Next Article in Journal
Query Join Order Optimization Method Based on Dynamic Double Deep Q-Network
Next Article in Special Issue
A Bi-Objective Simulation Facility for Speed and Range Calibration of 24 GHz and 77 GHz Automotive Millimeter-Wave Radars for Environmental Perception
Previous Article in Journal
A Broadband Analog Predistortion Linearizer Based on GaAs MMIC for Ka-Band TWTAs
Previous Article in Special Issue
A Synthesis of Algorithms Determining a Safe Trajectory in a Group of Autonomous Vehicles Using a Sequential Game and Neural Network
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

State Parameter Estimation of Intelligent Vehicles Based on an Adaptive Unscented Kalman Filter

1
College of Mechanical and Electronic Engineering, Shandong University of Science and Technology, Qingdao 266590, China
2
College of Transportation, Shandong University of Science and Technology, Qingdao 266590, China
*
Author to whom correspondence should be addressed.
Electronics 2023, 12(6), 1500; https://doi.org/10.3390/electronics12061500
Submission received: 17 February 2023 / Revised: 17 March 2023 / Accepted: 21 March 2023 / Published: 22 March 2023
(This article belongs to the Special Issue Feature Papers in Electrical and Autonomous Vehicles)

Abstract

:
The premise of vehicle intelligent decision making is to obtain vehicle motion state parameters accurately and in real-time. Several state parameters cannot be measured directly by vehicle sensors, so estimation algorithms based on filtering are effective solutions. The most representative algorithm is the Kalman filter, especially the standard unscented Kalman filter (UKF) that has been widely used in vehicle state estimation because of its superiority in dealing with nonlinear filtering problems. However, although the UKF assumes that the noise statistics of the system are known, due to the complex and changeable operating conditions, sensor aging and other factors, these noises vary. In order to realize high-precision vehicle state estimation, a noise-adaptive UKF algorithm is proposed in this article. The maximum a posteriori (MAP) algorithm is used to dynamically update the noise of the vehicle system, and it is embedded into the update step of the UKF to form an adaptive unscented Kalman filter (AUKF). The system will dynamically update the noise when noise statistics are unknown and prevent filter divergence by adjusting the mean and covariance of the estimated noise to improve accuracy. On this basis, the proposed method is verified by the joint simulation of CarSim and Matlab/Simulink, confirming that the AUKF performs better than the standard UKF in estimation accuracy and stability under different degrees of noise disturbance, and the estimation accuracy for the yaw rate, side slip angle and longitudinal velocity is improved by 20.08%, 40.98% and 89.91%, respectively.

1. Introduction

