CN114475599A - Queue control method for curved road scene - Google Patents
Queue control method for curved road scene Download PDFInfo
- Publication number
- CN114475599A CN114475599A CN202210205186.9A CN202210205186A CN114475599A CN 114475599 A CN114475599 A CN 114475599A CN 202210205186 A CN202210205186 A CN 202210205186A CN 114475599 A CN114475599 A CN 114475599A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- control
- vehicles
- following
- distance
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 230000001133 acceleration Effects 0.000 claims description 19
- 238000004422 calculation algorithm Methods 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000008878 coupling Effects 0.000 claims description 8
- 238000010168 coupling process Methods 0.000 claims description 8
- 238000005859 coupling reaction Methods 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 7
- 238000005516 engineering process Methods 0.000 claims description 6
- 238000004891 communication Methods 0.000 claims description 4
- 238000013459 approach Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000005457 optimization Methods 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000001131 transforming effect Effects 0.000 claims description 3
- 230000007246 mechanism Effects 0.000 claims description 2
- 230000008569 process Effects 0.000 claims description 2
- 238000012886 linear function Methods 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 3
- 239000013589 supplement Substances 0.000 abstract description 2
- 238000011160 research Methods 0.000 description 5
- 238000007726 management method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/10—Path keeping
- B60W30/12—Lane keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
- B60W30/165—Automatically following the path of a preceding lead vehicle, e.g. "electronic tow-bar"
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- G—PHYSICS
- G08—SIGNALLING
- G08C—TRANSMISSION SYSTEMS FOR MEASURED VALUES, CONTROL OR SIMILAR SIGNALS
- G08C17/00—Arrangements for transmitting signals characterised by the use of a wireless electrical link
- G08C17/02—Arrangements for transmitting signals characterised by the use of a wireless electrical link using a radio link
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/65—Data transmitted between vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/10—Longitudinal speed
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
The invention discloses a queue control method aiming at a curved road scene, which comprises the following steps of S1 vehicles longitudinally queuing and numbering, S2 all vehicles send own vehicle information to other vehicles, following vehicles adjust self states according to the received information, S3 establishes vehicle dynamics models for the vehicles in a queue, S4 each following vehicle takes a reference road track as a control target and the minimum safe distance with the front vehicle as a constraint condition, designs a cost function and solves the cost function to obtain an optimal control sequence in a prediction time domain, S5 acts a first element of the control sequence on a vehicle system to control, and S6 repeats S4 and S5 until the queue driving is finished. The method can effectively supplement the vehicle queue control method which is lacked at present and relates to the curved road scene, and realize better vehicle queue tracking effect.
Description
Technical Field
The invention relates to the field of intelligent traffic systems and intelligent networked automobiles, in particular to a queue control method for a curved road scene.
Background
With the increasing number of automobiles and the increasing traffic jam problem, the traditional traffic management model and the vehicle safety technology are more difficult to meet the challenges. And the intelligent transportation system provides an effective way for solving the problems. The intelligent traffic system is an intelligent traffic network management system which integrates multiple subject advanced technologies such as information, sensing, communication, control and the like, and has the advantages of high efficiency, real time, accuracy and the like. The intelligent networked automobile is an important component of an intelligent traffic system, and has important research significance for realizing intelligent traffic.
Vehicle queue control is an important research direction in the field of intelligent networked automobiles. According to the method, all vehicles located in the same lane automatically adjust the transverse and longitudinal movement states of the vehicle according to the state information of the vehicles adjacent to the vehicles, such as the inter-vehicle distance, the vehicle speed and the like, so that the speeds of all vehicles in a vehicle queue are consistent and the expected inter-vehicle distance is realized. Because the running states of all vehicles are similar, the vehicles running in the vehicle queue have great potential in the aspects of relieving traffic jam, improving traffic capacity, enhancing driving safety and the like, and the method is a hot spot in the research field of intelligent networked automobiles.
At present, there are many patents for researching vehicle queue control methods, such as a patent owned by the university of Hunan, "a vehicle queue control method and system considering economy," a patent owned by the university of northwest industry, "a vehicle queue optimal cooperative control method," a patent owned by the university of Qinhuang island of northeast university, "a finite time fleet control method based on a preset performance function," and the like, but these patents generally research the vehicle queue control method from the perspective of optimal economy or optimal control method, and less research the road scene realized by vehicle queue control. The actual road has a straight road and a curved road, and when vehicles run in a queue, different consideration must be given to different road scenes.
Disclosure of Invention
Aiming at the defects of the existing vehicle queue control technology, the invention aims to provide a queue control method under a curved road scene, and when vehicle queue control is carried out, the vehicle speed is controlled in the longitudinal direction to keep a relatively safe distance with other vehicles, and the front wheel turning angle is also controlled in the transverse direction to accurately track the road center. The method can ensure that the vehicle queue can realize good tracking effect in a curved road scene.
In order to achieve the purpose, the invention provides the following technical scheme:
a queue control method for a curved road scene comprises the following steps:
firstly, vehicles are longitudinally queued to run, information exchange is carried out between each vehicle and an adjacent vehicle through a wireless communication technology, a first vehicle is marked as a first vehicle, also called a pilot vehicle and numbered as 0, and the rest vehicles are called following vehicles and numbered from 1 to N-1, wherein N is the total number of the vehicles in a queue;
secondly, all vehicles in the queue are intelligent vehicles and have automatic driving related functions such as environment sensing, positioning planning and motion control capacity, the first vehicle runs on the road planned by automatic driving, state information of the first vehicle, such as position, speed, acceleration and the like, is sent to other vehicles, and the following vehicles adjust the states of the following vehicles according to the received information;
step three, establishing a vehicle dynamic model considering dynamic characteristics for each vehicle in the queue, and laying a foundation for realizing transverse tracking tracks and longitudinally adjusting the vehicle speed of the vehicle;
step four, designing and solving a cost function by each following vehicle by taking the reference road track as a control target and the distance between each following vehicle and the preceding vehicle as a constraint condition based on a model prediction control algorithm to obtain an optimal control sequence in a prediction time domain;
step five, each following vehicle acts the first element of the control sequence on the own vehicle to control, actual state information of the own vehicle at the moment is obtained, and the information is sent to other vehicles for use by the other vehicles;
step six, repeating the step four and the step five until finishing the queue driving;
the technical scheme of the invention has the following characteristics:
(1) in the third step, the established model is a three-degree-of-freedom transverse and longitudinal coupling dynamic model and is established by the following parameters of the vehicleObtaining the following components by a die: vehicle mass, gravitational acceleration, rotational inertia, front wheel yaw stiffness, rear wheel yaw stiffness, distance from center of mass to front wheel, distance from center of mass to rear wheel, rolling resistance coefficient, air longitudinal resistance coefficient, air vertical lift force coefficient czLongitudinal speed v of the vehiclexVehicle lateral velocity vyYaw rate of vehicleVehicle longitudinal position X, vehicle lateral position Y, vehicle yaw angle psi, tire longitudinal force FxAnd the front wheel turns δ. The three-degree-of-freedom transverse and longitudinal coupling dynamic model obtained by modeling is as follows:
writing the model into a state space equation form:
y=g(x)
the selection control quantity is as follows: u ═ Fx,δ]T;
vxis the longitudinal speed, v, of the vehicleyIs the lateral speed of the vehicle,is the vehicle yaw rate, X is the vehicle longitudinal position, Y is the vehicle lateral position, psi is the vehicle yaw angle, FxIs the tire longitudinal force, δ is the front wheel corner;
(2) the control targets in the fourth step are selected as follows:
the longitudinal position difference, the transverse position difference, the yaw angular speed difference and the reference transverse and longitudinal speed difference of the vehicle and the reference road are close to 0 through control;
Xrreference longitudinal coordinate, Y, for reference road centerrFor reference purposesThe reference lateral coordinate of the road center,for reference yaw rate, vxrTo the desired vehicle speed, vyrIs a reference lateral vehicle speed;
(3) the cost function in step four is set as follows:
wherein eta (k + i | k) is the output quantity of the prediction equation at the moment of k + i, etaref(k + i) is the desired reference at time k + i, Δ u (k + i | k) is the control increment at time k + i, ρ is the weight coefficient, ε is the relaxation factor, QQ,RRAs a weight matrix, NpTo predict the time domain, NcIs a control time domain;
respectively expressed in a prediction time domain NpThe speed error between the internal following vehicle and the reference vehicle speed, the transverse speed error, the longitudinal position error, the transverse position error and the yaw angle error of the reference road center reflect the tracking capability of the system to the reference quantity;
second itemIs represented in the control time domain NcThe size of the internal control increment reflects the requirement of the system for stable change of the control increment. Setting corresponding weight for each control target, and adjusting control weight QQ,RRThe value of (A) can adjust the control requirements of various performances;
(4) and the constraint condition of the first vehicle in the fourth step considers the constraint of the road geometry and the constraint of the executing mechanism of the vehicle. Road geometry constraints are reflected in the influence of road curvature and road friction coefficient on vehicle speed, i.e.:
wherein: g is the gravitational acceleration, μ is the road friction coefficient, and ρ is the road curvature.
The vehicle-body actuator constraints are embodied in the maximum acceleration and deceleration limits when the vehicle accelerates and decelerates, and the turning angle limits when the vehicle turns, that is, constraints on the control amount and the control increment.
The following vehicle considers the minimum safe distance constraint with the front vehicle, so that the difference between the actual distance of the two vehicles and the expected distance approaches to zero:
τ≥dfl-ddes≥0
dflto follow the distance between the car and the front car, ddesTau is a very small constant for the expected distance between the following vehicle and the front vehicle;
in particular, since the control is performed for a curved road scene, it is not reasonable to consider only the distance calculation in the longitudinal direction, taking the absolute distance value of two vehicles as the actual distance of the two vehicles:
(X, Y) is a position point of the following vehicle, (X)l,Yl) Is the position point of the front vehicle (suppose (X)l,Yl) The value is known);
the expected distance between the two vehicles is calculated by a safety distance strategy based on emergency braking:
the performance difference of different vehicles is considered in the distance strategy, and the braking capability of the vehicle is considered, so that the safety of the vehicle is ensured, and a more reasonable distance between the two vehicles is obtained;
vxto follow the current speed of the vehicle, axTo follow the current acceleration of the vehicle, α is the vehicle speed control coefficient, β is the acceleration control coefficient, amaxFor following the maximum braking deceleration of the vehicle, vlTo guide the current speed of the vehicle, amax,lMaximum braking deceleration for the lead vehicle;
(5) the constraint conditions of the control quantity and the control increment in the model predictive control algorithm used in the fourth step are as follows:
umin≤u(k+i|k)≤umax,i=0,1,…,Nc-1
Δumin≤Δu(k+i|k)≤Δumax,i=0,1,…,Nc-1
(6) the vehicle dynamics model and the constraints used in the fourth step need to be linearized and discretized so as to be convenient for control by using a model predictive control method.
Using Taylor's formula, willAt the operating point [ x ]t,ut-1]And (4) performing linearization processing, and neglecting high-order terms, then:
note the bookThen linearizing the vehicle dynamics model to obtain a state space equation for model predictive control, where the equation is as follows:
wherein,
discretizing by adopting forward Euler, namely approximating the derivative of x to time by the following formula;
wherein: t is sampling time, then:
x(k+1)=(I+TA)x(k)+TBu(k)
recording: a. thek=I+TA,Bk=TB,CkC, wherein: i is the identity matrix, and the above state space equation can be:
according to the model prediction control principle, a prediction equation is obtained by derivation:
Y=Ψξ(k)+ΘΔU
wherein:
the linearization and discretization of the constraint by the same method comprises the following steps:
thus dfl-ddesAfter linearization can be expressed as:
in the formula: dflIs about (X, Y, v)x,ax) Of (a) in which (X)r,Yr,vr,ar) Information (X) as a reference pointl,Yl,vl,al) The information of the preceding vehicles is known quantity.
To facilitate the uniformity of the state quantities, the state quantities are selected asForm, then can remember dflr-ddesr=a(X-Xr)+b(Y-Yr)+c(vx-vr)+d(ax-ar)+e。
Wherein:
the following constraints are to be satisfied due to the difference in distance between the front vehicle and the rear vehicle:
0≤dfl-ddes≤τ
therefore, the method comprises the following steps:
0≤a(X-Xr)+b(Y-Yr)+c(vx-vr)+d(ax-ar)+e≤τ
transforming the above inequalities into a matrix multiplication form, and writing together the constraints of the road geometry on the vehicle speed, then there are:
here:
a method for output quantity constraint processing of a reference model predictive control algorithm, wherein the constraint can be:
the constraints on the control quantities and control increments may be converted to:
Umin≤DkΔU+Ut≤Umax
ΔUmin≤ΔU≤ΔUmax
namely:
wherein:I2Ncis a column vector with the number of rows 2Nc, U (k-1) is the actual control quantity at the last moment, Umax,UminRespectively, a maximum value and a minimum value set of control quantity in a control time domain, delta Umax,ΔUminThe control time domain control increment is a minimum value set and a maximum value set of the control increment in the control time domain.
The above-mentioned model predictive control problem with constraints can be finally converted into the following quadratic programming problem solution:
s.t.MΔU≤γ
wherein, H is 2 (theta)TQQΘ+RR),gT=2ETQQΘ,Ω=ETQQE+ρε2And omega is a constant, the number of the first and second coils is,
(7) step five, completing the operation in the pair (6) in each control periodSolving the optimization problem to obtain a control time domain NcThe optimal control increment sequence in (1) is as follows:
ΔU*=[Δu*(k),Δu*(k+1),...,Δu*(k+Nc-1)]T
applying the first of the optimal control increment sequence as the actual control increment to the system, namely:
u(k)=u(k-1)+Δu*(k)
and repeating the process in the next control period, and thus, the vehicle queue control can be realized.
The invention has the beneficial effects that:
the queue control method under the curved road scene can effectively supplement the vehicle queue control method under the curved road scene which is lacked at present, and realize better vehicle queue tracking effect.
Drawings
Fig. 1 is a flowchart of a queue control method for a curved road scene according to the present invention.
Detailed Description
The following describes the technical solution of the present invention in detail with reference to the accompanying drawings.
Example 1, reference to fig. 1:
1. firstly, vehicles are longitudinally queued to run, information exchange is carried out between each vehicle and an adjacent vehicle through a wireless communication technology, a first vehicle is marked as a first vehicle, also called a pilot vehicle and numbered as 0, and the rest vehicles are called following vehicles and numbered from 1 to N-1, wherein N is the total number of the vehicles in a queue;
2. step two, all vehicles in the queue are intelligent vehicles and have related functions of automatic driving, such as environment sensing, positioning planning, motion control and the like, the first vehicle runs according to the road planned by the automatic driving, state information of the first vehicle, such as position, speed, acceleration and the like, is sent to other vehicles, the following vehicles adjust the state of the following vehicles according to the received information, and the information of the following vehicles is also sent to other vehicles;
3. step three, pairEstablishing a three-degree-of-freedom transverse and longitudinal coupling dynamic model for each vehicle in the queue, wherein the model comprises the following parameters: mass m of vehicle, acceleration of gravity g, moment of inertia IzFront wheel cornering stiffness CfRear wheel cornering stiffness CrDistance l from center of mass to front wheelfDistance l from center of mass to rear wheelrCoefficient of rolling resistance frCoefficient of air longitudinal resistance cxCoefficient of vertical lift of air czLongitudinal speed v of the vehiclexVehicle lateral velocity vyYaw rate of vehicleVehicle longitudinal position X, vehicle lateral position Y, vehicle yaw angle psi, tire longitudinal force FxAnd the front wheel turns δ. The three-degree-of-freedom transverse and longitudinal coupling dynamic model obtained by modeling is as follows:
the state space equation form of the model is:
y=g(x)
the selection control quantity is as follows: u ═ Fx,δ]T;
vxis the longitudinal speed, v, of the vehicleyIs the lateral speed of the vehicle,is the vehicle yaw rate, X is the vehicle longitudinal position, Y is the vehicle lateral position, psi is the vehicle yaw angle, FxIs the tire longitudinal force, δ is the front wheel corner;
calculating to obtain a control quantity by utilizing a model predictive control algorithm, and controlling the acceleration, the deceleration and the turning of the vehicle by controlling the longitudinal force of the tire and the front wheel steering angle;
4. step four, each following vehicle takes the longitudinal position difference, the transverse position difference, the yaw angular velocity difference and the reference transverse and longitudinal velocity difference with the center of the reference road as targets, namely, the following vehicles are obtained:
wherein, XrReference longitudinal coordinate, Y, for reference road centerrTo reference the reference lateral coordinates of the road center,for reference yaw rate, vxrTo the desired vehicle speed, vyrIs a reference lateral vehicle speed;
5. with the above control objectives clear, the cost function in the model predictive control algorithm can be set as follows:
wherein eta (k + i | k) is the output quantity of the prediction equation at the moment of k + i, etaref(k + i) is the desired reference at time k + i, Δ u (k + i | k) is the control increment at time k + i, ρ is the weight coefficient, ε is the relaxation factor, QQ,RRAs a weight matrix, NpTo predict the time domain, NcIs a control time domain;
respectively expressed in a prediction time domain NpThe speed error between the internal following vehicle and the reference vehicle speed, the transverse speed error, the longitudinal position error, the transverse position error and the yaw angle error of the reference road center reflect the tracking capability of the system to the reference quantity;
second itemIs represented in the control time domain NcThe size of the internal control increment reflects the requirement of the system for stable change of the control increment. Setting corresponding weight for each control target, and adjusting control weight QQ,RRThe value of (A) can adjust the control requirements of various performances;
6. the algorithm constraints are in addition to considering the control quantity and control increment constraints:
umin≤u(k+i|k)≤umax,i=0,1,…,Nc-1
Δumin≤Δu(k+i|k)≤Δumax,i=0,1,…,Nc-1
the first vehicle constraints also take into account road geometry constraints and vehicle actuator constraints. Road geometry constraints are reflected in the influence of road curvature and road friction coefficient on vehicle speed, i.e.:
wherein: g is the gravitational acceleration, μ is the road friction coefficient, and ρ is the road curvature.
The vehicle-body actuator constraints are embodied in the maximum acceleration and deceleration limits when the vehicle accelerates and decelerates, and the turning angle limits when the vehicle turns, that is, constraints on the control amount and the control increment.
The constraint condition of the following vehicle considers the minimum safe distance constraint with the front vehicle on the basis of the constraint condition of the front vehicle, so that the difference between the actual distance of the two vehicles and the expected distance approaches to zero:
τ≥dfl-ddes≥0
dflto follow the distance between the car and the front car, ddesTau is a very small constant for the expected distance between the following vehicle and the front vehicle;
in particular, since the control is performed for a curved road scene, it is not reasonable to consider only the distance calculation in the longitudinal direction, taking the absolute distance value of two vehicles as the actual distance of the two vehicles:
(X, Y) is a position point of the following vehicle, (X)l,Yl) Is the position point of the front vehicle (suppose (X)l,Yl) The value is known);
the expected distance between the two vehicles is calculated by a safety distance strategy based on emergency braking:
the performance difference of different vehicles is considered in the distance strategy, and the braking capability of the vehicle is considered, so that the safety of the vehicle is ensured, and a more reasonable distance between the two vehicles is obtained;
wherein v isxTo follow the current speed of the vehicle, axTo follow the current acceleration of the vehicle, α is the vehicle speed control coefficient, β is the acceleration control coefficient, amaxTo follow the maximum braking deceleration of the vehicle, vlTo guide the current speed of the vehicle, amax,lMaximum braking deceleration for the lead vehicle;
7. the established vehicle dynamics model and the constraints need to be subjected to linearization and discretization processing so as to be convenient for control by using a model predictive control method.
Using Taylor's formula, willAt the operating point [ x ]t,ut-1]And (4) performing linearization processing, and neglecting high-order terms, then:
note the bookThen the vehicle will be turnedAfter the vehicle dynamics model is linearized, a state space equation for model predictive control can be obtained, and the equation is as follows:
wherein,
forward euler is used for discretization, i.e. the derivative of x with respect to time is approximated by the following equation.
Wherein: t is sampling time, then:
x(k+1)=(I+TA)x(k)+TBu(k)
recording: a. thek=I+TA,Bk=TB,CkC, wherein: i is the identity matrix, and the above state space equation can be:
according to the model prediction control principle, a prediction equation is obtained by derivation:
Y=Ψξ(k)+ΘΔU
wherein:
the linearization and discretization of the constraint by the same method comprises the following steps:
thus dfl-ddesAfter linearization can be expressed as:
in the formula: dflIs about (X, Y, v)x,ax) Of (a) in which (X)r,Yr,vr,ar) Is information of a reference point, (X)l,Yl,vl,al) The information of the preceding vehicles is known quantity.
To facilitate the uniformity of the state quantities, the state quantities are selected asForm, then can remember
dflr-ddesr=a(X-Xr)+b(Y-Yr)+c(vx-vr)+d(ax-ar)+e。
Wherein:
the following constraints are to be satisfied due to the difference in distance between the front vehicle and the rear vehicle:
0≤dfl-ddes≤τ
therefore, the method comprises the following steps:
0≤a(X-Xr)+b(Y-Yr)+c(vx-vr)+d(ax-ar)+e≤τ
transforming the above inequalities into a matrix multiplication form, and writing together the constraints of the road geometry on the vehicle speed, then there are:
here:
a method for output quantity constraint processing of a reference model predictive control algorithm, wherein the constraint can be:
the constraints on the control quantities and control increments may be converted to:
Umin≤DkΔU+Ut≤Umax
ΔUmin≤ΔU≤ΔUmax
namely:
wherein:I2Ncis a column vector with the number of rows 2Nc, U (k-1) is the actual control quantity at the last moment, Umax,UminRespectively, a maximum value and a minimum value set of control quantity in a control time domain, delta Umax,ΔUminThe control time domain control increment is a minimum value set and a maximum value set of the control increment in the control time domain.
The above model predictive control problem with constraints can be finally converted into the following quadratic programming problem solution:
s.t.MΔU≤γ
wherein, H is 2 (theta)TQQΘ+RR),gT=2ETQQΘ,Ω=ETQQE+ρε2And omega is a constant, the number of the first and second coils is,
8. in the fifth step, the optimization problem in the step 7 is solved in each control period to obtain a control time domain NcThe optimal control increment sequence in (1) is as follows:
ΔU*=[Δu*(k),Δu*(k+1),...,Δu*(k+Nc-1)]T
applying the first of the optimal control increment sequence as the actual control increment to the vehicle system, namely:
u(k)=u(k-1)+Δu*(k)
then the actual state of the self vehicle is sent to other vehicles, and the next cycle is started;
9. and repeating the steps four and five by each following vehicle until the queue control is finished.
The above description is only for the preferred embodiment of the present invention, but the scope of the present invention is not limited thereto, and any person skilled in the art should be considered to be within the technical scope of the present invention, and the technical solutions and the inventive concepts thereof according to the present invention should be equivalent or changed within the scope of the present invention.
Claims (8)
1. A queue control method for a curved road scene is characterized by comprising the following steps:
s1: the method comprises the following steps that vehicles are longitudinally queued to run, information exchange is carried out between each vehicle and adjacent vehicles through a wireless communication technology, the first vehicle is marked as a first vehicle, namely a pilot vehicle and is numbered as 0, the rest vehicles are marked as following vehicles and are numbered from 1 to N-1, wherein N is the total number of vehicles in a queue;
s2: the first vehicle drives according to the road planned by automatic driving, the state information of the first vehicle is sent to other vehicles, and the following vehicle adjusts the state of the following vehicle according to the received state information, wherein the state information comprises position, speed and acceleration;
s3: for each vehicle in the queue, a vehicle dynamic model considering dynamic characteristics is established, and a foundation is laid for realizing transverse tracking tracks and longitudinally adjusting the vehicle speed of the vehicle;
s4: each following vehicle takes the reference road track as a control target, takes the distance between the following vehicle and the preceding vehicle as a constraint condition, designs a cost function and solves the cost function based on a model predictive control algorithm, and obtains an optimal control sequence in a prediction time domain;
s5: each following vehicle acts the first element of the control sequence on the own vehicle to control, actual state information of the own vehicle at the moment is obtained, and the information is sent to other vehicles for use by the other vehicles;
s6: steps S4 and S5 are repeated until the queued travel is ended.
2. The method as claimed in claim 1, wherein the step of establishing a vehicle dynamics model considering dynamics characteristics for each vehicle in the fleet specifically comprises:
establishing a three-degree-of-freedom transverse and longitudinal coupling dynamic model, and modeling by the following parameters of the vehicle: mass m of vehicle, acceleration of gravity g, moment of inertia IzFront wheel cornering stiffness CfRear wheel cornering stiffness CrDistance l from center of mass to front wheelfDistance l from center of mass to rear wheelrCoefficient of rolling resistance frCoefficient of air longitudinal resistance cxCoefficient of vertical lift of air czLongitudinal speed v of the vehiclexVehicle lateral velocity vyYaw rate of vehicleVehicle longitudinal position X, vehicle lateral position Y, vehicle yaw angle psi, tire longitudinal force FxFront wheel steering angle δ; three-degree-of-freedom transverse and longitudinal coupling dynamic modelThe type is as follows:
writing the three-degree-of-freedom transverse and longitudinal coupling dynamic model into a state space equation form:
y=g(x)
the selection control quantity is as follows: u ═ Fx,δ]T;
3. The queue control method for the curved road scene as claimed in claim 1, wherein the control targets in S4 are selected as:
the longitudinal position difference, the transverse position difference, the yaw angular speed difference and the reference transverse and longitudinal speed difference of the vehicle and the reference road are close to 0 through control;
4. The queue control method for the curved road scene as claimed in claim 1, wherein: the cost function is set as follows:
wherein eta (k + i | k) is the output quantity of the prediction equation at the moment of k + i, etaref(k + i) is the desired reference at time k + i, Δ u (k + i | k) is the control increment at time k + i, ρ is the weight coefficient, ε is the relaxation factor, QQ,RRAs a weight matrix, NpTo predict the time domain, NcIs a control time domain;
respectively expressed in a prediction time domain NpThe speed error between the internal following vehicle and the reference vehicle speed, the transverse speed error, the longitudinal position error, the transverse position error and the yaw angle error of the reference road center reflect the tracking capability of the system to the reference quantity;
second itemIs represented in the control time domain NcThe size of the internal control increment reflects the requirement of the system on the stable change of the control increment; setting corresponding weight for each control target, and adjusting control weight QQ,RRThe values of (c) can adjust the control requirements for each performance.
5. The queue control method for the curved road scene as claimed in claim 2, wherein the constraint condition of the first vehicle takes into account the road geometry constraint and the vehicle actuator constraint; road geometry constraints are reflected in the influence of road curvature and road friction coefficient on vehicle speed, i.e.:
wherein: g is the gravity acceleration, mu is the road friction coefficient, and rho is the road curvature;
the constraint of the executing mechanism of the vehicle is embodied in the maximum acceleration and deceleration limit when the vehicle accelerates and decelerates and the corner limit when the vehicle turns, namely the constraint of the control quantity and the control increment;
the constraint condition of the following vehicle is based on the constraint condition of the front vehicle, and the minimum safe distance constraint with the front vehicle is considered, so that the difference between the actual distance of the two vehicles and the expected distance approaches to zero:
τ≥dfl-ddes≥0
dflto follow the distance between the car and the front car, ddesTau is a very small constant for the expected distance between the following vehicle and the front vehicle;
in particular, since the control is performed for a curved road scene, it is not reasonable to consider only the distance calculation in the longitudinal direction, taking the absolute distance value of two vehicles as the actual distance of the two vehicles:
(X, Y) is a position point of the following vehicle, (X)l,Yl) Is the position point of the front vehicle (suppose (X)l,Yl) The value is known);
the expected distance between the two vehicles is calculated by a safety distance strategy based on emergency braking:
the performance difference of different vehicles is considered in the distance strategy, and the braking capability of the vehicle is considered, so that the safety of the vehicle is ensured, and a more reasonable distance between the two vehicles is obtained;
wherein: v. ofxTo follow the current speed of the vehicle, axTo follow the current acceleration of the vehicle, α is the vehicle speed control coefficient, β is the acceleration control coefficient, amaxFor following the maximum braking deceleration of the vehicle, vlTo guide the current speed of the vehicle, amax,lIs the maximum braking deceleration of the lead vehicle.
6. The queue control method for the curved road scene as claimed in claim 5, wherein the constraints on the control quantity and the control increment are as follows:
umin≤u(k+i|k)≤umax,i=0,1,…,Nc-1
Δumin≤Δu(k+i|k)≤Δumax,i=0,1,…,Nc-1。
7. the method as claimed in claim 5, wherein the three-degree-of-freedom transverse-longitudinal coupling dynamic model and the constraints on the control quantity and the control increment are linearized and discretized so as to facilitate control by a model predictive control method;
using Taylor's formula, willAt the operating point [ x ]t,ut-1]And (4) performing linearization processing, and neglecting high-order terms, then:
note the bookThen linearizing the vehicle dynamics model to obtain a state space equation for model predictive control, where the equation is as follows:
wherein,
discretizing by adopting forward Euler, namely approximating the derivative of x to time by the following formula;
wherein: t is sampling time, then there are:
x(k+1)=(I+TA)x(k)+TBu(k)
recording: a. thek=I+TA,Bk=TB,CkC, wherein: i is the identity matrix, and the above state space equation can be:
according to the model prediction control principle, a prediction equation is obtained by derivation:
Y=Ψξ(k)+ΘΔU
wherein:
the method for carrying out linearization and discretization on the control quantity and control increment constraints by adopting the same method comprises the following steps:
thus dfl-ddesAfter linearization can be expressed as:
in the formula: dflIs about (X, Y, v)x,ax) A linear function of (a), whereinr,Yr,vr,ar) Is information of a reference point, (X)l,Yl,vl,al) The information of the front vehicle is known quantity;
to facilitate the uniformity of the state quantities, the state quantities are selected asForm, then can remember dflr-ddesr=a(X-Xr)+b(Y-Yr)+c(vx-vr)+d(ax-ar)+e;
Wherein:
the following constraints are to be satisfied due to the difference in distance between the front vehicle and the rear vehicle:
0≤dfl-ddes≤τ
therefore, the method comprises the following steps:
0≤a(X-Xr)+b(Y-Yr)+c(vx-vr)+d(ax-ar)+e≤τ
transforming the above inequalities into a matrix multiplication form, and writing together the constraints of the road geometry on the vehicle speed, then there are:
here:
a method for output quantity constraint processing of a reference model predictive control algorithm, wherein the constraint can be:
the constraints on the control quantities and control increments may be converted to:
Umin≤DkΔU+Ut≤Umax
ΔUmin≤ΔU≤ΔUmax
namely:
wherein:I2Ncis a column vector with the number of rows 2Nc, U (k-1) is the actual control quantity at the last moment, Umax,UminRespectively, a maximum value and a minimum value set of control quantity in a control time domain, delta Umax,ΔUminRespectively a minimum value and a maximum value set of control increment in the control time domain;
the above-mentioned model predictive control problem with constraints can be finally converted into the following quadratic programming problem solution:
s.t.MΔU≤γ
wherein, H is 2 (theta)TQQΘ+RR),gT=2ETQQΘ,Ω=ETQQE+ρε2And omega is a constant, the number of the first and second coils is,
8. the method as claimed in claim 7, wherein the solving of the optimization problem is completed in each control period to obtain a control time domain NcThe optimal control increment sequence in (1) is as follows:
ΔU*=[Δu*(k),Δu*(k+1),...,Δu*(k+Nc-1)]T
applying the first of the optimal control increment sequence as the actual control increment to the system, namely:
u(k)=u(k-1)+Δu*(k)
and repeating the process in the next control period, and thus, the vehicle queue control can be realized.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210205186.9A CN114475599A (en) | 2022-03-02 | 2022-03-02 | Queue control method for curved road scene |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210205186.9A CN114475599A (en) | 2022-03-02 | 2022-03-02 | Queue control method for curved road scene |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114475599A true CN114475599A (en) | 2022-05-13 |
Family
ID=81484119
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210205186.9A Pending CN114475599A (en) | 2022-03-02 | 2022-03-02 | Queue control method for curved road scene |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114475599A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116564118A (en) * | 2023-07-11 | 2023-08-08 | 蘑菇车联信息科技有限公司 | Intersection passing control method, device and system of vehicles and electronic equipment |
-
2022
- 2022-03-02 CN CN202210205186.9A patent/CN114475599A/en active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116564118A (en) * | 2023-07-11 | 2023-08-08 | 蘑菇车联信息科技有限公司 | Intersection passing control method, device and system of vehicles and electronic equipment |
CN116564118B (en) * | 2023-07-11 | 2023-10-03 | 蘑菇车联信息科技有限公司 | Intersection passing control method, device and system of vehicles and electronic equipment |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111258323B (en) | Intelligent vehicle trajectory planning and tracking combined control method | |
CN110187639B (en) | Trajectory planning control method based on parameter decision framework | |
Wang et al. | Integrated optimal dynamics control of 4WD4WS electric ground vehicle with tire-road frictional coefficient estimation | |
CN110827535B (en) | Nonlinear vehicle queue cooperative self-adaptive anti-interference longitudinal control method | |
CN107161207B (en) | Intelligent automobile track tracking control system and control method based on active safety | |
CN112622903B (en) | Longitudinal and transverse control method for autonomous vehicle in vehicle following driving environment | |
CA2568220C (en) | Control device for vehicle | |
CN109969183A (en) | Bend follow the bus control method based on safely controllable domain | |
CN110377039A (en) | A kind of vehicle obstacle-avoidance trajectory planning and tracking and controlling method | |
CN109606363B (en) | Multi-state feedback intelligent automobile extension lane keeping control method | |
CN109144076A (en) | A kind of more vehicle transverse and longitudinals coupling cooperative control system and control method | |
CN111750866B (en) | Intelligent automobile transverse and longitudinal coupling path planning method based on regional virtual force field | |
CN110962849A (en) | Curve self-adaptive cruise method | |
CN110217227A (en) | A kind of braking in a turn joint collision avoidance control method suitable for ice-snow road operating condition | |
CN112660124A (en) | Collaborative adaptive cruise control method for lane change scene | |
CN108791290A (en) | Double-vehicle cooperative adaptive cruise control method based on online incremental DHP | |
CN113220021B (en) | Flight formation cooperative self-adaptive tracking control method based on virtual leader | |
CN113009829A (en) | Longitudinal and transverse coupling control method for intelligent internet motorcade | |
CN115285145A (en) | Unmanned curve collision avoidance trajectory planning and tracking control method | |
CN114475599A (en) | Queue control method for curved road scene | |
CN114779641A (en) | Environment self-adaptive MPC path tracking control method based on new course error definition | |
Kone | Lateral and longitudinal control of an autonomous racing vehicle. | |
CN111845738B (en) | Vehicle path tracking control method based on double-model combination | |
CN111413979B (en) | Automobile track tracking control method based on rapid model prediction | |
CN108594830A (en) | A kind of net connection intelligent vehicle formation travel control method based on spatial domain |
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 |