## Abstract

Automotive research and development passed through a vast evolution during past decades. Many passive and active driver assistance systems were developed, increasing the passengers’ safety and comfort. This ongoing process is a main focus in current research and offers great potential for further systems, especially focusing on the task of autonomous and cooperative driving in the future. For that reason, information about the current stability in terms of dynamic behavior and vehicle environment are necessary for the systems to perform properly. Thus, model-based online state and parameter estimation have become important throughout the last years using a detailed vehicle model and standard sensors, gathering this information. In this chapter, state and parameter estimation in vehicle dynamics utilizing the unscented Kalman filter is presented. The estimation runs in real time based on a detailed vehicle model and standard measurements taken within the car. The results are validated using a Volkswagen Golf GTE Plug-In Hybrid for various dynamic test maneuvers and a Genesys Automotive Dynamic Motion Analyzer (ADMA) measurement unit for high-precision measurements of the vehicle’s states. Online parameter estimation is shown for friction coefficient estimation performing maneuvers on different road surfaces.

### Keywords

- vehicle dynamics
- state estimation
- parameter estimation
- unscented Kalman filter
- dead-time compensation

## 1. Introduction

In the past decades, enormous developments in automotive research were achieved. Since the beginning of the twentieth century, a consistent search for solutions increasing vehicle’s safety and comfort took place. Starting with passive safety systems in the early twentieth century, e.g., airbag, safety belt, and deformable zone, a vast improvement of the passenger’s safety was accomplished. These systems reduce passenger injuries and or even death due to accidents. Later, starting in the 1960th and 1970th active safety systems or advanced driver assistance systems (ADAS), preventing the vehicle from accidents by actively influencing the vehicle was developed. First implementations were traction control (TCS) and antilock braking systems (ABS), stabilizing the vehicle during longitudinal dynamic maneuvers. In 1995, the superordinate electronic stability control (ESC) was developed, combining stabilization during longitudinal and lateral dynamic maneuvers. Because of its success, ESC is mandatory in modern vehicles in Europe since the end of 2014. Other ADAS, e.g., adaptive cruise control (ACC), autonomous emergency braking (AEB), or lane detection system, have been developed in the meantime, further increasing safety and comfort. Future trends show an enormous potential for advanced systems, finally leading to the objective of autonomous and cooperative driving.

Many of these ADAS rely on parametric models, describing and predicting the vehicle’s (future) behavior. Especially information about the vehicle’s stability, characterized by dynamic states, is necessary. Furthermore, information about the vehicle’s environment, e.g., by changing weather conditions and therefore changing friction conditions may influence the systems’ performance drastically. Thus, online estimation of the vehicle’s stability in terms of its dynamic behavior and online estimation of influential parameters, such as the friction coefficient, are challenging fields in modern automotive research.

Many methods for state estimation use simple models of vehicle dynamics to reduce the computational effort, e.g., considering a linear bicycle model [1, 2, 3] or a linear planar two-track model [4]. A further detailed description of the forces acting on the vehicle’s tire is developed in Ref. [5] and utilized in Ref. [6]. A more detailed model, considering roll dynamics (cf. Figure 1 ), is utilized in [7, 8].

Similarly, various methods considering the estimation algorithm are utilized. For linear models, the Kalman filter serves as an optimal filter. Considering nonlinear models, Kalman filter derivatives, such as extended and unscented Kalman filters (EKF/UKF), are used. The EKF is used for tire road force and sideslip angle estimation in Ref. [9] and for sideslip angle estimation of low friction roads in Ref. [6]. The UKF for vehicle state estimation is presented in [7, 8].

Simultaneous state and parameter estimation with dual extended Kalman filter is presented in Ref. [10], estimating the vehicle mass and moment of inertia around the vertical axis. The same parameters are estimated in Ref. [11] using a joint UKF. Friction coefficient estimation using a joint UKF is realized in [12, 13, 14].

In this chapter, state estimation in vehicle dynamics utilizing an UKF is presented. The estimation is based on measurements taken with standard sensors, which are implemented in modern vehicles. Therefore, a nonlinear process and measurement model are introduced. Furthermore, dead times, due to CAN communication, are considered and compensated using model-based methods. Additionally, simultaneous state and parameter estimation considering the friction coefficient between tires and road is presented. All methods are validated online using a Volkswagen Golf GTE Plug-In Hybrid as the test vehicle, equipped with a Genesys ADMA inertial platform for precise reference measurements. The friction coefficient estimation is validated on a test track with two different surfaces.