Obtaining the relevant parameters of intelligent vehicles’ driving state accurately and in real-time is the premise of active intelligent vehicle safety control. Because of the high cost and technical constraints of some intelligent vehicle state parameter sensors, this information cannot be measured directly. In the hopes of obtaining vehicle critical state information in a more economically feasible manner, intelligent vehicle state parameter estimation based on low-cost vehicle sensors and related algorithms has become a research hotspot [1,2,3]. State parameters characterizing vehicle stability in intelligent vehicle active safety control systems have become a key focus of related research [4]. Due to the complex and changeable working conditions of the environment, sensor aging and changeable noise in the actual driving process, estimation divergence often occurs, which leads to a reduction in estimation accuracy.
Estimation methods using nonlinear observers and the Kalman filter (KF) have received extensive attention by scholars. In [5,6], nonlinear observers were used to estimate vehicle states. Although these methods were proven to be effective under some conditions, the accurate acquisition of vehicle model parameters had a great influence on the estimation accuracy. Traditional Kalman filtering algorithms, such as the extended Kalman filter (EKF) and unscented Kalman filter (UKF), are implemented by recursive iteration for nonlinear systems, which are simple to calculate and easy to implement, and obtain better estimation results. Therefore, the KF algorithm has become one of the most widely used algorithms in research [7,8].
Some scholars have studied the vehicle state estimation based on EKF [9,10,11]. Compared with the EKF algorithm, the UKF algorithm abandons the Jacobian matrix for solving nonlinear functions, which reduces the amount of calculations and improves the accuracy and stability [12]. Liu Yingjie et al. [13] combined the UKF with genetic particle swarm optimization (PSO) to reduce computational complexity, and optimized the convergence speed and the estimation accuracy of vehicle state parameters. The UKF algorithm utilizes a noise covariance matrix to describe the process noise caused by model uncertainty and the measurement noise superimposed by the sensor error in the measurement process. However, these noises are generated randomly and not fixed in practice.
For this reason, scholars have proposed an adaptive adjustment mechanism of the noise covariance matrix and developed an adaptive Kalman filtering method. For example, Shen Fapeng et al. [14] made use of the ability of the particle filter algorithm to solve nonlinear and non-Gaussian problems, combined with the iterative extended Kalman algorithm for vehicle state estimation, and obtained high estimation accuracy. Li Gang [15] improved the estimation accuracy by improving the adaptive rules on the basis of the Sage–Husa adaptive EKF algorithm. BOADA et al. [16] first estimated the cornering angle with the help of an adaptive neuro-fuzzy inference system, took the estimated value as the measurement variable of the UKF and obtained an accurate cornering angle by minimizing the variance of the estimated mean square error. Wang Zhenpo et al. [17] combined fuzzy control with the unscented Kalman filter algorithm to realize the adaptive adjustment of the system measurement noise covariance matrix. Li Jiabo et al. [18] carried out joint modeling of the improved least squares support vector machine (LSSVM) and adaptive UKF to control the estimation error of SOC within 2%. Xue Zhongjin et al. [19] used unscented transform and statistical linearization to suppress outliers. On this basis, an iterative weighted least squares method based on M-estimation is used to deal with process uncertainty, innovation and observation outliers, which improves the robustness of the estimation process. Wang Yan et al. [20] proposed an embedded cubic Kalman filtering algorithm based on the coupled vehicle model to ensure the accuracy of preceding vehicles (PVS) state estimation while reducing the communication rate when the communication bandwidth is limited. When the communication rate is reduced to 37.55%, the estimation accuracy is still higher than that achieved with the cubic Kalman filter. In addition, many scholars have also carried out state estimation research based on cubature Kalman filter (CKF) [21,22,23,24], and have achieved good estimation results.
Through the analysis of the existing research results, ensuring the stability of the estimation method and avoiding estimation divergence while improving the estimation accuracy when an adaptive adjustment mechanism is introduced is a key problem [25]. Most of the current research is to set the covariance matrix of the observation noise to a fixed value and then make dynamic adjustments. This method is improved compared with the previous method, but in actual engineering applications, the process noise and measurement noise are dynamically changing, and thus online estimation and identification represent an improved method that can adapt to the real conditions. Therefore, we propose a noise adaptive UKF algorithm to obtain vehicle state parameters accurately in the presence of noise interference.
The core contributions of this study are as follows: (1) Using the maximum a posterior (MAP) algorithm to dynamically update the noise of vehicle system; (2) improve the noise statistic estimator so that the estimated noise covariance is positive and kept within a certain regular range; and (3) to have the above improved noise statistical estimation method embedded into the update step of the UKF to form an adaptive unscented Kalman filter (AUKF) algorithm, which can prevent filter divergence by adjusting the mean and covariance of measurement noise and the estimated noise to improve accuracy. In the simulation process, we set the process noise and observation noise in different time periods to different values. The results confirm that the estimation accuracy and stability of the AUKF are better than standard UKF under different degrees of noise disturbance.
The chapters of this article are arranged as follows:
In Section 2, we define the vehicle coordinate system and establish the vehicle dynamics model. We introduce the architecture of adaptive untraced Kalman filter (AUKF) in Section 3, and conduct a simulation comparison analysis of AUKF and standard UKF in Section 4. Finally, Section 5 summarizes the conclusion of the article.

2. Vehicle Dynamics Model

