# Design of an Interacting Multiple Model-Cubature Kalman Filter Approach for Vehicle Sideslip Angle and Tire Forces Estimation

Authors: SuoJun Hou; Wenbo Xu; Gang Liu
Journal: Mathematical Problems in Engineering
 (2019)

---

## Abstract

Vehicle states estimation (e.g., vehicle sideslip angle and tire force) is a key factor for vehicle stability control. However, the accurate values of these parameters could not be obtained directly. In this paper, an interacting multiple model-cubature Kalman filter (IMM-CKF) is used to estimate the vehicle state parameters. And improvements about estimation method are achieved in this paper. Firstly, the accuracy of the reference model is improved by building two different models: one is 7-degree-of-freedom (7 DOF) vehicle model with linear tire model, and the other is 7 DOF vehicle model with nonlinear Dugoff tire model. Secondly, the different models are switched by IMM-CKF to match different driving condition. Thirdly, the lateral acceleration correction for sideslip angle estimation is considered, because the sensor of lateral acceleration is easy to be influenced by the gravity on banked road. Then, to compare cubature Kalman filter (CKF) estimation method and IMM-CKF estimation method Hardware-In-Loop (HIL) tests are carried out in the paper. And simulation results show that IMM-CKF methodology can provide accurate estimation values of vehicle states parameters.


---

## Body

## 1. Introduction

With the development of the electronic and automotive technology, the vehicle stability control is also undergoing continuous progress. Vehicle stability control plays an important role in active vehicle safety control. The performance of vehicle stability control is determined by the accuracy of vehicle state (e.g., vehicle sideslip angle and tire force) because the vehicle state parameters show the potential of vehicle stability. However, the vehicle state parameters, such as the sideslip angle and tire force, cannot be measured directly for both technical and economic reasons. Therefore the vehicle state parameter must be estimated by a variety of algorithm methods.Recently, many estimation approaches based on standard ESP sensors (e.g., steering angle, yaw rate, longitudinal and lateral acceleration, and wheel-speed) have been proposed in the literature to estimate vehicle state parameters [1]. These approaches can be divided into two types according to the vehicle dynamic models. Type 1 uses the linear vehicle model to estimate the sideslip angle and tire-road forces. Based on the linear vehicle model, known as the single-track model with a linear tire-force model, the estimation approach of vehicle state works well under normal driving condition [2–4] because the vehicle state depends on the tire force and the effect of tire force can change the trajectory of the vehicle. Figure 1 shows the relation between the tire force and the wheel slip angle. Under the normal driving condition, the value of wheel slip angle is small. Therefore the curve, which reflects the relationship between the tire force and the wheel slip angle, is initially linear. Many algorithms, such as the variable forgetting factor recursive least squares algorithm [5], Luenberger linear Observer [6], H∞ filtering [7], and Kalman filters [8, 9], based on the linear model have been used to estimate the vehicle state parameters. However, the vehicle cannot always be under normal driving condition. Under extreme driving conditions, the value of vehicle state tends to nonlinear growth. Figure 1 shows that, as the wheel slip angle grows, the tire force gradually enters into the nonlinear region, which is caused by the limited friction on the road surface, especially on a low friction road. Consequently, the parameters estimated based on linear vehicle model are error due to the tire’s inherent nature. Compared to type 1, type 2 uses the estimation approach based on the nonlinear vehicle model [10, 11], which is more close to reflect the vehicle dynamics nature, to predict the vehicle state under extreme driving conditions. A lot of literatures have been proposed to estimate the parameters based on the nonlinear vehicle model. Liang Li and Gang Jia proposed a variable structure extended Kalman filter with the sideslip angle rate feedback to estimate the sideslip angle [12]. Their simulations and vehicle winter test show that the proposed approach can provide accurate value of sideslip under low friction road conditions. Yu and Kh Guo proposed a reduced-order sliding mode observer for vehicle state estimation [13, 14]. The precise nonlinear tire model “UniTire” is used to improve the accuracy of vehicle states parameters estimation. A novel approach is proposed to estimate parameters by using a mathematical tool, which includes a nonlinear Magic tire model [15]. B.L.Boada proposed a novel observer based on adaptive Neuro-Fuzzy Inference System (ANFIS), combined with Unscented Kalman Filter in order to estimate the sideslip angle and tire force [16]. Wei L. proposed an estimation approach based on the Extended Kalman Filter (EKF) combing with the Minimum Model Error (MME) criterion for vehicle state estimation [17]. However, the estimation based on nonlinear vehicle model is not suitable for parameters estimations under normal driving conditions because of the excessive computational power in embedded systems. In sum, the time to choose an optimal model for various driving conditions is also important besides the choice of vehicle model. The multiple model (MM) method takes advantage of several models to express possible vehicle model under different driving conditions, which can achieve more accurate vehicle state parameters by combined filters based on corresponding vehicle model of a limited number of different models compared with single vehicle model. Among several MM estimation algorithms, the interacting MM (IMM) has attracted wide attention because it can obtain accurate calculation results with low computational load [18].Figure 1
Lateral force curve.In this paper, we use the interacting multiple model (IMM) to choose an optimal model for various driving conditions. In the IMM method, two filters are used in parallel to estimate sideslip angle and tire force. One filter is CKF filter based on four-wheel nonlinear vehicle dynamics model with linear tire model for normal driving conditions and the other is based on four-wheel nonlinear vehicle dynamics model with nonlinear Dugoff tire model for extreme driving conditions. The sideslip angle and tire force predicted by the variable structure IMM-CKF filter are more accurate than the single filter for various driving conditions.This paper is organized as follows. In Section2, the dynamics models of the vehicle, linear tire, and nonlinear Dugoff tire model are presented, respectively. In Section 3, the detailed structure of IMM-CKF is represented. In Section 4, the key dynamics variable is given in detail. In Section 5 the simulations are presented to validate the performance of the estimation method.


