- freely available
- re-usable

*Sensors*
**2012**,
*12*(11),
15778-15800;
doi:10.3390/s121115778

## Abstract

**:**This paper presents a vehicle dynamics prediction system, which consists of a sensor fusion system and a vehicle parameter identification system. This sensor fusion system can obtain the six degree-of-freedom vehicle dynamics and two road angles without using a vehicle model. The vehicle parameter identification system uses the vehicle dynamics from the sensor fusion system to identify ten vehicle parameters in real time, including vehicle mass, moment of inertial, and road friction coefficients. With above two systems, the future vehicle dynamics is predicted by using a vehicle dynamics model, obtained from the parameter identification system, to propagate with time the current vehicle state values, obtained from the sensor fusion system. Comparing with most existing literatures in this field, the proposed approach improves the prediction accuracy both by incorporating more vehicle dynamics to the prediction system and by on-line identification to minimize the vehicle modeling errors. Simulation results show that the proposed method successfully predicts the vehicle dynamics in a left-hand turn event and a rollover event. The prediction inaccuracy is 0.51% in a left-hand turn event and 27.3% in a rollover event.

## 1. Introduction

In recent years, many vehicle control research propose using the future vehicle dynamics information to assist drivers' maneuvers. For example, the vehicle path predictions can provide the future position error for the vehicle guidance controls. Compared with the conventional “look-down” sensing system that provides current position error, the path prediction not only provides the information that are easier perceived by human drivers, but also provides additional information of road conditions, weather conditions, etc. [1,2]. As another example, many researchers propose using vehicle rollover predictions as anti-rollover measures [3–5]. The benefit is that the rollover prediction can trigger the control input earlier than the approaches without prediction. Consequently, the advance of the control action both saves actuation power and improves the driving safety. These examples highlight the importance of vehicle dynamics predictions.

In general, the future vehicle dynamics is predicted by using a vehicle mathematics model to numerically propagate current state values with time. Therefore, a vehicle dynamics prediction system needs a mathematic model and current vehicle state values [1–6]. There are two concerns regarding the mathematic model. First, many reports employ simplified vehicle models in the dynamics prediction, such as 2 DOF model [1], 4 DOF [2], and 2 DOF yaw-roll model [1–3,6]. The prediction results may only be acceptable for limited purposes and driving conditions. The inaccurate prediction result can be understood that, from the control viewpoint, the dynamics prediction is an open loop system. Thus, any model simplification would affect prediction accuracy to some extent. Our previous work [7] shows that even excluding the vehicle pitch dynamics from a 6 DOF vehicle model would result in an obvious error in the rollover prediction. One of the key components that are often neglected in the vehicle dynamics modeling is the road angle. Many research reports have shown that road angles have direct influences on the vehicle dynamics [8–10]. Our previous report [7] also show that, under the same driving maneuvers, a vehicle would roll over on a sloped road but would be under control on a flat road. Therefore, it is important to include the road angle in the vehicle dynamics prediction.

The second concern is the parameter uncertainty in the vehicle model. Most dynamics prediction methods use presumed vehicle parameters in the vehicle mathematics model [1–3,7]. This approach can simplify the prediction problem but may be inaccurate in practice. This is because the vehicle property (mass, moment of inertia) and road conditions (road angles, friction coefficients) may change from different driving situations, such as number of passengers, amount of fuel, road surface profiles, weather conditions, etc. Therefore, it is preferred that the parameters associated with the vehicle model can be identified in real time. From system identification viewpoint, the success of parameter identification depends on the model accuracy, persistent excitation, and signal-to-noise ratio (SNR) of the excitation signals [11]. Therefore, the vehicle parameter identification problem is closely related to the accompanied sensor fusion system that provides the measurements of the vehicle dynamics. In literatures, many vehicle parameter identification systems have been proposed to identify vehicle parameters such as vehicle masses, moments of inertia, road-tire frictions, etc. [9,12–14]. So far, we have not found a research report that identifies more than six vehicle parameters using their sensor systems.

As mentioned earlier, another key factor of the vehicle dynamics prediction is the sensor system for obtaining current vehicle state values. Since the vehicle system is highly nonlinear and many of its dynamics cannot be measured directly, the vehicle dynamics are often obtained by two ways: one is the observer-based sensor fusion system; the other is the kinematics-based sensor fusion system. The observer-based method needs a vehicle model and less number of sensors. On the contrary, the kinematics-based method does not require a vehicle model but needs more sensors. Since the state estimation accuracy of the observer-based method greatly relies on the incorporated model accuracy, the observer-based method is less preferred as compared with the kinematics-based method. Lots of kinematics-based sensor fusion systems employ a GPS and an IMU (three-axis accelerometer and three-axis gyroscope) to measure 6 degree-of-freedom (DOF) motions of an object. This sensor fusion system has been widely used in many applications, such as aircraft systems [15], ships [16], and road vehicles [17–19]. However, it has some drawbacks when applied to road vehicles. First, the rotation angles obtained by integrating the angular rates may suffer from the initial value ambiguity problem and the error accumulation problem. Second, both GPS and IMU are inertial sensors. Thus, the vehicle attitude and road angles are mingled together in the GPS and IMU measurements. Third, the measurement accuracy of the GPS is inadequate to determine the vehicle displacement in the vertical direction.

