A collaborative control method for heterogeneous platoons of semi-trailer trains based on distributed model predictive control

Through the distributed model prediction control method, a single vehicle dynamic model and communication topology of semi-trailer trains were established, and a nonlinear spacing strategy was designed, which solved the safety braking and stability problems in the queue motion control of semi-trailer trains. It realizes robust collaborative control of heterogeneous queues of semi-trailer trains.

CN115469646BInactive Publication Date: 2024-11-05JILIN UNIVERSITY

Patent Information

Application Number
CN202211194532.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-09-28
Publication Date
2024-11-05
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

The prior art is difficult to effectively control the movement of the autonomous semi-trailer train queue, especially in heavy vehicle queues with large quality differences, it is difficult to ensure safe braking and vehicle spacing control in emergency situations, and lack of horizontal and vertical directions of the vehicle. Comprehensive consideration of speed and articulation angle.

Method used

Using distributed model prediction and control methods, a single vehicle dynamic model of semi-trailer trains is established, and a nonlinear spacing strategy based on the quality of the whole vehicle is designed, a communication topology structure is built, and a DMPC controller is designed to ensure the stability and safety of the queue. sex.

Benefits of technology

It realizes robust collaborative control of heterogeneous queues of semi-trailer trains, ensures safe braking and stability of the queue in emergency situations, and improves the accuracy and real-timeness of the controller.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115469646B_ABST
    Figure CN115469646B_ABST
Patent Text Reader

Abstract

The present invention relates to a motion cooperative control method of a heterogeneous queue of semi-trailer automobile trains based on distributed model predictive control (DMPC), and the main steps are as follows: S1: Establish a linear discrete dynamic model of a semi-trailer automobile train single vehicle and queue system; S2: Build a communication topology structure model that characterizes the communication relationship between vehicles in the heterogeneous queue; S3: Construct a nonlinear spacing control strategy based on the mass of the whole vehicle; S4: Design a cooperative controller of the heterogeneous queue of semi-trailer automobile trains based on the DMPC control method. The controller meets control objectives such as safety and vehicle following stability, and can simultaneously ensure the stability of single vehicles and queues. The present invention can effectively supplement the cooperative control method of large-scale automatic driving vehicle queues such as semi-trailer automobile trains, while ensuring that the queue has good vehicle following performance and economic benefits.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the fields of intelligent transportation and heavy vehicle platoon control, and in particular to a coordinated control method for a heterogeneous platoon of semi-trailer vehicle trains based on distributed model predictive control. Background Art

[0002] Since the 21st century, with the rapid development of social economy, semi-trailer trains have become an important means of transport in high-speed long-distance transportation. When semi-trailer trains travel in a queue, they can effectively reduce wind resistance, improve economic benefits and increase road traffic capacity. Therefore, solving and realizing the lateral and longitudinal motion control problems of semi-trailer train queues is of great significance for reducing transportation costs and improving road safety.

[0003] However, there are few studies on the motion control of autonomous semi-trailer train platoons. Among them, the single vehicle dynamics model is mostly built based on handling stability. This type of model has a high degree of freedom and is difficult to solve, and is not suitable for the prediction model in the platoon controller; secondly, the vehicle spacing control in the platoon is mainly based on the constant distance strategy, but this spacing strategy is difficult to ensure that all vehicles can achieve safe braking under emergency conditions for heavy vehicle platoons with large mass differences; finally, in the controller design, most of the research objects are intelligent networked small cars, and there are few studies on heterogeneous platoons of semi-trailer trains with different parameters such as total mass and braking capacity. In addition, the existing controller design lacks comprehensive consideration of the vehicle's lateral and longitudinal speeds and articulation angles in the actual movement of the vehicle train. Summary of the invention

[0004] Based on distributed model prediction, the present invention proposes a motion control method suitable for heterogeneous platoons of semi-trailer trains. The method is based on the dynamic model of a single vehicle, and at the same time designs a spacing control strategy that takes into account the total mass of the vehicle, builds a communication topology, and effectively realizes robust collaborative control of heterogeneous platoons of semi-trailer trains while ensuring the control objectives of stable and safe platoons.

[0005] The technical solution of the present invention:

[0006] A method for cooperative control of a heterogeneous platoon of semi-trailer vehicle trains based on distributed model predictive control comprises the following steps:

[0007] S1: Considering the real-time requirements of platoon control, a linear discrete dynamic model of the semi-trailer train and the platoon system is established, and used as a prediction model in the subsequent heterogeneous platoon controller;

[0008] S2: Design a directed graph, define the adjacency matrix and reachability matrix, and build a communication topology model that characterizes the communication relationship between vehicles in a heterogeneous platoon;

[0009] S3: Solve the real-time position relationship between the vehicle node and the front vehicle and the pilot vehicle in the queue, and consider the differences in vehicle braking capabilities to build a nonlinear spacing strategy based on the vehicle mass;

[0010] S4: Set the cost function and constraints of the rolling optimization problem, and design a collaborative controller for the heterogeneous platoon of semi-trailer trains based on the DMPC control method.

[0011] Preferably, the S1 comprises the following steps:

[0012] S1-1, establish the inertial coordinate system XOY and the body coordinate systems X1O1Y1 and X2O2Y2 of the tractor and semi-trailer;

[0013] S1-2. Establish a single vehicle dynamics model of a semi-trailer train;

[0014] S1-3, let v x2 =v x1 , rewrite the above differential equation into the form of state space, as shown in formula (11):

[0015] In the formula, the state variable Control quantity input u=σ, output quantity The coefficient matrix C is the identity matrix;

[0016] S1-4, approximate linearization and discretization of the semi-trailer train dynamics model;

[0017] S1-5. Construct a linear discrete dynamic model of the heterogeneous platoon system of semi-trailer trains.

[0018] Preferably, the S1-2 comprises the following steps:

[0019] The model includes the longitudinal velocity v of the tractor x1 , lateral speed v y1 , yaw rate Semi-trailer lateral speed v y2 and yaw rate There are five degrees of freedom in total;

[0020] At the same time, the following assumptions are made for the model: ① The vertical motion, roll motion, and pitch motion of the vehicle are not considered; ② The longitudinal speeds of the tractor and the semi-trailer are kept consistent; ③ The articulation angle Δγ at the articulation point of the vehicle is small during operation; ④ The vertical load changes of the left and right wheels during driving are not considered; ⑤ The influence of air resistance and road slope is ignored;

[0021] Establish the differential equations of motion of the tractor and semi-trailer regarding the longitudinal velocity, lateral velocity and yaw angular velocity:

[0022]

[0023]

[0024] Where: m1, m2 are the total mass of the tractor and semi-trailer; I 1ZZ ,I 2ZZ is the lateral moment of inertia of the tractor and semi-trailer; a1, b1, f are the distances from the center of mass of the tractor to its front axle, equivalent rear axle, and hinge point; a2, b2 are the distances from the center of mass of the semi-trailer to the hinge point and the equivalent rear axle of the semi-trailer; v x1 、v x2 is the longitudinal speed of the tractor and semi-trailer; v y1 、v y2 is the lateral speed of the tractor and semi-trailer; is the yaw angular velocity of the tractor and semitrailer, is the derivative of the corresponding yaw rate; F x1 (F y1 ), F x2 (F y2 ), F x3 (F y3 ) is the longitudinal force or lateral force on the front axle of the tractor, the equivalent rear axle of the tractor, and the equivalent rear axle of the semitrailer; F 1x (F 1y ), F 2x (F 2y ) is the longitudinal force or lateral force generated by the articulated mechanism on the tractor or semi-trailer;

[0025] The expressions of the lateral and longitudinal velocities of the tractor mass center in the inertial coordinate system XOY are shown in formula (3):

[0026]

[0027] In the design of the platoon controller, the speed at the center of mass of the tractor is defined as the speed of the semi-trailer train;

[0028] The constraint relationship between the tractor and the semi-trailer at the articulation point is shown in the following formula (4):

[0029]

[0030] Calculate the side slip angle a of each equivalent tire i (i=1, 2, 3) is shown in the following formula (5):

[0031]

[0032] Where, σ is the front wheel turning angle of the front axle of the tractor;

[0033] To simplify the model, the vehicle tire force F xi 、Fyi (i=1, 2, 3) are linearized. In summary, the following five nonlinear motion differential equations can be obtained, as shown in equations (6) to (10):

[0034]

[0035]

[0036]

[0037]

[0038]

[0039] In the formula, k1(k a1 )、k2(k a2 )、k3(k a3 ) is the longitudinal stiffness (cornering stiffness) of the front axle of the tractor, the front axle of the semitrailer, and the rear axle of the semitrailer, in N / rad;

[0040] The expression of coefficient A is:

[0041] Preferably, S1-4 comprises the following steps:

[0042] At the reference point At Expanding according to Taylor's formula, we get:

[0043]

[0044] definition get The expression of is shown in formula (13):

[0045]

[0046] Among them, matrices A and B are the Jacobian matrices of the differential equation for state variables and input control quantities;

[0047] The continuous state space equation of the semi-trailer train is approximately discretized as shown in the following equation (14):

[0048]

[0049] Among them A k,t =I+TA,B k,t =TB, T is the sampling time.

[0050] Preferably, the S1-5 comprises the following steps:

[0051] First, number the vehicles; let the leading vehicle in the queue be numbered 0, and the following vehicles be numbered 1, 2, ... N, that is, the total number of vehicles in the queue is N+1;

[0052] Define the state variable sequence of all vehicles in the queue as The control sequence is The output is Then the linear discrete dynamic model of the heterogeneous platoon system of semi-trailer trains is as shown in the following formula (15):

[0053]

[0054] In the formula Ψ(k)=diag{B0…B N Preferably, the steps of constructing the communication topology model of the heterogeneous queue of semi-trailer trains in step S2 are as follows:

[0055] S2-1. The semi-trailer train heterogeneous platoon adopts the PLF structure of the front vehicle-pilot vehicle following communication topology, that is, the vehicles in the platoon receive the real-time motion information of the adjacent vehicles in front and the platoon leader vehicle, and perform following control;

[0056] S2-2, construct a directed graph G = {V, E} to express the communication relationship between vehicles in the queue; where V = {0, 1, 2, ... N} is a set of vehicle nodes, including the pilot vehicle; It is a set of directional connection edges between vehicles, indicating the directional passability of information flow from vehicle nodes to other nodes;

[0057] S2-3, construct the adjacency matrix H = [h ij ]∈R (N+1)×(N+1) To characterize the information flow between vehicles and other nodes, the expression is shown in the following formula (16):

[0058]

[0059] When j,i∈E, i.e. j→i, vehicle node i can receive the motion information of node j; otherwise, it cannot; then the adjacency matrix expression corresponding to the PLF communication topology structure is shown in the following formula (17):

[0060]

[0061] S2-4, construct the reachable matrix P = diag{p1,p2,p3…p N} is used to characterize the communication relationship between the platoon leader and the following vehicles; the expression is shown in the following formula (18):

[0062]

[0063] pi =1, vehicle node i can receive real-time information from the pilot vehicle; otherwise, it cannot; then the reachable matrix expression corresponding to the PLF communication topology structure is P=diag{1…1}.

[0064] Preferably, the steps of formulating a variable spacing strategy based on the total weight of the semi-trailer train in step S3 are as follows:

[0065] S3-1, establish the actual distance between vehicle node i and the preceding vehicle and the pilot vehicle;

[0066] S3-2. Considering the differences in the total mass of vehicles in the queue, in order to ensure the stability of the queue under emergency braking conditions and the safe braking of all vehicles, the established nonlinear spacing strategy is as follows (21):

[0067] S i,des =w i ×v x1,i t (21)

[0068] In the formula, S i,des is the expected inter-vehicle distance to the preceding vehicle; v x1,i is the longitudinal speed of vehicle node i; t is the reference vehicle headway; w i is the proportionality coefficient, which is related to the total mass of the vehicle and is expressed as follows:

[0069]

[0070] Where, M is the reference total mass of the semi-trailer train;

[0071] Then the expected inter-vehicle distance between vehicle node i and the leading vehicle in the queue is as shown in equation (23):

[0072]

[0073] Preferably, step S3-1 comprises the following steps:

[0074] In the geodetic coordinate system XOY, the distance between vehicle node i and the preceding vehicle is defined as shown in the following equation (19):

[0075] In the formula, (X i ,Y i )、(X i-1 ,Y i-1 ) are the centroid coordinates of the tractor at vehicle node i and the front vehicle node i-1 respectively; the second term is the distance supplement considering the actual size of the vehicle, a 1,i is the actual size parameter of node i, a 2,i-1 、b 1,i-1 、b2,i-1 is the actual size parameter of node i-1;

[0076] The distance between vehicle node i and the pilot vehicle is defined as follows:

[0077]

[0078] Where (X0, Y0) is the coordinate of the center of mass of the pilot vehicle and the tractor; 1,0 、a 2,0 、b 2,0 The actual size parameters of the platoon leader vehicle.

[0079] Preferably, the steps of designing a distributed model predictive controller for a heterogeneous queue of semi-trailer trains in step S4 are as follows:

[0080] S4-1. Define the prediction time domain of the controller as N p , the control time domain is N c , and define the following sequence of variables:

[0081] ① Prediction variable sequence; Predict state variables; Predict input variables; Predict output variables;

[0082] ②Optimal variable sequence; Optimal state variables; Optimal input variables; Optimal output variables;

[0083] ③Assume variable sequence; Assume state variables; Assume input variables; Assume output variable;

[0084] S4-2, define the cost function in the distributed model predictive controller;

[0085] For vehicle node i, (i = 0, 1, 2, ... N), the cost function of the optimal control problem solved by distributed model predictive control is shown in equation (24):

[0086]

[0087] J 1,i (k|t), J 2,i (k|t) are the following error cost functions of the ego vehicle, the pilot vehicle, and the front vehicle in the platoon, respectively, and are expressed as follows:

[0088]

[0089]

[0090] In the formula, y 0des ,y i-1des is the expected output state of the pilot vehicle and vehicle node i-1; Q i 、M i is the error cost matrix; for the leading car in the queue, J 1,i (k|t)=J 2,i (k|t)=0;

[0091] J 3,i (k|t) is defined as the stability cost function; stability requires data integrity during inter-vehicle communication, reduces data packet loss, and makes the predicted output sequence consistent with the assumed output sequence. The expression is shown in the following formula (27):

[0092]

[0093] In the formula, F i is the stability cost matrix;

[0094] S4-3. Define constraints in the distributed model predictive controller;

[0095] S4-4. For vehicle node i in the heterogeneous queue of semi-trailer trains, at time t, its optimal control problem is expressed as the following equation (33):

[0096]

[0097] At the same time, equations (28) to (32) are satisfied.

[0098] S4-5. The steps for solving the distributed model predictive controller for the heterogeneous platoon of semi-trailer trains are as follows:

[0099] ①Initialize the vehicle motion state;

[0100] ② Solve the optimal control problem J i (t), the optimal input

[0101] ③Will The first variable in the sequence is input to the vehicle node;

[0102] ④ The end of the sequence is padded with 0 as the hypothetical input at time t+1;

[0103] ⑤ Output series based on the previous car assumption Solve for expected output

[0104] ⑥Let t=t+1, and return to step ②;

[0105] The optimal input and expected output sequence of each vehicle node during the entire operation process is calculated to ensure the dynamic stability of the single vehicle of the semi-trailer train, and finally realize the motion coordination control of the heterogeneous queue of the semi-trailer train. Preferably, in step S4-3, for vehicle node i, the constraint conditions for the DMPC controller to solve the optimal control problem are set as follows:

[0106] ① Following target: The vehicle maintains the same speed as the leading vehicle in the queue and maintains the desired inter-vehicle distance with the preceding vehicle and the leading vehicle. The following target can be expressed as the following formula (28):

[0107]

[0108] For the leading car in the platoon, this control objective does not exist in the controller design;

[0109] ② Stability target: Set the boundary value of the tractor's front wheel angle and its increment to ensure the stability of the vehicle's steering. The stability target is shown in the following formula (29):

[0110] δ min ≤u i (k|t)≤δ max ,Δδ min ≤Δu i (k|t)≤Δδ max (29)

[0111] In the formula, δ max , δ min are the upper and lower boundary values ​​of the controller input variable, Δδ max , Δδ min The upper and lower boundary values ​​of the input variable increment;

[0112] ③ Safety target: Set the boundary values ​​of the vehicle's lateral and longitudinal speeds, and add constraints to the articulation angle to avoid dangers such as vehicle folding; the safety target is shown in the following formula (30):

[0113]

[0114] In the formula, v x1,max 、v x1,min are the upper and lower boundary values ​​of the vehicle longitudinal speed; v y1,max (v y2,max ),v y1,min (v y2,min ) are the upper and lower boundary values ​​of the lateral speed of the tractor and semi-trailer; are the upper and lower boundary values ​​of the vehicle's articulation angular velocity;

[0115] The vehicle dynamics constraints are shown in equation (31):

[0116]

[0117] The initial state constraint is as shown in equation (32):

[0118]

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

[0120] 1) The present invention builds a dynamic model of a single vehicle of a semi-trailer train suitable for platoon control. The model does not consider complex degrees of freedom such as roll motion and wheel rotation, but only includes the lateral and longitudinal velocities in the platoon control objectives, as well as the articulation angle of the articulated device, thereby improving the accuracy and real-time performance of the platoon controller design.

[0121] 2) The present invention takes into account the impact of heterogeneous parameters in the queue on the stability of the queue and designs a spacing control strategy based on the total mass of individual vehicles. This strategy ensures that all vehicles in the queue can achieve effective braking in an emergency, thereby ensuring the stability of the queue.

[0122] 3) The present invention introduces a distributed model predictive control method into a heterogeneous queue of semi-trailer vehicle trains, sets the following performance and stability cost functions, and sets safety and stability constraints based on the actual movement conditions of the semi-trailer vehicle trains. This method can simultaneously ensure the dynamic stability of individual vehicles and the stability of the queue. BRIEF DESCRIPTION OF THE DRAWINGS

[0123] Figure 1 It is a flow chart of the motion control method of a heterogeneous queue of semi-trailer vehicle trains based on distributed model predictive control in the present invention.

[0124] Figure 2 It is a schematic diagram of a nonlinear five-degree-of-freedom dynamic model of a semi-trailer vehicle train in the present invention.

[0125] Figure 3 It is a schematic diagram of the communication topology structure of the heterogeneous queue of semi-trailer vehicle trains in the present invention.

[0126] Figure 4 It is a schematic diagram of the gap control strategy between vehicles in a heterogeneous queue of a semi-trailer train in the present invention.

[0127] Figure 5 It is a schematic diagram of vehicle node information flow in the distributed model predictive control system of the present invention. DETAILED DESCRIPTION

[0128] The present invention is described in detail below in conjunction with the embodiments and drawings. The protection scope of the present invention is not limited to the embodiments, and any changes made by those skilled in the art within the scope defined by the claims also fall within the protection scope of the present invention.

[0129] The present invention proposes a coordinated control method for heterogeneous platoons of semi-trailer vehicles based on distributed model predictive control. Figure 1-5 Further description of the invention:

[0130] Figure 1 It is a flow chart of the motion control method of a heterogeneous platoon of semi-trailer vehicle trains based on distributed model predictive control.

[0131] S1: Considering the real-time requirements of platoon control, a linear discrete dynamic model of the semi-trailer train and the platoon system is established, and used as a prediction model in the subsequent heterogeneous platoon controller;

[0132] S2: Design a directed graph, define the adjacency matrix and reachability matrix, and build a communication topology model that characterizes the communication relationship between vehicles in a heterogeneous platoon;

[0133] S3: Solve the real-time position relationship between the vehicle node and the front vehicle and the pilot vehicle in the queue, and consider the differences in vehicle braking capabilities to build a nonlinear spacing strategy based on the vehicle mass;

[0134] S4: Set the cost function and constraints of the rolling optimization problem, and design a collaborative controller for the heterogeneous platoon of semi-trailer trains based on the DMPC control method.

[0135] Step 1: Establish a five-degree-of-freedom dynamic model and a platoon system model for the semi-trailer train.

[0136] (1) Establish the inertial coordinate system XOY and the body coordinate systems X1O1Y1 and X2O2Y2 of the tractor and semi-trailer.

[0137] Geodetic coordinate system XOY: the forward direction of the semitrailer is the positive direction of the X-axis, and X rotated 90° counterclockwise is the positive direction of the Y-axis; tractor coordinate system X1O1Y1: the origin O1 is fixed to the center of mass of the tractor, the forward direction of the tractor is the positive direction of the X1 axis, and X1 rotated 90° counterclockwise is the positive direction of the Y1 axis; semitrailer coordinate system X2O2Y2: the origin O2 is fixed to the center of mass of the semitrailer, the forward direction of the semitrailer is the positive direction of the X2 axis, and X2 rotated 90° counterclockwise is the positive direction of the Y2 axis.

[0138] (2) Establish a single vehicle dynamics model of the semi-trailer train.

[0139] The model includes the longitudinal velocity v of the tractor x1 , lateral speed v y1 , yaw rate Semi-trailer lateral speed v y2 , yaw rate There are five degrees of freedom in total. At the same time, the following assumptions are made for the model: ① The vertical motion, roll motion, and pitch motion of the vehicle are not considered; ② The longitudinal speeds of the tractor and the semi-trailer are kept consistent; ③ The articulation angle Δγ at the vehicle articulation is small; ④ The vertical load changes of the left and right wheels during driving are not considered; ⑤ The influence of air resistance and road slope is ignored.

[0140] Establish the differential equations of motion of the tractor and semi-trailer regarding the longitudinal velocity, lateral velocity and yaw angular velocity:

[0141]

[0142]

[0143] Where: m1, m2 are the total mass of the tractor and semi-trailer; I 1ZZ ,I 2ZZ is the lateral moment of inertia of the tractor and semi-trailer; a1, b1, f are the distances from the center of mass of the tractor to its front axle, equivalent rear axle, and hinge point; a2, b2 are the distances from the center of mass of the semi-trailer to the hinge point and the equivalent rear axle of the semi-trailer; v x1 、v x2 is the longitudinal speed of the tractor and semi-trailer; v y1 、v y2 is the lateral speed of the tractor and semi-trailer; is the yaw angular velocity of the tractor and semitrailer, is the derivative of the corresponding yaw rate; F x1 (F y1 ), F x2 (F y2 ), F x3 (F y3 ) is the longitudinal force (lateral force) of the front axle of the tractor, the equivalent rear axle of the tractor and the equivalent rear axle of the semitrailer; F 1x (F 1y ), F 2x (F 2y ) is the longitudinal force (lateral force) generated by the articulated mechanism on the tractor and semi-trailer.

[0144] The lateral and longitudinal velocities of the tractor mass center in the inertial coordinate system XOY are shown in formula (3):

[0145]

[0146] In the design of the platoon controller, the speed at the center of mass of the tractor is defined as the speed of the entire semi-trailer train.

[0147] The constraint relationship between the tractor and the semi-trailer at the articulation point is shown in the following formula (4):

[0148]

[0149] Calculate the side slip angle a of each equivalent tire i (i=1, 2, 3) is shown in the following formula (5):

[0150]

[0151] To simplify the model, the vehicle tire force F xi 、F yi (i=1, 2, 3) are linearized. In summary, the following five nonlinear motion differential equations can be obtained, as shown in equations (6) to (10):

[0152]

[0153]

[0154]

[0155]

[0156]

[0157] In the formula, k1(k a1 )、k2(k a2 )、k3(k a3 ) is the longitudinal stiffness (cornering stiffness) of the front axle of the tractor, the front axle of the semitrailer and the rear axle of the semitrailer;

[0158] The expression of coefficient A is:

[0159] (3) Let v x2 =v x1 , rewrite the above differential equation into the form of state space, as shown in formula (11):

[0160]

[0161] In the formula, the state variable Control quantity input u=σ, output quantity The coefficient matrix C is the identity matrix.

[0162] (4) Approximate linearization and discretization of the semi-trailer train dynamics model.

[0163] At the reference point At Expanding according to Taylor's formula, we get:

[0164]

[0165] definition get The expression of is shown in formula (13):

[0166]

[0167] Among them, matrices A and B are the Jacobian matrices of the differential equation for state variables and input control quantities.

[0168] The continuous state space equation of the semi-trailer train is approximately discretized as shown in the following equation (14):

[0169] Among them A k,t =I+TA,B k,t =TB, T is the sampling time.

[0170] (5) Construct a linear discrete dynamic model of the heterogeneous platoon system of semi-trailer trains.

[0171] First, number the vehicles. Let the leading vehicle in the queue be numbered 0, and the following vehicles be numbered 1, 2, ... N, that is, the total number of vehicles in the queue is N+1.

[0172] Define the state variable sequence of all vehicles in the queue as The control sequence is The output is Then the linear discrete dynamic model of the heterogeneous platoon system of semi-trailer trains is as shown in the following formula (15):

[0173]

[0174] In the formula Ψ(k)=diag{B0…B N}, Γ=diag{C…C}.

[0175] Step 2: Build the communication topology of the heterogeneous queue of semi-trailer trains.

[0176] The semi-trailer train heterogeneous platoon in the present invention selects a leading vehicle-pilot vehicle following communication topology (PLF) structure, that is, the vehicles in the platoon receive real-time motion information of the adjacent vehicles in front and the platoon pilot vehicle to perform following control.

[0177] (1) Construct a directed graph G = {V, E} to express the communication relationship between vehicles in the queue. V = {0, 1, 2, ... N} is a set of vehicle nodes, that is, the set contains N + 1 nodes; It is a set of directed connection edges between vehicles, indicating the directional passability of information flow from vehicle nodes to other nodes.

[0178] (2) Construct the adjacency matrix H = [h ij]∈R (N+1)×(N+1) To characterize the information flow between vehicles and other nodes, its expression is shown in the following formula (16):

[0179]

[0180] When j,i∈E, i.e. j→i, vehicle node i can receive the motion information of node j; otherwise, it cannot. Then the adjacency matrix expression corresponding to the PLF communication topology structure is shown in the following formula (17):

[0181]

[0182] (3) Construct the reachability matrix P = diag{p1,p2,p3…p N} is used to characterize the communication relationship between the platoon leader and the following vehicles. Its expression is shown in the following formula (18):

[0183]

[0184] p i =1, vehicle node i can receive real-time information from the pilot vehicle; otherwise, it cannot. Then the reachability matrix expression corresponding to the PLF communication topology structure is P=diag{1…1}.

[0185] Step 3: Develop a gap control strategy between vehicles in a heterogeneous queue of semi-trailer trains.

[0186] (1) Establish the actual distance between vehicle node i and the preceding vehicle and the pilot vehicle.

[0187] In the geodetic coordinate system XOY, the distance between vehicle node i and the preceding vehicle is defined as shown in the following equation (19):

[0188] In the formula, the coordinates of the center of mass of the tractor at vehicle node i are (X i ,Y i ), the centroid coordinates of the tractor vehicle at the front vehicle node i-1 are (X i-1 ,Y i-1 ). The second term is the distance supplement considering the actual size of the vehicle, a 1,i is the actual size parameter of node i, a 2,i-1 、b 1,i-1 、b 2,i-1 is the actual size parameter of node i-1.

[0189] The distance between vehicle node i and the pilot vehicle is defined as follows:

[0190]

[0191] Where, the coordinates of the center of mass of the pilot vehicle are (X0, Y0); 1,0 、a 2,0 、b 2,0 The actual size parameters of the platoon leader vehicle.

[0192] (2) The present invention mainly considers the differences in the total mass of vehicles in the queue. In order to ensure the stability of the queue under emergency braking conditions and the safe braking of all vehicles, the established nonlinear spacing strategy is shown in the following formula (21):

[0193] S i,des =w i ×v x1,i t (21)

[0194] In the formula, S i,des is the expected inter-vehicle distance to the preceding vehicle; v x1,i is the longitudinal speed of vehicle node i; t is the reference vehicle headway; w i is the proportionality coefficient, which is related to the total mass of the vehicle and is expressed as follows:

[0195]

[0196] Where M is the reference total mass of the semi-trailer train.

[0197] Then the expected inter-vehicle distance between vehicle node i and the leading vehicle in the queue is as shown in equation (23):

[0198]