## 2. Design of Vehicle Dynamics Model

### 2.1. Vehicle Model

In Figure2, the 7-DOF vehicle dynamics model is proposed to estimate the vehicle state parameters. The 7-DOF vehicle model includes longitudinal motion, lateral motion, yaw motion, and 4-wheel rotation [13].Figure 2
7-DOF vehicle model.The equation of longitudinal motion is expressed as follows:(1)mv˙x-vyφ˙=∑i,j=12Fxij=Fx11+Fx12cos⁡δ+Fx21+Fx22-Fx11+Fx12sin⁡δ=maxThe equation of lateral motion is expressed as follows:(2)mv˙y+vxφ˙=∑i,j=12Fyij=Fy11+Fy12cos⁡δ+Fy21+Fy22-Fy11+Fy12sin⁡δ=mayThe equation of yaw motion is expressed as follows:(3)Izφ¨=Fy11+Fy12Lfcos⁡δ+Fy11-Fy12Lrsin⁡δ-Fy21+Fy22Lr-Fx11-Fx12Lfsin⁡δ-Fx11-Fx12Bf2cos⁡δ-Fx21-Fx22Bf2The equation of wheel motion is expressed as follows:(4)Jww˙ij=Tij-pijKPTij-FxijRThe equation about sideslip angle can be expressed as follows:(5)mβ˙+φ˙vg=Fy11+Fy12cos⁡β-δ+Fy11+Fy12cos⁡β-Fx11+Fx12sin⁡β-δ-Fx11+Fx12sin⁡β(6)mv˙g=Fx11+Fx12cos⁡β-δ+Fx21+Fx22cos⁡β+Fy11+Fy12sin⁡β-δ+Fy11+Fy12sin⁡βwhere m represents the mass of the vehicle; β denotes the sideslip angle; δ denotes the front steering angle; vx represents the longitudinal velocity; vy is the lateral velocity of the vehicle; Fxij denotes the longitudinal tire force of 4 wheels, respectively; Fyij denotes the lateral tire force of 4 wheels, respectively; Lf and Lr are the distances from the front and rear axle to the gravity center, respectively; Bf represents track width of the vehicle; Jw denotes the wheel inertia; Tij denotes driving torque; pij denotes the brake pressure of wheels; KPTij denotes the coefficient of the brake pressure; ωij denotes the speed of 4 wheels, respectively; Iz is the yaw moment of inertia. R is the wheel radius; φ is yaw angle.


### 2.2. Tire Model

When the vehicle is turning, the longitudinal acceleration and the later acceleration will have an effect on each wheel because of the load transfer. Therefore, the vertical load of 4 wheels can be expressed as follows:(7)Fz11=mgLr2L-mhcgax2L-hcgLrLBfmayFz12=mgLr2L+mhcgax2L+hcgLfLBfmayFz21=mgLf2L+mhcgax2L+hcgLfLBfmayFz22=mgLr2L+mhcgax2L-hcgLfLBfmaywhere Fzij denotes the vertical force of 4 wheels; hcg denotes the distance between the gravity center and the ground; ay denotes the lateral acceleration; ax denotes the longitude acceleration; L denotes the distances between the front axle and rear axles.As discussed in Section1, in case of vehicle driving under normal driving conditions, the relationship between the lateral force and the tire slip angle is linear. On the other hand, under extreme driving conditions, the lateral acceleration of vehicle tends to be big, and the tire operates in the nonlinear region. Therefore, in this paper, linear tire model and the nonlinear tire model are established.


#### 2.2.1. Linear Tire Model

The linear tire model proposed by the authors [19] is adopted in this paper. The tire slip angles can be formulated as follows: (8)α11α12α21α22=δδ00-ξ11ξ12ξ21ξ22where ξij can be expressed as (9)
ξ
11
ξ
12
ξ
21
ξ
22
=
t
a
n
-
1
v
y
+
L
f
φ
˙
v
x
-
B
f
φ
˙
/
2
v
y
+
L
f
φ
˙
v
x
+
B
f
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
-
B
r
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
+
B
r
φ
˙
/
2
≈
v
y
+
L
f
φ
˙
v
x
-
B
f
φ
˙
/
2
v
y
+
L
f
φ
˙
v
x
+
B
f
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
-
B
r
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
+
B
r
φ
˙
/
2At small slip angle, the lateral tire force is proportion to the tire slip angle. The equation of lateral tire force can be written as follows:(10)Fyij=-Cyijαijwhere Cyij represents cornering stiffness of 4 wheels, respectively.The equation of longitudinal tire force can be expressed as(11)Fxij=kμλijFzijwhere λij denotes the slip ratio of 4 wheels, respectively; kμ is the proportional coefficient.


#### 2.2.2. Nonlinear Tire Model

