Trajectory tracking method and system of three-degree-of-freedom vehicle model based on strong wind effect

By considering the influence of vertical, longitudinal, roll and pitch torque of strong winds in the three-degree of freedom vehicle model, combining the tire side stiffness and vertical load relationship, the MPC controller is optimized, and the trajectory tracking accuracy difference of driverless commercial vehicles is solved. The problem of improving manipulation stability and security.

CN118940497AActive Publication Date: 2024-11-12XINGAN TECHNOLOGY (HEBEI XIONGAN) CO LTD
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
CN202410983928.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-12
Estimated Expiration
2044-07-22

AI Technical Summary

Technical Problem

The prior art fails to effectively consider the combined effect of strong winds on the vehicle's vertical force, longitudinal force, roll moment and pitch moment, resulting in poor accuracy of tracking and control of trajectory tracking for driverless commercial vehicles.

Method used

Using a three-degree of freedom vehicle model based on strong winds, by decomposing the combined force of strong winds and establishing a corresponding dynamic model, adding the relationship between tire side stiffness and vertical load, the MPC controller is optimized to achieve trajectory tracking control.

Benefits of technology

It improves the trajectory tracking accuracy, reduces the calculation amount and time, improves the timeliness, and enhances the handling stability and safety of the vehicle under strong wind conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118940497A_ABST
    Figure CN118940497A_ABST
Patent Text Reader

Abstract

The invention discloses a trajectory tracking method and system based on a three-degree-of-freedom vehicle model under the action of strong wind. The trajectory tracking method comprises the following steps: establishing a vehicle dynamics model comprising three degrees of freedom of longitudinal, transverse and yawing according to vehicle parameters; and establishing a tire model according to the tire structure and parameters. In a vehicle coordinate system, resultant force of strong wind acting on a vehicle is decomposed into component force in x, y and z directions, and a strong wind model is established. Influences brought by a vertical load, a roll moment and a pitching moment are represented through changes of the tire cornering stiffness, and a tire model with changes of the front wheel cornering stiffness and the rear wheel cornering stiffness is obtained. Adding the influence of the tire model with the front and rear wheel cornering stiffness change and the strong wind model into the three-degree-of-freedom vehicle dynamics model to obtain a three-degree-of-freedom vehicle dynamics model under the action of strong wind; and a trajectory tracking controller of the vehicle is established to realize trajectory tracking of the vehicle. The method is not only high in tracking trajectory precision, but also fast in tracking time efficiency.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention discloses a trajectory tracking method and system based on a three-degree-of-freedom vehicle model under strong winds, belonging to the technical field of intelligent vehicle trajectory tracking control. Background Art

[0002] Since the beginning of the 21st century, with the rapid development of highway construction in my country, the mileage of highways and bridges in mountainous and hilly areas has also increased rapidly, the number of passenger cars and passenger and freight transportation has increased day by day, and the demand for high-performance commercial vehicles has also increased. Highway tunnels in mountainous areas are usually very long. Due to the deep canyons between tunnels, strong winds are easily generated due to geographical factors. When a vehicle leaves a tunnel, it will enter a high-intensity crosswind area from an environment with no crosswind at all, or when a vehicle is driving normally on a bridge and is suddenly affected by the sea breeze, due to the large side area of ​​the commercial vehicle, the driver often has no time to react due to habitual effects, resulting in traffic accidents. Strong winds have an important impact on the driving stability and safety of vehicles. Therefore, studying the impact of strong winds on the trajectory tracking accuracy and safety of unmanned commercial vehicles has important theoretical significance and practical value.

[0003] At present, the existing technology mainly targets crosswind and considers the impact of strong wind on the yaw moment of the vehicle. For example, Zhao Youqun from Nanjing University of Aeronautics and Astronautics considered the obstacle avoidance problem of high-speed vehicles under the influence of crosswind, designed a second-order anti-disturbance controller, and used Carsim and Simulink for joint simulation. However, it did not consider the combined impact of strong wind on the vehicle's vertical force, longitudinal force, roll moment and pitch moment, resulting in poor trajectory tracking control accuracy. Summary of the invention

[0004] Purpose of the invention: In order to solve the problem in the prior art that the combined effects of vertical force, longitudinal force, roll moment and pitch moment of strong wind on the vehicle are not taken into account, resulting in poor trajectory tracking control accuracy, the present invention provides a trajectory tracking method based on a three-degree-of-freedom vehicle model under strong wind.

[0005] Technical solution: To achieve the above purpose, the technical solution adopted by the present invention is:

[0006] A trajectory tracking method based on a three-degree-of-freedom vehicle model under strong winds comprises the following steps:

[0007] Step 1: Establish a vehicle three-degree-of-freedom dynamic model including longitudinal, lateral and yaw degrees of freedom according to vehicle parameters.

[0008] Step 2: Establish a tire model based on tire structure and parameters.

[0009] Step 3, in the vehicle coordinate system, decompose the resultant force of the strong wind on the vehicle into components in the x, y and z directions, set the position of the strong wind resultant force point in the x, y and z directions at Δx, Δy and Δz from the center of mass of the vehicle, and establish a strong wind model.

[0010] Step 4, characterize the influence of vertical load, rolling moment and pitching moment through the change of tire cornering stiffness, and establish the relationship between tire cornering stiffness and vertical load. Take the average value of left and right wheel cornering stiffness as the cornering stiffness of the front and rear wheels in the three-degree-of-freedom vehicle dynamics model under strong wind, and then obtain the tire model with front and rear wheel cornering stiffness change through the change of front and rear wheel cornering stiffness.

