the Creative Commons Attribution 4.0 License.
the Creative Commons Attribution 4.0 License.
On coestimation and validation of vehicle driving states by a UKFbased approach
Peng Wang
Hui Pang
Zijun Xu
Jiamin Jin
It is necessary to acquire the accurate information of vehicle driving states for the implementation of automobile active safety control. To this end, this paper proposes an effective coestimation method based on an unscented Kalman filter (UKF) algorithm to accurately predict the sideslip angle, yaw rate, and longitudinal speed of a ground vehicle. First, a 3 degreesoffreedom (DOFs) nonlinear vehicle dynamics model is established as the nominal control plant. Then, based on CarSim software, the simulation results of the front steer angle and longitudinal and lateral acceleration are obtained under a variety of working conditions, which are regarded as the pseudomeasured values. Finally, the joint simulation of vehicle state estimation is realized in the MATLAB/Simulink environment by using the pseudomeasured values and UKF algorithm concurrently. The results show that the proposed UKFbased vehicle driving state estimation method is effective and more accurate in different working scenarios compared with the EKFbased estimation method.
As we all know, a variety of vehicles has become a popular and common device in people's daily lives; meanwhile, an active safety system (ASC) of a ground vehicle plays an important role in avoiding traffic accidents as a means of guaranteeing passenger safety. However, the effective operation of ASC systems is inseparable from the accurate acquisition of vehicle driving states (Zhang et al., 2019). In general, most vehicle state information is obtained by onboard sensors. However, due to the limitation of cost and measurement methods, it is difficult for some vehicle state signals to be measured directly by sensors, which makes the estimation of vehicle states a hot topic in the field of vehicle ASCs.
Among the vehicle state signals, the sideslip angle, yaw rate, and longitudinal speed are important input variables for the vehicle ASC systems, such as the Electronic Stabilization Program (ESP), Adaptive Cruise Control (ACC), and Lane Keeping Assist (LKA), as well as the state signals that often need to be estimated (Li et al., 2020).
Currently, the common vehicle state estimation methods are usually divided into kinematics methods and dynamics methods (Selmanaj et al., 2017). Based on the relationship between the known state and the unknown state, the kinematics modelbased methods calculate the unknown states by directly integrating the kinematics equation (Yamamoto et al., 1995). Generally, these methods have good accuracy for vehicle parameters, road adhesion coefficient, and driving operation. Under the condition of accurate sensor signals, these methods have high estimation accuracy for the sideslip angle in both linear and nonlinear regions (Li et al., 2014). However, the accuracy of these estimation methods is heavily dependent on the measurement accuracy of sensors, which will directly affect the estimation result of the kinematics method. What is more, due to the error accumulations in the integral process, the estimation error caused by measurement noise will increase gradually, and this will still result in the deviation of the estimated value of kinematics from its corresponding values (Piyabongkarn et al., 2009; Kim et al., 2020).
Based on the vehicle dynamics model and tire model, the dynamics methods use modern observation technology to estimate the unknown state, which can reduce the dependence on the sensor precision. The Kalman filter (KF) algorithm family are the common dynamics modelbased methods, and lots of scholars have conducted extensive research on the Kalman filter familybased state estimation method. Based on an extended Kalman filter (EKF), Zong et al. (2009) established an information fusion algorithm, which gave out fusion results of vehicle state at minimum square error, and an offline simulation with real vehicle site test data in the MATLAB/Simulink environment was carried out. In Naets et al. (2017)'s research, a nonlinear least square tire parameter estimator was designed to estimate the sideslip angle and the side force of the tire based on the EKF approach, and the covariance caused by the model changes and the variation of driving conditions were also considered. Besides, Katriniok and Abel (2016) proposed an EKFbased estimator to estimate the dynamic parameters of electric vehicles, such as the longitudinal and lateral speeds, along with the yaw rate. Meanwhile, the effectiveness of this EKFbased estimator was validated through MATLAB/Simulink. Moreover, a modelbased state observer (Reina et al., 2017) was developed to estimate the key motion states and the vehicle mass online; based on this, a type of vehicle parameter estimation approach was proposed by integrating with the EKF algorithm, and a comparative study between the proposed method and the KF approach was also conducted. Considering that the steering torque signal has faster and more direct response characteristics than the steering angle signal, Ma et al. (2018) proposed an EKF estimation method for the sideslip angle based on the steering torque and verified the accuracy of this method by real vehicle tests.
Like the study above, Liu et al. (2016) proposed a state estimation method for fourwheel drive vehicles based on the minimum model error (MME) criterion by combing with the EKF algorithm. It should be noticed that this method can effectively find out the dynamic tire force errors and then update the system model parameters, which improves the estimation accuracy of the vehicle state.
It is worth pointing out that the EKF algorithm is usually used to estimate the weaknonlinear systems and simple systems. When the system is strongly nonlinear, the EKF estimation results may lead to large errors or even diverge. In addition, when the estimated system is too complex, the computational load of the EKF algorithm will increase dramatically, which may cause no solution of the Jacobian matrix (Zhou et al., 2019; Strano and Terzo, 2018). Fortunately, compared with the EKF algorithm, the unscented Kalman filter (UKF) algorithm approximates linearization by sampling instead of calculating the Jacobian matrix, which can avoid the abovementioned problems.
In recent years, some scholars have used the UKF algorithm to estimate the driving states of vehicles. Heidfeld et al. (2019) proposed a state estimation method for allwheel drive electric vehicles based on the UKF algorithm, which realized the comprehensive estimation of longitudinal and lateral speed, tire slip angle, and tire friction coefficient on each wheel. Based on the UKF algorithm, Song et al. (2020) designed a state observer to realize the joint estimation of vehicle states and parameters and carried out the simulation verification on the Simulink/Carsim platform. The results showed that the joint observer could effectively estimate and identify the relevant vehicle states and parameters and had a good convergence effect.
Inspired by these studies, in this paper, an effective estimation method is conducted based on the UKF algorithm in order to accurately estimate the driving states of vehicles.
This paper is organized as follows: 3 degreesoffreedom (DOFs) vehicle dynamics modeling and problem formulation of vehicle state estimation are provided in Sect. 2, and Sect. 3 synthesizes the proposed UKFbased vehicle driving state estimation method. Besides, in Sect. 4, the validity of this UKFbased vehicle state estimation is verified by the joint simulation of CarSim and MATLAB/Simulink. Finally, Sect. 5 summarizes the conclusions and future works along this research direction.
In this paper, the 3DOFs nonlinear vehicle dynamics model is selected as the nominal model for vehicle state estimation. Based on the 2DOFs linear vehicle dynamics model (Li et al., 2017), a dynamic model including longitudinal, lateral, and yaw motion is established, as demonstrated in Fig. 1.
The 3DOFs vehicle dynamics model can be described as follows:
where a and b are the distances between the vehicle center of mass and the front axle and rear axle, respectively; k_{1} and k_{2} are equivalent cornering stiffness of the front and rear axles, respectively; m and I_{z} are the mass and the rotational inertia of the vehicle, respectively; v_{x} is the longitudinal velocity; r is the vehicle yaw rate; β is the vehicle sideslip angle; δ is the front steer angle; a_{y} is the lateral acceleration.
It is noted that we aim to estimate β, r, and v_{x} in real time by using the measured a_{x} and a_{y} as well as δ (obtained indirectly by measuring the steering wheel angle).
The system state vector x is defined as
the system input vector u is defined as
and the system output vector z (the measurement vector) is defined as
Combining Eqs. (1)–(7), the vehicle dynamics model is expressed in the form of a statespace equation as
where the state matrices A, B, C, and D are described in Appendix A.
Based on the 3DOFs vehicle dynamics model established above in Eq. (8), the UKF algorithm is applied to estimate the key driving states with the measured inputs acquired by the vehicle onboard sensors.
3.1 Unscented transformation (UT)
UT is the key of the UKF algorithm, which is a method to approximate Gaussian distribution by using a fixed number of parameter branches (Kim and Park, 2010). The UT approach can realize the linearization process of a nonlinear system by the sampling method, and it can also avoid the complicated calculation of the Jacobian matrix. The flowchart of UT is demonstrated in Fig. 2.
The detailed procedure of the UT is illustrated as follows.

