Fault-tolerant control method, medium, system and vehicle for lane changing of autonomous driving vehicle

Through dynamic game theory combined with TFC and DYC, control strategies are optimized to deal with front wheel steering failures, and the lateral stability and trajectory tracking problems of autonomous vehicles under extreme operating conditions are solved, achieving safe lane change in the event of failure.

CN115179963BActive Publication Date: 2024-11-05HUNAN UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210839980.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-07-18
Publication Date
2024-11-05
Estimated Expiration
2042-07-18

AI Technical Summary

Technical Problem

In the extreme operating conditions, existing autonomous driving vehicles have deteriorated due to the tire side tilt force approaching saturation, and their lateral stability performance has deteriorated, resulting in deterioration of the trajectory tracking control effect and failure to effectively deal with the risk of lane change failure caused by front wheel angle failure.

Method used

Using dynamic game theory combined with trajectory tracking control (TFC) and direct yaw torque control (DYC), the failure coefficients of front wheel execution are obtained in real time, the weight coefficients are dynamically adjusted, and the control strategy is optimized to ensure that the vehicle is partially or completely in front wheel steering. The lane change operation can be successfully completed when it fails.

Benefits of technology

It improves the lateral stability performance and path tracking capabilities of autonomous driving vehicles under extreme operating conditions, ensuring that lane change can be safely completed in the case of front wheel steering failure and avoid accidents.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115179963B_ABST
    Figure CN115179963B_ABST
Patent Text Reader

Abstract

The present invention discloses a fault-tolerant control method, medium, system and automobile for lane changing of an autonomous driving vehicle, including: obtaining the current state information and expected path information of the vehicle, establishing a state equation model of discrete tracking error variables; constructing cost functions by adopting the best front wheel steering angle to achieve the best path and generating the best additional yaw moment to achieve the best lateral stability as the goals of TFC and DYC; introducing the failure coefficient α executed by the front wheel into the constructed cost function to obtain a time-varying cost function, and changing the control amount weight of the time-varying cost function according to the size of α when the vehicle is running in real time; solving the optimal control amount, and applying the optimal control amount to the autonomous driving vehicle to enable the vehicle to complete the lane changing operation. Construct the cost function of the two goals, and solve the optimal control strategy through dynamic game theory. And by obtaining α in real time, dynamically adjust the weight coefficient, so that the vehicle can successfully complete the lane changing operation.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of autonomous driving technology, and in particular to a fault-tolerant control method, medium, system and vehicle for lane changing of an autonomous driving vehicle. Background Art

[0002] Trajectory Following Control (TFC) is one of the key technologies in the control direction of autonomous vehicles. Its goal is to obtain the control quantity of the vehicle, such as the front wheel angle, based on the planned trajectory and the real-time status information of the vehicle to ensure that the vehicle drives along the desired trajectory. The accuracy of its tracking will directly affect the performance and safety of the autonomous vehicle. However, under certain extreme conditions, the lateral stability of the vehicle will deteriorate due to the saturation of the tire's cornering force, resulting in a deterioration in the tracking control effect. Therefore, direct yaw moment control (DYC) is introduced on the original basis, which can control the lateral stability of the vehicle by adjusting the force state of the wheel to generate additional yaw moment. Therefore, in order to improve the trajectory tracking effect, the direct yaw moment control is coordinated with the steering system to improve the lateral stability of the vehicle.

[0003] Due to the coupling characteristics of the vehicle, TFC and DYC usually operate in an interactive manner during vehicle operation, that is, the control quantity of each controller may depend on the control quantity of another controller, so game theory can be used for research. Game theory, as a mathematical theory and method for studying phenomena with a fighting and competitive nature, is widely used in conflict decision-making fields such as economy and politics. Non-cooperative game, as a type of dynamic game theory, can effectively solve the problem of control rights allocation for multiple participants. By defining TFC and DYC as two participants with different control objects, interactive control between them is achieved, and the lateral stability performance and path tracking ability of the vehicle are improved. The introduction of game theory provides a good framework for exploring the robustness of control, while reducing complexity and enhancing synergy and scalability.

[0004] The patent with application number 202111180026.5 discloses a commercial lateral trajectory following and stability collaborative control method based on game theory. First, a three-degree-of-freedom vehicle model is established, and a vehicle-road model is constructed, and then a performance index function is constructed, which is solved by the principle of dynamic programming. However, the three-degree-of-freedom vehicle model used is based on active front-wheel steering, which assists the driver in maneuvering by estimating the front wheel angle to achieve the purpose of stabilizing the vehicle; the vehicle tracking error model is easy to calculate and has universal applicability; but it does not consider the situation where the front wheel angle fails, and its cost function is fixed. When the front wheel steering actuator fails, it may cause the expected behavior, such as lane changing, to fail to complete normally, which may lead to an accident. Summary of the invention

