MPE Mathematical Problems in Engineering 1563-5147 1024-123X Hindawi 10.1155/2018/3106329 3106329 Research Article Vehicle Running State Estimation by Adaptive Soft-Sensing Algorithm http://orcid.org/0000-0002-7529-3405 Hao Liang 1 2 Guo Lixin 2 Liu Shuwei 1 2 Strano Salvatore 1 Automobile & Traffic Engineering College Liaoning University of Technology Jinzhou Liaoning 121000 China lnit.edu.cn 2 School of Mechanical Engineering & Automation Automotive Engineering Northeastern University Shenyang 110819 China neu.edu.cn 2018 8112018 2018 30 08 2018 17 10 2018 8112018 2018 Copyright © 2018 Liang Hao et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

Vehicle running state adaptive unscented Kalman filter soft-sensing algorithm is put forward in this paper based on traditional UKF which can estimate vehicle running state parameters and suboptimal Sage-Husa noise estimator which can effectively solve the problem of noises varying with time. Meanwhile 3-DOF dynamic model of vehicle and HSRI tire model are established. So vehicle running state can be accurately estimated by fusing the low-cost measurement information of longitudinal and lateral acceleration and handwheel steering angle. Under the typical working condition, AUKF soft-sensing algorithm is verified with substantial vehicle tests. Comparing with UKF soft-sensing algorithm, the result indicates AUKF soft-sensing algorithm has a good performance in robustness and is able to realize the effective estimation of vehicle running state more precisely than UKF soft-sensing algorithm.

National Natural Science Foundation of China 50875041 New Century Excellent Talents Support Project NCET-08-0103 Major Science and Technology Platform Project of Liaoning Province Education Department JP2016011
1. Introduction

In recent years, more and more active safety system is matched in the vehicle, but active safety system can well achieve active safety control by the real-time obtaining vehicle running state information. However, as some of their parameters like side slip angle are hard to be measured and have quite a high cost of measurement, it is of vital importance to find out a low-cost method for getting the high-accuracy parameters of distributive vehicles in quite real time.

At present, soft-sensing technology has been widely applied to the estimation of vehicles’ dynamic and kinematic parameters. For example, UKF was used to estimate the running state and parameters of vehicles [1, 2]; vehicles’ driving state was efficiently estimated by multirate EKF soft-sensing algorithm ; what is more, vehicles’ state and parameters, respectively, can be estimated by double EKF working at the same time [4, 5]; UKF estimation algorithm was put forward to study the lateral and longitudinal speed of vehicles ; UKF was used to estimate vehicle state and road parameters [7, 8].

High-accuracy noise statistical characteristics are required for UKF soft-sensing technology, but noise statistical characteristics are actually varying with time in practice, which is easy to make the estimation accuracy greatly reduced, or even divergent. For that reason, self-adaptive UKF algorithm based on Sage-Husa is established in this paper to avoid the deficiency described above. Meanwhile, multisensor fusion technology is adopted to realize the precise estimation of longitudinal and lateral speed, side slip angle, and yaw rate of electric vehicles. Finally, the validity of the algorithm is verified through the real vehicle test.

2. Dynamic Model 2.1. Vehicle 3-DOF Model

The model includes longitudinal and lateral speed and yaw rate. In Figure 1, the ISO coordinate system is through the mass center of a vehicle, where the right part of x-axis means the positive and the symmetry axis for longitudinal direction, and the upper part of y-axis means the positive and going through the mass center O.

Vehicle 3-DOF dynamic model.

The dynamic equation derived from the 3-DOF vehicle dynamic model is shown as formula (1): (1) u · = a x + v · γ v · = a y - u · γ γ · = Γ I Z Γ = a F x 1 sin δ 1 + F y 1 cos δ 1 - t f 2 F x 1 cos δ 1 - F y 1 sin δ 1 + a F x 2 sin δ 2 + F y 2 cos δ 2 + t f 2 F x 2 cos δ 2 - F y 2 sin δ 2 - b F x 3 sin δ 3 + F y 3 cos δ 3 - t r 2 F x 3 cos δ 3 - F y 3 sin δ 3 - b F x 4 sin δ 4 + F y 4 cos δ 4 + t r 2 F x 4 cos δ 4 - F y 4 sin δ 4 β = v u a x = 1 m F x 1 cos δ 1 - F y 1 sin δ 1 + F x 2 cos δ 2 - F y 2 sin δ 2 + F x 3 cos δ 3 - F y 3 sin δ 3 + F x 4 cos δ 4 - F y 4 sin δ 4 - F w a y = 1 m F x 1 sin δ 1 + F y 1 cos δ 1 + F x 2 sin δ 2 + F x 2 cos δ 2 + F x 3 sin δ 3 + F y 3 cos δ 3 + F x 4 sin δ 4 + F y 4 cos δ 4 where u is longitudinal speed; v is lateral speed; γ is yaw rate; ax is longitudinal acceleration; ay is lateral acceleration; Г is torque around z axis; a, b denote the distance from mass center to front axis and to back axis; Iz is car inertia around z-axis; δi is wheel steering angle; i=1(front left), 2(front right), 3(rear left), 4(rear right); Fxj is longitudinal force; Fyj is lateral force; j=1(front left), 2(front right), 3(left rear), 4(right rear); Fw is wind resistance.

2.2. HSRI Tire Model

HSRI is a semiempirical tire model acquired through a number of tire tests carried out by Highway Safety Research Institute of University of Michigan in America. In this paper, a relative simple model form is used because of its simple form and less parameters for identification . Meanwhile, higher accuracy can be achieved without taking the aligning torque of tire into consideration.

For the wheels of vehicle, the longitudinal and lateral force on each tire can be expressed by the following formulas:(2)Fx=-CsSx1-Sxλ1-CsSx1-Sxλ2-λ0<λ<1-CsμFz1Cs2+CαSy2λ=0(3)Fy=-CαSy1-Sxλ1-CαSy1-Sxλ2-λ0<λ<1-CsSyμFz1Cs2+CαSy2λ=0where λ=μFz(1-Sx)/2(CsSx)2+(CαSy)2; λ is limit of adhesion region; Cs, Cα denote longitudinal and lateral slip stiffness; μ is road friction coefficient; Sx,Sy denote longitudinal and lateral slip rate; Fz is tire vertical force.

The longitudinal slip rate and lateral slip rate on each tire can be expressed by the following formulas:(4)Sxij=Rωij-uxijuxij=Rωijuxij-1<0uxij0  for  brakingRωij-uxijRωij=1-uxijRωij>0ωij0  for  driving(5)Syij=vyijuxijwhere ωij is angular speed of four wheels, ij=fl (front left), fr (front right), rl (rear left), rr (rear right); uxij, vxij are longitudinal and lateral wheel velocities.

Vertical force can be calculated by(6)Fz1=12mg-mayhgtfba+b-12maxhga+bFz2=12mg+mayhgtfba+b-12maxhga+bFz3=12mg-mayhgtfaa+b+12maxhga+bFz4=12mg+mayhgtfaa+b+12maxhga+bwhere Fzp is tire vertical force, p=1(front left), 2(front right), 3(rear left), 4(rear right); m is car mass; g is gravitational constant; hg is vehicle height of center of gravity; a, b are distance of front and rear wheels from center of gravity; tf,tr are distance of the vehicle front and rear longitudinal axis from wheels; ax,ay are longitudinal and lateral acceleration.

The longitudinal and lateral wheel velocities can be expressed by the following formulas: (7) u x f l = u - γ t f 2 cos δ 1 + v + γ a sin δ 1 v y f l = - u - γ t f 2 sin δ 1 + v + γ a cos δ 1 u x f r = u + γ t f 2 cos δ 2 + v + γ a sin δ 2 v y f r = - u + γ t f 2 sin δ 2 + v + γ a cos δ 2 u x r l = u - γ t r 2 cos δ 3 + v - γ b sin δ 3 v y r l = - u - γ t r 2 sin δ 3 + v - γ b cos δ 3 u x r r = u + γ t r 2 cos δ 4 + v - γ b sin δ 4 v y r r = - u + ω t r 2 sin δ 4 + v - ω b cos δ 4

3. AUKF Soft-Sensing Technology

Soft-sensing technology includes state estimation, neural network, fuzzy mathematics, mechanism modeling, and so on other relative analyzing techniques. It mainly uses those process parameters which can be easily measured to estimate the parameters which cannot be effectively measured, so as to effectively overcome deficiencies on the high cost of hardware measurement or its undetectability in literature . Soft-sensing technology is established based on UKF in this paper.

Instead of traditionally making nonlinear functions linearized, UKF retains the framework of Kalman filter and uses the way of UT to solve the problem of the nonlinear estimation of mean value and covariance in literature [11, 12]. As for the state parameters of a nonlinear system, the estimation made by UKF which keeps higher order terms is more precise and more stable than EKF estimation. However, they both require the quite precise mathematical model of coefficients and noise statistic characteristics. Otherwise, it will lead to reduced estimation accuracy and filtering accuracy or even a divergent result. Therefore, organically combining UKF and suboptimal Sage-Husa noise estimator, the consequent AUKF soft-sensing algorithm can use the suboptimal Sage-Husa noise estimator to realize the real-time estimation for the mean value and covariance matrix of the process noises in this system while the vehicle state is being estimated.

According to the parameters ax,ay,δi, and ωij measured by the vehicle sensor, the unknown vehicle u, v, and γ parameters are further estimated. Since only discrete signals can be processed on computers, the equation for system state discretization works out according to formula (1) is shown as below:(8)xk+1=fxk,uk+ϖk=uvγΓaxayk=uvγ000k+ax+vγay-uγΓIz000kT+000Γaxayk+ϖk

Discretization form for system observation equation is(9)zk=hxk,uk+υk=axayγk=000010000001001000uvγΓaxayk+υkwhere state variable X=[u,v,ω,T,ax,ay]T; observed quantity Z=axayγT; control variable u=[δi].

ϖ k and υk should be mutually independent white noises.

The statistic characteristics of noises are(10)Eϖk=qkEυk=rkEϖk-qkϖi-qkT=QkϑkiEυk-rkυi-rkT=Rkϑki

The vehicle state variables are 6D random variables and their initial mean values X-=E(X0) and P0=E[(X0-X-)(X0-X-)T]. By formulae (11) and (12), 13 Sigma points X and relevant weights χ can be acquired through UT.

①Calculate the 13 Sigma sampling points:(11)X0=X-i=0Xi=X-+6+λPii=1~6Xi=X--6+λPii=7~12

②Calculate the relevant weights of these sampling points:(12)χm0=τn+τχc0=τn+τ+1-α2+βχmi=χci=τn+τi=1~12where the subscripts m and c mean the covariances; λ=α2(6+κ)-6 is scaling coefficient; α which is generally 0.001 is used to fix the Sigma point set around X-; κ is a second-order proportional parameter and κ=0 here; β0 is a nonnegative weight coefficient. Generally β=2.

③Putting Sigma point set in formula (8), further estimation can be made to get X(i)(k+1k)=f(X(i)(kk),uk)+qk and calculate the covariance matrix of system state variables:(13)Xk+1k=i=02nχmiXik+1kPk+1k=i=02nχciXk+1k-Xik+1kXk+1k-Xik+1kT+Qk

④The new observed quantity Z(i)(k+1k)=h(Xi(k+1k),uk)+rk+1 can be acquired by putting Sigma point set in formula (9), and the mean value and covariance of system estimation is acquired by weighted summation:(14)Zk+1k=i=02nχmiZik+1kPzkzk=i=02nχciZik+1k-Zk+1kZik+1k-Zk+1kT+RPxkzk=i=02nχciXik+1k-Xk+1kZik+1k-Zk+1kT

⑤Gain matrix K(k+1)=PxkzkPzkzk-1 by which system state update and covariance update can be calculated by(15)Xk+1k+1=Xk+1k+Kk+1zk+1-Zk+1kPk+1k+1=Pk+1k-Kk+1PzkzkKTk+1

⑥The update of the characteristics of process noise statistics is(16)qk+1=1-dk+1qk+dk+1Xk+1k+1-i=02nχmiXik+1kQk+1=1-dk+1Qk+dk+1Kk+1Zk+1kZTk+1kKTk+1+Pk+1k+1-PxkzkZk+1k=zk+1-Zk+1kdk+1=1-f1-fk+1where c is forgetting factor which values from 0.95 to 0.99.

4. Algorithm Verification and Analysis

Handwheel steering angle sensor, biaxial speedometer, gyro inertial navigation system, and 1000 Hz sampling frequency data acquisition instrument are placed in a kind of B car. The parameters of vehicle are partly shown in Table 1 and vehicle experiment data’s acquisition and analysis procedure are shown in Figure 2. High-speed double lane change emergency braking and fishhook emergency braking on dry concrete pavement are chosen to verify AUKF algorithm effectiveness.

Vehicle some parameters.

Parameters values
Car mass m/kg 1170
Distance of front wheels from center of gravity a/m 0.998
Distance of rear wheels from center of gravity b/m 0.998
Distance of front longitudinal axis from wheels tf/m 1.481
Distance of rear longitudinal axis from wheels tr /m 1.481
Height of center of gravity hg/m 0.54
Inertia around x axis Ix/kg⋅m2 200
Inertia around y axis Iy/kg⋅m2 1200
Inertia around z axis Iz/kg⋅m2 1200
Vehicle steering Angle transmission ratio i 17

Vehicle test data’s acquisition and analysis procedure.

4.1. High-Speed Double Lane Change Braking Test

According to ISO 3888-1 working condition standard for double lane change test, the initial state value is recorded by biaxial speedometer and gyro inertial navigation system. Road friction coefficient is 0.8 and 0.68 Mpa pressure caused by the brake master cylinder for emergency braking in the second second.

In order that the algorithm can realize the accurate soft measurement of vehicle state, it is critical to properly identify the initial value for AUKF estimation. The initial values are the covariance matrix of system errors P=zeros(6,6), the covariance matrix of system excitation noises Q=eye(6)0.00001, the covariance matrix of measured noises R=eye(3)0.001, the mean value of process noises q=zeros(6,1), and the mean value of measured noises r=zeros(3,1).

Longitudinal and lateral speed, side slip angle, and yaw angle rate are estimated with effect through the efficient information fusion of longitudinal and lateral acceleration, wheel velocities, and the handwheel steering angle (see Figure 3). The test results are shown in Figure 4.

Input signals by the sensors in double lane change emergency braking test.

Curves of double lane change emergency braking test.

According to the curves of longitudinal speed in Figure 4, it shows that self-adaptive AUKF algorithm does better than UKF algorithm in terms of accuracy, stability, astringency, and real-time performance. According to the curves of lateral speed in Figure 4, it is easy to see that AUKF performs better than UKF on the whole and in astringency. Yaw rate curves show that comparing with UKF in Figure 4. AUKF is clearly more accurate on the whole and has a good performance in stability and astringency. Side slip angle curves show that AUKF has higher accuracy of side slip angle estimation on the whole and better astringency in Figure 4. According to Figure 3, lateral acceleration is less than 0.4g on the whole, so vehicle is in linear motion state that tire lateral force depends linearly on side slip angle. According to Figure 4, the real-time tire longitudinal and lateral force can be calculated by HSRI tire model, and ultimately the calculated values can well track and converge to the actual values.

4.2. Fishhook Braking Test

The initial state value is recorded by biaxial speedometer and gyro inertial navigation system. Road friction coefficient is 0.8 and 0.47 Mpa pressure caused by the brake master cylinder for emergency braking in the second second. The covariance matrix of system errors P=zeros(6,6), the covariance matrix of system excitation noises Q=eye(6)0.001, the covariance matrix of measured noises R=eye(3)1000, the mean value of process noises q=zeros(6,1), and the mean value of measured noises r=zeros(3,1).

Longitudinal and lateral speed, side slip angle, and yaw angle rate are estimated with effect through the efficient information fusion of longitudinal and lateral acceleration, wheel velocities, and the handwheel steering angle (see Figure 5). The simulation result is shown in Figure 6.

Input signals by the sensors in the fishhook emergency braking test.

Curves of fishhook emergency braking test.

According to the curves of longitudinal speed and its error, respectively, in Figure 6, they show that self-adaptive AUKF algorithm does better than UKF algorithm in terms of accuracy, stability, astringency, and real-time performance. According to lateral speed curves in Figure 6, AUKF did more better in estimation results, stability, and final astringency than UKF; and the side slip angle features in Figure 6 are the same as the features of the estimated lateral speed. According to yaw rate curves in Figure 6, AUKF performs better than UKF in the general estimation of yaw rate, and the same thing happens in terms of the overall stability and astringency. According to Figure 5, lateral acceleration is greater than 0.4g in some time area, so vehicle is in nonlinear motion state that tire lateral force depends nonlinearly on side slip angle. According to Figure 6, the real-time tire longitudinal and lateral force can also be calculated when HSRI tire model is in nonlinear motion interval, and ultimately the calculated values well track and converge to the actual values.