Constructing the Sigma points
According to a certain sampling strategy, a series of sampling points χ_{i} ($i=\mathrm{0},\mathrm{1},\mathrm{\dots},\mathrm{2}n$) are sampled from the vehicle state variables at the previous moment, which are called Sigma points. 2n is the number of sampling points, and the weights of the mean and covariance are ${\mathit{W}}_{i}^{\left(\mathrm{m}\right)}$ and ${\mathit{W}}_{i}^{\left(\mathrm{c}\right)}$, which represent the weighted coefficients of the firstorder and secondorder statistical properties, respectively.

Nonlinear transformation
After the nonlinear transformation of χ_{i}, ${\mathit{\chi}}_{i}^{}$ can be obtained, which can approximately represent the distribution of the prediction function $\dot{\mathit{x}}=\mathbf{A}\mathit{x}+\mathbf{B}\mathit{u}$ or measurement function $\mathit{z}=\mathbf{C}\mathit{x}+\mathbf{D}\mathit{u}$ in Eq. (8).

Calculating the weighted sample mean and covariance
By calculating the weighted sum of ${\mathit{\chi}}_{i}^{}$, the prior distribution of vehicle states can be approximated; that is, the mean value and covariance of the state vector x in Eq. (5) can be calculated. The crucial issue of UT is to determine the sampling strategy of Sigma points, that is, to determine the number, position, and corresponding weight of each Sigma point (Kim and Park, 2010).
3.2 UKF algorithm
When the onestep prediction equation of the standard KF algorithm uses UT to realize the nonlinear transformation of the mean and covariance matrix, the UKF algorithm is then constructed. The steps of the UKF algorithm are as follows.

