A speed regulation control method and system for articulated vehicles based on yaw warning

By designing the yaw warning optimization objective function in the vehicle body coordinate system, the problems of limited adjustment amplitude and insufficient smoothness in articulated vehicle speed adjustment control are solved, and a more efficient path tracking control effect is achieved.

CN115447576BActive Publication Date: 2024-11-19UNIV OF SCI & TECH BEIJING
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202211129156.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-09-16
Publication Date
2024-11-19
Estimated Expiration
2042-09-16

AI Technical Summary

Technical Problem

The existing unmanned articulated vehicle motion control method has limited adjustment amplitude and insufficient smoothness when adjusting longitudinal speeds to improve the accuracy of path tracking control.

Method used

Adopting an articulated vehicle speed adjustment control method based on yaw warning, by establishing a driving trajectory prediction model and designing a yaw warning optimization objective function in the vehicle body coordinate system, decoupling the horizontal and vertical coordinates and heading angles, and solving the optimization objective function to achieve Speed ​​adjustment control.

Benefits of technology

The adjustment amplitude and smoothness of articulated vehicles in path tracking control can be improved, and the deviation of the reference path can be more effectively reduced and faster longitudinal speed adjustment can be achieved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115447576B_ABST
    Figure CN115447576B_ABST
Patent Text Reader

Abstract

The present invention discloses a speed regulation control method and system for an articulated vehicle based on yaw warning, the method comprising: establishing a driving trajectory prediction model for an articulated vehicle; importing the driving trajectory prediction model into a vehicle body coordinate system, using the vehicle body coordinate system to decouple the vehicle's lateral and longitudinal coordinates from the heading angle, designing an articulated vehicle yaw warning optimization objective function in the vehicle body coordinate system; solving the optimization objective function to achieve speed regulation control for the articulated vehicle. The speed regulation control method for an articulated vehicle provided by the present invention effectively solves the problems of limited adjustment range and insufficient adjustment smoothness in existing speed regulation control methods.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of motion control of unmanned articulated vehicles, and in particular to a speed regulation control method and system of an articulated vehicle based on yaw warning. Background Art

[0002] Articulated vehicles are a type of special vehicle commonly used in industries such as mining and construction, and their motion control is difficult. Traditional unmanned articulated vehicle motion control usually considers longitudinal speed regulation control and lateral path tracking control separately. However, some literature points out that due to the limited response speed of the steering mechanism of articulated vehicles, the longitudinal speed will have a significant impact on the effect of path tracking control (Bai G, Meng Y, Liu L, et al. A new path tracking method based on multilayer model predictive control [J]. Applied Sciences, 2019, 9 (13): 2649). In response to this, the literature proposes a path tracking control method based on multilayer model predictive control to improve the accuracy of path tracking control by actively adjusting the longitudinal speed. However, this method can only adjust the longitudinal speed at fixed intervals, and the longitudinal speed change amplitude between each two control cycles cannot change. Therefore, although this method can improve the accuracy of path tracking control by actively adjusting the longitudinal speed of the articulated vehicle, it still has shortcomings in terms of adjustment amplitude and smoothness. Summary of the invention

[0003] The present invention provides an articulated vehicle speed regulation control method and system based on yaw warning, so as to solve the technical problems of limited adjustment range and insufficient adjustment smoothness in existing speed regulation control methods when adjusting the longitudinal speed of the articulated vehicle to improve the accuracy of path tracking control.

[0004] In order to solve the above technical problems, the present invention provides the following technical solutions:

[0005] In one aspect, the present invention provides a method for adjusting and controlling the speed of an articulated vehicle based on a yaw warning, the method comprising:

[0006] Establish a model for predicting the trajectory of articulated vehicles;

[0007] The driving trajectory prediction model is imported into the vehicle body coordinate system, the vehicle body coordinate system is used to decouple the vehicle's lateral and longitudinal coordinates from the heading angle, and an articulated vehicle yaw warning optimization objective function is designed in the vehicle body coordinate system;