From pervious discussion, it can be concluded that a precise vehicle model is important for the accuracy of the dynamics prediction. How precise this vehicle model can be is determined by the accompanied sensor fusion system that provides current vehicle state values both for the state propagations and for the real time identification of vehicle parameters. In our previous work [20], we propose a kinematic based senor fusion system that employs a three-antenna global positioning system (GPS), an inertial measurement unit (IMU), and four suspension displacement sensors. This sensor fusion system can obtain the 6 DOF vehicle dynamics and two road angles. Based on this sensor system, we develop a vehicle dynamics prediction system in this paper using a vehicle model that is more complicated than most of the existing approaches. Moreover, the parameters of this vehicle model that may change in different driving conditions are identified in real time. In this paper, the dynamics prediction procedures, the parameter identification algorithms, the parameter observability, the SNR influence, and the prediction accuracy are all discussed in detail.

## 2. Euler Angles and Coordinate Systems

Three coordinate systems are introduced to describe a vehicle moving on a sloped road (see, Figure 1). These three coordinate systems are: global frame {g}, road frame {r}, and vehicle frame {v}. Similar to conventional research, the global frame is fixed to a point on Earth, while the vehicle frame is fixed to the center of gravity (CG) of the vehicle and rotates with the vehicle. The additional road frame is introduced to describe the vehicle dynamics on a sloped road, which is fixed to a road and rotated with the road terrain.

Three sets of Euler angles are used to describe the relationships between any two out of three coordinate systems. The first set of Euler angles (ψ_{g}, θ_{g}, ϕ_{g}), which are referred to in this paper as the “absolute yaw angle”, “absolute pitch angle” and “absolute roll angle”, are used to describe the absolute attitude of the vehicle (global frame vs. vehicle frame). The rotation order of this set of Euler angles is yaw-pitch-roll. Its direction cosine matrix
$({\mathbf{\text{C}}}_{\mathrm{g}}^{\mathrm{v}})$ can be written as follows:

The second set of Euler angles (θ_{r}, ϕ_{r}, ψ_{r}), which are referred to in this paper as the “road grade angle”, “road bank angle” and “road curve angle”, are used to describe the road grade profiles (global frame vs. road frame). The rotation order of this set of Euler angles is pitch-roll-yaw. Since a vehicle may move on a terrain irrelevant to the human-defined road path, it is impossible to determine the road curve angle from vehicle dynamics. Thus, it is assumed to be zero (ψ_{r} = 0) for simplicity. Its direction cosine matrix
$({\mathbf{\text{C}}}_{\mathrm{g}}^{\mathrm{r}})$ can be written as:

The third set of Euler angles (ψ_{v}, θ_{v}, ϕ_{v}), which are referred to in this paper as the “vehicle yaw angle”, “vehicle pitch angle” and “vehicle roll angle”, are used to describe the vehicle attitude relative to a road plane (road frame vs. vehicle frame). The rotation order of this set of Euler angles is yaw-pitch-roll. Its direction cosine matrix
$({\mathbf{\text{C}}}_{\mathrm{r}}^{\mathrm{v}})$ can be written as:

Since two sets of Euler angles are enough to describe the relationships between three coordinate systems, complying with the above angle definitions, the following relationship can be established for these angles:

An additional auxiliary frame (aux-frame) is obtained by rotating the z-axis of the road frame until the x-axis of the road frame is aligned with the x-axis of the body frame. The aux-frame is used because it describes vehicle translational motions in an intuitive manner while preserving the information of other vehicle dynamics relative to the road level. In the following vehicle modeling, vehicle translational motions are described in the aux-frame, and the rotational motions are described by angles ψ_{v}, θ_{v}, ϕ_{v}.

## 3. A Sensor Fusion System for Road Vehicles

Since lots of the vehicle dynamics cannot be directly measured by individual sensors, a sensor fusion system is constructed to obtain the vehicle dynamics on a sloped road. The proposed sensor fusion system consists of a group of sensors, a kinematic model related to those sensor outputs, and a state estimation algorithm. They are discussed in the following.

#### 3.1. Sensor Selections

#### 3.1.1. Three-Antenna GPS System

Different from a conventional GPS system, a three-antenna GPS is used here because it not only provides absolute position measurements $({x}_{g}^{\mathit{\text{gps}}},{y}_{g}^{\mathit{\text{gps}}},{z}_{g}^{\mathit{\text{gps}}})$but also absolute angle measurements $({\varphi}_{g}^{\mathit{\text{gps}}},{\theta}_{g}^{\mathit{\text{gps}}},{\psi}_{g}^{\mathit{\text{gps}}})$. Both information are relative to the global frame, and the reported angle measuring error is approximately 0.1° from a test vehicle [21,22].

#### 3.1.2. Suspension Displacement Sensors

Four suspension displacement sensors are installed at four corners of a vehicle. The suspension deflection can be related to the vehicle attitude and vertical displacement of the vehicle CG, both relative to the road frame:

_{r}is the vertical displacement of the vehicle CG observed in the road frame {r}; H

_{i}represents the displacement of suspension at the corner i; the subscript (i) refers to four suspension corners in a way: 1 → front-left, 2 to 4 in a clockwise direction; l

_{f}and l

_{r}are the distances from CG to the front and rear axis, respectively; t

_{f}and t

_{r}are one half of the distances of the front and rear track, respectively.

#### 3.1.3. Inertial Measurement Unit

An IMU sensor is installed at the center of gravity of the vehicle to measure the 6 DOF movements. They are used here to improve the estimation accuracy of the vehicle dynamics.

#### 3.2. A Kinematic Model

As discussed in this paper, three sets of Euler angles (nine angles in total) parameterize this vehicle attitude determination system. The relationships stated in Equation (4) provide three constrained equations; the 3-antenna GPS system provides the measurements of three absolute vehicle angles (ϕ_{g}, θ_{g}, ψ_{g}); the measurements from suspension displacement sensors provide the values of two vehicle attitude
$({\varphi}_{v}^{\mathit{\text{sus}}},{\theta}_{v}^{\mathit{\text{sus}}})$; the road curve angle is assumed to be zero (ψ_{r} = 0). Therefore, even without a kinematic model, those nine angles can be solved.

In addition to the angle measurements above, the vehicle rotational dynamics are also present in the IMU measurements, GPS position measurements, and suspension displacement measurements. In order to improve the robustness and accuracy of the angle determination, all the sensor measurements should be used. Thus, the estimation of vehicle dynamics is done for the rotational dynamics and translational dynamics simultaneously. In that case, since Equation (4) provide three constrained equations, six angles must be employed as system states to describe the vehicle attitude, and those six angle states are chosen as (ϕ_{g}, θ_{g}, ψ_{g}, ϕ_{r}, θ9_{r}, ψ_{v}) for the ease of subsequent fusion algorithm derivation. Furthermore, in order to apply existing state estimation techniques to this problem, the “governing equations” of these unknown angles must be obtained beforehand and added to the conventional kinematic model. Since it is impractical to either use additional sensors to measure the change rate of the last three angles or obtain this information for a specific case, the change rates of the last three angles are assumed to be zero.

Thus, a kinematic model that can coordinate the outputs of IMU, GPS and suspension displacement sensors is:

_{g}, y

_{g}, z

_{g}) and (ẋ

_{g}, ẏ

_{g}, ż

_{g}) represent position and velocity observed in the global frame; C

_{ω}describes the relation between angular rate and rate of change of Euler angles, which can be found in [23].

#### 3.3. State Estimation Algorithm

For a dynamics model shown in Equation (7), a state observer that can estimate each state value is constructed as follows:

**L**is the matrix of observer gains. In this paper, the extended Kalman filter is chosen as the state estimation algorithm to calculate the observer gain. The standard procedures of the extended Kalman filter can be found in [11].

The system output equation h(x) in Equation (8) is carefully chosen as follows to ensure the system observability.

_{r}, θ

_{r}, ψ

_{v}) and its values are calculated from the measurements of a three-antenna GPS. The output equation ${\mathrm{y}}_{1}^{\mathit{\text{sus}}}$ is a function of (ϕ

_{r}, θ

_{r}) and its values are calculated from the measurements of the suspension displacement sensors. The output equation ${\mathrm{y}}_{2}^{\mathit{\text{sus}}}$ is related to a function of (ϕ

_{r}, θ

_{r}) and (x

_{g}, y

_{g}, z

_{g}) and its values are then calculated from the measurements of the suspension displacement sensors in Equation (5) and three-antenna GPS.

It should be emphasized that the $({\mathrm{y}}_{2}^{\mathit{\text{gps}}},{\mathrm{y}}_{1}^{\mathit{\text{sus}}})$ are two sets of output equations, and each consists of 2 to 3 nonlinear algebraic equations. Each equation consists of multiplication terms of two or more trigonometric functions from the corresponding direction cosine matrix. In most cases, only one equation in each set of output equations is enough to ensure the observability of state estimations. However, since it involves multiplications of trigonometric functions, the estimation would fail at certain angles. Therefore, redundant equations are used to ensure the success at all angles.

#### 3.4. Multi-Rate Kalman Filter

Since the outputs of the GPS, IMU and suspension displacement sensors are unsynchronized and contaminated by different noise characteristics (see Table 1), instead of using a conventional extended Kalman filter, a multi-rate extended Kalman filter [24] is chosen to coordinate these sensor outputs. The algorithm of a multi-rate Kalman filter is similar to that of a conventional extended Kalman filter with the only difference in correcting the estimated state values. When the GPS measurement is available, the estimated state value is updated by the measurements of the GPS and the suspension displacement sensors. When the GPS measurement is unavailable, the estimated state value is updated only by the measurements of the suspension displacement sensors. It is done by the following:

**when GPS measurements are available,**

**when GPS measurements are unavailable,**

#### 3.5. Alpha-Beta Filter

The above state estimation process can provide noiseless information for the displacement, velocity, and attitude of the vehicle, but not for the angular velocity and accelerations. Without this information, the subsequent vehicle parameter identification can be much complicated. Potentially, the angular velocity and accelerations can also be obtained from Kalman filtering by including those two states as system states in Equation (7). However, this approach may need a fictitious noise and increase the computation complexity. Hence, the alpha-beta filter is used to obtain the values for the angular velocity and acceleration.

The alpha-beta filter is a steady-state filter for noisy signals. Its algorithm is shown as follows:

_{α}is a set of state vector for a two-dimensional model; z is the measured first dimensional state; z is the estimated value of z;

**A**

_{α}is the system matrix of the two-dimensional model; T

_{s}is the sampling period; the feedback gains α and β are chosen empirically. The detailed information of alpha-beta filters can be found in [11]. For example, x̂

_{α}can be chosen as [ω

_{x}, ω̇

_{x}]

^{T}; the corresponding z is the measured rotational velocity from the gyroscope $({\omega}_{x}^{\mathit{\text{gyro}}})$. Thus, through the alpha-beta filter, the rotational acceleration can be obtained without the direct differentiation.

## 4. A Vehicle Model for the Dynamics Predictions

As mentioned earlier, a dynamics prediction system needs a precise vehicle model. Furthermore, some of the parameters in that vehicle model should be identified in real time. To meet both requirements, we propose the following vehicle model for the dynamics prediction, which consists of 6 DOF vehicle dynamics, road angles, tire-road friction, nonlinear suspension, etc.

where g is the Earth gravity; (x_{a}, y_{a}, z_{a}) represents the three-axis displacement of the vehicle CG observed in the aux-frame; (F_{x,tire}, F_{y,tire}, F_{z,spring}) are the translational forces generated by tires and suspension systems; (M_{x}, M_{y}, M_{z}) are the external torques acting on the vehicle CG along three axes of the vehicle frame, which are the functions of forces (F_{x,tire}, F_{y,tire}, F_{z,spring}), vehicle attitude (ψ_{v}, θ_{v}, ϕ_{v}), and vehicle geometry [25]; (I_{x}, I_{y}, I_{z}) are the moment of inertia of the vehicle body along three axes of the vehicle frame; (ω_{x}, ω_{y}, ω_{z}) are the rotational velocities of the vehicle body along three axes of the vehicle frame; ω_{i} represents the angular rate of each tire i; F_{a,tire},_{i} is the longitudinal adhesive force generated by tire i; T_{i} are the wheel torque transmitted to the tire i; r_{i} is the effective rolling radius of a tire i; I_{ω} is the moment of inertia of a tire.

The suspension system is modeled as a nonlinear spring-mass-damper system. Thus, the translational force generated by the suspension can be described as follows [7]:

_{s,i}is the spring stiffness of the suspension i and C

_{1}, C

_{2}, C

_{3}parameterize the stiffness; D

_{s,i}is the damper coefficient of the suspension i; m

_{u,i}is the unsprung mass of the suspension corner i.

The adhesive force generated by tire is a highly nonlinear function of variables including slip ratios, slip angles, vertical loads, etc. [26,27]. However, under normal vehicle maneuvering, the adhesive force is almost linearly proportional to those variables. Thus, a linear tire model [13,14] is used to describe the longitudinal and lateral tire forces (F_{a,tire}, F_{b,tire}) for simplicity.

_{λ,i}and C

_{α,i}are the tracking stiffness and the cornering stiffness of the tire i, respectively; λ

_{i}and α

_{i}are the slip ratio and slip angle, respectively. The translational forces represented in the x-axis and the y-axis of the aux-frame (F

_{x,tire}, F

_{y,tire}) can be obtained as follows:

Noted that two rear wheel angles (δ_{3}, δ_{4}) are zeros for a front-steer vehicle, and two front wheel angles (δ_{1}, δ_{2}) are known values because they can be obtained by the steering wheel angle and the Ackerman principle [28]. The vehicle model for the dynamics prediction is thus constructed and shown in Equations (13)–(16).

## 5. Vehicle Parameter Identification Systems

In this approach, the parameters shown in the vehicle model in Equations (13)–(16) needs to be identified using the vehicle dynamics obtained from the sensor fusion system in Equation (7). Note that the vehicle dynamics from the sensor fusion system is presented in the global frame, while the above vehicle model is presented in the aux-frame. Thus, the estimated vehicle dynamics are transformed into the aux-frame using the matrices shown in Equations (1)–(3), prior to the vehicle parameter identification.

After feeding the vehicle dynamics, Equation (13) becomes a set of 10 linear equations with 12 unknown vehicle parameters. Hence, the number of the cornering stiffness is reduced from four to two because the cornering stiffness is similar at two sides of the vehicle [13,14]. In that case, the model of the lateral tire force is simplified as follows:

#### 5.1. Recursive Least-Square Algorithms

In order to apply the recursive-least-square (RLS) algorithm to identify vehicle parameters, the vehicle parameters and the corresponding measured dynamics are rearranged into the following format:

**A**

_{rls}and

**b**are the vehicle dynamics both from direct sensor measurements and the output of the sensor fusion system;

**Q**is the weighting matrix;

**W**is the scaling matrix. By choosing matrices

**Q**,

**W**, and an initial guess of the vector x̄, the vector x̄ is solved recursively by the following steps [29]:

**P̄**is the covariance matrix.

#### 5.2. Vehicle Parameter Identifications

The following vehicle parameters are identified using the above RLS algorithms: vehicle mass (m_{tot}), moment of inertia of the vehicle body (I_{x}, I_{y}, I_{z}), tracking stiffness (C_{λ,1∼4}), and the cornering stiffness (C_{α,f}, C_{α,r}). These parameters are identified in real time because their values can be changing in each driving condition. The other vehicle parameters such as the spring stiffness K_{s}, the damper coefficient D_{s}, the unsprung mass m_{u}, the rolling radius of tire r, and the moment of inertia of the tire I_{ω} are assumed to be known values.

In this case, it is possible to manipulate the signal processing steps and formulate four independent RLS problems for identifying the above ten parameters, which can greatly reduce the computation loads and efforts of searching the optimal **Q** and **W** matrices. Those four independent RLS problems are “mass identification”, “tracking stiffness identification”, “cornering stiffness identification”, and “moment of inertia identification”.

#### 5.2.1. Mass Identification

The translational dynamics in z direction in the vehicle model in Equations (13) and (14) can be rearranged as:

_{11}and w

_{11}are the elements in weighting and scaling matrices, respectively. ${\dot{H}}_{i}^{\mathit{\text{sus}}}$ is the derivative of the suspension displacement and is obtained by the alpha-beta filter via the input from the suspension displacement measurements.

#### 5.2.2. Tracking Stiffness Identification

The wheel dynamics in the vehicle model in Equations (13) and (15)–(16) can be rearranged as:

Noted that the matrix **A**_{rls,2} is singular when one of the slip ratios is zero. It can be understood that the tracking stiffness cannot be identified when there is no traction force. Moreover, the angular rates of four tires are directly measured by tachometers (see Table 1) and conditioned by the alpha-beta filter. The slip ratios are calculated using the measurements from the sensor fusion system and the tachometers. The applying wheel torque is assumed to be obtained from torque sensors.

#### 5.2.3. Cornering Stiffness Identification

The longitudinal and lateral dynamics in the vehicle model Equations (13) and (15)–(17) can be rearranged as:

Noted that the matrix **A**_{rls,3} is singular when the summation of the front (or rear) two slip angles is zero or the summation of the front steering wheel angles is zero. Again, it can be understood that the cornering stiffness cannot be identified when there is no lateral force. Moreover, the slip angles are calculated using the measurements from the sensor fusion system and the steering wheel angle.

#### 5.2.4. Moment of Inertia Identification

The rotational dynamics in the vehicle model in Equation (13) can be rearranged as:

## 6. Vehicle Dynamics Prediction

From a system observability viewpoint [30], if both the governing equations of a dynamic system and state values at a time instant are given, the state values at any time instant can be calculated accordingly. Stemming from this concept, one can predict the vehicle dynamics using a vehicle model and current state values. In this case, the current vehicle dynamics is obtained from the sensor fusion system shown in Equations (7)–(9); the vehicle model for propagating the current vehicle states is shown in Equations (13)–(16); the parameters in that vehicle model is estimated using four RLS algorithms in Equations (20)–(23). The block diagram of this signal processing is shown in Figure 2.

## 7. Simulation Results

Numerical simulations are used to demonstrate the feasibility of the proposed dynamics prediction method. In these simulations, a vehicle moves at a longitudinal speed of 90 km/h. The steering wheel angles and the generated tire torques are both varying with time at the frequency of 1 Hz (see, Figure 3). The road bank angle is 2° and the road grade angle is −2°. A full-state vehicle model, which is a nonlinear 6 DOF vehicle model and consists of 20 states and road angles [7], is used to mimic the real vehicle dynamics on this slope road. This full-state vehicle model differs from the vehicle model shown in Equation (13) only in the tire model, wherein the nonlinear tire model “magic formula” [26] is used. The selected sensors and their output characteristics are listed in Table 1. The sampling frequency of the simulations is 100 Hz. No other disturbance is applied to the vehicle system unless otherwise specified.

#### 7.1. Vehicle Dynamics Estimations

The simulation results of the proposed sensor fusion system are shown in Figure 4, where the state values from the full-state vehicle model are drawn in dashed-blue line, the sensor outputs are drawn in dashed-dotted-green line, and the state values from the output of the sensor fusion system are drawn in solid-red line. Simulation results indicate that the proposed sensor fusion system can accurately obtain the 6 DOF vehicle dynamics and two road angles. The estimation error of each vehicle state, which is defined as the standard deviation of the difference between the simulated vehicle dynamics and the sensor fusion outputs, is also shown in Figure 4.

#### 7.2. Vehicle Parameter Identifications

The vehicle dynamics and sensor fusion outputs presented in the global frame (show in Figure 4) are converted into the aux-frame and shown in Figure 5. These state values, along with direct sensor measurements conditioned by the alpha-beta filter, are used for the vehicle parameter identification. The identification results are shown in Figures 6 and 7, where the identified vehicle parameters are drawn in the solid-red line, and the real vehicle parameters are drawn in the dashed-blue line. The “relative inaccuracy” of estimation, which is defined as (real value — identified value)/(real value) [31], of the mass and moment of inertial are calculated to be (m̅_{tot}, I̅_{x}, I̅_{y}, I̅_{z}) = (5.17 × 10^{−3}%, 0.12%, 5.05%, 4.37%). The estimation accuracy is good mainly because the incorporated suspension displacement sensors are relatively accurate. On the other hand, as shown in Figure 7, the estimation of tracking stiffness and cornering stiffness do not converge well and because there is no corresponding tracking stiffness and cornering stiffness in the full-state vehicle model. The feasibility of the tire stiffness estimation is discussed in the next section.

#### 7.3. Vehicle Dynamic Predictions

Continuing from previous simulations, the driver is assumed to hold still the steering wheel and the gas/brake pedal at the time instant 10.25 s to do a left-hand turn on the road. The prediction system is turned on at the 10.25 s to predict the vehicle dynamics for the next 4.75 s, using the vehicle dynamics from the sensor fusion system at the 10.25 s and the vehicle model with the parameters identified from Figures 6 and 7. Since the steering wheel and the gas/brake pedal are the same during 10.25 to 15 s, both the vehicle dynamics and the prediction results during this period can be shown in the same plot for comparison. In Figure 8, the real vehicle dynamics are drawn in the dashed-blue line, and the predicted vehicle dynamics are drawn in the solid-green line. According to the simulation results, the proposed method can predict the vehicle dynamics accurately. The prediction error of each state can be found in the plot. The relative-inaccuracy of this prediction, averaged from vehicle displacements (x_{a}, y_{a}, z_{a}) and vehicle attitude (ψ_{v}, θ_{v}, ϕ_{v}), is 0.51%.

In another example, the driver holds the steering wheel still but generate 1,000 N · m torques on two tires on the right hand side (T_{2} = T_{3} = 1,000 N · m). In that case, the vehicle is likely to rollover due to the excess yaw moment applying to the vehicle. The simulation results (see Figure 9) show that the vehicle roll angle is larger than 90° at the 11.5 s, which indicates a rollover incident. The dynamic prediction system can predict the rollover event. The relative-inaccuracy of this prediction is 27.3%, which is calculated from 10.25 s to 11.5 s and averaged from vehicle states including vehicle displacements (x_{a}, y_{a}, z_{a}) and vehicle attitude (ψ_{v}, θ_{v}, ϕ_{v}). The prediction accuracy is worse than that of the previous case. The reason is discussed in the following section.

## 8. Discussion

Although the vehicle rollover accident can be foreseen in this case, the prediction is a bit inaccurate. According to the parameter identification results shown in Figures 6 and 7, this error is likely due to the model difference used in the prediction process and in the simulated vehicle dynamics. In turns, it leads to two possibilities: (1) the vehicle dynamics estimated from the sensor fusion system are not accurate enough for the traction/cornering stiffness identification; (2) the adhesive tire forces in the rollover event are located in the nonlinear regime and the linear tire model is inadequate to describe them. To clarify this, Figure 10 presents the relation between longitudinal tire force and slip ratio, and Figure 11 presents the relation between lateral tire force and slip angle. As shown in Figure 10, the longitudinal tire force estimated from the sensor fusion system (drawn in blue dots) and from the simulated vehicle dynamics (drawn in green stars) are not the same. Thus, the sensor noise associated with the selected sensors does affect the estimation of longitudinal dynamics to certain extent. In turns, the identified traction stiffness (drawn in solid-black line) cannot be accurate. On the other hand, as shown in Figure 11, the lateral tire force estimated from the sensor fusion system are close to the simulated vehicle dynamics. Thus, the identified cornering stiffness is more accurate than the identified traction stiffness.

The tire forces of two prediction cases are also shown in Figures 10 and 11. The tire forces are drawn in red circles for the left-turn event and in cyan squares for the rollover event. The tire forces of the left-hand turn event are very close to the forces calculated from the identified traction/cornering stiffness, except for the force at the rear-left tire. Thus, the prediction of the left-hand turn dynamics is quite accurate. On the other hand, the tire forces of the rollover event are far from the forces calculated from the identified traction/cornering stiffness. Thus, the prediction of the rollover dynamics is a bit inaccurate.

From above discussion, one may propose using nonlinear tire models, such as Pacejka's magic formula [26] or Dugoff tire model [27], for the friction coefficient identifications and dynamics predictions. Our experiences show that it is possible to identify more parameters of a nonlinear tire model as long as the nonlinear tire adhesive forces are present in the measured vehicle dynamics (persistent excitation condition). However, the tire adhesive forces are within in the linear regime in most driving conditions. In that case, including a nonlinear tire model in the identification process would not gain any advantage but cause convergence problems.

This vehicle parameter identification is challenging mainly because the system has a low degree-of-observability [32,33], and it gets worse when large amount of noise is present in the sensor measurements. This effect can be investigated by the signal-to-noise ratio (SNR), where the signal is referred to as the estimated vehicle dynamics from the sensor fusion system, while the noise is referred to as the estimation error. To show how the SNR affects this parameter identification, we use the identification of the moment of inertia as an example. As shown in Table 2, the estimation error can be minimized when the SNR is large, and the relative error approaches (1.94%, 2.68%, 0.33%) for (I̅_{x}, I̅_{y}, I̅_{z}). The best estimation accuracy is limited by the numerical errors and the model errors from the linear tire model assumption. To enlarge the SNR, either the range of vehicle dynamics needs to be enlarged or the noise from the sensor measurement needs to be minimized. The vehicle dynamics cannot have a large span due to its strong stability. On the other hand, using high-end sensors would reduce the noise but incur higher cost.

One alternative to improve this parameter identification is to increase the degree-of-observability by choosing proper weighting and scaling matrices shown in Equation (19). To show the effectiveness of this approach, we use the identification of the moment of inertia as an example and assume no noise in the sensor measurement. The choice of weighting matrix (**Q**_{4}) changes the minimum eigenvalue of the estimation matrix
$({\mathbf{\text{A}}}_{\mathit{\text{rls}},4}^{\mathbf{\text{T}}}{\mathbf{\text{Q}}}_{4}^{\mathbf{\text{T}}}{\mathbf{\text{Q}}}_{4}{\mathbf{\text{A}}}_{\mathit{\text{rls}},4})$ and results in different degree-of-observability [32,33]. Table 3 shows the larger minimum eigenvalues of the resulting matrix, the better parameter observability and the faster convergence rate of the parameter identification.

## 9. Conclusions

A vehicle dynamics prediction system, consisting of a kinematics-based sensor fusion system and a vehicle parameter identification system, is proposed and verified by simulation results. The sensor fusion system can obtain the 6 DOF vehicle dynamics and the two road angles accurately. The estimation error for each vehicle dynamics is shown in Figure 4. The vehicle parameter identification system uses the dynamics information from the sensor fusion system to identify ten vehicle parameters in real time. The identification inaccuracy of the vehicle mass and moment of inertia is less than 5.05%. Using the vehicle dynamics from the sensor fusion system and the vehicle model from the parameter identification system, the prediction system successful predicts the vehicle dynamics in a left-hand turn event and a rollover event. The prediction inaccuracy is 0.51% in the left-hand turn event and 27.3% in the rollover event.

The prediction accuracy of the rollover event is worse than that of the left-hand turn event. It is mainly because the identified linear tire model cannot accurately describe the nonlinear tire adhesive force in the rollover event. Using a nonlinear tire model for the dynamics prediction is possible but not practical in this case, because the nonlinear tire behaviors are not excited in normal vehicle maneuvers.

The prediction accuracy of two scenarios suggests that modeling error of the unsprung mass system may greatly affect the accuracy of the parameter identification and thus the dynamics predictions. Therefore, a detail modeling and/or real-time system identification of the unsprung mass system may be needed to improve the feasibility of this approach. Besides, this research also shows that the vehicle parameter identification is challenging because the system has a low degree-of-observability. Therefore, increasing the SNR of the sensor systems and careful designs of the weighting matrix of the identification algorithm are recommended.