Setting the initial values:
$$\begin{array}{}\text{(9)}& \left\{\begin{array}{l}\widehat{\mathit{x}}\left(\mathrm{0}\right)=E\left[\mathit{x}\left(\mathrm{0}\right)\right]\\ \mathit{P}\left(\mathrm{0}\right)=E\left\{\left[\mathit{x}\left(\mathrm{0}\right)\widehat{\mathit{x}}\left(\mathrm{0}\right)\right]{\left[\mathit{x}\left(\mathrm{0}\right)\widehat{\mathit{x}}\left(\mathrm{0}\right)\right]}^{\mathrm{T}}\right\}\end{array}\right),\end{array}$$wherein x(0) is the initial state value in Eq. (5).

Update the timescale states.
 a.
Sampling the Sigma points
Based on the symmetric sampling strategy, the Sigma points and the weights of Sigma points, together with the corresponding covariance, are calculated by using the estimated state $\widehat{\mathit{x}}(k\mathrm{1})$ and the corresponding covariance P_{x}(k−1) of Eq. (5) at k−1 sampling time. The Sigma points ξ_{i} are constructed as
$$\begin{array}{}\text{(10)}& {\mathit{\xi}}_{i}\left(k\right)=\left\{\begin{array}{ll}\widehat{\mathit{x}}(k\mathrm{1}),& i=\mathrm{0},\\ \widehat{\mathit{x}}(k\mathrm{1})& \\ +(\sqrt{\left(n+\mathit{\lambda}\right){\mathit{P}}_{x}(k\mathrm{1})}{)}_{j}& i=\mathrm{1},\mathrm{2},\mathrm{\dots},n,\\ \widehat{\mathit{x}}(k\mathrm{1})& \\ (\sqrt{\left(n+\mathit{\lambda}\right){\mathit{P}}_{x}(k\mathrm{1})}{)}_{j}& i=n+\mathrm{1},\mathrm{\dots},\mathrm{2}n,\end{array}\right)\end{array}$$where n is the dimension of the state vector to be estimated; $\mathit{\lambda}={\mathit{\alpha}}^{\mathrm{2}}(n+{k}_{\mathrm{p}})n$ is the proportionality coefficient, which is used to adjust the distance between $\widehat{\mathit{x}}(k\mathrm{1})$ and Sigma points. The constant α determines the degree of dispersion of Sigma points which usually takes a small positive value. The constant k_{p} is the second scale parameter, which is usually set as 0 or 3−n. $(\sqrt{\left(n+\mathit{\lambda}\right){P}_{x}(k\mathrm{1})}{)}_{j}$ is the jth column of the covariance matrix square root where $j=\mathrm{1},\mathrm{2},\mathrm{\dots},n$.
The weights of each Sigma point and the covariance matrix, i.e., ${\mathit{W}}_{i}^{\left(\mathrm{m}\right)}$ and ${\mathit{W}}_{i}^{\left(\mathrm{c}\right)}$, are determined by
$$\begin{array}{}\text{(11)}& {\displaystyle}{\mathit{W}}_{i}^{\left(\mathrm{m}\right)}=\left(\right)open="\{">\begin{array}{ll}\frac{\mathit{\lambda}}{n+\mathit{\lambda}},& i=\mathrm{0},\\ \frac{\mathrm{1}}{\mathrm{2}(n+\mathit{\lambda})},& i=\mathrm{1},\mathrm{2},\mathrm{\dots},\mathrm{2}n,\end{array}\end{array}\text{(12)}& {\displaystyle}{\mathit{W}}_{i}^{\left(\mathrm{c}\right)}=\left\{\begin{array}{ll}{\mathit{W}}_{\mathrm{0}}^{\left(\mathrm{c}\right)}+(\mathrm{1}{\mathit{\alpha}}^{\mathrm{2}}+\mathit{\gamma}),& i=\mathrm{0},\\ \frac{\mathrm{1}}{\mathrm{2}(n+\mathit{\lambda})},& i=\mathrm{1},\mathrm{2},\mathrm{\dots},\mathrm{2}n,\end{array}\right)$$where γ is the state distribution parameter, which is used to describe the distribution information of $\widehat{\mathit{x}}(k\mathrm{1})$. In the case of Gaussian distribution, the optimal value is 2.
When k>1, a Sigma point set containing 2n+1 sample points is constructed according to Eq. (10), which can be represented by
$$\begin{array}{}\text{(13)}& \begin{array}{rl}{\mathit{\xi}}_{i}\left(k\right)& =\left(\right)open="\{">\widehat{\mathit{x}}(k\mathrm{1}),\widehat{\mathit{x}}(k\mathrm{1})+(\sqrt{(n+\mathit{\lambda}){\mathit{P}}_{x}(k\mathrm{1})}{)}_{j},\end{array}& \left(\right)open>\left(\widehat{\mathit{x}}(k\mathrm{1})(\sqrt{(n+\mathit{\lambda}){\mathit{P}}_{x}(k\mathrm{1})}{)}_{j}\right\},\end{array}$$where $i=\mathrm{1},\mathrm{2},\mathrm{\dots},\mathrm{2}n+\mathrm{1}$; $j=\mathrm{1},\mathrm{2},\mathrm{\dots},n$.
 b.
