Vehicle Sideslip Angle Estimation Based on Hybrid Kalman Filter

Vehicle sideslip angle is essential for active safety control systems.This paper presents a new hybrid Kalman filter to estimate vehicle sideslip angle based on the 3-DoF nonlinear vehicle dynamic model combined withMagic Formula tire model.The hybrid Kalman filter is realized by combining square-root cubature Kalman filter (SCKF), which has quick convergence and numerical stability, with square-root cubature based receding horizon Kalman FIR filter (SCRHKF), which has robustness against model uncertainty and temporary noise. Moreover, SCKF and SCRHKF work in parallel, and the estimation outputs of two filters are merged by interacting multiple model (IMM) approach. Experimental results show the accuracy and robustness of the hybrid Kalman filter.


Introduction
Active safety control systems can improve the handling and stability of vehicle effectively and then reduce the probability of traffic accidents.For instance, March and Shim [1] developed an integrated control system of an active suspension system (ASS) and active front steering (AFS) to enhance vehicle handling and stability in which the active suspension system was mainly used to control the normal force of the vehicle.Mashadi and Majidi [2] proposed a slidingmode controller that cooperates with active front steering and direct yaw moment control (DYC) to prevent vehicle from spinning and drifting out of lane.However, on the premise that we can access the vehicle states information accurately, which include the longitudinal acceleration, the lateral acceleration, the vehicle sideslip angle, the yaw rate, and other states information, then the control logic of these vehicle active safety control systems can work effectively.Some of the required vehicle states information is easy to be measured by the sensors which are equipped on the mass production vehicle, but others are difficult to detect for both technical and economical reasons, such as the sideslip angle.As a consequence, estimation of the sideslip angle based on the measured vehicle states information has important theoretical and practical significance.
Estimation of vehicle sideslip angle, or equivalently the lateral velocity, has been well investigated in the literature, and the estimation approach can be classified into two categories: kinematics-based approach designed according to kinematics motion and model-based approach designed according to the physical vehicle model.Tseng et al. [3] adopted integration method based on kinematical relationship of lateral velocity rate, longitudinal velocity, yaw rate, and lateral acceleration to estimate the lateral velocity.Farrelly and Wellstead [4] proposed a kinematics-based approach that integrated lateral and longitudinal kinematics motion with the pole placement method to estimate the lateral velocity.The kinematic model is unobservable when the yaw rate is zero, and so the resulting observer only functions when the yaw rate is nonzero.Ungoren et al. [5] combined the approach proposed by [4] with a model-based approach to avoid unobservability during near-zero yaw rate conditions.The kinematics-based approach is considered reliable for a transient manoeuvre, but its integration operation can inevitably cause progressive drifting issues resulting from sensor errors.

Mathematical Problems in Engineering
Compared with kinematics-based approach, the modelbased approach has the merit of being independent of sensor errors.Pi et al. [6] proposed a model-based approach based on a simplified single-track model with a linear adaptive tire-force model to estimate the sideslip angle.The vehicle lateral force is calculated by the linear adaptive tire-force model and fed into the extended Kalman filter (EKF), which provides the final estimation of the sideslip angle.Antonov et al. [7] established a planar two-track model with the empiric Magic Formula as a basis for the estimator design and utilized unscented Kalman filter (UKF) to estimate the longitudinal velocity and lateral velocity.Baffet et al. [8] presented a nonlinear cascaded observer method for vehicle sideslip angle and tire-road forces.The first block contains a sliding-mode observer whose principal role is to estimate tire-road forces, and then the estimated tire-road forces are used as input to the second block, in which the EKF estimates the sideslip angle.Ren et al. [9] proposed an UKF based on a 3-DoF vehicle model with the piecewise linear tire model to estimate the instantaneous vehicle speed.Shraim et al.
[10] adopted a high order sliding-mode observer based on the dynamic model of the wheel for the estimation of the longitudinal forces, and then a sliding-mode observer based on the supertwisting algorithm for the estimation of sideslip angle and vehicle speed was proposed.Gadola et al. [11] proposed an EKF-based sideslip angle estimation using a simple single-track model and a set of curves which described the relationship of the lateral forces, the tire slip angle, and the vertical load.Xin et al. [12] proposed a cubature Kalman filter (CKF) based on 3-DoF vehicle model to estimate vehicle velocity, sideslip angle, and yaw rate.The model-based approach strongly depends on the accuracy of the physical vehicle model while the practical vehicle is a nonlinear timevarying high order dynamic system.Therefore, it is necessary to design the sideslip angle estimator which has robustness against model uncertainty and temporary disturbing noise.
Square-root cubature Kalman filter (SCKF) presented by Arasaratnam and Haykin [13] is a nonlinear filter for high-dimensional state estimation.SCKF introduces a thirddegree spherical-radial cubature rule to numerically approximate the multidimensional integrals encountered in the nonlinear Bayesian filter and has proper approximate accuracy and high convergence speed.However, the estimation accuracy and stability of SCKF may be reduced due to model uncertainty and temporary noise [14][15][16].Square-root cubature based receding horizon Kalman filter (SCRHKF) has robustness against model uncertainty and temporary noise [17], while the convergence speed of this filter is worse than SCKF due to the use of a finite number of measurements.Namely, the two filters have complementary features with each other.This paper proposes the hybrid Kalman filter, which integrates the advantage of SCKF and SCRHKF and overcomes the disadvantage of the filters, to estimate the vehicle sideslip angle.In the hybrid Kalman filter, SCKF and SCRHKF work in parallel, and the estimation outputs of two filters are merged by interacting multiple model (IMM) approach.This approach can always make the estimation output of the hybrid Kalman filter smoothly track the estimation output of the filter with the smallest estimation error.Then, in the real vehicle experiment environment, the performance of the proposed method is verified under double lane change and slalom conditions.This paper is organized as follows.Section 2 provides the 3-DoF vehicle dynamic model.Section 3 shows the proposed hybrid Kalman filter.Section 4 introduces our experiments and results.Finally, Section 5 draws the main conclusion of our work.

The Dynamic Model
The proposed method is based on a nonlinear 3-DoF vehicle body model with a precise nonlinear tire model "Magic Formula," which consists of the longitudinal motion, lateral motion, and yaw motion.In order to reduce the size of the state vector, the following modeling assumptions are made: (i) The vehicle body is modeled as being rigid and lumped at the mass center of gravity.
(ii) The vehicle is moving on a flat horizontal plane.
(iii) The heave, pitch, and roll motion are ignored.
(iv) The aerodynamic drag forces are ignored.
(v) The steer angles of the front left and front right wheels are equal.
As shown in Figure 1,  is the fixed coordinate on the ground, and  is the fixed coordinate on the vehicle, with -axis in the vehicle longitudinal direction, -axis in the lateral direction, -axis in the vertical direction, and the origin at the vehicle center of gravity (CoG).The yaw angle around the -axis is taken as positive in the anticlockwise direction.The differential equations of the longitudinal, lateral, and yaw motions are expressed as where V  and V  are the longitudinal and the lateral velocity at the CoG;   and   are the longitudinal and the lateral acceleration at the CoG;  is the yaw rate;  is the vehicle mass;   is the steer angle of front wheels;   is the vehicle moment of inertia about -axis;  is the distance from the front axle to CoG;  is the distance from the rear axle to CoG;  is the track width;  is the vehicle sideslip angle; and   and   are the longitudinal and lateral tire force, where  ∈ {, , , }.Meanwhile, the first subscript of (⋅)  denotes the front and rear axles, and the second denotes the left and right sides of the vehicle.The tire forces of each wheel are described by a nonlinear tire model "Magic Formula."For the sake of simplicity, we neglect the aligning torque and the minor effects due to wheel camber.The tire model expresses the longitudinal force   and the lateral force   as a function of the wheel longitudinal slip  and the wheel sideslip angle , respectively.The general form of the tire model is given by [18,19] where the input  represents  or , which can be expressed as a function of   , V  , V  , ,   , and   ; the output variable () stands for either   or   ; the coefficients , , , and  are expressed as a function of the dynamic normal force   .
Considering pitch and roll load transfer, the dynamic normal forces of each wheel are calculated by where ℎ is the CoG height and  is the wheel base.
The sideslip angle of each wheel can be calculated by The longitudinal speed of the wheel center can be calculated by ( The wheel longitudinal slip is defined as where   is the angular velocity and  ∈ {, , , };   is the effective rolling radius.In summary, we can calculate the input of the tire model that the wheel longitudinal slip , the wheel sideslip angle , and the dynamic normal force   based on the states   , V  , V  , ,   , and   are described by the nonlinear 3-DoF vehicle body model, and then the longitudinal force   and the lateral force   , which can be used as the input of the nonlinear 3-DoF vehicle body model, are calculated by the tire model.Hence, the tire model and the nonlinear 3-DoF vehicle body model are merged together into a complete vehicle model, which in the continuous state-space form reads as ẋ () = f ( () ,  ()) ,  () = ℎ ( () ,  ()) (7) with the input, state, and measurement vectors given by To get the discrete form representation of the system, the zero-order-hold assumption for the system input vector () during the sampling time Δ and the classical forward Euler integration are used.Meanwhile, introducing the stochastic process noise   and the stochastic measurement noise V  , we obtain the discrete form of the system for the filter design as follows: where   and V  are uncorrelated zero-mean white Gaussian noise processes and the covariance of the two processes is denoted by  and , respectively.

The Hybrid Kalman Filter
The hybrid Kalman filter is shown in Figure 2. It consists of interaction/mixing, SCKF, SCRHKF, model probability update, and estimation fusion.In the hybrid Kalman filter, the SCKF and SCRHKF are processed to estimate the vehicle sideslip angle based on the nonlinear 3-DoF vehicle model, respectively, and the state estimate and its covariance of the two filters are combined by interacting multiple model (IMM) approach.Assuming  1 denotes the modelbased SCKF,  2 denotes the model-based SCRHKF, and  = { 1 ,  2 } denotes the model set consisting of  1 and  2 .
3.1.Square-Root Cubature Kalman Filter.SCKF is a squareroot extension of the standard CKF and uses the leastsquares method for the Kalman gain and triangularization for covariance updates to improve the numerical stability.SCKF introduces a third-degree spherical-radial cubature rule to calculate the cubature point   and the corresponding weight   : where  = 2 and  is the system state dimension; [1] is the set of points composed of the full array of the unit vector  = [1, 0, . . ., 0] T 's elements, and [1]  is the th point from set [1].
Assume at time  − 1 that the Cholesky decomposition of the covariance the steps of SCKF are presented as follows [13].
(1) Time Update Evaluate the cubature point: Evaluate the propagated cubature points through the state function: Estimate the predicted state: Estimate the square-root factor of the predicted error covariance: where Tria(⋅) denotes a general triangularization algorithm (e.g., the QR decomposition) and is a lower triangular matrix;  ,−1 denotes a square-root factor of  −1 such that  −1 =  ,−1  T ,−1 and the weighted, centered matrix (2) Measurement Update Evaluate the cubature points: Evaluate the propagated cubature points through the measurement function: Estimate the predicted measurement: Estimate the square-root of the innovation covariance matrix: where  , denotes a square-root factor of   such that   =  ,  T , and the weighted, centered matrix Estimate the cross-covariance matrix: where the weighted, centered matrix Hidden horizon: RHKF Active horizon: SCKF Estimate the Kalman gain: Estimate the updated state: Estimate the square-root factor of the corresponding error covariance:

Square-Root Cubature Based Receding Horizon Kalman
Filter.SCRHKF has an FIR structure, and the current estimation states of SCRHKF are based on a finite number of measurements over the recent time horizon [20].Figure 3 shows the concept of the SCRHKF, which consists of the hidden horizon and the active horizon.The sizes of the receding horizon and receding interval are set up as  which is the system dimension.The RHKF is processed in the hidden horizon.The states and the inverse covariance matrix at time  (+1) , which are used as the initial values of the active horizon from  (+1) to  (+2) , can be estimated based on the final estimation states at time   and the measurements from   to  (+1) in this horizon.After processing the hidden horizon, the active horizon and another hidden horizon are carried out.In the active horizon, the SCKF is processed to calculate the final estimation states from  (+1) to  (+2) based on the outputs of the hidden horizon at time  (+1) .
The steps of SCRHKF are presented as follows. (

1) Initialization of Hidden Horizon
Initialize the states, the inverse covariance, and the pseudo error state:

) Time Update of Hidden Horizon
Estimate the predicted inverse covariance: where Estimate the predicted pseudo error state: (28)

Mathematical Problems in Engineering (3) Measurement Update of Hidden Horizon
Estimate the update inverse covariance: where   = (ℎ/)| = *  .Estimate the update pseudo error state:

) Initialization of Active Horizon
Initialize the states and the covariance: (

Interacting Multiple Model Approach.
The IMM approach carries out a "soft switching" between the model-based SCKF and the model-based SCRHKF by the model probability.The steps of IMM are presented as follows [21]. (

1) Model Mixing Probability Calculation
Calculate the model mixing probability: where (

2) Interaction/Mixing
Consider the following: (3) Filtering The SCKF and SCRHKF are processed to estimate the vehicle sideslip angle, respectively.

(4) Model Probability Update
Update the probability model: (

5) Estimation Fusion
Consider the following:

Experimental Results
The performance of the proposed estimator has been verified by a rear-wheel-drive Hongqi H7 test vehicle.The vehicle is additionally equipped with the Oxford Technical Solutions RT3000 measurement unit and the rotary potentiometer coupled with the steering column using a simple belt and pulley system.Different driving manoeuvres are performed on a flat and dry asphalt surface for testing the estimator performance.All the geometrical and physical data of the car are listed in Table 1.
As previously explained, the signals used for testing the proposed estimator include (i) the longitudinal and lateral vehicle velocity, the longitudinal and lateral vehicle acceleration, the vehicle sideslip angle, and the yaw rate acquired from the RT3000 unit, (ii) the steering angle captured by the rotary potentiometer, and (iii) front and rear wheel speeds obtained from the vehicle CAN bus system.The covariance The initial model probabilities for the model-based SCKF and the model-based SCRHKF are identical with  1 0 =  2 0 = 0.5.The initial states of the estimator are identical to the measured values from the RT3000 unit, and the initial covariance matrix is chosen as  0 = 0 *  3×3 .
First, the double lane change manoeuvre is implemented and the lateral acceleration is more than 0.8 g, which is shown in Figure 4. Figures 5(a)-5(d) show a comparison of the estimated results versus the measured values for the manoeuvre.The results based on the hybrid Kalman filter follow the trend of measured values quite well and they are always within an acceptable range, while the estimated lateral velocity and sideslip angle using SCKF generate some large errors due to the modeling mismatch in nonlinear region and sensor noise.Moreover, in order to quantitatively evaluate the effectiveness of the proposed method, the root meansquared error between the estimated and measured values is computed.According to the statistical results shown in Table 2, the proposed method has the maximum root meansquared error 0.0777 and mean values 0.0258, while the maximum and mean root mean-squared errors of the SCKF are 0.1840 and 0.0690, respectively.
Second, the slalom manoeuvre is implemented and the vehicle undergoes the fast and large steering angle action, which is shown in Figure 6.Figures 7(a)-7(d) show a comparison of the estimated results versus the measured values for the manoeuvre and similar results can be obtained compared with double lane change manoeuvre.The SCKF is influenced by the modeling mismatch and sensor noise and shows some large errors for the estimated lateral velocity and sideslip angle.However, the hybrid Kalman filter has high convergence speed for the fast and large vehicle lateral motion and great robustness against model mismatch and sensor noise, and therefore the filter can accurately track the measured values except the peak region of the lateral acceleration, in which the vehicle reaches the limit of tireroad adhesion and the estimated lateral velocity and sideslip angle of the hybrid Kalman filter have acceptable errors.According to the statistical results shown in Table 2, the proposed method has the smallest maximum 0.0739 and mean values 0.0251; the maximum and mean values of the SCKF are 0.1271 and 0.0446, respectively.

Conclusions
This paper has presented novel estimation methods based on the nonlinear 3-DoF vehicle model with the tire model "Magic Formula" and making use of typical sensory information found in stock ESC sensor packs to estimate the vehicle sideslip angle accurately.The proposed method combines the merit of SCKF that has high convergence speed and numerical stability with the merit of SCRHKF that has great robustness against model uncertainty and temporary noise.Then, the real vehicle test is implemented to validate the performance of the proposed method.The comparison with SCKF shows that it can provide more accurate estimation for the active safety control systems.
In future works, the proposed method can be improved to adapt to various road conditions.Moreover, active safety

Figure 4 :
Figure 4: Estimation input under double lane change manoeuvre.

Table 2 :
Root mean-square error of state estimation.