Fast path tracking distributed control method for four-wheel drive intelligent electric vehicle
Through the adaptive sliding mode control method of the input and output subsystem of multiple agents, the problem of path tracking accuracy and dynamic stability of smart electric vehicles when driving at high speed and high curvature is solved, and efficient path tracking under extreme operating conditions is achieved and stability guarantee.
Patent Information
- Application Number
- CN202410971313.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-19
- Publication Date
- 2024-11-12
AI Technical Summary
When smart electric vehicles are driving at high speed and high curvature, the lateral nonlinear factors of the tires are enhanced, resulting in a decrease in path tracking control accuracy. It is easy to slip and tail flutter under high-speed and low-attached road surfaces. The existing technology is difficult to under extreme operating conditions. Ensure dynamic stability.
Adaptive sliding mode control method of input and output subsystem based on multi-agents is adopted. By redefining the system output, the path tracking model is decomposed into input and output subsystem and zero dynamic subsystem, the topology structure is established using graph theory method, and the controller is designed. Parameters are used to achieve rapid convergence of wheel slip state and lateral movement, and coordinate the four-wheel steering angle and driving torque.
It improves the path tracking accuracy and dynamic stability, reduces the design difficulty and computing efficiency of the system controller, and is widely applicable, and is suitable for widespread promotion and application.
Smart Images