[0199] Step 4: Design a distributed model predictive controller for heterogeneous platoons of semi-trailer trains.

[0200] The DMPC controller i corresponding to vehicle node i consists of three parts: prediction model, cost function and constraints, and optimal solution. The prediction model is the linear discrete dynamic model of the semi-trailer train built previously; the cost function includes the following error cost function J with the leading vehicle and the pilot vehicle. 1,i , J 2,i , stability cost matrix J 3,i Three sub-functions. The constraints include followability, stability, and safety constraints. The optimal solution is that at the current moment, the cost function J 1,i +J 2,i +J 3,i Under the set constraints, the optimal control quantity u corresponding to the minimum value * (t).

[0201] For vehicle node i, (i = 0, 1, 2, ... N), the cost function of the optimal control problem solved by distributed model predictive control is defined as follows:

[0202]

[0203] J 1,i (k|t), J 2,i (k|t) are the following error cost functions of the ego vehicle, the pilot vehicle, and the front vehicle in the platoon, respectively, and are expressed as follows:

[0204]

[0205]

[0206] In the formula, y 0des ,y i-1des is the expected output state of the pilot vehicle and vehicle node i-1; Q i 、M i is the error cost matrix; for the leading car in the queue, J 1,i (k|t)=J 2,i (k|t)=0;

[0207] J 3,i (k|t) is defined as the stability cost function; stability requires data integrity during inter-vehicle communication, reduces data packet loss, and makes the predicted output sequence consistent with the assumed output sequence. The expression is shown in the following formula (27):

[0208] In the formula, F i is the stability cost matrix;

[0209] For vehicle node i, the constraints of its DMPC controller for solving the optimal control problem are set as follows:

[0210] ① Following target. The vehicle maintains the same speed as the leading vehicle in the queue and maintains the desired inter-vehicle distance with the preceding vehicle and the leading vehicle. The following target can be expressed as the following formula (28):

[0211]

[0212] For the leading vehicle in the platoon, this control objective does not exist in the controller design.

[0213] ② Stability target. Set the boundary value of the tractor's front wheel angle and its increment to ensure the stability of the vehicle's steering. The stability target is shown in the following formula (29):

[0214] δ min ≤u i (k|t)≤δ max ,Δδ min ≤Δu i(k|t)≤Δδ max (29)

[0215] In the formula, δ max ,δ min are the upper and lower boundary values ​​of the controller input variable, Δδ max , Δδ min The upper and lower boundary values ​​for the input variable increment.

[0216] ③ Safety target. Set the boundary values ​​of the vehicle's lateral and longitudinal speeds, and add constraints to the articulation angle to avoid dangers such as vehicle folding. The safety target is shown in the following formula (30):

[0217]

[0218] In the formula, v x1,max 、v x1,min are the upper and lower boundary values ​​of the vehicle longitudinal speed; v y1,max (v y2,max ),v y1,min (v y2,min ) are the upper and lower boundary values ​​of the lateral speed of the tractor and semi-trailer; are the upper and lower boundary values ​​of the vehicle's articulation angular velocity.

[0219] The vehicle dynamics constraints are shown in equation (31):

[0220]

[0221] The initial state constraint is as shown in equation (32):

[0222]

[0223] S4-4. In summary, for the vehicle node i in the heterogeneous queue of semi-trailer trains, at time t, its optimal control problem is expressed as the following formula (33):

[0224]

[0225] At the same time, equations (28) to (32) are satisfied.

[0226] At time t, vehicle node i sends the vehicle's current state variable sequence ξ i (k|t) is input into the DMPC controller i, that is, the controller receives the corresponding vehicle current state variable sequence ξ i (k|t), and simultaneously receive the hypothetical output variable sequence of the leading vehicle and the pilot vehicle through the communication topology and Solve optimization problems based on set constraintsJ i Get the optimal control input sequence And the first item of the optimal sequence Acting on vehicle node i, DMPC controller i outputs the assumed output variable sequence of vehicle node i

Claims

1. A method for cooperative control of heterogeneous platoons of semi-trailer trains based on distributed model predictive control, characterized in that: The following steps are involved: S1: Considering the real-time requirements of platoon control, a linear discrete dynamic model of the semi-trailer train and the platoon system is established, and used as a prediction model in the subsequent heterogeneous platoon controller; S2: Design a directed graph, define the adjacency matrix and reachability matrix, and build a communication topology model that characterizes the communication relationship between vehicles in a heterogeneous platoon; S3: Solve the real-time position relationship between the vehicle node and the front vehicle and the pilot vehicle in the queue, and consider the differences in vehicle braking capabilities to build a nonlinear spacing strategy based on the vehicle mass; S4: Set the cost function and constraints of the rolling optimization problem, and design a collaborative controller for the heterogeneous platoon of semi-trailer trains based on the DMPC control method.