[0008] The optimization objective function is solved to achieve speed regulation control of the articulated vehicle.

[0009] Furthermore, the establishment of the articulated vehicle driving trajectory prediction model includes:

[0010] The following articulated vehicle kinematic model is established:

[0011]

[0012] Among them, L f L is the distance from the front axle to the articulation point of an articulated vehicle. r is the distance from the rear axle to the articulation point of an articulated vehicle, x f ,y f is the coordinate of the front axle center of the articulated vehicle in the global coordinate system, v f is the longitudinal velocity of the articulated vehicle, θ f is the heading angle, ω γ is the articulation angular velocity, γ is the articulation angle;

[0013] When performing yaw warning, the input of the model is the articulation angular velocity ω γ It is known that, assuming that the future articulation angular velocities are all 0, a series of articulation angular velocities are obtained, and the formula is as follows:

[0014]

[0015] Among them, ω γ (t) is the hinge angular velocity at the initial moment, ω γ (t|t) is the joint angular velocity at time t, ω γ (t+i|t) is the articulation angular velocity at time t+i, i=1,2,…,p-1, p is the predicted number of steps;

[0016] Using the Euler method discretized model, the future articulation angle is calculated as follows:

[0017]

[0018] Where γ(t|t) is the articulation angle at time t, γ(t+i|t) is the articulation angle at time t+i, i=1,2,…,p, and T is the prediction period;

[0019] When calculating the future heading angle, it is assumed that the longitudinal velocity is constant: And import the calculation of the future heading angle into the vehicle body coordinate system, that is, assuming that the initial value of the heading angle is 0, we get:

[0020]

[0021] Among them, θ f (t+i|t) is the heading angle at time t+i, i=1,2,…,p;

[0022] The initial values ​​of the horizontal and vertical coordinates are also assumed to be 0, and we get:

[0023]

[0024]

[0025] Among them, x f (t+i|t) is the x-coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system, and y f (t+i|t) is the y coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system;

[0026] make:

[0027]

[0028] This is the articulated vehicle driving trajectory prediction model.

[0029] Furthermore, the vehicle body coordinate system is used to decouple the vehicle's lateral and longitudinal coordinates from the heading angle, and an optimization objective function for the yaw warning of an articulated vehicle is designed in the vehicle body coordinate system, including:

[0030] When the driving trajectory prediction model has been imported into the vehicle body coordinate system, the p reference points on the reference path in front of the vehicle are also imported into the vehicle body coordinate system to obtain:

[0031]

[0032] Among them, x ref (t+i|t), y ref (t+i|t) is the coordinate of the reference path, θ ref (t+i|t) is the heading angle of the reference path, x refGC (t+i|t), y refGC (t+i|t) is the coordinate of the reference path in the global coordinate system, x GC (t), y GC (t) is the initial coordinate in the global coordinate system, θ GC (t) is the initial heading angle in the global coordinate system, θ refGC (t+i|t) is the heading angle of the reference path in the global coordinate system;

[0033] Writing the above equation in vector form, we get:

[0034]

[0035] Fitting the reference information as a function of the longitudinal velocity yields:

[0036]

[0037] Among them, f x (iv f T) is the function of the horizontal axis with respect to the longitudinal velocity, f y (iv f T) is the function of the ordinate with respect to the longitudinal velocity, f θ (iv f T) is the function of heading angle with respect to longitudinal velocity;

[0038] The optimization objective function is designed as:

[0039]

[0040] in:

[0041]

[0042] Among them, q x ,q y and q θ They are the displacement error weight in the horizontal direction, the displacement error weight in the vertical direction and the heading error weight respectively.

[0043] Furthermore, the optimization objective function is solved to realize the speed regulation control of the articulated vehicle, including:

[0044] The minimum value of the optimization objective function is solved to obtain a faster longitudinal speed that can make the articulated vehicle deviate less from the reference path, thereby realizing speed regulation control of the articulated vehicle.