Under the extreme driving conditions, such as a low friction road surface, the tire is easy to enter into nonlinear state even at low lateral acceleration. Thus, the Dugoff nonlinear tire model is used to represent the tire forces in nonlinear region [20].The equations of lateral tire force and the longitudinal tire forces can be expressed as(12)Fyij=Cyijtan⁡αij1-λijfS(13)Fxij=Cxijλij1-λijfS(14)S=μFzij1-εvxλij2+tan2αij2Cij2λij2+Cij2tan2αij1-λij2(15)fS=1S>1S2-SS<1λij=Rwωij-vxmax⁡Rwωij,vxwhere ε denotes roll steer coefficient.


#### 2.2.3. Modified Tire-Road Force

Considering the time lag of tire force, Reference [21] proposed a relaxation length to represent the transient behavior of tires. The modified tire-road force can be expressed as (16)F˙yij=vgσij-Fyij+F-yij(17)F˙xij=vgσij-Fxij+F-xijwhere F-yij denotes the quasi-static lateral Dugoff tire force; σij denotes the relaxation coefficient.


## 2.1. Vehicle Model

In Figure2, the 7-DOF vehicle dynamics model is proposed to estimate the vehicle state parameters. The 7-DOF vehicle model includes longitudinal motion, lateral motion, yaw motion, and 4-wheel rotation [13].Figure 2
7-DOF vehicle model.The equation of longitudinal motion is expressed as follows:(1)mv˙x-vyφ˙=∑i,j=12Fxij=Fx11+Fx12cos⁡δ+Fx21+Fx22-Fx11+Fx12sin⁡δ=maxThe equation of lateral motion is expressed as follows:(2)mv˙y+vxφ˙=∑i,j=12Fyij=Fy11+Fy12cos⁡δ+Fy21+Fy22-Fy11+Fy12sin⁡δ=mayThe equation of yaw motion is expressed as follows:(3)Izφ¨=Fy11+Fy12Lfcos⁡δ+Fy11-Fy12Lrsin⁡δ-Fy21+Fy22Lr-Fx11-Fx12Lfsin⁡δ-Fx11-Fx12Bf2cos⁡δ-Fx21-Fx22Bf2The equation of wheel motion is expressed as follows:(4)Jww˙ij=Tij-pijKPTij-FxijRThe equation about sideslip angle can be expressed as follows:(5)mβ˙+φ˙vg=Fy11+Fy12cos⁡β-δ+Fy11+Fy12cos⁡β-Fx11+Fx12sin⁡β-δ-Fx11+Fx12sin⁡β(6)mv˙g=Fx11+Fx12cos⁡β-δ+Fx21+Fx22cos⁡β+Fy11+Fy12sin⁡β-δ+Fy11+Fy12sin⁡βwhere m represents the mass of the vehicle; β denotes the sideslip angle; δ denotes the front steering angle; vx represents the longitudinal velocity; vy is the lateral velocity of the vehicle; Fxij denotes the longitudinal tire force of 4 wheels, respectively; Fyij denotes the lateral tire force of 4 wheels, respectively; Lf and Lr are the distances from the front and rear axle to the gravity center, respectively; Bf represents track width of the vehicle; Jw denotes the wheel inertia; Tij denotes driving torque; pij denotes the brake pressure of wheels; KPTij denotes the coefficient of the brake pressure; ωij denotes the speed of 4 wheels, respectively; Iz is the yaw moment of inertia. R is the wheel radius; φ is yaw angle.


## 2.2. Tire Model

When the vehicle is turning, the longitudinal acceleration and the later acceleration will have an effect on each wheel because of the load transfer. Therefore, the vertical load of 4 wheels can be expressed as follows:(7)Fz11=mgLr2L-mhcgax2L-hcgLrLBfmayFz12=mgLr2L+mhcgax2L+hcgLfLBfmayFz21=mgLf2L+mhcgax2L+hcgLfLBfmayFz22=mgLr2L+mhcgax2L-hcgLfLBfmaywhere Fzij denotes the vertical force of 4 wheels; hcg denotes the distance between the gravity center and the ground; ay denotes the lateral acceleration; ax denotes the longitude acceleration; L denotes the distances between the front axle and rear axles.As discussed in Section1, in case of vehicle driving under normal driving conditions, the relationship between the lateral force and the tire slip angle is linear. On the other hand, under extreme driving conditions, the lateral acceleration of vehicle tends to be big, and the tire operates in the nonlinear region. Therefore, in this paper, linear tire model and the nonlinear tire model are established.


### 2.2.1. Linear Tire Model

The linear tire model proposed by the authors [19] is adopted in this paper. The tire slip angles can be formulated as follows: (8)α11α12α21α22=δδ00-ξ11ξ12ξ21ξ22where ξij can be expressed as (9)
ξ
11
ξ
12
ξ
21
ξ
22
=
t
a
n
-
1
v
y
+
L
f
φ
˙
v
x
-
B
f
φ
˙
/
2
v
y
+
L
f
φ
˙
v
x
+
B
f
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
-
B
r
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
+
B
r
φ
˙
/
2
≈
v
y
+
L
f
φ
˙
v
x
-
B
f
φ
˙
/
2
v
y
+
L
f
φ
˙
v
x
+
B
f
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
-
B
r
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
+
B
r
φ
˙
/
2At small slip angle, the lateral tire force is proportion to the tire slip angle. The equation of lateral tire force can be written as follows:(10)Fyij=-Cyijαijwhere Cyij represents cornering stiffness of 4 wheels, respectively.The equation of longitudinal tire force can be expressed as(11)Fxij=kμλijFzijwhere λij denotes the slip ratio of 4 wheels, respectively; kμ is the proportional coefficient.