Calculating the sample points of the predicted values
The prediction function $\dot{\mathit{x}}=\mathbf{A}\mathit{x}+\mathbf{B}\mathit{u}$ in Eq. (8) is used to perform the nonlinear transformation on each Sigma point to obtain the predicted value of each point, as shown in Eq. (14):
$$\begin{array}{}\text{(14)}& \begin{array}{rl}& {\mathit{\xi}}_{i}^{}\left(k\right)=f\left({\mathit{\xi}}_{i}\right(k),\phantom{\rule{0.25em}{0ex}}\phantom{\rule{0.25em}{0ex}}\mathit{u}(k\left)\right)={\mathbf{A}}_{i}{\mathit{\xi}}_{i}\left(k\right)+{\mathbf{B}}_{i}\mathit{u}\left(k\right),\\ & i=\mathrm{1},\mathrm{2},\mathrm{\dots},\mathrm{2}n+\mathrm{1}.\end{array}\end{array}$$  c.
Calculating the prior state estimate and covariance
By using the weight of Sigma points and corresponding covariance obtained from Eqs. (11) and (12), the weighted sum of the predicted sample points and covariance can be calculated; that is, the prior state and covariance can be given by
$$\begin{array}{}\text{(15)}& {\displaystyle}{\widehat{\mathit{x}}}^{}\left(k\right)=\sum _{i=\mathrm{0}}^{\mathrm{2}n}{\mathit{W}}_{i}^{\left(\mathrm{m}\right)}{\mathit{\xi}}_{i}^{}\left(k\right),\text{(16)}& {\displaystyle}\begin{array}{rl}{\mathit{P}}_{x}^{}\left(k\right)& =\sum _{i=\mathrm{0}}^{\mathrm{2}n}{\mathit{W}}_{i}^{\left(\mathrm{c}\right)}\left[{\mathit{\xi}}_{i}^{}\right(k){\widehat{\mathit{x}}}^{}(k\left)\right]\\ & \cdot \left[{\mathit{\xi}}_{i}^{}\right(k){\widehat{\mathit{x}}}^{}(k){]}^{\mathrm{T}}+{\mathbf{Q}}_{k},\end{array}\end{array}$$wherein Q_{k} is the covariance matrix of system noise.
In fact, the essence of steps (a) to (c) is to perform a UT on $\widehat{\mathit{x}}(k\mathrm{1})$ and P_{x}(k−1) using the prediction function $\dot{\mathit{x}}=\mathbf{A}\mathit{x}+\mathbf{B}\mathit{u}$ in Eq. (8).
 d.
