Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via...

12
Vehicle sideslip angle estimation for a heavy-duty vehicle via Extended Kalman Filter using a Rational tyre model DI BIASE, Feliciano, LENZO, Basilio <http://orcid.org/0000-0002-8520-7953> and TIMPONE, Francesco Available from Sheffield Hallam University Research Archive (SHURA) at: http://shura.shu.ac.uk/26862/ This document is the author deposited version. You are advised to consult the publisher's version if you wish to cite from it. Published version DI BIASE, Feliciano, LENZO, Basilio and TIMPONE, Francesco (2020). Vehicle sideslip angle estimation for a heavy-duty vehicle via Extended Kalman Filter using a Rational tyre model. IEEE Access, p. 1. Copyright and re-use policy See http://shura.shu.ac.uk/information.html Sheffield Hallam University Research Archive http://shura.shu.ac.uk

Transcript of Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via...

Page 1: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

Vehicle sideslip angle estimation for a heavy-duty vehicle via Extended Kalman Filter using a Rational tyre model

DI BIASE, Feliciano, LENZO, Basilio <http://orcid.org/0000-0002-8520-7953> and TIMPONE, Francesco

Available from Sheffield Hallam University Research Archive (SHURA) at:

http://shura.shu.ac.uk/26862/

This document is the author deposited version. You are advised to consult the publisher's version if you wish to cite from it.

Published version

DI BIASE, Feliciano, LENZO, Basilio and TIMPONE, Francesco (2020). Vehicle sideslip angle estimation for a heavy-duty vehicle via Extended Kalman Filter using a Rational tyre model. IEEE Access, p. 1.

Copyright and re-use policy

See http://shura.shu.ac.uk/information.html

Sheffield Hallam University Research Archivehttp://shura.shu.ac.uk

Page 2: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

Received June 29, 2020, accepted July 27, 2020, date of publication July 29, 2020, date of current version August 14, 2020.

Digital Object Identifier 10.1109/ACCESS.2020.3012770

Vehicle Sideslip Angle Estimation for aHeavy-Duty Vehicle via Extended KalmanFilter Using a Rational Tyre ModelFELICIANO DI BIASE1,2, BASILIO LENZO 1, (Member, IEEE), AND FRANCESCO TIMPONE21Department of Engineering and Mathematics, Sheffield Hallam University, Sheffield S1 1WB, U.K.2Department of Industrial Engineering, University of Naples Federico II, 80125 Napoli, Italy

Corresponding author: Basilio Lenzo ([email protected])

ABSTRACT Vehicle sideslip angle is a key state for lateral vehicle dynamics, but measuring it is expensiveand unpractical. Still, knowledge of this state would be really valuable for vehicle control systems aimed atenhancing vehicle safety, to help to reduce worldwide fatal car accidents. This has motivated the researchcommunity to investigate techniques to estimate vehicle sideslip angle, which is still a challenging problem.One of the major issues is the need for accurate tyre model parameters, which are difficult to characteriseand subject to change during vehicle operation. This paper proposes a new method for estimating vehiclesideslip angle using an Extended Kalman Filter. The main novelties are: i) the tyre behaviour is describedusing a Rational tyre model whose parameters are estimated and updated online to account for their variationdue to e.g. tyre wear and environmental conditions affecting the tyre behaviour; ii) the proposed techniqueis compared with two other methods available in the literature by means of experimental tests on a heavy-duty vehicle. Results show that: i) the proposed method effectively estimates vehicle sideslip angle with anerror limited to 0.5 deg in standard driving conditions, and less than 1 deg for a high-speed run; ii) the tyreparameters are successfully updated online, contributing to outclassing estimation methods based on tyremodels that are either excessively simple or with non-varying parameters.

INDEX TERMS Kalman filter, sideslip angle, state estimation, rational tyre model, vehicle dynamics.

LIST OF SYMBOLSSymbol Unit QuantityA various Dynamic matrixai m Vehicle semi-wheelbaseay m/s2 Lateral accelerationB various Matrix used to work out QBc various Matrix used to work out BCF N/rad Front cornering stiffnessCR N/rad Rear cornering stiffnessck various Control input vectorc1i rad2 Rational tyre model parameterc2i N/rad Rational tyre model parameterFyi N Lateral forceFzi N Vertical loadFzi,0 N Nominal vertical loadf - Function defining the dynamics of

the analysed system

The associate editor coordinating the review of this manuscript and

approving it for publication was Halil Ersin Soken .

H various Matrix relating z to xh - Function defining the measurements as a

function of the stateJ kg m2 Vehicle moment of inertia about a

vertical axisK - Kalman gaink - Time stepl m Vehicle wheelbaseM kg Vehicle massP various State covarianceP− various Predicted state covarianceQ various Process covariance matrixR various Measurement covariance matrixr rad/s Yaw rater rad/s2 Yaw accelerationti m Vehicle track widthu m/s Longitudinal vehicle speeduij m/s Corrected wheel speedum,ij m/s Measured wheel speedV m/s Vehicle speed (centre of mass)

142120 This work is licensed under a Creative Commons Attribution 4.0 License. For more information, see https://creativecommons.org/licenses/by/4.0/ VOLUME 8, 2020

Page 3: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

Vi m/s Vehicle speed at axle iv various Measurement noisew various Process noisex various State vectorx− various Predicted state vectorx various Estimated state vectorz various Measurement vectorαi rad Slip angleβ rad Vehicle sideslip angleβ rad/s Sideslip angle rate1t s Discretisation timeδ rad Front wheel steering angle3 various Matrix used to work out Qµ - Friction coefficientσciF various Square root of the covariance of ciFσciR various Square root of the covariance of ciRσCF rad Square root of the covariance of CFσCR rad Square root of the covariance of CRσay m/s2 Square root of the covariance of the

accelerometerσr rad/s Square root of the covariance of the

gyroscopeσδ rad Square root of the covariance of the

steering angle sensorSubscripts : i = F(Front),R(Rear); j = L(Left),R(Right)

I. INTRODUCTIONThe potential of many vehicle control systems, such as theESC (Electronic Stability Control), could be significantlyenhanced with the availability of the vehicle sideslip angle.Unfortunately such parameter can only be measured withexpensive optical sensors. That has motivated researchers toinvestigate techniques to estimate vehicle sideslip angle.

Common techniques include model-based approaches andneural networks [1]. The former are generally preferredbecause they are explicitly linked to the physics of the studiedphenomenon, e.g. through equations describing the vehicledynamics. Many model-based approaches exist, includingLuenberger Observers [2], Sliding Mode Observers [3], andthe most commonly adopted approach, i.e. the Kalman Fil-ter [4]. Over time, several authors have proposed numeroustechniques to estimate vehicle sideslip angle via KalmanFilters and their variants, including Extended Kalman Filter(EKF), Unscented Kalman Filter (UKF), Cubature KalmanFilter (CKF), Square-Root Cubature Kalman Filter (SCKF)etc. [5]–[8]. Each technique adopts different hypotheses andassumptions on the available inputs, the measurable out-puts, the tyre model, and the environmental/road condi-tions [9]–[11]. In some cases tyre force sensors are used tofacilitate the estimation process [12], but that approach isnot cost-effective for passenger cars and often tyre forcesneed to be estimated, too [13]. Some other studies pro-pose kinematics-based techniques that do not need a tyremodel [14], [15]. More recent studies investigate the optionof particle filters, which normally are rather demanding in

terms of computational capability but can provide very goodperformance [16], [17].

As of yet, a general solution, that works in all condi-tions, does not exist. That is essentially down to the highcomplexity and variability of the possible driving conditions,which include e.g. the progressive wear of the tyres, theirbehaviour in different road conditions (e.g. dry, wet, ice), thecharacteristics of the road (e.g. irregularity, presence of slopeand/or bank angle) etc. The biggest issue with model-basedapproaches is that their accuracy depends on whether theyinclude a truly representative model of the tyre behaviour,which is very challenging. In general it is difficult to obtaintyre models and/or their parameters from, e.g., the tyre man-ufacturers. Even so, such values are (or should be) represen-tative only for new tyres. So the models should somehowaccount for changes in the tyre behaviour. Some interestingattempts in the literature propose estimators based on lineartyre models, with the estimator computing the cornering stiff-ness of each axle, that is updated in real time or according torule-based criteria [5], [18], [19]. Yet, it is well known thatlinear tyre models are accurate only for relatively low valuesof tyre slip angle. Another relevant aspect of sideslip angleestimation is that the majority of works deal with standardpassenger cars. Very few works deal with other types ofvehicles. For example, [20] investigates articulated heavy-duty vehicles in conditions of limit of adhesion.

This paper proposes a novel vehicle sideslip angle esti-mator, consisting of a simple single-stage EKF approach(differently from more complex approaches such as [22])with the following main novelties:

- the Rational tyre model [21], [22] is adopted and itsparameters are estimated and updated in real time, for a betteraccuracy of the estimator with respect to parameter-varyingestimators based on linear tyre models and estimators basedon fixed tyre parameters;

- the EKF performance is assessed on experimental datacollected on a heavy-duty vehicle equipped with a sideslipangle sensor. The performance of the proposed algorithmis also compared to a similar approach using a linear tyremodel (inspired to the recent paper [19]) and to a Rationalmodel-based filter with no tyre parameter update.

An EKF is preferred over an UKF structure due to thepeculiarities of the problem at hand, including the need ofease of tuning and low computational burden [23], withthe perspective of real-time application of the estimator foradvanced real-time controllers, aimed at enhancing vehiclesafety.

The remainder of this paper is structured as follows.Section II introduces the vehicle model and the tyre mod-els. Section III discusses the framework of the three filters.Results are presented in Section IV, and the main conclusionsare in Section V.

II. VEHICLE MODELThe dynamics of the vehicle is based on the well-knownsingle-track vehicle model (Fig. 1) [24], [25], which assumes

VOLUME 8, 2020 142121

Page 4: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

FIGURE 1. Single-track vehicle model: main parameters.

small steering angles:

β =FyFMu+FyRMu− r (1)

r =FyFaFJ−FyRaRJ

(2)

The Adapted ISO sign convention [26] is used throughout thepaper. Two different approaches are investigated as regardsthe tyre model: i) linear model; ii) Rational tyre model.

The linear tyre model is expressed as:

Fyi = Ciαi (3)

which is a relatively good approximation only for small slipangles. The Rational model, instead, allows to capture thenonlinear behaviour of the tyre as well as its saturation. TheRational tyre model was proposed in the literature to providea simple alternative to Pacejka’s Magic Formula [21], [22],still incorporating features such as explicit dependence onnormal load and road adhesion coefficient. The expressionof the Rational tyre model herein adopted is ([22]):

Fyi = c2iµFziFzi,0

(αic1i (µ+ 1)

α2i + c1i (µ+ 1)

)(4)

where c1 and c2 are constant parameters andµ is the tyre-roadfriction coefficient.

Taking into account the standard linearised congruenceequations [14]:

αF = δ −(β +

ruaF)

(5)

αR = −(β −

ruaR)

(6)

and using them in (3) and (4), the constitutive equations forthe front and rear axles can be rewritten for the linear modelas:

FyF = CF(δ − β −

ruaF)

(7)

FyR = −CR(β −

ruaR)

(8)

and for the Rational tyre model as:

FyF = c2FµFzFFzF,0

(δ − β − r

uaF)c1F (µ+ 1)(

δ − β − ruaF

)2+ c1F (µ+ 1)

(9)

FyR = c2RµFzRFzR,0

(−β + r

uaR)c1R (µ+ 1)(

−β + ruaR

)2+ c1R (µ+ 1)

(10)

III. DESIGN OF THE EXTENDED KALMAN FILTERAccording to the general formulation of an Extended KalmanFilter (EKF), the dynamics of the system at a generic dis-cretisation step can be expressed by the non-linear stochasticdifference equation [4]:

xk+1 = f (xk , ck ,wk) (11)

where the process noise, w, is meant to account for unmod-elled effects and external disturbances. w has zero mean andcovariance Q. A model is also needed to relate the availablemeasurements to the state vector:

zk+1 = h (xk+1, vk+1) (12)

which accounts for sensor noise through the measurementnoise vector v, that has zero mean and covariance R.

The estimation operates through the well-knownprediction-correction cycle [4] expressed by an a-priori esti-mation (prediction):

x−k+1 = f (xk , ck , 0) (13)

P−k+1 = AkPkATk + Q (14)

and an a-posteriori estimation (correction) based on the avail-able measurements:

xk+1 = x−k+1 + Kk+1(zk+1 − Hk+1x

k+1

)(15)

where

Kk+1 = P−k+1HTk+1

(Hk+1P

k+1HTk+1 + R

)−1(16)

Pk+1 = (I − Kk+1Hk+1)P−

k+1 (17)

Ak is the Jacobian matrix of partial derivatives of f withrespect to the state vector x:

Ak =∂f∂x

(xk , ck , 0) (18)

and Hk+1 is the Jacobian matrix of partial derivatives of hwith respect to x:

Hk+1 =∂h∂x

(x−k+1) (19)

In the present case study, the control input is the front wheelsteering angle, δ, and the measured quantities are the yawrate, r , and the lateral acceleration, ay. Both measurementsare obtained through an Inertial Measurement Unit (IMU)which integrates a three-axis gyroscope and a three-axis

142122 VOLUME 8, 2020

Page 5: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

accelerometer. The sensor noise is reflected in the diagonalmatrix R:

R = diag(σ 2r , σ

2ay

)(20)

where the values of σr and σay were obtained through thesensor datasheet.

The definitions of x, f , h and Q depend on the adoptedtyre model and on whether the estimator is also aimed atestimating the tyre model parameters. A schematic of theEKF framework is depicted in Fig. 2.

FIGURE 2. Schematic of the EKF framework.

The subsequent subsections investigate three cases: i) filterwith linear tyre model and estimation of tyre parameters(LINT); ii) filter with Rational tyre model (RATT); iii) filterwith Rational tyre model and estimation of tyre parameters(RATTE).

A. FILTER WITH LINEAR TYRE MODEL (LINT)This version of the filter employs equations (7) and (8)in equations (1) and (2). Differently from conventionalapproaches, the values of CF and CR are not fixed. The statevector includes them as augmented variables, to be estimatedby the filter. As discussed, the rationale is that the potentiallyavailable values of CF and CR might not be accurate, and thatanyway they are subject to change.

The state vector is chosen as:

x =[β, r, β,r,CF ,CR

]T (21)

and, by using the forward Euler method, the equations of thedynamics of the system in discrete time are:

βk+1 = βk + βk1t (22)

rk+1 = rk + rk1t (23)

βk+1 = −

(CF,k+CR,k

Mu

)βk−

(CF,kaF − CR,kaR

Mu2+1)rk

+CF,kδkMu

(24)

rk+1 = −(CF,kaF − CR,kaR

J

)βk

(CF,ka2F + CR,ka

2R

Ju

)rk +

CF,kaFδkJ

(25)

CF,k+1 = CF,k (26)

CR,k+1 = CR,k (27)

By studying the stability of the system defined byequations (1-3) and (5-6), it turns out that the problem is notstiff [27]. Specifically, for the case study vehicle, the ratiobetween the two eigenvalues of the system is 1 above 6 m/s,and up to ∼1.3 at low speeds. This supports the use of theforward Euler method.

Equations (26) and (27) show that no change is expectedfor CF and CR in the prediction model. The reason is thattheir dynamics is not known. Therefore, the variation of suchparameters takes place within the correction phase of thefilter.

The dynamics of the system is nonlinear - hence an EKFis used - only because of the presence of the augmentedvariables CF and CR in the state vector. Otherwise, a classicallinear Kalman Filter could be used.

By applying equation (18), Ak results as:

Ak =

1 0 1t 0 0 00 1 0 1t 0 0A31 A32 0 0 A35 A36A41 A42 0 0 A45 A460 0 0 0 1 00 0 0 0 0 1

(28)

where

A31 = −CF,k + CR,k

Mu(29)

A32 = −

(CF,kaF − CR,kaR

Mu2+ 1

)(30)

A35 =δk

Mu−βk

Mu−rkaFMu2

(31)

A36 =aRrkMu2−βk

Mu(32)

A41 = −CF,kaF − CR,kaR

J(33)

A42 = −CF,ka2F + CR,ka

2R

Ju(34)

A45 =δkaFJ−rka2FJu−βkaFJ

(35)

A46 =βkaRJ−rka2RJu

(36)

where the symbol ( ) represents the estimated value of aquantity, in other words:

xk =[βk , rk , ˆβ, ˆr, CF,k , CR,k

]T(37)

The measurement vector is:

z =[r, ay

]T (38)

VOLUME 8, 2020 142123

Page 6: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

Note that the measured lateral acceleration can be directlyused in the filter equations because of the particular choice ofvariables in the state vector. This follows from:

ay,k = uβk + urk (39)

and from the fact that β appears in the state vector. Thisis inspired from [19] and is not common in the literature.In alternative approaches that include the lateral acceler-ation in the measurement vector, the lateral accelerationexplicitly depends on the control input, i.e. the steeringangle [5], [28], [29]. Based on equations (38) and (39),it results:

Hk =[0 1 0 0 0 00 u u 0 0 0

](40)

The process noise w is assumed to be generated by uncer-tainties on the input (the steering angle) and the unknowndynamics of the augmented variables. So, according to [30]and by accounting for the presence of augmented variables:

Q = 1tBk3BTk (41)

where

3 = diag(σ 2δ , σ

2CF , σ

2CR

)(42)

Bk =

0 0...

...

Bc,k 0...

1 00 1

(43)

Bc,k =∂f∂c

(xk , ck , 0) (44)

Bk includes the Jacobian matrix of partial derivatives of fwith respect to c, evaluated at step k , denoted as Bc,k , whilethe subsequent columns of Bk correspond to the augmentedvariables CF and CR. Specifically:

Bk =

0 0 00 0 0

CF,kMu

0 0CF,kaFJ

0 0

0 1 00 0 1

(45)

B. FILTER WITH RATIONAL TYRE MODEL (RATT)This version of the filter employs equations (9) and (10)in equations (1) and (2). The tyre model parameters c1, c2and µ are assumed constant. The parameters c1 and c2 wereobtained via fitting equation (4) by using the Matlab function‘‘lsqnonlin’’ on an extensive amount of experimental data,with the assumption µ = 1. For the purposes of fitting,the values of lateral and vertical forces for front and rearaxles were obtained through the TRICK tool [31], [32].Fig. 3 shows the results of the fitting, and Table 1 reports theobtained parameters.

FIGURE 3. Data fitting for (top) front axle and (bottom) rear axle.

TABLE 1. Rational tyre model parameters for section III.B.

Since the tyre parameters are constant, the state vectorreads:

x =[β, r, β,r

]T (46)

and the dynamics of the system is represented by four equa-tions, i.e. equations (22) and (23) together with:

βk+1 =

c2FµFzFFzF,0

( (δk−βk−

rku aF

)c1F (µ+1)(

δk−βk−rku aF

)2+c1F (µ+1)

)Mu

+

c2RµFzRFzR,0

( (−βk+

rku aR

)c1R(µ+1)(

−βk+rku aR

)2+c1R(µ+1)

)Mu

− rk (47)

rk+1 =c2Fµ

FzFFzF,0

( (δk−βk−

rku aF

)c1F (µ+1)(

δk−βk−rku aF

)2+c1F (µ+1)

)aF

J

c2RµFzRFzR,0

( (−βk+

rku aR

)c1R(µ+1)(

−βk+rku aR

)2+c1R(µ+1)

)aR

J(48)

As a result:

Ak =

1 0 1t 00 1 0 1tA31 A32 0 0A41 A42 0 0

(49)

142124 VOLUME 8, 2020

Page 7: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

where the expressions of each term are reported in theAppendix.

With the state vector in (46) and the same available mea-surements, Hk changes to:

Hk =[0 1 0 00 u u 0

](50)

Finally, (41) holds with:

3 = diag(σ 2δ

)(51)

and

Bk = Bc,k =

00B31B41

(52)

where the expressions of B31 and B41 are detailed in theAppendix.

C. FILTER WITH RATIONAL TYRE MODEL AND TYREPARAMETER ESTIMATION (RATTE)Similarly to the previous case, this filter uses equations (9)and (10) in equations (1) and (2). However the tyre parametersc1 and c2 are now augmented variables in the state vector:

x =[β, r, β,r, c1F , c2F , c1R, c2R

]T (53)

The dynamics of the system is given by eight equations, i.e.equations (22), (23), (48), (49) and

c1F,k+1 = c1F,k (54)

c2F,k+1 = c2F,k (55)

c1R,k+1 = c1R,k (56)

c2R,k+1 = c2R,k (57)

Therefore:

Ak =

1 0 1t 0 0 0 0 00 1 0 1t 0 0 0 0A31 A32 0 0 A35 A36 A37 A38A41 A42 0 0 A45 A46 A47 A480 0 0 0 1 0 0 00 0 0 0 0 1 0 00 0 0 0 0 0 1 00 0 0 0 0 0 0 1

(58)

Finally, (41) holds with:

3 = diag(σ 2δ , σ

2c1F , σ

2c2F , σ

2c1R , σ

2c2R

)(59)

and

Bk =

0 0 0 0 00 0 0 0 0B31 0 0 0 0B41 0 0 0 00 1 0 0 00 0 1 0 00 0 0 1 00 0 0 0 1

(60)

IV. RESULTSThe performance of the three filters was assessed throughexperimental data obtained on the heavy-duty vehicle shownin Fig. 4. The main vehicle parameters are in Table 2. Thevehicle was equipped with wheel speed sensors, a steer-ing wheel sensor, a Racelogic Inertial Measurement UnitRLVBIMU04 V2, and a Kistler Correvit S-350 sensor. Thesampling frequency was 20 Hz, resulting in a filter discreti-sation time step of 0.05 s. This is enough to capture the fre-quencies of interest in vehicle dynamics [33] while limitingthe computational burden.

FIGURE 4. The instrumented vehicle used in the experimental analysis.

TABLE 2. Vehicle parameters.

As shown in the equations of the filters in the previ-ous section, the longitudinal velocity, u, is needed. That iscomputed as a function of the measured four wheel speeds.Specifically, such values are corrected, as suggested by [14]:

uFL = uFL,m cos (δ)+ r(tF2

)(61)

uFR = uFR,m cos (δ)− r(tF2

)(62)

uRL = uRL,m + r(tR2

)(63)

uRR = uRR,m − r(tR2

)(64)

VOLUME 8, 2020 142125

Page 8: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

and then their average is taken as the estimated longitudinalvelocity.

Fig. 5 shows a sample timeframe comparing the four wheelspeeds before and after correction, together with the actuallongitudinal vehicle velocity, u, measured by the Kistler Cor-revit sensor.

FIGURE 5. Longitudinal speed comparison: (top) measured values;(bottom) corrected values.

Fig. 6 shows the measured sideslip angle (from the Cor-revit sensor) along with the estimate of the filters alongthree consecutive laps on the Vairano track, Italy. The speedof each lap was around 30, 40 and 45 km/h respectively.The speed profile and the lateral acceleration are depictedin Figure 7, showing that lap 1 was between 0 and 299 s,lap 2 between 299 and 526 s, and lap 3 between 526 and 721 s.Bymultiplying each laptime and speed, the approximate tracklength is obtained, i.e. 2.5 km. The pattern of the lateralacceleration profile is the same for the three laps, with a fewpositive and negative peaks at the beginning of the lap dueto the handling section (highlighted in green in Fig. 6a), thenanother important peak at the hairpin bend before the mainstraight. The magnitude of the acceleration peaks increasesas the lap speed increases.

By looking at Fig. 6b, the RATTE filter produces a goodestimate of the sideslip angle all round, performing muchbetter than LINT and RATT. Interestingly, the filter perfor-mance improves with the vehicle speed. In straight drivingconditions the performance of LINT, RATT and RATTE israther similar, as shown in Fig. 6c which refers to the straighthighlighted in red in Fig. 6a. On the other hand, the RATTEfilter is significantly better in cornering conditions - which iswhen sideslip angle matters the most - as shown in Fig. 6d,which refers to the handling section highlighted in greenin Fig. 6a. In particular, Fig. 6b clearly shows that LINTand RATT tend to underestimate the vehicle sideslip angle,which is an important drawback from the safety point of view.In fact, potential safety-critical condition are normally asso-ciated to relatively large values of sideslip angle [34], hencethe need to promptly detect such instances, which the RATTEfilter proved able to do. It is also important to note that at the

FIGURE 6. (a) Vairano track, highlight of the start/finish point, a straight(red) and a handling section (green); (b) Measured and estimated β;(c) Detail of the filter performance on the highlighted straight; (d) Detailof the filter performance on the highlighted handling section.

end of the three laps the vehicle decelerated from 45 km/h tozero speed in around 5 seconds, and the performance of thethree filters remained satisfactory until ∼0.4 seconds before

142126 VOLUME 8, 2020

Page 9: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

FIGURE 7. Vehicle speed and lateral acceleration during three constantspeed laps.

stopping, when also the measured value started to diverge dueto the optical nature of the sensor.

To assess the performance of each filter, the sideslip angleRoot Mean Square Error (RMSE) was introduced:

RMSE =

√√√√∑Nk=1

(βk − βk

)2N

(65)

in which βk is the estimated value of the sideslip angle andβk is the value of the measured sideslip angle, at time stepk . N is the number of samples. The RMSE values of thethree filters are reported in Table 3, which confirms thatthe RATTE filter outperforms the other two. By comparingRATT and LINT, the former presents a 37% improvementwith respect to latter. By allowing the tyre parameters tochange, RATTE improves RATT by 44%, with an overall65% improvement with respect to LINT. In terms of absolutevalues the performance of RATTE is deemed satisfactory,with an error smaller than 0.5 deg.

TABLE 3. Performance analysis, constant speed laps.

The time histories of the estimated tyre parameters areshown in Fig. 8 (LINT) and Fig. 9 (RATTE). As expectedtheir variation is relatively limited, yet significant for the filterperformance.

The performance of the developed filters was also assessedon a high speed lap with a top speed of 115 km/h and averagespeed 76 km/h. As depicted in Fig. 10, the RATTE filter stillworks well and outperforms the other two. Its RMSE valueis 0.62 deg, a bit larger than for the constant speed laps due

FIGURE 8. Cornering stiffness values, LINT filter.

FIGURE 9. Rational tyre model parameters, RATTE filter.

FIGURE 10. Measured and estimated β during a high speed lap.

to the more challenging manoeuvre (see speed and lateralacceleration profiles in Fig. 11), but still satisfactory in termsof sideslip angle tracking. Both LINT and RATT resulted lessaccurate, with RMSE values slightly above 1 deg.

VOLUME 8, 2020 142127

Page 10: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

FIGURE 11. Vehicle speed and lateral acceleration during a high speedlap.

V. CONCLUSIONThis paper presented an EKF approach to the estimationof the vehicle sideslip angle. After analysing a linear tyremodel approach inspired to a recent approach proposed inthe literature, an EKF framework was developed based onthe Rational tyre model. A further evolution of the algorithmwas also conceived, allowing the possibility for the filter toestimate relevant tyre parameters. The experimental resultsconfirmed the effectiveness of the proposed approach, pro-viding significant benefits with respect to the linear approach,with a limited increase in complexity.

Future developments include: i) the development of a moredetailed vehicle model, including effects such as road slope,bank angle, vehicle roll and pitch motions; ii) the investiga-tion of further alternative tyre models; iii) the implementationof a more advanced estimation algorithm, bearing in mindthe need for low computational cost; and iv) the real-timeimplementation of the filter on the vehicle (e.g. through adSPACE board) and the execution of further experimentaltests, including scenarios with variable friction conditions(e.g. dry-wet).

APPENDIXThe terms in equations (49) are:

A31 =2F zFµc1Fc2F (µ+ 1)

(−δk + βk +

rku aF

)2FzF,0Mu

((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)2

−Fz1µc1Fc2F (µ+ 1)

FzF,0Mu((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)

+

2F zRµc1Rc2R (µ+ 1)(βk −

rku aR

)2FzR,0Mu

((βk −

rku aR

)2+ c1R (µ+ 1)

)2

−FzRµc1Rc2R (µ+ 1)

FzR,0Mu((βk −

rku aR

)2+ c1R (µ+ 1)

)

A32 =2F zFµaFc1Fc2F (µ+ 1)

(−δk + βk +

rku aF

)2FzF,0Mu2

((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)2

−FzFµaFc1Fc2F (µ+ 1)

FzF,0Mu2((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)

2F zRµaRc1Rc2R (µ+ 1)(βk −

rku aR

)2FzR,0Mu2

((βk −

rku aR

)2+ c1R (µ+ 1)

)2

+Fz2µa2c1Rc2R (µ+ 1)

FzR,0Mu2((βk −

rku aR

)2+ c1R (µ+ 1)

) − 1

A41 =2F zFµaFc1Fc2F (µ+ 1)

(−δk + βk +

rku aF

)2FzF,0J

((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)2

−FzFµaFc1Fc2F (µ+ 1)

FzF,0J((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)

2F zRµaRc1Rc2R (µ+ 1)(βk −

rku aR

)2FzR,0J

((βk −

rku aR

)2+ c1R (µ+ 1)

)2

+FzRµaRc1Rc2R (µ+ 1)

FzR,0J((βk −

rku aR

)2+ c1R (µ+ 1)

)

A42 =2F zFµa2Fc1Fc2F (µ+ 1)

(−δk + βk +

rku aF

)2FzF,0Ju

((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)2

−FzFµa2Fc1Fc2F (µ+ 1)

FzF,0Ju((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)

+

2F zRµa2Rc1Rc2R (µ+ 1)(βk −

rku aR

)2FzR,0Ju

((βk −

rku aR

)2+ c1R (µ+ 1)

)2

FzRµa2Rc1Rc2R (µ+ 1)

FzR,0Ju((βk −

rku aR

)2+ c1R (µ+ 1)

)

The terms in equations (58) include the expressions givenabove for A31,A32,A41,A42 (with c1F,k , c2F,k , c1Rk , c2R,kinstead of, respectively, c1F , c2F , c1R, c2R) and:

A35 =FzFµc1F,k c2F,k (µ+ 1)2

(−δk + βk +

rku aF

)FzF,0Mu

((−δk + βk +

rku aF

)2+ c1F,k (µ+ 1)

)2

142128 VOLUME 8, 2020

Page 11: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

FzFµc2F,k (µ+ 1)(−δk + βk +

rku aF

)FzR,0Mu

((−δk + βk +

rku aF

)2+ c1F,k (µ+ 1)

)

A36 = −FzFµc1F,k (µ+ 1)

(−δk + βk +

rku aF

)FzF,0Mu

((−δk + βk +

rku aF

)2+ c1F,k (µ+ 1)

)

A37 =FzRµc1R,k c2R,k (µ+ 1)2

(βk −

rku aR

)FzR,0Mu

((βk −

rku aR

)2+ c1R,k (µ+ 1)

)2

FzRµc2R,k (µ+ 1)(βk −

rku aR

)FzR,0Mu

((βk −

rku aR

)2+ c1R,k (µ+ 1)

)

A38 = −FzRµc1R,k (µ+ 1)

(βk −

rku aR

)FzR,0Mu

((βk −

rku aR

)2+ c1R,k (µ+ 1)

)

A45 =FzFµaF c1F,k c2F,k (µ+ 1)2

(−δk + βk +

rku aF

)FzF,0J

((−δk + βk +

rku aF

)2+ c1F,k (µ+ 1)

)2

FzFµaF c2F,k (µ+ 1)(−δk + βk +

rku aF

)FzF,0J

((−δk + βk +

rku aF

)2+ c1F,k (µ+ 1)

)

A46 = −FzFµaF c1F,k (µ+ 1)

(−δk + βk +

rku aF

)FzF,0J

((−δk + βk +

rku aF

)2+ c1F,k (µ+ 1)

)

A47 = −FzRµaRc1R,k c2R,k (µ+ 1)2

(βk −

rku aR

)FzR,0J

((βk −

rku aR

)2+ c1R,k (µ+ 1)

)2

+

FzRµaRc2R,k (µ+ 1)(βk −

rku aR

)FzR,0J

((βk −

rku aR

)2+ c1R,k (µ+ 1)

)

A48 =FzRµaRc1R,k (µ+ 1)

(βk −

rku aR

)FzR,0J

((βk −

rku aR

)2+ c1R,k (µ+ 1)

)

The terms in equation (52) are:

B31 = −2F zFµc1Fc2F (µ+ 1)

(−δk + βk +

rku aF

)2FzF,0Mu

((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)2

+FzFµc1Fc2F (µ+ 1)

FzF,0Mu((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)

B41 = −2F z1µaFc1Fc2F (µ+ 1)

(−δk + βk +

rku aF

)2FzF,0J

((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)2

+FzFµaFc1Fc2F (µ+ 1)

FzF,0J((−δk + βk +

rku aF

)2+ c1F (µ+ 1)

)The terms in equation (60) include the expressions givenabove for B31 and B32, using c1F,k , c2F,k , c1Rk , c2R,k insteadof, respectively, c1F , c2F , c1R, c2R.

REFERENCES[1] D. Chindamo, B. Lenzo, and M. Gadola, ‘‘On the vehicle sideslip angle

estimation: A literature review of methods, models, and innovations,’’Appl. Sci., vol. 8, no. 3, p. 355, Mar. 2018.

[2] N. Ding, W. Chen, Y. Zhang, G. Xu, and F. Gao, ‘‘An extended Luenbergerobserver for estimation of vehicle sideslip angle and road friction,’’ Int. J.Vehicle Des., vol. 66, no. 4, pp. 385–414, 2014.

[3] S. Cheng, L. Li, B. Yan, C. Liu, X. Wang, and J. Fang, ‘‘Simultaneousestimation of tire side-slip angle and lateral tire force for vehicle lateralstability control,’’ Mech. Syst. Signal Process., vol. 132, pp. 168–182,Oct. 2019.

[4] G. Welch and G. Bishop, ‘‘An introduction to the Kalman Filter,’’ in Proc.SIGGRAPH, 2006, pp. 1–16.

[5] F. Cheli, E. Sabbioni, M. Pesce, and S. Melzi, ‘‘A methodology for vehiclesideslip angle identification: Comparison with experimental data,’’ VehicleSyst. Dyn., vol. 45, no. 6, pp. 549–563, Jun. 2007.

[6] B.-C. Chen and F.-C. Hsieh, ‘‘Sideslip angle estimation using extendedKalman filter,’’ Vehicle Syst. Dyn., vol. 46, no. sup1, pp. 353–364,Sep. 2008.

[7] B. L. Boada, M. J. L. Boada, and V. Diaz, ‘‘Vehicle sideslip anglemeasurement based on sensor data fusion using an integrated ANFISand an unscented Kalman filter algorithm,’’ Mech. Syst. Signal Process.,vols. 72–73, pp. 832–845, May 2016.

[8] S. Cheng, L. Li, and J. Chen, ‘‘Fusion algorithm design based on adaptiveSCKF and integral correction for side-slip angle observation,’’ IEEE Trans.Ind. Electron., vol. 65, no. 7, pp. 5754–5763, Jul. 2018.

[9] M. Gadola, D. Chindamo, M. Romano, and F. Padula, ‘‘Development andvalidation of a Kalman filter-based model for vehicle slip angle estima-tion,’’ Vehicle Syst. Dyn., vol. 52, no. 1, pp. 68–84, Jan. 2014.

[10] C. Pieralice, B. Lenzo, F. Bucchi, and M. Gabiccini, ‘‘Vehicle sideslipangle estimation using Kalman filters: Modelling and validation,’’ inProc. Int. Conf. IFToMM ITALY. Cham, Switzerland: Springer, 2018,pp. 114–122.

[11] E. Joa, K. Yi, and Y. Hyun, ‘‘Estimation of the tire slip angle undervarious road conditions without tire–road information for vehicle stabilitycontrol,’’ Control Eng. Pract., vol. 86, pp. 129–143, May 2019.

[12] K. Nam, S. Oh, H. Fujimoto, and Y. Hori, ‘‘Estimation of sideslip androll angles of electric vehicles using lateral tire force sensors through RLSand Kalman filter approaches,’’ IEEE Trans. Ind. Electron., vol. 60, no. 3,pp. 988–1000, Mar. 2013.

[13] J. Dakhlallah, S. Glaser, S. Mammar, and Y. Sebsadji, ‘‘Tire-road forcesestimation using extended Kalman filter and sideslip angle evaluation,’’ inProc. Amer. Control Conf., Jun. 2008, pp. 4597–4602.

[14] D. Selmanaj, M. Corno, G. Panzani, and S. M. Savaresi, ‘‘Vehicle sideslipestimation: A kinematic based approach,’’ Control Eng. Pract., vol. 67,pp. 1–12, Oct. 2017.

[15] A. Y. Ungoren, H. Peng, and H. E. Tseng, ‘‘A study on lateral speed estima-tion methods,’’ Int. J. Vehicle Auton. Syst., vol. 2, nos. 1–2, pp. 126–144,2004.

[16] K. György, A. Kelemen, and L. Dávid, ‘‘Unscented Kalman filters andparticle filter methods for nonlinear state estimation,’’ Procedia Technol.,vol. 12, pp. 65–74, Jan. 2014.

[17] B. Lenzo and R. De Castro, ‘‘Vehicle sideslip estimation for four-wheel-steering vehicles using a particle filter,’’ in Advances in Dynamics ofVehicles on Roads and Tracks (Lecture Notes in Mechanical Engineering).Cham, Switzerland: Springer, 2020, pp. 1624–1634.

VOLUME 8, 2020 142129

Page 12: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via …shura.shu.ac.uk/26862/15/Lenzo_VehicleSideslipAngle(VoR).pdf · 2021. 3. 17. · F. Di Biase et al.: Vehicle Sideslip

F. Di Biase et al.: Vehicle Sideslip Angle Estimation for a Heavy-Duty Vehicle via EKF Using a Rational Tyre Model

[18] S. van Aalst, F. Naets., B. Boulkroune, W. D. Nijs, and W. Desmet,‘‘An adaptive vehicle sideslip estimator for reliable estimation in low andhigh excitation driving,’’ IFAC-PapersOnLine, vol. 51, no. 9, pp. 243–248,2018.

[19] G. Reina and A. Messina, ‘‘Vehicle dynamics estimation via aug-mented extended Kalman filtering,’’Measurement, vol. 133, pp. 383–395,Feb. 2019.

[20] G. Morrison and D. Cebon, ‘‘Sideslip estimation for articulated heavyvehicles at the limits of adhesion*,’’ Vehicle Syst. Dyn., vol. 54, no. 11,pp. 1601–1628, Nov. 2016.

[21] S. C. Baslamısllı and S. Solmaz, ‘‘Construction of a rational tire modelfor high fidelity vehicle dynamics simulation under extreme driving andenvironmental conditions,’’ in Proc. ASME 10th Biennial Conf. Eng. Syst.Design Anal., vol. 3, Jan. 2010, pp. 131–137.

[22] A. H. Ahangarnejad and S. Ç. Baslamısllı, ‘‘Adap-tyre: DEKF filtering forvehicle state estimation based on tyre parameter adaptation,’’ Int. J. VehicleDes., vol. 71, nos. 1–4, pp. 52–74, 2016.

[23] M. Rhudy and Y. Gu, ‘‘Understanding nonlinear Kalman filters—Part 1:Selection of EKF or UKF,’’ Interact. Robot. Lett., Jun. 2013. [Online].Available: https://yugu.faculty.wvu.edu/research/interactive-robotics-letters/understanding-nonlinear-kalman-filters-part-i

[24] M. Guiggiani, The Science of Vehicle Dynamics. Cham, Switzerland:Springer, 2018.

[25] G. Genta,Motor Vehicle Dynamics: Modeling and Simulation. Singapore:World Scientific Publishing, 1997.

[26] H. B. Pacejka, Tyre and Vehicle Dynamics. Oxford, U.K.: Butterworth-Heinemann, 2006.

[27] K. Atkinson, W. Han, and D. E. Stewart, Numerical Solution of OrdinaryDifferential Equations, vol. 108. Hoboken, NJ, USA: Wiley, 2011.

[28] F. Naets, S. van Aalst, B. Boulkroune, N. E. Ghouti, and W. Desmet,‘‘Design and experimental validation of a stable two-stage estimator forautomotive sideslip angle and tire parameters,’’ IEEE Trans. Veh. Technol.,vol. 66, no. 11, pp. 9727–9742, Nov. 2017.

[29] J. Farrelly and P. Wellstead, ‘‘Estimation of vehicle lateral velocity,’’ inProc. IEEE Int. Conf. Control Appl. IEEE Int. Conf. Control Appl. HeldTogether With IEEE Int. Symp. Intell. Control, Sep. 1996, pp. 552–557.

[30] G. Franklin, D. Powell, and M. Workman, Digital Control of DynamicSystems. Reading, MA, USA: Addison-Wesley, 1997.

[31] F. Farroni, ‘‘TRICK-Tire/Road interaction characterization &knowledge—A tool for the evaluation of tire and vehicle performancesin outdoor test sessions,’’ Mech. Syst. Signal Process., vols. 72–73,pp. 808–831, May 2016.

[32] F. Farroni, G. N. Dell’Annunziata, A. Sakhnevych, F. Timpone, B. Lenzo,and M. Barbieri, ‘‘Towards T.R.I.C.K. 2.0—A tool for the evaluation ofthe vehicle performance through the use of an advanced sensor system,’’in Proc. Conf. Italian Assoc. Theor. Appl. Mech., Cham, Switzerland:Springer, 2019, pp. 1093–1102.

[33] P. Perinciolo and E. Sondhi,Model Based Handling Analyses. Stockholm,Sweden: KTH, 2018.

[34] B. Lenzo, M. Zanchetta, A. Sorniotti, P. Gruber, and W. De Nijs, ‘‘Yawrate and sideslip angle control through single input single output directyaw moment control,’’ IEEE Trans. Control Syst. Technol., early access,Feb. 4, 2020, doi: 10.1109/TCST.2019.2949539.

FELICIANO DI BIASE received the bachelor’sdegree in mechanical engineering from the SecondUniversity of Naples, Italy, in 2016, and the M.Sc.degree in mechanical engineering for design andproduction from the University of Naples FedericoII, Italy, in 2019. He completed his internshipthesis work at the Department of Engineering andMathematics SheffieldHallamUniversity. His cur-rent research interests include vehicle dynamicsand control.

BASILIO LENZO (Member, IEEE) received theM.Sc. degree in mechanical engineering from theUniversity of Pisa and the University Sant’Anna,Pisa, Italy, in 2010, and the Ph.D. degree inrobotics from University Sant’Anna, in 2013.In 2010, he was a Research and DevelopmentIntern with Ferrari Formula 1. Since 2016, he hasbeen a Senior Lecturer of automotive engineeringwith Sheffield Hallam University. He was alsoa Visiting Researcher with the École Normale

Supérieure Cachan, France, the University of Delaware, USA, ColumbiaUniversity, USA, the University of Naples, Italy, the German AerospaceCenter DLR, Germany, and the Politecnico di Torino, Italy. He was atwo-time TEDx Speaker. His research interests include vehicle dynamics,state estimation, control, and robotics.

FRANCESCO TIMPONE received the M.Sc.degree in mechanical engineering and the Ph.D.degree in thermomechanical system engineer-ing from the University of Naples Federico II,in 1999 and 2004, respectively. He is currentlyan Associate Professor of applied mechanics andvehicle dynamics with the University of NaplesFederico II. His research interests include thedynamics and the control of mechanical systems.

142130 VOLUME 8, 2020