### 2.2.2. Nonlinear Tire Model

Under the extreme driving conditions, such as a low friction road surface, the tire is easy to enter into nonlinear state even at low lateral acceleration. Thus, the Dugoff nonlinear tire model is used to represent the tire forces in nonlinear region [20].The equations of lateral tire force and the longitudinal tire forces can be expressed as(12)Fyij=Cyijtan⁡αij1-λijfS(13)Fxij=Cxijλij1-λijfS(14)S=μFzij1-εvxλij2+tan2αij2Cij2λij2+Cij2tan2αij1-λij2(15)fS=1S>1S2-SS<1λij=Rwωij-vxmax⁡Rwωij,vxwhere ε denotes roll steer coefficient.


### 2.2.3. Modified Tire-Road Force

Considering the time lag of tire force, Reference [21] proposed a relaxation length to represent the transient behavior of tires. The modified tire-road force can be expressed as (16)F˙yij=vgσij-Fyij+F-yij(17)F˙xij=vgσij-Fxij+F-xijwhere F-yij denotes the quasi-static lateral Dugoff tire force; σij denotes the relaxation coefficient.


## 2.2.1. Linear Tire Model

The linear tire model proposed by the authors [19] is adopted in this paper. The tire slip angles can be formulated as follows: (8)α11α12α21α22=δδ00-ξ11ξ12ξ21ξ22where ξij can be expressed as (9)
ξ
11
ξ
12
ξ
21
ξ
22
=
t
a
n
-
1
v
y
+
L
f
φ
˙
v
x
-
B
f
φ
˙
/
2
v
y
+
L
f
φ
˙
v
x
+
B
f
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
-
B
r
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
+
B
r
φ
˙
/
2
≈
v
y
+
L
f
φ
˙
v
x
-
B
f
φ
˙
/
2
v
y
+
L
f
φ
˙
v
x
+
B
f
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
-
B
r
φ
˙
/
2
v
y
-
L
r
φ
˙
v
x
+
B
r
φ
˙
/
2At small slip angle, the lateral tire force is proportion to the tire slip angle. The equation of lateral tire force can be written as follows:(10)Fyij=-Cyijαijwhere Cyij represents cornering stiffness of 4 wheels, respectively.The equation of longitudinal tire force can be expressed as(11)Fxij=kμλijFzijwhere λij denotes the slip ratio of 4 wheels, respectively; kμ is the proportional coefficient.


## 2.2.2. Nonlinear Tire Model

Under the extreme driving conditions, such as a low friction road surface, the tire is easy to enter into nonlinear state even at low lateral acceleration. Thus, the Dugoff nonlinear tire model is used to represent the tire forces in nonlinear region [20].The equations of lateral tire force and the longitudinal tire forces can be expressed as(12)Fyij=Cyijtan⁡αij1-λijfS(13)Fxij=Cxijλij1-λijfS(14)S=μFzij1-εvxλij2+tan2αij2Cij2λij2+Cij2tan2αij1-λij2(15)fS=1S>1S2-SS<1λij=Rwωij-vxmax⁡Rwωij,vxwhere ε denotes roll steer coefficient.


## 2.2.3. Modified Tire-Road Force

Considering the time lag of tire force, Reference [21] proposed a relaxation length to represent the transient behavior of tires. The modified tire-road force can be expressed as (16)F˙yij=vgσij-Fyij+F-yij(17)F˙xij=vgσij-Fxij+F-xijwhere F-yij denotes the quasi-static lateral Dugoff tire force; σij denotes the relaxation coefficient.


## 3. IMM-CKF