## References

- Feng, K.T.; Tan, H.S.; Tomizuka, M. Future Predictor for Vehicle Steering Guidance-Sensitivity Analysis and Experimental Results. Proceedings of the 38th IEEE Conference on Decision and Control, Phoenix, AZ, USA, 7– 10 December 1999; pp. 3722–3727.
- Lin, C.F.; Ulsoy, A.G.; LeBlanc, D.J. Vehicle dynamics and external disturbance estimation for vehicle path prediction. IEEE Trans. Contr. Syst. Technol.
**2000**, 8, 508–518. [Google Scholar] - Gaspar, P.; Szabo, Z.; Bokor, J. Prediction Based Combined Control to Prevent the Rollover of Heavy Vehicles. Proceedings of the 13th Mediterranean Conference on Control and Automation, Limassol, Cyprus, 27–29 June 2005; pp. 575–580.
- Ghandour, R.; Cunha, F.R.; Victorino, A.; Charara, A.; Lechner, D. A Method of Vehicle Dynamics Prediction to Anticipate the Risk of Future Accidents: Experimental Validation. Proceedings of the 14th IEEE Conference on Intelligent Transportation Systems, Washington, DC, USA, 5– 7 October 2011; pp. 1692–1697.
- Scanchez, E.N.; Ricalde, L.J.; Langari, R.; Shahmirzadi, D. Rollover Prediction and Control in Heavy Vehicles via Recurrent Neural Networks. Proceedings of the 43rd IEEE Conference on Decision and Control, Bahamas, Paradise Island, Atlantis, 14– 17 December 2004; pp. 5210–5215.
- Travis, W.E.; Whitehead, R.J.; Bevly, D.M.; Flowers, G. T. Using Scaled Vehicles to Investigate the Influence of Various Properties on Rollover Propensity. Proceedings of the American Control Conference, Boston, CA, USA, 30 June–2 July 2004; pp. 3381–3386.
- Hsu, L.Y.; Chen, T.L. Vehicle full-state estimation and prediction system using state observers. IEEE Trans. Veh. Technol.
**2009**, 58, 2651–2662. [Google Scholar] - Ryu, J.; Gerdes, J.C. Estimation of Vehicle Roll and Road Bank Angle. Proceedings of the American Control Conference, Boston, CA, USA, 30 June–2 July 2004; pp. 2110–2115.
- Hahn, J.O.; Rajamani, R.; Alexander, L. GPS-based teal-time identification of tire-toad friction coefficient. IEEE Trans. Contr. Syst. Technol.
**2002**, 10, 331–343. [Google Scholar] - Tseng, H.E. Dynamic estimation of road bank angle. Veh. Syst. Dyn.
**2001**, 36, 307–328. [Google Scholar] - Bar-Shalom, Y.; Li, X.R.; Kirubarajan, T. Estimation with Applications to Tracking and Navigation; Wiley-Interscience: Hoboken, NJ, USA, 2001. [Google Scholar]
- Pence, B.L.; Fathy, H.K.; Stein, J.L. Sprung Mass Estimation for Off-Road Vehicles via Base-Excitation Suspension Dynamics and Recursvie Least Squares. Proceedings of the American Control Conference, St. Louis, MO, USA, 10–12 June 2009; pp. 5043–5048.
- Wesemeier, D.; Isermann, R. Identification of vehicle parameters using stationary driving maneuvers. Contr. Eng. Pract.
**2009**, 17, 1426–1431. [Google Scholar] - Baffet, G.; Charara, A.; Dherbomez, G. An observer of tire-road gorces and griction for active security vehicle systems. IEEE/ASME Trans. Mech.
**2007**, 12, 651–661. [Google Scholar] - Bijker, J.; Steyn, W. Kalman filter configurations for a low-cost loosely integrated inertial navigation system on an airship. Contr. Eng. Pract.
**2008**, 16, 1509–1518. [Google Scholar] - Moore, T.; Hill, C.; Norris, A.; Hide, C.; Park, D.; Ward, N. The potential impact of GNSS/INS integration on maritime navigation. J. Navig.
**2008**, 61, 221–237. [Google Scholar] - Zhou, J.; Bolandhemmat, H. Integrated INS/GPS System for an Autonomous Mobile Vehicle. Proceedings of the International Conference on Mechatronics and Automation, Harbin, China, 5–8 August 2007; pp. 694–699.
- Yang, Q.; Sun, J. A Location Method for Autonomous Vehicle Based on Integrated GPS/INS. Proceedings of the IEEE Vehicular Electronics and Safety, Beijing, China, 13– 15 December 2007; pp. 1–4.
- Ryu, J.; Gerdes, J.C. Integrating inertial sensors with GPS for vehicle dynamics control. ASME J. Dyn. Syst. Meas. Contr.
**2004**, 126, 243–254. [Google Scholar] - Hsu, L.Y.; Chen, T.L. Applying a Three-Antenna GPS and Suspension Displacement Sensors to a Road Vehicle. Proceedings of the IEEE Sensors Conference, Chirstchurch, New Zealand, 25– 28 October 2009; pp. 1593–1597.
- Wang, B.; Zhai, C.; Zhan, X. GPS-Based Attitude Determination RAIM Method Study and Optimize. Proceedings of the IEEE Internaltional Conference on Mechatronics and Automation, Changchun, China, 9– 12 August 2009; pp. 4561–4565.
- Lachapelle, G.L.; Cannon, M.E.; Vogel, B. Performance Analysis of a Shipborne Gyrocompass with a Multi-Antenna GPS System. Proceedings of the IEEE Position Location and Navigation Symposium, Las Vegas, NV, USA, April 1994; pp. 337–343.
- Synge, J.L.; Griffith, B.A. Principles of Mechanics; Mc-Graw Hill: New York, NY, USA, 1942; p. 424. [Google Scholar]
- Andrew, S.; Wu, M. Multi-rate kalman filtering for the data fusion of displacement and acceleration response measurements in dynamic system monitoring. Mech. Syst. Signal Proc.
**2007**, 21, 706–723. [Google Scholar] - Hingwe, P. Robustness and Performance Issues in the Lateral Control of Vehicle in Automated Highway System. Ph.D. Thesis, Department of Mechanical Engineering, University of California, Berkeley, CA, USA, 1997; pp. 23–26. [Google Scholar]
- Pacejka, H.B.; Bakker, E. The Magic Formula Tyre Model. Veh. Syst. Dyn. Suppl.
**1993**, 21, 1–18. [Google Scholar] - Dugoff, H.; Fancher, P.S.; Segel, L. An Anlysis of Tire Traction Properties and their Influence on Vehicle Dynamic Performance; SAE Technical Paper, University of Michigan: Michigan, MI, USA, 1970. [Google Scholar]
- Norris, W. Modern Steam Road Wagons; Longmans: London, UK, 1906; pp. 63–67. [Google Scholar]
- Chong, E.P.; Zak, S.H. An Introduction to Optimization; Wiley-Interscience: New York, NY, USA, 2001. [Google Scholar]
- Chen, C.T. Linear System Theory and Design; Holt, Rinehart and Winston: New York, NY, USA, 1984. [Google Scholar]
- Pallas-Areny, R.; Webster, J.G. Sensors and Signal Conditioning, 2nd ed.; John Wiley and Sons: New York, NY, USA, 2001; p. 13. [Google Scholar]
- Singh, A.K.; Hahn, J. Determining optimal sensor loactions for state and parameter estimation for stable nonlinear systems. Ind. Eng. Chem. Res.
**2005**, 44, 5645–5659. [Google Scholar] - Nahvi, A.; Hollerbach, J.M.; Hayward, V. Calibration of a Parallel Robot Using Multiple Kinematic Closed Loops. Proceedings of the IEEE International Conference on Robotics and Automation, San Diego, CA, USA, 8– 13 May 1994; pp. 407–412.

**Figure 1.**A schematic plot a vehicle and four coordinate systems (global frame, road frame, vehicle frame and auxiliary frame).

**Figure 3.**The driving maneuvers for the illustrative simulation. The upper plot is the steering wheel angle and the lower plot is the wheel torques applying on four tires. The frequency is 1 Hz.

**Figure 4.**Comparisons of the vehicle dynamics from the simulated vehicle dynamics, the sensor outputs, and the sensor fusion system outputs. The vehicle dynamics are presented in the global frame. The error standard deviations are calculated from the 5th second to the 10th second.

**Figure 5.**Comparisons of the vehicle dynamics from the simulated vehicle dynamics and the sensor fusion system outputs. The vehicle dynamics are presented in the aux-frame.

**Figure 6.**The identification of the vehicle mass and moment of inertia. The mean values are calculated from the 15th second to the 10th second.

**Figure 7.**The identification of the tire tracking stiffness and cornering stiffness. The mean values are calculated from the 15th second to the 10th second.

**Figure 8.**Predictions of the vehicle dynamics in a left-hand turn event. The prediction inaccuracy is 0.51% on average, calculated from the 10.25th second to the 15th second.

**Figure 9.**Predictions of the vehicle dynamics in a rollover event. The prediction system successfully predicts the rollover incident. The prediction inaccuracy is 27.3% on average, calculated from the 10.25th second to the 11.5th second.

Output frequency | Noise | |
---|---|---|

Standard deviation | ||

GPS | 5 Hz | 0.4° |

(attitude measurement) | ||

GPS | 5 Hz | horizontal: 1 m |

(position measurement) | vertical: 3 m | |

Suspension | 1 Hz | 0.001 m |

displacement sensor | ||

Accelerometer | 1 kHz | 0.02 m/s^{2} |

Gyroscope | 1 kHz | 0.08°/s |

Tachometer | 1 kHz | 2°/s |

The measurement bias is not considered.

**Table 2.**The relations between the estimation error of sensor fusion system and the relative inaccuracy of the parameter identification.

relative inaccuracy | I̅_{x} | I̅_{y} | I̅_{z} | |
---|---|---|---|---|

infinite | 1.94% | 2.68% | 0.33% | |

SNR | 30 dB | 2.50% | 14.62% | 1.52% |

20 dB | 14.91% | 60.28% | 10.41% | |

10 dB | 69.05% | 93.63% | 54.11% |

convergence rate a | I̅_{x} | I̅_{y} | I̅_{z} | |
---|---|---|---|---|

diag{0.625, 0.625, 0.625} | 0.08 s | 1.63 s | 0.24 s | |

Q_{4}b | diag{0.125, 0.125, 0.125} | 6.19 s | 18.2 s | 3.32 s |

diag{0.025, 0.025, 0.025} | 36 s | Nan c | 25 s | |

diag{0.005, 0.005, 0.005} | Nan c | Nan c | Nan c |

^{a}The convergent rate is defined at the time when estimated value reaches 90% of the real value.^{b}**Q**_{4} and **W**_{4} are both designed as a diagonal matrix. **Q**_{4} varies in each case, while **W**_{4} is kept the same as diag{1, 1, 1}.^{c}The value “Nan” means that the convergence time is too long to calculate.

© 2012 by the authors; licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution license (http://creativecommons.org/licenses/by/3.0/).