2. The method for coordinated control of heterogeneous platoons of semitrailer trains based on distributed model predictive control according to claim 1, characterized in that: The S1 comprises the following steps: S1-1, establish the inertial coordinate system XOY and the body coordinate systems X1O1Y1 and X2O2Y2 of the tractor and semi-trailer; S1-2. Establish a single vehicle dynamics model of a semi-trailer train; The S1-2 comprises the following steps: The model includes the longitudinal velocity v of the tractor x1 , lateral speed v y1 , yaw rate Semi-trailer lateral speed v y2 and yaw rate There are five degrees of freedom in total; At the same time, the following assumptions are made for the model: ① The vertical motion, roll motion, and pitch motion of the vehicle are not considered; ② The longitudinal speeds of the tractor and the semi-trailer are kept consistent; ③ The articulation angle Δγ at the articulation point of the vehicle is small during operation; ④ The vertical load changes of the left and right wheels during driving are not considered; ⑤ The influence of air resistance and road slope is ignored; Establish the differential equations of motion of the tractor and semi-trailer regarding the longitudinal velocity, lateral velocity and yaw angular velocity: Where: m1, m2 are the total mass of the tractor and semi-trailer; I 1ZZ ,I 2ZZ is the lateral moment of inertia of the tractor and semi-trailer; a1, b1, f are the distances from the center of mass of the tractor to its front axle, equivalent rear axle, and hinge point; a2, b2 are the distances from the center of mass of the semi-trailer to the hinge point and the equivalent rear axle of the semi-trailer; v x1 、v x2 is the longitudinal speed of the tractor and semi-trailer; v y1 、v y2 is the lateral speed of the tractor and semi-trailer; is the yaw angular velocity of the tractor and semitrailer, is the derivative of the corresponding yaw rate; F x1 (F y1 ), F x2 (F y2 ), F x3 (F y3 ) is the longitudinal force or lateral force on the front axle of the tractor, the equivalent rear axle of the tractor, or the equivalent rear axle of the semitrailer; F 1x (F 1y ), F 2x (F 2y ) is the longitudinal force or lateral force generated by the articulated mechanism on the tractor or semi-trailer; The expressions of the lateral and longitudinal velocities of the tractor mass center in the inertial coordinate system XOY are shown in formula (3): In the design of the platoon controller, the speed at the center of mass of the tractor is defined as the speed of the semi-trailer train; The constraint relationship between the tractor and the semi-trailer at the articulation point is shown in the following formula (4): Calculate the side slip angle a of each equivalent tire i (i=1, 2, 3) is shown in the following formula (5): Where, σ is the front wheel turning angle of the front axle of the tractor; To simplify the model, the vehicle tire force F xi 、F yi (i=1, 2, 3) is linearized; in summary, the following five nonlinear motion differential equations can be obtained, as shown in equations (6) to (10): In the formula, k1(k a1 )、k2(k a2 )、k3(k a3 ) is the longitudinal cornering stiffness of the front axle of the tractor, the front axle of the semitrailer and the rear axle of the semitrailer, in N / rad; The expression of coefficient A is: S1-3, let v x2 =v x1 , rewrite the above differential equation into the form of state space, as shown in formula (11): In the formula, the state variable Control quantity input u=σ, output quantity The coefficient matrix C is the identity matrix; S1-4, approximate linearization and discretization of the semi-trailer train dynamics model; S1-5. Construct a linear discrete dynamic model of the heterogeneous platoon system of semi-trailer trains.

3. The method for coordinated control of heterogeneous platoons of semitrailer trains based on distributed model predictive control according to claim 2 is characterized in that: The S1-4 comprises the following steps: At the reference point At Expanding according to Taylor's formula, we get: definition get The expression of is shown in formula (13): Among them, matrices A and B are the Jacobian matrices of the differential equation for state variables and input control quantities; The continuous state space equation of the semi-trailer train is approximately discretized as shown in the following equation (14): Among them A k,t =I+TA,B k,t =TB, T is the sampling time.

4. The method for coordinated control of heterogeneous platoons of semitrailer trains based on distributed model predictive control according to claim 2, characterized in that: The S1-5 comprises the following steps: First, number the vehicles; let the leading vehicle in the queue be numbered 0, and the following vehicles be numbered 1, 2, ... N, that is, the total number of vehicles in the queue is N+1; Define the state variable sequence of all vehicles in the queue as The control sequence is The output is Then the linear discrete dynamic model of the heterogeneous platoon system of semi-trailer trains is as shown in the following formula (15): where Ψ(k) = diag{B0…B N}, Γ = diag{C…C}.

5. The method for coordinated control of heterogeneous platoons of semitrailer vehicles based on distributed model predictive control according to claim 1, characterized in that: The steps of constructing the communication topology model of the heterogeneous queue of semi-trailer trains in step S2 are as follows: S2-1. The semi-trailer train heterogeneous platoon adopts the PLF structure of the front vehicle-pilot vehicle following communication topology, that is, the vehicles in the platoon receive the real-time motion information of the adjacent vehicles in front and the platoon leader vehicle, and perform following control; S2-2, construct a directed graph G = {V, E} to express the communication relationship between vehicles in the queue; where V = {0, 1, 2, ... N} is a set of vehicle nodes, including the pilot vehicle; It is a set of directional connection edges between vehicles, indicating the directional passability of information flow from vehicle nodes to other nodes; S2-3, construct the adjacency matrix H = [h ij ]∈R (N+1)×(N+1) To characterize the information flow between vehicles and other nodes, the expression is shown in the following formula (16): When j,i∈E, i.e. j→i, vehicle node i can receive the motion information of node j; otherwise, it cannot; then the adjacency matrix expression corresponding to the PLF communication topology structure is shown in the following formula (17): S2-4, construct the reachable matrix P = diag{p1,p2,p3…p N } is used to characterize the communication relationship between the platoon leader and the following vehicles; the expression is shown in the following formula (18): p i =1, vehicle node i can receive real-time information from the pilot vehicle; otherwise, it cannot; then the reachable matrix expression corresponding to the PLF communication topology structure is P=diag{1…1}.

6. The method for coordinated control of heterogeneous platoons of semitrailer trains based on distributed model predictive control according to claim 1 or 2, characterized in that: The steps of formulating the variable spacing strategy based on the total weight of the semi-trailer train in step S3 are as follows: S3-1, establish the actual distance between vehicle node i and the preceding vehicle and the pilot vehicle; S3-2. Considering the differences in the total mass of vehicles in the queue, in order to ensure the stability of the queue under emergency braking conditions and the safe braking of all vehicles, the established nonlinear spacing strategy is as follows (21): S i,des =w i ×v x1,i t (21) In the formula, S i,des is the expected inter-vehicle distance to the preceding vehicle; v x1,i is the longitudinal speed of vehicle node i; t is the reference vehicle headway; w i is the proportionality coefficient, which is related to the total mass of the vehicle and is expressed as follows: Where, M is the reference total mass of the semi-trailer train; Then the expected inter-vehicle distance between vehicle node i and the leading vehicle in the queue is as shown in equation (23):