The algorithm structure of vehicle state estimation proposed in this paper is shown in Figure3. The whole algorithm structure can be regarded as hierarchical strategy, and it can be divided into 2 layers. The first layer is signal layer. In the first layer, the signals obtained by the sensors or derived from other systems are transmitted to next layers for estimation, and these signals include the longitudinal acceleration ax, the lateral acceleration ax, yaw rate φ˙, longitudinal speed vx, speed of each ωij, steer angle δh, and break pressure of each wheel cylinder pij. The second layer is responsible for calculation of weight according to the road friction coefficient and vehicle lateral acceleration.Figure 3
Scheme of the IMM-CKF method for vehicle state estimation.In the second layer, the IMM-based estimation layer calculates the model switch probabilities and integrates the CKF estimation of each model by stochastic process to adapt to various driving conditions. The further algorithm about IMM-CKF can be found in Reference [22].It is appropriate that the filter of 7-DOF vehicle model based on linear tire model is used under the normal work conditions because the relationship of tire slip angle and lateral force is linear and there is a small amount of computations for embedded system. In contrast, the relationship of the tire slip angle and the lateral force is no longer linear under extreme driving conditions. The filter of 7-DOF vehicle model based on nonlinear tire model can provide better prediction performance. The process of IMM-CKF can be described in Figure4. The IMM-CKF can be broken down into 4 steps:Figure 4
The process of IMM-CKF.Step 1 (interaction reinitialization).
Compute the mixed probabilities and the initial condition in first step. Initial mean and covariance for each CKF filter model can be expressed as follows:(18)x-k-1∣k-1i=Exk-1∣mkiZk-1=∑i=1rx^k-1∣k-1iμk-1∣k-1i,j(19)p-k-1∣k-1i=∑i=1rPk-1∣k-1i+x^k-1∣k-1j-x-k-1∣k-1jx^k-1∣k-1j-x-k-1∣k-1jTμk-1∣k-1i,jwhere μk-1∣k-1(i,j)=P(mk-1(i)∣mk(i)Zk-1)=1/C-πijμk-1(i)i,j=1,2,...,r.
μ k - 1 ∣ k - 1 ( i , j ) is mixing probabilities of model i; the model switch probabilities of the IMM filter between the two models are due to the Markov Process, which is determined by the transition probability matrix πij. The model transition probability matrix πij denotes the transition probability of vehicle model from model j to model i. The parameter πij can be expressed as (20)πij=0.990.010.020.98where j,i denote the 7-DOF vehicle model with linear tire model and 7-DOF vehicle model with nonlinear Dugoff tire model, respectively. These values of model switch probability matrix were obtained by a statistical method, which related to the sampling time interval under the real driving condition [23–26].Step 2 (mode-filtering using CKF and then computation of the model probability update).
In this step, the CKF is used to obtain each model statex^k∣k and covariance Pk∣k which is based on the previous mixing state x-k-1∣k-1(i) and the covariance p-k-1∣k-1(i). The overall flowchart of the CKF for vehicle model i is presented in Figure 5. The state equation of the vehicle model with the linear tire model is similar to that of the vehicle model with nonlinear Dugoff tire model. The state equation of the vehicle model with the linear tire model includes equations (1), (2), (3), (4), (5), (6), (9), (10), and (11). The state equation of the vehicle model with nonlinear Dugoff tire model includes equations (1), (2), (3), (4), (5), (6), (9), (12), and (13). Both state equations can be expressed as (21)x˙t=fxt,ut+Wtyt=hxt,ut+VtThe input vector of both models can be written as(22)u=δh,ω11,ω12,ω21,ω22The output of both models can be described as(23)y=ax,ay,φ˙,ω11,ω12,ω21,ω22The state of both models can be expressed as(24)x=φ˙,vg,β,Fy11,Fy12,Fy21,Fy22,Fx11,Fx12,Fx21,Fy22Hence, the function f(.) of equation (17) can be written as(25)f1=1Izx4+x5Lfcos⁡u1+x4-x5Lrsin⁡u1-x6+x7Lr-x8-x9Lfsin⁡u1-x8-x9Bf2cos⁡u1-x10-x11Bf2f2=1mx8+x9cos⁡x3-u1+x6+x7cos⁡x3+x4+x5sin⁡x3-u1+x4+x5sin⁡x3f3=1mx2x4+x5cos⁡x3-u1+x4+x5cos⁡x3-x8+x9sin⁡x3-u1-x8+x9sin⁡x3-x1f4=x2σ11-x4+F-y11,f5=x2σ12-x5+F-y12,f6=x2σ21-x6+F-y21f7=x2σ22-x7+F-y22,f8=x2σ11-x8+F-x11,f9=x2σ12-x9+F-x12f10=x2σ21-x10+F-x21,f11=x2σ22-x11+F-x22The measurement function h(.) of equation (21) can be written as (26)h1=1mx8+x9cos⁡u1+x6+x7-x8+x9sin⁡u1h2=1mx4+x5cos⁡u1+x10+x11-x4+x5sin⁡u1h3=x1,h4=u2,h5=u3,h6=u4,h7=u5Before using the CKF to estimate the state vector x(t), equation (21) should be discretized as follows:(27)xk=fxk-1,uk-1+wk-1zk=hxk,uk+vkwhere xk∈Rnx denotes the state of the vehicle system at discrete time k; zk∈Rnx denotes measurement; uk∈Rnx denotes the input; wk-1∈Rnx and vk∈Rnx denote independent process and measurement Gaussian noise sequences assumed to be in white independent and with covariance Qk and Rk, respectively. The CKF can be expressed as follows:
(i) Time Update(28)Sk-1∣k-1=SVDPk-1∣k-1χk-1∣k-1=Sk-1∣k-1ξ+xk-1∣k-1χk∣k-1∗=fχk-1∣k-1xk∣k-1=1m∑i=1mχi,k∣k-1∗Pk∣k-1=1m∑i=1mχi,k∣k-1∗χi,k∣k-1∗T-xk∣k-1xk∣k-1T+Qk (ii) Measurement Update(29)Sk∣k-1=SVDPk∣k-1χk∣k-1=Sk∣k-1ξ+xk∣k-1Zk∣k-1=hχk∣k-1zk∣k-1=1m∑i=1mZi,k∣k-1Pzz,k∣k-1=1m∑i=1mZi,k∣k-1Zi,k∣k-1T-zk∣k-1zk∣k-1T+RkPxz,k∣k-1=1m∑i=1mχi,k∣k-1Zi,k∣k-1T-xk∣k-1zk∣k-1T+RkKk=Pxz,k∣k-1Pzz,k∣k-1-1xk∣k=xk∣k-1+Kkzk-zk∣k-1Pk∣k=Pk∣k-1-KkPzz,k∣k-1KkTwhere SVD denotes the matrix singular value decomposition method; S represents the square-root of the covariance matrix P; m=2n,m denotes the total number of Cubature points; ξ=m/2[1]i; χi is the Cubature point which is generated by the states equations; Zi is the Cubature point which is generated by measurements.Figure 5
HIL simulation platform.Step 3 (model probability update).
In this step, the likelihood function of each mode can be expressed as(30)Λki=Pz~ki∣mki,zk-1=2πSki-1/2exp⁡-12z~kiTSki-1z~ki(31)μki=Pmki∣zk=1cΛkic-j(32)c=∑i=1rΛkic-jwhere Sk(i)=Hk(i)Pk∣k-1(i)(Hk(i))T+Rk(i); Sk(i) denotes the innovation covariance. c denotes the normalization factor.Step 4 (estimation fusion).
After calculation of each mode's probabilities, the vehicle state parameters prediction and the covariance can be calculated according to Gaussian mixture equation. The equation of vehicle state parameters prediction and its covariance can be, respectively, expressed as(33)x^k∣k=∑i=1rx^kiμki(34)Pk∣k=∑i=1rPk∣ki+x^k∣k-x^k∣kix^k∣k-x^k∣kiTμki


## 4. Key Dynamics Variable of VSIMM-CKF

The sensor of lateral acceleration is a sort of inertial sensors which is easily affected by the gravity when the axis of chassis is not horizontal. Therefore, the outputs of lateral acceleration sensor need to be corrected. Similarly, road adhesion coefficient and cornering stiffness correction are very important, so they are introduced separately in this section.


### 4.1. Correction of Lateral Acceleration

In case of vehicle driving on the flat and level road, the measured results of lateral acceleration are precise. But in case of driving on the slope road, the measured results tend to become higher than those on the flat and level road. Because the lateral acceleration sensor is easy to be influenced by the roll angle of the vehicle, therefore, it is necessary to correct the measured results before being used in the vehicle state estimation. The equation of correct lateral acceleration can be written as(35)ay=aym-gαrollwhere ay denotes the corrected lateral acceleration; αroll denotes the roll angle; aym denotes the measured results of lateral acceleration.The equation of roll angle can be expressed as(36)αroll=mayhrollKF+KR-mghrollwhere hroll denotes the distance between the gravity and the axis of rolling; KF denotes the rolling stiffness of front suspension; KR denotes the rolling stiffness of rear suspension.


### 4.2. Road Friction Estimation

Road friction plays an important role in vehicle state estimation. However, it is difficult to acquire its value directly. According to the estimation method proposed in Reference [27], the value of road friction can be calculated as follows:(37)μ=ayg+μewhereg denotes the gravitational acceleration; μe denotes the evaluated error. The value of μe can be referred in Reference [27].


### 4.3. Correction of Cornering Stiffness

According to Reference [27], the cornering stiffness can be expressed as a second order polynomial of tire force. But in the real vehicle dynamics system, the lateral tire force is always coupled with the longitudinal tire force. In order to minimize the discrepancy caused by simplification, the following correction is applied to cornering stiffness. According to Reference [28], Pacejka and H.B. proposed the limiting factor with the longitudinal tire force as input variable for the condition where no longitudinal dynamics is considered:(38)φlf=μ2Fzij2-Fxij2μFzijThe limiting factor limits the max lateral tire force to its certain fraction, which conversely redefines the cornering stiffness as follows:(39)Cαμ,Fzij,Fxij=φlfCαμ,Fzij,Fxij=0-12μFzij+12μFzij-Fxij


## 4.1. Correction of Lateral Acceleration

In case of vehicle driving on the flat and level road, the measured results of lateral acceleration are precise. But in case of driving on the slope road, the measured results tend to become higher than those on the flat and level road. Because the lateral acceleration sensor is easy to be influenced by the roll angle of the vehicle, therefore, it is necessary to correct the measured results before being used in the vehicle state estimation. The equation of correct lateral acceleration can be written as(35)ay=aym-gαrollwhere ay denotes the corrected lateral acceleration; αroll denotes the roll angle; aym denotes the measured results of lateral acceleration.The equation of roll angle can be expressed as(36)αroll=mayhrollKF+KR-mghrollwhere hroll denotes the distance between the gravity and the axis of rolling; KF denotes the rolling stiffness of front suspension; KR denotes the rolling stiffness of rear suspension.


## 4.2. Road Friction Estimation

Road friction plays an important role in vehicle state estimation. However, it is difficult to acquire its value directly. According to the estimation method proposed in Reference [27], the value of road friction can be calculated as follows:(37)μ=ayg+μewhereg denotes the gravitational acceleration; μe denotes the evaluated error. The value of μe can be referred in Reference [27].


## 4.3. Correction of Cornering Stiffness

According to Reference [27], the cornering stiffness can be expressed as a second order polynomial of tire force. But in the real vehicle dynamics system, the lateral tire force is always coupled with the longitudinal tire force. In order to minimize the discrepancy caused by simplification, the following correction is applied to cornering stiffness. According to Reference [28], Pacejka and H.B. proposed the limiting factor with the longitudinal tire force as input variable for the condition where no longitudinal dynamics is considered:(38)φlf=μ2Fzij2-Fxij2μFzijThe limiting factor limits the max lateral tire force to its certain fraction, which conversely redefines the cornering stiffness as follows:(39)Cαμ,Fzij,Fxij=φlfCαμ,Fzij,Fxij=0-12μFzij+12μFzij-Fxij


## 5. Simulation Verification

In order to validate the proposed estimation method, the simulations were carried out. The simulations are based on the Hardware-In-Loop (HIL) and the simulation platform is shown in Figure5. Vedyna [29] is used to describe the vehicle model, and the vehicle model is downloaded into the Simulator of DSPACE. The vehicle state estimation algorithm is realized by Matlab/Simulink, and the method is also downloaded into the MicroAutobox of DSPACE. The signal of steering angle, which is generated by driver, is transmitted to the Simulator. And then the vehicle state is changed by the operation of the driver. The MicroAutobox receives the signal of vehicle state such as the longitudinal acceleration ax, the lateral acceleration ay, the yaw rate φ˙, the steering angle δ, and the wheels speed ωij by CAN BUS the Simulator. In order to improve CANBUS delay problem, a node is selected as the synchronization node. The synchronization node sends a synchronization message with ID0 once every 300ms interval. The transmission intervals of other nodes are set to 5ms, 10ms, 20ms, 30ms, 40ms, etc. When other nodes receive synchronization messages from synchronization nodes, they empty their own counters so that all nodes synchronize once every 300 milliseconds. Other nodes use messages sent by synchronous nodes as the benchmark to send messages sequentially, which can avoid the problem of collision between multiple nodes at sending time, avoid bus competition, and reduce the possibility of message delay. At last, the vehicle state is calculated by the proposed algorithm in this paper. The whole simulation scheme based on HIL can be depicted as Figure 6. The values of the parameters for simulation are expressed in Table 1 [19, 30].Table 1
Parameters for simulation.
Symbol Value Unit Description L f 1.4 m Distance c.g. to front axle L r 1.4 m Distance c.g. to rear axle C y f 110000 N/rad Front cornering stiffness C y r 95000 N/rad Rear cornering stiffness I z 3500 Kg/m2 Yaw moment of inertia B f 1.5 M Track width m 2000 Kg Vehicle mass J w 1.3 Kg/m2 Wheel inertia R 0.28 M Wheel radiusFigure 6
The simulation scheme based on HIL.Two kinds of simulation tests are adopted to validate the estimation method. The first one is double-lane change (DLC) maneuvers on banked 5% road to validate the method of lateral acceleration correction proposed in Section4. The second one is DLC maneuvers on flat level road. And the simulation results of estimation method proposed in this paper are compared with the estimation based on CKF to discuss the performance of both methods.


### 5.1. Simulation Results of the DLC Manoeuver on Banked 5% Road (Steering Angle Is 55 Degrees at 71km/h)

Figures7(a) and 7(b) show the steering angle, lateral acceleration during DLC test on banked 5% road. It is because of the existence of bank angle that the lateral acceleration is influenced. Figure 8 shows the simulation result of the estimated sideslip angle on banked 5% road. Seen from Figure 8, the sideslip angle estimated by IMM-CKF without the lateral acceleration correction deviates from the real one largely. In contrast, the value of sideslip angle estimated by IMM-CKF with lateral acceleration correction can predict more accurate value of sideslip angle as described in Figure 8. Thus the proposed IMM-CKF with lateral acceleration correction has robustness on the banked road.Figure 7 (a)
Steer angle of steering wheel (b)
The lateral acceleration of vehicleFigure 8
The estimated sideslip angle on banked 5% road.Figure9 shows the simulation results of the estimation method of the sideslip angle on banked 10%. It can be seen from the curve that the error of the estimated sideslip angle becomes large for the reason of the increase in error of lateral acceleration.Figure 9
The estimated sideslip angle on banked 10% road.


### 5.2. Simulation Results of the DLC Manoeuver on Flat Level Road (Steering Angle Is 55 Degrees at 71km/h)

In this section, as shown in Figure10, two kinds of simulation tests under high adhesion coefficient (μ=0.8) are adopted to compare the performance among the proposed estimator (IMM-CKF), cubature Kalman filter (CKF), unscented Kalman filter (UKF), and extended Kalman filter (EKF). The simulation results, which include the estimated sideslip angle and the estimated tire-road force, are described in Figures 11–13. Figure 12 shows the simulation results of sideslip angle. The values estimated by other filter methods have more error than the value estimated by IMM-CKF. The same phenomenon can be observed in Figure 13. The IMM-CKF algorithm shows more accuracy than other methods. There is a small difference between the actual value and the value estimated by IMM-CKF, which maybe neglects the effect of the suspension model.Figure 10
The simulation model for the sideslip angle estimation.Figure 11 (a)
The yaw rate of vehicle (b)
The lateral acceleration of vehicleFigure 12
The estimated sideslip angle on flat level road.Figure 13 (a)
Front right lateral tire force (b)
Front left lateral tire force (c)
Front right longitudinal tire force (d)
Front left longitudinal tire forceAs shown in Figure12, during the time intervals (5-6s and 7-8s), the estimated sideslip and tire force are not consistent with the true value. The error is due to longitudinal load transfer. With the increase of vehicle mass, the error increases gradually.