Calculating the prior measurement
Return to step (a) and use the measurement function $\mathit{z}=\mathbf{C}\mathit{x}+\mathbf{D}\mathit{u}$ in Eq. (8) to carry out the second UT on ${\widehat{\mathit{x}}}^{}\left(k\right)$ and ${\mathit{P}}_{x}^{}\left(k\right)$ to obtain the prior measurement values ${\widehat{\mathit{z}}}^{}\left(k\right)$, where the weight of each Sigma point is the same as step (a). The reconstructed Sigma point and the corresponding sampling points of prior measurement values are represented by χ_{i}(k) and ${\mathit{\chi}}_{i}^{}\left(k\right)$, respectively. Simultaneously, the selfcovariance P_{z}(k) of ${\widehat{\mathit{z}}}^{}\left(k\right)$ and the crosscovariance of ${\widehat{\mathit{x}}}^{}\left(k\right)$ and ${\widehat{\mathit{z}}}^{}\left(k\right)$ can be calculated. The relevant calculation formulas are as follows:
$$\begin{array}{}\text{(17)}& \begin{array}{rl}{\mathit{\chi}}_{i}\left(k\right)& =\left(\right)open="\{">{\widehat{\mathit{x}}}^{}\left(k\right),{\widehat{\mathit{x}}}^{}\left(k\right)+(\sqrt{(n+\mathit{\lambda}){\mathit{P}}_{x}^{}\left(k\right)}{)}_{j},\end{array}& \left({\widehat{\mathit{x}}}^{}\left(k\right)(\sqrt{(n+\mathit{\lambda}){\mathit{P}}_{x}^{}\left(k\right)}{)}_{j}\right\},\end{array}$$where $i=\mathrm{1},\mathrm{2},\mathrm{\dots},\mathrm{2}n+\mathrm{1}$; $j=\mathrm{1},\mathrm{2},\mathrm{\dots},n$, ${\mathit{\chi}}_{i}^{}\left(k\right)$ and ${\widehat{\mathit{z}}}^{}\left(k\right)$ are as follows:
$$\begin{array}{}\text{(18)}& {\displaystyle}{\mathit{\chi}}_{i}^{}\left(k\right)=h\left({\mathit{\chi}}_{i}\right(k),\mathit{u}(k\left)\right)={\mathbf{C}}_{i}{\mathit{\chi}}_{i}\left(k\right)+{\mathbf{D}}_{i}u\left(k\right),\text{(19)}& {\displaystyle}{\widehat{\mathit{z}}}^{}\left(k\right)=\sum _{i=\mathrm{0}}^{\mathrm{2}n}{\mathit{W}}_{i}^{\left(\mathrm{m}\right)}{\mathit{\chi}}_{i}^{}\left(k\right),\text{(20)}& {\displaystyle}\begin{array}{rl}{\mathit{P}}_{z}\left(k\right)& =\sum _{i=\mathrm{0}}^{\mathrm{2}n}{\mathit{W}}_{i}^{\left(\mathrm{m}\right)}\left[{\mathit{\chi}}_{i}^{}\right(k){\widehat{\mathit{z}}}^{}(k\left)\right]\\ & \cdot \left[{\mathit{\chi}}_{i}^{}\right(k){\widehat{\mathit{z}}}^{}(k){]}^{\mathrm{T}}+{\mathbf{R}}_{k},\end{array}\end{array}$$wherein R_{k} is the covariance matrix of measured noise.
$$\begin{array}{}\text{(21)}& \begin{array}{rl}{\mathit{P}}_{xz}\left(k\right)& =\sum _{i=\mathrm{0}}^{\mathrm{2}n}{\mathit{W}}_{i}^{\left(\mathrm{m}\right)}\left[{\mathit{\chi}}_{i}\right(k){\widehat{\mathit{x}}}^{}(k\left)\right]\\ & \cdot \left[{\mathit{\chi}}_{i}^{}\right(k){\widehat{\mathit{z}}}^{}(k){]}^{\mathrm{T}}\end{array}\end{array}$$
 a.

Update the posterior estimation with measured values.
By comparing the actual measured value and the estimated measured value in Eq. (19), the Kalman gain is used to update the prior state and covariance, and we can obtain the updated value of the posterior state $\widehat{\mathit{x}}\left(k\right)$ and covariance ${\widehat{\mathit{P}}}_{x}\left(k\right)$ by using Eq. (22).
$$\begin{array}{}\text{(22)}& \left\{\begin{array}{l}\mathit{K}\left(k\right)={\mathit{P}}_{xz}\left(k\right){\mathit{P}}_{z}^{\mathrm{1}}\left(k\right)\\ \widehat{\mathit{x}}\left(k\right)={\widehat{\mathit{x}}}^{}\left(k\right)+\mathit{K}\phantom{\rule{0.125em}{0ex}}\left[\mathit{z}\right(k){\widehat{\mathit{z}}}^{}(k\left)\right]\\ {\widehat{\mathit{P}}}_{x}\left(k\right)={\mathit{P}}_{x}^{}\left(k\right)\mathit{K}\left(k\right){\mathit{P}}_{z}\left(k\right)\mathit{K}(k{)}^{\mathrm{T}}\end{array}\right)\end{array}$$By synthesizing the above derivations, the estimation flowchart of vehicle states based on the UKF approach is provided in Fig. 3.
In order to validate the accuracy and feasibility of the proposed UKFbased vehicle states estimation approach, a cosimulation and verification in CarSim and MATLAB/Simulink is performed. First, the response curves of δ, β, r, and v_{x} as well as a_{x} and a_{y} are obtained in the CarSim environment under sine and fishhook maneuvers. Then, based on MATLAB/Simulink, the UKF and EKF algorithms are used to estimate β, r, and v_{x}, wherein δ and a_{x} are regarded as the input values and a_{y} is regarded as the measurement. Finally, the estimation results of UKF and EKF are compared with those of CarSim to judge the accuracy of the estimation of vehicle driving states by the UKF algorithm.
In this work, the initial value of the state covariance matrix of the UKF algorithm is set as ${\mathit{P}}_{\mathrm{0}}={I}_{\mathrm{4}\times \mathrm{4}}$, and the system process noise Q_{k} and the measured noise R_{k} are given as ${\mathit{Q}}_{k}=\mathrm{0.001}\times {I}_{\mathrm{4}\times \mathrm{4}}$ and R_{k}=0.005, respectively. The related vehicle parameters used in the simulation model are shown in Table 1 (Li et al., 2017), and the structure of the simulator based on the UKF algorithm is shown in Fig. 4.
4.1 Sine manoeuver test
The sine manoeuver test is first carried out in the CarSim environment, and the simulation results of δ and a_{x} are shown in Fig. 5. Taking these estimates as pseudomeasured values and input values, we use the proposed UKFbased estimation method to estimate the required states. Simultaneously, the comparison curves of β, r, v_{x}, and a_{y}, along with their corresponding absolute and relative error curves, are provided in Figs. 6, 7, and 8, respectively.
In terms of the results in Figs. 6, 7, and 8, the estimated values of UKF on β, r, v_{x}, and a_{y} are basically consistent with the measured values gotten by CarSim software and have smaller absolute errors than EKF. Among them, the relative errors of UKF on β, r, v_{x}, and a_{y} are basically kept below 3 %; only when the steering wheel angle reaches its maximum will the fluctuation of the relative errors be a little larger. In general, the relative errors of UKF are lower than EKF. Obviously, UKF has better estimation ability than EKF.
4.2 Fishhook manoeuver test
4.2.1 Case I
The similar simulations are conducted under the fishhook manoeuver test I scenario using CarSim software, and the obtained δ and a_{x} are shown in Fig. 9. Meanwhile, the comparison curves of β, r, v_{x}, and a_{y}, along with their corresponding absolute and relative error curves, are provided Figs. 10, 11, and 12, respectively.
In terms of Figs. 10, 11, and 12, there is also a high consistency in UKF between the estimated and measured values of β, r, v_{x}, and a_{y} under fishhook manoeuver test I. Especially the absolute error of v_{x} with UKF is far lower than that with EKF. Under the circumstance that the absolute error of EKF presents an increasing trend, the error curve of UKF is still relatively flat. Meanwhile, the relative errors of UKF on v_{x} and a_{y} are always kept below 3 %; only the relative errors of β and r are relatively high at 0 and 2 s, respectively, and later they also decrease to below 3 %, which indicates that the estimation results of the proposed UKFbased driving states estimation method have higher accuracy.
4.2.2 Case II
Similar to the simulation in Case I, the related simulations are carried out under fishhook manoeuver test II. The obtained results of δ and a_{x} are displayed in Fig. 13, which are used as the inputs to the UKFbased simulation model in the MATLAB/Simulink environment. Thus, the comparison curves of β, r, v_{x}, and a_{y}, along with their corresponding error curves, are displayed in Figs. 14, 15, and 16, respectively.
Like the situations in Case I, the proposed UKFbased vehicle estimation method still maintains a higher accuracy than EKF in Case II, and only the error of β and r at 2 and 10 s is relatively large. It is noted that the vehicle will be unstable at these two moments when steering quickly at a high speed. In other words, the working area of the tire is shifted, which weakens the axle cornering characteristic and changes the steering characteristic of the vehicle (Zhang et al., 2014), resulting in a larger error.
To further demonstrate the accuracy of the proposed UKFbased vehicle states estimation method, the mean absolute percentage error (MAPE) (Ma et al., 2016), a statistical index which can express the estimation error as a percentage, is given as below:
where x^{∗}(k) is the exact value of the vehicle state at moment k, which is the state value estimated by CarSim software in this paper; $\widehat{\mathit{x}}\left(k\right)$ is the estimated value of UKF at moment k, that is, the posterior state value obtained by Eq. (22); N is the number of state values of the vehicle.
The MAPE of UKF and EKF on β, r, v_{x}, and a_{y} under the sine manoeuver test, Case I, and Case II are shown in Table 2, and the average errors of the proposed UKFbased method and traditional EKF are displayed in Fig. 17.
As shown in Table 2, the MAPEs of UKF on β, r, and v_{x} are all around 1 % and lower than that of EKF under the three kinds of conditions, while the MAPE of a_{y} is so small that it can be ignored. In addition, the average error of the proposed UKFbased estimation method displayed in Fig. 17 was lower far from these of the EKF, which implies that the proposed UKFbased estimation method can keep a better overall accuracy than EKF when estimating the driving states of vehicles.
In this paper, we proposed a type of UKFbased vehicle driving state estimation method with higher accuracy. First, a 3DOFs vehicle dynamics model is established, and then a vehicle driving state estimation method is designed based on the UKF algorithm. Finally, by using CarSim and MATLAB/Simulink software, the cosimulation and validation are carried out to validate the accuracy of the proposed estimation method under the sinusoidal and fishhook conditions. Several highlights of this work are given below.