7. The method for coordinated control of heterogeneous platoons of semitrailer trains based on distributed model predictive control according to claim 6, characterized in that: Step S3-1 includes the following steps: In the geodetic coordinate system XOY, the distance between vehicle node i and the preceding vehicle is defined as shown in the following equation (19): In the formula, (X i ,Y i )、(X i-1 ,Y i-1 ) are the centroid coordinates of the tractor at vehicle node i and the front vehicle node i-1 respectively; the second term is the distance supplement considering the actual size of the vehicle, a 1,i is the actual size parameter of node i, a 2,i-1 、b 1,i-1 、b 2,i-1 is the actual size parameter of node i-1; The distance between vehicle node i and the pilot vehicle is defined as follows: Where (X0, Y0) is the coordinate of the center of mass of the pilot vehicle and the tractor; 1,0 、a 2,0 、b 2,0 The actual size parameters of the platoon leader vehicle.

8. The method for coordinated control of heterogeneous platoons of semitrailer trains based on distributed model predictive control according to claim 1 or 2, characterized in that: The steps of designing a distributed model predictive controller for a heterogeneous platoon of semitrailer trains in step S4 are as follows: S4-1. Define the prediction time domain of the controller as N p , the control time domain is N c , and define the following sequence of variables: ① Prediction variable sequence; Predict state variables; Predict input variables; Predict output variables; ②Optimal variable sequence; Optimal state variables; Optimal input variables; Optimal output variables; ③Assume variable sequence; Assume state variables; Assume input variables; Assume output variable; S4-2, define the cost function in the distributed model predictive controller; For vehicle node i, (i = 0, 1, 2, ... N), the cost function of the optimal control problem solved by distributed model predictive control is shown in equation (24): J 1,i (k|t), J 2,i (k|t) are the following error cost functions of the ego vehicle, the pilot vehicle, and the front vehicle in the platoon, respectively, and are expressed as follows: In the formula, y 0des ,y i-1des is the expected output state of the pilot vehicle and vehicle node i-1; Q i 、M i is the error cost matrix; for the leading car in the queue, J 1,i (k|t)=J 2,i (k|t)=0; J 3,i (k|t) is defined as the stability cost function; stability requires data integrity during inter-vehicle communication, reduces data packet loss, and makes the predicted output sequence consistent with the assumed output sequence. The expression is shown in the following formula (27): In the formula, F i is the stability cost matrix; S4-3. Define constraints in the distributed model predictive controller; S4-4. For vehicle node i in the heterogeneous queue of semi-trailer trains, at time t, its optimal control problem is expressed as the following equation (33): At the same time, equations (28) to (32) are satisfied. S4-5. The steps for solving the distributed model predictive controller for the heterogeneous platoon of semi-trailer trains are as follows: ①Initialize the vehicle motion state; ② Solve the optimal control problem J i (t), the optimal input ③ The first variable in the sequence is input to the vehicle node; ④ The end of the sequence is padded with 0 as the hypothetical input at time t+1; ⑤ Output series based on the previous car assumption Solve for expected output ⑥Let t=t+1, and return to step ②; The optimal input and expected output sequence of each vehicle node during the entire operation process is calculated to ensure the dynamic stability of the individual vehicles of the semi-trailer train, and ultimately realize the motion coordinated control of the heterogeneous queue of semi-trailer trains.

9. The method for coordinated control of heterogeneous platoons of semitrailer trains based on distributed model predictive control according to claim 8, characterized in that: In step S4-3, for vehicle node i, the constraints for the DMPC controller to solve the optimal control problem are set as follows: ① Following target: The vehicle maintains the same speed as the leading vehicle in the queue and maintains the desired inter-vehicle distance with the preceding vehicle and the leading vehicle. The following target can be expressed as the following formula (28): For the leading car in the platoon, this control objective does not exist in the controller design; ② Stability target: Set the boundary value of the tractor's front wheel angle and its increment to ensure the stability of the vehicle's steering. The stability target is shown in the following formula (29): d min ≤u i (k|t)≤δ max ,Dd min ≤Δu i (k|t)≤Δδ max (29) In the formula, δ max , δ min are the upper and lower boundary values ​​of the controller input variable, Δδ max , Δδ min The upper and lower boundary values ​​of the input variable increment; ③ Safety goal: set the boundary values ​​of the vehicle's lateral and longitudinal speeds, and add constraints to the articulation angle to avoid the risk of the vehicle folding; The safety target is shown in the following formula (30): In the formula, v x1,max 、v x1,min are the upper and lower boundary values ​​of the vehicle longitudinal speed; v y1,max (v y2,max ),v y1,min (v y2,min ) are the upper and lower boundary values ​​of the lateral speed of the tractor and semi-trailer; are the upper and lower boundary values ​​of the vehicle's articulation angular velocity; The vehicle dynamics constraints are shown in equation (31): The initial state constraint is as shown in equation (32):

Citation Information

Patent Citations

  • Path tracking method of semi-trailer train based on model predictive control

    CN111532283A

  • Pilot fleet coordinated single-lane multi-queue hierarchical control method

    CN112445229A

  • Intelligent networked electric vehicle queue control method considering both stability and energy conservation

    CN112477846A

  • Road traffic state prediction method and system, terminal, and storage medium

    WO2022104504A1

Cited By

  • Heavy truck autonomous following prediction control method considering sweeping collision avoidance and double reference trajectories

    CN120828807A

  • A heavy truck autonomous following predictive control method considering sweep collision avoidance and double reference trajectory

    CN120828807B