[0011] Step 5: Compare the tire model with the front and rear wheel cornering stiffness changes and the x- and y-direction components of the wind force in the wind model wx 、F wy and the yaw moment M caused by strong wind wz The influence of is added into the three-degree-of-freedom vehicle dynamics model, and the three-degree-of-freedom vehicle dynamics model under strong wind is obtained.

[0012] Step 6: Perform vehicle trajectory tracking control based on the strong wind model and the three-degree-of-freedom vehicle dynamics model under the strong wind.

[0013] Preferably, the dynamics and kinematics equations of the three-degree-of-freedom vehicle dynamics model under the action of strong wind in step 5 are:

[0014]

[0015]

[0016]

[0017]

[0018]

[0019] Where m is the vehicle mass, v is x is the lateral velocity of the front wheel, v y is the longitudinal velocity, is the yaw angular velocity, F xf is the longitudinal force on the front wheel, F xr is the longitudinal force on the rear wheel, δ f are the front wheel angle, C f is the cornering stiffness of the front wheel, C r is the cornering stiffness of the rear wheel, α f , α r are the front and rear wheel slip angles, C Dx is the air coefficient in the x direction, CDy is the air coefficient in the y direction, C Dz is the air coefficient in the z direction, ρ is the air density, A is the frontal area of ​​the vehicle, v rx is the relative wind speed in the x direction, v ry is the relative wind speed in the y direction, v rz is the relative wind speed in the z direction, I z It is expressed as the moment of inertia of the vehicle body around the z-axis, a is the distance from the center of mass to the front axle, and b is the distance from the center of mass to the rear axle.

[0020] Preferably, in step 4, when calculating the change in the vertical load on the wheel, it is assumed that the vertical load, the rolling moment and the pitching moment generated by the strong wind are positive, and the change in the vertical load on the left and right wheels caused by the strong wind rolling moment is The change in vertical load on the front and rear wheels caused by the pitching moment is The change in vertical load on the front and rear wheels caused by the vertical load is

[0021] The vertical load variation of the four wheels of the vehicle is:

[0022]

[0023]

[0024]

[0025]

[0026] Where, ΔF wx M is the vertical load variation of the left and right wheels caused by the strong wind roll moment. wx is the torque generated by the strong wind in the x direction, B is the wheelbase, ΔF wy M is the change in vertical load of the front and rear wheels caused by the pitching moment. wy is the moment generated by the strong wind in the y direction, L is the wheelbase, ΔF zf is the change in the vertical load on the front wheel caused by the vertical load, b is the distance from the center of mass to the rear axle, ΔF z is the change in the vehicle's vertical load, ΔF zr is the change in the vertical load on the rear wheel caused by the vertical load, a is the distance from the center of mass to the front axle, ΔF fl is the vertical load change of the left front wheel, ΔF fr is the vertical load change of the right front wheel, ΔF rl is the vertical load change of the left rear wheel, ΔF rr is the vertical load variation of the right rear wheel.

[0027] Preferably, the strong wind model includes the force and torque generated by the strong wind, and the force and torque generated by the strong wind are as follows:

[0028]

[0029]

[0030] In the formula, F wk is the force generated by the strong wind, M wk is the torque generated by the strong wind, ρ is the air density, v rk is the relative wind speed in the k direction, C Dk is the air coefficient in the k direction, A is the frontal area of ​​the vehicle, Δk is the position of the point of action of the resultant force of the strong wind in the k-axis direction of the vehicle from the center of mass, where k = x, y, z.

[0031] Preferably, the tire model in step 2 includes the relationship between the longitudinal force and the vertical force of the wheel, the longitudinal slip rate, and the lateral force of the front and rear wheels.

[0032] The relationship between the wheel longitudinal force and the vertical force is:

[0033]

[0034] The longitudinal slip rate is:

[0035]

[0036] Among them, F x is the longitudinal force of the wheel, μ is the road adhesion coefficient, F z is the wheel vertical force, s is the longitudinal slip rate, r is the rolling radius of the wheel, ω is the wheel angular velocity, v x is the longitudinal speed of the wheel;

[0037] The normal forces on the front and rear wheels are F zf is the normal force on the front wheel, F zr is the normal force on the rear wheel, g is the acceleration due to gravity, and the wheelbase L = a + b.

[0038] The lateral forces on the front and rear wheels are:

[0039] F yf =C f α f ;

[0040] F yr =C r α r ;

[0041] Among them, C f is the cornering stiffness of the front wheel, αf is the front wheel yaw angle, C r is the cornering stiffness of the rear wheel, α r is the rear wheel yaw angle.

[0042] Preferably, under the assumption of a small wheel angle,

[0043] Preferably, in step 3, when the point of action of the strong wind resultant force is not located at the center of mass of the vehicle, the vehicle will also be subjected to the effects of yaw moment, roll moment and pitch moment.

[0044] Another object of the present invention is to provide a trajectory tracking control system based on a three-degree-of-freedom vehicle model under strong winds, comprising an MPC controller, a state estimator, a turning angle matching unit, a strong wind model unit, and a comparison unit. The MPC controller comprises a prediction model unit, an objective function constraint condition unit, and an optimal solution unit, wherein:

[0045] The prediction model unit is provided with a three-degree-of-freedom vehicle dynamics model under the action of strong winds.

[0046] The high wind model unit obtains vehicle state data under the high wind according to the high wind.

