Estimation of Sideslip Angle Based on Extended Kalman Filter

The sideslip angle plays an extremely important role in vehicle stability control, but the sideslip angle in production car cannot be obtained from sensor directly in consideration of the cost of the sensor; it is essential to estimate the sideslip angle indirectly by means of other vehicle motion parameters; therefore, an estimation algorithm with real-time performance and accuracy is critical. Traditional estimation method based on Kalman filter algorithm is correct in vehicle linear control area; however, on low adhesion road, vehicles have obvious nonlinear characteristics. In this paper, extended Kalman filtering algorithm had been put forward in consideration of the nonlinear characteristic of the tire and was verified by the Carsim and Simulink joint simulation, such as the simulation on the wet cement road and the ice and snow road with double lane change. To test and verify the effect of extended Kalman filtering estimation algorithm, the real vehicle test was carried out on the limit test field. The experimental results show that the accuracy of vehicle sideslip angle acquired by extended Kalman filtering algorithm is obviously higher than that acquired by Kalman filtering in the area of the nonlinearity.


Introduction
In the recent years, with the improvement of the road conditions and the progress of automobile technology, the speed of the car is also accelerating; however, the proportion of traffic accidents caused by the instability of vehicle is also increasing [1].Therefore, it is an important subject for modern automobile to improve the safety.In terms of vehicle stability control system, the vehicle sideslip angle is a very important control variable [2].
In the low adhesive road, the vehicle is easy to sideslip because of the tire lateral force's saturation; although the yaw rate remains in a small range, the vehicle has lost the balance [3].In other words, the actual yaw rate is the same as the ideal value, the sideslip angle will increase quickly and exceed critical value, and then the vehicle loses the balance.Therefore, in the low adhesive road, the sideslip angle can be better describing the real situation of the vehicle [4,5].The yaw rate can be obtained directly by the yaw rate sensor and because of the cost there is no sensor to directly measure the sideslip angle.The sideslip angle can only be estimated by measuring the motion state parameters of other vehicles and using the estimation method [6].There are many methods to estimate sideslip angle such as the original integration method, the simple Kalman filter to the present neural network, and the fuzzy logic method.There are great improvements in estimation accuracy, computational efficiency, and robustness of the algorithm [7].The advantages of the direct integration method are simplicity, being easy to implement, small amount of calculation, and good realtime performance.The disadvantage of the direct integration method is that, with the increase of time, the accumulation of the error increases, so that the estimated value is greatly deviated from the true value [8,9].To estimate the vehicle sideslip angle based on fuzzy logic and vehicle kinematics model combining test, the results show that the robustness and accuracy of the method are good, and the response frequency is high.Then, it could meet the control needs of ESP [10,11].In the above algorithm, the author takes the real-time, robustness, accuracy and other reasons into consideration, based on the application of Kalman filtering algorithm in the actual project [12].However, with the limitation of the linear tire model itself, the filter algorithm of Kalman estimation method is accurate within vehicles

Equation of state prediction
Covariance prediction equation

Filter equation
Covariance update equation linear control area and it is not enough for vehicle stability control system which can be triggered only under extreme conditions [3].For example, the nonlinear characteristics of the vehicle are more obvious on the low adhesive road, but the extended Kalman filtering method can obtain good effects even when vehicle dynamics are in nonlinear area because the extended Kalman filtering method considers the nonlinear characteristics of tires [13].Therefore, this paper uses the extended Kalman filtering method to study the sideslip angle of the vehicle.

Extended Kalman Filtering Theory
2.1.Kalman Filtering Theory.Kalman filtering method is a linear system estimation method.The process can be divided into two parts [14]: (i) Time updating: (ii) Measurement updating: In this formula,   is the state vector for  moment in the system,   is the system input,   is the observation vector, and ,  is the covariance matrix for process noise and measurement noise.

Extended Kalman Filtering Theory.
Kalman filtering algorithm has low precision for some systems with strong nonlinearity.It generally uses extended Kalman filter (EKF) for the state estimation of nonlinear systems such as automobiles.EKF transfers nonlinear model into linear model, so that Kalman filter can be used for nonlinear systems.
The processes of EKF are as shown in Figure 1.
Usually, the state space equation and the observation equation can be expressed by the following formula: In the nonlinear state equation and observation equation (( 3) and ( 4)), extended Kalman filtering algorithm can be expanded through Taylor series.The specific approach of linear approximation of nonlinear equations ( 3) is to make linearization by state equation and measurement equation for nonlinear system (i.e., the Jacobian matrix) and then estimate it.The specific steps of the EKF method are as follows.
The state update process of EKF is as follows: The measurement update process of EKF is as follows: In the formula,  is the Jacobian matrix of  to : In the formula,  is the Jacobian matrix of  to :

Simulation Analysis of Sideslip Angle Estimation Based on Extended Kalman Filtering Algorithm
The extended Kalman filtering estimation algorithm is based on the 2-degree-of-freedom vehicle dynamics model (shown in Figure 2), and the tire model is based on MF formula.

Sideslip Angle Estimation Based on Extended Kalman Filtering.
According to the 2-degree-of-freedom vehicle model and MF tire establish the following formula: (1) Establish the nonlinear state equation as Measurement equation: Put   ,   with MF tire formula, state quantity is  = , and control input is (2) The linear model (take Jacobian matrix for state equation and measurement equation) is as follows: Put the discretization of the equation of state "( |  − 1) =  + () * "and the discretization of the measurement equation "() = ()" in the five formulas of EKF status update and measurement update.Table 1 indicates various parameters and variables of automobile.

Sideslip Angle Estimation
Based on EKF Simulation.In order to verify the effect of extended Kalman filtering algorithm sideslip angle estimation, we carried out simulation verification to a car.The simulation adopts a typical double lane condition, in order to verify the accuracy of the extended Kalman filtering sideslip angle estimation and make the vehicle lateral acceleration as fast as possible, so as to make the vehicle into the nonlinear control area.interface, and 3D animation and experimental curve drawing interface.The relationship between the four parts and the main interface of Carsim is shown in Figure 3. Table 2 lists the parameters of vehicle settings in Carsim.

Wet Cement Pavement.
Take the double lane change simulation of 95 km/h on the simulation of ground with adhesion coefficient of 0.45 and use the extended Kalman filtering technology to recognize the sideslip angle.The result is shown in Figures 4 and 5.
Note from Figures 4(b) and 4(c) that the relationship between the yaw rate and the steering wheel angle is not linear, which indicates that the vehicle dynamics have entered the nonlinear region.
Note from Figure 5 that when we take the 4 s, there are largely different Kalman filtering estimation and simulation of the actual value.Overall, the accuracy of the sideslip angle estimation is higher than the accuracy of Kalman filtering algorithm.

Ice and Snow Road.
When the vehicle enters strongly nonlinear region, in order to verify the effect of the extended Kalman filtering algorithm to estimate the sideslip angle, then take the sideslip angle estimation simulation on low attachment snow ground (the ground adhesion coefficient is 0.2).
Take the double lane change simulation of 55 km/h on the snow ground with round adhesion coefficient of 0.2 and then use the extended Kalman filtering algorithm to identify the sideslip angle.The result is shown in Figures 6 and 7.
In the snow and other low adhesion roads, the vehicle easily enters the nonlinear region.From Figure 7, we can see that when the vehicle is in its limit operation, the difference between the sideslip angle curve Kalman filtering algorithm estimated and actual sideslip angle is large and there is also a difference between the extended Kalman filtering estimation and simulation of the actual value, but the curve is relatively close; overall, the accuracy of the sideslip angle estimation is higher than the accuracy of Kalman filtering algorithm.Moment of inertia about the -axis (kgm ∧ 2) 1523

Sideslip Angle Estimation of Vehicle Test Method
In the simulation test, the extended Kalman filtering algorithm has been verified.This section uses the real vehicle test data to estimate the sideslip angle and real vehicle test data to estimate the sideslip angle.Usually, when the vehicle goes into the nonlinear region, the sideslip angle estimation will have a large deviation from the actual value.In order to enter the nonlinear state, we take the double lane change test in vehicle limit test site with low adhesion road in Heihe City.It is easy to get the vehicle state data of nonlinear region.Figure 8 shows the arrangement of sideslip angle measurement system, Figure 9 shows the snow road with 3 cm thick snow of the double lane test site.The adhesion coefficient of the actual ice and snow road will be changed to 0.3-0.35 because of the difference of compaction degree, water content of snow, and smoothness of snow surface.The vehicle mounted gyroscope is used for real-time acquisition of vehicle yaw rate, lateral acceleration, vehicle speed, and steering wheel angle signal from the vehicle CAN communication.
According to ISO 3888-1: 1999 to implement the double lane change test, pass the double lane change path with the speed of 67 km/h (±5 km/h).At the same time, record the data in computer through Kvaser and write the time history curve of each measurement variable such as the steering wheel angle, yaw velocity, lateral acceleration, longitudinal velocity, the sideslip angle, and the steering rod force information.
Figure 10 shows the steering wheel angle, yaw velocity, longitudinal velocity, lateral acceleration, and yaw angle response curves.From Figure 10(d), we can see that, in the first 10 seconds, the speed is 67 km/h and in double lane change operation speed has decreased.In 20 seconds, the test speed was 60 km/h.From Figure 10(b), we can see that, in 14,5 seconds, the lateral acceleration has reached 0.33 g and the adhesion coefficient of snow and ice road surface is about 0.35.It is almost near the limit state of critical instability.Figure 11 shows that, from the contrast among the extended Kalman filtering estimation, Kalman filtering estimation, and the measured value of the sideslip angle, we can see that when the vehicle is near the critical instability region, because Kalman filtering algorithm ignores the nonlinear tire, the estimation accuracy is lower than that of the extended Kalman filter algorithm.

Conclusion
This paper discusses Kalman filtering and extended Kalman filtering, the two kinds of algorithms of the sideslip angle estimation, and analyzes their characteristics.This paper presents the simulation of the two algorithms on the low adhesion road and carries out the low adhesion road double lane change test.The experimental results show that when the vehicle dynamics enter the nonlinear region, the accuracy of the sideslip angle estimation is higher than the accuracy of Kalman filtering algorithm.We will improve the algorithm to restrain the filtering divergence in the following study.

Figure 3 :
Figure 3: The main interface and constitution of Carsim.
Carsim-Simulink.The main interface of Carsim includes four parts: vehicle characteristics interface, test environment interface, simulation solver

Figure 9 :
Figure 9: Double lane change test site.
Figure 10(e) shows the sideslip angle curve measurement.It has reached 3.22 ∘ in 14.75 s and over 4 ∘ in 16 s.From Figures 10(b) and 10(e), we can see that, taking double lane test on snow and ice road with the speed of 67 km/h, the vehicle is near critical unstable state.
Sideslip angle measurement and filtering value

Figure 10 :
Figure 10: Vehicle state parameters under line condition.

Figure 11 :
Figure 11: Sideslip angle identification values compared with the experimental value under line condition.

Table 1 :
Parameters and meaning.

Table 2 :
Parameters of vehicle settings in Carsim.