CN115963770B - Method, system, computer equipment and storage medium for controlling safety lane change of motorcade - Google Patents
Method, system, computer equipment and storage medium for controlling safety lane change of motorcade Download PDFInfo
- Publication number
- CN115963770B CN115963770B CN202310256661.XA CN202310256661A CN115963770B CN 115963770 B CN115963770 B CN 115963770B CN 202310256661 A CN202310256661 A CN 202310256661A CN 115963770 B CN115963770 B CN 115963770B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- liquid crystal
- display device
- crystal display
- representing
- 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
Links
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Abstract
The invention belongs to the technical field of vehicle team lane change control, and particularly discloses a vehicle team safety lane change control method, a system, computer equipment and a storage medium. The invention adopts a layering control strategy with integral consistency, and improves the control performance. Constructing a target lane change track for a leader vehicle in a technical layer; longitudinal and transverse controllers are provided at the operator level to ensure that the leader and follower vehicles respectively complete tracking of the constructed target lane-change trajectory and the lead vehicle. The invention can avoid collision with vehicles in the target lane and the current lane at the same time, and improves the safety of changing lanes of the motorcade. The invention can ensure that the motorcade can safely finish lane changing with preset precision within preset time, and the preset lane changing finishing time considers the information of relative displacement, speed, acceleration and the like of the vehicle, thereby ensuring that the vehicle can realize preset performance lane changing in the born control input, protecting the hardware equipment of the vehicle and avoiding the collision of the vehicle.
Description
Technical Field
The invention belongs to the technical field of vehicle team lane change control, and particularly relates to a vehicle team safety lane change control method, a system, computer equipment and a storage medium.
Background
Lane change control of vehicles is an important research content in intelligent transportation. In practice, vehicles need to change lanes to adjust speed or handle emergency situations, etc. Whether the vehicle can safely finish lane changing affects the transportation efficiency and stability of the whole intelligent transportation system. Due to the complexity of the driving road conditions, the possibility of collision during the course of changing the vehicle is very high. The occurrence of vehicle collision not only affects the safety of the whole intelligent transportation system and reduces the transportation efficiency, but also causes casualties and economic losses, so that a reliable vehicle lane change control method is widely focused and studied. Vehicle lane change control algorithms have been proposed by scholars to avoid collisions with vehicles in the target lane. However, when it is necessary to complete a lane change by acceleration or deceleration, the vehicle is necessarily at risk of collision with other vehicles in the current lane. To this end, the learner further developed a series of vehicle safety lane change control algorithms based on minimum safety distances from the vehicles in the target lane and the current lane.
So far, most lane change control studies have been mainly directed to a single vehicle. And a fleet composed of a plurality of vehicles can complete more complex tasks, so that the fleet safety lane change control is extremely valuable to study. However, the above-described single-vehicle lane-change control algorithm cannot prevent collisions between vehicles in a fleet, and thus cannot be directly applied to the fleet lane-change control. In order to avoid collision between the vehicle and the target lane and collision between the vehicles in the current lane and collision in the vehicle, the safety of changing the lane of the vehicle is ensured to the greatest extent, and a more perfect vehicle collision avoidance algorithm is required to be provided so as to determine the lane changing tracking track of the vehicle.
In addition, convergence time and convergence area are key indicators for evaluating system performance. The limited time stability criterion can ensure that the system converges faster than the asymptotic stability theory. Therefore, scholars have proposed a non-singular terminal sliding mode controller to ensure that a fleet completes a lane change within a limited time and avoid collisions within the fleet. Such limited time lane change control algorithms require that the initial position of the vehicle must be known, however in practical systems such requirements are not necessarily guaranteed.
In addition, vehicles are often modeled as non-linear systems for fit reality. Based on the nonlinear term of the fuzzy logic system or the neural network which is approximate to the unknown, the finite time fleet lane change error is not converged to zero any more but is converged to an unknown cell. Then, before the lane change is completed, the time required for the fleet to complete the lane change and the accuracy that the fleet can ensure for the lane change cannot be determined, which increases the risk of collision. Therefore, it is of further practical value and significance if it can be ensured that the fleet completes the lane change with a predetermined accuracy within a predetermined time. The existing preset performance lane change control algorithm can only avoid the collision in the vehicle platoon, so that the lane change vehicle platoon still has higher collision risk among the vehicle platoons. In addition, the above-described reservation of the fleet completion lane change time does not take into account information such as the position, speed, and acceleration of the vehicle, which is too far from reality. To ensure that lane changes can be completed within a predetermined time, a fleet theoretically requires very large control inputs, but vehicles are difficult to reach in practice.
Disclosure of Invention
The invention aims to provide a safe lane change control method for a motorcade, which ensures that the lane change precision and the finishing time can be reserved by providing a more practical performance function, and ensures that the motorcade can realize the lane change control with preset performance more easily.
In order to achieve the above purpose, the invention adopts the following technical scheme:
a motorcade safety lane change control method comprises the following steps:
step 2, obtaining a vehicle team collision avoidance condition based on the constructed vehicle team kinematics model, namely obtaining a condition for avoiding collision among the vehicle teams and in the vehicle teams in the lane change process;
step 3, calculating the lane change completion time of the motorcade based on the collision avoidance conditions of the motorcade;
step 5, designing a longitudinal controller and a transverse controller with preset performances for a motorcade consisting of a leader vehicle and a follower vehicle respectively based on a backstepping method according to the constructed target tracking track;
and 6, based on the longitudinal controller and the transverse controller, finishing the safety lane change control of the motorcade.
In addition, on the basis of the motorcade safety lane change control method, the invention also provides a motorcade safety lane change control system which is suitable for the motorcade safety lane change control method, and the motorcade safety lane change control system adopts the following technical scheme:
a fleet safety lane change control system comprising:
the motorcade kinematic model construction module is used for building a motorcade kinematic model;
the motorcade collision avoidance condition calculation module is used for obtaining motorcade collision avoidance conditions according to the constructed motorcade kinematic model, namely obtaining conditions for avoiding collision among motorcades and in motorcades in the lane change process;
the motorcade lane change completion time calculation module is used for calculating the motorcade lane change completion time according to the collision avoidance conditions of the motorcade;
the target tracking track construction module is used for constructing a target tracking track of the leader vehicle according to the lane change completion time of the vehicle team, and comprises a transverse tracking track of the target of the leader vehicle and a longitudinal tracking track of the leader vehicle;
the preset performance controller construction module is used for respectively designing a longitudinal controller and a transverse controller with preset performance for the leader vehicle and the follower vehicle based on a backstepping method according to the constructed target tracking track;
and the motorcade safety lane change control module is used for completing motorcade safety lane change control according to the longitudinal controller and the transverse controller.
In addition, on the basis of the vehicle team safety lane change control method, the invention also provides computer equipment which comprises a memory and one or more processors.
The memory stores executable codes, and the processor is used for realizing the steps of the motorcade security lane change control method when executing the executable codes.
In addition, on the basis of the vehicle team safety lane change control method, the invention further provides a computer readable storage medium on which a program is stored.
The program, when executed by the processor, is adapted to carry out the steps of the above-mentioned fleet safety lane change control method.
The invention has the following advantages:
1. the method adopts a layering control strategy with integral consistency, and improves the control performance. At the technical layer, a target lane change track is constructed for a leader vehicle; at the operating level, longitudinal and transverse controllers are respectively proposed to ensure that the leader and follower vehicles respectively complete tracking of the constructed target lane-change trajectory and the lead vehicle.
2. The method can avoid collision with vehicles in the target lane and the current lane at the same time, improves the lane changing safety of the motorcade, has practical application value and meets the technical requirements of intelligent traffic control.
3. The method can ensure that the motorcade safely completes lane changing with preset precision within preset time, and the preset lane changing completion time considers the information of relative displacement, speed, acceleration and the like of the vehicle, so as to ensure that the vehicle can realize preset performance lane changing in the born control input, and avoid the collision of the vehicle while protecting the hardware equipment of the vehicle.
Drawings
FIG. 1 is a flow chart of a method for controlling a fleet safety lane change in an embodiment of the present invention.
Fig. 2 is a schematic diagram of lane change implemented by the method of the present invention, showing a state before lane change of a fleet.
Fig. 3 is a schematic diagram of lane change implemented by the method of the present invention, showing a state in a lane change process of a fleet.
Fig. 4 is a schematic diagram of lane change implemented by the method of the present invention, showing a state after lane change of a fleet.
FIG. 5 shows a vehicle M during lane change in accordance with an embodiment of the present invention 0 And vehicle L d Is a positional relationship diagram of (a).
FIG. 6 is a schematic illustration of a vehicle M during lane change in an embodiment of the invention 0 And vehicle L o Is a positional relationship diagram of (a).
FIG. 7 shows a vehicle M during lane change in accordance with an embodiment of the present invention n And vehicle F d Is a positional relationship diagram of (a).
FIG. 8 is a schematic illustration of a vehicle M during lane change in an embodiment of the invention n And vehicle F o Is a positional relationship diagram of (a).
Fig. 9 is a graph of radius of curvature during lane change in an embodiment of the invention.
Detailed Description
Example 1
Aiming at the defects of the existing motorcade safety lane change control technology, the embodiment 1 provides a motorcade safety lane change control method with preset performance based on a layering technology, wherein a target lane change track is designed for a leader vehicle on a technical layer while collision between motorcades and inside motorcades is avoided; on the operation layer, the leader vehicle and the follower vehicle are ensured to respectively track the target lane change track and the front vehicle with preset precision in preset time.
Specifically, as shown in fig. 1, the method for controlling the safe lane change of the motorcade in this embodiment includes the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,indicating vehicle->Is a displacement vector of (a); />And->Respectively corresponding to express vehicle->Longitudinal displacement and lateral displacement of the left front corner;indicating vehicle->Is a velocity vector of (2); />And->Respectively corresponding to express vehicle->Longitudinal speed and lateral speed of the left front corner; />Indicating vehicle->Is a vector of acceleration; />And->Respectively corresponding to express vehicle->Longitudinal acceleration and lateral acceleration of the front left corner; />Indicating vehicle->Is a saturation controller of (1); />And->Respectively corresponding to express vehicle->Is a saturation longitudinal controller and a saturation transverse controller.
Is a longitudinal control to be designed, +.>Is a transverse controller to be designed;,/>,/>,the method comprises the steps of carrying out a first treatment on the surface of the Wherein (1)>、/>、/>And->Are predetermined normal numbers.Representing an unknown nonlinear vector function, +.>Andrepresenting an unknown nonlinear function ++>,;/>N represents the number of follower vehicles.
When i=0, the number of the cells,representing the leader vehicle when +.>When (I)>Representing a follower vehicle.
And 2, obtaining a collision avoidance condition of the motorcade based on the constructed motorcade kinematic model, namely obtaining a condition for avoiding collision among motorcades and in the motorcade in the lane changing process. The method for obtaining the collision avoidance conditions of the motorcade comprises the following steps:
step 2.1. Leader vehicle according to the vehicle position relationship shown in FIG. 5And front car of target lane->Collision avoidance conditions between->The method comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,indicating vehicle->Longitudinal displacement of the left front corner;,/>and->Respectively are provided withIndicating vehicle->Length of (d) and vehicleWidth of->Indicating vehicle->Deflection angle of +.>Indicating vehicle->And vehicle->A predetermined safe distance therebetween; />Indicating the time of completion of the change of the fleet,/>Indicating vehicle->Longitudinal displacement of the left front corner.
Step 2.2. Leader vehicle according to the vehicle position relationship shown in FIG. 6And the current lane front car->Collision avoidance conditions between->The method comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,indicating vehicle->Left front angle longitudinal displacement;,/>indicating vehicle->Length of->Indicating vehicle->And vehicle->A predetermined safe distance therebetween.
Step 2.3. Follower vehicle according to the vehicle position relationship shown in FIG. 7And rear car of target lane->Collision avoidance conditions between->The method comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,indicating vehicle->Longitudinal displacement of the left front corner;,/>indicating vehicle->Width of->Indicating vehicle->Is provided; />Indicating vehicle->And vehicle->A predetermined safe distance therebetween; />Indicating vehicle->Longitudinal displacement of the left front corner.
Step 2.4. Follower vehicle according to the vehicle position relationship shown in FIG. 8And the rear car of the current lane->Collision avoidance conditions between->The method comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,indicating vehicle->Longitudinal displacement of the left front corner; />,Indicating vehicle->Width of->Indicating vehicle->And vehicle->A predetermined safe distance therebetween.
Step 2.5. In addition, the radius of curvature as shown in fig. 9 directly determines the stability of the lane change process. Thus, a smooth lane change process is critical to ensuring driver and passenger comfort.
According to the longitudinal displacement required for changing tracks shown in FIG. 9The conditions are satisfied:
the method comprises the steps of carrying out a first treatment on the surface of the Wherein (1)>Is the turning radius +.>Is the overall longitudinal displacement of the fleet; thus, the time for the completion of the changing of the vehicle team is +.>The following requirements are also satisfied:
wherein, the liquid crystal display device comprises a liquid crystal display device,represents an integral variable +.>Is the minimum turning radius; />Indicating vehicle->Target longitudinal acceleration of (a); />Indicating team +.>Is used for the initial longitudinal velocity of the vehicle.
And step 3, calculating the lane change completion time of the motorcade based on the collision avoidance conditions of the motorcade.
Time of completion of changing lane of motorcadeObtained by solving the following set of inequalities:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing leader vehicle->Is set in the first longitudinal direction; />、/>、、/>Respectively corresponding to express vehicle->、/>、/>、/>Longitudinal acceleration of (2); />、、/>、/>Respectively corresponding to express vehicle->、/>、/>、/>Is set in the first longitudinal direction;representing fleet and vehicle->Initial distance between>Representing fleet and vehicle->An initial distance between; />Representing fleet and vehicle->Initial distance between>Representing fleet and vehicle->An initial distance between; to ensure that the vehicle is +_ after lane change is complete>And vehicle->Can not collide and can be wore>The following conditions need to be satisfied:
wherein, the liquid crystal display device comprises a liquid crystal display device,indicating team +.>Is a length of (2); />、/>、/>、/>、Respectively corresponding to express vehicle->、/>、/>、/>、/>Is used for the initial longitudinal displacement of the piston.
Based on formula (9)And the meeting condition is that the vehicle team lane change completion time can be obtained through solving.
And 4, constructing a target tracking track of the leader vehicle based on the fleet lane change completion time, wherein the constructing comprises constructing a target transverse tracking track of the leader vehicle and a longitudinal tracking track of the leader vehicle.
According to the steps of3, the lane change completion time calculated in 3Leader vehicle->The target acceleration of (2) is modeled as:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing leader vehicle->Is set in the vehicle, is a target lateral acceleration of (1).
The construction method of the transverse tracking track and the longitudinal tracking track of the leader vehicle target comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing a leader vehicle target lateral tracking trajectory;
wherein, the liquid crystal display device comprises a liquid crystal display device,representing a leader vehicle target longitudinal tracking trajectory.
And 5, respectively designing a longitudinal controller and a transverse controller with preset performances for a motorcade consisting of a leader vehicle and a follower vehicle based on a backstepping method according to the constructed target tracking track.
The step 5 specifically comprises the following steps:
step 5.1. Vehicle obtained according to step 3Queue change completion timeThe following more realistic performance functions were constructed:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing a performance function; />And->Is a predetermined positive design parameter, ">Representation->Or alternatively,/>Depending on the initial state of the fleet system, +.>Is a predetermined fleet lane change tracking error.
Step 5.2. According to the constructed Performance functionThe following error transformations were performed:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing follower vehicle->And front vehicle->The error in the longitudinal displacement between them,representing follower vehicle->And front vehicle->And a lateral displacement error therebetween.
Representing longitudinal displacement error +.>Error transformation of->Representing lateral displacement errorsIs a transformation of the error of (2); />Representation->Performance function at time, ++>Representation->Performance function at time; />Representing the longitudinal displacement of the leader vehicle>And longitudinal target tracking track->Error between->Representing the transverse displacement of the leader vehicle>And transverse target tracking track->Errors between; />,/>The method comprises the steps of carrying out a first treatment on the surface of the Wherein (1)>Representing follower vehicle->Length of->Representing predetermined fleet of vehiclesSafety distance between vehicles.
Step 5.3. Designing a longitudinal controller of preset Performance for a fleet of leader and follower vehicles based on a back-stepping approachAnd a transversal controller->The method comprises the steps of carrying out a first treatment on the surface of the The specific process is as follows:
step 5.1. According to the fleet lane change completion time obtained in step 3The following more realistic performance functions were constructed:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing a performance function; />And->Is a predetermined positive design parameter, ">Representation->Or alternatively,/>Depending on the initial state of the fleet system, +.>Is a predetermined fleet lane change tracking error;
step 5.2. According to the constructed Performance functionThe following error transformations were performed:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing follower vehicle->And front vehicle->The error in the longitudinal displacement between them,representing follower vehicle->And front vehicle->A lateral displacement error therebetween;
representing longitudinal displacement error +.>Error transformation of->Representing lateral displacement errorsIs a transformation of the error of (2); />Representation->Performance function at time, ++>Representing z =p y Performance function at time; />Representing the longitudinal displacement of the leader vehicle>And longitudinal target tracking track->Error between->Representing the transverse displacement of the leader vehicle>And transverse target tracking track->Errors between;
wherein, the liquid crystal display device comprises a liquid crystal display device,representing follower vehicle->Length of->Representing a predetermined safe distance between vehicles in the fleet;
step 5.3. Designing a longitudinal controller of preset Performance for a fleet of leader and follower vehicles based on a back-stepping approachAnd a transversal controller->The method comprises the steps of carrying out a first treatment on the surface of the The specific process is as follows:
when (when)When (I)>,/>;Is a virtual longitudinal speed controller, +.>Is a virtual lateral speed controller; />Is a virtual longitudinal speed control error, +.>Is a virtual lateral velocity control error.
using the young's inequality, we get:
substituting equations (17) and (18) into equation (16) yields:
according to equation (19), virtual longitudinal and lateral speed controllers are designed to be:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is a design parameter; in connection with formulas (20) and (21), formula (19) is rewritten as:
step 5.3.2. Control error for virtual longitudinal speedAnd virtual lateral velocity control errorThe following Lyapunov candidate function is constructed>The method comprises the following steps: />
wherein, the liquid crystal display device comprises a liquid crystal display device,is a virtual longitudinal acceleration controller, +.>Is a virtual lateral acceleration controller; />Is a virtual longitudinal acceleration control error, +.>Is a virtual lateral acceleration control error;,/>。
wherein, superscript、/>Represents the>、/>Order derivative, l.epsilon.0, 1]The method comprises the steps of carrying out a first treatment on the surface of the Using the young's inequality, we get:
substituting equations (25) and (26) into equation (24) yields:
constructing virtual longitudinal acceleration controllers according to formula (27)Lateral acceleration controllerThe method comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is a design parameter.
Combining equations (28) and (29), equation (27) translates into:
step 5.3.3. Will be the vehicle respectivelyThe true adaptive neural network longitudinal and transverse controllers are designed.
Control error for virtual longitudinal accelerationAnd virtual lateral acceleration error->The following Lyapunov candidate function is constructed>:
Wherein, the liquid crystal display device comprises a liquid crystal display device,is approximation error, ++>,/>Or->;/>Is an unknown parameter->Is a similar estimate of (1); according to formula (3), we get:
approximation of unknown nonlinear functions using neural networksAnd->The method comprises the following steps of:
wherein, the liquid crystal display device comprises a liquid crystal display device,、/>ideal weight vector representing neural network, +.>And->Is a Gaussian function>And->The expressions of (2) are respectively:
wherein, the liquid crystal display device comprises a liquid crystal display device,is an exponential function, M>1 is the number of nodes of the neural network,is->Center vector of each hidden layer node, +.>Is a center vector +.>Is a sub-vector of (2); />Is->The width of the individual neurons; />Andis an approximation error, and->And->Is a positive constant; substituting equations (33) and (34) into equation (32) yields:
using the young's inequality, we get:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is an unknown parameter, which will be approximately estimated by the design of an adaptive law below; combining equations (36) and (37), equation (35) translates into:
according to equation (38), the adaptive longitudinal and lateral controllers are designed to:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is a design parameter; substituting equations (39) and (40) into equation (38) yields: />
According to the formula (41), the adaptive law of the design parameters is as follows:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is a design parameter;using equations (42) and (43), equation (41) is converted into:
according to the young's inequality, we get:
substituting equations (45) and (46) into equation (44) yields:
and 6, based on the longitudinal controller and the transverse controller, finishing the safety lane change control of the motorcade.
according to formulas (22), (30) and (47), we get:
,/>the method comprises the steps of carrying out a first treatment on the surface of the Derived from formula (49)>Is bounded; thus (S)>And->Is bounded; based on->And->Respectively considerAnd->Further based on the longitudinal controller and the transverse controller of the preset performance designed in the step 5, the track-changing tracking error of the motorcade +.>And->Can be +.>Inside respectively converging to a predetermined area->And->An inner part; thus, the fleet safely completes the preset performance lane change.
Example 2
Embodiment 2 describes a system for controlling the lane change of the fleet safety, which is based on the same inventive concept as the method for controlling the lane change of the fleet safety described in embodiment 1. Specifically, the fleet safety lane change control system includes:
the motorcade kinematic model construction module is used for building a motorcade kinematic model;
the motorcade collision avoidance condition calculation module is used for obtaining motorcade collision avoidance conditions according to the constructed motorcade kinematic model, namely obtaining conditions for avoiding collision among motorcades and in motorcades in the lane change process;
the motorcade lane change completion time calculation module is used for calculating the motorcade lane change completion time according to the collision avoidance conditions of the motorcade;
the target tracking track construction module is used for constructing a target tracking track of the leader vehicle according to the lane change completion time of the vehicle team, and comprises a transverse tracking track of the target of the leader vehicle and a longitudinal tracking track of the leader vehicle;
the preset performance controller construction module is used for respectively designing a longitudinal controller and a transverse controller with preset performance for the leader vehicle and the follower vehicle based on a backstepping method according to the constructed target tracking track;
and the motorcade safety lane change control module is used for completing motorcade safety lane change control according to the longitudinal controller and the transverse controller.
It should be noted that, in the fleet safety lane changing control system, the implementation process of the functions and roles of each functional module is specifically shown in the implementation process of the corresponding steps in the method in the above embodiment 1, and will not be described herein again.
Example 3
Embodiment 3 describes a computer apparatus for implementing the steps of the fleet safety lane change control method described in embodiment 1 above.
The computer device includes a memory and one or more processors. Executable code is stored in the memory, which when executed by the processor is used to implement the steps of the fleet safety lane change control method described above.
In this embodiment, the computer device is any device or apparatus having data processing capability, which is not described herein.
Example 4
The computer-readable storage medium of embodiment 4 has stored thereon a program for implementing the steps of the above-described fleet safety lane change control method when executed by a processor.
The computer readable storage medium may be an internal storage unit of any device or apparatus having data processing capability, such as a hard disk or a memory, or may be an external storage device of any device having data processing capability, such as a plug-in hard disk, a Smart Media Card (SMC), an SD Card, a Flash memory Card (Flash Card), or the like, which are provided on the device.
The foregoing description is, of course, merely illustrative of preferred embodiments of the present invention, and it should be understood that the present invention is not limited to the above-described embodiments, but is intended to cover all modifications, equivalents and alternatives falling within the spirit and scope of the present invention as defined by the appended claims.
Claims (5)
1. The method for controlling the safety lane change of the motorcade is characterized by comprising the following steps:
step 1, establishing a motorcade kinematic model;
step 2, obtaining a collision avoidance condition of the motorcade based on the constructed motorcade kinematic model, namely obtaining a condition for avoiding collision among motorcades and in the motorcade in the lane changing process;
step 3, calculating the lane change completion time of the motorcade based on the collision avoidance conditions of the motorcade;
step 4, constructing a target tracking track of the leader vehicle based on the lane change completion time of the vehicle fleet, wherein the step comprises constructing a target transverse tracking track of the leader vehicle and a longitudinal tracking track of the leader vehicle;
step 5, designing a longitudinal controller and a transverse controller with preset performances for a motorcade consisting of a leader vehicle and a follower vehicle based on a back step method according to the constructed target tracking track;
step 6, based on the longitudinal controller and the transverse controller, finishing the safety lane change control of the motorcade;
in the step 1, the motorcade dynamics model is expressed as:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing vehicle M i Is a displacement vector of (a); />And->Respectively and correspondingly represent the vehicle M i Longitudinal displacement and lateral displacement of the left front corner;
representing vehicle M i Is a velocity vector of (2); />And->Respectively and correspondingly represent the vehicle M i Longitudinal speed and lateral speed of the left front corner;
representing vehicle M i Is a vector of acceleration; />And->Respectively and correspondingly represent the vehicle M i Longitudinal acceleration and lateral acceleration of the front left corner;
and->Respectively and correspondingly represent the vehicle M i A saturation longitudinal controller and a saturation transverse controller;
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Are predetermined normal numbers;
representing an unknown nonlinear vector function, +.>And->Representing an unknown nonlinear function ++>
i=0, 1, …, n, n representing the number of follower vehicles;
when i=0, M 0 Representing a leader vehicle, when i=1, …, n, M i Representing a follower vehicle;
in the step 2, the method for obtaining the collision avoidance conditions of the motorcade comprises the following steps:
step 2.1. Leader vehicle M 0 And a target lane front vehicle L d Collision avoidance conditions S between MLd (t) is:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing a vehicle L d Longitudinal displacement of the left front corner;
l Ld and->Respectively represent the vehicles L d Length of (d) and vehicle M 0 Is (t) represents the width of the vehicle M 0 Deflection angle d of (d) MLd Representing a vehicle L d And vehicle M 0 A predetermined safe distance therebetween;
t l indicating the completion time of the change of the motorcade,representing vehicle M 0 Longitudinal displacement of the left front corner;
step 2.2. Leader vehicle M 0 And a current lane front vehicle L o Collision avoidance conditions S between MLo (t) is:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing a vehicle L o Left front corner longitudinalDisplacement; />l Lo Representing a vehicle L o Length d of (d) MLo Representing a vehicle L o And vehicle M 0 A predetermined safe distance therebetween;
step 2.3. follower vehicle M n And target lane rear vehicle F d Collision avoidance conditions S between MFd (t) is:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing vehicle F d Longitudinal displacement of the left front corner;
representing vehicle M n Width of->Representing vehicle M n Is provided; d, d MFd Representing vehicle F d And vehicle M n A predetermined safe distance therebetween;
step 2.4. follower vehicle M n And a rear vehicle F of the current lane o Collision avoidance conditions S between MFo (t) is:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing vehicle F o Longitudinal displacement of the left front corner; />Representing vehicle M n Width d of (d) MFo Representing vehicle F o And vehicle M n A predetermined safe distance therebetween;
step 2.5. The longitudinal displacement L required for lane change satisfies the condition:
wherein R is a turning radius, and H is the overall longitudinal displacement of the fleet; thus, the lane change completion time t of the motorcade l The following requirements are also satisfied:
wherein λ represents an integral variable, R min Is the minimum turning radius;
representing vehicle M 0 Target longitudinal acceleration of (a); />Representing an initial longitudinal speed of the fleet M;
in the step 3, the time t for completing the lane change of the motorcade l Obtained by solving the following set of inequalities:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing leader vehicle M 0 Is set in the first longitudinal direction; /> Respectively and correspondingly represent the vehicle L d 、L o 、F d 、F o Longitudinal acceleration of (2); /> Respectively and correspondingly represent the vehicle L d 、L o 、F d 、F o Is set in the first longitudinal direction; s is S MLd (0) Representing fleet and vehicle L d Initial distance between S MLo (0) Representing fleet and vehicle L o An initial distance between; s is S MFd (0) Representing fleet and vehicle F d Initial distance between S MFo (0) Representing fleet and vehicle F o An initial distance between;
to ensure that the lane change is completed the vehicle M 0 And vehicle L d The collision can not occur, and the collision can not occur,the following conditions need to be satisfied:
wherein l M Indicating the length of the fleet M; respectively and correspondingly represent the vehicle L d 、L o 、F d 、F o 、M 0 Is used for the initial longitudinal displacement of the piston;
based on formula (9)The satisfied conditions, namely the completion time of the changing of the motorcade can be solved;
in the step 4, the construction method of the transverse tracking track and the longitudinal tracking track of the leader vehicle target comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing a leader vehicle target lateral tracking trajectory;
wherein, the liquid crystal display device comprises a liquid crystal display device,representing a leader vehicle target longitudinal tracking trajectory;
the step 5 specifically comprises the following steps:
step 5.1. According to the fleet lane change completion time t obtained in step 3 l The following more realistic performance functions were constructed:
wherein D is zi (t) represents a performance function; r is R zi And epsilon zi Is a predetermined positive design parameter, z represents p x Or p y ,R zi Depending on the initial state of the fleet system ε zi Is a predetermined fleet lane change tracking error;
step 5.2. According to the constructed Performance function D zi (t) performing the following error transformation:
wherein, the liquid crystal display device comprises a liquid crystal display device,representing follower vehicle M i And a front vehicle M (i-1) Longitudinal displacement error between->Representing follower vehicle M i And a front vehicle M (i-1) A lateral displacement error therebetween;
representing longitudinal displacement error +.>Error transformation of->Representing lateral displacement errorsIs a transformation of the error of (2); />Representing z=p x Performance function at time, ++>Representing z=p y Performance function at time; />Representing the longitudinal displacement of the leader vehicle>And longitudinal target tracking track->Error between->Representing the transverse displacement of the leader vehicle>And transverse target tracking track->Errors between;
wherein l Mi Representing follower vehicle M i D represents a predetermined safe distance between vehicles in the fleet;
step 5.3. Designing a longitudinal controller of preset Performance for a fleet of leader and follower vehicles based on a back-stepping approachAnd a transversal controller->The specific process is as follows:
step 5.3.1. For i=0, 1, …, n, the lyapunov candidate function is selectedThe method comprises the following steps:
according to equation (1), equation (13) and equation (14), then V pi The derivative of (t) is:
is virtualLongitudinal speed controller->Is a virtual lateral speed controller; />Is a virtual longitudinal speed control error, +.>Is a virtual lateral velocity control error;
using the young's inequality, we get:
substituting equations (17) and (18) into equation (16) yields:
according to equation (19), virtual longitudinal and lateral speed controllers are designed to be:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is a design parameter; in connection with formulas (20) and (21), formula (19) is rewritten as:
step 5.3.2. Control error for virtual longitudinal speedAnd virtual lateral velocity control errorConstruction of the following Lyapunov candidate function +.>The method comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,is a virtual longitudinal acceleration controller, +.>Is a virtual lateral acceleration controller;is a virtual longitudinal acceleration control error, +.>Is a virtual lateral acceleration control error;
wherein, the superscript l, l+1 represents the first, l+1 derivative of the variable, l.epsilon.0, 1; using the young's inequality, we get:
substituting equations (25) and (26) into equation (24) yields:
constructing virtual longitudinal acceleration controllers according to formula (27)Lateral acceleration controllerThe method comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is a design parameter;
combining equations (28) and (29), equation (27) translates into:
step 5.3.3. Will be vehicle M, respectively i Designing true adaptive neural network longitudinal and lateral controlA device;
control error for virtual longitudinal accelerationAnd virtual lateral acceleration error->Construction of the following Lyapunov candidate function +.>
Wherein, the liquid crystal display device comprises a liquid crystal display device,is approximation error, ++>k=x i Or y i ;
approximation of unknown nonlinear functions using neural networksAnd->The method comprises the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,ideal weight vector representing neural network, +.>And->Is a Gaussian function>And->The expressions of (2) are respectively:
wherein exp (·) is an exponential function, M>1 is the number of nodes of the neural network, c m =[c 1,m ,c 2,m ,...,c M,m ] T Is the center vector of the mth hidden layer node, c 1,m ,c 2,m ,...,c M,m As the center vector c m Is a sub-vector of (2);
w m is the width of the mth neuron;
substituting equations (33) and (34) into equation (32) yields:
using the young's inequality, we get:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is an unknown parameter, which will be approximately estimated by the design of an adaptive law below;
combining equations (36) and (37), equation (35) translates into:
according to equation (38), the adaptive longitudinal and lateral controllers are designed to:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is a design parameter; substituting equations (39) and (40) into equation (38) yields:
according to the formula (41), the adaptive law of the design parameters is as follows:
wherein, the liquid crystal display device comprises a liquid crystal display device,and->Is a design parameter; using equations (42) and (43), equation (41) is converted into:
according to the young's inequality, we get:
substituting equations (45) and (46) into equation (44) yields:
2. the method for controlling a safe lane change of a vehicle according to claim 1, wherein,
the step 6 specifically comprises the following steps:
the integral Lyapunov function V (t) is constructed as follows:
according to formulas (22), (30) and (47), we get:
v (t) is bounded, as obtained according to equation (49); thus (S)>And->Is bounded; based on->And->Respectively considerAnd->Further based on the longitudinal controller and the transverse controller of the preset performance designed in the step 5, the track-changing tracking error of the motorcade +.>And->Can converge to a predetermined area within a predetermined limited time tl, respectively>And->An inner part; thus, the fleet safely completes the preset performance lane change.
3. A fleet safety lane change control system for implementing the fleet safety lane change control method as set forth in claim 1 or 2, characterized in that the fleet safety lane change control system comprises:
the motorcade kinematic model construction module is used for building a motorcade kinematic model;
the motorcade collision avoidance condition calculation module is used for obtaining the motorcade collision avoidance conditions according to the constructed motorcade kinematics model, namely obtaining the conditions for avoiding collision between motorcades and in motorcades in the lane change process;
the motorcade lane change completion time calculation module is used for calculating the motorcade lane change completion time according to the motorcade collision avoidance conditions;
the target tracking track construction module is used for constructing a target tracking track of the leader vehicle according to the lane change completion time of the vehicle team, and comprises a transverse tracking track of the target of the leader vehicle and a longitudinal tracking track of the leader vehicle;
the preset performance controller construction module is used for respectively designing a longitudinal controller and a transverse controller with preset performance for the leader vehicle and the follower vehicle based on a backstepping method according to the constructed target tracking track;
and the motorcade safety lane change control module is used for completing motorcade safety lane change control according to the longitudinal controller and the transverse controller.
4. A computer device comprising a memory and one or more processors, the memory having executable code stored therein, wherein the processor, when executing the executable code,
the steps of implementing the fleet safety lane change control method as claimed in claim 1 or 2.
5. A computer-readable storage medium having a program stored thereon, which when executed by a processor, implements the steps of the fleet safety lane change control method as claimed in claim 1 or 2.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310256661.XA CN115963770B (en) | 2023-03-17 | 2023-03-17 | Method, system, computer equipment and storage medium for controlling safety lane change of motorcade |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310256661.XA CN115963770B (en) | 2023-03-17 | 2023-03-17 | Method, system, computer equipment and storage medium for controlling safety lane change of motorcade |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115963770A CN115963770A (en) | 2023-04-14 |
CN115963770B true CN115963770B (en) | 2023-07-07 |
Family
ID=85894709
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310256661.XA Active CN115963770B (en) | 2023-03-17 | 2023-03-17 | Method, system, computer equipment and storage medium for controlling safety lane change of motorcade |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115963770B (en) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106994969A (en) * | 2017-03-24 | 2017-08-01 | 奇瑞汽车股份有限公司 | A kind of fleet's formation control loop and method |
CN107729687A (en) * | 2017-11-09 | 2018-02-23 | 四川海卓大数据科技有限公司 | Construction transportation plan optimization method in dam engineering building course |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10222773B2 (en) * | 2016-12-23 | 2019-03-05 | Centurylink Intellectual Property Llc | System, apparatus, and method for implementing one or more internet of things (IoT) capable devices embedded within a roadway structure for performing various tasks |
CN113763742B (en) * | 2020-06-01 | 2022-09-30 | 大唐移动通信设备有限公司 | Method and device for assisting driving of motorcade based on MEC and storage medium |
CN112083719B (en) * | 2020-08-19 | 2022-04-01 | 东北大学秦皇岛分校 | Finite time fleet control method based on preset performance function |
CN113721634B (en) * | 2021-09-09 | 2023-12-19 | 东北大学秦皇岛分校 | Vehicle team limited time cooperative control method based on back stepping method considering actuator saturation |
CN115729263A (en) * | 2022-11-22 | 2023-03-03 | 大连海事大学 | Obstacle avoidance control method for under-actuated quad-rotor unmanned aerial vehicle |
-
2023
- 2023-03-17 CN CN202310256661.XA patent/CN115963770B/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106994969A (en) * | 2017-03-24 | 2017-08-01 | 奇瑞汽车股份有限公司 | A kind of fleet's formation control loop and method |
CN107729687A (en) * | 2017-11-09 | 2018-02-23 | 四川海卓大数据科技有限公司 | Construction transportation plan optimization method in dam engineering building course |
Also Published As
Publication number | Publication date |
---|---|
CN115963770A (en) | 2023-04-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Huang et al. | Personalized trajectory planning and control of lane-change maneuvers for autonomous driving | |
Huang et al. | A novel local motion planning framework for autonomous vehicles based on resistance network and model predictive control | |
CN112389427B (en) | Vehicle track optimization method and device, electronic equipment and storage medium | |
CN110015306B (en) | Driving track obtaining method and device | |
Huang et al. | Toward safe and personalized autonomous driving: Decision-making and motion control with DPF and CDT techniques | |
CN111679660B (en) | Unmanned deep reinforcement learning method integrating human-like driving behaviors | |
Feng et al. | Collision avoidance method of autonomous vehicle based on improved artificial potential field algorithm | |
Huang et al. | Collision-probability-aware human-machine cooperative planning for safe automated driving | |
Hu et al. | Probabilistic lane-change decision-making and planning for autonomous heavy vehicles | |
Yang et al. | Towards robust decision-making for autonomous driving on highway | |
Huang et al. | Human-machine cooperative trajectory planning and tracking for safe automated driving | |
Yuan et al. | Mixed local motion planning and tracking control framework for autonomous vehicles based on model predictive control | |
CN113954837A (en) | Deep learning-based lane change decision method for large-scale commercial vehicle | |
He et al. | Design and experiential test of a model predictive path following control with adaptive preview for autonomous buses | |
Na et al. | Experimental evaluation of a game-theoretic human driver steering control model | |
Wahid et al. | Vehicle collision avoidance motion planning strategy using artificial potential field with adaptive multi‐speed scheduler | |
Wang et al. | Motion planning and model predictive control for automated tractor-trailer hitching maneuver | |
Li et al. | Path planning and obstacle avoidance control for autonomous multi-axis distributed vehicle based on dynamic constraints | |
CN115963770B (en) | Method, system, computer equipment and storage medium for controlling safety lane change of motorcade | |
Garzón et al. | Game theoretic decision making based on real sensor data for autonomous vehicles’ maneuvers in high traffic | |
CN114537435A (en) | Real-time whole vehicle track planning method in automatic driving | |
Liu et al. | Road safety analysis for high‐speed vehicle in complex environments based on the viability kernel | |
Qian et al. | Obstacle avoidance planning of autonomous vehicles using deep reinforcement learning | |
Liu et al. | Research on lane change motion planning steering input based on optimal control theory | |
CN113033902A (en) | Automatic driving track-changing planning method based on improved deep learning |
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 |