[0047] The state estimator receives the real-time parameters of the controlled vehicle and the state data under the action of strong wind in real time to obtain the latest estimated state.

[0048] The comparison unit compares the reference trajectory with the latest control trajectory to obtain input parameters.

[0049] The MPC controller controls the front wheel steering angle according to the input parameters based on the three-degree-of-freedom vehicle dynamics model under the action of strong winds, and optimizes and solves through the objective function constraint condition unit and the optimal solution unit to output the optimal control value.

[0050] Another object of the present invention is to provide an electronic device, comprising: at least one processor, at least one memory and a communication interface. The processor, memory and communication interface communicate with each other. The memory stores program instructions that can be executed by the processor, and the processor calls the program instructions to execute the trajectory tracking method based on the three-degree-of-freedom vehicle model under the action of strong wind.

[0051] Another object of the present invention is to provide a computer-readable storage medium, which stores program instructions, and when the program instructions are executed by a processor, the processor executes the trajectory tracking method based on the three-degree-of-freedom vehicle model under strong winds.

[0052] Compared with the prior art, the present invention has the following beneficial effects:

[0053] 1. The x and y direction components of the wind force F wx 、F wy and the yaw moment M caused by strong wind wz The influence of the wind force F is added to the three-degree-of-freedom vehicle dynamics model by increasing the x and y direction components of the wind force. wx 、F wy and the yaw moment M caused by strong wind wz The influence of the tracking trajectory is high.

[0054] 2. Only a three-degree-of-freedom model is used, and the pitch moment and roll moment are converted into the change of the cornering stiffness of the front and rear wheels through the relationship between the vertical load of the tire and the cornering stiffness; finally, due to the reduction of the degree of freedom of the model, the two degrees of freedom of pitch and roll are reduced, the amount of algorithm calculation is reduced, the calculation time is shortened, and the timeliness of tracking is improved. BRIEF DESCRIPTION OF THE DRAWINGS

[0055] Figure 1 It is the three-degree-of-freedom dynamic model of the vehicle.

[0056] Figure 2 The tire dynamics model.

[0057] Figure 3 is the relationship between the tire's cornering stiffness and vertical load.

[0058] Figure 4 It is a model predictive control prediction model with a strong wind model added.

[0059] Figure 5 is the body coordinate system.

[0060] Figure 6 The process of converting front and rear wheel cornering stiffness into high wind torque.

[0061] Figure 7 It is the double lane change reference trajectory and fan position under overtaking conditions.

[0062] Figure 8 This is the trajectory tracking effect diagram under the lateral wind speed of 10m / s and the road adhesion coefficient of 0.8.

[0063] Fig. 9 This is a graph showing the change of yaw angle over time when the lateral wind speed is 10m / s and the road adhesion coefficient is 0.8.

[0064] Fig.10 This is a graph showing the yaw angular velocity changing with time when the lateral wind speed is 10m / s and the road adhesion coefficient is 0.8.

[0065] Fig.11 This is the trajectory tracking effect diagram under the lateral wind speed of 10m / s and the road adhesion coefficient of 0.5.

[0066] Fig.12 This is a graph showing the change of yaw angle over time when the lateral wind speed is 10m / s and the road adhesion coefficient is 0.5.

[0067] Fig.13 This is a graph showing the yaw angular velocity changing with time when the lateral wind speed is 10m / s and the road adhesion coefficient is 0.5.

[0068] Fig.14 This is the trajectory tracking effect diagram under the lateral wind speed of 10m / s and the road adhesion coefficient of 0.3.

[0069] Fig.15 This is a graph showing the change of yaw angle over time when the lateral wind speed is 10m / s and the road adhesion coefficient is 0.3.

[0070] Fig.16 This is a graph showing the yaw angular velocity changing with time when the lateral wind speed is 10m / s and the road adhesion coefficient is 0.3. DETAILED DESCRIPTION

[0071] The present invention is further explained below in conjunction with the accompanying drawings and specific embodiments. It should be understood that these examples are only used to illustrate the present invention and are not used to limit the scope of the present invention. After reading the present invention, various equivalent forms of modifications to the present invention by those skilled in the art all fall within the scope defined by the claims attached to this application.

[0072] Example

[0073] During the driving process of the car, facing a variety of road conditions and environmental interference, such as deep canyons between tunnels, it is easy to generate strong winds due to geographical factors. When the vehicle leaves the tunnel, it will drive into a high-intensity crosswind area from an environment with no crosswind at all, or when the vehicle is driving normally on the bridge, it will be suddenly affected by the sea breeze. Due to the influence of strong winds in all directions, the front and side areas of unmanned commercial vehicles are large, which prevents the vehicle from being affected by strong winds and causing dangerous situations such as tail-spinning. Therefore, studying the influence of strong winds on the trajectory tracking accuracy and safety of unmanned commercial vehicles has important theoretical significance and practical value. To this end, we propose a trajectory tracking method based on a three-degree-of-freedom vehicle model under strong winds, which includes the following steps:

[0074] Step 1: Establish a vehicle three-degree-of-freedom dynamic model including longitudinal, lateral and yaw degrees of freedom according to vehicle parameters.