### 5.3. Simulation Results of the DLC Manoeuver on Banked 10% Road

In order to evaluate the correction of cornering stiffness, the steering input of DLC manoeuver on banked 10% road is generated. The simulation is done on ice road (road frictionμ=0.3), and the vehicle velocity is 60km/h. The simulation results with and without the correction of cornering stiffness are presented in Figure 14. The change of cornering stiffness is due to the drastic lateral load transfer, which immediately leads to the increase of the sideslip angle. As such, the estimation result with correction of cornering stiffness shows more robust performance, especially in presence of large sideslip angle regime, compared with the simulation result in the absence of correction about cornering stiffness. Such an obvious difference in the performance is observed clearly in the period between 8.5s and 9s in Figure 14(a). The result of correction is presented in Figures 14(b) and 14(c).Figure 14 (a)
Estimated sideslip angle with and without cornering stiffness correction (b)
Front cornering stiffness (c)
Rear cornering stiffness


## 5.1. Simulation Results of the DLC Manoeuver on Banked 5% Road (Steering Angle Is 55 Degrees at 71km/h)

Figures7(a) and 7(b) show the steering angle, lateral acceleration during DLC test on banked 5% road. It is because of the existence of bank angle that the lateral acceleration is influenced. Figure 8 shows the simulation result of the estimated sideslip angle on banked 5% road. Seen from Figure 8, the sideslip angle estimated by IMM-CKF without the lateral acceleration correction deviates from the real one largely. In contrast, the value of sideslip angle estimated by IMM-CKF with lateral acceleration correction can predict more accurate value of sideslip angle as described in Figure 8. Thus the proposed IMM-CKF with lateral acceleration correction has robustness on the banked road.Figure 7 (a)
Steer angle of steering wheel (b)
The lateral acceleration of vehicleFigure 8
The estimated sideslip angle on banked 5% road.Figure9 shows the simulation results of the estimation method of the sideslip angle on banked 10%. It can be seen from the curve that the error of the estimated sideslip angle becomes large for the reason of the increase in error of lateral acceleration.Figure 9
The estimated sideslip angle on banked 10% road.


## 5.2. Simulation Results of the DLC Manoeuver on Flat Level Road (Steering Angle Is 55 Degrees at 71km/h)

In this section, as shown in Figure10, two kinds of simulation tests under high adhesion coefficient (μ=0.8) are adopted to compare the performance among the proposed estimator (IMM-CKF), cubature Kalman filter (CKF), unscented Kalman filter (UKF), and extended Kalman filter (EKF). The simulation results, which include the estimated sideslip angle and the estimated tire-road force, are described in Figures 11–13. Figure 12 shows the simulation results of sideslip angle. The values estimated by other filter methods have more error than the value estimated by IMM-CKF. The same phenomenon can be observed in Figure 13. The IMM-CKF algorithm shows more accuracy than other methods. There is a small difference between the actual value and the value estimated by IMM-CKF, which maybe neglects the effect of the suspension model.Figure 10
The simulation model for the sideslip angle estimation.Figure 11 (a)
The yaw rate of vehicle (b)
The lateral acceleration of vehicleFigure 12
The estimated sideslip angle on flat level road.Figure 13 (a)
Front right lateral tire force (b)
Front left lateral tire force (c)
Front right longitudinal tire force (d)
Front left longitudinal tire forceAs shown in Figure12, during the time intervals (5-6s and 7-8s), the estimated sideslip and tire force are not consistent with the true value. The error is due to longitudinal load transfer. With the increase of vehicle mass, the error increases gradually.


## 5.3. Simulation Results of the DLC Manoeuver on Banked 10% Road

In order to evaluate the correction of cornering stiffness, the steering input of DLC manoeuver on banked 10% road is generated. The simulation is done on ice road (road frictionμ=0.3), and the vehicle velocity is 60km/h. The simulation results with and without the correction of cornering stiffness are presented in Figure 14. The change of cornering stiffness is due to the drastic lateral load transfer, which immediately leads to the increase of the sideslip angle. As such, the estimation result with correction of cornering stiffness shows more robust performance, especially in presence of large sideslip angle regime, compared with the simulation result in the absence of correction about cornering stiffness. Such an obvious difference in the performance is observed clearly in the period between 8.5s and 9s in Figure 14(a). The result of correction is presented in Figures 14(b) and 14(c).Figure 14 (a)
Estimated sideslip angle with and without cornering stiffness correction (b)
Front cornering stiffness (c)
Rear cornering stiffness


## 6. Conclusions

(1)
For the sake of the various driving conditions, two vehicle models were built for estimation. The 7-degree-of-freedom (7 DOF) vehicle model with linear tire model was built for normal driving condition, and the other is 7DOF vehicle model with nonlinear Dugoff tire model for the extreme driving condition. Two models were switched by IMM-CKF to match the different driving condition. (2)
To eliminate the estimation error caused by lateral acceleration sensor in case of vehicle driving on the slope road, the lateral acceleration correction for sideslip angle estimation is considered. The overall results from HIL verify that the proposed method can realize accurate estimation about vehicle state parameters in a wide range of road conditions. Meanwhile, the method is only applied on the mild banked road, and the application of the proposed approach under higher banking angle road would be concerned in the future research.



---

*Source: 6087450-2019-06-20.xml*