[0045] On the other hand, the present invention further provides an articulated vehicle speed regulation control system based on yaw warning, the articulated vehicle speed regulation control system based on yaw warning comprising:

[0046] A driving trajectory prediction model building module is used to build a driving trajectory prediction model for an articulated vehicle;

[0047] A vehicle yaw warning optimization objective function design module is used to import the driving trajectory prediction model constructed by the driving trajectory prediction model construction module into the vehicle body coordinate system, use the vehicle body coordinate system to decouple the vehicle's transverse and longitudinal coordinates from the heading angle, and design an articulated vehicle yaw warning optimization objective function in the vehicle body coordinate system;

[0048] The optimization objective function solving module is used to solve the optimization objective function designed by the vehicle yaw warning optimization objective function design module to achieve articulated vehicle speed regulation control.

[0049] Furthermore, the driving trajectory prediction model building module is specifically used for:

[0050] The following articulated vehicle kinematic model is established:

[0051]

[0052] Among them, L f L is the distance from the front axle to the articulation point of an articulated vehicle. r is the distance from the rear axle to the articulation point of an articulated vehicle, x f ,y f is the coordinate of the front axle center of the articulated vehicle in the global coordinate system, v f is the longitudinal velocity of the articulated vehicle, θ f is the heading angle, ω γ is the articulation angular velocity, γ is the articulation angle;

[0053] When performing yaw warning, the input of the model is the articulation angular velocity ω γ It is known that, assuming that the future articulation angular velocities are all 0, a series of articulation angular velocities are obtained, and the formula is as follows:

[0054]

[0055] Among them, ω γ (t) is the hinge angular velocity at the initial moment, ω γ (t|t) is the joint angular velocity at time t, ω γ (t+i|t) is the articulation angular velocity at time t+i, i=1,2,…,p-1, p is the predicted number of steps;

[0056] Using the Euler method discretized model, the future articulation angle is calculated as follows:

[0057]

[0058] Where γ(t|t) is the articulation angle at time t, γ(t+i|t) is the articulation angle at time t+i, i=1,2,…,p, and T is the prediction period;

[0059] When calculating the future heading angle, it is assumed that the longitudinal velocity is constant: And import the calculation of the future heading angle into the vehicle body coordinate system, that is, assuming that the initial value of the heading angle is 0, we get:

[0060]

[0061] Among them, θ f (t+i|t) is the heading angle at time t+i, i=1,2,…,p;

[0062] The initial values ​​of the horizontal and vertical coordinates are also assumed to be 0, and we get:

[0063]

[0064]

[0065] Among them, x f (t+i|t) is the x-coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system, and y f (t+i|t) is the y coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system;

[0066] make:

[0067]

[0068] This is the articulated vehicle driving trajectory prediction model.

[0069] Furthermore, the vehicle deviation warning optimization objective function design module is specifically used for:

[0070] When the driving trajectory prediction model has been imported into the vehicle body coordinate system, the p reference points on the reference path in front of the vehicle are also imported into the vehicle body coordinate system to obtain:

[0071]

[0072] Among them, x ref (t+i|t), y ref (t+i|t) is the coordinate of the reference path, θ ref (t+i|t) is the heading angle of the reference path, x refGC (t+i|t), y refGC (t+i|t) is the coordinate of the reference path in the global coordinate system, x GC (t), y GC (t) is the initial coordinate in the global coordinate system, θ GC (t) is the initial heading angle in the global coordinate system, θ refGC (t+i|t) is the heading angle of the reference path in the global coordinate system;

[0073] Writing the above equation in vector form, we get:

[0074]

[0075] Fitting the reference information as a function of the longitudinal velocity yields:

[0076]

[0077] Among them, f x (iv f T) is the function of the horizontal axis with respect to the longitudinal velocity, f y(iv f T) is the function of the ordinate with respect to the longitudinal velocity, f θ (iv f T) is the function of heading angle with respect to longitudinal velocity;