[0075] In order to simplify the vehicle dynamic model, this embodiment assumes that the wheel slip angle is small, the vehicle mass is the sprung mass, and the mass of the suspension and wheels is ignored. A model including longitudinal, lateral and yaw degrees of freedom is established, such as Figure 1 , Figure 5 As shown, where v xis the lateral velocity of the front wheel, v y is the longitudinal speed, a is the distance from the center of mass to the front axle, b is the distance from the center of mass to the rear axle, F xf 、F xr are the longitudinal forces on the front and rear wheels, respectively, yf 、F yr are the lateral forces on the front and rear wheels, δ f are the front wheel angle, α f is the front wheel yaw angle, α r is the rear wheel yaw angle, is the yaw angular velocity, F wx 、F wy 、M wz They are respectively the components of the strong wind force in the x and y directions and the yaw moment caused by the strong wind.

[0076] The dynamics and kinematics equations of the three-degree-of-freedom vehicle dynamics model are:

[0077]

[0078]

[0079]

[0080]

[0081]

[0082] Where m is the vehicle mass, v is x is the lateral velocity of the front wheel, v y is the longitudinal velocity, is the yaw angular velocity, F xf is the longitudinal force on the front wheel, F xr is the longitudinal force on the rear wheel, δ f are the front wheel angle, C f is the cornering stiffness of the front wheel, C r is the cornering stiffness of the rear wheel, α f , α r are the front and rear wheel slip angles, C Dx is the air coefficient in the x direction, C Dy is the air coefficient in the y direction, C Dz is the air coefficient in the z direction, ρ is the air density, A is the frontal area of ​​the vehicle, v rx is the relative wind speed in the x direction, v ry is the relative wind speed in the y direction, v rz is the relative wind speed in the z direction, I zIt is expressed as the moment of inertia of the vehicle body around the z-axis, a is the distance from the center of mass to the front axle, b is the distance from the center of mass to the rear axle, and F wx 、F wy 、M wz They are respectively the components of the strong wind force in the x and y directions and the yaw moment caused by the strong wind.

[0083] Step 2: Establish a tire model based on tire structure and parameters.

[0084] Among the existing nonlinear tire models, the Pacejka tire model is widely used in the industry. It determines the structure and parameters of the model by measuring tire data and can better describe tire behavior and performance. According to the assumptions of this paper, the Pacejka tire model can be described under linear conditions. Its dynamic model is as follows: Figure 2 The tire model includes the relationship between the longitudinal force and vertical force of the wheel, the longitudinal slip rate, and the lateral force of the front and rear wheels.

[0085] The relationship between the wheel longitudinal force and the vertical force is:

[0086] F x =μF z ;

[0087] The longitudinal slip rate is:

[0088]

[0089] Among them, F x is the longitudinal force of the wheel, μ is the road adhesion coefficient, F z is the wheel vertical force, s is the longitudinal slip rate, r is the rolling radius of the wheel, ω is the wheel angular velocity, v x is the longitudinal speed of the wheel;

[0090] The normal forces on the front and rear wheels are F zf is the normal force on the front wheel, F zr is the normal force on the rear wheel, g is the acceleration due to gravity, and the wheelbase L = a + b.

[0091] The lateral forces on the front and rear wheels are:

[0092] F yf =C f α f ;

[0093] F yr =C r α r ;

[0094] Among them, C f is the cornering stiffness of the front wheel, α f is the front wheel yaw angle, Cr is the cornering stiffness of the rear wheel, α r is the rear wheel yaw angle.

[0095] Under the assumption of a small wheel angle,

[0096] Step 3: In the vehicle coordinate system, decompose the resultant force of the strong wind on the vehicle into the x, y and z direction components. When the point of action of the strong wind resultant force is not located at the center of mass of the vehicle, the vehicle will also be subjected to yaw moment, roll moment and pitch moment. Set the distance from the point of action of the strong wind resultant force to the center of mass of the vehicle in the x, y and z directions as Δx, Δy and Δz to establish a strong wind model.

[0097] This paper assumes that the vehicle will not slip under the action of strong wind. In the vehicle coordinate system, the resultant force of the strong wind on the vehicle is decomposed into the x, y and z direction components, and they are represented by F wx 、F wy , and F wz When the point of action of the strong wind resultant force is not located at the center of mass of the vehicle, the vehicle will also be subjected to yaw moment, roll moment and pitch moment. The position of the strong wind resultant force point in the x, y and z directions from the center of mass of the vehicle is set to Δx, Δy and Δz. The strong wind model includes the force and moment generated by the strong wind. According to aerodynamic theory and theoretical mechanics, the force and moment generated by the strong wind are as follows:

[0098]

[0099]

[0100] In the formula, F wk is the force generated by the strong wind, M wk is the torque generated by the strong wind, ρ is the air density, v rk is the relative wind speed in the k direction, C Dk is the air coefficient in the k direction, A is the frontal area of ​​the vehicle, Δk is the position of the point of action of the resultant force of the strong wind in the k-axis direction of the vehicle from the center of mass, where k = x, y, z.

[0101] Step 4, such as Figure 6 As shown in the figure, the influence of vertical load, rolling moment and pitching moment is characterized by the change of tire cornering stiffness, and the relationship between tire cornering stiffness and vertical load is established. The average value of left and right wheel cornering stiffness is taken as the cornering stiffness of the front and rear wheels in the three-degree-of-freedom vehicle dynamics model under strong wind, and then the tire model with front and rear wheel cornering stiffness change is obtained through the change of front and rear wheel cornering stiffness.

