State estimation based on unscented Kalman filter for semiactive suspension systems
Cheng Lin^{1} , Wei Liu^{2} , Hongbin Ren^{3}
^{1, 2}Collaborative Innovation Center of Electric Vehicles in Beijing, Beijing, China
^{1, 2, 3}School of Mechanical Engineering, Beijing Institute of Technology, Beijing, China
^{2}Corresponding author
Journal of Vibroengineering, Vol. 18, Issue 1, 2016, p. 446457.
Received 2 September 2015; received in revised form 18 November 2015; accepted 13 December 2015; published 15 February 2016
In this paper, a novel approach to estimate vehicle vibration state information in real time is proposed; it is based on unscented Kalman filter (UKF) theory. The UKF is based on the unscented transfer technique which considers high order terms during the measurement and update stage during the estimation. The proposed observer uses easily accessible measurements such as accelerations and suspension deflections to estimate the sprung and unspring mass vertical velocity for the suspension systems of full vehicle under unknown road disturbance. And it is with low sensitivity and robust to the unknown road surfaces. Matlab/Carsim cosimulation experiments are carried out to validate the performance of the estimator under two typical road excitations. The simulation results clearly indicate that the proposed UKF sate observer is precise.
Keywords: nonlinear suspension system, UKF, state estimation, cosimulation.
1. Introduction
State estimation is to identify the internal state information of a real system by combining information obtained from measurements of the input and output of the real system. Knowing the system state is necessary to design the controller or online fault diagnosis for a given system, such as stabilizing a system by using state feedback, PID control, et al. And the performance of the controllers relies heavily on the precision of the vehicle states. Some of the required vehicle state information is easily to be measured by the sensors, for example, vehicle body vertical acceleration; but others are difficult to detect due to the expense, complexity and the technical limitations. Reducing sensor is a potential approach to cut down the cost and improve the reliability and performance of the controller. Tims [1] studied the approaches to reduce sensors in active suspension control, he used the suspension stroke sensor to estimate sprung mass vertical velocity, but he didn’t consider the potential for phase advance or lag in the estimation of velocity, especially for the large pitch and roll motion; this will induce the signal’s time delay. Time delay is a key issue for the active suspension control.
System dynamic control heavily depends on accurate state information. And the research of vehicle’s states and parameters online estimation are attacking more and more attentions in automobile industry. One of the principal problems in semiactive suspension control is to estimate the suspension vibration states from easily accessible measurements such as accelerations. This requires observers to produce good state estimation, such as vehicle body and wheel absolute velocities, vehicle body roll and pitch rate et al. Kyongsu [2] proposed a suspension state estimation method by measuring the acceleration signals, and the stability of observer was proved. Hernandez [3] designed Romberg observer with low sensitivity to unknown road surfaces; the simulation results show that low gain Romberg observers have the best overall performance even driving on different road excitations. An online system identification to identify sprung mass and spring stiffness based on the recursive leastsquares is presented in [4].
This paper studies the state estimation for strong nonlinear suspension systems. An estimation algorithm is designed based on the UKF theory to estimate the vehicle body and wheel vertical velocity as well as roll and pitch rate by the suspension stroke and vehicle body acceleration sensors. These estimated states are necessary information for the control application of suspension systems.
The organization of this paper is follows: full vehicle and the hydropneumatic suspension are modelling in Section 2; the state observer design and UKF theory are explained, respectively in Section 3; the effects of the proposed observer are validated by numerical simulation under two different road types in Section 4.
2. Vehicle dynamic modeling
The fullscale nonlinear vehicle model considering the heavepitchroll motion is necessary in development of vehicle technologies, such as suspension control, chassis integrated control, active safety, driving assistant technology, etc.
The sprung mass includes the chassis, which consists of internal components and passengers, and the sprung mass varies with the number of passengers and the payload condition of a car. It connects the suspension systems to four wheels (unsprung masses). The chassis is free to heave, pitch, and roll. The four wheels bounce vertically relatively to the vehicle body. The hydropneumatic suspension systems are used in this study. The damping forces can be continuously adjusted by controlling the current of the proportional relief valve according to the control algorithm. ${m}_{u}$ is the unsprung mass, which is supported by the tire, the stiffness coefficient of tire is ${K}_{t}$. The sprung and unsprung mass displacement of are denoted as ${z}_{s}$ and ${z}_{u}$, respectively. The road excitation is $q$.
Fig. 1. Fullscale vehicle semiactive suspension model
The differential equations including vertical, pitch and roll motions are expressed as:
where, ${F}_{sus}$ is the total suspension force including the spring force and damping force; and is generated by the hydropneumatic suspension. It can be described by using a nonlinear function:
where, ${u}_{ij}$ is the control current; $fl$, $fr$, $rl$, $rr$ denote frontleft, frontright, rearleft, rearright of the vehicle body.
The dynamic equations of four wheels’ vertical motion are as follows:
The damping continuous hydropneumatic suspension consists of an accumulator and a cylinder. The accumulator is filled with precharge gas, and it works as a nonlinear spring in hydropneumatic suspension system. The spring force can be calculated by:
where, ${P}_{0}$ is initial pressure in the accumulator; ${V}_{0}$ is initial accumulator volume.
Fig. 2. Suspension bench test
Fig. 3. Spring force comparison between bench test and simulation
The bench test of hydropneumatic suspension is shown in Fig. 2. And the spring force comparison between bench test and simulation is shown in Fig. 3. The damping continuous adjustable suspension is based on the bypass principle using a proportional relief valve in parallel with a conventional damper orifice and valve assembly. If the bypass valve is closed, all the flow goes through the conventional damper orifice and valve assembly, presenting harddamping characteristic. If the bypass valve is open partially or totally, most of the flow will pass through the bypass valve due to the lower flow resistance, and the damping characteristic will be soft mode.
The currentvelocitydamping force is fitted by a highorder polynomial function, as shown in Fig. 4. It is easy to calculate the control current to generate a desired damping force. It can be described as follows:
where, ${b}_{i}$, ${c}_{i}$ and ${d}_{i}$ are the fitting coefficients obtained from the experimental data. The values of these coefficients are listed in Table 1.
Table 1. Coefficients of the polynomial function
$b$

Values

$c$

Values

$d$

Values

${b}_{0}$

–108.67

${c}_{0}$

–812.59

${d}_{0}$

1035.77

${b}_{1}$

–4172.29

${c}_{1}$

47632.73

${d}_{1}$

–2546.27

${b}_{2}$

–5960.93

${c}_{2}$

4939.83

${d}_{2}$

–3108.31

${b}_{3}$

5755.10

${c}_{3}$

–79007.97

${d}_{3}$

22568.64

${b}_{4}$

5242.83

${c}_{4}$

–5593.96

${d}_{4}$

2257.40

${b}_{5}$

–2448.37

${c}_{5}$

44306.14

${d}_{5}$

–12670.56

Fig. 4. Currentvelocitydamping force fitting results (the dotted line is test data; the continuous line is the fitting results. When $\mathrm{\Delta}{\dot{z}}_{s}<0$, the suspension is in rebound motion)
The control current can be obtained according to the suspension relative velocity and the desired damping force which is determined according the control logic.
3. UKF observer design
In the semiactive suspension control application, some states are difficult to be measured, and some of them cannot be measured at all due to the high cost or limitations of technology. So it is necessary to design the observer to identify the states or parameters of the suspension systems, such as sprung mass vertical velocity. Kalman filtering (KF) is based on linear quadratic optimal theory, as shown in Fig. 5, which estimates unknown variables from easily measured signals. Extend Kalman filter (EKF) is a frequently used for optimal nonlinear system state and parameters estimation. EKF is based on the oneorder Taylor series expansions to convert the nonlinear system into linearized one. It works well for the weakly nonlinear systems; for the strong nonlinear system, the estimation performance is not good because of high calculation cost of the system’s Jacobian matrixes. And this estimation algorithm can induce a large error in the actual values of mean and covariance, which may lead to suboptimal performance and sometimes even cause divergence of the filter [10].
Fig. 5. Flowchart of Kalman filter
UKF is also a nonlinear Kalman filter. It is based on the Unscented Transform (UT) theory and statistical linearization technique. This technique is a new approximation method by propagating means and covariance through nonlinear transformations. The UKF is more accuracy than the EKF in terms of speed of convergence and robustness; the computational load of UKF is almost same to the EKF algorithm [10].
3.1. UT theory
The Unscented Transfer (UT) is a mathematical tool for calculating the statistics of a random variable which undergoes a nonlinear transformation, named as sigma points. The sigma points are a set of points which have mean and covariance equal to the given mean and covariance. The elements of sigma points are discrete in probability distribution. This distribution can be propagated exactly by applying the nonlinear function to each point.
In the paper, the symmetrically sampling method is used to pick up the sigma points. For the random variable state vector $\mathbf{x}$, the mean is $\stackrel{}{\mathbf{x}}$ and the covariance of $\mathbf{x}$ is denoted as ${\mathbf{P}}^{\mathbf{x}}$. The sigma points are chosen so that their mean and covariance are exactly equal to $\stackrel{}{\mathbf{x}}$ and ${\mathbf{P}}^{\mathbf{x}}$ respectively. Define ${\mathrm{\chi}}_{k}$ as a set of $2n+1$ sigma points [11]:
where, $n$ is the dimension of the state vector $\mathbf{x}$; $\lambda $ is scaling parameter, $\lambda ={\alpha}^{2}\left(n+\kappa \right)n$; the constant $\alpha $ is used to indicate the distribution of sigma around vector $\stackrel{}{x}$, and the value of $\alpha $ usually is a very small value no more than one; $\kappa \ge 0$ will keep the matrix of covariance to be positive definite. ${\left(\sqrt{(n+\lambda ){\mathbf{P}}^{\mathbf{x}}}\right)}_{k}$ is the $k$th column of the matrix square root.
3.2. UKF estimation
The sigma vectors can be renewed by:
where, $\mathrm{\Delta}T$ is system sampling time; $f$ is system function; ${\mathbf{u}}_{k+1}$ is the system input; ${\mathbf{w}}_{k+1}$ is the process Gaussian white noise with covariance $Q$.
Measurement elements update:
where, $h$ is measurement function; ${\mathbf{v}}_{k}$ is the observation Gaussian white noise with covariance $R$.
The updated state vector ${\mathbf{x}}_{k+1}$ and the measurement value ${\mathbf{y}}_{k+1}$ can be calculated by weighted sigma vectors:
Covariance update. The state vector and the measurement vector covariance can be renewed by:
${\mathbf{P}}_{{\mathrm{}}^{{\mathrm{}}_{k+1}}}^{\mathbf{y}}=\sum _{i=1}^{2n+1}\left[{\mathbf{W}}_{i}^{c}\right(({Y}_{k+1}{)}_{i}{\mathbf{y}}_{k+1})\left(\right({\mathbf{Y}}_{k+1}{)}_{i}{\mathbf{y}}_{k+1}\left)\mathrm{\text{'}}\right]+\mathbf{R},$
${\mathbf{P}}_{{\mathrm{}}^{{\mathrm{}}_{k+1}}}^{\mathbf{x}\mathbf{y}}=\sum _{i=1}^{2n+1}\left[{\mathbf{W}}_{i}^{c}\right(({\mathrm{\chi}}_{k+1}{)}_{i}{\mathbf{x}}_{k+1})\left(\right({\mathbf{Y}}_{k+1}{)}_{i}{\mathbf{y}}_{k+1}\left)\mathrm{\text{'}}\right],$
where:
${\mathbf{W}}_{i}^{c}=\left[\frac{\lambda}{n+\lambda}+1{\alpha}^{2}+\beta ,\underset{2n}{\underset{\u23df}{\frac{\frac{1}{2}}{n+\lambda},\cdots ,\frac{\frac{1}{2}}{n+\lambda}}}\right].$
In which, $\beta $ considers the high order moment of the prior distribution, for Gaussian distribution, $\beta =2$ is optimal.
State correction
${\mathbf{x}}_{k+1k+1}={\mathbf{x}}_{k+1k}+{\mathbf{K}}_{k+1}\left({\mathbf{z}}_{k+1}{\mathbf{y}}_{k+1}\right),$
${\mathbf{P}}_{k+1k+1}^{x}={\mathbf{P}}_{k+1k}^{x}{\mathbf{K}}_{k+1}{\mathbf{P}}_{k+1}^{y}({\mathbf{K}}_{k+1}{)}^{\mathrm{\text{'}}},$
where, ${\mathbf{z}}_{k+1}$ are the measurements from the sensors.
3.3. Suspension state estimation
Choose the state vector as $\mathbf{x}=[\begin{array}{llllll}{\dot{z}}_{s}& \dot{\phi}& \dot{\theta}& {\dot{z}}_{u1~4}& {f}_{d1~4}& (q{z}_{u}{)}_{1~4}\end{array}{]}^{\mathrm{T}}$, and choose $h\left(x\right)=[{x}_{8~12},{\ddot{z}}_{s1~4}{]}^{\mathrm{{\rm T}}}$, i.e. four suspension strokes and four sprung mass vertical accelerations as observer measurements. The system function can be rewritten as statespace format:
where, $\mathbf{w}=\dot{q}$ is the process noise, which is the derivative of road disturbance and it is a white noise with covariance $\mathbf{Q}$; $\mathrm{v}$is the measurement noise assumed to be zero mean Gaussian white noise with covariance $\mathbf{R}$.
${x}_{1}={\dot{z}}_{s}$ is vertical velocity of vehicle body mass center; ${x}_{2}=\dot{\phi}$ is velocity body roll rate; ${x}_{3}=\dot{\theta}$ is velocity body pitch rate; ${x}_{4~7}={\dot{z}}_{u1~4}$ is unsprung mass vertical velocities; ${x}_{8~11}={f}_{d1~4}$ is suspension stroke rates of four corners; ${x}_{12~15}=(q{z}_{u}{)}_{1~4}$ is vertical displacements of wheels.
The continuous system functions of vehicle’s dynamics function (16) could be converted as discretetime form by using the firstorder approximation, as follows:
The state observer of nonlinear suspension system is designed; the flowchart of observer is shown in Fig. 5. Here the derivative of road disturbance is considered as system process noise. The observer is low sensitivity to unknown random road disturbances.
Fig. 6. The flowchart of suspension state observer
4. Simulation and discussion
In order to demonstrate the effectiveness of the proposed semiactive suspension control algorithm, it is validated in the Matlab/Simulink and Carsim cosimulation environment. CarSim is a commercial software which is widely used to simulate the dynamic behavior of vehicles. Carsim provides measurement outputs for the observer. And the control algorithm and state observer are designed in Matlab/Simulink. The estimation performance is validated under two working conditions, random road and speed bump road. The smooth random road represents consistent excitations with wide range of frequencies; the speed bump road represents the discrete events of relatively short duration and high intensity. The vehicle parameters are list in Table 2.
Table 2. Parameters of offroad vehicle suspension
Description

Symbol

Value

Sprung mass

${m}_{s}$

9000 kg

Unsprung mass

${m}_{u}$

250 kg

The distance of body mass center to front axis

$a$

1.94 m

The distance of body mass center to rear axis

$b$

2.56 m

Tire stiffness

${k}_{t}$

1501.2 kN/m

Roll moment of inertia

${I}_{x}$

3531 kg∙m^{2}

Pitch moment of inertia

${I}_{y}$

16243 kg∙m^{2}

Track width

$B$

1.481 m

Leverage ratio

$l$

1.507

Initial pressure of accumulator

${P}_{0}$

8 MPa

4.1. Case 1. Random road modeling
The power spectral density (PSD) of the random road model can be described as the following form:
where, the space frequency is denoted as $n$ (m^{1}); ${n}_{0}$is the reference space frequency, ${n}_{0}=$0.01 m^{1}; ${G}_{q}\left({n}_{0}\right)$ is the road roughness coefficient, here, choose ${G}_{q}\left({n}_{0}\right)=\text{256\xd71}{\text{0}}^{\text{6}}$; $w$ is frequency index, it reflects the frequency structure of the road model, usually $w=\text{2}$.
The random road excitation model can be acquired by integration of Gaussian white noise. The random road differential equation can be described as [12]:
where, $W\left(t\right)$is the Gaussian white noise; ${n}_{00}$ is the low cutoff space frequency, ${n}_{00}=\text{0.001}\text{}{\text{m}}^{\text{1}}$; $u$ is the vehicle longitudinal speed.
The four wheels road excitation can be referenced to the method proposed by Ren et al. [13]. The vehicle speed is kept constant as 60 km/h, and the four wheels of irregular road profiles are plotted in Fig. 7. The estimation results are presented in Figs. 812. Fig. 9 is the vehicle body mass center vertical velocity estimation results. Fig. 9 and Fig. 10 plot the vehicle body roll and pitch rate estimation results. Fig. 11 and Fig. 12 are the vehicle body and wheel vertical velocity estimation results. From the estimation results, we can find that compared with the EKF estimation results, the UKF state observer could estimate the suspension state in accurate when vehicle is driving on the random road.
4.2. Case 2: speed bump road
The speed bump road can certainly do harm if drive over them too quickly, and it cause large motion of vehicle body in a short time. In the numerical simulation, the vehicle velocity is kept constant as 30km/h. Time history of speed bump road is plotted in Fig. 13. The estimation results are presented in Figs. 1417. It can be found that the UKF observer could estimate the suspension states in precise when vehicle is crossing the speed bump road.
Fig. 7. Time history of four wheels disturbance input
Fig. 8. Vehicle body mass center vertical velocity estimation results
Fig. 9. Roll velocity estimation results
Fig. 10. Pitch velocity estimation results
Fig. 11. Sprung mass vertical velocity estimation results
Fig. 12. Unsprung mass vertical velocity estimation results
Fig. 13. Time history of speed bump road input
Fig. 14. Vehicle body mass center vertical velocity estimation results
Fig. 15. Pitch angle velocity estimation results
Fig. 16. Sprung mass vertical velocity estimation results
Fig. 17. Unsprung mass vertical velocity estimation results
5. Conclusion and future work
The suspension state observer with low sensitivity to road disturbance is designed based on UKF theory for nonlinear suspension systems. The UKF observer is successfully in estimating the state information of the suspension vibration with good accuracy. The performance of the proposed estimator is validated on two typical road excitations. The simulation results indicated that compared with the EKF estimation results, the performance of the designed UKF observer is more precise. The future work should be concentrating on validating the designed observer algorithms in the vehicle tests.
Acknowledgements
The authors acknowledge that this paper has been supported by National Natural Science Foundation of China (No. 51575044).
References
 Tims H. Vehicle Active Suspension System Sensor Reduction. Ph.D. Thesis, University of Texas, Austin, Tex, USA, 2005. [Search CrossRef]
 Yi Kyongsu, Song Byung Suk Observer design for semiactive suspension control. Vehicle System Dynamics, Vol. 32, Issues 23, 1999, p. 129148. [Search CrossRef]
 HernandezAlcantara Diana, AmezquitaBrooks Luis, MoralesMenendez Ruben StateObservers for SemiActive Suspension Control Applications with Low Sensitivity to Unknown Road Surfaces. SAE Technical Paper No. 2014010867, 2014. [Search CrossRef]
 Best, M. C., Gordon T. J. Suspension system identification based on impulsemomentum equations. Vehicle System Dynamics, Vol. 29, Issue 1, 1998, p. 598618. [Search CrossRef]
 Zong C., Hu D., Zheng H. Dual extended Kalman filter for combined estimation of vehicle state and road friction. Chinese Journal of Mechanical Engineering, Vol. 26, Issue 2, 2013, p. 313324. [Search CrossRef]
 Ren H., Chen S., Shim T., Wu Z. Effective assessment of tyreroad friction coefficient using a hybrid estimator. Vehicle System Dynamics, Vol. 52, Issue 8, 2014, p. 10471065. [Search CrossRef]
 Ren H., Chen S., Liu G., et al. Vehicle state information estimation with the unscented Kalman filter. Advances in Mechanical Engineering, 2014, p. 111. [Search CrossRef]
 Lu Fan Study on Vehicle Vibration State Observation Algorithm Based on the Nonlinearity of Suspension. Ph.D. Thesis, Beijing Institute of Technology, Beijing, China, 2014. [Search CrossRef]
 Beltran Carbajal Francisco, et al. Active disturbance rejection control of a magnetic suspension system. Asian Journal of Control, Vol. 17, Issue 3, 2015, p. 842854. [Search CrossRef]
 Wan Eric, van der Merwe Rudolph Kalman Filtering and Neural Networks. Chapter 7: The Unscented Kalman Filter. Wiley Publishing, 2001. [Search CrossRef]
 Rambabu Kandepu, Foss Bjarne, Imsland Lars Applying the unscented Kalman filter for nonlinear state estimation. Journal of Process Control, Vol. 18, Issue 7, 2008, p. 753768. [Search CrossRef]
 Wu Z., Chen S., Yang L., et al. Model of road roughness in time domain based on rational function. Transactions of Beijing Institute of Technology, Vol. 29, Issue 9, 2009, p. 795798. [Search CrossRef]
 Hongbin R., Sizhong C., Zhicheng W. Model of excitation of random road profile in time domain for a vehicle with four wheels. The Proceedings of the International Conference on Mechatronic Science, Electric Engineering and Computer, Jilin, China, 2011, p. 23322335. [Search CrossRef]