[0005] The present invention provides a fault-tolerant control method, medium, system and vehicle for lane changing of an autonomous driving vehicle. During the lane changing process of the vehicle, TFC and DYC respectively optimize the path tracking performance and the lateral stability performance of the vehicle, and solve the optimal control strategy through dynamic game theory. In addition, during the lane changing process of the vehicle, the actuator failure is considered, and the failure coefficient of the front wheel execution is obtained in real time, and the weight coefficient is dynamically adjusted, so that the vehicle can successfully complete the lane changing operation in the case of partial or complete failure of the front wheel steering, avoiding accidents.

[0006] In a first aspect, the present invention provides a fault-tolerant control method for lane changing of an autonomous driving vehicle, comprising:

[0007] Obtain the current state information and expected path information of the vehicle, and then establish a state equation model of discrete tracking error variables;

[0008] The cost function J1 is constructed by taking the best front wheel steering angle to achieve the best path tracking performance as the target of trajectory tracking control (TFC), and the cost function J2 is constructed by generating the best additional yaw moment to achieve the best lateral stability performance as the target of direct yaw moment control (DYC);

[0009] The failure coefficient of the front wheel execution is obtained according to the fault model of the actuator, and the failure coefficient of the front wheel execution is introduced into the constructed cost function to obtain a time-varying cost function, and then the control amount weights of the time-varying cost functions of trajectory tracking control and direct yaw moment control are changed accordingly according to the size of the failure coefficient of the front wheel execution when the vehicle is running in real time;

[0010] Solve the optimal control quantity based on dynamic game theory, that is, the optimal front wheel steering angle and the optimal additional yaw moment;

[0011] The optimal control amount is applied to the autonomous driving vehicle to enable the vehicle to complete the lane changing operation.

[0012] Furthermore, the state information includes the vehicle longitudinal speed, the vehicle lateral speed, the vehicle current heading angle, the vehicle current yaw angular velocity, and the vehicle current position information; the expected path information includes the reference point expected position information, the reference point expected heading angle, and the reference point curvature.

[0013] Furthermore, the state space equation model of the discrete tracking error variable is:

[0014]

[0015] in,

[0016]

[0017] X(k) represents the system state at time k, Where e1 represents the distance from the vehicle's center of mass to the nearest point corresponding to the desired path; e2 represents the vehicle direction error relative to the lane; n represents the discretization interval; δ f represents the front wheel turning angle of the vehicle; ΔM represents the additional yaw moment of the vehicle; represents the yaw foot speed determined by the road curvature, v x represents the longitudinal velocity of the vehicle, ρ represents the curvature of the reference point; C αf Indicates the vehicle's front wheel cornering stiffness; C αr Indicates the vehicle rear wheel cornering stiffness; l f Indicates the distance from the vehicle's center of mass to the front axle; l r represents the distance from the center of mass of the vehicle to the rear axle; m represents the mass of the vehicle; I z represents the moment of inertia around the vehicle's z-axis; T s Indicates the sampling time.

[0018] Furthermore, the cost functions J1 and J2 are respectively:

[0019]

[0020]

[0021] in,

[0022]

[0023]

[0024] N p represents the prediction time domain; X(k+i) represents the system state at time k+i; Q1 and Q2 represent the system state weight matrix; q e1 represents the weight coefficient of e1; q e2 represents the weight coefficient of e2; express The weight coefficient of express The weight coefficient of the vehicle is: e1 represents the distance from the vehicle center of mass to the nearest point corresponding to the desired path; e2 represents the vehicle direction error relative to the lane; R 11 Represents the weight coefficient of the control input front wheel steering angle; R 22 represents the weight coefficient of the additional yaw moment of the control input; δ f (k+i) represents the front wheel steering angle control amount input at time k+i; ΔM(k+i) represents the additional yaw moment control amount input at time k+i;

[0025] Furthermore, the actuator fault model is:

[0026]

[0027] in, is the actual front wheel steering angle; is the front wheel steering angle of the control input; α is the failure coefficient of the front wheel execution, 0≤α≤1, when α=0, it means that the front wheel steering has no fault; when α=1, it means that the front wheel steering has completely failed.

[0028] Furthermore, according to the change in the size of the failure coefficient, the control amount weight of the cost function is:

[0029] When 0≤α<1, that is, the front wheel is partially ineffective:

[0030]

[0031]