[0102] In this paper, the x and y direction components of the strong wind force F wx 、F wyand the yaw moment M caused by strong wind wz The influence of the vertical load, rolling moment and pitching moment is added to the three-degree-of-freedom vehicle dynamics model. Since the vertical load, rolling moment and pitching moment are not considered in the three-degree-of-freedom vehicle model, this paper characterizes the influence of the vertical load, rolling moment and pitching moment by the change of tire cornering stiffness, and takes the average value of the left and right wheel cornering stiffness as Figure 1 The cornering stiffness of the front and rear wheels in the model. The relationship between the cornering stiffness of the tire and the vertical load in this paper is as follows Figure 3 shown.

[0103] When calculating the change in wheel vertical load, it is assumed that the vertical load, roll moment and pitch moment generated by strong wind are positive (when negative, the signs are opposite). The change in vertical load on the left and right wheels caused by the strong wind roll moment is The change in vertical load on the front and rear wheels caused by the pitching moment is The change in vertical load on the front and rear wheels caused by the vertical load is

[0104] The vertical load variation of the four wheels of the vehicle is:

[0105]

[0106]

[0107]

[0108]

[0109] Where, ΔF wx M is the vertical load variation of the left and right wheels caused by the strong wind roll moment. wx is the torque generated by the strong wind in the x direction, B is the wheelbase, ΔF wy M is the change in vertical load of the front and rear wheels caused by the pitching moment. wy is the moment generated by the strong wind in the y direction, L is the wheelbase, ΔF zf is the change in the vertical load on the front wheel caused by the vertical load, b is the distance from the center of mass to the rear axle, ΔF z is the change in the vehicle's vertical load, ΔF zr is the change in the vertical load on the rear wheel caused by the vertical load, a is the distance from the center of mass to the front axle, ΔF fl is the vertical load change of the left front wheel, ΔF fr is the vertical load change of the right front wheel, ΔF rl is the vertical load change of the left rear wheel, ΔF rr is the vertical load variation of the right rear wheel.

[0110] Step 5: Compare the tire model with the front wheel cornering stiffness change and the x- and y-direction components of the strong wind force in the strong wind model wx 、F wy and the yaw moment M caused by strong wind wz The influence of is added into the vehicle three-degree-of-freedom dynamics model, and the three-degree-of-freedom vehicle dynamics model under strong wind is obtained.

[0111] The dynamic and kinematic equations of the three-degree-of-freedom vehicle dynamics model under strong wind are:

[0112]

[0113]

[0114]

[0115]

[0116]

[0117] Where m is the vehicle mass, v is x is the lateral velocity of the front wheel, v y is the longitudinal velocity, is the yaw angular velocity, F xf is the longitudinal force on the front wheel, F xr is the longitudinal force on the rear wheel, δ f are the front wheel angle, C f is the cornering stiffness of the front wheel, C r is the cornering stiffness of the rear wheel, α f , α r are the front and rear wheel slip angles, C Dx is the air coefficient in the x direction, C Dy is the air coefficient in the y direction, C Dz is the air coefficient in the z direction, ρ is the air density, A is the frontal area of ​​the vehicle, v rx is the relative wind speed in the x direction, v ry is the relative wind speed in the y direction, v rz is the relative wind speed in the z direction, I z It is expressed as the moment of inertia of the vehicle body around the z-axis, a is the distance from the center of mass to the front axle, and b is the distance from the center of mass to the rear axle.

[0118] Step 6: Perform trajectory tracking control based on the strong wind model and the three-degree-of-freedom vehicle dynamics model under the strong wind.

[0119] Since this article uses a three-degree-of-freedom vehicle dynamics model, vertical load, roll moment and pitch moment are not considered. The changes in wheel adhesion and cornering stiffness can only be used to characterize the effects of vertical load, roll moment and pitch moment, and the average value of the cornering stiffness of the left and right wheels is taken as the cornering stiffness of the front and rear wheels in the model. The relationship between the cornering stiffness of the tire and the vertical load is shown in the figure below. In order to facilitate the simulation of strong winds in the Carsim software, it is assumed that the strong wind acting on the vehicle is in the Y direction of the vehicle coordinate system, and the strong wind is given by the Carsim fan.

[0120] In order to compensate for the errors of state and control quantities under the influence of strong winds, this paper introduces a strong wind model into the MPC controller. The block diagram of the vehicle model predictive control principle is as follows: Figure 4 shown.

[0121] Therefore, in another embodiment, a trajectory tracking control system of a three-degree-of-freedom vehicle model based on strong wind is provided, such as Figure 4 As shown, it includes an MPC controller, a state estimator, a turning angle matching unit, a strong wind model unit, and a comparison unit. The MPC controller includes a prediction model unit, an objective function constraint condition unit, and an optimal solution unit, wherein:

[0122] The prediction model unit is provided with a three-degree-of-freedom vehicle dynamics model under the action of strong winds.

[0123] The high wind model unit obtains vehicle state data under the high wind according to the high wind.

[0124] The state estimator receives the real-time parameters of the controlled vehicle and the state data under the action of strong wind in real time to obtain the latest estimated state.

[0125] The comparison unit compares the reference trajectory with the latest control trajectory to obtain input parameters.

[0126] The MPC controller controls the front wheel steering angle according to the input parameters based on the three-degree-of-freedom vehicle dynamics model under the action of strong winds, and optimizes and solves through the objective function constraint condition unit and the optimal solution unit to output the optimal control value.

[0127] (1) Model prediction

[0128] The prediction model is based on the discretized linear time-varying model, and the system prediction output expression can be obtained:

[0129] Y(t)=ψ t ξ(tt)+Θ t ΔU(t);

[0130] in,

[0131]