Considering the complexity of modeling and the need for real-time calculations, we introduced the longitudinal motion degree of freedom into the two-degrees-of-freedom (2-DOF) vehicle model [26] to form a 3-DOF model [27] with yaw displacement, lateral displacement and longitudinal displacement. The model diagram is shown in Figure 1. We assume that the vehicle is symmetrical to the X-axis and take the center of mass as the origin to establish the XOY coordinate system.
u and t are the longitudinal speed and the lateral speed; FY1 and FY2 are the lateral forces of the front and rear axles; v1 is the centroid velocity; α1 and α2 are the side deflection angle; v1 is the centroid velocity; and vx1 and vx2 are the speed of the midpoint of the front and rear axles of the vehicle.
The motion equation of the vehicle includes two input variables, three state variables and one measurement variable:
State equation:
{ r ˙ = a 2 k 1 + b 2 k 2 I x v x r + a k 1 b k 2 I z β a k 1 I z δ β ˙ = ( a k 1 b k 2 m v x 2 1 ) r + k 1 + k 2 m v x β k 1 m v x δ v ˙ x = r β v x + a x
Measurement equation:
a y = a k 1 b k 2 m v x r + k 1 + k 2 m β k 1 m δ
In the formula, β and r are the center of mass angle and the yaw angular velocity; vx is the longitudinal speed; ax is the longitudinal acceleration; ay is the lateral acceleration; a and b are the distance from the center of mass to the front and rear axles; k1 and k2 are the equivalent lateral cornering of the front and rear axle; Iz is the moment of inertia around the Z axis; δ is the front wheel angle; and m is the vehicle mass.

3. AUKF Algorithm

In order to facilitate state estimation, we use the following formula to express the state–space equation:
X k + 1 = f ( X k , k ) + ω k
Z k + 1 = h ( X k + 1 , k + 1 ) + v k + 1
where Xk and Zk are the state vector and output vector; ωk and νk are the system excitation noise and measurement noise; qk and rk are the mean value of ωk and νk; and Qk and Rk are covariance matrix of ωk and νk.
Based on the traditional UKF iterative framework [28,29], AUKF includes the following two steps:
(1) The UKF obtains the sigma point using the following formula:
{ χ 0 = X ¯ k i = 0 χ i , k = X ¯ k + ( ( n + λ ) P k ) i i = 1 , , n χ i , k + 1 q = X ¯ k ( ( n + λ ) P k ) i i = L + 1 , 2 n
where χ i , k are the sigma points, n is dimension of the state vector, Pk is the system state error matrix, and λ is the scale factor.
The next step in the UKF process involves making a one-step prediction for each sigma point using the system equations. The predicted sigma point is obtained as
X i , k + 1 k = f ( χ i , k , k ) + q k
Then, the predicted values of the system state variables X ¯ k + 1 k and covariance matrix P k + 1 k are obtained as
X ¯ k + 1 k = i = 0 2 n W i ( m ) X i , k + 1 k
P k + 1 k = i = 0 2 n W i ( c ) [ X i , k + 1 k X ¯ k + 1 k ] [ X i , k + 1 k X ¯ k + 1 k ] T + Q k + 1 T
where { W 0 ( m ) = W 0 ( c ) = λ / ( n + λ ) , i = 0 W i ( m ) = W i ( c ) = 1 / 2 ( n + λ ) , i = 1 , 2 n . Subsequently, the observed predicted values of sigma points are calculated, and the covariance matrix of observed variable Pyy is obtained via weighted summation,
Y i , k + 1 k = h ( X i , k + 1 k , k + 1 ) + r k + 1
y ¯ k + 1 k = i = 0 2 n W i ( m ) Y i , k + 1 k + r k + 1
P y y = i = 0 2 n W i ( c ) [ Y i , k + 1 k y ¯ k + 1 k ] [ Y i , k + 1 k y ¯ k + 1 k ] T + R k + 1
In addition, the covariance matrix Pxy between X ¯ k k 1 and y ¯ k k 1 are obtained as
P x y = i = 0 2 n W i ( c ) [ X i , k + 1 k X ¯ k + 1 k ] [ Y i , k + 1 k y ¯ k + 1 k ] T
Finally, the gain matrix Kk is calculated and the state variable X ¯ k and error covariance matrix Pk are updated.
K k + 1 = P x y P y y 1
X ¯ k + 1 = X ¯ k + 1 k + K k + 1 ( Z k + 1 y ¯ k + 1 k )
P k + 1 = P k + 1 k K k + 1 P y y K k + 1 T
(2) When the measurement noise and process noise are fixed, the UKF algorithm works normally and can complete the estimation of vehicle state parameters. However, the process noise and observation noise are generated randomly in practice. To solve this problem, a noise statistical estimator is designed using the MAP algorithm [30], and a MAP-based AUKF algorithm theory is proposed. The noise update steps are as follows:
r ^ k + 1 = ( 1 d k + 1 ) r ^ k + d k + 1 [ Z k + 1 i = 0 2 n W i m h k + 1 ( X i , k + 1 k ) ]
R ^ k + 1 = ( 1 d k + 1 ) R ^ k + d k + 1 [ ε k + 1 ε k + 1 T i = 0 2 n W i ( c ) ( Y i , k + 1 k y ¯ k + 1 k ) ( Y i , k + 1 k y ¯ k + 1 k ) T ]
q ^ k + 1 = ( 1 d k + 1 ) q ^ k + d k + 1 [ X ¯ k + 1 i = 0 2 n W i ( m ) f ( χ i , k + 1 k ) ]
Q ^ k + 1 = ( 1 d k + 1 ) Q ^ k + d k + 1 [ K k + 1 ε k + 1 ε k + 1 T K k + 1 T + P k + 1 i = 0 2 n W i ( c ) ( X i , k + 1 k X ¯ k + 1 k ) ( X i , k + 1 k X ¯ k + 1 k ) T ]
where ε k + 1 = Z k + 1 h ( X ¯ k + 1 | k , k + 1 ) r k + 1 , d k + 1 = ( 1 b ) / ( 1 b k + 1 ) , and 0 < b < 1 is the forgetting factor. In general, the filter cooperates well with the conventional algorithms (5)~(19). However, there is subtraction in Equations (17) and (19) that can produce negative R ^ k + 1 and Q ^ k + 1 matrices. Therefore, we make the following improvements to the noise statistical estimator to avoid this kind of situation:
  • Calculate the R ^ k + 1 using Equation (17); if R ^ k + 1 < 0, then:
    R k + 1 = R ^ k + 1 + d k + 1 ( i = 0 2 n W i ( c ) [ Y i , k + 1 k y ¯ k + 1 k ] [ Y i , k + 1 k y ¯ k + 1 k ] T )
  • Calculate the Q ^ k + 1 using Equation (19); if Q ^ k + 1 < 0, then:
    Q k = Q ^ k + 1 + d k + 1 ( i = 0 2 n W i ( c ) [ X i , k + 1 k X ¯ k + 1 k ] [ X i , k + 1 k X ¯ k + 1 k ] T )
Therefore, if R0 and Q0 are positive definite matrices, Rk and Qk can be positive definite matrices with any given k.
Figure 2 is the frame diagram of the estimation process of the AUKF algorithm. The specific iterative process is as follows.

4. Simulation Results and Analyses

According to the literature [31,32], combining the CarSim and MATLAB/Simulink simulation platform can effectively verify the estimation algorithm. The control quantity and observation output of the vehicle are input into the UKF algorithm model, and the three state variables are estimated in real-time. We compare the estimated results of UKF and AUKF with the ideal values of CarSim output, and obtain the maximum estimation error and the percentage improvement of estimation accuracy, so as to verify the effectiveness of the AUKF algorithm. The parameters of the vehicle model used in this paper are given: m = 1310 kg, a = 1.015 m, b = 1.895 m and Iz = 1536.7 kg·m2.
The UKF algorithm and AUKF algorithm are compared at different speeds under double lane change and serpentine conditions. The friction coefficient between tire and road surface is 0.85, and the sampling time is Ts = 0.01 s. In order to highlight that the proposed method can cope with different degrees of noise disturbance, we set the variance of the noise matrix of the square normal condition analysis in the first half to 0.001, and increase the variance of the noise matrix in the second half tenfold, so as to show that the vehicle can still achieve adaptive filtering under different noise levels. The estimation accuracy of the algorithm usually chooses the root mean square error (RMSE) to describe:
R M S E = 1 M k = 1 M ( x k x ^ k ) 2
where M represents the total time step of the run, and k represents the time step of one run.

4.1. Simulation Analysis of Double Lane Change Condition

(1) We fixed the vehicle speed at 40 km/h and initialized the state vector as x0 = [0,0,40/3.6]. Figure 3a, Figure 4a and Figure 5a show the simulation results of UKF, AUKF and ideal values.
In Figure 3a and Figure 4a, we can see that the vehicle changes lanes at 5–15 s. At the inflection point of the curve, the standard UKF deviates from the reference value, while the AUKF can track the ideal value effectively. At the same time, due to the change in process noise after 10 s, UKF diverges in the estimation, which is larger than that in the previous 10 s, indicating that UKF algorithm cannot accurately estimate the corresponding state parameters when there are different degrees of noise disturbance. The estimation results of the AUKF algorithm are largely consistent with the ideal values in the whole working condition, and the effect of the AUKF algorithm is ideal. The maximum instantaneous error of the yaw rate and side slip angle is 1.034 deg/s and 0.195 deg.
As shown in Figure 5a, the UKF algorithm has a divergence in the estimation, especially after the variance of the noise matrix increases tenfold, which shows that the UKF algorithm cannot accurately estimate the corresponding state parameters when there are different degrees of noise disturbance. The AUKF in the first 10 s is largely consistent with the ideal value, and the error is within an acceptable range in the last 10 s. The effect of the AUKF algorithm is ideal and the maximum instantaneous error of the longitudinal velocity is 0.405 m/s.
The estimation errors of each algorithm are shown in Figure 3b, Figure 4b and Figure 5b. The RMSE of the UKF and AUKF are given in Table 1.
As can be seen from Table 1, in the estimation of the three kinds of vehicle states, the RMSE estimated by the AUKF algorithm is the smallest, demonstrating its higher estimation accuracy. The estimation accuracy for yaw rate, side slip angle and longitudinal velocity was improved by 21.52%, 40.98% and 90.22%, respectively.
(2) We fixed the vehicle speed at 80 km/h and initialize the state vector as x0 = [0,0,80/3.6]. Figure 6a, Figure 7a and Figure 8a show the simulation results of UKF, AUKF and ideal values.
In Figure 6a and Figure 7a, we can see that the vehicle changes lanes at 5–15 s. At the inflection point of the curve, the standard UKF deviates from the reference value, while the AUKF can track the ideal value effectively. At the same time, due to the change in process noise after 10 s, UKF diverges in the estimation, which is larger than that in the previous 10 s, indicating that UKF algorithm cannot accurately estimate the corresponding state parameters when there are different degrees of noise disturbance. The estimation results of the AUKF algorithm are largely consistent with the ideal values in the whole working condition, and the effect of the AUKF algorithm is ideal. The maximum instantaneous error of the yaw rate and side slip angle is 2.358 deg/s and 0.104 deg.
As shown in Figure 8a, the UKF algorithm has a divergence in the estimation, especially after the variance of the noise matrix increases tenfold, which shows that the UKF algorithm cannot accurately estimate the corresponding state parameters when there are different degrees of noise disturbance. The AUKF in the first 10 s is largely consistent with the ideal value, and the error is within an acceptable range in the last 10 s. The effect of the AUKF algorithm is ideal and the maximum instantaneous error of the longitudinal velocity is 0.495 m/s.
The estimation errors of each algorithm are shown in Figure 6b, Figure 7b and Figure 8b. The RMSE of the UKF and AUKF are given in Table 2.
As can be seen from Table 1, in the estimation of the three kinds of vehicle states, the RMSE estimated by the AUKF algorithm is the smallest, demonstrating its higher estimation accuracy. Compared with the UKF algorithm, the estimation accuracy for yaw rate, side slip angle and longitudinal velocity state variables was improved by 20.08%, 74.54% and 89.91%, respectively.
In summary, compared with the UKF algorithm, the AUKF algorithm can better suppress the interference of noise, demonstrating its higher estimation accuracy and stronger robustness.

4.2. Simulation Analysis of Serpentine Condition

(1) We fixed the vehicle speed at 40 km/h and initialize the state vector as x0 = [0,0,40/3.6]. Figure 9a, Figure 10a and Figure 11a show the simulation results of UKF, AUKF and ideal values.
In Figure 9a, we can see that the standard UKF estimates a divergence at the inflection point of the curve during 0–10 s, while the AUKF can track the ideal value effectively. At the same time, due to the change in process noise after 10 s, the divergence phenomenon of the UKF is more obvious in the estimation, and this fluctuation is larger than that seen during the first 10 s, which shows that the UKF algorithm cannot accurately estimate the corresponding state parameters when there are different degrees of noise disturbance. However, the estimation results of the AUKF algorithm are largely consistent with the ideal values in the whole working condition, and the effect of the AUKF algorithm is ideal. The maximum instantaneous error of the yaw rate is 0.247 deg/s.
In Figure 10a, we can see that the standard UKF estimates a divergence at the inflection point of the curve during 0–10 s, while the AUKF can track the ideal value effectively. At the same time, due to the change in process noise after 10 s, the divergence phenomenon of UKF is more obvious in the estimation, and this fluctuation is larger than that seen in the first 10 s, which shows that the UKF algorithm cannot accurately estimate the corresponding state parameters when there are different degrees of noise disturbance. However, the estimation results of the AUKF algorithm are largely consistent with the ideal values in the whole working condition, and the effect of the AUKF algorithm is ideal. The maximum instantaneous error of the side slip angle is 0.038 deg.
As shown in Figure 11a, when the UKF algorithm diverges in estimation, especially after the variance of the noise matrix increased tenfold, the divergence is particularly obvious, indicating that the UKF algorithm cannot accurately estimate the corresponding state when there are different degrees of noise disturbance. However, the estimated result of the AUKF algorithm in the first 10 s is largely consistent with the ideal value, and the error between the estimated result and the reference value in the next 10 s is within an acceptable range, and the effect of the AUKF algorithm is ideal. The maximum instantaneous error of the longitudinal velocity is 0.492 m/ s.
The estimation errors of each algorithm are shown in Figure 9b, Figure 10b and Figure 11b. The RMSE of the UKF and AUKF are given in Table 3.
As can be seen from Table 3, in the estimation of the three kinds of vehicle states, the RMSE estimated by the AUKF algorithm is the smallest, demonstrating its higher estimation accuracy. Compared with UKF algorithm, the estimation accuracy of yaw rate, side slip angle and longitudinal velocity state variables was improved by 69.58%, 86.16% and 93.32%, respectively.
(2) We fixed the vehicle speed at 80 km/h and initialized the state vector as x0 = [0,0,80/3.6]. Figure 12a, Figure 13a and Figure 14a show the simulation results of UKF, AUKF and ideal values.
In Figure 12a, we can see that the standard UKF estimates a divergence at the inflection point of the curve during 0–10 s, while the AUKF can track the ideal value effectively. At the same time, due to the change in process noise after 10 s, the divergence phenomenon of the UKF is more obvious in the estimation, and this fluctuation is larger than that seen during the first 10 s, which shows that the UKF algorithm cannot accurately estimate the corresponding state parameters when there are different degrees of noise disturbance. However, the estimation results of the AUKF algorithm are largely consistent with the ideal values in the whole working condition, and the effect of the AUKF algorithm is ideal. The maximum instantaneous error of the yaw rate is 0.617 deg/s.
In Figure 13a, we can see that the standard UKF estimates a divergence at the inflection point of the curve during 0–10 s, while the AUKF can track the ideal value effectively. At the same time, due to the change in process noise after 10 s, the divergence phenomenon of UKF is more obvious in the estimation, and this fluctuation is larger than that seen in the first 10 s, which shows that the UKF algorithm cannot accurately estimate the corresponding state parameters when there are different degrees of noise disturbance. However, the estimation results of the AUKF algorithm are largely consistent with the ideal values in the whole working condition, and the effect of the AUKF algorithm is ideal. The maximum instantaneous error of the side slip angle is 0.038 deg.
As shown in Figure 14a, when the UKF algorithm diverges in estimation, especially after the variance of the noise matrix increases tenfold, the divergence is particularly obvious, indicating that the UKF algorithm cannot accurately estimate the corresponding state when there are different degrees of noise disturbance. However, the estimated result of the AUKF algorithm in the first 10 s is largely consistent with the ideal value, and the error in the next 10 s is within an acceptable range. The effect of the AUKF algorithm is ideal. The maximum instantaneous error of the longitudinal velocity is 0.505 m/s.
The estimation errors of each algorithm are shown in Figure 12b, Figure 13b and Figure 14b. The RMSE of the UKF and AUKF are given in Table 4.
As can be seen from Table 4, in the estimation of the three kinds of vehicle states, the RMSE estimated by the AUKF algorithm is the smallest, demonstrating its higher estimation accuracy. Compared with UKF algorithm, the estimation accuracy of yaw rate, side slip angle and longitudinal velocity state variables was improved by 28.54%, 90.08% and 94.21%, respectively.
In summary, compared with the UKF algorithm, the AUKF algorithm can better suppress the interference of noise, demonstrating higher estimation accuracy and stronger robustness.

5. Conclusions

When the vehicle is disturbed by different degrees of noise during driving, the traditional vehicle state estimation methods will show some problems such as a divergence or even a failure of the estimation results, which will affect the decision making and control of subsequent vehicle systems. On this basis, we propose a MAP-based AUKF algorithm to solve the problem of adaptive estimation of vehicle state parameters under different degrees of noise interference. In this study, the maximum a posteriori algorithm was used to dynamically update the noise of a vehicle system, and it was embedded into the update steps of an UKF to form an AUKF. Through the simulation experiments under double lane change and serpentine conditions, our method can adapt to different levels of noise interference and obtain great estimation accuracy. The estimation accuracy for the yaw rate, side slip angle and longitudinal velocity was improved by 20.08%, 40.98% and 89.91%, respectively. Because the AUKF has a better performance, this method is expected to provide more reliable perceptual information for intelligent driving vehicle decisions and control system applications.
The next steps include building a more accurate vehicle model and taking into account the roll motion of the vehicle, the motion of the suspension and the nonlinear characteristics of the tire. The proposed algorithm could also be tested with real vehicles.

Author Contributions

Conceptualization, Y.W.; Writing—original draft, Y.W.; Writing—review & editing, Y.L. and Z.Z.; Supervision, Y.L. and Z.Z. All authors have read and agreed to the published version of the manuscript.

Funding

This research was partially funded by Jilin Provincial Major Science and Technology Projects (Grant: 20210301020GX).

Data Availability Statement

Data were curated by the authors and are available upon request.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Zhang, R.; Xiong, L.; Yu, Z. Active steering angle control for intelligent vehicle. J. Mech. Eng. 2017, 53, 106–113. [Google Scholar] [CrossRef]
  2. Mousavinejad, E.; Han, Q.; Yang, F.; Zhu, Y.; Vlacic, L. Integrated control of ground vehicles dynamics via advanced terminal sliding mode control. Veh. Syst. Dyn. 2017, 55, 268–294. [Google Scholar] [CrossRef]
  3. Dahmani, H.; Pagès, O.; El Hajjaji, A. Observer-based state feedback control for vehicle chassis stability in critical situations. IEEE Trans. Control Syst. Technol. 2015, 24, 636–643. [Google Scholar] [CrossRef]
  4. Liu, W.; He, H.; Sun, F. Vehicle state estimation based on minimum model error criterion combining with extended Kalman filter. J. Frankl. Inst. 2016, 353, 834–856. [Google Scholar] [CrossRef]
  5. Chen, T.; Xu, X.; Chen, L.; Jiang, H.; Cai, Y.; Li, Y. Estimation of longitudinal force, lateral vehicle speed and yaw rate for four-wheel independent driven electric vehicles. Mech. Syst. Signal Process. 2018, 101, 377–388. [Google Scholar] [CrossRef]
  6. Lu, S.; Lian, M.; Liu, Y.; Zhao, Y.; Xiao, Y. Comparison of vehicle state estimation based on nonlinear observer and untracked Kalman filter. Acad. Accel. 2020, 50, 1288–1300. [Google Scholar]
  7. Guo, H.; Chen, H.; Zhao, H.; Yang, S. Research progress and prospect of vehicle driving state parameter estimation. Control Theory Appl. 2013, 30, 661–672. [Google Scholar]
  8. Bergman, M.J.; Delleur, J.W. Kalman filter estimation and prediction of daily stream flows: I. review, algorithm, and simulation experiments. J. Am. Water Resour. Assoc. 1985, 21, 815–825. [Google Scholar] [CrossRef]
  9. Zhang, Z.; Zhao, J.; Huang, C.; Li, L. Precise and robust sideslip angle estimation based on INS/GNSS integration using invariant extended Kalman filter. Proc. Inst. Mech. Eng. Part D J. Automob. Eng. 2022, 09544070221102662. [Google Scholar] [CrossRef]
  10. Zhang, Z.; Zhang, S.; Huang, C.; Zhang, L.; Li, B. State estimation of distributed drive electric vehicles based on adaptive extended Kalman filter. J. Mech. Eng. 2018, 55, 156–165. [Google Scholar] [CrossRef]
  11. Wang, Y.; Xu, L.; Zhang, F.; Dong, H.; Liu, Y.; Yin, G. An adaptive fault-tolerant EKF for vehicle state estimation with partial missing measurements. IEEE/ASME Trans. Mechatron. 2021, 26, 1318–1327. [Google Scholar] [CrossRef]
  12. Julier, S.J.; Uhlmann, J.K. Unscented filtering and nonlinear estimation. Proc. IEEE Inst. Electr. Electron. Eng. 2004, 92, 401–422. [Google Scholar] [CrossRef] [Green Version]
  13. Liu, Y.J.; Dou, C.H.; Shen, F.; Sun, Q.Y. Vehicle state estimation based on unscented Kalman filtering and a genetic-particle swarm algorithm. J. Inst. Eng. (India) Ser. C 2021, 102, 447–469. [Google Scholar] [CrossRef]
  14. Shen, F.; Zhao, Y.; Sun, Q.; Lin, F.; Wang, W. Vehicle state Estimation based on IEKF-APF. China J. Mech. Eng. 2014, 50, 137–141. [Google Scholar] [CrossRef]
  15. Li, G.; Zhao, D.; Xie, R.; Han, H.; Zong, C. Vehicle State Estimation Based on Improved Sage–Husa Adaptive Extended Kalman Filtering. Automot. Eng. 2015, 37, 1426–1432. [Google Scholar]
  16. Boada, B.L.; Boada, M.J.L.; Diaz, V. Vehicle sideslip angle measurement based on sensor data fusion using an integrated ANFIS and an Unscented Kalman Filter algorithm. Mech. Syst. Signal Process. 2016, 72, 832–845. [Google Scholar] [CrossRef] [Green Version]
  17. Wang, Z.; Xue, X.; Wang, Y. State parameter estimation of distributed drive electric vehicle based on adaptive unscented Kalman filter. J. Beijing Inst. Technol. 2018, 38, 698–702. [Google Scholar]
  18. Li, J.; Ye, M.; Jiao, S.; Meng, W.; Xu, X. A novel state estimation approach based on adaptive unscented Kalman filter for electric vehicles. IEEE Access 2020, 8, 185629–185637. [Google Scholar] [CrossRef]
  19. Xue, Z.; Cheng, S.; Li, L.; Zhong, Z.; Mu, H. A Robust Unscented M-Estimation-Based Filter for Vehicle State Estimation With Unknown Input. IEEE Trans. Veh. Technol. 2022, 71, 6119–6130. [Google Scholar] [CrossRef]
  20. Wang, Y.; Yan, Y.; Shen, T.; Bai, S.; Hu, J.; Xu, L.; Yin, G. An event-triggered scheme for state estimation of preceding vehicles under connected vehicle environment. IEEE Trans. Intell. Veh. 2022, 8, 583–593. [Google Scholar] [CrossRef]
  21. Wang, Y.; Zhang, F.; Geng, K.; Zhuang, W.; Dong, H.; Yin, G. Estimation of vehicle state using robust cubature kalman filter. In Proceedings of the 2020 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM), Boston, MA, USA, 7–10 July 2020; pp. 1024–1029. [Google Scholar]
  22. Wang, Y.; Yin, G.; Dong, H. A novel approach for tire-road friction coefficient estimation using adaptive cubature kalman filter. In Proceedings of the 2020 4th CAA International Conference on Vehicular Control and Intelligence (CVCI), Hangzhou, China, 18–20 December 2020; pp. 30–34. [Google Scholar]
  23. Wang, Y.; Yin, G.; Geng, K.; Dong, H.; Lu, Y.; Zhang, F. Tire tateral forces and sideslip angle estimation for distributed drive electric vehicle using noise adaptive cubature Kalman filter. J. Mech. Eng. 2019, 55, 103–112. [Google Scholar]
  24. Wang, Y.; Geng, K.; Xu, L.; Ren, Y.; Dong, H.; Yin, G. Estimation of sideslip angle and tire cornering stiffness using fuzzy adaptive robust cubature kalman filter. IEEE Trans. Syst. Man Cybern. Syst. 2020, 52, 1451–1462. [Google Scholar] [CrossRef]
  25. Yu, Z.; Gao, X. Review of vehicle state estimation problem under driving situation. J. Mech. Eng. 2009, 45, 20–33. [Google Scholar] [CrossRef]
  26. Yu, Z. Automobile Theory, 6th ed.; China Machine Press: Beijing, China, 2019; pp. 170–171. [Google Scholar]
  27. Wang, G.; Wei, M.; Zhao, W.; Zhang, F.; Yan, M. Vehicle state estimation based on the combination of recursive least squares method and fuzzy adaptive extended Kalman filter. Chin. J. Mech. Eng. 2017, 28, 750–755. [Google Scholar]
  28. Wang, Y.; Lv, C.; Yan, Y.; Peng, P.; Wang, F.; Xu, L.; Yin, G. An Integrated Scheme for Coefficient Estimation of Tire–Road Friction With Mass Parameter Mismatch Under Complex Driving Scenarios. IEEE Trans. Ind. Electron. 2021, 69, 13337–13347. [Google Scholar] [CrossRef]
  29. Hu, J.; Wang, Y.; Yan, Y.; Ren, Y.; Wang, J.; Yin, G. Estimation of Vehicle State Based on Limited Memory Random Weighted Unscented Kalman Filter. In Proceedings of the 2021 5th CAA International Conference on Vehicular Control and Intelligence (CVCI), Tianjin, China, 29–31 October 2021; pp. 1–6. [Google Scholar]
  30. Lin, Z.; Wang, X. An adaptive UKF with noise statistic estimator. In Proceedings of the 2009 4th IEEE Conference on Industrial Electronics and Applications, Xian, China, 25–27 May 2009; Volume 36, pp. 614–618. [Google Scholar]
  31. Hashemi, E.; Kasaiezadeh, A.; Khosravani, S.; Khajepour, A.; Moshchuk, N.; Chen, S.K. Estimation of longitudinal speed robust to road conditions for ground vehicles. Veh. Syst. Dyn. 2016, 54, 1120–1146. [Google Scholar] [CrossRef] [Green Version]
  32. Hashemi, E.; Pirani, M.; Khajepour, A.; Fidan, B.; Kasaiezadeh, A.; Chen, S.K. Opinion dynamics-based vehicle velocity estimation and diagnosis. IEEE Trans. Intell. Transp. Syst. 2017, 19, 2142–2148. [Google Scholar] [CrossRef]
Figure 1. 3-DOF vehicle model.
Figure 1. 3-DOF vehicle model.
Electronics 12 01500 g001
Figure 2. The framework of the AUKF algorithm.
Figure 2. The framework of the AUKF algorithm.
Electronics 12 01500 g002
Figure 3. Simulation results of yaw rate. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 3. Simulation results of yaw rate. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g003
Figure 4. Simulation results of side slip angle. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 4. Simulation results of side slip angle. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g004
Figure 5. Simulation results of longitudinal velocity. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 5. Simulation results of longitudinal velocity. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g005
Figure 6. Simulation results of yaw rate. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 6. Simulation results of yaw rate. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g006
Figure 7. Simulation results of side slip angle. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 7. Simulation results of side slip angle. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g007
Figure 8. Simulation results of longitudinal velocity. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 8. Simulation results of longitudinal velocity. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g008
Figure 9. Simulation results of yaw rate. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 9. Simulation results of yaw rate. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g009
Figure 10. Simulation results of side slip angle. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 10. Simulation results of side slip angle. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g010
Figure 11. Simulation results of longitudinal velocity. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 11. Simulation results of longitudinal velocity. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g011
Figure 12. Simulation results of yaw rate. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 12. Simulation results of yaw rate. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g012
Figure 13. Simulation results of side slip angle. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 13. Simulation results of side slip angle. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g013
Figure 14. Simulation results of longitudinal velocity. (a) Comparison of estimated results and (b) comparison of estimated error.
Figure 14. Simulation results of longitudinal velocity. (a) Comparison of estimated results and (b) comparison of estimated error.
Electronics 12 01500 g014
Table 1. RMSE of the two algorithms during the entire duration of the process.
Table 1. RMSE of the two algorithms during the entire duration of the process.
Estimation AlgorithmRMSE of State Variable Estimation
Yaw RateSide Slip AngleLongitudinal Velocity
UKF0.31880.08981.3941
AUKF0.25020.05300.1364
Table 2. RMSE of the two algorithms during the entire duration of the process.
Table 2. RMSE of the two algorithms during the entire duration of the process.
Estimation AlgorithmRMSE of State VARIABLE Estimation
Yaw RateSide Slip AngleLongitudinal Velocity
UKF0.85390.14261.9616
AUKF0.68240.03630.1980
Table 3. RMSE of the two algorithms during the entire duration of the process.
Table 3. RMSE of the two algorithms during the entire duration of the process.
Estimation AlgorithmRMSE of State Variable Estimation
Yaw RateSide Slip AngleLongitudinal Velocity
UKF0.20740.07301.9674
AUKF0.06310.01010.1314
Table 4. RMSE of the two algorithms during the entire duration of the process.
Table 4. RMSE of the two algorithms during the entire duration of the process.
Estimation AlgorithmRMSE of State Variable Estimation
Yaw RateSide Slip AngleLongitudinal Velocity
UKF0.34650.12603.3560
AUKF0.24760.01250.1942
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Wang, Y.; Li, Y.; Zhao, Z. State Parameter Estimation of Intelligent Vehicles Based on an Adaptive Unscented Kalman Filter. Electronics 2023, 12, 1500. https://doi.org/10.3390/electronics12061500

AMA Style

Wang Y, Li Y, Zhao Z. State Parameter Estimation of Intelligent Vehicles Based on an Adaptive Unscented Kalman Filter. Electronics. 2023; 12(6):1500. https://doi.org/10.3390/electronics12061500

Chicago/Turabian Style

Wang, Yu, Yushan Li, and Ziliang Zhao. 2023. "State Parameter Estimation of Intelligent Vehicles Based on an Adaptive Unscented Kalman Filter" Electronics 12, no. 6: 1500. https://doi.org/10.3390/electronics12061500

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop