Intelligent vehicle lane changing trajectory planning and self-adaptive tracking control method
Patent Information
- Application Number
- CN202410982661.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-22
- Publication Date
- 2024-11-12
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The existing intelligent vehicle obstacle avoidance trajectory planning and tracking control strategy mainly only considers a single scenario, and the traditional model prediction controller has little research on trajectory tracking control in the time domain of adaptive vehicle speed change, and cannot effectively deal with complex traffic environments and emergency situations. The optimal collision avoidance path planning.
The optimal road change path is generated using a multi-objective cost function based on the B-spline curve, and the adaptive trajectory tracking controller is designed in combination with the vehicle dynamic model. By introducing a relaxation factor and front wheel angle constraint, a linear time-varying model predicts the controller. Carry out trajectory planning and tracking control to adapt to the prediction time domain adjustment of different vehicle speeds.
It realizes the rapid and accurate planning of the optimal trajectory under multi-objective constraints, ensures the safety, dynamic stability and driving comfort of the vehicle, enhances the adaptability and lateral stability of the trajectory tracking control, and reduces tracking errors. and side deflection angle changes.
Smart Images

Figure CN118938661A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of intelligent vehicle lane changing, and in particular to an intelligent vehicle lane changing trajectory planning and adaptive tracking control method. Background Art
[0002] With the rapid development of vehicle intelligent technology, autonomous driving is increasingly being used in reducing the incidence of traffic accidents and environmental pollution, and improving traffic efficiency and safety. As key technologies for autonomous driving, obstacle avoidance trajectory planning and tracking control have a great impact on the autonomous driving system. The purpose of the trajectory planning algorithm is to drive the intelligent vehicle safely and smoothly from the initial position to the target position according to the optimal speed sequence under the premise of meeting multi-objective constraints, while the purpose of trajectory tracking control is to ensure that the vehicle can accurately track the trajectory planned by the trajectory planning layer. Efficient and accurate trajectory planning and tracking control strategies provide important guarantees for efficient and safe driving of intelligent vehicles.
[0003] Zhang et al. established an improved hazard assessment module based on artificial potential field, and used the gradient descent method to generate lane change paths based on the potential energy distribution of target obstacles and road boundaries. At the same time, a coordinated controller based on proportional integral control and model predictive control (PI-MPC) was used in the tracking layer. The results showed that the algorithm can achieve active collision avoidance in complex traffic scenarios, but it did not take into account the uncertainty of surrounding obstacles. Li et al. proposed an integrated collision avoidance framework consisting of a new path planner and a tracking controller considering multiple dynamic constraints for autonomous multi-axis distributed vehicles. At the upper layer, a new safe and stable optimized path generator was designed based on the B-spline optimized path generator, and a path tracking controller based on nonlinear model predictive control (NMPC) was designed at the bottom layer. The results showed that under the dynamic constraints of considering safety and stability, path planning and path tracking have good performance, but the integrated framework only considers a single scenario.
[0004] Zhang Zhineng et al. proposed a dynamic path planning algorithm based on discrete optimization, which is only applicable to simple working conditions and cannot cope with complex working conditions. At the same time, they designed a fractional-order PID path tracking controller based on the preview theory at the path tracking level. The results show that the algorithm can better handle obstacle avoidance problems in complex dynamic environments, but the dynamic path planning algorithm cannot find the optimal collision avoidance path under emergency conditions. Ji Jie et al. used the trapezoidal acceleration method to design a virtual ideal trajectory for lane change, and designed a model predictive control system with multiple constraints. The results show that the system can effectively track the expected driving path while improving the vehicle's handling stability.
[0005] According to the current research status, the existing integrated strategy of obstacle avoidance trajectory planning and tracking control only considers a single scenario, and most of the research on vehicle trajectory tracking control is based on traditional model predictive controllers. There are few designs of trajectory tracking controllers that predict the time domain based on the adaptive changes of vehicle speed. Summary of the invention
[0006] 1. Technical issues to be resolved
[0007] In view of the deficiencies in the prior art, the present invention provides a method for intelligent vehicle lane-changing trajectory planning and adaptive tracking control, which solves the above-mentioned technical problems.
[0008] (II) Technical solution
[0009] To achieve the above object, the present invention provides the following technical solution: a method for intelligent vehicle lane change trajectory planning and adaptive tracking control, comprising the following steps:
[0010] S1. Generate a feasible lane-changing path connecting the lane-changing initial point and the lane-changing end point based on a smooth B-spline curve with continuous curvature, and establish a multi-objective cost function with path length and curvature as evaluation indicators to screen the optimal lane-changing path. The specific expression is as follows:
[0011]
[0012] Among them, P1 P2 … P s Represent n different control points, u represents the independent variable, B i,k (u) represents the i-th k-order B-spline basis function, B i,k-1 (u) represents the i-th k-1 order B-spline basis function, P i represents the i-th control point, B i+1,k-1 (u) represents the i+1th k-1th order B-spline basis function, u i are nodes and P(u) is the definition expression of the B-spline curve.
[0013] The specific expression of the constructed multi-objective cost function f is as follows:
[0014]
[0015] Where f represents the multi-objective cost function, ω1 and ω2 represent the weights of the lane change path length and the average curvature of the lane change path, f1 and f2 represent the evaluation values of the lane change path length and the lane change path curvature, respectively, and x j and j They represent the horizontal and vertical coordinates of the vehicle at time j, respectively. j+1 and j+1 They represent the horizontal and vertical coordinates of the vehicle at time j+1, respectively. jrepresents the curvature of the lane-changing path of the vehicle at time j.
[0016] S2. Construct the vehicle's motion equations and corresponding constraints, solve the speed sequence, integrate the minimum cost path and speed distribution of each path, and obtain the optimal trajectory.
[0017] S3. A trajectory tracking controller is established based on the vehicle dynamics model, and dynamic constraints are added. At the same time, a relaxation factor is introduced to avoid infeasible solutions.
[0018] S4. By curve fitting different vehicle speeds and the control rate corresponding to the optimal prediction time domain, a prediction time domain adaptive trajectory tracking controller is established based on the control rate to track the optimal trajectory planned in S2.
[0019] As a preferred technical solution of the present invention, the specific expression of the motion equation of the vehicle in step S2 is as follows:
[0020]
[0021]
[0022] Among them, s s (t) represents the arc length of the sth segment of the trajectory, v s (t) represents the vehicle speed of the sth segment of the trajectory, t represents time, and a s (t) represents the vehicle acceleration of the sth trajectory, c s,0 、c s,1 、c s,2 、c s,3 、c s,4 、c s,5 represent the coefficient of the sth segment trajectory, s s (t k-1 ) and s s (t k ) represent the sth trajectory at t k-1 Time and t k The arc length of the planned trajectory at the moment, v s (t k ) represents the sth trajectory at time t k The vehicle speed, a s (t k ) represents the sth trajectory at time t k The vehicle acceleration, v max Indicates the maximum speed, v min Indicates the minimum speed, a max Indicates the maximum acceleration, a min Indicates the minimum acceleration.
[0023] The objective function is introduced to solve the constraints in step S2, and its expression is as follows:
[0024]
[0025] in, They represent the acceleration a in time t = [0, 1] s (t), jerk i (t), actual arc length S s,t With reference arc length The integral of the square of the difference term, α1 represents the weight coefficient of the acceleration term, α2 represents the weight coefficient of the jerk term, and α3 represents the weight coefficient of the reference velocity difference term. The constraint is converted into a quadratic programming problem for solution. The specific expression is as follows:
[0026]
[0027] St
[0028] R·x≤b
[0029] R eq x≤b eq
[0030] c min ≤x≤c max
[0031] Among them, min(J1) represents the minimum value of J1, x represents the optimal polynomial coefficient vector, and x T represents the transpose of x, q represents the gradient vector, R and b both represent the inequality constraint matrix, R eq and b eq They represent the equality constraint matrix, c max and c min are the upper and lower bounds of the coefficients.
[0032] As a preferred technical solution of the present invention, the specific expression in step S3 is as follows:
[0033]
[0034] Where J2 represents the output, t represents the sampling time, t+j represents the jth time after time t, η(t+j|t) represents the output of the trajectory tracking controller at time t+j predicted by time t, and η ref (t+j|t) represents the reference system output at time t+j predicted at time t, Δu(t+j|t) represents the control increment, u(t+j|t) represents the control amount, Q, R, S are the weight coefficients of tracking error, control increment and control amount respectively, N p represents the prediction time domain, N crepresents the control time domain, ε represents the relaxation factor, ρ is the weight coefficient of the relaxation factor ε, Indicates the square of the difference between the output and the reference output. Represents the square of the output increment, Represents the square of the output.
[0035] As a preferred technical solution of the present invention, the trajectory tracking controller in step S4 includes a vehicle dynamics model, and the specific expression is as follows:
[0036]
[0037] Where m represents the vehicle curb mass, x represents the vehicle longitudinal displacement, represents the longitudinal velocity of the vehicle, represents the longitudinal acceleration of the vehicle, y represents the lateral displacement of the vehicle, represents the lateral speed of the vehicle, represents the lateral acceleration of the vehicle, a represents the distance from the center of mass to the front axle, b represents the distance from the center of mass to the rear axle, δ f represents the front wheel turning angle, I z represents the moment of inertia about the z-axis, represents the yaw angle, represents the yaw angular velocity, is the yaw angular acceleration, C cf , C cr are the longitudinal stiffness of the front and rear tires, s f 、s r are the front and rear tire slip rates respectively.
[0038] Compared with the prior art, the present invention provides a method for intelligent vehicle lane change trajectory planning and adaptive tracking control, which has the following beneficial effects:
[0039] 1. The present invention adopts a lane changing trajectory planning method based on B-spline curves, adds a trajectory optimization step to the traditional trajectory planning, designs a cost function that considers multiple indicators such as lane changing efficiency, safety and stability goals, and optimizes the path according to the changes in control points. This method can plan the optimal trajectory more quickly and accurately.
[0040] 2. The present invention comprehensively considers various dynamic constraints such as vehicle driving safety and stability, and uses quadratic programming to optimize the speed sequence within the time and space boundaries to ensure the safety, dynamic stability and driving comfort of the vehicle.
[0041] 3. The present invention adds dynamic constraints such as front wheel angle constraint and front wheel angle increment constraint on the basis of linear time-varying model predictive controller, and introduces relaxation factor to avoid infeasible solutions. Based on cubic polynomial fitting of the vehicle speed and predicted time domain control relationship, the controller can adaptively adjust the predicted time domain according to the vehicle speed while ensuring stability, thereby enhancing the adaptability of the trajectory tracking controller at different vehicle speeds. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] Figure 1 It is a schematic diagram of the flow chart of the present invention;
[0043] Figure 2 This is the optimal lane-changing path diagram for active obstacle avoidance of the vehicle of the present invention.
[0044] Figure 3 This is a curvature variation diagram of the optimal lane-changing path for active obstacle avoidance of the vehicle of the present invention.
[0045] Figure 4 It is the optimal speed curve diagram in the ST diagram of the present invention.
[0046] Figure 5 Graph showing the tracking errors of different tracking controllers of the present invention.
[0047] Figure 6 This is a diagram showing the change in the sideslip angle of the center of mass of different tracking controllers of the present invention.
[0048] Figure 7 Graph showing the yaw angular velocity variation of different tracking controllers of the present invention.
[0049] Figure 8 This is a fitting function relationship diagram of the prediction time domain and vehicle speed according to the present invention. DETAILED DESCRIPTION
[0050] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0051] See also Figure 1-Figure 8 , an intelligent vehicle lane-changing trajectory planning and adaptive tracking control method, comprising the following steps:
[0052] S1. Generate a feasible lane-changing path connecting the lane-changing initial point and the lane-changing end point based on a smooth B-spline curve with continuous curvature, and establish a multi-objective cost function with path length and curvature as evaluation indicators to screen the optimal lane-changing path. The specific expression is as follows:
[0053]
[0054] Among them, P1 P2 … P s Represent n different control points, u represents the independent variable, B i,k (u) represents the i-th k-order B-spline basis function, B i,k-1 (u) represents the i-th k-1 order B-spline basis function, P i represents the i-th control point, B i+1,k-1 (u) represents the i+1th k-1th order B-spline basis function, u i are nodes and P(u) is the definition expression of the B-spline curve.
[0055] There are 6 control points P i (i=1, 2, ..., 6), P0 is the midpoint of the imaginary lane change path, P1 is the starting position of the vehicle's center of mass before the lane change, and P6 is the ending position of the vehicle after the lane change. In addition, P2-P5 are also important geometric control reference points that need to be determined for the parameterization of the fourth-order cubic B-spline path shape. These six control points satisfy the following relationship:
[0056]
[0057] After obtaining the initial position of the vehicle changing lanes, the control point P1 can be determined. At the same time, after determining the end position P6, the symmetric point P0 can be calculated according to the above formula. When P0 is determined and the position of P3 is known, the coordinates of other control points can be known, thereby defining the shape of the curve.
[0058] The positions of the symmetric point P0 and the control point P3 can determine the shape of the lane-changing path. P0 and P3 are used as the solution vectors of the optimization problem and are freely combined to generate a series of lane-changing path sets. The optimal lane-changing path is selected using the comprehensive evaluation index composed of the path length and the average curvature of the lane-changing path. The specific expression of the multi-objective cost function f constructed with the path length and curvature as the evaluation index is as follows:
[0059] The specific expression of the constructed multi-objective cost function f is as follows:
[0060]
[0061] Where f represents the multi-objective cost function, ω1 and ω2 represent the weights of the lane change path length and the average curvature of the lane change path, f1 and f2 represent the evaluation values of the lane change path length and the lane change path curvature, respectively, and x j and j They represent the horizontal and vertical coordinates of the vehicle at time j, respectively. j+1 and j+1 They represent the horizontal and vertical coordinates of the vehicle at time j+1, respectively. jrepresents the curvature of the lane-changing path of the vehicle at time j.
[0062] S2. Construct the vehicle's motion equations and corresponding constraints, solve the speed sequence, integrate the minimum cost path and speed distribution of each path, and obtain the optimal trajectory.
[0063] In order to select the optimal collision-free trajectory, the motion of surrounding vehicles is described in the space-time graph. Speed planning is the process of finding the optimal speed profile from the collision-free area in the space-time graph under complex constraints. In the ST graph, the horizontal axis represents time and the vertical axis represents the arc length position along the given trajectory. The speed at each position can be expressed as v i =f(t i ,s i ), the dynamic obstacle is the blue area in the figure, which indicates that the moving obstacle will overlap with the trajectory and collide with it within a certain period of time. On the contrary, planning the vehicle speed in the white area can generate a safe and collision-free speed profile. The planned speed curve is composed of 8 segments of quintic polynomial curves. The specific expression of the vehicle's motion equation is as follows:
[0064]
[0065]
[0066] Among them, s s (t) represents the arc length of the sth segment of the trajectory, v s (t) represents the vehicle speed of the sth segment of the trajectory, t represents time, and a s (t) represents the vehicle acceleration of the sth trajectory, c s,0 、c s,1 、c s,2 、c s,3 、c s,4 、c s,5 represent the coefficient of the sth segment trajectory, s s (t k-1 ) and s s (t k ) represent the sth trajectory at t k-1 Time and t k The arc length of the planned trajectory at the moment, v s (t k ) represents the sth trajectory at time t k The vehicle speed, a s (t k ) represents the sth trajectory at time t k The vehicle acceleration, v max Indicates the maximum speed, v min Indicates the minimum speed, a max Indicates the maximum acceleration, a minIndicates the minimum acceleration.
[0067] The objective function is introduced to solve the constraints in step S2, and its expression is as follows:
[0068]
[0069] in, They represent the acceleration a in time t = [0, 1] s (t), jerk i (t), actual arc length S s,t With reference arc length The integral of the square of the difference term, α1 represents the weight coefficient of the acceleration term, α2 represents the weight coefficient of the jerk term, and α3 represents the weight coefficient of the reference velocity difference term. The constraint is converted into a quadratic programming problem for solution. The specific expression is as follows:
[0070]
[0071] St
[0072] R·x≤b
[0073] R eq x≤b eq
[0074] c min ≤x≤c max
[0075] Among them, min(J1) represents the minimum value of J1, x represents the optimal polynomial coefficient vector, and x T represents the transpose of x, q represents the gradient vector, R and b both represent the inequality constraint matrix, R eq and b eq They represent the equality constraint matrix, c max and c min are the upper and lower bounds of the coefficients.
[0076] S3. Design a trajectory tracking controller based on the vehicle dynamics model. In the process of trajectory tracking, it is necessary to ensure that the tracking deviation meets the requirements while limiting the control input. These requirements are reflected through the objective function. Therefore, the following objective function is designed:
[0077]
[0078] Where J2 represents the output, t represents the sampling time, t+j represents the jth time after time t, η(t+j|t) represents the output of the trajectory tracking controller at time t+j predicted by time t, and η ref(t+j|t) represents the reference system output at time t+j predicted at time t, Δu(t+j|t) represents the control increment, u(t+j|t) represents the control amount, Q, R, S are the weight coefficients of tracking error, control increment and control amount respectively, N p represents the prediction time domain, N c represents the control time domain, ε represents the relaxation factor, ρ is the weight coefficient of the relaxation factor ε, Indicates the square of the difference between the output and the reference output. Represents the square of the output increment, Represents the square of the output.
[0079] S4, fitting different vehicle speeds with the control rates corresponding to the optimal prediction time domain by curve fitting, and establishing a prediction time domain adaptive trajectory tracking controller based on the control rate to track the optimal trajectory planned in S2;
[0080] In order to enable the vehicle to quickly and accurately track the planned trajectory under lane change conditions, a three-degree-of-freedom vehicle dynamics model is established in the trajectory tracking controller, as shown in the following formula:
[0081]
[0082] Where m represents the vehicle curb mass, x represents the vehicle longitudinal displacement, represents the longitudinal velocity of the vehicle, represents the longitudinal acceleration of the vehicle, y represents the lateral displacement of the vehicle, represents the lateral speed of the vehicle, represents the lateral acceleration of the vehicle, a represents the distance from the center of mass to the front axle, b represents the distance from the center of mass to the rear axle, δ f represents the front wheel turning angle, I z represents the moment of inertia about the z-axis, represents the yaw angle, represents the yaw angular velocity, is the yaw angular acceleration, C cf , C cr are the longitudinal stiffness of the front and rear tires, s f 、s r are the front and rear tire slip rates respectively.
[0083] In order to obtain the optimal prediction time domain N under different constant vehicle speeds p The value is 36, 72, 90, 108, 126 / (km·h -1 ) speed, and the specific prediction time domain N is obtained by fitting the optimal prediction time domain of the selected 5 groups of different speeds and rounding the third polynomial. p -The vehicle speed v control law is as follows:
[0084]
[0085] The optimal lane change path selected by the comprehensive evaluation index composed of path length and average curvature is as follows: Figure 2 As shown in the figure, the total lane change distance is 43.4838m, and the lane change path curvature change diagram is as follows Figure 3 As shown, the average curvature of the lane change path is 0.0089m- 1 The results show that the proposed optimized trajectory planning algorithm is able to generate feasible trajectories to ensure safe autonomous lane changing for intelligent vehicles.
[0086] The trajectory planning module plans the path and speed coupling to generate the optimal lane-changing trajectory, and the optimal lane-changing trajectory is input into the trajectory tracking control module for tracking. Figure 4 The comparison of different prediction time domain trajectory tracking, AdaptiveNp represents the prediction time domain adaptive trajectory tracking controller, ConstantNp represents the constant prediction time domain trajectory tracking controller. Compared with the controller using the traditional constant prediction time domain trajectory tracking controller for tracking, the controller using the prediction time domain adaptive trajectory tracking controller for tracking has a maximum tracking error of 0.6m and an average tracking error of 0.25m. The change curves of the vehicle's center of mass sideslip angle and yaw angular velocity are shown in Figure 2. Figure 5 and Figure 6 The maximum value of the side slip angle variation range of the vehicle center of mass using the adaptive prediction time domain trajectory tracking controller is reduced by 9.16°, and the maximum value of the yaw rate variation range is reduced by 2.21 / (rad·s -1 ), which shows that the vehicle has better lateral stability when using adaptive predictive time-domain trajectory tracking controller during the speed change and lane change tracking process on the curve. Figure 7 This is the change diagram of the prediction time domain. It can be seen that as the vehicle speed changes, the adaptive prediction time domain controller updates and selects the optimal prediction time domain in real time, enhancing the adaptability of the trajectory tracking controller at different vehicle speeds.
[0087] Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the appended claims and their equivalents.
Claims
1. An intelligent vehicle lane-changing trajectory planning and adaptive tracking control method, characterized in that: The following steps are involved: S1. Generate a feasible lane-changing path connecting the lane-changing initial point and the lane-changing end point based on a smooth B-spline curve with continuous curvature, and establish a multi-objective cost function with path length and curvature as evaluation indicators to screen the optimal lane-changing path. The specific expression is as follows: Among them, P1P2…P s Represent n different control points, u represents the independent variable, B i,k (u) represents the i-th k-order B-spline basis function, B i,k-1 (u) represents the i-th k-1 order B-spline basis function, P i represents the i-th control point, B i+1,k-1 (u) represents the i+1th k-1th order B-spline basis function, u i is a node, P(u) is the definition expression of the B-spline curve; The specific expression of the constructed multi-objective cost function f is as follows: Where f represents the multi-objective cost function, ω1 and ω2 represent the weights of the lane change path length and the average curvature of the lane change path, f1 and f2 represent the evaluation values of the lane change path length and the lane change path curvature, respectively, and x j and j They represent the horizontal and vertical coordinates of the vehicle at time j, respectively. j+1 and j+1 They represent the horizontal and vertical coordinates of the vehicle at time j+1, respectively. j represents the curvature of the lane-changing path of the vehicle at time j; S2, construct the vehicle's motion equation and corresponding constraints, solve the speed sequence, integrate the minimum cost path and speed distribution of each path, and obtain the optimal trajectory; S3. Establish a trajectory tracking controller based on the vehicle dynamics model, add dynamic constraints, and introduce relaxation factors to avoid infeasible solutions; S4. By curve fitting different vehicle speeds and the control rate corresponding to the optimal prediction time domain, a prediction time domain adaptive trajectory tracking controller is established based on the control rate to track the optimal trajectory planned in S2.
2. The intelligent vehicle lane-changing trajectory planning and adaptive tracking control method according to claim 1, characterized in that: The specific expression of the motion equation of the vehicle in step S2 is as follows: Among them, s s (t) represents the arc length of the sth trajectory, ν s (t) represents the vehicle speed of the sth segment of the trajectory, t represents time, and a s (t) represents the vehicle acceleration of the sth trajectory, c s,0 、c s,1 、c s,2 、c s,3 、c s,4 、c s,5 represent the coefficient of the sth segment trajectory, s s (t k-1 ) and S s (t k ) represent the sth trajectory at t k-1 Time and t k The arc length of the trajectory planned at the moment, ν s (t k ) represents the sth trajectory at time t k The vehicle speed, a s (t k ) represents the sth trajectory at time t k The vehicle acceleration, ν max represents the maximum velocity, ν min Indicates the minimum speed, a max Indicates the maximum acceleration, a min Indicates the minimum value of acceleration; The objective function is introduced to solve the constraints in step S2, and its expression is as follows: in, They represent the acceleration a in time t = [0, 1] s (t), jerk i (t), actual arc length S s,t With reference arc length The integral of the square of the difference term, α1 represents the weight coefficient of the acceleration term, α2 represents the weight coefficient of the jerk term, and α3 represents the weight coefficient of the reference velocity difference term. The constraint is converted into a quadratic programming problem for solution. The specific expression is as follows: st R·x≤b R eq ·x≤b eq c min ≤x≤c max Among them, min(J1) represents the minimum value of J1, x represents the optimal polynomial coefficient vector, and x T represents the transpose of x, q represents the gradient vector, R and b both represent the inequality constraint matrix, R eq and b eq They represent the equality constraint matrix, c max and c min are the upper and lower bounds of the coefficients.
3. The intelligent vehicle lane-changing trajectory planning and adaptive tracking control method according to claim 1, characterized in that: The specific expression in step S3 is as follows: Where J2 represents the output, t represents the sampling time, t+j represents the jth time after time t, η(t+j|t) represents the output of the trajectory tracking controller at time t+j predicted by time t, and η ref (t+j|t) represents the reference system output at time t+j predicted at time t, Δu(t+j|t) represents the control increment, u(t+j|t) represents the control amount, Q, R, S are the weight coefficients of tracking error, control increment and control amount respectively, N p represents the prediction time domain, N c represents the control time domain, ε represents the relaxation factor, ρ is the weight coefficient of the relaxation factor ε, Indicates the square of the difference between the output and the reference output. Represents the square of the output increment, Represents the square of the output.
4. The intelligent vehicle lane-changing trajectory planning and adaptive tracking control method according to claim 1, characterized in that: The trajectory tracking controller in step S4 includes a vehicle dynamics model, and the specific expression is as follows: Where m represents the vehicle curb mass, x represents the vehicle longitudinal displacement, represents the longitudinal velocity of the vehicle, represents the longitudinal acceleration of the vehicle, y represents the lateral displacement of the vehicle, represents the lateral speed of the vehicle, represents the lateral acceleration of the vehicle, a represents the distance from the center of mass to the front axle, b represents the distance from the center of mass to the rear axle, δ f represents the front wheel turning angle, I z represents the moment of inertia about the z-axis, represents the yaw angle, represents the yaw angular velocity, is the yaw angular acceleration, C cf , C cr are the longitudinal stiffness of the front and rear tires, s f 、s r are the front and rear tire slip rates respectively.
Citation Information
Patent Citations
Automatic driving lane changing preparation and execution integrated trajectory planning method
CN108387242A
Vehicle active collision avoidance control method based on model predictive control algorithm
CN115454086A
Automatic driving vehicle path tracking method based on adaptive model predictive control
CN116560371A
Automatic driving intelligent control method based on svo
CN117032203A
Automatic driving vehicle local trajectory planning and control integration method
CN117784612A
Cited By
Precise motion control method and device of tablet for intelligent driving test
CN121348885A