[0078] The optimization objective function is designed as:

[0079]

[0080] in:

[0081]

[0082] Among them, q x ,q y and q θ They are the displacement error weight in the horizontal direction, the displacement error weight in the vertical direction and the heading error weight respectively.

[0083] Furthermore, the optimization objective function solving module is specifically used for:

[0084] The minimum value of the optimization objective function is solved to obtain a faster longitudinal speed that can make the articulated vehicle deviate less from the reference path, thereby realizing speed regulation control of the articulated vehicle.

[0085] On the other hand, the present invention further provides an electronic device, comprising a processor and a memory; wherein the memory stores at least one instruction, and the instruction is loaded and executed by the processor to implement the above method.

[0086] In yet another aspect, the present invention further provides a computer-readable storage medium, wherein the storage medium stores at least one instruction, and the instruction is loaded and executed by a processor to implement the above method.

[0087] The beneficial effects brought about by the technical solution provided by the present invention include at least:

[0088] The present invention provides a speed regulation control method for an articulated vehicle based on yaw warning. The method adopts the idea of ​​predictive control. First, a driving trajectory prediction model of the articulated vehicle is established. Then, the lateral and longitudinal coordinates are decoupled from the heading angle using the local coordinate system of the vehicle body. A yaw warning optimization objective function is designed in this coordinate system to obtain a faster longitudinal speed that can make the articulated vehicle deviate less from a reference path, thereby solving the problems of limited adjustment range and insufficient adjustment smoothness in existing speed regulation control methods. BRIEF DESCRIPTION OF THE DRAWINGS

[0089] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0090] Figure 1 It is a schematic diagram of the execution flow of the speed regulation control method of an articulated vehicle based on yaw warning provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0091] In order to make the objectives, technical solutions and advantages of the present invention more clear, the embodiments of the present invention will be further described in detail below with reference to the accompanying drawings.

[0092] First embodiment

[0093] This embodiment provides a method for adjusting and controlling the speed of an articulated vehicle based on yaw warning, which can be implemented by an electronic device. The execution process of the method is as follows: Figure 1 As shown, the following steps are included:

[0094] S1, establish a prediction model for the driving trajectory of an articulated vehicle;

[0095] S2, import the driving trajectory prediction model into the vehicle body coordinate system, use the vehicle body coordinate system to decouple the vehicle's lateral and longitudinal coordinates from the heading angle, and design the articulated vehicle yaw warning optimization objective function in the vehicle body coordinate system;

[0096] S3, solving the optimization objective function to realize the speed regulation control of the articulated vehicle.

[0097] Furthermore, the process of establishing the articulated vehicle driving trajectory prediction model includes:

[0098] The articulated vehicle trajectory prediction model is based on the articulated vehicle kinematic model:

[0099]

[0100] Among them, L f L is the distance from the front axle to the articulation point of an articulated vehicle. r is the distance from the rear axle to the articulation point of an articulated vehicle, x f ,y f is the coordinate of the center of the front axle of the articulated vehicle in the global coordinate system, v f is the longitudinal velocity of the articulated vehicle, θ f is the heading angle (roll angle), ω γ is the articulation angular velocity, γ is the articulation angle;

[0101] When performing yaw warning, the input of the model is the articulation angular velocity ω γ It is known that, assuming that the future articulation angular velocities are all 0, a series of articulation angular velocities can be obtained:

[0102]

[0103] Among them, ω γ (t) is the hinge angular velocity at the initial moment, ω γ (t|t) is the joint angular velocity at time t, ω γ (t+i|t) is the articulation angular velocity at time t+i, i=1,2,…,p-1, p is the predicted number of steps;

[0104] Using the Euler method to discretize the model, the future articulation angle can also be calculated:

[0105]

[0106] Where γ(t|t) is the articulation angle at time t, γ(t+i|t) is the articulation angle at time t+i, i=1,2,…,p, and T is the prediction period;

[0107] For the heading angle, considering that the heading angular velocity is proportional to the longitudinal velocity, when the optimization goal is to reduce the heading error and its integral displacement error, there is a local optimal situation where the error can be reduced by increasing the longitudinal velocity. To avoid this situation, the longitudinal velocity is assumed to be constant at v when calculating the future heading angle. f At the same time, considering that the coupling relationship between the heading angle and the lateral and longitudinal errors is changing, in order to weaken the influence of this change, the calculation of the future heading angle is imported into the vehicle body coordinate system, that is, assuming that the initial value of the heading angle is 0:

[0108]

[0109] Among them, θ f (t+i|t) is the heading angle at time t+i, i=1,2,…,p;

[0110] The initial values ​​of the horizontal and vertical axes are also assumed to be 0:

[0111]

[0112]

[0113] Among them, x f (t+i|t) is the x-coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system, and y f (t+i|t) is the y coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system;

[0114] make:

[0115]

[0116] This is the articulated vehicle driving trajectory prediction model.

[0117] Furthermore, the vehicle body coordinate system is used to decouple the vehicle's lateral and longitudinal coordinates from the heading angle, and an optimization objective function for the yaw warning of an articulated vehicle is designed in the vehicle body coordinate system, including:

[0118] Since the driving trajectory prediction model has been imported into the body coordinate system, the design of the articulated vehicle yaw warning optimization objective function first requires importing the p reference points on the reference path in front of the vehicle into the body coordinate system:

[0119]

[0120] The subscript ref refers to the reference path information, and the subscript GC refers to the information in the global coordinate system. ref (t+i|t),y ref (t+i|t) is the coordinate of the reference path, θ ref (t+i|t) is the heading angle of the reference path, x refGC (t+i|t), y refGC (t+i|t) is the coordinate of the reference path in the global coordinate system, x GC (t), y GC (t) is the initial coordinate in the global coordinate system, θ GC (t) is the initial heading angle in the global coordinate system, θ refGC (t+i|t) is the heading angle of the reference path in the global coordinate system;

[0121] Write the above equation in vector form:

[0122]

[0123] Considering that the reference point selection is also related to the speed, the reference information is fitted as a function of the longitudinal speed:

[0124]

[0125] Among them, f x (iv f T) is the function of the horizontal axis with respect to the longitudinal velocity, f y (iv f T) is the function of the ordinate with respect to the longitudinal velocity, f θ (iv f T) is the function of heading angle with respect to longitudinal velocity;

[0126] On this basis, the optimization objective function can be designed as:

[0127]

[0128] in:

[0129]

[0130] Among them, q x ,q y and q θ They are the displacement error weight in the horizontal direction, the displacement error weight in the vertical direction and the heading error weight. To ensure timely deceleration, q x Usually a smaller value is used.

[0131] Furthermore, the optimization objective function is solved to realize the speed regulation control of the articulated vehicle, including:

[0132] By solving the minimum value of the above-mentioned yaw warning optimization objective function, a faster longitudinal speed that can make the articulated vehicle deviate less from the reference path can be obtained, thereby realizing speed regulation control of the articulated vehicle.

[0133] In summary, this embodiment provides a speed regulation control method for an articulated vehicle based on yaw warning, which adopts the idea of ​​predictive control. First, a driving trajectory prediction model of an articulated vehicle is established. Then, the local coordinate system of the vehicle body is used to decouple the transverse and longitudinal coordinates from the heading angle, and a yaw warning optimization objective function is designed in this coordinate system to obtain a faster longitudinal speed that can make the articulated vehicle deviate less from the reference path, thereby solving the problems of limited adjustment range and insufficient adjustment smoothness in existing speed regulation control methods.

[0134] Second embodiment

[0135] This embodiment provides an articulated vehicle speed adjustment control system based on yaw warning, comprising:

[0136] A driving trajectory prediction model building module is used to build a driving trajectory prediction model for an articulated vehicle;

[0137] A vehicle yaw warning optimization objective function design module is used to import the driving trajectory prediction model constructed by the driving trajectory prediction model construction module into the vehicle body coordinate system, use the vehicle body coordinate system to decouple the vehicle's transverse and longitudinal coordinates from the heading angle, and design an articulated vehicle yaw warning optimization objective function in the vehicle body coordinate system;

[0138] The optimization objective function solving module is used to solve the optimization objective function designed by the vehicle yaw warning optimization objective function design module to achieve articulated vehicle speed regulation control.

[0139] The articulated vehicle speed regulation control system based on yaw warning of the present embodiment corresponds to the articulated vehicle speed regulation control method based on yaw warning of the above-mentioned first embodiment; wherein, the functions implemented by each functional module in the articulated vehicle speed regulation control system based on yaw warning of the present embodiment correspond one-to-one to each process step in the articulated vehicle speed regulation control method based on yaw warning of the above-mentioned first embodiment; therefore, they will not be repeated here.

[0140] Third embodiment

[0141] This embodiment provides an electronic device, which includes a processor and a memory; wherein the memory stores at least one instruction, and the instruction is loaded and executed by the processor to implement the method of the first embodiment.

[0142] The electronic device may have relatively large differences due to different configurations or performances, and may include one or more processors (central processing units, CPU) and one or more memories, wherein the memory stores at least one instruction, and the instruction is loaded by the processor to execute the above method.

[0143] Fourth embodiment

[0144] This embodiment provides a computer-readable storage medium, which stores at least one instruction, and the instruction is loaded and executed by a processor to implement the method of the first embodiment. The computer-readable storage medium may be a ROM, a random access memory, a CD-ROM, a magnetic tape, a floppy disk, an optical data storage device, etc. The instructions stored therein may be loaded by a processor in a terminal to execute the method.

[0145] In addition, it should be noted that the present invention can be provided as a method, an apparatus or a computer program product. Therefore, the embodiments of the present invention can take the form of a complete hardware embodiment, a complete software embodiment or an embodiment combining software and hardware. Moreover, the embodiments of the present invention can take the form of a computer program product implemented on one or more computer-usable storage media containing computer-usable program code.

[0146] The embodiments of the present invention are described with reference to the flowcharts and / or block diagrams of the methods, terminal devices (systems), and computer program products according to the embodiments of the present invention. It should be understood that each process and / or block in the flowchart and / or block diagram, as well as the combination of the processes and / or blocks in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, an embedded processor, or other programmable data processing terminal device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing terminal device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0147] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing terminal device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce a manufactured product including an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 These computer program instructions can also be loaded onto a computer or other programmable data processing terminal device, so that a series of operation steps are executed on the computer or other programmable terminal device to produce a computer-implemented process, so that the instructions executed on the computer or other programmable terminal device provide for implementing the process in the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0148] It should also be noted that, in this article, the terms "include", "comprises" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or terminal device including a series of elements includes not only those elements, but also includes other elements not explicitly listed, or also includes elements inherent to such process, method, article or terminal device. In the absence of further restrictions, the elements defined by the sentence "comprises a ..." do not exclude the existence of other identical elements in the process, method, article or terminal device including the elements.

[0149] Finally, it should be noted that the above is a preferred embodiment of the present invention. It should be pointed out that although the preferred embodiment of the present invention has been described, for those skilled in the art, once the basic creative concept of the present invention is known, several improvements and modifications can be made without departing from the principles of the present invention, and these improvements and modifications should also be regarded as the protection scope of the present invention. Therefore, the attached claims are intended to be interpreted as including the preferred embodiment and all changes and modifications that fall within the scope of the embodiments of the present invention.

Claims

1. A speed regulation control method for an articulated vehicle based on yaw warning, It is characterized in that include: Establish a model for predicting the trajectory of articulated vehicles; The driving trajectory prediction model is imported into the vehicle body coordinate system, the vehicle body coordinate system is used to decouple the vehicle's lateral and longitudinal coordinates from the heading angle, and an articulated vehicle yaw warning optimization objective function is designed in the vehicle body coordinate system; Solving the optimization objective function to achieve speed regulation control of the articulated vehicle; The method of establishing a travel trajectory prediction model for an articulated vehicle comprises: The following articulated vehicle kinematic model is established: Among them, L f L is the distance from the front axle to the articulation point of an articulated vehicle. r is the distance from the rear axle to the articulation point of an articulated vehicle, x f ,y f is the coordinate of the front axle center of the articulated vehicle in the global coordinate system, v f is the longitudinal velocity of the articulated vehicle, θ f is the heading angle, ω γ is the articulation angular velocity, γ is the articulation angle; When performing yaw warning, the input of the model is the articulation angular velocity ω γ It is known that, assuming that the future articulation angular velocities are all 0, a series of articulation angular velocities are obtained, and the formula is as follows: Among them, ω γ (t) is the hinge angular velocity at the initial moment, ω γ (t|t) is the joint angular velocity at time t, ω γ (t+i|t) is the articulation angular velocity at time t+i, i=1,2,…,p-1, p is the predicted number of steps; Using the Euler method discretized model, the future articulation angle is calculated as follows: Where γ(t|t) is the articulation angle at time t, γ(t+i|t) is the articulation angle at time t+i, i=1,2,…,p, and T is the prediction period; When calculating the future heading angle, it is assumed that the longitudinal velocity is constant: And import the calculation of the future heading angle into the vehicle body coordinate system, that is, assuming that the initial value of the heading angle is 0, we get: Among them, θ f (t+i|t) is the heading angle at time t+i, i=1,2,…,p; The initial values ​​of the horizontal and vertical coordinates are also assumed to be 0, and we get: Among them, x f (t+i|t) is the x-coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system, and y f (t+i|t) is the y coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system; make: That is, the articulated vehicle driving trajectory prediction model; The vehicle body coordinate system is used to decouple the vehicle's lateral and longitudinal coordinates from the heading angle, and an optimization objective function for the yaw warning of an articulated vehicle is designed in the vehicle body coordinate system, including: When the driving trajectory prediction model has been imported into the vehicle body coordinate system, the p reference points on the reference path in front of the vehicle are also imported into the vehicle body coordinate system to obtain: Among them, x ref (t+i|t), y ref (t+i|t) is the coordinate of the reference path, θ ref (t+i|t) is the heading angle of the reference path, x refGC (t+i|t), y refGC (t+i|t) is the coordinate of the reference path in the global coordinate system, x GC (t), y GC (t) is the initial coordinate in the global coordinate system, θ GC (t) is the initial heading angle in the global coordinate system, θ refGC (t+i|t) is the heading angle of the reference path in the global coordinate system; Writing the above equation in vector form, we get: Fitting the reference information as a function of the longitudinal velocity yields: Among them, f x (iv f T) is the function of the horizontal axis with respect to the longitudinal velocity, f y (iv f T) is the function of the ordinate with respect to the longitudinal velocity, f θ (iv f T) is the function of heading angle with respect to longitudinal velocity; The optimization objective function is designed as: in: Among them, q x ,q y and q θ They are the displacement error weight in the horizontal direction, the displacement error weight in the vertical direction and the heading error weight respectively.

2. The speed regulation control method for an articulated vehicle based on yaw warning according to claim 1, It is characterized in that Solving the optimization objective function to achieve speed regulation control of the articulated vehicle includes: The minimum value of the optimization objective function is solved to obtain a faster longitudinal speed that can make the articulated vehicle deviate less from the reference path, thereby realizing speed regulation control of the articulated vehicle.