[0032] Among them, ω1≥1, ω2≤1; represents the weight coefficient of the control input front wheel steering angle after the change; ω1 represents the gain coefficient of the control input front wheel steering angle; R 11 Represents the weight coefficient of the control input front wheel steering angle; represents the weight coefficient of the additional yaw moment of the control input after the change; ω2 represents the gain coefficient of the additional yaw moment of the control input; R 22 Represents the weight coefficient of the additional yaw moment of the original control input;

[0033] When α=1, that is, the front wheel fails completely:

[0034]

[0035]

[0036] Where, <1; INF means infinity; ω means the gain coefficient of the control input additional yaw moment when α=1;

[0037] Furthermore, the optimal additional yaw moment cannot act directly on the vehicle, and the driving torque of the four wheels of the vehicle is distributed to the wheel torque according to the front and rear axle load ratio of the vehicle, so as to meet the requirements of the total driving force and additional yaw moment of the vehicle. The driving torque of each wheel is specifically distributed as follows:

[0038]

[0039]

[0040]

[0041]

[0042] Among them, T fl Indicates the driving torque of the left front wheel of the vehicle; T fr Indicates the driving torque of the right front wheel of the vehicle; T rl Indicates the driving torque of the left rear wheel of the vehicle; T rr Indicates the driving torque of the right rear wheel of the vehicle; F des represents the total longitudinal driving force; m represents the total mass of the vehicle; g represents the acceleration due to gravity; l r Indicates the distance from the vehicle's center of mass to the rear axle; l f Indicates the distance from the vehicle's center of mass to the front axle; ΔM Nash represents the additional yaw moment based on the solution of the dynamic game; a x Indicates the longitudinal acceleration of the vehicle; h c represents the height of the vehicle's center of mass; L represents the vehicle's wheelbase; r represents the wheel rolling radius; W represents the wheelbase.

[0043] In a second aspect, the present invention provides a computer-readable storage medium storing a computer program, wherein the computer program is suitable for being loaded by a processor and executing the fault-tolerant control method for lane changing of an autonomous driving vehicle as described above.

[0044] In a third aspect, the present invention provides a fault-tolerant control system for lane changing of an autonomous driving vehicle, comprising:

[0045] Trajectory planning module, fault diagnosis module, autonomous driving vehicle driving subsystem, autonomous driving vehicle steering subsystem, and fault-tolerant controller for autonomous driving vehicle lane changing based on dynamic game;

[0046] The trajectory planning module is used to provide the desired path information;

[0047] The fault diagnosis module is used for the actuator fault model to estimate the failure coefficient of the front wheel actuator in real time according to the front wheel steering angle;

[0048] The autonomous driving vehicle drive subsystem is used to drive the vehicle to complete longitudinal movement by the actuator;

[0049] The steering subsystem of the autonomous vehicle is used to drive the vehicle to complete lateral movement;

[0050] The fault-tolerant controller for lane changing of an autonomous driving vehicle based on dynamic game is used to establish a state equation model of discrete tracking error variables according to the current state information and expected path information of the vehicle; based on the established state equation model of discrete tracking error variables, the optimal front wheel steering angle is used to achieve the best path tracking performance as the target of trajectory tracking control to construct the cost function J1, and the cost function J2 is constructed by generating the best additional yaw moment to achieve the best lateral stability performance as the target of direct yaw moment control; then the failure coefficient executed by the front wheels is introduced into the constructed cost function to obtain a time-varying cost function, and the control amount weight of the time-varying cost function is changed accordingly according to the size of the failure coefficient executed by the front wheels when the vehicle is running in real time; the optimal control amount is calculated, and then the optimal control amount is applied to the driving subsystem and the steering subsystem of the autonomous driving vehicle.

[0051] In a fourth aspect, the present invention provides a car, comprising the fault-tolerant control system for lane changing of an autonomous driving vehicle as described above.

[0052] Beneficial Effects

[0053] The present invention provides a fault-tolerant control method, medium, system and vehicle for lane changing of an autonomous driving vehicle, which have the following advantages:

[0054] (1) The TFC-DYC controller is designed based on dynamic game theory to reduce computational complexity while enhancing synergy and scalability. From the perspective of trajectory tracking, a dynamic model of trajectory tracking error is established. In order to ensure both path tracking performance and lateral stability performance, a controller is designed based on dynamic game theory to solve the problem and improve the performance of autonomous driving vehicles.

[0055] (2) The fault-tolerant design of the time-varying cost function can estimate the front wheel failure coefficient in real time during the operation of the vehicle from a safety perspective when the front wheel steering fails during lane change. The time-varying cost function is then designed to achieve the change of the weights of TFC and DYC. This allows the autonomous driving vehicle to successfully complete lane change and other operations when the front wheel steering actuator fails, ensuring safety and avoiding accidents. BRIEF DESCRIPTION OF THE DRAWINGS

[0056] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0057] Figure 1 is a schematic diagram of a vehicle dynamics model provided by the present invention;

[0058] Figure 2 is a schematic diagram of a vehicle tracking error model provided by the present invention;

[0059] Figure 3 It is a flow chart of a fault-tolerant control method for lane changing of an autonomous driving vehicle provided by the present invention;

[0060] Figure 4 It is an architecture diagram of a fault-tolerant control system for lane changing of an autonomous driving vehicle provided by the present invention; DETAILED DESCRIPTION

[0061] To make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be described in detail below. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all the embodiments. Based on the embodiments of the present invention, all other implementation methods obtained by ordinary technicians in this field without creative work belong to the scope of protection of the present invention.

[0062] Example 1

[0063] like Figure 1-3 As shown, the present invention provides a fault-tolerant control method for lane changing of an autonomous driving vehicle, comprising the following steps:

[0064] Step 1: Get the current state information of the vehicle, including the longitudinal speed v x (m / s), vehicle lateral speed v y (m / s), vehicle's current heading angle The current yaw rate of the vehicle The vehicle's current position information (x, y); obtain the desired trajectory information, including the reference point position information (x r ,y r ), reference point expected heading angle Reference point curvature ρ.

[0065] Step 2: If Figure 1 As shown, the vehicle lateral position x and the vehicle heading angle The bicycle model is a two-degree-of-freedom vehicle with a degree of freedom. Ignoring the road slope and applying Newton's second law along the Y axis, the dynamic equation for lateral translation motion can be obtained:

[0066]

[0067] Wherein, m represents the vehicle mass; y represents the longitudinal position information; is the current heading angle of the vehicle; v x Indicates the longitudinal speed of the vehicle; F yf Indicates the lateral force of the front wheel; F yr Represents the lateral force on the tire of the rear wheel.

[0068] According to the torque balance equation around the z-axis, the yaw dynamic equation can be obtained:

[0069]

[0070] Among them, I z represents the moment of inertia around the z-axis; l f Indicates the distance from the vehicle's center of mass to the front axle; l r represents the distance from the vehicle's center of mass to the rear axle; ΔM represents the additional yaw moment.

[0071] When the tire slip angle is small, the lateral force of the tire is proportional to the tire slip angle, and the lateral force of the front wheel of the vehicle is:

[0072] F yf =2C αf (δ f -θ f ) (3)

[0073] Among them, F yf Indicates the lateral force of the front wheel of the vehicle; C αf represents the front wheel cornering stiffness; δ f represents the front wheel turning angle; θ f represents the front wheel speed angle;

[0074] Similarly, the lateral force on the rear wheels of the vehicle can be expressed as:

[0075] F yr =2C αr (-θ r ) (4)

[0076] Among them, F yf Indicates the lateral force of the rear wheels of the vehicle; C αr Represents the rear wheel cornering stiffness; θ r Represents the rear wheel speed angle.

[0077] and

[0078]

[0079]

[0080] Then, the state equation model of the tracking error variable is established, such as Figure 2 As shown, p0 represents the center of mass of the vehicle, and p1 represents the corresponding nearest point on the desired path.

[0081] definition:

[0082]

[0083]

[0084] Among them, e1 represents the distance from the center of mass of the vehicle to the nearest point corresponding to the desired path;

[0085] definition:

[0086]

[0087]

[0088] Where e2 represents the vehicle direction error relative to the lane; represents the yaw rate determined by the road curvature, ρ is the reference point curvature;

[0089] Combining (1)-(10), we get the state equation model of the tracking error variable:

[0090]

[0091] in,

[0092] X represents the system state quantity.

[0093] In order to meet the requirements of controller design, the zero-order hold method is used to discretize equation (11), and finally the discrete state space equation is obtained:

[0094]

[0095] Among them, X(k) represents the system state at time k, e1 represents the distance from the vehicle's center of mass to the nearest point corresponding to the desired path; e2 represents the vehicle's direction error relative to the lane; n represents the discretization interval; T s Indicates the sampling time.

[0096] Step 3: Considering trajectory tracking control and direct yaw moment control as two independent participants, the optimal front wheel steering angle is used to achieve the best path tracking performance as the goal of trajectory tracking control to construct the cost function J1, and the optimal additional yaw moment is used to generate the best lateral stability performance as the goal of direct yaw moment control to construct the cost function J2;

[0097]

[0098]

[0099] in,

[0100]

[0101]

[0102] N p represents the prediction time domain; X(k+i) represents the system state at time k+i; Q1 and Q2 represent the system state weight matrix; q e1 represents the weight coefficient of e1; q e2 represents the weight coefficient of e2; express The weight coefficient of express The weight coefficient of 11 Represents the weight coefficient of the control input front wheel steering angle; R 22 represents the weight coefficient of the additional yaw moment of the control input; δ f (k+i) represents the front wheel steering angle control amount input at time k+i; ΔM(k+i) represents the additional yaw moment control amount input at time k+i;

[0103] Step 4: The steering failure of the vehicle wheel is mainly manifested as partial or complete failure of the steering actuator, which may cause the vehicle to fail to obtain the actual expected steering when the front wheel receives the steering command. Therefore, the loss of the front wheel steering control command is regarded as the decline in the control efficiency of the vehicle steering mechanism, and the failure coefficient of the front wheel execution is defined as α, 0≤α≤1. When α=0, it means that the front wheel steering has no fault, and when α=1, it means that the front wheel steering has completely failed. The actuator fault model is established:

[0104]

[0105] in, Indicates the actual front wheel steering angle; The front wheel angle representing the control input.

[0106] The vehicle's lane changing operation requires turning the steering wheel to steer the front wheels. When the front wheel steering actuator fails partially or completely, the front wheel angle will not be able to reach the expected control input angle. The controller calculates the expected front wheel angle and additional yaw moment according to the original rules. Without any compensation operation, the vehicle cannot complete the normal lane change, which leads to serious consequences. Therefore, the failure coefficient α of the front wheel execution is introduced into the constructed cost function to obtain a time-varying cost function. By obtaining the size of the failure coefficient α of the front wheel actuator in real time, the control weight coefficient of the cost function is dynamically adjusted to achieve the change of the weights of TFC and DYC. Change the corresponding control weight R, when R ii The larger the value, the smaller the corresponding control amount will be. When the front wheel fails completely, the control weight of TFC becomes infinite, and the control weight of DYC is appropriately reduced. When the front wheel turning angle is zero, steering can be achieved by relying solely on the additional yaw torque.

[0107] When 0≤α<1, that is, partial failure:

[0108]

[0109]

[0110] In the formula, represents the weight coefficient of the control input front wheel steering angle after the change; ω1 represents the gain coefficient of the control input front wheel steering angle; R 11 Represents the weight coefficient of the control input front wheel steering angle; represents the weight coefficient of the additional yaw moment of the control input after the change; ω2 represents the gain coefficient of the additional yaw moment of the control input; R 22 Represents the weight coefficient of the control input additional yaw moment; where ω1≥1, ω2≤1.

[0111] When α=1, that is, complete failure:

[0112]

[0113]

[0114] Where INF represents infinity; ω represents the gain coefficient of the control input additional yaw moment when α=1, ω<1.

[0115] Step 5: Solve the optimal control quantity based on dynamic game theory. The specific process includes:

[0116] According to the Nash equilibrium theory, a set of coupled Riccati equations are established based on the idea of ​​linear quadratic (LQ) differential game and solved through iteration.

[0117] In non-cooperative games, Nash equilibrium theory is defined as a combination of control actions whose property is that if only one player changes his decision and the other players stick to their own choices, then no player will benefit. When this concept is converted to the TFC-DYC non-cooperative game, the control action combination is represents the Nash solution of the front wheel steering angle, ΔM Nash represents the Nash solution of the additional yaw moment and satisfies the following conditions:

[0118]

[0119]

[0120] in, represents the optimal solution of the front wheel turning angle; ΔM * represents the optimal solution for the additional yaw moment.

[0121] The corresponding Hamiltonian function is established for the above optimization problem, which is expressed as:

[0122]

[0123] Among them, u1 represents the front wheel steering angle; u2 represents the additional yaw moment; j represents the participants, namely TFC and DYC.

[0124] Its canonical equations and terminal constraints are:

[0125]

[0126] Because u i Unconstrained, according to You can get:

[0127]

[0128]

[0129] Among them, λ1(k+τ+1) and λ2(k+τ+1) represent the adjoint variables that satisfy the canonical equation and terminal constraints;

[0130] Because λ has a linear relationship with X, that is:

[0131] λ i (k+τ)=P i (k+τ)X(k+τ) (24)

[0132] Among them, P i (k+τ) represents a positive definite matrix;

[0133] Ignore noisy road reference signal Substitute equations (22) to (24) into equation (12), and we get:

[0134]

[0135] Substitute equations (22) and (23) into equations (20) and (21):

[0136]

[0137]

[0138] where \(I\) represents the identity matrix.

[0139] Substitute equations (24) and (25) into equation (21), and a coupled Riccati equation can be obtained, and \(P(k + \tau)\) can be calculated by an iterative method: i (k + τ):

[0140]

[0141]

[0142] where the terminal conditions are \(P_1(k + N p ) = Q_1\) and \(P_2(k + N p ) = Q_2\).

[0143] Step 6: Since the additional yaw moment cannot act directly on the vehicle, after iteratively solving the optimal front wheel angle and the optimal target additional yaw moment through equations (26) to (29), it is necessary to distribute the driving torques of the four wheels to meet the requirements of the total driving force and the additional yaw moment. In order to improve the stability margin of the wheels corresponding to the lower axle load, the torques of the wheels are distributed according to the front-to-rear axle load ratio.

[0144] The calculation formula for the front and rear axle loads of the vehicle is:

[0145]

[0146]

[0147] In the formula, \(F zf \) represents the front axle load of the vehicle; \(F zr \) represents the rear axle load of the vehicle; \(m\) represents the vehicle mass; \(g\) represents the gravitational acceleration; \(l r \) represents the distance from the vehicle center of mass to the rear axle; \(a x \) represents the vehicle longitudinal acceleration; \(h c \) represents the vehicle center of mass height; \(L\) represents the vehicle wheelbase; \(l f \) represents the distance from the vehicle center of mass to the front axle.

[0148] In order to meet the total driving force requirements, the torque of each wheel should meet the following requirements:

[0149]

[0150]

[0151] T fl +T fr +T rl +T rr =F des r

[0152]

[0153] Among them, F xj represents the longitudinal force on the front and rear tires of the vehicle, j = fl, fr, rl, rr; r represents the rolling radius of the wheel; W represents the wheelbase; T fl Indicates the driving torque of the left front wheel of the vehicle; T fr Indicates the driving torque of the right front wheel of the vehicle; T rl Indicates the driving torque of the left rear wheel of the vehicle; T rr Indicates the driving torque of the right rear wheel of the vehicle.

[0154] The relationship between the torque and driving force of each wheel is:

[0155] T fl =rF xfl

[0156] T fr =rF xfr

[0157] T rl =rF xrl

[0158] T rr =rF xrr (32)

[0159] Combining equations (27) to (29), the driving torque of each wheel is obtained as:

[0160]

[0161]

[0162]

[0163]

[0164] Among them, F des represents the total longitudinal driving force;

[0165] Step 7: The optimal control quantity Apply it to the vehicle to make it move and update the vehicle state. Then, step 1 reacquires the vehicle state and starts a new round of control quantity calculation.

[0166] Example 2

[0167] This embodiment provides a computer-readable storage medium storing a computer program, wherein the computer program is suitable for being loaded by a processor and executing the fault-tolerant control method for lane changing of an autonomous driving vehicle as described above.

[0168] It should be understood that in the embodiments of the present invention, the processor may be a central processing unit (CPU), and the processor may also be other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or the processor may also be any conventional processor, etc. The memory may include a read-only memory and a random access memory, and provide instructions and data to the processor. A portion of the memory may also include a non-volatile random access memory. For example, the memory may also store information about the type of device.

[0169] The readable storage medium is a computer-readable storage medium, which may be an internal storage unit of the controller described in any of the foregoing embodiments, such as a hard disk or memory of the controller. The readable storage medium may also be an external storage device of the controller, such as a plug-in hard disk, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card, a flash card (Flash Card), etc. equipped on the controller. Furthermore, the readable storage medium may also include both an internal storage unit of the controller and an external storage device. The readable storage medium is used to store the computer program and other programs and data required by the controller. The readable storage medium may also be used to temporarily store data that has been output or is to be output.

[0170] Based on this understanding, the technical solution of the present invention, in essence or in other words, the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product, which is stored in a storage medium and includes several instructions for enabling a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present invention. The aforementioned readable storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk, etc., various media that can store program codes.

[0171] Example 3

[0172] This embodiment provides a fault-tolerant control system for lane changing of an autonomous driving vehicle, including:

[0173] Trajectory planning module, fault diagnosis module, autonomous driving vehicle driving subsystem, autonomous driving vehicle steering subsystem, and fault-tolerant controller for autonomous driving vehicle lane changing based on dynamic game;

[0174] The trajectory planning module is used to provide the desired path information;

[0175] The fault diagnosis module is used for the actuator fault model to estimate the failure coefficient of the front wheel actuator in real time according to the front wheel steering angle;

[0176] The autonomous driving vehicle drive subsystem is used to drive the vehicle to complete longitudinal movement by the actuator;

[0177] The steering subsystem of the autonomous vehicle is used to drive the vehicle to complete lateral movement;

[0178] The fault-tolerant controller for lane changing of an autonomous driving vehicle based on dynamic game is used to establish a state equation model of discrete tracking error variables according to the current state information and expected path information of the vehicle; based on the established state equation model of discrete tracking error variables, the optimal front wheel steering angle is used to achieve the best path tracking performance as the target of trajectory tracking control to construct the cost function J1, and the cost function J2 is constructed by generating the best additional yaw moment to achieve the best lateral stability performance as the target of direct yaw moment control; then the failure coefficient executed by the front wheels is introduced into the constructed cost function to obtain a time-varying cost function, and the control amount weight of the time-varying cost function is changed accordingly according to the size of the failure coefficient executed by the front wheels when the vehicle is running in real time; the optimal control amount is calculated, and then the optimal control amount is applied to the driving subsystem and the steering subsystem of the autonomous driving vehicle.

[0179] Example 4

[0180] This embodiment provides a car, which adopts the fault-tolerant control system for lane changing of the automatic driving vehicle as described in Example 3.

[0181] It can be understood that the same or similar parts of the above embodiments can be referenced to each other, and the contents not described in detail in some embodiments can refer to the same or similar contents in other embodiments.

[0182] Although the embodiments of the present invention have been shown and described above, it is to be understood that the above embodiments are exemplary and are not to be construed as limitations of the present invention. A person skilled in the art may change, modify, replace and vary the above embodiments within the scope of the present invention.

Claims

1. A fault-tolerant control method for lane changing of an autonomous driving vehicle, It is characterized in that include: Obtain the vehicle's current state information and expected path information, and then establish a state equation model of discrete tracking error variables; The cost function J is constructed by taking the optimal front wheel steering angle to achieve the best path tracking performance as the goal of trajectory tracking control. 1 , the cost function J is constructed by generating the best additional yaw moment to achieve the best lateral stability performance as the goal of direct yaw moment control 2 ; The failure coefficient of the front wheel execution is obtained according to the fault model of the actuator, and the failure coefficient of the front wheel execution is introduced into the constructed cost function to obtain a time-varying cost function, and then the control amount weights of the time-varying cost functions of trajectory tracking control and direct yaw moment control are changed accordingly according to the size of the failure coefficient of the front wheel execution when the vehicle is running in real time; Solve the optimal control quantity based on dynamic game theory, that is, the optimal front wheel steering angle and the optimal additional yaw moment; The optimal control amount is applied to the autonomous driving vehicle to enable the vehicle to complete the lane changing operation.

2. The fault-tolerant control method for lane changing of an autonomous driving vehicle according to claim 1, It is characterized in that The state information includes the vehicle longitudinal speed, the vehicle lateral speed, the vehicle current heading angle, the vehicle current yaw angular velocity, and the vehicle current position information; the expected path information includes the reference point expected position information, the reference point expected heading angle, and the reference point curvature.

3. The fault-tolerant control method for lane changing of an autonomous driving vehicle according to claim 1, It is characterized in that The state space equation model of the discrete tracking error variable is: in, X(k) represents the system state at time k, Among them, e 1 represents the distance from the vehicle's center of mass to the nearest point corresponding to the desired path; e 2 represents the vehicle direction error relative to the lane; n represents the discretization interval; δ f represents the front wheel turning angle of the vehicle; ΔM represents the additional yaw moment of the vehicle; represents the yaw rate determined by the road curvature, v x represents the longitudinal velocity of the vehicle, ρ represents the curvature of the reference point; C αf Indicates the vehicle's front wheel cornering stiffness; C αr Indicates the vehicle rear wheel cornering stiffness; l f Indicates the distance from the vehicle's center of mass to the front axle; l r represents the distance from the center of mass of the vehicle to the rear axle; m represents the mass of the vehicle; I z represents the moment of inertia around the vehicle's z-axis; T s Indicates the sampling time.

4. The fault-tolerant control method for lane changing of an autonomous driving vehicle according to claim 1, It is characterized in that The cost function J 1 and J 2 They are: in, N p represents the prediction time domain; X(k+i) represents the system state at time k+i; Q 1 , Q 2 represents the system state weight matrix; q e1 Indicates e 1 The weight coefficient of e2 Indicates e 2 The weight coefficient of express The weight coefficient of express The weight coefficient of 1 represents the distance from the vehicle's center of mass to the nearest point corresponding to the desired path; e 2 Represents the vehicle direction error relative to the lane; R 11 Represents the weight coefficient of the control input front wheel steering angle; R 22 represents the weight coefficient of the additional yaw moment of the control input; δ f (k+i) represents the front wheel steering angle control amount input at time k+i; ΔM(k+i) represents the additional yaw moment control amount input at time k+i.

5. The fault-tolerant control method for lane changing of an autonomous driving vehicle according to claim 4, It is characterized in that The actuator fault model is: in, is the actual front wheel steering angle; is the front wheel steering angle of the control input; α is the failure coefficient of the front wheel execution, 0≤α≤1, when α=0, it means that the front wheel steering has no fault; when α=1, it means that the front wheel steering has completely failed.

6. The fault-tolerant control method for lane changing of an autonomous driving vehicle according to claim 5, It is characterized in that According to the change in the failure coefficient of the front wheel, the control amount weight of the cost function is: When 0≤α<1, that is, the front wheel is partially ineffective: Among them, v 1 ≥1,ω 2 ≤1; Represents the weight coefficient of the control input front wheel steering angle after the change; ω 1 Represents the gain coefficient of the control input front wheel steering angle; R 11 Represents the weight coefficient of the control input front wheel steering angle; Represents the weight coefficient of the additional yaw moment of the control input after the change; ω 2 Represents the gain coefficient of the control input additional yaw moment; R 22 Represents the weight coefficient of the control input additional yaw moment; When α=1, that is, the front wheel fails completely: Wherein, ω<1; INF represents infinity; ω represents the gain coefficient of the control input additional yaw moment when α=1.

7. The fault-tolerant control method for lane changing of an autonomous driving vehicle according to claim 1, It is characterized in that The optimal additional yaw moment cannot act directly on the vehicle, and the driving torque of the four wheels of the vehicle is distributed to the wheel torque according to the front and rear axle load ratio of the vehicle, so as to meet the requirements of the total driving force and additional yaw moment of the vehicle. The specific distribution of the driving torque of each wheel is as follows: Among them, T fl Indicates the driving torque of the left front wheel of the vehicle; T fr Indicates the driving torque of the right front wheel of the vehicle; T rl Indicates the driving torque of the left rear wheel of the vehicle; T rr Indicates the driving torque of the right rear wheel of the vehicle; F des represents the total longitudinal driving force; m represents the total mass of the vehicle; g represents the acceleration due to gravity; l r Indicates the distance from the vehicle's center of mass to the rear axle; l f Indicates the distance from the vehicle's center of mass to the front axle; ΔM Nash represents the additional yaw moment based on the solution of the dynamic game; a x Indicates the longitudinal acceleration of the vehicle; h c represents the height of the vehicle's center of mass; L represents the vehicle's wheelbase; r represents the wheel rolling radius; W represents the wheelbase.

8. A computer-readable storage medium storing a computer program, It is characterized in that The computer program is suitable for being loaded by a processor and executing the fault-tolerant control method for lane changing of an autonomous driving vehicle as described in any one of claims 1 to 7.

9. A fault-tolerant control system for lane changing of an autonomous vehicle. It is characterized in that include: Trajectory planning module, fault diagnosis module, autonomous driving vehicle driving subsystem, autonomous driving vehicle steering subsystem, and fault-tolerant controller for autonomous driving vehicle lane changing based on dynamic game; The trajectory planning module is used to provide the desired path information; The fault diagnosis module is used for the actuator fault model to estimate the failure coefficient of the front wheel actuator in real time according to the front wheel steering angle; The autonomous driving vehicle drive subsystem is used to drive the vehicle to complete longitudinal movement by the actuator; The steering subsystem of the autonomous vehicle is used to drive the vehicle to complete lateral movement by the actuator; The fault-tolerant controller for lane changing of autonomous driving vehicles based on dynamic game is used to establish a state equation model of discrete tracking error variables according to the current state information and expected path information of the vehicle; based on the established state equation model of discrete tracking error variables, the optimal front wheel steering angle is used to achieve the best path tracking performance as the target of trajectory tracking control to construct the cost function J 1 , the cost function J is constructed by generating the best additional yaw moment to achieve the best lateral stability performance as the goal of direct yaw moment control 2 ; Then, the failure coefficient of the front wheel is introduced into the constructed cost function to obtain a time-varying cost function, and the control amount weight of the time-varying cost function is changed accordingly according to the size of the failure coefficient of the front wheel when the vehicle is running in real time; The optimal control quantity is calculated and then applied to the driving subsystem and the steering subsystem of the autonomous driving vehicle.

10. A car, It is characterized in that The automobile includes a fault-tolerant control system for autonomous vehicle lane changing as described in claim 9.