The chapter is organized as follows: in Section 2, the nonlinear process and measurement models of the vehicle’s longitudinal and lateral dynamics are introduced. Based on this, Section 3 addresses the state and parameter estimation utilizing the unscented Kalman filter. Furthermore, dead-time compensation and bounded parameter estimation are introduced. In Section 4, the estimation results, using this method, are presented. Thus, measurements taken on a test vehicle using a precise initial measurement unit are presented and discussed. The chapter is recapped with a Conclusion in Section 5.

## 2. Modeling

In this section, a detailed parametric model of the vehicle’s dynamics is presented. Deriving this model for online application, a trade-off between accuracy and computational effort has to be faced. Starting from the contact patch of tires and road as a predominant source of forces acting on the vehicle, the full dynamics of the vehicle will be derived. Furthermore, a measurement model describing certain measurements, representing the vehicle’s dynamics taken with standard sensors is presented. The resulting models form the basis for the later state and parameter estimation algorithm using the UKF.

### 2.1. Tire model

First, the vehicle’s tires are considered, representing the contact patch between vehicle and road, consequently providing forces substantially influencing the vehicle’s dynamics. These forces arise due to differences in relative motion between tire and road and therefore lead to a deformation of the tire due to friction, described by the friction coefficient

for longitudinal and tire sideslip angle

for lateral motion, respectively, where

assuming identical maximum friction coefficient for longitudinal and lateral forces. The nonlinear functions

with individual parameters for longitudinal and lateral dynamics

The function
_{1}-element as

with tire-delay constant

The inputs to the system are the drive and break torques

with the tire’s moment of inertia

with constant and velocity dependent part, represented by

### 2.2. Vehicle body dynamics

Considering a two-track model with additional roll dynamics as displayed in
Figures 1
and
4
, the vehicle’s dynamics under disregard of vertical dynamics can be described by the vehicle’s yaw-rate

with

Roll dynamics are represented in analogy to a spring-damper system with gravitational influence with chassis mass

These constants result from combinations of suspension and stabilization constants

### 2.3. Measurement model

Inside the vehicle, standard sensors are implemented to obtain information about the current driving state. These sensors measure the yaw-rate

A measurement model representing these sensors is needed for the later implementation of KF derivatives. Since the measured yaw-rate and wheel velocities are states within the model, they are obtained directly and no further model is needed. The longitudinal and lateral accelerations in the sensor position

with

Due to the sensors’ sampling rate of

Within the model, numerous parameters are utilized. These parameters can either be measured directly, e.g., geometrical parameters, or need to be identified using an offline identification algorithm. Since the model is strongly nonlinear, a particle swarm algorithm (PSO) is used. Therefore, measurements representing longitudinal and lateral dynamics, driven by a test vehicle, have to be performed. Hence, a sequential identification can be realized, first considering longitudinal excitation, neglecting lateral dynamics and subsequently lateral excitation. Further details can be found in Ref. [15].

In summary, the vehicle’s dynamics can be expressed by the discrete time state space representation

at discrete time step

## 3. State and parameter estimation

In this section, a brief overview over the used Kalman filter derivative will be given. At first, the algorithm for state estimation will be presented. Furthermore, a model-based dead-time compensation will be introduced. Secondly, the joint UKF for state and parameter estimation will be presented. Subsequently, an extension for the estimation of bounded parameters is introduced.

### 3.1. The unscented Kalman filter for state estimation

The process and measurement model presented in Section 2 are strongly nonlinear, especially considering the forces acting on the vehicle’s tires (cf. Eq. (5)). Therefore, a Kalman filter derivative, capable of estimating nonlinear systems, the UKF is utilized. Since no information about the covariance is available, the additive form of the process and measurement equations

with
* a priori* state and covariance estimation utilizing the process model is executed. Using the unscented transformation [17], a carefully chosen set of

with
* a priori* estimation as

Following this, a measurement

with weighting factors
* a posteriori* estimations of the state and covariance,

### 3.2. Dead-time compensation

When designing online methods for real-time applications, dead times are frequently to face. Especially, considering vehicular applications, the communication is realized via CAN-Bus, leading to dead times. In the following, a method to compensate for dead times within state estimation is presented.

Since the measurement update (Eqs. (31)–(35)) can only be processed, as soon as a measurement

for j = 1 to

end

To reduce computational cost, the update steps can be reduced, so that only the mean is transformed and therefore no further sigma point needs to be calculated and transformed as