3. An articulated vehicle speed regulation control system based on yaw warning, It is characterized in that include: A driving trajectory prediction model building module is used to build a driving trajectory prediction model for an articulated vehicle; A vehicle yaw warning optimization objective function design module is used to import the driving trajectory prediction model constructed by the driving trajectory prediction model construction module into the vehicle body coordinate system, use the vehicle body coordinate system to decouple the vehicle's transverse and longitudinal coordinates from the heading angle, and design an articulated vehicle yaw warning optimization objective function in the vehicle body coordinate system; An optimization objective function solving module is used to solve the optimization objective function designed by the vehicle yaw warning optimization objective function design module to achieve speed regulation control of the articulated vehicle; The driving trajectory prediction model building module is specifically used for: The following articulated vehicle kinematic model is established: Among them, L f L is the distance from the front axle to the articulation point of an articulated vehicle. r is the distance from the rear axle to the articulation point of an articulated vehicle, x f ,y f is the coordinate of the front axle center of the articulated vehicle in the global coordinate system, v f is the longitudinal velocity of the articulated vehicle, θ f is the heading angle, ω γ is the articulation angular velocity, γ is the articulation angle; When performing yaw warning, the input of the model is the articulation angular velocity ω γ It is known that, assuming that the future articulation angular velocities are all 0, a series of articulation angular velocities are obtained, and the formula is as follows: Among them, ω γ (t) is the hinge angular velocity at the initial moment, ω γ (t|t) is the joint angular velocity at time t, ω γ (t+i|t) is the articulation angular velocity at time t+i, i=1,2,…,p-1, p is the predicted number of steps; Using the Euler method discretized model, the future articulation angle is calculated as follows: Where γ(t|t) is the articulation angle at time t, γ(t+i|t) is the articulation angle at time t+i, i=1,2,…,p, and T is the prediction period; When calculating the future heading angle, it is assumed that the longitudinal velocity is constant: And import the calculation of the future heading angle into the vehicle body coordinate system, that is, assuming that the initial value of the heading angle is 0, we get: Among them, θ f (t+i|t) is the heading angle at time t+i, i=1,2,…,p; The initial values ​​of the horizontal and vertical coordinates are also assumed to be 0, and we get: Among them, x f (t+i|t) is the x-coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system, and y f (t+i|t) is the y coordinate of the center of the front axle of the articulated vehicle at time t+i in the global coordinate system; make: That is, the articulated vehicle driving trajectory prediction model; The vehicle deviation warning optimization objective function design module is specifically used for: When the driving trajectory prediction model has been imported into the vehicle body coordinate system, the p reference points on the reference path in front of the vehicle are also imported into the vehicle body coordinate system to obtain: Among them, x ref (t+i|t), y ref (t+i|t) is the coordinate of the reference path, θ ref (t+i|t) is the heading angle of the reference path, x refGC (t+i|t), y refGC (t+i|t) is the coordinate of the reference path in the global coordinate system, x GC (t), y GC (t) is the initial coordinate in the global coordinate system, θ GC (t) is the initial heading angle in the global coordinate system, θ refGC (t+i|t) is the heading angle of the reference path in the global coordinate system; Writing the above equation in vector form, we get: Fitting the reference information as a function of the longitudinal velocity yields: Among them, f x (iv f T) is the function of the horizontal axis with respect to the longitudinal velocity, f y (iv f T) is the function of the ordinate with respect to the longitudinal velocity, f θ (iv f T) is the function of heading angle with respect to longitudinal velocity; The optimization objective function is designed as: in: Among them, q x ,q y and q θ They are the displacement error weight in the horizontal direction, the displacement error weight in the vertical direction and the heading error weight respectively.

4. The articulated vehicle speed regulation control system based on yaw warning as claimed in claim 3, It is characterized in that The optimization objective function solving module is specifically used for: The minimum value of the optimization objective function is solved to obtain a faster longitudinal speed that can make the articulated vehicle deviate less from the reference path, thereby realizing speed regulation control of the articulated vehicle.