Vehicle side slip angle estimation method

By constructing a vehicle three-degrees of freedom kinematics and dynamics model, combining the adaptive Kalman filtering algorithm, the vehicle center of mass estimation strategy is designed, which solves the problem of difficulty in accurately obtaining the vehicle center of mass lateral deflection angle in the existing technology, and realizes the vehicle Improved stability and cost.

CN118907124APending Publication Date: 2024-11-08TAIYUAN UNIVERSITY OF TECHNOLOGY
View PDF 0 Cites 3 Cited by

Patent Information

Application Number
CN202411150926.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-21
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

The prior art is difficult to accurately obtain the side deflection angle of the vehicle center of mass, which affects the control of the vehicle stability, and direct measurement instruments are expensive and occupy a large space, so they cannot be popularized.

Method used

A vehicle three-degree of freedom kinematic model and linear dynamic model are constructed, combined with the adaptive square root volume Kalman filtering algorithm, a vehicle kinematics, linear dynamics and nonlinear dynamics estimator is designed, and the vehicle center of mass lateral deflection angle is estimated through a fusion strategy.

Benefits of technology

It realizes accurate estimation of the side deflection angle of the vehicle center of mass, reduces cost and space occupation, and improves vehicle stability and driving comfort.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118907124A_ABST
    Figure CN118907124A_ABST
Patent Text Reader

Abstract

The invention discloses a vehicle side slip angle estimation method, which belongs to the technical field of new energy vehicle stability control, and comprises the following steps: constructing a vehicle three-degree-of-freedom kinematics model, a three-degree-of-freedom dynamics model and a magic tire model; the method comprises the following steps of: based on the influence of roll motion on lateral acceleration measured by an IMU (Inertial Measurement Unit) sensor in the actual driving process of a vehicle, modeling the roll motion of the vehicle to correct a lateral acceleration measured value; based on Kalman filtering and advantages and disadvantages of an improved algorithm thereof, an adaptive square root cubature Kalman filtering algorithm is constructed; respectively designing a vehicle kinematics estimator, a vehicle linear dynamics estimator and a vehicle nonlinear dynamics estimator based on an adaptive square root volume Kalman filtering algorithm; and based on the characteristics of different side slip angle estimators and an applicable scene design estimation strategy, vehicle side slip angle estimation is completed.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of new energy vehicle stability control, and in particular relates to a method for estimating a vehicle center of mass sideslip angle. Background Art

[0002] With the gradual improvement of people's income level and the vigorous development of the automobile industry, the number of cars has continued to increase in recent years, and has become a common means of transportation for people. However, the frequent traffic accidents have caused immeasurable harm and losses to people's property and life safety, which has attracted widespread attention. Therefore, how to improve automobile safety performance has become a research focus of the industry and academia.

[0003] Most of the active safety control technologies of automobiles are highly dependent on the accurate and real-time acquisition of relevant state parameters of the vehicle during driving, especially the sideslip angle and yaw angular velocity of the center of mass. As the input of the active safety control technology of automobiles and important variables in the control logic, they have a crucial impact on the stability control of the vehicle.

[0004] The vehicle's yaw rate can be measured using inertial sensors, but instruments that can directly measure the center of mass slip angle are expensive, occupy a large space, are limited in installation, and cannot be popularized in mass-produced vehicles. Accurately obtaining the value of the center of mass slip angle has important engineering significance in the field of vehicle stability control. Therefore, it is necessary to use soft measurement methods to replace sensors to obtain the value of the vehicle's center of mass slip angle. Summary of the invention

[0005] In order to solve the above technical problems, the present invention proposes a method for estimating the sideslip angle of the center of mass of a vehicle to solve the problems existing in the above prior art.

[0006] To achieve the above object, the present invention provides a method for estimating a vehicle center of mass sideslip angle, comprising:

[0007] Construct a vehicle three-degree-of-freedom kinematic model, a vehicle three-degree-of-freedom linear dynamic model and a magic tire model, and construct a vehicle roll motion model;

[0008] Constructing an adaptive square root volumetric Kalman filter algorithm, and constructing a vehicle kinematics estimator, a vehicle linear dynamics estimator, and a vehicle nonlinear dynamics estimator based on the adaptive square root volumetric Kalman filter algorithm and the vehicle three-degree-of-freedom kinematic model, the vehicle three-degree-of-freedom linear dynamics model, and the magic tire model;

[0009] Constructing a vehicle center of mass sideslip angle fusion estimation strategy based on the vehicle kinematics estimator, the vehicle linear dynamics estimator and the vehicle nonlinear dynamics estimator;

[0010] A vehicle center of mass sideslip angle estimation model is constructed based on the vehicle roll motion model and the vehicle center of mass sideslip angle fusion estimation strategy, and the vehicle center of mass sideslip angle is estimated based on the vehicle center of mass sideslip angle estimation model.

[0011] Preferably, the expression of the vehicle three-degree-of-freedom kinematic model is:

[0012]

[0013] Among them, v x and v y are the longitudinal speed and lateral speed of the vehicle respectively; a x and a y are the longitudinal acceleration and lateral acceleration of the vehicle respectively; and Respectively represent the derivatives of the vehicle's longitudinal velocity and lateral velocity with respect to time t; ω z is the yaw rate of the vehicle;

[0014] The three-degree-of-freedom linear dynamic model of the vehicle

[0015]

[0016] Among them, v x 、v y are the longitudinal and lateral speeds of the vehicle respectively; ω z is the yaw angular velocity; m is the mass; I z is the vehicle body yaw moment; l f , l r are the distances between the center of mass and the front and rear axles; δ f is the front wheel steering angle; M z is the external additional torque; F yf 、F yr are the lateral forces of the front and rear axles respectively; C f Indicates the lateral stiffness of the front axle tire; C r Represents the cornering stiffness of the rear axle tire; α f is the front axle tire side slip angle; α r is the rear axle tire slip angle, represents the derivative of the vehicle's sideslip angle, Represents the derivative of the vehicle's yaw rate.

[0017] Preferably, the process of constructing the vehicle roll motion model also includes: modeling the vehicle roll motion based on the influence of the roll motion during actual driving of the vehicle on the lateral acceleration measured by the IMU sensor, and generating the vehicle roll motion model.

[0018] Preferably, the process of constructing an adaptive square root cubature Kalman filter algorithm includes:

[0019] The nonlinear system is expressed as a discrete state space equation form, and the square roots of the error covariance matrix and the innovation covariance matrix are calculated respectively;

[0020] Calculating a Kalman filter gain based on the square root of the error covariance matrix and the innovation covariance matrix;

[0021] Calculate the posterior state estimate at time k+1 and calculate the square root factor of the error covariance matrix at time k+1;

[0022] The process noise covariance and the measurement noise covariance are updated based on the a posteriori state estimate and the error covariance matrix square root factor.

[0023] Preferably, the expression in the form of discrete state space equation is:

[0024]

[0025] Where x k ∈R n is the state variable; u k ∈R n is the input variable; Z k ∈R m is the observed variable; k is the time step of state estimation; A, B, H matrices are the state matrix, control matrix and observation matrix in the system respectively; w k 、v k are the process noise and observation noise of the system, both of which are independent Gaussian white noises with a mean of 0; Q and R are w k and v k The covariance matrix of .

[0026] Preferably, the expression for calculating the square root of the error covariance matrix and the innovation covariance matrix is:

[0027]

[0028] In the formula and γ k|k-1 is the weight matrix; Z k ∈R m is the observed variable; is the measurement noise covariance R k Cholesky decomposition of S yy for QR decomposition of P xy is the cross-covariance matrix.

[0029] Preferably, the vehicle kinematics estimator is obtained by using the vehicle three-degree-of-freedom kinematics model and the adaptive square-root cubature Kalman filter algorithm;

[0030] The vehicle linear dynamics estimator is obtained by using the vehicle three-degree-of-freedom linear dynamics model and the adaptive square root cubature Kalman filter algorithm;

[0031] The vehicle nonlinear dynamics estimator is obtained by the magic tire model and the adaptive square root cubature Kalman filter algorithm;

[0032] Preferably, the process of constructing a vehicle center of mass sideslip angle fusion estimation strategy includes:

[0033] The yaw angular velocity is measured using the IMU module when If the value is greater than the manually set threshold, it is considered that the vehicle is in a turning condition.

[0034] When the vehicle is in a turning condition, the center of mass sideslip angle value is estimated by fusion through the vehicle kinematics estimator, the vehicle linear dynamics estimator and the vehicle nonlinear dynamics estimator.

[0035] Compared with the prior art, the present invention has the following advantages and technical effects:

[0036] 1) The present invention fully considers factors such as vehicle active safety, vehicle space utilization and manufacturing cost, and the proposed vehicle center of mass sideslip angle estimation strategy is more reasonable and accurate.

[0037] 2) The proposed vehicle center of mass sideslip angle estimation strategy helps to maintain the stability of the vehicle while having little impact on the driving experience, thereby improving ride comfort. BRIEF DESCRIPTION OF THE DRAWINGS

[0038] The drawings constituting a part of the present application are used to provide a further understanding of the present application. The illustrative embodiments and descriptions of the present application are used to explain the present application and do not constitute an improper limitation on the present application. In the drawings:

[0039] Figure 1 is a schematic diagram of a method flow of an embodiment of the present invention;

[0040] Figure 2 is a schematic diagram of a vehicle roll joint simulation model according to an embodiment of the present invention;

[0041] Figure 3 is a schematic diagram of a vehicle center of mass sideslip angle fusion estimation strategy according to an embodiment of the present invention;

[0042] Figure 4 It is a schematic diagram of the first part of the vehicle center of mass sideslip angle fusion estimation strategy joint simulation model according to an embodiment of the present invention;

[0043] Figure 5It is a schematic diagram of the second part of the vehicle center of mass sideslip angle fusion estimation strategy joint simulation model according to an embodiment of the present invention;

[0044] Figure 6 It is a schematic diagram of the vehicle center of mass sideslip angle estimation result under specific working conditions of an embodiment of the present invention. DETAILED DESCRIPTION

[0045] It should be noted that, in the absence of conflict, the embodiments and features in the embodiments of the present application can be combined with each other. The present application will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.

[0046] It should be noted that the steps shown in the flowcharts of the accompanying drawings can be executed in a computer system such as a set of computer executable instructions, and that, although a logical order is shown in the flowcharts, in some cases, the steps shown or described can be executed in an order different from that shown here.

[0047] Embodiment 1

[0048] like Figure 1 As shown, this embodiment provides a method for estimating a vehicle center of mass sideslip angle, including:

[0049] First, the vehicle kinematic model, vehicle linear dynamics model and tire model are constructed: the vehicle kinematic model is used to describe the relationship between the longitudinal, lateral and yaw motion of the vehicle; the vehicle linear dynamics model is used to describe the mathematical relationship between the various parameters of the vehicle; the tire model is used to fully express the mechanical properties of the tire, such as longitudinal force, lateral force and righting torque, and thus accurately obtain the sideslip angle of the vehicle's center of mass.

[0050] Secondly, construct the vehicle roll model, such as Figure 2 As shown in the figure, it is used to introduce the roll motion caused by the suspension during the actual driving of the vehicle to the lateral acceleration measured by the IMU This lays a theoretical foundation for the subsequent vehicle center of mass sideslip angle estimation strategy.

[0051] Then, based on the advantages and disadvantages of Kalman filtering and its improved algorithm, an adaptive square root cubature Kalman filtering algorithm is constructed. The square root of the state covariance matrix is ​​used to replace the state covariance matrix for calculation. When its initial value is positive definite, the problem of non-positive definiteness in subsequent iterations can be avoided, the amount of calculation can be reduced, and the calculation efficiency can be improved.

[0052] Based on the ASRCKF algorithm, the vehicle kinematics estimator (KE), vehicle linear dynamics estimator (DEL) and vehicle nonlinear dynamics estimator (DEN) are designed respectively to obtain the dynamic change trend of the vehicle's sideslip angle.

[0053] Finally Figure 3As shown in the figure, a fusion estimation strategy is designed based on the characteristics of different center of mass sideslip angle estimators and applicable scenarios to complete the vehicle center of mass sideslip angle estimation.

[0054] Furthermore, the three-degree-of-freedom model of the vehicle is:

[0055]

[0056] Where v x and v y are the longitudinal speed and lateral speed of the vehicle respectively; a x and a y are the longitudinal acceleration and lateral acceleration of the vehicle respectively; and Respectively represent the derivatives of the vehicle's longitudinal velocity and lateral velocity with respect to time t; ω z is the yaw angular velocity of the vehicle.

[0057] The longitudinal velocity of the vehicle is v x and lateral velocity v y These are the two main parameters for deriving the vehicle's center of mass sideslip angle β

[0058]

[0059] In order to describe the mathematical relationship between various vehicle parameters, a two-degree-of-freedom dynamic model of the vehicle including lateral motion and yaw motion is established.

[0060]

[0061] Where v x 、v y are the longitudinal and lateral speeds of the vehicle respectively; ω z is the yaw angular velocity; m is the mass; I z is the vehicle body yaw moment; l f , l r are the distances between the center of mass and the front and rear axles; δ f is the front wheel steering angle; M z is the external additional torque; F yf 、F yr are the lateral forces on the front and rear axles respectively.

[0062] The tire lateral force can be expressed as:

[0063]

[0064] Where C f Indicates the lateral stiffness of the front axle tire; C r Represents the cornering stiffness of the rear axle tire; α f is the front axle tire side slip angle; α r is the rear axle tire slip angle.

[0065] The tire front and rear axle slip angle can be expressed as:

[0066]

[0067] Where δ f is the front wheel steering angle.

[0068] Vehicle center of mass sideslip angle β:

[0069] β=v y / v x ;

[0070] Vehicle dynamics model:

[0071]

[0072] The kinematic equation is used to model the longitudinal direction of the vehicle, which can be expressed as:

[0073]

[0074] Where a x is the vehicle longitudinal acceleration.

[0075] The motion equation of the four-wheel speed can be expressed as:

[0076]

[0077] Where ω fl,k ,ω fr,k ,ω rl,k and ω rr,k are the four wheel speeds respectively; b is the wheelbase; r is the effective radius of the wheel.

[0078] Furthermore, the vehicle tire model

[0079] The unified form of the magic formula can be expressed as:

[0080]

[0081] Where B, C, D, and E are fitting parameters, among which B is the stiffness factor, C is the curve shape factor, D is the peak factor, and E is the curve curvature factor; Y is the tire lateral force; X is the tire slip angle; S h , S ν are the drift of the curve in the horizontal and vertical directions respectively.

[0082] The vertical load on each tire can be expressed as:

[0083]

[0084] Where F zfl 、Fzfr 、F zrl and F zrr Represents the vertical load of the front left, front right, rear left and rear right tires respectively; a x 、a y are longitudinal and lateral acceleration respectively; g is the acceleration due to gravity; h is the height of the center of gravity; b f and b r is the front and rear wheelbase. m is the vehicle mass; I z is the yaw moment of the vehicle body; l is the front and rear wheelbase of the vehicle; l f , l r are the center of mass and the distance between the front and rear axles respectively.

[0085] The longitudinal slip rate of the tire can be expressed as:

[0086]

[0087] Where s j represents the slip rate of the jth tire; ω j represents the wheel speed of the jth tire; v nj represents the wheel linear velocity of the jth tire.

[0088] Furthermore, the vehicle roll model

[0089] When a vehicle turns, the vehicle body usually has a slight roll angle around the X axis relative to the road surface. Roll Angle and lateral acceleration a y is roughly proportional, so it can be approximately expressed as:

[0090]

[0091] The constant is the proportionality coefficient, a y is the lateral acceleration.

[0092] Roll Angle This will cause the IMU to measure The weight of gravity , i.e. the acceleration deviation due to the vehicle's rolling motion.

[0093] For passenger cars, under normal driving conditions, the vehicle roll angle is usually between -10° and 10°, which is in line with The small angle approximation of Therefore, the measured lateral acceleration can be expressed as:

[0094]

[0095] In order to compensate for the influence of vehicle roll motion on the measured value and obtain accurate lateral acceleration, the acceleration measurement value Divide by a constant factor To obtain the actual lateral acceleration a of the vehicle during actual driving y .

[0096] Furthermore, the advantages and disadvantages of Kalman filtering and its improved algorithm are analyzed to construct a suitable filtering algorithm to design the vehicle center of mass sideslip angle estimator.

[0097] The Kalman Filter (KF) algorithm is based on the feedback control method, which estimates the state quantity at a certain moment in the process and uses the noisy measurement value to feed back the estimated value. Therefore, the KF algorithm has two obvious information update processes: time update and observation update. It is suitable for linear systems and has the advantages of strong robustness and fast calculation, and can effectively process real-time signals of the system.

[0098] The linear system is expressed in discrete state space equation form as

[0099]

[0100] Where x k ∈R n is the state variable; u k ∈R n is the input variable; Z k ∈R m is the observed variable; k is the time step of state estimation; A, B, H matrices are the state matrix, control matrix and observation matrix in the system respectively; w k 、v k are the process noise and observation noise of the system, both of which are independent Gaussian white noises with a mean of 0; Q and R are w k and v k The covariance matrix of .

[0101] Further, the method for constructing the adaptive square root cubature Kalman filter algorithm is:

[0102] The nonlinear system can be expressed as the following discrete state space equation form:

[0103]

[0104] Where x k ∈R n is the state variable; u k ∈R n is the input variable; Z k ∈R mis the observed variable; k is the time step of state estimation; f(·) is the state equation, h(·) is the observation equation; w k 、v k are the process noise and observation noise of the system, both of which are independent Gaussian white noises with a mean of 0; Q and R are w k and v k The covariance matrix of .

[0105] Compute the square roots of the error covariance matrix and the innovation covariance matrix separately:

[0106]

[0107] In the formula and γ k|k-1 is the weight matrix; is the measurement noise covariance R k Cholesky decomposition of .

[0108] Calculate the Kalman filter gain:

[0109]

[0110] Calculate the posterior state estimate at time k+1:

[0111]

[0112] Calculate the square root factor of the error covariance matrix at time k+1

[0113]

[0114] Update Q k and R k

[0115]

[0116] Where H k is the innovation covariance matrix; M is the size of the moving estimation window; e i For innovation sequence.

[0117] Further, for the vehicle kinematics estimator

[0118] The state equation of the vehicle's three-degree-of-freedom kinematic model in the continuous time domain is:

[0119]

[0120] In practical applications, considering the amount of calculation, the state equation is discretized using the Euler method:

[0121]

[0122] The system state variable is x k =[v x,k v y,k ] T ; T is the simulation step length, which is set to 0.001s in this paper; k is the sampling time; w k is the system noise.

[0123] The discrete observation equation of the system can be expressed as:

[0124]

[0125] The system observation variable is and The longitudinal and lateral speeds of the vehicle are preliminarily calculated by using the output data of the GPS module and the IMU module through the trigonometric function relationship; k is the observation noise; the initial state of the system is x0 =

[00] T ; Input variables are Calculate the value of the vehicle's center of mass sideslip angle.

[0126] For the vehicle linear dynamics estimator

[0127] The state equation of the vehicle linear three-degree-of-freedom dynamic model in the continuous time domain is:

[0128]

[0129] Similarly, the discretized state equation can be expressed as:

[0130]

[0131] The system state variable is x k =[β k ω z,k v x,k ] T .

[0132] The discrete observation equation of the system can be expressed as:

[0133]

[0134] The system observation variable is where β f,k and The vehicle center of mass sideslip angle and longitudinal speed are preliminarily calculated using the output data of the GPS module and the IMU module; the initial state of the system is x0 =

[000] T ; Input variables are

[0135] For vehicle nonlinear dynamics estimator;

[0136] The dynamic formulas for longitudinal and lateral motion in the vehicle's nonlinear three-degree-of-freedom dynamics model can be expressed as:

[0137]

[0138] The dynamics of the vehicle's yaw motion can be expressed as:

[0139]

[0140] Therefore, the discretized state equation of the system can be expressed as:

[0141]

[0142] The system state variable is x k =[v x,k v y,k ω z,k ] T ; where (·)1 and (·)2 represent the tire force relationship in formula (3-29), and (·)3 represents the tire force relationship in formula (3-30).

[0143] The system discrete observation equation can be expressed as the formula:

[0144]

[0145] The system observation variable is and The longitudinal and lateral speeds of the vehicle are preliminarily calculated based on the output data of the GPS module and the IMU module. The input variables are The initial state of the system is x0 =

[000] T . Calculate the value of the vehicle's center of mass side slip angle

[0146] Further, if Figure 4-5 As shown, first use the IMU module to measure the yaw angular velocity Set the switching judgment mechanism 1: When the vehicle is greater than the artificially set threshold W (set to 0.05 rad / s in this paper), it is considered that the vehicle is in a turning condition. At this time, the three center of mass side slip angle estimators KE, DEL and DEN designed above are used for fusion estimation. If the value is less than or equal to the artificially set threshold W, the vehicle is considered to be in a straight-line driving condition at this time, and the value of the vehicle's center of mass sideslip angle is artificially set to 0. This means that during long-term driving, the cumulative error caused by sensor bias and noise is also artificially set to 0 when the vehicle is in a straight-line driving condition, which helps the center of mass sideslip angle estimation result to converge quickly to 0.

[0147] Vehicle yaw angle model:

[0148]

[0149] Where Z k is the vehicle yaw angle at the current moment, Z k-1 is the vehicle yaw angle at the previous moment; T IMU is the sampling period of the IMU module, which is set to 0.001s in this paper.

[0150] Calculate the initial vehicle center of mass sideslip angle:

[0151]

[0152] The initial vehicle longitudinal and lateral velocities are calculated using trigonometric relationships:

[0153]

[0154] Set the corrected lateral acceleration a y and longitudinal speed It is the input variable in the extension fusion set, and the extension set 1 and set 2 are constructed based on the plane extension theory to realize the fusion calculation of the center of mass sideslip angle values ​​estimated by DEL and DEN, and DEN and KE respectively.

[0155]

[0156] when and a y When it falls into the classical domain, the tire force is considered to be in the linear region, and the weight coefficient is set to λ0=0.1. At this time, β F Mainly affected by β DEL influence; when and a y When it falls into the non-domain, it is considered that the tire force is in the weak nonlinear region, and the weight coefficient is set to λ0=0.8. At this time, β F Mainly affected by β DEN Influence; When point P is in the fusion domain, it is considered that the tire force is in the transition area from the linear area to the weak nonlinear area. At this time, the weight coefficient λ0 can be obtained by calculating the correlation function:

[0157]

[0158] Wherein, point P1 and point P2 are the intersection points of the line connecting point P and the origin of the coordinate system with the boundary of the classical domain and the boundary of the fusion domain respectively; ρ(P, P1) and ρ(P, P2) are the fusion distances.

[0159] The correlation function can be expressed as the formula:

[0160]

[0161] Set the weight coefficient λ0 to the formula:

[0162] λ0=0.7K 2 +0.1;

[0163] when and a y When it falls into the classical domain, it is considered that the tire force is in the weak nonlinear region, and the weight coefficient is set to λ0=0.1. At this time, β F Mainly affected by β DEN influence; when and a y When it falls into the non-domain, it is considered that the tire force is in the strong nonlinear region, and the weight coefficient is set to λ0=0.8. At this time, β F Mainly affected by β KE When point P is in the fusion domain, it is considered that the tire force is in the transition region from the weak linear region to the strong nonlinear region.

[0164] Figure 6 This is the vehicle center of mass sideslip angle estimation result under specific working conditions of an embodiment of the present invention. The effectiveness of the estimation strategy proposed in the present invention can be clearly seen from the figure.

[0165] The above are only preferred specific implementations of the present application, but the protection scope of the present application is not limited thereto. Any changes or substitutions that can be easily thought of by a person skilled in the art within the technical scope disclosed in the present application should be included in the protection scope of the present application. Therefore, the protection scope of the present application should be based on the protection scope of the claims.

Claims

1. A method for estimating vehicle center of mass sideslip angle, It is characterized in that The following steps are involved: Construct a vehicle three-degree-of-freedom kinematic model, a vehicle three-degree-of-freedom linear dynamic model and a magic tire model, and construct a vehicle roll motion model; Constructing an adaptive square root volumetric Kalman filter algorithm, and constructing a vehicle kinematics estimator, a vehicle linear dynamics estimator, and a vehicle nonlinear dynamics estimator based on the adaptive square root volumetric Kalman filter algorithm and the vehicle three-degree-of-freedom kinematic model, the vehicle three-degree-of-freedom linear dynamics model, and the magic tire model; Constructing a vehicle center of mass sideslip angle fusion estimation strategy based on the vehicle kinematics estimator, the vehicle linear dynamics estimator and the vehicle nonlinear dynamics estimator; A vehicle center of mass sideslip angle estimation model is constructed based on the vehicle roll motion model and the vehicle center of mass sideslip angle fusion estimation strategy, and the vehicle center of mass sideslip angle is estimated based on the vehicle center of mass sideslip angle estimation model.

2. The vehicle center of mass sideslip angle estimation method according to claim 1, It is characterized in that The expression of the vehicle three-degree-of-freedom kinematic model is: Among them, v x and v y are the longitudinal speed and lateral speed of the vehicle respectively; a x and a y are the longitudinal acceleration and lateral acceleration of the vehicle respectively; and Respectively represent the derivatives of the vehicle's longitudinal velocity and lateral velocity with respect to time t; ω z is the yaw rate of the vehicle; The expression of the three-degree-of-freedom linear dynamic model of the vehicle is: Among them, v x 、v y are the longitudinal and lateral speeds of the vehicle respectively; ω z is the yaw angular velocity; m is the mass; I z is the vehicle body yaw moment; l f , l r are the distances between the center of mass and the front and rear axles; δ f is the front wheel steering angle; M z is the external additional torque; F yf 、F yr are the lateral forces of the front and rear axles respectively; C f Indicates the lateral stiffness of the front axle tire; C r Represents the cornering stiffness of the rear axle tire; α f is the front axle tire side slip angle; α r is the rear axle tire slip angle, represents the derivative of the vehicle's sideslip angle, Represents the derivative of the vehicle's yaw rate.

3. The vehicle center of mass sideslip angle estimation method according to claim 1, It is characterized in that The process of constructing the vehicle roll motion model also includes: modeling the vehicle roll motion based on the influence of the roll motion during actual driving of the vehicle on the lateral acceleration measured by the IMU sensor to generate the vehicle roll motion model.

4. The vehicle center of mass sideslip angle estimation method according to claim 1, It is characterized in that The process of building an adaptive square root cubature Kalman filter algorithm includes: The nonlinear system is expressed as a discrete state space equation form, and the square roots of the error covariance matrix and the innovation covariance matrix are calculated respectively; Calculating a Kalman filter gain based on the square root of the error covariance matrix and the innovation covariance matrix; Calculate the posterior state estimate at time k+1 and calculate the square root factor of the error covariance matrix at time k+1; The process noise covariance and the measurement noise covariance are updated based on the a posteriori state estimate and the error covariance matrix square root factor.

5. The vehicle center of mass sideslip angle estimation method according to claim 4, It is characterized in that The expression in discrete state space equation form is: Where x k ∈R n is the state variable; u k ∈R n is the input variable; Z k ∈R m is the observed variable; k is the time step of state estimation; A, B, H matrices are the state matrix, control matrix and observation matrix in the system respectively; w k 、v k are the process noise and observation noise of the system, both of which are independent Gaussian white noises with a mean of 0; Q and R are w k and v k The covariance matrix of .

6. The vehicle center of mass sideslip angle estimation method according to claim 4, It is characterized in that The expression for calculating the square root of the error covariance matrix and the innovation covariance matrix is: In the formula and γ k|k-1 is the weight matrix; Z k ∈R m is the observed variable; S Rk is the measurement noise covariance R k Cholesky decomposition, S yy for QR decomposition of P xy is the cross-covariance matrix.

7. The vehicle center of mass sideslip angle estimation method according to claim 1, It is characterized in that The vehicle kinematics estimator is obtained by using the vehicle three-degree-of-freedom kinematics model and the adaptive square-root cubature Kalman filter algorithm; The vehicle linear dynamics estimator is obtained by using the vehicle three-degree-of-freedom linear dynamics model and the adaptive square root cubature Kalman filter algorithm; The vehicle nonlinear dynamics estimator is obtained through the magic tire model and the adaptive square root cubature Kalman filter algorithm.

8. The vehicle center of mass sideslip angle estimation method according to claim 1, It is characterized in that The process of building a vehicle center of mass sideslip angle fusion estimation strategy includes; The yaw angular velocity is measured using the IMU module when If the value is greater than the manually set threshold, it is considered that the vehicle is in a turning condition. When the vehicle is in a turning condition, the center of mass sideslip angle value is estimated by fusion through the vehicle kinematics estimator, the vehicle linear dynamics estimator and the vehicle nonlinear dynamics estimator.

Citation Information

Cited By

  • Side slip angle estimation method based on intelligent tire and related equipment

    CN120735783A

  • Vehicle steering control method and system based on zero centroid deflection

    CN121157892A

  • Vehicle steering control method and system based on zero-centroid yaw

    CN121157892B