[0132] Y(t) is the control output vector, ψ t , Θ t is the coefficient matrix, ξ(t|t) is the system state quantity based on time t, ΔU(t) is the control increment of the system, and A, B, and C are the coefficient matrices.

[0133] in,

[0134]

[0135]

[0136]

[0137] (2) Scrolling Optimization

[0138] The determination of the optimization objective function is based on minimizing the vehicle state error and the control input increment, optimizing the system state error under the constraints, and avoiding the sudden change of the actuator output, so as to maintain the continuity of the control input. The objective function used in this paper is in the form of:

[0139]

[0140] The constraints are as follows:

[0141] -12°<β<12°, good road surface;

[0142] -2°<β<2°, icy and snowy road;

[0143] -15°<α f <15°;

[0144]

[0145] ε>0;

[0146] ΔU min ≤ΔU t ≤ΔU max ;

[0147] ΔU min ≤AΔU t +ΔU t ≤ΔU max ;

[0148] Where η(k+i|t) and ΔU(k+i|t) are the system output state quantity and reference output state quantity at time t+i based on time t, respectively; Q, R, ρ are weight coefficients; N p is the prediction time domain; N cis the control time domain; ε is the relaxation factor. The first term reflects the system's ability to follow the reference trajectory, and the second term reflects the requirement for smooth changes in the control quantity. The function of the entire expression is to enable the system to quickly and smoothly track the desired trajectory.

[0149] (3) Feedback correction

[0150] After solving the objective function in each control cycle, the control input increment sequence in the control time domain is as follows:

[0151]

[0152] The first element of the control sequence (front wheel steering angle) acts on the controlled vehicle, that is, the actual control input increment:

[0153]

[0154] After entering the next control cycle, the above steps are continued in a loop to achieve trajectory tracking of the autonomous driving vehicle.

[0155] Let the state of the vehicle be in is the longitudinal speed, is the lateral speed, is the yaw angle at the center of mass of the vehicle, is the yaw rate at the center of mass of the vehicle, X is the longitudinal displacement, Y is the lateral displacement, ΔF zij is the change in vertical load on the four wheels, and the output control quantity of the controller with the strong wind model added is u d =δ f ,In the trajectory tracking controller, the established strong wind model is added to the ,vehicle dynamic model as a prediction model.

[0156] In another embodiment, an electronic device is provided, comprising: at least one processor, at least one memory and a communication interface. The processor, the memory and the communication interface communicate with each other. The memory stores program instructions executable by the processor, and the processor calls the program instructions to execute the trajectory tracking method based on the three-degree-of-freedom vehicle model under strong wind.

[0157] In another embodiment, a computer-readable storage medium is provided, wherein the computer storage medium stores program instructions, and when the program instructions are executed by a processor, the processor executes the trajectory tracking method based on the three-degree-of-freedom vehicle model under strong winds.

[0158] simulation

[0159] In order to verify the vehicle trajectory tracking control effect under strong winds, this paper builds a whole vehicle simulation model in Carsim software, selects a van model that comes with the software, and its main parameters are shown in Table 1. The vehicle state, road adhesion coefficient, and wind speed are set as inputs; the front wheel angle is the output; at the same time, a three-degree-of-freedom vehicle dynamics model, a Dugoff tire model, a road adhesion coefficient estimation model based on the unscented Kalman filter algorithm, and a strong wind model are built in Simulink software; then Carsim and Simulink are used for joint simulation.

[0160] Table 1 Vehicle dynamics parameters

[0161]

[0162] The double lane change test, also known as the dynamic roll test, is mainly used to test the sharp turn action of the vehicle's steering angle reversal. It is an internationally common test item. Because it can better evaluate the trajectory tracking level of the control algorithm and reflect the handling stability of the vehicle, it is often used in vehicle dynamics simulation and stability testing. The double lane change reference trajectory and fan position set in the Carsim software in this article are as follows Fig.10 The simulation test uses a fan on one side of the road to simulate the sideways strong wind condition, and uses Carsim / Simulink joint simulation to compare the simulation with the case without strong wind model.

[0163] The test vehicle uses front wheel steering control, assuming that the wind speed is constant, the wind speed is V = 10m / s, simulating a force 5 gale, and the wind speed direction is along Figure 7 The Y-axis direction remains unchanged. Assuming that the vehicle speed remains unchanged, the wind direction and torque acting on the vehicle body will change as the vehicle travels along the double lane. This paper calculates the changes in force and torque caused by strong winds based on the wheel force output and strong wind model of Carsim software.

[0164] Under the condition of simulating high-speed driving on a good road, the road adhesion coefficient is set to 0.8, the simulation speed is 96km / h, and the wind speed is 10m / s. The simulation results are as follows Figure 8-10 As shown. Compared with the controller without the strong wind model, the trajectory tracking control with the strong wind model is closer to the reference trajectory and has a better trajectory tracking effect. The vehicle yaw angle is reduced by about 2° and about 15% compared with the control without the strong wind model. It tends to be stable after 7s and converges faster. At the same time, the yaw angular velocity is also reduced to about 12° / s, about 25%, and tends to be stable after 8s.

[0165] Under the conditions of simulating the general road urban driving speed, the road adhesion coefficient is set to 0.5, the speed is 72km / h, and the wind speed is 10m / s. The simulation results are as follows: Figure 11-13As shown. Compared with the controller without the strong wind model, the tracking trajectory of the controller with the strong wind model is more consistent with the reference trajectory, and the trajectory tracking control effect is better. The yaw angle of the vehicle is controlled within 10°, and the yaw rate is controlled within 15° / s. Compared with the controller without the strong wind model, the yaw angle is reduced by about 2°, which is about 16%, and the yaw rate is reduced by about 6° / s, which is about 23%. The yaw angle and yaw rate tend to stabilize faster than the control without the strong wind model.

[0166] When simulating the tracking control effect on icy and snowy roads, the road adhesion coefficient is set to 0.3, the vehicle speed is 54km / h, and the wind speed to which the vehicle is subjected is 10m / s. The simulation results are as follows: Figure 14-16 Compared with the controller without the strong wind model, the control trajectory with the strong wind model basically matches the reference trajectory, and the yaw angle is controlled within 7°, and the yaw angular velocity is controlled within 4° / s. Compared with the controller without the strong wind model, the yaw angle is reduced by about 4°, which is about 30%, and the yaw angular velocity is reduced by about 4° / s, which is about 20%.

[0167] From the above simulation analysis, it can be seen that in the double lane change dynamic simulation, under different road adhesion coefficients and different vehicle speed conditions, compared with the controller without the strong wind model, the tracking trajectory of the controller with the strong wind model is more consistent with the reference trajectory, and the trajectory tracking control effect is better. In addition, the yaw angle and yaw rate of the vehicle are smaller than those of the controller without the strong wind model, and the speed of stabilization is faster. The simulation results verify the effectiveness of the trajectory tracking control with the strong wind model.

[0168] Using the strong wind model, under conditions of simulating high-speed driving on good roads, the controller with the strong wind model reduced the yaw angle by about 15%, the yaw angular velocity by about 31%, and the trajectory tracking accuracy by adding the strong wind model compared to the controller without the strong wind model; under conditions of simulating urban driving speed on general roads, the yaw angle was reduced by about 16%, and the yaw angular velocity was reduced by about 23%; when simulating trajectory tracking control on icy and snowy roads, the yaw angle was reduced by about 30%, and the yaw angular velocity was reduced by about 20%, achieving effective control of trajectory tracking and improving vehicle driving safety.

[0169] In the double lane change dynamic simulation, under different vehicle speed conditions, the tracking trajectory of the controller with the strong wind model is more consistent with the reference trajectory than the controller without the strong wind model. On the roads with adhesion coefficients of 0.8, 0.5 and 0.3, the yaw angle and yaw rate of the vehicle are smaller than those without the strong wind model, and the speed of stabilization is faster. Comparing the estimation results of the three adhesion coefficients of high, medium and low roads, it can be found that the trajectory tracking control effect is better on the road with high adhesion coefficient. The simulation results verify the effectiveness of the trajectory tracking control with the strong wind model.

[0170] The above is only a preferred embodiment of the present invention. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principle of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.

Claims

1. A trajectory tracking method based on a three-degree-of-freedom vehicle model under strong wind, characterized in that: The following steps are involved: Step 1, establishing a vehicle dynamics model including longitudinal, lateral and yaw degrees of freedom according to vehicle parameters; Step 2, establishing a tire model according to tire structure and parameters; Step 3, in the vehicle coordinate system, decompose the resultant force of the strong wind on the vehicle into components in the x, y and z directions, set the position of the strong wind resultant force point in the x, y and z directions from the vehicle's center of mass to Δx, Δy and Δz, and establish a strong wind model; Step 4, characterize the influence of vertical load, rolling moment and pitching moment through the change of tire cornering stiffness, and establish the relationship between tire cornering stiffness and vertical load; and take the average value of the cornering stiffness of the front left and right wheels and the rear left and right wheels as the cornering stiffness of the front and rear wheels in the three-degree-of-freedom vehicle dynamics model under the action of strong wind, and then obtain the tire model with the change of front and rear wheel cornering stiffness through the change of front and rear wheel cornering stiffness; Step 5: Compare the tire model with the front and rear wheel cornering stiffness changes and the x- and y-direction components of the wind force in the wind model wx 、F wy and the yaw moment M caused by strong wind wz The influence of is added into the three-degree-of-freedom vehicle dynamics model, and the three-degree-of-freedom vehicle dynamics model under strong wind is obtained; Step 6: According to the strong wind model and the three-degree-of-freedom vehicle dynamics model under the strong wind, a trajectory tracking controller of the vehicle is established to track the trajectory.

2. The trajectory tracking method of a three-degree-of-freedom vehicle model based on strong winds according to claim 1, characterized in that: The dynamic and kinematic equations of the three-degree-of-freedom vehicle dynamics model under strong wind in step 5 are: Where m is the mass of the vehicle, v is x is the lateral velocity of the front wheel, v y is the longitudinal velocity, is the yaw angular velocity, F xf is the longitudinal force on the front wheel, F xr is the longitudinal force on the rear wheel, δ f is the front wheel turning angle, C f , C r are the cornering stiffness of the front and rear wheels, α f , α r are the front and rear wheel slip angles, C Dx is the air coefficient in the x direction, C Dy is the air coefficient in the y direction, C Dz is the air coefficient in the z direction, ρ is the air density, A is the frontal area of ​​the vehicle, v rx is the relative wind speed in the x direction, v ry is the relative wind speed in the y direction, v rz is the relative wind speed in the z direction, I z It is expressed as the moment of inertia of the vehicle body around the z-axis, a is the distance from the center of mass to the front axle, and b is the distance from the center of mass to the rear axle.

3. The trajectory tracking method based on a three-degree-of-freedom vehicle model under strong wind according to claim 2 is characterized in that: In step 4, when calculating the change in the vertical load on the wheels, it is assumed that the vertical load, roll moment, and pitch moment generated by the strong wind are positive. The change in the vertical load on the left and right wheels caused by the roll moment of the strong wind is The change in vertical load on the front and rear wheels caused by the pitching moment is The change in vertical load on the front and rear wheels caused by the vertical load is The vertical load variation of the four wheels of the vehicle is: Where, ΔF wx M is the vertical load variation of the left and right wheels caused by the strong wind roll moment. wx is the torque generated by the strong wind in the x direction, B is the wheelbase, ΔF wy M is the change in vertical load of the front and rear wheels caused by the pitching moment. wy is the moment generated by the strong wind in the y direction, L is the wheelbase, ΔF zf is the change in the vertical load on the front wheel caused by the vertical load, b is the distance from the center of mass to the rear axle, ΔF z is the change in the vertical load of the vehicle, ΔF zr is the change in the vertical load on the rear wheel caused by the vertical load, a is the distance from the center of mass to the front axle, ΔF fl is the vertical load change of the left front wheel, ΔF fr is the vertical load change of the right front wheel, ΔF rl is the vertical load change of the left rear wheel, ΔF rr is the vertical load variation of the right rear wheel.

4. The trajectory tracking method based on a three-degree-of-freedom vehicle model under strong wind according to claim 3 is characterized in that: The high wind model includes the forces and moments generated by high winds, and the forces and moments generated by high winds are as follows: In the formula, F wk is the force generated by the strong wind, M wk is the torque generated by the strong wind, ρ is the air density, v rk is the relative wind speed in the k direction, C Dk is the air coefficient in the k direction, A is the frontal area of ​​the vehicle, Δk is the position of the point of action of the resultant force of the strong wind in the k-axis direction of the vehicle from the center of mass, where k = x, y, z.

5. The trajectory tracking method based on a three-degree-of-freedom vehicle model under strong wind according to claim 4, characterized in that: The tire model in step 2 includes the relationship between the longitudinal force and the vertical force of the wheel, the longitudinal slip rate, and the lateral force of the front and rear wheels; The relationship between the wheel longitudinal force and the vertical force is: The longitudinal slip rate is: Among them, F x is the wheel longitudinal force, μ is the road adhesion coefficient, F z is the wheel vertical force, s is the longitudinal slip rate, r is the rolling radius of the wheel, ω is the wheel angular velocity, v x is the longitudinal speed of the wheel; The normal forces on the front and rear wheels are F zf is the normal force on the front wheel, F zr is the normal force on the rear wheel, g is the acceleration due to gravity, and the wheelbase L = a + b; The lateral forces on the front and rear wheels are: F yf =C f a f ; F yr =C r a r ; Among them, C f is the cornering stiffness of the front wheel, α f is the front wheel yaw angle, C r is the cornering stiffness of the rear wheel, α r is the rear wheel yaw angle.

6. The trajectory tracking method based on a three-degree-of-freedom vehicle model under strong wind according to claim 5, characterized in that: Under the assumption of a small wheel angle, 7. The trajectory tracking method based on a three-degree-of-freedom vehicle model under strong wind according to claim 6, characterized in that: In step 3, when the point of action of the strong wind resultant force is not located at the center of mass of the vehicle, the vehicle will also be subjected to the effects of yaw moment, roll moment and pitch moment.

8. A trajectory tracking control system based on a three-degree-of-freedom vehicle model under strong wind, characterized in that: The invention comprises an MPC controller, a state estimator, a turning angle matching unit, a high wind model unit, and a comparison unit. The MPC controller comprises a prediction model unit, an objective function constraint condition unit, and an optimal solution unit, wherein: The prediction model unit is provided with a three-degree-of-freedom vehicle dynamics model under the action of strong wind; The strong wind model unit obtains the state data of the vehicle under the strong wind according to the strong wind; The state estimator receives the real-time parameters of the controlled vehicle and the state data under the action of strong wind in real time to obtain the latest estimated state; The comparison unit compares the reference trajectory with the latest control trajectory to obtain input parameters; The MPC controller predicts the vehicle speed and the front wheel turning angle according to the input parameters based on the three-degree-of-freedom vehicle dynamics model under the action of strong winds; and optimizes and solves the vehicle through the objective function constraint condition unit and the optimal solution unit to output the optimal control value.

9. An electronic device, characterized in that: include: At least one processor, at least one memory and a communication interface; the processor, memory and communication interface communicate with each other; The memory stores program instructions that can be executed by the processor, and the processor calls the program instructions to execute the trajectory tracking method of a three-degree-of-freedom vehicle model based on strong winds as described in any one of claims 1 to 7.

10. A computer-readable storage medium, characterized in that: The computer storage medium stores program instructions, and when the program instructions are executed by the processor, the processor executes the trajectory tracking method based on a three-degree-of-freedom vehicle model under strong wind as described in any one of claims 1 to 7.

Citation Information

Patent Citations

  • Vehicle motion characteristic simulation method and system based on vehicle dynamics model

    CN110175428A

  • Intelligent electric vehicle trajectory tracking and motion control method

    CN111890951A

  • Trajectory tracking and attitude control method for differential steering unmanned vehicle

    CN114859733A

  • Vehicle trajectory tracking and stability coordination control method considering roll

    CN117465419A

  • Automatic driving automobile transverse control method suitable for complex road conditions

    CN117944660A