A plug-in cooperative lane-changing control method for intelligent connected vehicle fleet
By adopting the plug-in collaborative lane change control method in the intelligent connected fleet, and using the backward follow-up information topology structure to optimize vehicle behavior, the problems of low success rate and poor stability in the existing technology are solved, and high-density traffic is achieved Efficient lane change in the environment improves the mobility and stability of the fleet.
Patent Information
- Application Number
- CN202210974262.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-08-15
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2042-08-15
AI Technical Summary
The existing intelligent connected fleet lane change control method has low success rate, poor stability, long calculation time, and cannot guarantee real-time performance in high-density traffic environments, resulting in insufficient mobility and adaptability of fleets in high-density traffic environments.
Using the plug-in collaborative lane change control method, the central controller collects information about controlled vehicles and surrounding vehicles in the fleet, establishes a backward follow-up information topology, optimizes the acceleration, braking and steering process of the vehicle, generates decision commands and passes them to Power and braking systems realize the coordinated lane change of the fleet.
In a high-density traffic environment, effectively use small lane change gaps to complete the fleet lane change, improve lane change capabilities and efficiency, enhance the mobility and stability of the fleet, reduce the computing load, and ensure the accuracy of the vehicle following the reference target trajectory.
Smart Images

Figure CN115320596B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of intelligent network-connected vehicle fleet control, and in particular to a plug-in cooperative lane-changing control method for an intelligent network-connected vehicle fleet. Background Art
[0002] Intelligent networked vehicles are equipped with advanced sensors, decision-makers, controllers, actuators and other devices, integrating modern communication technology and network technology, and have functions such as vehicle-to-vehicle and vehicle-to-road communication and vehicle-mounted sensing. Vehicle-mounted communication equipment and vehicle-mounted sensing equipment enable intelligent networked vehicles to have the ability to perceive the environment. The environmental perception information is determined by the decision-making system to generate decision commands. The control system receives the decision commands to control the acceleration, braking and steering process of the vehicle. Finally, the vehicle actuator completes the control operation of automatic driving.
[0003] Collaborative platoon driving of intelligent connected vehicles is a key technology in the application of intelligent connected vehicles. Platoon driving can effectively improve the mobility, safety and sustainability of the transportation system. Organizing multiple intelligent connected vehicles into a platoon can reduce the following distance between vehicles in the platoon, thereby nearly doubling the road capacity, reducing fuel consumption by 10% to 20% and carbon emissions by 14%. In order to achieve platoon driving of intelligent connected vehicles, it is often necessary to base it on perfect intelligent connected vehicle platoon control, that is, multi-vehicle collaborative horizontal and vertical coupling control in multiple scenarios. To achieve this control goal, the central controller is currently mainly used to collect vehicle information in the platoon through multi-vehicle communication technology, combine data information processing and send vehicle control instructions, so as to control the acceleration, braking and steering of the intelligent connected vehicles in the platoon accordingly.
[0004] However, most of the current intelligent connected vehicle cooperative platoon driving technologies only consider the longitudinal level, which makes it easy for the controlled vehicle to leave the platoon when taking lane change measures. Since the lateral control is only performed at the single vehicle level, the continuity and stability of the platoon driving cannot be guaranteed. Although the existing technology has considered the lane changing behavior of intelligent connected vehicle platoons and proposed some intelligent connected vehicle platoon lane changing methods, the existing intelligent connected vehicle platoon lane changing methods still have the following obvious defects:
[0005] 1. The most prominent problem of the existing control methods is that the lane change of the convoy has high requirements on the lane change gap and the speed and acceleration of the front vehicle and the vehicles before and after the lane change gap. In a high-density traffic environment, the lane change gap is small, and the lane change success rate of the convoy using the existing control method is very low, which greatly reduces the mobility of the intelligent networked fleet and its adaptability to real traffic scenarios.
[0006] 2. In the existing control methods, the stability of the platoon has not been verified, and the following error of the controlled vehicles may increase from the beginning to the end of the platoon, which not only increases the probability of collision but also causes traffic oscillation.
[0007] 3. The existing control methods take too long and are uncertain to calculate, which puts a lot of pressure on the hardware and cannot guarantee the real-time performance of the algorithm.
[0008] 4. In the existing control methods, the lateral control of vehicles only aims to optimize the current offset or the offset of a certain position, and cannot take into account the overall error in the future, resulting in low control accuracy and the vehicle formation is prone to overshoot and swing.
[0009] The above defects will cause the vehicles in platoon driving to be unable to accurately follow the trajectory of the reference target vehicle, and unable to use the smaller lane changing gaps in high-density traffic environments to achieve coordinated lane changing of the intelligent connected fleet. Summary of the invention
[0010] The purpose of the present invention is to overcome the defects of the above-mentioned prior art and to provide a plug-in cooperative lane changing control method for an intelligent connected fleet, so that the fleet can complete the lane changing of the fleet using a smaller lane changing gap in a high-density traffic environment, thereby effectively improving the lane changing ability and lane changing efficiency of the fleet in a high-density traffic environment.
[0011] The purpose of the present invention can be achieved by the following technical solution: A plug-in cooperative lane change control method for an intelligent networked vehicle fleet, comprising the following steps:
[0012] S1. Select the initial reference coordinate system for the lane changing of the formation according to different lane changing scenarios;
[0013] S2, the central controller collects the information of the controlled vehicles and the reference coordinate origin in the intelligent networked fleet, and initiates a communication connection between the controlled vehicles and the central controller. If the communication connection fails, execute step S3, otherwise execute step S4;
[0014] S3, if data packet loss occurs, the central controller reads the previous information from the database as the current controlled vehicle information, and then executes step S4;
[0015] S4, saving the information of all controlled vehicles in the fleet to the database;
[0016] S5. The central controller makes behavior decisions, speed decisions, and lane change decisions for the controlled convoy based on the information of each controlled vehicle and vehicles around the convoy, generates corresponding decision commands, and saves the decision command information to the database;
[0017] S6. Establishing a rearward following information topology structure during the lane changing process. The controlled vehicle aims to follow the rear vehicle and uses the state of the adjacent rear vehicle in the convoy as a reference state. The rearward following information topology structure is used to insert and expand a small gap, thereby creating space for the convoy to change lanes.
[0018] S7, the central controller receives the decision control command generated in step S5, and takes corresponding speed decision and motion control command according to the behavior instruction;
[0019] In the lane-changing process, the backward following information topology structure established in step S6 is used to optimize the acceleration, braking and steering processes of each controlled vehicle in the time domain according to the information of each controlled vehicle, and the optimized control instructions are transmitted to the power system, braking system and steering system of each controlled vehicle, and the optimized state information is saved in the database;
[0020] S8. The power system, braking system and steering system of each controlled vehicle correspondingly execute the optimized control instructions generated in step S7 to complete the coordinated lane change.
[0021] Furthermore, in the step S1, the initial reference coordinate system of the formation lane change includes a lateral relative reference coordinate system and a longitudinal relative reference coordinate system. The initial reference coordinate system does not need to be fixed throughout the formation operation, but only needs to be clarified during the lane change process;
[0022] For the scenario of coordinated lane change of a convoy at a fixed position on the road, the fixed position on the road is taken as the origin of the longitudinal coordinate, and the direction along the road is taken as the longitudinal positive direction;
[0023] For the scenario of changing lanes at a fixed position in the traffic flow, such as using a traversable gap in front of a vehicle in the traffic flow to change lanes, the position of the vehicle is used as the origin of the longitudinal coordinate, and the positive direction is along the road direction;
[0024] The coordinate origin of the lateral control is uniformly set to the left edge of the road, and the direction perpendicular to the road direction pointing to the right is the positive direction of the lateral coordinate system.
[0025] Furthermore, in step S2, the controlled vehicle information collected by the central controller includes: the longitudinal position, lateral position, yaw angle, vehicle speed, steering wheel angle, acceleration, wheelbase, and front wheel angle of the road coordinate system; the vehicle speed of the longitudinal control reference object and the longitudinal position in the road coordinate system.
[0026] Furthermore, the step S5 specifically includes the following steps:
[0027] S51, in the behavior decision part, the central controller makes decisions on the state of the controlled fleet, including cruising, following and lane changing states;
[0028] S52, in the speed decision part, the central controller makes a decision on the reference speed of the fleet;
[0029] S53. In the lane-changing decision section, the central controller makes lane-changing decisions for the controlled vehicles in the fleet, including finding a lane-changing gap and making lane changes.
[0030] Furthermore, the step S51 specifically includes the following steps:
[0031] S511, tracking the global path, if the convoy faces a mandatory lane change requirement, the convoy enters a lane change state; if the mandatory lane change requirement is not met, executing step S512;
[0032] S512: If there is a vehicle ahead of the convoy and the convoy faces a random lane change requirement, the convoy enters a lane change state; otherwise, step S513 is executed;
[0033] S513: If there is a vehicle ahead of the convoy, the convoy enters a following state; if there is no vehicle ahead of the convoy, the convoy enters a cruising state.
[0034] Furthermore, the step S52 specifically includes the following steps:
[0035] S521. When the convoy is in cruising state, the reference speed of the convoy is:
[0036]
[0037] in, is the expected speed of the convoy;
[0038] S522. When the convoy is in the following state, the reference speed of the convoy is:
[0039]
[0040] in, is the speed of the front vehicle in the convoy;
[0041] S523. When the convoy is in the state of searching for a lane-changing gap, if the convoy faces a random lane-changing demand, the convoy reference speed is:
[0042]
[0043] If the convoy faces a mandatory lane change requirement, the convoy reference speed is:
[0044]
[0045] in, is the expected speed difference during the gap search process;
[0046] S524. When the convoy is in the lane-changing state, the convoy reference speed is:
[0047]
[0048] in, is the speed of the preceding vehicle during the lane change gap, is the expected speed difference during the lane change gap expansion process.
[0049] Furthermore, the step S53 specifically includes the following steps:
[0050] S531. Calculate the safe lane-changing distance between the vehicle behind the lane-changing gap and the controlled vehicle:
[0051]
[0052] in, is the human driving reaction time, t b For braking delay, is the speed of the vehicle behind the lane change gap, v is the speed of the controlled vehicle, a min is the maximum deceleration of the vehicle;
[0053] Then calculate the safe lane-changing distance between the front vehicle and the controlled vehicle:
[0054]
[0055] in, The response time of intelligent connected vehicles. is the speed of the preceding vehicle during the lane change gap;
[0056] S532, compare the actual distance between the controlled vehicle and the vehicle behind and ahead of the lane change gap with the corresponding safe lane change distance. If the actual distance between the controlled vehicle and the vehicle behind and ahead of the lane change gap is satisfied at the same time, and the actual distance between the controlled vehicle and the vehicle ahead during the lane change gap The controlled vehicle takes lane-changing measures under the current lane-changing gap conditions.
[0057] Furthermore, the step S6 specifically includes the following steps:
[0058] S61, selecting a lane change gap in the target lane;
[0059] S62: Manipulate the last controlled vehicle in the convoy to take lane-changing measures and enter the lane-changing gap;
[0060] S63, reduce the speed of the last controlled vehicle in the convoy to expand the lane-changing gap;
[0061] S64, manipulate the convoy to successively take lane-changing measures from the last to the first controlled vehicle;
[0062] S65. If another vehicle cuts in, the cutting-in vehicle is regarded as the preceding vehicle in the lane-changing gap;
[0063] S66. Continue to manipulate the controlled vehicles to take lane-changing measures until all controlled vehicles in the convoy complete the lane-changing.
[0064] Furthermore, in step S7, the state information of the controlled vehicles in the fleet includes speed, position, heading, and time, and the control information includes acceleration and front wheel deflection angle;
[0065] The specific process of optimizing the acceleration, braking and steering process of each controlled vehicle is as follows:
[0066] S71. Calculate the initial state vector of the fleet consisting of n controlled vehicles:
[0067]
[0068]
[0069] Among them, φ x,n is the longitudinal state vector of the convoy, φ y,n is the lateral state vector of the convoy, v j is the speed of the jth controlled vehicle, v j -v j+1 is the relative speed between the jth controlled vehicle and the j+1th controlled vehicle, x j is the longitudinal position of the jth controlled vehicle, x j -x j+1 is the relative longitudinal position between the jth controlled vehicle and the j+1th controlled vehicle, g d is the expected following distance, is the heading angle error of the jth controlled vehicle relative to the road direction, y j is the lateral position of the jth controlled vehicle, is the desired lateral position of the jth controlled vehicle;
[0070] The initial control vector of the convoy is:
[0071]
[0072]
[0073] Among them, u x,n is the longitudinal control vector of the convoy, u y,n is the lateral control vector of the convoy, a j is the acceleration of the jth controlled vehicle, is the front wheel deflection angle of the vehicle;
[0074] S72. Calculate the state update equation coefficient matrix:
[0075]
[0076]
[0077]
[0078]
[0079]
[0080]
[0081] Among them, A x,n , B x,n , C x,n is the coefficient matrix of the longitudinal state update equation, A y,n , B y,n , C y,n is the coefficient matrix of the lateral state update equation, d t is the time domain step of vehicle control, I is the identity matrix, v is the vehicle speed, L fr is the wheelbase of the vehicle, k is the road curvature;
[0082] S73, calculate the cost function matrix:
[0083]
[0084]
[0085]
[0086]
[0087] Among them, Q x,n , R x,n is the vertical control cost function matrix, Q y,n , R y,n is the lateral control cost function matrix, q v ,q g , r a ,q θ ,q y , r σ All are positive numbers, and the specific debugging is selected according to the control preference during vehicle control;
[0088] S74. Define the adjoint matrix of the final state
[0089] S75, reverse calculation of adjoint matrix;
[0090] S76. Calculate the control vector and state vector forward.
[0091] Furthermore, the step S75 specifically includes the following steps:
[0092] S751, calculate separately:
[0093]
[0094]
[0095]
[0096]
[0097]
[0098] S752, calculate the cost function fitting matrix in, is the expected state quantity;
[0099] S753, calculate separately:
[0100]
[0101]
[0102] in, is the adjoint matrix of the cost function matrix, The adjoint matrix of the cost function fitting matrix.
[0103] Furthermore, the step S76 specifically includes the following steps:
[0104] S761. According to the Pontryagin maximum principle, the control vector and state vector are calculated:
[0105]
[0106]
[0107] S762, if u i >u max , then u i =u max ;
[0108] If u i <u min , then u i =u min ;
[0109] Among them, u max and u minare the maximum and minimum values of the control quantity, u i is the control quantity calculated iteratively in the i-th step;
[0110] S763, if φ i >φ max , then φ i =φ max ;
[0111] If φ i <φ min , then φ i =φ min ;
[0112] Among them, φ max and φ min are the maximum and minimum values of the state quantity, respectively, i The state quantity calculated for the i-th step iteration.
[0113] Compared with the prior art, the present invention obtains the running status of the vehicles by collecting information of the controlled vehicles in the fleet and the vehicles around the fleet in the coordinate system, and then makes decisions from the three parts of vehicle behavior, fleet speed and vehicle lane change, and generates corresponding decision commands; then, based on the decision command, the rear-following fleet information topology structure is adopted, and the longitudinal and lateral errors of the controlled vehicles in the future period of time are comprehensively considered, and the longitudinal and lateral driving behaviors are optimized in the time domain, and then the acceleration, braking and steering processes of each controlled vehicle are optimized and controlled, and finally the control results are output to the power system, braking system and steering system of the controlled vehicle to realize the coordinated lane change control process. In the present invention, the fleet can realize plug-in coordinated lane change, so that the fleet can complete the lane change of the fleet in a high-density traffic environment with a smaller lane change gap, which greatly improves the lane change ability and efficiency of the fleet in a high-density traffic environment, and improves the mobility of the fleet in the traffic flow.
[0114] The present invention takes into account the errors of the vehicle in the future within the time domain, which can effectively improve the optimization control accuracy of the vehicle in the current state, so that the vehicles in platoon driving can accurately follow the trajectory of the reference target vehicle; the control algorithm performance in the present invention has excellent reliability and robustness, and can still be applied even in traffic congestion, and can ensure the stability of the intelligent connected vehicle fleet, has the computing efficiency of the engineering application level, and can reduce the computing load. BRIEF DESCRIPTION OF THE DRAWINGS
[0115] Figure 1 It is a schematic diagram of the method flow of the present invention. DETAILED DESCRIPTION
[0116] The present invention is described in detail below with reference to the accompanying drawings and specific embodiments.
[0117] Example
[0118] like Figure 1 As shown, a plug-in cooperative lane-changing control method for an intelligent connected vehicle fleet includes the following steps:
[0119] S1. Select the initial reference coordinate system for the lane changing of the formation according to different lane changing scenarios;
[0120] S2, the central controller collects the information of the controlled vehicles and the reference coordinate origin in the intelligent networked fleet, and initiates a communication connection between the controlled vehicles and the central controller. If the communication connection fails, execute step S3, otherwise execute step S4;
[0121] S3, if data packet loss occurs, the central controller reads the previous information from the database as the current controlled vehicle information, and then executes step S4;
[0122] S4, saving the information of all controlled vehicles in the fleet to the database;
[0123] S5. The central controller makes behavior decisions, speed decisions, and lane change decisions for the controlled convoy based on the information of each controlled vehicle and vehicles around the convoy, generates corresponding decision commands, and saves the decision command information to the database;
[0124] S6. Establishing a rearward following information topology structure during the lane changing process. The controlled vehicle aims to follow the rear vehicle and uses the state of the adjacent rear vehicle in the convoy as a reference state. The rearward following information topology structure is used to insert and expand a small gap, thereby creating space for the convoy to change lanes.
[0125] S7, the central controller receives the decision control command generated in step S5, and takes corresponding speed decision and motion control command according to the behavior instruction;
[0126] In the lane-changing process, the backward following information topology structure established in step S6 is used to optimize the acceleration, braking and steering processes of each controlled vehicle in the time domain according to the information of each controlled vehicle, and the optimized control instructions are transmitted to the power system, braking system and steering system of each controlled vehicle, and the optimized state information is saved in the database;
[0127] S8. The power system, braking system and steering system of each controlled vehicle correspondingly execute the optimized control instructions generated in step S7 to complete the coordinated lane change.
[0128] This embodiment applies the above technical solution, which mainly includes the following contents:
[0129] Step 1: According to different lane-changing scenarios, select the initial reference coordinate system for the formation lane-changing.
[0130] In step 1, the reference coordinate system does not need to be fixed throughout the formation operation, but only needs to be clarified during the lane changing process. The horizontal and vertical directions can have different relative reference systems, and the origin of the relative reference system can be any stationary or moving point. For the scenario of coordinated lane changing of the convoy at a fixed position on the road, the position is used as the origin of the longitudinal coordinate, and the positive longitudinal direction is along the road direction; for the scenario of changing lanes at a fixed position in the traffic flow, such as using the gap in front of a vehicle in the traffic flow to change lanes, the position of the vehicle is used as the origin of the longitudinal coordinate, and the positive longitudinal direction is along the road direction. The coordinate origin of the lateral control is uniformly set to the left edge of the road, and the direction perpendicular to the road direction pointing to the right is the positive direction of the lateral coordinate system.
[0131] Step 2: The central controller collects information about the controlled vehicles and the reference coordinate origin in the intelligent networked fleet, and the controlled vehicles communicate with the central controller. If the communication fails, go to step 3, otherwise, go to step 4.
[0132] In step 2, the information of each controlled vehicle collected by the central controller includes: the longitudinal position, lateral position, yaw angle, vehicle speed, steering wheel angle, acceleration, wheelbase, and front wheel angle of the road coordinate system; it also includes the vehicle speed of the longitudinal control reference object and the longitudinal position in the road coordinate system.
[0133] In order to collect this information, the vehicle to which the present invention is applied should have: a vehicle information collection device, a communication device, a vehicle database, and a central controller placed on any vehicle in the fleet.
[0134] In the present invention, the control device of the controlled vehicle is connected to the power system, the braking system and the steering system of the controlled vehicle.
[0135] Step 3: If data packet loss occurs, the central controller reads the previous information from the database and regards it as the current controlled vehicle information, and then proceeds to step 4.
[0136] Step 4: Save the information of all controlled vehicles in the fleet to the database.
[0137] Step 5: The central controller makes behavior decisions, speed decisions, and lane change decisions for the controlled fleet based on the information of each controlled vehicle and the vehicles around the fleet, generates corresponding decision commands, and saves the decision command information to the database.
[0138] In step 5, decisions are made based on vehicle behavior, convoy speed, and vehicle lane change, and corresponding decision commands are generated, including the following steps:
[0139] Step 5.1: In the behavior decision part, the central controller makes decisions on the state of the controlled fleet, including cruising, following, and lane changing;
[0140] Specifically, the central controller's decision-making process for the controlled fleet status (cruising, following, lane changing) is as follows:
[0141] Step 5.1.1: Track the global path. If the team faces a mandatory lane change requirement (such as ramps, turns, etc.), the team enters the lane change state. If the mandatory lane change requirement is not met, the team proceeds to step 5.1.2 for decision making.
[0142] Step 5.1.2: If there is a vehicle ahead of the convoy and the convoy faces a random lane change demand (such as being blocked by a slow-moving vehicle, etc.), the convoy enters the lane change state; if the above conditions are not met, proceed to step 5.1.3 for decision making;
[0143] Step 5.1.3: If there is a vehicle in front of the convoy, the convoy enters the following state; if there is no vehicle in front of the convoy, the convoy enters the cruising state.
[0144] Step 5.2: In the speed decision part, the central controller makes a decision on the reference speed of the fleet;
[0145] Specifically, the decision calculation process of the reference speed of the fleet is:
[0146] Step 5.2.1: When the convoy is in cruising state, the reference speed of the convoy is in is the desired speed of the convoy;
[0147] Step 5.2.2: When the convoy is in the following state, the convoy reference speed is in is the speed of the front car in the convoy;
[0148] Step 5.2.3: When the convoy is in the state of searching for a lane-changing gap, if the convoy faces a random lane-changing demand (such as being blocked by slow-moving vehicles, etc.), the convoy reference speed is If the fleet faces a mandatory lane change requirement (such as the requirement to follow the global path such as ramps and turns), the fleet reference speed is in is the expected velocity difference during the gap search;
[0149] Step 5.2.4: When the convoy is in the lane-changing state, the convoy reference speed is in is the speed of the preceding vehicle during the lane change gap, is the expected speed difference during the lane change gap expansion process.
[0150] Step 5.3: In the lane change decision part, the central controller makes a lane change decision for the controlled vehicles in the fleet, including finding a lane change gap and making a lane change;
[0151] Specifically, the decision-making process of the controlled vehicles in the convoy to change lanes is:
[0152] Step 5.3.1: Calculate the safe lane-changing distance between the rear vehicle and the controlled vehicle:
[0153]
[0154] in, is the human driving reaction time, t b For braking delay, is the speed of the vehicle behind the lane change gap, v is the speed of the controlled vehicle, a min is the maximum deceleration of the vehicle;
[0155] Calculate the safe lane-changing distance between the front vehicle and the controlled vehicle:
[0156]
[0157] in, The response time of intelligent connected vehicles. is the speed of the preceding vehicle during the lane change gap;
[0158] Step 5.3.2: Compare the actual distance between the controlled vehicle and the vehicle behind and ahead of the lane change gap with the corresponding safe lane change distance. If both the actual distance between the controlled vehicle and the vehicle behind and ahead of the lane change gap are satisfied, and the actual distance between the controlled vehicle and the vehicle ahead during the lane change gap The controlled vehicle takes lane-changing measures under the current lane-changing gap conditions.
[0159] Step 6: Establish the information topology structure of the rearward following in the lane changing process. The controlled vehicle aims to follow the rear vehicle and uses the state of the rear vehicle in the platoon as the reference state. This information topology structure can achieve the purpose of inserting and expanding the small gap to create space for the platoon lane changing.
[0160] In step 6, based on the information topology structure of the backward following, the specific process of the fleet taking the insertion coordinated lane change is as follows:
[0161] Step 6.1, selecting a lane change gap in the target lane;
[0162] Step 6.2: Manipulate the last controlled vehicle in the convoy to take lane-changing measures and enter the lane-changing gap;
[0163] Step 6.3, reducing the speed of the last controlled vehicle in the convoy to expand the lane-changing gap;
[0164] Step 6.4, the convoy is operated to successively take lane-changing measures from the last vehicle to the first controlled vehicle;
[0165] Step 6.5: If another vehicle cuts in, the cutting vehicle is regarded as the preceding vehicle in the lane change gap;
[0166] Step 6.6: Continue to manipulate the controlled vehicles to take lane-changing measures until all controlled vehicles in the convoy complete the lane-changing.
[0167] Step 7: The central controller receives the decision control command generated in step 5, and takes the corresponding speed decision and motion control command according to the behavior command. In the lane changing process, the information topology structure of the backward following established in step 6 is used to optimize the acceleration, braking and steering process of each controlled vehicle in the time domain according to the information of each controlled vehicle, and the optimized control command is transmitted to the power system, braking system and steering system of each controlled vehicle, and the optimized state information is saved in the database.
[0168] In step 7, the state information of the controlled vehicles in the convoy includes speed, position, heading, and time, and the control information includes acceleration and front wheel deflection angle; the contents of optimizing the acceleration, braking, and steering processes of each controlled vehicle include:
[0169] Step 7.1: Calculate the initial state vector of the fleet consisting of n controlled vehicles:
[0170]
[0171]
[0172] where φ x,n is the longitudinal state vector of the convoy, φ y,n is the lateral state vector of the convoy, v j is the speed of the jth controlled vehicle, in m / s; v j -v j+1 is the relative speed between the jth controlled vehicle and the j+1th controlled vehicle, in m / s; x j is the longitudinal position of the jth controlled vehicle, in m; x j -x j+1 is the relative longitudinal position between the jth controlled vehicle and the j+1th controlled vehicle, in meters; g d is the expected following distance, in meters; is the heading angle error of the jth controlled vehicle relative to the road direction, in rad; y j is the lateral position of the jth controlled vehicle, in meters; is the desired lateral position of the jth controlled vehicle, in meters. The initial control vector of the platoon is where u x,n is the longitudinal control vector of the convoy, u y,n is the lateral control vector of the convoy, a j is the acceleration of the jth controlled vehicle, in m / s 2 ; is the front wheel deflection angle of the vehicle, in rad;
[0173] Step 7.2, calculate the state update equation coefficient matrix:
[0174]
[0175]
[0176]
[0177]
[0178]
[0179]
[0180] Among them, A x,n , B x,n , C x,n is the coefficient matrix of the longitudinal state update equation; A y,n , B y,n , C y,n is the coefficient matrix of the lateral state update equation; d t is the time domain step of vehicle control, in seconds; I is the unit matrix; v is the vehicle speed, in m / s; L fr is the wheelbase of the vehicle, in meters; k is the road curvature;
[0181] Step 7.3, calculate the cost function matrix:
[0182]
[0183]
[0184]
[0185]
[0186] Where Q x,n , R x,n is the vertical control cost function matrix, Q y,n , R y,n is the lateral control cost function matrix, q v ,q g , r a , q y , r δ It is a positive number, and can be selected for debugging according to the control preference during vehicle control;
[0187] Step 7.4: Define the adjoint matrix of the final state
[0188] Step 7.5, inversely calculate the adjoint matrix;
[0189] In step 7.5, the inverse calculation of the adjoint matrix includes the following steps:
[0190] Step 7.5.1, calculate four matrices:
[0191]
[0192]
[0193]
[0194]
[0195]
[0196] Step 7.5.2. Calculate the cost function fitting matrix in, is the expected state quantity;
[0197] Step 7.5.3, calculate the corresponding two adjoint matrices:
[0198] Step 7.6: Calculate the control vector and state vector forward.
[0199] In step 7.6, the forward calculation of the control vector and the state vector includes the following steps:
[0200] Step 7.6.1. Calculate the control vector and state vector according to the Pontryagin maximum principle:
[0201]
[0202]
[0203] Step 7.6.2, if u i >u max , then u i =u max ; if u i <u min , then u i =u min ; Among them, umax and u min are the maximum and minimum values of the control quantity, u i is the control quantity calculated iteratively in the i-th step;
[0204] Step 7.6.3, if φ i >φ max , then φ i =φ max ; if φ i <φ min , then φ i =φ min ; where φ max and φ min are the maximum and minimum values of the state quantity, respectively, i The state quantity calculated for the i-th step iteration.
[0205] Step 8: The power system, braking system and steering system of each controlled vehicle execute the optimized control instructions in step 7, and then return to step 2 or stop the coordinated lane change control process.
[0206] It should be noted that in this technical solution, if the control step is set to 0.1 second, it is necessary to determine a control amount every 0.1 second, so d t =0.1s;
[0207] Fleet reference speed calculation Parameters can be set automatically based on actual needs, and based on experience, It can increase the probability of successful lane change gap search during forced lane change and improve The speed of expanding the lane-changing gap can be increased. Take it as 3m / s;
[0208] q in the cost function matrix v ,q g , r a , q y , r δ Parameters are set automatically according to actual needs, and based on experience, q is improved. v ,q g , q y size, which is conducive to the vehicle quickly reaching the control target and improving r a and r δ , which is beneficial to reduce vehicle control oscillation.
[0209] In summary, this technical solution aims at the problem of insufficient lane-changing space for convoys in high-density traffic environments, and proposes a space-making intelligent networked convoy collaborative lane-changing method. By collecting information about controlled vehicles in the convoy and vehicles around the convoy, the convoy information topology of rearward following is adopted, and decisions are made from three parts: vehicle behavior, convoy speed, and vehicle lane-changing. The longitudinal and lateral driving behaviors are optimized in the time domain, that is, based on the corresponding decision commands, the convoy information topology of rearward following is adopted, and the adjacent rear vehicles in the convoy are used as reference targets. The controlled vehicles in the convoy are coordinated and controlled to follow the reference target trajectory. Combined with the information of the controlled vehicles and the reference target information, the acceleration, braking, and steering processes of the controlled vehicles in the convoy are optimized by comprehensively considering the errors in the front for a period of time, under the constraints of safe following, comfortable acceleration and deceleration, speed threshold, etc., and the optimization control principle is used to optimize the acceleration, braking, and steering processes of the controlled vehicles in the convoy, and the optimization results are transmitted to the power device, braking device, and steering device of the controlled vehicles. As a result, the convoy can use the smaller lane-changing gap in the high-density traffic environment to complete the lane-changing of the convoy, thereby greatly improving the mobility of the convoy in the actual traffic flow. This technical solution considers the error of the vehicle in the future in the time domain, thereby improving the optimization control accuracy of the vehicle in the current state. The control algorithm performance of this technical solution is reliable and robust, can ensure the stability of the intelligent networked fleet, has engineering application level computing efficiency, and can reduce the computing load.
Claims
1. A plug-in cooperative lane-changing control method for an intelligent networked vehicle fleet, characterized in that: The following steps are involved: S1. Select the initial reference coordinate system for the lane changing of the formation according to different lane changing scenarios; S2, the central controller collects the information of the controlled vehicles and the reference coordinate origin in the intelligent networked fleet, and initiates a communication connection between the controlled vehicles and the central controller. If the communication connection fails, execute step S3, otherwise execute step S4; S3, if data packet loss occurs, the central controller reads the previous information from the database as the current controlled vehicle information, and then executes step S4; S4, saving the information of all controlled vehicles in the fleet to the database; S5. The central controller makes behavior decisions, speed decisions, and lane change decisions for the controlled convoy based on the information of each controlled vehicle and vehicles around the convoy, generates corresponding decision commands, and saves the decision command information to the database; S6. Establishing a rearward following information topology structure during the lane changing process. The controlled vehicle aims to follow the rear vehicle and uses the state of the adjacent rear vehicle in the convoy as a reference state. The rearward following information topology structure is used to insert and expand a small gap, thereby creating space for the convoy to change lanes. S7, the central controller receives the decision control command generated in step S5, and takes corresponding speed decision and motion control command according to the behavior instruction; In the lane-changing process, the backward following information topology structure established in step S6 is used to optimize the acceleration, braking and steering processes of each controlled vehicle in the time domain according to the information of each controlled vehicle, and the optimized control instructions are transmitted to the power system, braking system and steering system of each controlled vehicle, and the optimized state information is saved in the database; S8, the power system, braking system and steering system of each controlled vehicle correspondingly execute the optimized control instructions generated in step S7 to complete the coordinated lane change; In step S1, the initial reference coordinate system of the formation lane change includes a lateral relative reference coordinate system and a longitudinal relative reference coordinate system. The initial reference coordinate system does not need to be fixed throughout the formation operation, but only needs to be clarified during the lane change process; For the scenario of coordinated lane change of a convoy at a fixed position on the road, the fixed position on the road is taken as the origin of the longitudinal coordinate, and the direction along the road is taken as the longitudinal positive direction; For the scenario of changing lanes at a fixed position in the traffic flow, such as using a traversable gap in front of a vehicle in the traffic flow to change lanes, the position of the vehicle is used as the origin of the longitudinal coordinate, and the positive direction is along the road direction; The coordinate origin of the lateral control is uniformly set to the left edge of the road, and the direction perpendicular to the road direction pointing to the right is the positive direction of the lateral coordinate system; In step S2, the controlled vehicle information collected by the central controller includes: longitudinal position, lateral position, yaw angle of the road coordinate system, vehicle speed, steering wheel angle, acceleration, wheelbase, and front wheel angle; The longitudinal control refers to the vehicle speed and longitudinal position of the reference object in the road coordinate system.
2. The plug-in cooperative lane-changing control method for an intelligent networked vehicle fleet according to claim 1, characterized in that: The step S5 specifically comprises the following steps: S51, in the behavior decision part, the central controller makes decisions on the state of the controlled fleet, including cruising, following and lane changing states; S52, in the speed decision part, the central controller makes a decision on the reference speed of the fleet; S53. In the lane-changing decision section, the central controller makes lane-changing decisions for the controlled vehicles in the fleet, including finding a lane-changing gap and making lane changes.
3. The plug-in cooperative lane-changing control method for an intelligent networked vehicle fleet according to claim 2, characterized in that: The step S51 specifically includes the following steps: S511, tracking the global path, if the convoy faces a mandatory lane change requirement, the convoy enters a lane change state; if the mandatory lane change requirement is not met, executing step S512; S512: If there is a vehicle ahead of the convoy and the convoy faces a random lane change requirement, the convoy enters a lane change state; otherwise, step S513 is executed; S513: If there is a vehicle ahead of the convoy, the convoy enters a following state; if there is no vehicle ahead of the convoy, the convoy enters a cruising state.
4. The plug-in cooperative lane-changing control method for an intelligent networked vehicle fleet according to claim 2, characterized in that: The step S52 specifically includes the following steps: S521. When the convoy is in cruising state, the reference speed of the convoy is: in, is the expected speed of the convoy; S522. When the convoy is in the following state, the reference speed of the convoy is: in, is the speed of the front vehicle in the convoy; S523. When the convoy is in the state of searching for a lane-changing gap, if the convoy faces a random lane-changing demand, the convoy reference speed is: If the convoy faces a mandatory lane change requirement, the convoy reference speed is: in, is the expected speed difference during the gap search process; S524. When the convoy is in the lane-changing state, the convoy reference speed is: in, is the speed of the preceding vehicle during the lane change gap, is the expected speed difference during the lane change gap expansion process.
5. The plug-in cooperative lane-changing control method for an intelligent network-connected vehicle fleet according to claim 4, characterized in that: The step S53 specifically includes the following steps: S531. Calculate the safe lane-changing distance between the vehicle behind the lane-changing gap and the controlled vehicle: in, is the human driving reaction time, t b For braking delay, is the speed of the vehicle behind the lane change gap, v is the speed of the controlled vehicle, a min is the maximum deceleration of the vehicle; Then calculate the safe lane-changing distance between the front vehicle and the controlled vehicle: in, The response time of intelligent connected vehicles. is the speed of the preceding vehicle during the lane change gap; S532, compare the actual distance between the controlled vehicle and the vehicle behind and ahead of the lane change gap with the corresponding safe lane change distance. If the actual distance between the controlled vehicle and the vehicle behind and ahead of the lane change gap is satisfied at the same time, and the actual distance between the controlled vehicle and the vehicle ahead during the lane change gap The controlled vehicle takes lane-changing measures under the current lane-changing gap conditions.
6. The plug-in cooperative lane-changing control method for an intelligent connected vehicle fleet according to claim 1, characterized in that: The step S6 specifically comprises the following steps: S61, selecting a lane change gap in the target lane; S62: Manipulate the last controlled vehicle in the convoy to take lane-changing measures and enter the lane-changing gap; S63, reduce the speed of the last controlled vehicle in the convoy to expand the lane-changing gap; S64, manipulate the convoy to successively take lane-changing measures from the last to the first controlled vehicle; S65. If another vehicle cuts in, the cutting-in vehicle is regarded as the preceding vehicle in the lane-changing gap; S66. Continue to manipulate the controlled vehicles to take lane-changing measures until all controlled vehicles in the convoy complete the lane-changing.