for j=1 to

end

This may lead to reduced performance, depending on the length of the dead time, the process model complexity, and the uncertainties within the process.

### 3.3. Parameter estimation

Since parameters may vary within dynamic systems, simultaneous state and parameter estimation is considered. Various methods to solve this task have been developed in the past decades. In the following, the approach of joint state and parameter estimation is presented. Therefore, states and parameters are concentrated into one joint state vector as

with primary state

If some parameters are bounded as

Using this substitution, the estimated parameter

## 4. Estimation results

In this section, the results of the vehicle’s states and parameter estimation using an unscented Kalman filter and the two-track model described Section 2 are presented. At first, the test vehicle and the measurement equipment that is necessary for the validation are introduced. Secondly, the results of the vehicle state estimation and the results by considering dead time within the estimation are shown. Furthermore, a simultaneous state and friction estimation are presented that exhibit improved estimation results for varying road conditions.

### 4.1. Measurement setup

The estimation results are verified by using a Volkswagen Golf GTE Plug-In Hybrid ( Figure 5(a) ) equipped with a Genesys ADMA-G-Eco + ( Figure 5(b) ). This system is developed especially for vehicle dynamics testing in the automotive sector. This inertial measurement unit (IMU) corrected by global positioning system (GPS) enables precise measurement of acceleration, speed, and position of the moving test vehicle in all three-dimensional axes. Furthermore, the pitch, roll and yaw angles, angular velocities as well as sideslip angle can be obtained. The GPS antenna is mounted on the roof of the test vehicle, whereas the IMU is placed in the footwell of the passenger seat. Ideally, the two sensors are placed in the center of gravity; unfortunately, in praxis, this requirement usually either cannot or can only be fulfilled with very high effort. Furthermore, it is hardly possible to exactly align the ADMA’s measurement axes with the vehicle’s axes. The errors caused by the distance between the installation position and the c.o.g as well as by misalignment angle can be mathematically compensated considering the lever arms and the angle offsets, respectively. The IMU’s measurements are exclusively provided for the validation of the Kalman filter application. Additional measurements of the wheel speeds, accelerations and yaw rate as well as system inputs, i.e., steering angle, engine, and breaking torque, are taken from the vehicle’s bus system. The onboard measurements are provided for the measurement update of the real-time Kalman filter application. Furthermore, an ES910 prototyping and interface module provides the connection to the vehicle bus and the computation of the filter application with system-level behavior.

### 4.2. Unscented Kalman filter setup

The UKF utilizes a two-track model including roll dynamics as described in Section 2. The estimator’s state and measurement vector were therefore

The initial covariance matrix of the state distribution is initialized with

### 4.3. State estimation

In this section, the results of vehicle state estimation are shown. The UKF estimation results are displayed in light grey, while the reference measurements of the ADMA-G-Eco+are displayed in black and the vehicle’s onboard measurements are displayed in grey. Each displayed maneuver is subdivided into eight diagrams. The top line shows yaw-rate and sideslip angle representing lateral dynamics, and the second line shows roll angle and roll rate representing roll dynamics. Furthermore, the velocity in the c.o.g. and the wheel speeds representing longitudinal dynamics are displayed in the third line and at last longitudinal and lateral acceleration in the bottom line. The accelerations in the c.o.g are displayed with continuous lines and the accelerations measured with onboard acceleration sensor that is not mounted in the c.o.g. in the dashed lines. The distances of the sensor position from the c.o.g. are identified with

A steering sweep maneuver is optimal to validate the filter application and the integrated vehicle dynamic models, but it is not a practical example, whereas, for example, lane change maneuvers often occur. In addition, lane change maneuvers enable high lateral acceleration and high values of tire sideslip angles, which may lead, under certain conditions, to loss of stability due to nonlinear tire characteristics. Therefore, lane change maneuvers are suitable as practical driving situation.

A double-lane change maneuver with moderate lateral acceleration represents a typical maneuver on highways or freeways occurring by overtaking another slower moving vehicle. However, a double-lane change maneuver with high lateral acceleration represents obstacle avoidance maneuver. This kind of maneuver is displayed with a high lateral acceleration up to

### 4.4. Dead-time compensation

A major problem in control systems is dead time. Dead time may lead either to poor control results or to unstable control. In case of stability control systems and therefore for robust car steering, the real-time information of sideslip angle and yaw rate is very important. As pointed previously, an accurate estimation of this vehicle states can be realized using UKF with nonlinear two-track model even if vehicles move at its stability limits. However, the estimated states are not the true vehicle states at this particular time. They are delayed due to the dead-time-shifted measurement update, which occurs particularly of the communication on the CAN network. In dependence on the length of dead time, different arrangements exist for dead-time compensation. In addition, to consider the dead time in the controller designing, a further possibility is model-based dead-time compensation within state estimation. A simple method to predict the system’s state and covariance during the dead time is to execute only the filter process update without doing the measurement update as defined in Section 3.2. Alternatively, to reduce computational cost, the prediction can be executed only considering the mean of the system states by neglecting further sigma points. During the prediction from time step * k* to

It is quite obvious that both methods for dead-time compensation do not really differ in the application of vehicle dynamics; thus, it is at an advantage due to reduced computational costs only to consider the mean of the state. Furthermore, the UKF results with dead-time-compensated states also do not differ from the time-shifted UKF prediction without dead time displayed in light grey. Therefore, it is possible to include dead-time compensation in the state estimation in a simple manner and to obtain precise estimation results. However, this method for dead-time compensation has the restriction that the system does not contain varying dead time and the dead time is well known.

All previously presented test maneuvers are executed on dry asphalt. Thus, the maximum friction coefficient between road and tire is well known. Under different road conditions, for example, wet, snow, and ice and without adaption of the friction coefficient, the accuracy of the state estimation decreases highly. Hence, for precise state estimation, it is essential to estimate the maximum friction coefficient as well.

### 4.5. Maximum friction coefficient estimation

However, not only for improved vehicle state estimation a simultaneous estimation of the maximum friction coefficient between road and tire is of paricular importance. To ensure a proper functionality of safety functions not only the knowledge of the driving situation but also of the driving environment, in particular the road condition, is required. This section focuses on the road condition classification using a joint unscented Kalman filter approach as described in Section 3.3. The extended process, covariance matrix

Furthermore, the maximum friction coefficient is bounded according to Eq. (37) with a upper bound of 1.1 and a lower bound of 0.1. The upper bound corresponds to the best traction potential that may occur when the roads are dry and the tires are in good condition. The lower bound corresponds to the lowest traction potential that may occur when the roads are icy and the tires have a low tire profile.

In
Figure 9
, again a double-lane change maneuver on dry asphalt at a velocity of approximately

In Figure 10 , the estimation of the maximum friction coefficient on different roads is displayed. Beginning on dry asphalt, the test vehicle drives a sine steering maneuver and changes over to wet steel. Wet steel exhibits similar properties regarding traction potential as an icy road. Because it is much easier to build up a road composed of wet steel than of ice to carry out a test, in this test, the wet steel represents a road with low traction potential. Over the entire period of the sine maneuver, a sufficient excitation is existent. Hence, the unscented Kalman filter estimates while driving over the dry asphalt a maximum friction coefficient of approximately 1. After changing to wet steel, clearly, a lower friction level with a maximum friction coefficient of approximately 0.3 is detected. It can be spotted that while sufficient excitation is existent, different friction levels according to different road conditions can also be clearly recognized. The last 5 s of the maneuver is without steering and acceleration, and the estimated maximum friction coefficient remains constant. Therefore, due to missing excitation, it would not be possible to distinguish between dry asphalt and wet steel. Nonsufficient excitation is a major disadvantage of Kalman filter-based approaches for parameter estimation in general and thus also for friction estimation.

A promising approach to solving this problem is to use further source of information, for example, optical sensors and to do an information fusion, so that disadvantages of one information can be compensated by advantages of other information. Information fusion is the next step for improved friction estimation and current research.

## 5. Conclusion

In this chapter, state and parameter estimation in vehicle dynamics using the unscented Kalman filter is presented. Therefore, a detailed nonlinear process and measurement model of the vehicle are introduced, representing the vehicle’s stability and the measurements taken with standard sensors. Dead times, due to CAN communication, are faced and compensated using model-based prediction. The validation of the introduced methods is realized by using a Volkswagen Golf GTE Plug-In Hybrid for high dynamic test maneuvers, e.g., double-lane change. The estimation results are compared with high-precision measurements using a Genesys ADMA inertial measurement unit. Accurate estimation even in situations with lateral acceleration above

The parameter estimation is presented using the example of friction coefficient estimation utilizing the joint unscented Kalman filter. Thus, maneuvers with different excitation on different road surfaces are executed. Again, precise estimation in the presence of sufficient excitation can be shown.

## References

- 1.
Best MC, Gordon TJ, Dixon PJ. An extended adaptive Kalman filter for real-time state estimation of vehicle handling dynamics. Vehicle System Dynamics. 2000; 34 (1):57-75. DOI: 10.1076/0042-3114(200008)34:1;1-K;FT057 - 2.
Cheli F, Sabbioni E, Pesce M, Melzi S. A methodology for vehicle sideslip angle identification: Comparison with experimental data. Vehicle System Dynamics. 2007; 45 (6):549-563. DOI: 10.1080/00423110601059112 - 3.
Chen BC, Hsieh F-C. Sideslip angle estimation using extended Kalman filter. Vehicle System Dynamics. 2009; 46 (S1):353-364. DOI: 10.1080/00423110801958550 - 4.
Doumiati M, Victorino AC, Charara A, Lechner D. Onboard real-time estimation of vehicle lateral tire–road forces and sideslip angle. IEEE Transactions on Mechatronics. 2011; 16 (4):601-614. DOI: 10.1109/TMECH.2010.2048118 - 5.
Pacejka HB, Bakker E. The magic formula tire model. Vehicle System Dynamics. 1992; 21 (S1):1-18. DOI: 10.1080/00423119208969994 - 6.
Li L, Jia G, Ran X, Song J, Wu K. A variable structure extended Kalman filter for vehicle sideslip angle estimation on a low friction road. International Journal of Vehicle Mechanics and Mobility. 2014; 52 (2):280-308. DOI: 10.1080/00423114.2013.877148 - 7.
Antonov S, Fehn A, Kugi A. Unscented Kalman filter for vehicle state estimation. Vehicle System Dynamics. 2011; 49 (9):1497-1520. DOI: 10.1080/00423114.2010.527994 - 8.
Wielitzka M, Dagen M, Ortmaier T. State estimation of vehicle's lateral dynamics using unscented Kalman filter. Los Angeles, USA: IEEE 53rd Annual Conference on Decision and Control (CDC); 15-17 December 2014; 2015. pp. 5015-5020 - 9.
J Dakhlallah J, Glaser S, Mammar S, Sebsadji Y. Tire-Road Forces Estimation Using Extended Kalman Filter and Sideslip Angle Evaluation. Seattle, USA: 2008 American Control Conference (ACC); 11–13 June 2008; 2008. pp. 4597-4602 - 10.
Wenzel TA, Burnham KJ, Blundell MV, Williams RA. Dual extended Kalman filter for vehicle state and parameter estimation. Vehicle System Dynamics. 2006; 44 (2):153-171. DOI: 10.1080/00423110500385949 - 11.
Wielitzka M., Dagen M., Ortmaier T.: Joint unscented Kalman filter for state and parameter estimation in vehicle dynamics. Sydney, Australia: IEEE Conference On Control Applications (CCA); 21-23 September 2015. pp. 1945-1950 - 12.
Ahn C, Peng H, Tseng HE. Robust estimation of road friction coefficient using lateral and longitudinal vehicle dynamics. Vehicle System Dynamics. 2012; 50 (6):961-985. DOI: 10.1080/00423114.2012.659740 - 13.
Ahn C, Peng H, Tseng HE. Robust estimation of road friction. IEEE Transactions on Control Systems Technology. 2013; 521 (1):1-13. DOI: 10.1109/TCST.2011.2170838 - 14.
Wielitzka M, Dagen M, Ortmaier T. State and maximum friction coefficient estimation in vehicle dynamics using UKF. Seattle, USA: American Control Conference (ACC); 24-26 May 2017. pp. 4322-4327 - 15.
Wielitzka M, Dagen M, Ortmaier T. Nonlinear modeling and parameter identification of Vehicle’s lateral dynamics. Tokio, Japan: 12th ^{th}International Symposium on Advanced Vehicle Control (AVEC); 22–16 September 2014 - 16.
Rajamani, Rajesh. Vehicle dynamics and control; Springer Science & Business Media; 2011 - 17.
Julier SJ. The Scaled Unscented Transformation. 2002: American Control Conference (ACC); 08-10 May 2002. USA: Anchorage; 2012. pp. 4555-4559 - 18.
Wan EA, Van der Merwe R. The unscented Kalman filter for nonlinear estimation. Alberta, Canada: Adaptive Systems for Signal Processing, Communications, and Control Symposium (AS-SPCC); 04 October 2000. p. 153-158