A complete UKFbased coestimation method is proposed to predict the values of β, r, v_{x}, and a_{y} for a ground vehicle by combining CarSim and MATLAB/Simulink software.

Through the cosimulation and validation, we obtain that the average errors of β, r, v_{x}, and a_{y} with our proposed UKFbased estimation approach are, respectively, reduced by about 94 %, 92 %, 67 %, and 97 % in comparison with those with the EKFbased approach. The simulation results validate that the proposed coestimation method can well predict the driving states of vehicles with higher accuracy.
In the future works, we would like to focus on the research of the adaptive UKFbased estimation method and try to use the adaptive algorithm to reduce the impacts of noise covariance on the accuracy of the desirable estimation method.
The state matrices of statespace Eq. (8):
All the data used in this paper can be obtained from the corresponding author upon request.
PW was responsible for the conceptualization, methodology and writing of the original draft. HP was responsible for supervision and writing, review and editing. ZX and JJ performed investigation and data curation.
The authors declare that they have no conflict of interest.
This article is part of the special issue “Robotics and advanced manufacturing”. It is not associated with a conference.
This research has been supported by the National Natural Science Foundation of China (grant nos. 51675423 and 51305342) and the Primary Research & Development Plan of Shaanxi Province (grant no. 2017GY029).
This paper was edited by Haiyang Li and reviewed by two anonymous referees.
Heidfeld, H., Schünemann, M., and Kasper, R.: Experimental Validation of a GPSAided ModelBased UKF Vehicle State Estimator, 2019 IEEE International Conference on Mechatronics (ICM), Ilmenau, Germany, 537–543, https://doi.org/10.1109/ICMECH.2019.8722942, 2019.
Katriniok, A. and Abel, D.: Adaptive EKFBased Vehicle State Estimation With Online Assessment of Local Observability, IEEE T. Contr. Syst. T, 24, 1368–1381, https://doi.org/10.1109/TCST.2015.2488597, 2016.
Kim, D., Min, K., Kim, H., and Huh, K.: Vehicle sideslip angle estimation using deep ensemblebased adaptive Kalman filter, Mech. Syst. Signal Pr., 144, 106862, https://doi.org/10.1016/j.ymssp.2020.106862, 2020.
Kim, K. and Park, C. G.: Nonsymmetric unscented transformation with application to inflight alignment, Int. J. Control Autom., 8, 776–781, https://doi.org/10.1007/s125550100409z, 2010.
Li, J., Zhang, J. X., Zhang, Y. H., and Chen, L. J.: Estimation of vehicle state and parameter based on strong tracking CDKF, Journal of Jilin University (Engineering and Technology Edition), 47, 1329–1335, https://doi.org/10.13229/j.cnki.jdxbgxb201705001, 2017 (in Chinese).
Li, L., Jia, G., Ran, X., Song, J., and Wu, K.: A variable structure extended Kalman filter for vehicle sideslip angle estimation on a low friction road, Vehicle Syst. Dyn., 52, 280–308, https://doi.org/10.1080/00423114.2013.877148, 2014.
Li, X. Y., Xu, N., and Guo, K. H.: Vehicle Sideslip Angle Estimation Based on Fusion of Kinematic Method and Kinematicgeometry Method, J. Mech. Eng., 56, 121–129, https://doi.org/10.3901/JME.2020.02.121, 2020 (in Chinese).
Liu, W., He, H. W., and Sun, F. C.: Vehicle state estimation based on Minimum Model Error criterion combining with Extended Kalman Filter, J. Frankl. Inst., 353, 834–856, https://doi.org/10.1016/j.jfranklin.2016.01.005, 2016.
Ma, B., Liu, Y., Gao, Y., Yang, Y., Ji, X., and Bo, Y.: Estimation of vehicle sideslip angle based on steering torque, Int. J. Adv. Manuf. Tech., 94, 3229–3237, https://doi.org/10.1007/s0017001694262, 2018.
Ma, Z. Y., Ji, X. W., Zhang, Y. Q., and Yang, J. Z.: State estimation in roll dynamics for commercial vehicles, Vehicle Syst. Dynam., 55, 1–25, https://doi.org/10.1080/00423114.2016.1262049, 2016.
Naets, F., Van Aalst, S., Boulkroune, B., Ghouti, N. E., and Desmet, W.: Design and Experimental Validation of a Stable TwoStage Estimator for Automotive Sideslip Angle and Tire Parameters, IEEE T. Veh. Technol., 66, 9727–9742, https://doi.org/10.1109/TVT.2017.2742665, 2017.
Piyabongkarn, D., Rajamani, R., Grogg, J. A., and Lew, J. Y.: Development and Experimental Evaluation of a Slip Angle Estimator for Vehicle Stability Control, IEEE T. Contr. Syst. T., 17, 78–88, https://doi.org/10.1109/TCST.2008.922503, 2009.
Reina, G., Paiano, M., and BlancoClaraco, J. L.: Vehicle parameter estimation using a modelbased estimator, Mech. Syst. Signal Pr., 87, 227–241, https://doi.org/10.1016/j.ymssp.2016.06.038, 2017.
Selmanaj, D., Corno, M., Panzani, G., and Savaresi, S.: Vehicle sideslip estimation: A kinematic based approach, Control Eng. Pract., 67, 1–12, https://doi.org/10.1016/j.conengprac.2017.06.013, 2017.
Song, Y., Shu, H., Chen, X., Jing, C., and Guo, C.: State and Parameters Estimation for Distributed Drive Electric Vehicle Based on Unscented Kalman Filter, J. Mech. Eng., 56, 204–213, https://doi.org/10.3901/JME.2020.16.204, 2020 (in Chinese).
Strano, S. and Terzo, M.: Constrained nonlinear filter for vehicle sideslip angle estimation with no a priori knowledge of tyre characteristics, Control Eng. Pract., 71, 10–17, https://doi.org/10.1016/j.conengprac.2017.10.004, 2018.
Yamamoto, M., Koibuchi, K., Fukada, Y., and Inagaki, S.: Vehicle stability control in limit cornering by active brake, JSAE Rev., 16, 323, https://doi.org/10.1016/03894304(95)95150S, 1995.
Zhang, X. L., Chen, B., Song, J., and Wang, Q. Y.: Test Method Research on Vehicle's tire sideslip angle in extreme driving condition, Chinese Society of Agricultural Machinery, 45, 31–36, https://doi.org/10.6041/j.issn.10001298.2014.09.006, 2014 (in Chinese).
Zhang, Z. Y., Zhang, S. Z., Huang, C. X., Zhang, L. Z., and Li, B. H.: State Estimation of Distributed Drive Electric Vehicle Based on Adaptive Extended Kalman Filter, J. Mech. Eng., 55, 156–165, https://doi.org/10.3901/JME.2019.06.156, 2019 (in Chinese).
Zhou, W. Q., Qi, X., Chen, L., and Xu, X.: Vehicle State Estimation Based on the Combination of Unscented Kalman Filtering and Genetic Algorithm, Automot. Eng., 41, 198–205, https://doi.org/10.19562/j.chinasae.qcgc.2019.02.012, 2019 (in Chinese).
Zong, C. F., Pan, Z., Hu, D., Zheng, H. Y., Xu, Y., and Dong, Y. L.: Information Fusion Algorithm for Vehicle State Estimation Based on Extended Kalman Filtering, J. Mech. Eng., 45, 272–277, https://doi.org/10.3901/JME.2009.10.272, 2009 (in Chinese).
 Abstract
 Introduction
 3DOFs vehicle dynamics modeling
 State estimation of vehicles based on UKF
 Coestimation and validation based on CarSim and MATLAB/Simulink
 Conclusions and future work
 Appendix A
 Data availability
 Author contributions
 Competing interests
 Special issue statement
 Financial support
 Review statement
 References
 Abstract
 Introduction
 3DOFs vehicle dynamics modeling
 State estimation of vehicles based on UKF
 Coestimation and validation based on CarSim and MATLAB/Simulink
 Conclusions and future work
 Appendix A
 Data availability
 Author contributions
 Competing interests
 Special issue statement
 Financial support
 Review statement
 References