Figure CN118938899A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of intelligent electric vehicle path tracking control, and mainly to a fast path tracking distributed control method for a four-wheel drive intelligent electric vehicle. Background Art
[0002] Path tracking control is a key technology for realizing the intelligentization of automobiles. It controls the size of the front wheel steering angle in real time through vehicle status information and pre-planned desired paths, aiming to minimize the lateral offset and heading error between the vehicle and the target path, and ensure that the vehicle travels along the expected path. At present, intelligent vehicles can achieve good path tracking effects under most working conditions. However, when the car is driving at high speed and large curvature, the lateral nonlinear factors of the tires are enhanced, and the path tracking accuracy under steering control will be greatly affected. The front wheel steering angle determined by the path tracking controller is difficult to meet the control requirements; on high-speed and low-adhesion roads, the car is prone to side slip, tail swing and other dangerous conditions when turning. Since there is only one control quantity, the front wheel steering angle, under extreme conditions, it is difficult for the steering controller to ensure the dynamic stability of the car while tracking the path.
[0003] The steering system directly causes the vehicle to generate lateral acceleration through the lateral force of the tire, which directly affects the lateral displacement, while active yaw moment control (DYC) indirectly affects the lateral response of the vehicle by affecting the yaw angular velocity. The coordinated control of DYC and active steering can effectively improve the dynamic performance of the vehicle during path tracking. The driving / braking torque of the four wheels of a four-wheel drive electric vehicle is independently controllable, and the driving / braking torque control of a single wheel and the torque distribution control between axles and wheels can be accurately and quickly achieved within the capacity of the motor, providing additional degrees of freedom for the lateral control of the vehicle, which can significantly improve the maneuverability and stability of the vehicle. The control methods commonly used for the coordination mechanism of active steering and DYC in four-wheel drive intelligent electric vehicles include: optimal control, sliding mode control, adaptive inversion control, model predictive control, etc. Reference 1 [Liang J, Lu Y, Yin G, et al. A Distributed Integrated Control Architecture of AFS and DYC based on MAS for Distributed Drive Electric Vehicles [J]. IEEE Transactions on Vehicular Technology, 2021, (99): 1-1.] regards the AFS system and DYC system as multi-agents, and proposes a new distributed framework for AFS+DYC system integrated control based on the MAS idea. The collaborative control strategy of the two agents is obtained through the Pareto optimal theory to improve the lateral stability of the vehicle and reduce the driver's calculation amount during path tracking. Reference 2 [Hang P, Chen X, Luo F. LPV / H-infinity Controller Design for Path Tracking of Autonomous Ground Vehicles Through Four-Wheel Steering and Direct Yaw-Moment Control [J]. International Journal of Automotive Technology, 2019 (4): 20.] A four-wheel steering (4WS) and direct yaw moment control (DYC) system is used to design the path tracking control of an autonomous ground vehicle (AGV). The linear variable parameter (LPV) / H∞ control is used as the upper-level controller, and the weighted least squares (WLS) allocation algorithm is used at the lower level for torque distribution.Reference 3 [Mashadi, B., Ahmadizadeh, P., Majidi, M. et al. Integrated robust controller for vehicle path following. Multibody Syst Dyn 33, 207–228 (2015).] Based on the μ synthesis method, a robust controller is designed for the integrated 4WS+DYC control system to achieve path tracking of AGV. This method has the powerful ability to enable the vehicle to track the required path in the presence of parameter uncertainty. The above active steering and DYC coordinated control schemes both utilize the redundant control freedom brought by the active yaw torque to improve the path tracking capability of the four-wheel drive smart electric vehicle while taking into account the dynamic stability. However, the above methods rarely consider tire slip, as well as the effective trade-off between computational efficiency and system dynamic performance during implementation.
[0004] Since multi-agent systems can achieve complex intelligence through the mutual cooperation of each agent, while reducing the complexity of system modeling, the robustness, reliability and flexibility of the system are improved. They have been widely used in the fields of aircraft formation, sensor network, data fusion, parallel computing, traffic vehicle control, etc. The main idea of sliding mode control is to design a dynamic, continuous or discrete control strategy so that the state of the system can slide on the preset sliding surface to achieve the desired performance. Therefore, the present invention redefines the system output, decomposes the under-driven intelligent electric vehicle path tracking system into an input-output subsystem and a zero dynamic subsystem, and proposes an adaptive sliding mode control method for the input-output subsystem based on a multi-agent. The design parameters in the controller are selected with the goal of satisfying the rapid convergence of the zero dynamic subsystem, so as to effectively balance the path tracking accuracy and dynamic stability. Summary of the invention
[0005] In order to improve the path tracking capability of smart electric vehicles and ensure their dynamic stability under extreme working conditions, the present invention aims to reduce the design difficulty of the entire system controller and improve the real-time performance of the algorithm, balances the performance indicators and computational efficiency of the system, adopts a method of redefining the system output, and proposes a fast path tracking distributed control method for four-wheel drive smart electric vehicles. While ensuring good tracking control effects under different working conditions, the dynamic stability of the system is improved.
[0006] The technical solution adopted by the present invention to solve the technical problem is as follows:
[0007] A fast path tracking distributed control method for a four-wheel drive intelligent electric vehicle comprises the following steps:
[0008] Step 1: Use the CarSim car model to obtain the real-time parameters of the vehicle: Y-axis coordinates, X-axis coordinates, heading angle, lateral speed and acceleration, longitudinal speed and acceleration, heading angular velocity, rolling angular velocity of each wheel, vertical force of each wheel, etc.
[0009] Step 2: Establish a path tracking model for the four-wheel drive smart electric vehicle based on the kinematics and dynamics of the vehicle;
[0010] Step 3: Based on the path tracking model obtained in step 2, redefine the output of the system, and decompose the path tracking model into an input-output subsystem and a zero dynamic subsystem by input-output linearization;
[0011] Step 4: Consider the 6 degrees of freedom equations in the input-output subsystem as 6 intelligent agents. According to the internal working communication of the 6 intelligent agents, determine the topological structure of the 6 intelligent agents in the input-output subsystem. Based on the graph theory method, obtain the adjacency matrix A, in-degree matrix D, Laplace matrix L and correlation matrix B used for information exchange between the 6 intelligent agents.
[0012] Step 5: Based on the Y-axis coordinates, X-axis coordinates, heading angle, lateral velocity and acceleration, longitudinal velocity and acceleration, heading angular velocity, rolling angular velocity of each wheel, vertical force of each wheel, etc. output by the CarSim vehicle model, the controller parameters are designed with the goal of fast convergence of the zero dynamic subsystem state obtained in step 3;
[0013] Step 6. Based on the given reference trajectory, the input-output subsystem obtained in step 3, the adjacency matrix A, in-degree matrix D, Laplace matrix L and correlation matrix B for information exchange between the six agents obtained in step 4, and the controller parameters obtained in step 5, the four-wheel steering angle and four-wheel drive torque are obtained through the multi-agent-based input-output subsystem adaptive sliding mode control module, and input them into the CarSim vehicle model.
[0014] The beneficial effects of the present invention are as follows:
[0015] 1) According to the dynamic motion mechanism of the vehicle, the present invention establishes a mathematical model of the path tracking system, considers the slip state of the four wheels, trajectory tracking error and yaw stability, redefines the output of the system, and uses input-output linearization to decompose the path tracking system into an input-output subsystem and a zero dynamic subsystem, thereby achieving dimensionality reduction and decoupling of the model.
[0016] 2) The present invention regards the 6-degree-of-freedom equations in the input-output subsystem as 6 intelligent agents, establishes a dimensionality reduction control model of the input-output subsystem based on graph theory, and simplifies the model dimension.
[0017] 3) The present invention proposes an adaptive sliding mode control strategy based on multi-agent for the input-output subsystem, so that the state of the input-output subsystem: the slip state of each wheel Δω σ , the lateral motion of the vehicle Δγ and Δv y It converges to zero in a finite time, preventing excessive wheel slip while controlling the vehicle's handling stability, effectively balancing the system's performance indicators and the computing power requirements of the algorithm in engineering applications.
[0018] 4) The present invention aims to quickly stabilize the heading angle following error and lateral displacement following error of the zero dynamic subsystem near the equilibrium point, and selects the design parameters of the controller to ensure the asymptotic stability of the trajectory tracking control system of the intelligent electric vehicle.
[0019] 5) The method proposed in the present invention is simple, easy to implement, and has a wide range of applications, and is suitable for widespread promotion and application. BRIEF DESCRIPTION OF THE DRAWINGS
[0020] Figure 1 It is a schematic diagram of the topological structure of the input and output subsystem based on graph theory of the present invention.
[0021] Figure 2 The invention discloses a fast path tracking control principle block diagram of a four-wheel drive intelligent electric vehicle. DETAILED DESCRIPTION
[0022] The present invention is further described in detail below with reference to the accompanying drawings and specific embodiments.
[0023] like Figure 1 As shown, in the fast path tracking distributed control method of the four-wheel drive intelligent electric vehicle of the present invention, the six degree-of-freedom equations in the input-output subsystem are regarded as six intelligent agents, and according to the communication topology of the six subsystems, a topological structure diagram of the six intelligent agents of the input-output subsystem based on graph theory is constructed.
[0024] like Figure 2As shown, the fast path tracking distributed control method of the four-wheel drive intelligent electric vehicle of the present invention includes: step one, using the CarSim car model to obtain the real-time parameters of the vehicle: Y-axis coordinates, X-axis coordinates, heading angle, lateral speed and acceleration, longitudinal speed and acceleration, heading angular velocity, rolling angular velocity of each wheel, vertical force of each wheel, etc. Step two, according to the kinematic and dynamic mechanisms of the vehicle, a path tracking model of the four-wheel drive intelligent electric vehicle is established; step three, according to the path tracking model obtained in step two, the output of the system is redefined, and the path tracking model is decomposed into an input-output subsystem and a zero dynamic subsystem through input-output linearization; step four, the six degree-of-freedom equations in the input-output subsystem are regarded as six intelligent agents, and the topological structure of the six intelligent agents in the input-output subsystem is determined according to the internal working communication of the six intelligent agents, and the adjacency matrix, in-degree matrix, Laplace matrix and correlation matrix for information exchange between the six intelligent agents are obtained based on the graph theory method; step five, according to the CarSim car model The output Y-axis coordinates, X-axis coordinates, heading angle, lateral velocity and acceleration, longitudinal velocity and acceleration, heading angular velocity, rolling angular velocity of each wheel, vertical force of each wheel, etc., are used to design controller parameters with the goal of rapid convergence of the zero dynamic subsystem state obtained in step 3; step 6, according to the given reference trajectory, the input-output subsystem obtained in step 3, the weighted adjacency matrix, degree matrix and Laplace matrix for information exchange between the six agents obtained in step 4, and the controller parameters obtained in step 5, the four-wheel steering angle and four-wheel drive torque are obtained through the multi-agent-based input-output subsystem adaptive sliding mode control module, and they are input into the CarSim vehicle model.
[0025] The fast path tracking distributed control method of the four-wheel drive intelligent electric vehicle of the present invention has the following specific implementation steps:
[0026] Step 1: Use the CarSim car model to obtain the real-time parameters of the vehicle: Y-axis coordinates, X-axis coordinates, heading angle, lateral speed and acceleration, longitudinal speed and acceleration, heading angular velocity, rolling angular velocity of each wheel, vertical force of each wheel, etc.
[0027] Step 2: Based on the dynamic mechanism of the vehicle, a path tracking model of the four-wheel drive intelligent electric vehicle is established. The specific implementation method is as follows:
[0028] 2.1 Vehicle dynamics model
[0029] In the design of the controller, the handling dynamics model of the four-wheel drive smart electric vehicle can be described as:
[0030]
[0031]
[0032] Among them, v x and v y are the longitudinal and lateral velocities of the vehicle, respectively. r is the yaw rate. m and I z is the vehicle mass and yaw inertia. F yf and F yr is the lateral force of the front and rear tires. f and δ r is the steering angle of the front and rear wheels. f and l r ΔM is the distance from the center of mass of the vehicle to the front axle and the rear axle respectively. z The additional yaw moment generated by the longitudinal force difference between the left and right tires is:
[0033]
[0034] Among them, T qσ is the driving torque of each wheel, σ=fl, fr, rl, rr, representing the left front wheel, right front wheel, left rear wheel, right rear wheel, t wσ Satisfy t wfl =t wfr =t wf , t wrl =t wrr =t wr , t wf ,t wr are the wheelbases of the front and rear wheels of the vehicle, R e is the wheel rolling radius.
[0035] When the lateral acceleration is less than 0.4g (g is the acceleration of gravity), the slip angle does not exceed 4° to 5°. The relationship between the tire lateral force and the slip angle can be expressed as a linear relationship, which can be written as:
[0036] F yf =-k f α f , F yr =-k r α r (4)
[0037] Among them, k f and k r are the cornering stiffness of the front and rear tires respectively. f and α r is the front and rear tire slip angle, defined as:
[0038]
[0039] Assuming that the steering angles of the front and rear wheels are small, cosδ in equations (1) and (2) is f ≈cosδ r≈1. Substituting equations (4) and (5), the vehicle model described by equations (1) and (2) can be simplified to the following linear dynamic equation:
[0040]
[0041] Wheel dynamics equation:
[0042]
[0043] In the formula, ω σ is the rolling angular velocity of each wheel, I ω is the wheel moment of inertia, F zσ The vertical force on each wheel during the vehicle's roll and pitch motion is not considered, and μ is the road friction coefficient.
[0044]
[0045] In the formula, m ω is the sprung mass, and h is the height of the sprung center of mass.
[0046] The desired wheel rolling angular velocity ω is calculated from the wheel center velocity dσ :
[0047]
[0048] Where η wfl =η wrl =-1,η wfr =η wrr =1.
[0049] Desired wheel rolling angular velocity ω dσ Derivatives:
[0050]
[0051] In order to control the tire slip rate, the desired wheel angular velocity is set to the angular velocity of the wheel when it is in pure rolling, so the desired tire slip state is Δω σ =ω σ -ω dσ =0, indicating that the tire has no slip.
[0052]
[0053] 2.2 Path tracking model
[0054] In order to enable the vehicle to accurately track the target path, a path tracking control strategy is designed to reduce the heading angle error The lateral position error Δy is minimized. Δy is the lateral deviation between the center of mass of the vehicle and the closest point d on the reference path, R is the arc length along the reference path, and are the desired heading angle on the reference path and the actual heading angle of the car, respectively.
[0055] Actual heading angle and target heading angle The difference is the heading angle error, which is
[0056]
[0057] Based on the Serret-Frenet coordinate system and linearized by the small angle assumption, we can obtain:
[0058]
[0059] Where ρ is the curvature corresponding to the reference path point.
[0060] The lateral position error satisfies the following equation:
[0061]
[0062] Under ideal steady-state conditions, Therefore, according to equations (13) and (14), γ d =v x ρ; v yd = 0, let Δγ = γ-γ d , Δv y =v y -v yd is the desired yaw rate γ d Tracking deviation, expected lateral velocity v yd tracking deviation.
[0063]
[0064]
[0065] make The path tracking model is obtained from equations (11), (13)-(16):
[0066]
[0067] u z =[δ β ,δ γ ,T fl ,T fr ,T rl ,T rr ] T ,
[0068]
[0069]
[0070]
[0071] Step 3: Based on the path tracking model obtained in step 2, redefine the output of the system, and decompose the path tracking model into an input-output subsystem and a zero dynamic subsystem by input-output linearization. The specific implementation is as follows:
[0072] In order to control the wheel slip rate while controlling the vehicle's handling stability and prevent excessive wheel slip, the wheel slip state Δω is calculated. σ , the lateral motion of the vehicle Δγ and Δv y As a state variable, we control x z1 =Δv y ,x z2 =Δγ,x z3 =Δω fl ,x z4 =Δω fr ,x z5 =Δω rl ,x z6 =Δω rr , considering the influence of the slip state of the four wheels on the trajectory tracking error and yaw stability, the output of the system is redefined as:
[0073]
[0074] In the formula, the design parameter k i1 , k i2 , k i3 is a constant to be determined, i = 1, 2, ..., 6. By selecting appropriate design parameters k i1 , k i2 , k i3 , which can ensure the internal dynamic stability of the system.
[0075] By taking the derivative of equation (18), according to the path tracking model (17), the heading angle error (12) and the lateral position error (13), the input-output subsystem can be obtained:
[0076]
[0077] In the formula,
[0078]
[0079]
[0080] K z3=[k 12 ,k 22 ,k 32 ,k 42 ,k 52 ,k 62 ] T
[0081]
[0082] Since the trajectory tracking model (17) is 8-dimensional and the input-output subsystem (19) is only 6-dimensional, the remaining 2-dimensional system states, namely the heading angle following error (13) and the lateral displacement following error (14), constitute the internal subsystem of the trajectory tracking control system. It can be seen that by adopting the method of redefining the system output (18), the path tracking control system (17) is decomposed into the input-output subsystem (19) and the internal subsystems (13)-(14).
[0083] When a specific control input u z , so that when the output z of the input-output subsystem (19) is zero, the internal subsystems (13) and (14) are zero dynamic subsystems. Ensuring the local stability of the zero dynamic subsystem can ensure the local asymptotic stability of the entire closed-loop system. Therefore, the present invention proposes an adaptive sliding mode control strategy based on multi-agents for the input-output subsystem, so that the input-output subsystem converges to zero in a finite time; for the internal subsystem, when a specific control input u z When the output of the input-output subsystem is zero, the internal subsystem is the zero dynamic subsystem. By selecting reasonable controller design parameters, the zero dynamic subsystem is asymptotically stable near the equilibrium point, thereby ensuring the asymptotic stability of the intelligent electric vehicle trajectory tracking control system.
[0084] Step 4: Consider the 6 degrees of freedom equations in the input-output subsystem as 6 intelligent agents. According to the internal working communication of the 6 intelligent agents, determine the communication topology of the 6 intelligent agents in the input-output subsystem. Based on the graph theory method, obtain the adjacency matrix A, in-degree matrix D, Laplace matrix L and correlation matrix B for information exchange between the 6 intelligent agents. The specific implementation method is as follows:
[0085] Let K B =K z1 B z , K A =K z1 A z +K z2 According to formula (19), we can know that K z1 B z is a diagonal matrix. Rewrite the input-output subsystem (19) as follows:
[0086]
[0087] In the formula, K Aii Denotes the matrix K A The element in the i-th row and i-th column, K Aij Denotes the matrix K A The element in row i and column j, K Bii Denotes the matrix K B The element at the i-th row and i-th column.
[0088] Drawing on the theory of multi-agents, each degree of freedom equation in the input-output subsystem (20) is regarded as an agent. For the i-th agent (20), a terminal sliding mode control strategy based on multi-agents is proposed. Through the network interconnection of 6 agents, sharing resources and mutual communication, the tasks of the entire input-output subsystem are completed together. From the comparison of equations (19) and (20), it can be seen that the 6-dimensional input-output subsystem is organized into 6 1-dimensional agents that collaborate to complete the task, achieving model dimensionality reduction.
[0089] According to graph theory, any multi-agent system can be represented as G = (V, E, A), where V = {1, 2, ..., 6} represents a set of nodes. represents the edge set, A=[a ij ] is the adjacency matrix of G, a ij Used to describe the relationship between each node and edge. If (i,j)∈E then a ij =1, otherwise a ij = 0. The correlation matrix B = diag(b1, b2, ..., b6), b i >0 means that the i-th agent can receive the communication information sent by the leader; b i =0 means that the i-th agent cannot receive the communication information sent by the leader. The in-degree matrix D = diag(d1, d2, ..., d6), Laplace matrix L = DA, L = [l ij ], each element is defined as:
[0090]
[0091] According to the communication topology of the six agents (20), the topological structure diagram of each agent in the input and output subsystem can be obtained, as shown in Figure 1 shown. Figure 1 In the equation, agents 1-6 are the 6 degrees of freedom equations of the input and output subsystems respectively. Based on graph theory, the adjacency matrix A, in-degree matrix D, Laplace matrix L and correlation matrix B between the 6 agents can be obtained:
[0092]
[0093] Step 5: Based on the Y-axis coordinates, X-axis coordinates, heading angle, lateral velocity and acceleration, longitudinal velocity and acceleration, heading angular velocity, rolling angular velocity of each wheel, vertical force of each wheel, etc. output by the CarSim car model, the controller parameters are designed with the goal of fast convergence of the zero dynamic subsystem state obtained in step 3. The specific implementation method is as follows:
[0094] The 2D state variables of the internal subsystem (heading angle following error The lateral displacement following error Δy) is derivatized twice so that the control u z Appear:
[0095]
[0096] General Substituting (22) and (23), we can obtain
[0097]
[0098] In the formula,
[0099]
[0100] From the input and output subsystem, we can see that when the system state converges to zero in a finite time, that is, Available z =-(K z1 B z ) -1 [(K z1 A z +K z2 )x z +D z ], and bring it into the internal subsystem (24), the zero dynamic subsystem can be obtained as follows:
[0101]
[0102] make:
[0103]
[0104] The following equation can be obtained:
[0105]
[0106] Substituting equation (26) into (25), we can obtain
[0107]
[0108] From formula (27), we can see that if [A ο -B ο (K z1 B z) -1 K N2 K N3 ] is strictly guaranteed to be in the left half plane of the complex plane, then the equilibrium point of the original nonlinear system is asymptotically stable. Therefore, we select a suitable parameter k to redefine the system output. i1 , k i2 , k i3 , i = 1, 2, ..., 6, so that the matrix [A ο -B ο (K z1 B z ) -1 K N2 K N3 ] are all negative, then the zero dynamic subsystem (27) of the path tracking control system will be at the equilibrium point Approaching stability.
[0109] Step 6: Based on the given reference trajectory, the input-output subsystem obtained in step 3, the adjacency matrix, in-degree matrix, Laplace matrix and correlation matrix for information exchange between the six agents obtained in step 4, and the controller parameters obtained in step 5, the four-wheel steering angle and four-wheel drive torque are obtained through the multi-agent-based input-output subsystem adaptive sliding mode control module. The specific implementation is as follows:
[0110] According to the basic knowledge of multi-agent graph theory and the topological structure diagram of each agent in the input and output subsystem, the deviation equation of the i-th agent following the leader is defined as follows:
[0111]
[0112] Where z0 is the state variable of the leader, satisfying z0=0,l ij is the element of the Laplace matrix L.
[0113] Let τ i =∫υ i dt, for the i-th agent of the input-output subsystem, the following terminal sliding surface is introduced:
[0114]
[0115] In the formula, c1, c2, c3>0, 0<g1<2, Expressed as
[0116]
[0117] In the formula, g2 is an odd number, 0<g1 / g2<1, Υ is a positive number,
[0118] Let the sliding mode switching coefficient When the road friction coefficient of the ith agent is unknown, or the state parameters of other agents are unknown due to communication or other reasons, D zi , β si Unknown. β si The estimated value of , for the i-th agent (20) of the input-output subsystem, the following control strategy (31) and Adaptation rate (32):
[0119]
[0120] The adaptive rate is designed as follows:
[0121]
[0122] In the formula, ρ β is the design parameter, and ρ β >0.
Claims
1. A fast path tracking distributed control method for a four-wheel drive intelligent electric vehicle, characterized in that: The method comprises the following steps: Step 1: Use the CarSim car model to obtain the real-time parameters of the vehicle: Y-axis coordinates, X-axis coordinates, heading angle, lateral speed and acceleration, longitudinal speed and acceleration, heading angular velocity, rolling angular velocity of each wheel, and vertical force of each wheel; Step 2: Establish a path tracking model for the four-wheel drive smart electric vehicle based on the kinematics and dynamics of the vehicle; Step 3: Based on the path tracking model obtained in step 2, redefine the output of the system, and decompose the path tracking model into an input-output subsystem and a zero dynamic subsystem by input-output linearization; Step 4: Consider the 6 degrees of freedom equations in the input-output subsystem as 6 intelligent agents. According to the internal working communication of the 6 intelligent agents, determine the topological structure of the 6 intelligent agents in the input-output subsystem. Based on the graph theory method, obtain the adjacency matrix A, in-degree matrix D, Laplace matrix L and correlation matrix B used for information exchange between the 6 intelligent agents. Step 5: Based on the Y-axis coordinates, X-axis coordinates, heading angle, lateral velocity and acceleration, longitudinal velocity and acceleration, heading angular velocity, rolling angular velocity of each wheel, and vertical force of each wheel output by the CarSim vehicle model, the controller parameters are designed with the goal of fast convergence of the zero dynamic subsystem state obtained in step 3; Step 6. Based on the given reference trajectory, the input-output subsystem obtained in step 3, the adjacency matrix, in-degree matrix, Laplace matrix and correlation matrix for information exchange between the six agents obtained in step 4, and the controller parameters obtained in step 5, the four-wheel steering angle and four-wheel drive torque are obtained through the multi-agent-based input-output subsystem adaptive sliding mode control module, and input them into the CarSim vehicle model.
2. The fast path tracking distributed control method of the four-wheel drive intelligent electric vehicle as claimed in claim 1, characterized in that: The implementation process of the path tracking model of the four-wheel drive intelligent electric vehicle in step 2 is as follows: 2.1 Vehicle dynamics model In the design of the controller, the handling dynamics model of the four-wheel drive smart electric vehicle can be described as: Among them, v x and v y are the longitudinal and lateral velocities of the vehicle, respectively; r is the yaw rate; m and I z is the vehicle mass and yaw inertia; F yf and F yr is the lateral force of the front and rear tires; δ f and δ r is the front and rear wheel steering angle; l f and l r are the distances from the center of mass of the vehicle to the front axle and the rear axle respectively; ΔM z The additional yaw moment generated by the longitudinal force difference between the left and right tires is: Among them, T qσ is the driving torque of each wheel, σ=fl, fr, rl, rr, representing the left front wheel, right front wheel, left rear wheel, right rear wheel, t wσ Satisfy t wfl =t wfr =0.5t wf , t wrl =t wrr =0.5t wr , t wf ,t wr are the wheelbases of the front and rear wheels of the vehicle, R e is the wheel rolling radius; When the lateral acceleration is less than 0.4g (g is the acceleration of gravity), the slip angle does not exceed 4° to 5°. The relationship between the tire lateral force and the slip angle can be expressed as a linear relationship, which can be written as: F yf =-k f a f ,F yr =-k r a r (4) Among them, k f and k r are the cornering stiffness of the front and rear tires respectively; α f and α r is the front and rear tire slip angle, defined as: Assuming that the steering angles of the front and rear wheels are small, cosδ in equations (1) and (2) is f ≈cosδ r ≈1; Substituting equations (4) and (5), the vehicle model described by equations (1) and (2) can be simplified to the following linear dynamic equation: Wheel dynamics equation: In the formula, ω σ is the rolling angular velocity of each wheel, I ω is the wheel moment of inertia, F zσ is the vertical force of each wheel when the vehicle rolls and pitches, μ is the road friction coefficient; In the formula, m ω is the sprung mass, h is the height of the sprung mass center; The desired wheel rolling angular velocity ω is calculated from the wheel center velocity dσ : where η wfl = η wrl = -1, η wfr = η wrr = 1; Desired wheel rolling angular velocity ω dσ Derivatives: In order to control the tire slip rate, the desired wheel angular velocity is set to the angular velocity of the wheel when it is in pure rolling, so the desired tire slip state is Δω σ =ω σ -ω dσ =0, indicating that the tire has no slip; 2.2 Path tracking model In order to enable the vehicle to accurately track the target path, a path tracking control strategy is designed to reduce the heading angle error and the lateral position error Δy is minimized; Δy is the lateral deviation between the center of mass of the vehicle and the closest point d on the reference path, R is the arc length along the reference path, and are the desired heading angle on the reference path and the actual heading angle of the vehicle, respectively; Actual heading angle and target heading angle The difference is the heading angle error, which is Based on the Serret-Frenet coordinate system and linearized by the small angle assumption, we can obtain: Where ρ is the curvature corresponding to the reference path point; The lateral position error satisfies the following equation: Under ideal steady-state conditions, Therefore, according to equations (13) and (14), γ d =v x ρ; v yd = 0, let Δγ = γ-γ d , Δv y =v y -v yd is the desired yaw rate γ d The tracking deviation and the expected lateral velocity v yd tracking deviation; make The path tracking model is obtained from equations (11), (13)-(16): u z =[δ β ,δ γ ,T fl ,T fr ,T rl ,T rr ] T , 3. The fast path tracking distributed control method of the four-wheel drive intelligent electric vehicle as claimed in claim 1, characterized in that: The implementation process of the input-output subsystem and zero dynamic subsystem model in step 3 is as follows: In order to control the wheel slip rate while controlling the vehicle's handling stability and prevent excessive wheel slip, the wheel slip state Δω is calculated. σ , the lateral motion of the vehicle Δγ and Δv y As a state variable, control; let x z1 =Δv y ,x z2 =Δγ,x z3 =Δω fl ,x z4 =Δω fr ,x z5 =Δω rl ,x z6 =Δω rr , considering the influence of the slip state of the four wheels on the trajectory tracking error and yaw stability, the output of the system is redefined as: In the formula, the design parameter k i1 , k i2 , k i3 is an undetermined constant, i=1,2,…,6; by selecting a suitable design parameter k i1 , k i2 , k i3 , which can ensure the internal dynamic stability of the system; By taking the derivative of equation (18), according to the path tracking model (17), the heading angle error (12) and the lateral position error (13), the input-output subsystem can be obtained: In the formula, K z3 =[k 12 ,k 22 ,k 32 ,k 42 ,k 52 ,k 62 ] T When a specific control input u z , so that when the output z of the input-output subsystem (19) is zero, the internal subsystems (13) and (14) are zero dynamic subsystems.
4. The fast path tracking distributed control method of the four-wheel drive intelligent electric vehicle as claimed in claim 1, characterized in that: The implementation process of obtaining the adjacency matrix, in-degree matrix, Laplace matrix and correlation matrix for information exchange between the six agents based on the graph theory method in step 4 is as follows: Let K B =K z1 B z , K A =K z1 A z +K z2 According to formula (19), we can know that K z1 B z is a diagonal matrix; rewrite the input-output subsystem (19) into the following form: In the formula, K Aii Denotes the matrix K A The element in the i-th row and i-th column, K Aij Denotes the matrix K A The element in row i and column j, K Bii Denotes the matrix K B The element in row i and column i; According to graph theory, any multi-agent system can be represented as G = (V, E, A), where V = {1, 2, ..., 6} represents a set of nodes. represents the edge set, A=[a ij ] is the adjacency matrix of G, a ij Used to describe the relationship between each node and edge; if (i, j) ∈ E then a ij =1, otherwise a ij =0; the correlation matrix B = diag(b1,b2,...,b6), b i >0 means that the i-th agent can receive the communication information sent by the leader; b i =0 means that the i-th agent cannot receive the communication information sent by the leader; the in-degree matrix D = diag(d1, d2, ..., d6), Laplace matrix L = DA, L = [l ij ], each element is defined as: According to the communication topology of the six agents (20), the topological structure diagram of each agent in the input and output subsystem can be obtained; in the figure, agents 1-6 are the six degree-of-freedom equations of the input and output subsystems respectively. Based on the knowledge of graph theory, the adjacency matrix A, in-degree matrix D, Laplace matrix L and correlation matrix B between the six agents can be obtained:
5. The fast path tracking distributed control method of the four-wheel drive intelligent electric vehicle as claimed in claim 1, characterized in that: The implementation process of controller parameter design described in step 5 is as follows: The 2D state variables of the internal subsystem (heading angle following error The lateral displacement following error Δy) is derivatized twice so that the control u z Appear: General Substituting (22) and (23), we can obtain In the formula, From the input and output subsystem, we can see that when the system state converges to zero in a finite time, that is, Available z =-(K z1 B z ) -1 [(K z1 A z +K z2 )x z +D z ], and bring it into the internal subsystem (24), the zero dynamic subsystem can be obtained as follows: make: The following equation can be obtained: Substituting equation (26) into (25), we can obtain From formula (27), we can see that if [A ο -B ο (K z1 B z ) -1 K N2 K N3 ] is strictly guaranteed to be in the left half plane of the complex plane, then the equilibrium point of the original nonlinear system is asymptotically stable; select an appropriate parameter k to redefine the system output i1 , k i2 , k i3 , i = 1, 2, ..., 6, so that the matrix [A ο -B ο (K z1 B z ) -1 K N2 K N3 ] are all negative, then the zero dynamic subsystem (27) of the path tracking control system will be at the equilibrium point Approaching stability.
6. The fast path tracking distributed control method of the four-wheel drive intelligent electric vehicle as claimed in claim 1, characterized in that: The implementation process of obtaining the four-wheel steering angle and four-wheel driving torque described in step 6 is as follows: According to the basic knowledge of multi-agent graph theory and the topological structure diagram of each agent in the input and output subsystem, the deviation equation of the i-th agent following the leader is defined as follows: Where z0 is the state variable of the leader, satisfying z0=0,l ij is the element of Laplace matrix L; Let τ i =∫υ i dt, for the i-th agent of the input-output subsystem, the following terminal sliding surface is introduced: In the formula, c1, c2, c3>0, 0<g1<2, Expressed as In the formula, g2 is an odd number, 0<g1 / g2<1, Υ is a positive number, Let the sliding mode switching coefficient When the road friction coefficient of the ith agent is unknown, or the state parameters of other agents are unknown due to communication or other reasons, D zi , β si unknown; make β si The estimated value of , for the i-th agent (20) of the input-output subsystem, the following control strategy (31) and the estimated value of the sliding mode switching term coefficient are proposed Adaptation rate (32): The adaptive rate is designed as follows: In the formula, ρ β is the design parameter, and ρ β >0.
Citation Information
Cited By
Distributed driving electric vehicle path tracking control method
CN119781472A