5. Conclusion

( 1 ) According to the 3-DOF dynamic model, self-adaptive AUKF soft-sensing algorithm was established, integrating the signals of longitudinal and lateral acceleration and handwheel steering angle which were measured by low-cost sensors. In this way, the state parameters of running vehicle, such as longitudinal speed, lateral speed, yaw rate, and side slip angle, can be estimated more accurately even under the premise of vehicle parameters perturbation.

( 2 ) AUKF soft-sensing algorithm was verified using substantial vehicle tests under the premise of the same HSRI tire model that produces the same tire force error. The results have shown that, comparing with UKF, AUKF performed better in accuracy and robustness.

Data Availability

The data used to support the findings of this study are available from the corresponding author upon request.

Conflicts of Interest

The authors declare that they have no conflicts of interest.

Acknowledgments

This work was supported by the National Natural Science Fund Project (50875041), New Century Excellent Talents Support Project (NCET-08-0103), and Major Science and Technology Platform Project of Liaoning Province Education Department (JP2016011).

Ren H. Chen S. Liu G. Zheng K. Vehicle state information estimation with the unscented Kalman filter Advances in Mechanical Engineering 2014 2014 86 1120 1146 2-s2.0-84893675450 Antonov S. Fehn A. Kugi A. Unscented Kalman filter for vehicle state estimation Vehicle System Dynamics 2011 49 9 1497 1520 2-s2.0-79960771466 10.1080/00423114.2010.527994 Anderson R. Bevly D. M. Using GPS with a model-based estimator to estimate critical vehicle states Vehicle System Dynamics 2010 48 12 1413 1438 2-s2.0-78349258595 10.1080/00423110903461347 Cheng C. Cebon D. Parameter and state estimation for articulated heavy vehicles Vehicle System Dynamics 2011 49 1-2 399 418 2-s2.0-78650279985 10.1080/00423110903406656 Wenzel T. A. Burnham K. J. Blundell M. V. Williams R. A. Dual extended Kalman filter for vehicle state and parameter estimation Vehicle System Dynamics 2006 44 2 153 171 10.1080/00423110500385949 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 Mechanical Systems and Signal Processing 2018 101 377 388 2-s2.0-85029699751 10.1016/j.ymssp.2017.08.041 He W. Williard N. Chen C. Pecht M. State of charge estimation for electric vehicle batteries using unscented kalman filtering Microelectronics Reliability 2013 53 6 840 847 2-s2.0-84879843176 10.1016/j.microrel.2012.11.010 Xu Y. Chen B. Chi C. Estimation of road friction coefficient and vehicle states by 3-DOF dynamic model and HSRI model based on information fusion Asian Journal of Control 2018 20 3 1067 1076 10.1002/asjc.1449 MR3813420 Saadeddin K. Abdel-Hafez M. F. Jarrah M. A. Estimating vehicle state by GPS/IMU fusion with vehicle dynamics Journal of Intelligent & Robotic Systems 2014 74 1-2 147 172 2-s2.0-84892796220 Chen Te Chen Long Xu Xing Cai Yingfeng Jiang Haobin Sun Xiaoqiang Reliable Sideslip Angle Estimation of Four-Wheel Independent Drive Electric Vehicle by Information Iteration and Fusion Mathematical Problems in Engineering 2018 2018 14 10.1155/2018/9075372 9075372 MR3789300 Melzi S. Sabbioni E. On the vehicle sideslip angle estimation through neural networks: numerical and experimental results Mechanical Systems and Signal Processing 2011 25 6 2005 2019 10.1016/j.ymssp.2010.10.015 2-s2.0-79957472824 Han Bao Xin Guan Xin Jia Fan Liu A Study on Maneuvering Obstacle Motion State Estimation for Intelligent Vehicle Using Adaptive Kalman Filter Based on Current Statistical Model Mathematical Problems in Engineering 2015 2015 14 10.1155/2015/515787 515787 MR3396052 Zbl1394.93325