CN110696793B - Intelligent vehicle layered control method combining four-wheel steering and differential braking - Google Patents

Intelligent vehicle layered control method combining four-wheel steering and differential braking Download PDF

Info

Publication number
CN110696793B
CN110696793B CN201910887904.3A CN201910887904A CN110696793B CN 110696793 B CN110696793 B CN 110696793B CN 201910887904 A CN201910887904 A CN 201910887904A CN 110696793 B CN110696793 B CN 110696793B
Authority
CN
China
Prior art keywords
control
vehicle
formula
layer
ideal
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910887904.3A
Other languages
Chinese (zh)
Other versions
CN110696793A (en
Inventor
朱梁鹏
刘成晔
赵景波
朱燕
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu University of Technology
Original Assignee
Jiangsu University of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jiangsu University of Technology filed Critical Jiangsu University of Technology
Priority to CN201910887904.3A priority Critical patent/CN110696793B/en
Publication of CN110696793A publication Critical patent/CN110696793A/en
Application granted granted Critical
Publication of CN110696793B publication Critical patent/CN110696793B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T8/00Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
    • B60T8/17Using electrical or electronic regulation means to control braking
    • B60T8/172Determining control parameters used in the regulation, e.g. by calculations involving measured or detected parameters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T8/00Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
    • B60T8/17Using electrical or electronic regulation means to control braking
    • B60T8/1755Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Regulating Braking Force (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

The invention discloses a four-wheel steering and differential braking combined unmanned vehicle hierarchical control method, which designs a combined controller by a nonlinear Model Prediction (MPC) algorithm to control four-wheel steering and differential braking of a vehicle. The method has a three-layer control structure, the upper layer is a track planning layer, so that the longitudinal, transverse and yaw angle tracking of the vehicle is realized, and an ideal yaw angular speed and a centroid side drift angle are output; the middle layer is an MPC centralized control layer to realize the control of the rear wheel steering angle and the control of the additional yaw moment of the vehicle; the lower layer is a braking force distributor which is converted into braking control on a single wheel through the calculation of an additional yaw moment; finally, the MPC is combined with the four-wheel corner and the differential braking force output by the controller to act on the whole vehicle, so as to realize the stability tracking of the target path. The method utilizes the rolling optimization characteristic of the MPC control method, realizes the combined control of four-wheel steering and differential braking on the basis of improving the tracking precision, and improves the stability of intelligent automobile track tracking under the condition of high-speed automobiles.

Description

Intelligent vehicle layered control method combining four-wheel steering and differential braking
Technical Field
The invention relates to the field of intelligent vehicle control, in particular to a track tracking layered control method for an unmanned vehicle with four-wheel steering combined differential braking.
Background
The existing path tracking control of the unmanned vehicle mostly carries out transverse tracking control through front wheel steering, because the strong nonlinearity of a vehicle model causes that the stability of the vehicle cannot be ensured only by the front wheel steering control when the vehicle is under a high-speed working condition, and the design and application difficulty of an over-integrated control algorithm is too high, the comprehensive consideration of the four-wheel steering combined differential braking hierarchical control is an effective way for solving the path tracking stability of the unmanned vehicle.
Disclosure of Invention
In order to solve the problems of unmanned vehicle path tracking control precision and vehicle stability, the invention provides a layered control method of four-wheel steering combined differential braking, which aims to: a combined controller is designed by a nonlinear Model Prediction (MPC) algorithm, four-wheel steering and differential braking control is carried out on the vehicle, and stable tracking of an expected path under a high-speed vehicle condition is realized.
In order to achieve the purpose, the invention adopts the technical scheme that:
a layered control method for four-wheel steering combined differential braking has a three-layer control structure, and specifically comprises the following steps:
and (3) upper layer: the track planning layer is used for tracking the longitudinal direction, the transverse direction and the yaw angle of the vehicle and outputting an ideal yaw angular speed and a centroid side slip angle;
an intermediate layer: the MPC centralized control layer realizes the control of the rear wheel steering angle and the control of the additional yaw moment of the vehicle;
the lower layer: the braking force distributor is used for converting the calculation of the additional yaw moment into braking control on a single wheel;
finally, the MPC is combined with the four-wheel corner and the differential braking force output by the controller to act on the whole vehicle, so as to realize the stability tracking of the target path.
Specifically, the method comprises the following steps:
a first layer: kinematics based MPC control
1 establishing an MPC controller of an upper track planning layer to realize front wheel steering control
1.1 according to a vehicle single-track model, a vehicle kinematic model is established and written into a state space expression form as follows:
Figure GDA0003692078490000011
wherein the state quantities are:
Figure GDA0003692078490000021
in the formula: x is the longitudinal displacement of the vehicle, Y is the transverse displacement of the vehicle,
Figure GDA0003692078490000022
is the vehicle yaw angle;
the control quantity is selected as follows:
u=[v,δ f ] T
in the formula: v is the central speed of the rear axle of the vehicle, delta f For deflecting the angle of the front wheel
1.2, carrying out linear processing on the vehicle kinematic nonlinear model shown by the formula to obtain a linear time-varying system as follows:
Figure GDA0003692078490000023
1.3 discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:
Figure GDA0003692078490000024
wherein: a. the k =I+A*T;B k =I+B*T;
1.4, setting a certain moment in the vehicle track tracking process as a moment t, and establishing the following objective function for solving the front wheel rotation angle at the moment t:
Figure GDA0003692078490000025
in the formula: n is a radical of P Is a prediction time domain; n is a radical of c Is a control time domain; rho is a weight coefficient; epsilon is a relaxation factor 1.5 formula, and the system is controlled by replacing a control quantity with a control increment, so that the formula is rewritten into a state space equation of the control increment formula:
Figure GDA0003692078490000026
Figure GDA0003692078490000027
wherein:
Figure GDA0003692078490000028
1.6, the control quantity and the control increment in the control process are restrained:
u min (k+1)<u<u max (k+1)
Δu min (k+1)<Δu<Δu max (k+1)
1.7 solving the objective function to obtain a series of control input increments in the control time domain
Figure GDA0003692078490000029
Applying the first element in the control sequence at time t as a control input increment to the system, namely:
u(t)=u(t-1)+Δu(t)
1.8 repeating the steps at the moment t +1 to complete the tracking of the expected track and obtain a series of control quantities v, delta f
A second layer: ideal following model
2. Establishing an ideal vehicle following model, and calculating an ideal mass center slip angle and a yaw angular velocity under trajectory tracking
2.1 ideal barycenter side deviation angle model of vehicle
The ideal centroid slip angle at vehicle steady state is:
Figure GDA0003692078490000031
in the formula: l is the wheelbase; l. the f Is the centroid to front wheel distance; l r Is the distance from the center of mass to the rear wheel; k is a radical of r The centroid slip angle under the maximum adhesion limit of the tire with the rear wheel side slip stiffness is as follows:
Figure GDA0003692078490000032
in the formula: μ is the adhesion rate; g is the acceleration of gravity
The ideal vehicle centroid slip angle is:
β d =min(|β ideal |,|β max |)·sgn(β ideal )
2.2 model of ideal yaw rate of vehicle
Figure GDA0003692078490000033
The maximum yaw acceleration at the tire adhesion limit is:
Figure GDA0003692078490000034
the ideal vehicle yaw rate is:
r d =min(|r ideal |,|r max |)·sgn(r ideal )
and a third layer: middle control layer
3. An intermediate-layer MPC controller is established, an additional yaw moment generated by braking force is calculated, and rear wheel steering angle control is realized
3.1, establishing a vehicle four-wheel steering and differential braking combined dynamic model, and rewriting the model into a state space expression form:
Figure GDA0003692078490000035
wherein the state quantities are:
x=[β,r] T
in the formula: beta is the vehicle mass center slip angle, r is the vehicle yaw rate,
Figure GDA0003692078490000036
a front wheel deflection angle;
the control quantity is selected as follows:
u=[δ r ,M s ] T
in the formula: m s Additional yaw moment, delta, generated for braking r For deflecting the angle of the rear wheel
3.2, carrying out linear processing on the vehicle kinematic nonlinear model shown by the formula to obtain a linear time-varying system as follows:
Figure GDA0003692078490000041
3.3 discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:
Figure GDA0003692078490000042
wherein: a. the k =I+A*T;B k =I+B*T;
3.4, setting a certain moment in the vehicle track tracking process as a moment t, and establishing the following objective function for solving the front wheel rotation angle at the moment t:
Figure GDA0003692078490000043
in the formula: n is a radical of hydrogen P Is a prediction time domain; n is a radical of c Is a control time domain; rho is a weight coefficient; epsilon is a relaxation factor;
and 3.5, replacing the control quantity with the control increment to carry out system control by adopting a control increment formula, and therefore rewriting the formula into a state space equation of the control increment formula:
Figure GDA0003692078490000044
Figure GDA0003692078490000045
wherein:
Figure GDA0003692078490000046
3.6, the control quantity and the control increment in the control process are restrained:
u min (k+1)<u<u max (k+1)
Δu min (k+1)<Δu<Δu max (k+1)
3.7 solving the objective function to obtain a series of control input increments in the control time domain
Figure GDA0003692078490000047
Applying the first element in the control sequence at time t as a control input increment to the system, namely:
u(t)=u(t-1)+Δu(t)
3.8 repeating the steps at the moment t +1 to complete the tracking of the expected track and obtain a series of control quantities M sr A fourth layer: braking force distribution layer
4.1 vehicle steering Condition discrimination
Figure GDA0003692078490000048
In the formula:
Figure GDA0003692078490000049
when K is 1 =0,
Figure GDA0003692078490000051
Neutral steering: k is equal to 0, and K is equal to 0,
Figure GDA0003692078490000052
is the median value;
and (3) oversteering: k<0,
Figure GDA0003692078490000053
Increasing;
understeer: k>0,
Figure GDA0003692078490000054
Decrease;
4.1 Single-wheel brake pressure calculation
Figure GDA0003692078490000055
4.2 brake application decisions
Figure GDA0003692078490000056
Compared with the prior art, the invention has the following beneficial effects:
1. the invention designs an intelligent vehicle track tracking layered control method of four-wheel steering combined differential braking considering vehicle stability, which tracks an expected path through an upper track planning layer, optimally calculates a rear wheel corner and an additional yaw moment control quantity by using a front wheel corner, an expected yaw velocity and a mass center sideslip angle planned by the upper layer through an intermediate layer, and distributes braking force through a lower layer controller, thereby realizing the active adjustment of four-wheel corners and differential braking of an unmanned vehicle and improving the stability of vehicle track tracking.
2. The invention brings the four-wheel steering control into the control algorithm, and improves the maneuverability and the stability of the vehicle under the high-speed working condition.
3. The invention realizes the differential braking control of the track tracking, and can actively adjust the steering angle and the braking moment of the rear wheel of the automobile, thereby optimizing the mass center slip angle, the yaw velocity and the lateral displacement of the automobile and improving the track tracking stability of the intelligent vehicle under the high-speed working condition.
4. The method adopts the model prediction controller as a control algorithm, carries out real-time prediction and rolling optimization on the control target, processes the multi-constraint optimization problem, and greatly improves the stability of trajectory tracking.
Drawings
Other features, objects and advantages of the invention will become more apparent upon reading of the detailed description of non-limiting embodiments with reference to the following drawings:
FIG. 1 is a diagram of a vehicle kinematic model according to the present invention;
FIG. 2 is a frame diagram of a hierarchical control algorithm of an intelligent vehicle with four-wheel steering combined with differential braking according to the present invention;
FIG. 3 is a control strategy simulation diagram of the present invention;
FIG. 4 is a diagram of a trace-tracking simulation result of the present invention;
FIG. 5 is a diagram of a simulation result of four wheel turning angles according to the present invention;
FIG. 6 is a diagram of the simulation result of four wheel longitudinal force according to the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
Referring to fig. 1-5, the invention relates to a four-wheel steering combined differential braking unmanned vehicle layered control method, which has a three-layer control structure. The upper layer is a track planning layer, so that the longitudinal, transverse and yaw angles of the vehicle are tracked, and an ideal yaw velocity and a centroid side slip angle are output. The middle layer is an MPC centralized control layer, and the control of the rear wheel steering angle and the control of the additional yaw moment of the vehicle are realized. The lower layer is a braking force distributor which is converted into braking control of a single wheel through calculation of an additional yaw moment. And finally, the MPC is combined with four-wheel corners and differential braking force output by the controller to act on the whole vehicle, so that the stability tracking of the target path is realized.
A first layer: upper track following control layer
The design of the upper layer model predicted trajectory tracking controller is explained in detail below with reference to fig. 1:
1. vehicle kinematics modeling
Figure GDA0003692078490000061
Figure GDA0003692078490000062
Figure GDA0003692078490000063
In the formula: l is the vehicle wheel base; v is the vehicle rear axle center velocity; delta f For deflecting the angle of the front wheel
2. From the formula, it can be derived as a state space expression of:
Figure GDA0003692078490000064
wherein the state quantities are:
Figure GDA0003692078490000071
in the formula: x is the longitudinal displacement of the vehicle, Y is the transverse displacement of the vehicle,
Figure GDA0003692078490000072
is the vehicle yaw angle;
the control quantity is selected as follows:
u=[v,δ f ] T
in the formula: v is the vehicle rear axle center speed, delta f For deflecting the angle of the front wheel
3. Establishing a linear error equation
3.1 because the vehicle model has the non-linear characteristic, the model needs to be linearized, because the expected input can not give the information of all state points, the invention adopts the approximate linearization method to linearize the model, applies the constant control quantity of a certain working point to the system, designs the control algorithm according to the deviation of the track and the actual state of the working point, considers that the certain working point of the system is [ x ] x 0 ,u 0 ],x 0 To always apply a control quantity of u 0 The system state quantity obtained later is
x 0 (k+1)=f(x 0 (k),u 0 )
x 0 (0)=x 0
By derivation, it can be obtained that:
Figure GDA0003692078490000073
in the formula:
Figure GDA0003692078490000074
3.2 discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:
Figure GDA0003692078490000075
y(k)=C k x(k)
wherein:
Figure GDA0003692078490000076
Figure GDA0003692078490000077
Figure GDA0003692078490000078
3.3 the formula replaces the control quantity with the control increment to carry out the control of the system, so the formula is rewritten as a state space equation of the control increment formula:
Figure GDA0003692078490000079
Figure GDA0003692078490000081
wherein:
Figure GDA0003692078490000082
3.4 through derivation, a prediction output expression of the system can be obtained:
Figure GDA0003692078490000083
Figure GDA0003692078490000084
Figure GDA0003692078490000085
Figure GDA0003692078490000086
Figure GDA0003692078490000087
Figure GDA0003692078490000088
4. establishing rolling time domain optimization controller
4.1 for the trajectory tracking control problem, the following control objective function is established
Figure GDA0003692078490000089
In the formula: n is a radical of hydrogen P Is a prediction time domain; n is a radical of c Is a control time domain; rho is a weight coefficient; epsilon is a relaxation factor; q and R are weight matrixes.
4.2 in order to increase the smoothness of the track tracking, the control quantity and the control increment need to be restrained:
u min (t+k)≤u(t+k)≤u max (t+k)
Δu min (t+k)≤Δu(t+k)≤Δu max (t+k)
in the formula: Δ u is the control increment, u min For controlling incremental minimums, u max For controlling incremental maximum
The invention sets the control limit to u min =[-0.2 -0.6] T ,u max =[0.2 0.6] T ,Δu min =[-0.34 -0.02] T ,Δu max =[0.02] T Y max =[-3 -0.3] T ,Y min =[3 0.3] T
4.3 converting the objective function into a standard quadratic form and combining constraint conditions to solve the following optimization problems:
J(ξ(t),u(t-1),ΔU(t))=[ΔU(t) T ,ε]H t [ΔU(t) T ,ε]+G t [ΔU(t) T ,ε]
Figure GDA0003692078490000091
Figure GDA0003692078490000092
Figure GDA0003692078490000093
in the formula:
Figure GDA0003692078490000094
e t for predicting tracking errors in the time domain
4.3 solving the objective function to obtain a series of control input increments in the control time domain
Figure GDA0003692078490000095
Applying the first element in the control sequence at time t as a control input increment to the system, namely:
u(t)=u(t-1)+Δu(t)
repeating the steps at the moment of t +1 to complete the tracking of the expected track and obtain a series of control quantities v, delta f A second layer: ideal following model
2. Establishing an ideal vehicle following model, and calculating an ideal mass center slip angle and a yaw angular velocity under trajectory tracking
2.1 vehicle ideal centroid cornering angle model
The ideal centroid slip angle at vehicle steady state is:
Figure GDA0003692078490000096
in the formula: l is the wheelbase; l f Is the centroid to front wheel distance; l r Is the distance from the center of mass to the rear wheel; k is a radical of r The centroid slip angle under the maximum adhesion limit of the tire with the rear wheel side slip stiffness is as follows:
Figure GDA0003692078490000097
in the formula: μ is the adhesion rate; g is gravity acceleration
The ideal vehicle centroid slip angle is:
β d =min(|β ideal |,|β max |)·sgn(β ideal )
2.2 model of ideal yaw rate of vehicle
Figure GDA0003692078490000101
The maximum yaw acceleration at the tire adhesion limit is:
Figure GDA0003692078490000102
the ideal vehicle yaw rate is:
r d =min(|r ideal |,|r max |)·sgn(r ideal )
and a third layer: middle control layer
1. Vehicle kinematics modeling
Figure GDA0003692078490000103
Figure GDA0003692078490000104
In the formula: i is rotational inertia; l f ,l r Is the wheelbase; k is a radical of formula f ,k r For side deflection rigidity of front and rear wheels
2. From the formula, it can be derived as a state space expression of the form:
Figure GDA0003692078490000105
wherein the state quantities are:
x=[β,r] T
in the formula: beta is the vehicle mass center slip angle, r is the vehicle yaw rate,
Figure GDA0003692078490000106
a front wheel deflection angle;
the control quantity is selected as follows:
u=[δ r ,M s ] T
in the formula: m s Additional yaw moment, delta, generated for braking r For deflecting rear wheels
3. Establishing a linear error equation
3.1 because the vehicle model has the non-linear characteristic, the model needs to be linearized, because the expected input can not give the information of all state points, the invention adopts the approximate linearization method to linearize the model, applies the constant control quantity of a certain working point to the system, designs the control algorithm according to the deviation of the track and the actual state of the working point, considers that the certain working point of the system is [ x ] x 0 ,u 0 ],x 0 To always apply a control quantity of u 0 The system state quantity obtained later is
x 0 (k+1)=f(x 0 (k),u 0 )
x 0 (0)=x 0
By derivation, we can get:
Figure GDA0003692078490000111
in the formula:
Figure GDA0003692078490000112
3.2 discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:
Figure GDA0003692078490000113
wherein:
Figure GDA0003692078490000114
Figure GDA0003692078490000115
3.3 formula replaces the controlled variable with the control increment to control the system, so the formula is rewritten as a state space equation of the control increment formula:
Figure GDA0003692078490000116
Figure GDA0003692078490000117
wherein:
Figure GDA0003692078490000118
the formula replaces the control quantity with the control increment to carry out the control of the system, so the formula is rewritten into a state space equation of the control increment formula:
Figure GDA0003692078490000119
Figure GDA00036920784900001110
wherein:
Figure GDA00036920784900001111
3.4 through derivation, a prediction output expression of the system can be obtained:
Figure GDA00036920784900001112
Figure GDA00036920784900001113
Figure GDA0003692078490000121
Figure GDA0003692078490000122
Figure GDA0003692078490000123
Figure GDA0003692078490000124
4. establishing rolling time domain optimization controller
4.1 for the trajectory tracking control problem, the following control objective function is established
Figure GDA0003692078490000125
In the formula: n is a radical of P Is a prediction time domain; n is a radical of hydrogen c To control the time domain; rho is a weight coefficient; epsilon is a relaxation factor; q and R are weight matrixes.
4.2 in order to increase the smoothness of the track tracking, the control quantity and the control increment need to be restrained:
u min (t+k)≤u(t+k)≤u max (t+k)
Δu min (t+k)≤Δu(t+k)≤Δu max (t+k)
in the formula: Δ u is the control increment, u min For controlling incremental minimums, u max For controlling incremental maximum
The present invention sets the control amount limit to:
u min =[-0.6 -100] T ,u max =[0.2 100] T ,Δu min =[-0.34 -5] T ,Δu min =[0.34 5] T ,Y max =[-1.5 -10] T ,Y min =[1.5 10] T
4.3 converting the objective function into a standard quadratic form and combining constraint conditions to solve the following optimization problems:
J(ξ(t),u(t-1),ΔU(t))=[ΔU(t) T ,ε]H t [ΔU(t) T ,ε]+G t [ΔU(t) T ,ε]
Figure GDA0003692078490000131
Figure GDA0003692078490000132
Figure GDA0003692078490000133
in the formula:
Figure GDA0003692078490000134
e t solving the objective function for predicting the tracking error 4.3 in the time domain to obtain a series of control input increments in the control time domain
Figure GDA0003692078490000135
Applying the first element in the control sequence at time t as a control input increment to the system, namely:
u(t)=u(t-1)+Δu(t)
repeating the steps at the moment of t +1 to complete the tracking of the expected track and obtain a series of control quantities delta r ,M s A fourth layer: braking force distribution layer
4.1 vehicle steering Condition discrimination
Figure GDA0003692078490000136
In the formula:
Figure GDA0003692078490000137
when K is 1 =0,
Figure GDA0003692078490000138
Neutral steering: k is equal to 0, and K is equal to 0,
Figure GDA0003692078490000139
is the median value;
oversteer: k<0,
Figure GDA00036920784900001310
Increasing;
understeer: k>0,
Figure GDA00036920784900001311
Decreasing;
4.1 Single-wheel brake pressure calculation
Figure GDA00036920784900001312
4.2 brake application decisions
Figure GDA00036920784900001313
Figure GDA0003692078490000141
The technical means disclosed in the invention scheme are not limited to the technical means disclosed in the above embodiments, but also include the technical scheme formed by any combination of the above technical features. All other embodiments, which can be obtained by a person skilled in the art without any inventive step based on the embodiments of the present invention, are within the scope of the present invention.

Claims (1)

1. A layered control method for four-wheel steering combined differential braking is characterized in that: the device has a three-layer control structure, which specifically comprises the following steps:
and (3) upper layer: the track planning layer is used for tracking the longitudinal direction, the transverse direction and the yaw angle of the vehicle and outputting an ideal yaw angular speed and a centroid side slip angle;
an intermediate layer: the MPC centralized control layer realizes the control of the rear wheel steering angle and the control of the additional yaw moment of the vehicle;
the lower layer: the braking force distributor is used for converting the calculation of the additional yaw moment into braking control on a single wheel;
finally, the MPC is combined with four-wheel corners and differential braking force output by the controller to act on the whole vehicle, so as to realize the stability tracking of the target path;
the specific control process of the upper track planning layer is as follows:
(1) an MPC controller of an upper track planning layer is established to realize front wheel steering control
(1.1) building a vehicle kinematic model according to a vehicle monorail model, and writing the vehicle kinematic model into a state space expression form:
Figure FDA0003692078480000011
in the formula: x is a state quantity, and u is a control quantity;
wherein the state quantities are:
Figure FDA0003692078480000012
in the formula: x is the longitudinal displacement of the vehicle, Y is the transverse displacement of the vehicle,
Figure FDA0003692078480000013
is the vehicle yaw angle, T is the time;
the control quantity is selected as follows:
u=[v,δ f ] T
in the formula: v is the central speed of the rear axle of the vehicle, delta f A front wheel deflection angle;
(1.2) carrying out linear processing on the vehicle kinematic nonlinear model shown by the formula to obtain a linear time-varying system as follows:
Figure FDA0003692078480000014
(1.3) discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:
Figure FDA0003692078480000015
wherein: a. the k =I+A*T;B k =I+B*T;
(1.4) setting a certain moment in the vehicle track tracking process as a time t, and establishing the following objective function for solving the front wheel rotation angle at the time t:
Figure FDA0003692078480000016
in the formula: n is a radical of P Is a prediction time domain; n is a radical of c Is a control time domain; rho is a weight coefficient; epsilon is a relaxation factor;
(1.5) the formula replaces the control quantity with the control increment to control the system, so the formula is rewritten as a state space equation of the control increment formula:
Figure FDA0003692078480000021
Figure FDA0003692078480000022
wherein:
Figure FDA0003692078480000023
(1.6) constraining the control quantity and the control increment in the control process:
u min (k+1)<u<u max (k+1)
Δu min (k+1)<Δu<Δu max (k+1)
(1.7) solving the objective function to obtain a series of control input increments in the control time domain
Figure FDA0003692078480000024
Applying the first element in the control sequence at time t as a control input increment to the system, namely:
u(t)=u(t-1)+Δu(t)
(1.8) repeating the steps at the time t +1 to complete the tracking of the expected track and obtain a series of control quantities v, delta f
(2) Establishing an ideal vehicle following model, and calculating an ideal mass center slip angle and a yaw angular velocity under trajectory tracking
(2.1) vehicle ideal centroid cornering angle model
The ideal centroid slip angle at vehicle steady state is:
Figure FDA0003692078480000025
in the formula: l is the wheelbase; l f Is the centroid to front wheel distance; l r Is the distance from the center of mass to the rear wheel; k is a radical of r Is rear wheel cornering stiffness;
the centroid slip angle at the maximum adhesion limit of the tire is:
Figure FDA0003692078480000026
in the formula: μ is the attachment rate; g is gravity acceleration;
the ideal vehicle centroid slip angle is:
β d =min(|β ideal |,|β max |)·sgn(β ideal )
(2.2) model of ideal yaw rate of vehicle
Figure FDA0003692078480000027
The maximum yaw acceleration at the tire adhesion limit is:
Figure FDA0003692078480000028
the ideal vehicle yaw rate is:
r d =min(|r ideal |,|r max |)·sgn(r ideal );
the specific control process of the middle layer MPC centralized control layer is as follows: establishing an intermediate-layer MPC controller, calculating an additional yaw moment generated by braking force, and realizing rear wheel steering angle control;
(1) establishing a vehicle four-wheel steering and differential braking combined dynamic model, and rewriting the model into a state space expression form:
Figure FDA0003692078480000031
wherein the state quantities are:
x=[β,r] T
in the formula: beta is the vehicle mass center slip angle, r is the vehicle yaw rate,
Figure FDA0003692078480000032
a front wheel deflection angle;
the control quantity is selected as follows:
u=[δ r ,M s ] T
in the formula: m s Additional yaw moment, delta, generated for braking r A rear wheel deflection angle;
(2) the vehicle kinematics nonlinear model shown in the formula is subjected to linear processing to obtain a linear time-varying system as follows:
Figure FDA0003692078480000033
(3) discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:
Figure FDA0003692078480000034
wherein: a. the k =I+A*T;B k =I+B*T;
(4) Setting a certain moment in the vehicle track tracking process as a moment t, and establishing the following objective function for solving the front wheel rotation angle at the moment t:
Figure FDA0003692078480000035
in the formula: n is a radical of P Is a prediction time domain; n is a radical of c To control the time domain; rho is a weight coefficient; epsilon is a relaxation factor
(5) The formula replaces the control quantity with the control increment to carry out the control of the system, so the formula is rewritten into a state space equation of the control increment formula:
Figure FDA0003692078480000036
Figure FDA0003692078480000037
wherein:
Figure FDA0003692078480000038
(6) and (3) constraining the control quantity and the control increment in the control process:
u min (k+1)<u<u max (k+1)
Δu min (k+1)<Δu<Δu max (k+1)
(7) solving the objective function to obtain a series of control input increments in the control time domain
Figure FDA0003692078480000039
Applying the first element in the control sequence at time t as a control input increment to the system, namely:
u(t)=u(t-1)+Δu(t)
(8) Repeating the steps at the moment of t +1 to complete the tracking of the expected track and obtain a series of control quantities M sr (ii) a The specific control process of the lower-layer braking force distributor is as follows:
(1) vehicle steering condition determination
Figure FDA0003692078480000041
When K is 1 =0,
Figure FDA0003692078480000042
Neutral steering: k is equal to 0, and K is equal to 0,
Figure FDA0003692078480000043
is the median value;
oversteer: k<0,
Figure FDA0003692078480000044
Enlarging;
understeer: k is>0,
Figure FDA0003692078480000045
Decrease;
(2) single wheel brake pressure calculation
Figure FDA0003692078480000046
(3) Brake application decision
Figure FDA0003692078480000047
CN201910887904.3A 2019-09-19 2019-09-19 Intelligent vehicle layered control method combining four-wheel steering and differential braking Active CN110696793B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910887904.3A CN110696793B (en) 2019-09-19 2019-09-19 Intelligent vehicle layered control method combining four-wheel steering and differential braking

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910887904.3A CN110696793B (en) 2019-09-19 2019-09-19 Intelligent vehicle layered control method combining four-wheel steering and differential braking

Publications (2)

Publication Number Publication Date
CN110696793A CN110696793A (en) 2020-01-17
CN110696793B true CN110696793B (en) 2022-08-19

Family

ID=69195500

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910887904.3A Active CN110696793B (en) 2019-09-19 2019-09-19 Intelligent vehicle layered control method combining four-wheel steering and differential braking

Country Status (1)

Country Link
CN (1) CN110696793B (en)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111267835B (en) * 2020-03-26 2021-04-27 桂林电子科技大学 Four-wheel independent drive automobile stability control method based on model prediction algorithm
CN111845738B (en) * 2020-06-22 2021-10-12 江苏大学 Vehicle path tracking control method based on double-model combination
CN112230651A (en) * 2020-07-06 2021-01-15 湖南工业大学 Distributed unmanned vehicle path tracking control method based on hierarchical control theory
CN113954833B (en) * 2020-07-06 2023-05-30 湖南工业大学 Full-electric-drive distributed unmanned vehicle path tracking and stability coordination control method
CN111717282B (en) * 2020-07-07 2021-12-03 中国人民解放军国防科技大学 Man-machine shared driving auxiliary steering method based on model predictive control
CN112572473B (en) * 2020-12-09 2022-06-10 北京三快在线科技有限公司 Control method and device of unmanned equipment
CN114003030B (en) * 2021-10-09 2023-08-08 北京科技大学 Path tracking control method of two-wheel differential mobile robot considering centroid change
CN114044003B (en) * 2021-12-21 2024-01-23 吉林大学 Tracking control method for front-rear double-axle steering vehicle
CN115256396B (en) * 2022-08-23 2024-05-28 北京理工大学 Double-layer model predictive control-based omnidirectional walking centroid track planning method for bipedal robot
CN117622125A (en) * 2024-01-12 2024-03-01 杭州世宝汽车方向机有限公司 Path tracking control method based on differential steering

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108099901B (en) * 2017-12-18 2019-07-09 长春工业大学 A kind of method of active front wheel steering control precision under raising limiting condition
CN108099902B (en) * 2017-12-18 2019-08-30 长春工业大学 A kind of Yaw stability control method embodying Vehicle Nonlinear characteristic
CN108454623B (en) * 2018-01-22 2019-10-29 大连理工大学 A kind of unmanned electric vehicle Trajectory Tracking Control method of four motorized wheels
CN108248605A (en) * 2018-01-23 2018-07-06 重庆邮电大学 The transverse and longitudinal control method for coordinating that a kind of intelligent vehicle track follows
CN108944866B (en) * 2018-07-06 2021-06-01 长春工业大学 Self-adaptive model prediction control algorithm for improving steering and braking cooperative control
CN109017778B (en) * 2018-07-31 2022-04-15 大连民族大学 Active steering control method for expected path of four-wheel independent drive vehicle
CN109017759B (en) * 2018-07-31 2022-04-08 大连民族大学 Desired path vehicle yaw control method
CN109017760B (en) * 2018-07-31 2022-04-12 大连民族大学 Vehicle expected trajectory tracking method and device and rolling time domain optimization algorithm
CN109795502B (en) * 2018-09-27 2021-05-04 吉林大学 Intelligent electric vehicle path tracking model prediction control method
CN110217229B (en) * 2019-06-25 2020-09-18 长春工业大学 Path tracking control method suitable for high-speed limit working condition

Also Published As

Publication number Publication date
CN110696793A (en) 2020-01-17

Similar Documents

Publication Publication Date Title
CN110696793B (en) Intelligent vehicle layered control method combining four-wheel steering and differential braking
CN108454623B (en) A kind of unmanned electric vehicle Trajectory Tracking Control method of four motorized wheels
Termous et al. Coordinated control strategies for active steering, differential braking and active suspension for vehicle stability, handling and safety improvement
CN108107732B (en) Automobile stability control method combining active front wheel steering and direct yaw moment
CN112572411B (en) Vehicle chassis coordination control method and system considering tire cornering characteristic
CN109291932B (en) Feedback-based electric vehicle yaw stability real-time control device and method
CN110116732B (en) Vehicle lateral stability control method considering tire cornering stiffness change
CN112622903A (en) Longitudinal and transverse control method for autonomous vehicle in vehicle following driving environment
CN108107731A (en) A kind of Vehicle Stability Control method based on Tire nonlinearity characteristic
CN111959500B (en) Automobile path tracking performance improving method based on tire force distribution
JP2007269295A (en) Apparatus and method for controlling vehicle motion
CN111965977B (en) Automobile stability control method based on equal backup capacity of tire
CN113183950A (en) Self-adaptive control method for steering of active front wheel of electric automobile
CN113911106A (en) Commercial vehicle transverse track following and stability cooperative control method based on game theory
CN111679575A (en) Intelligent automobile trajectory tracking controller based on robust model predictive control and construction method thereof
CN112606843A (en) Intelligent vehicle path tracking control method based on Lyapunov-MPC technology
Li et al. Adaptive sliding mode control of lateral stability of four wheel hub electric vehicles
CN108394413B (en) A kind of electronic vehicle attitude and parameter correcting method of four motorized wheels and steering
CN116902108B (en) High-speed steering active roll control method and system applied to wheel-leg type vehicle
CN113401113A (en) Unmanned vehicle direct yaw moment control method and controller based on vehicle stable envelope line
CN117215202A (en) Novel fuzzy model predictive control method for transverse movement of automatic driving vehicle
CN117270386A (en) Coupling active disturbance rejection-based distributed drive six-wheel steering vehicle same-phase steering control method and controller
CN114044003B (en) Tracking control method for front-rear double-axle steering vehicle
US11648949B2 (en) Method for controlling a wheeled vehicle in low-grip conditions
CN113044047B (en) AFS/DYC integrated control method based on class PID-STSM

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant