Você está na página 1de 6

VEHICLE SIDESLIP ANGLE OBSERVERS

Joanny Stéphant , Ali Charara , Dominique Meizel


Laboratoire Heudiasyc UMR CNRS 6599
Université de Technologie de Compiègne
Centre de recherches de Royallieu BP 20259 - 60205 COMPIEGNE CEDEX, France
joanny.stephant@hds.utc.fr, ali.charara@hds.utc.fr, dominique.meizel@hds.utc.fr
Fax. 33 (0)3 44 23 44 77

Keywords: Sideslip angle, Observability, Nonlinear observa- 


(Vehicle engineering Research and Development Company),
tion, Sliding mode observation, Vehicle model. and all data processed with MATLAB software.

Abstract 2 Vehicle and simulator


This paper compares four observers of vehicle sideslip an- 2.1 STRADA
gle. The first is linear and uses a linear vehicle model. Next
observers use an extended nonlinear model. The three non-
linear observers are: extended Luenberger observer, extended
Kalman filter and sliding mode observer. Modelling and model
simplification are described, and an observability analysis is
performed for the entire vehicle trajectory. The paper also deals
with three different sets of sensors. Comparison is first done by
simulation, and then observers are used on experimental data.
Figure 1: Heudiasyc laboratory experimental vehicle :
1 Introduction STRADA
In vehicle development, knowledge of wheel-ground contact STRADA is the Heudiasyc Laboratory’s test vehicle: a Citroën
forces is important. The information is useful for security ac- Xantia station-wagon equipped with a number of sensors. Tests
tuators, for validating vehicle simulators and for advanced ve- use GPS, with longitudinal and lateral acceleration to trace the
hicle control systems. path and to determine whether the vehicle reaches linear ap-
Braking systems and control systems must be able to stabilize proximation limits. The speed of center of gravity is calculated
the car during cornering. When subject to transversal forces, as the mean of the longitudinal speeds of the two rear wheels
such as when cornering, or in the presence of a camber an- (odometry), and yaw rate obtained from the yaw rate gyrome-
gle, tire torsional flexibility produces an aligning torque which ter.
modifies the original wheel direction. The difference is charac-
terized by an angle known as ”sideslip angle”. This is a signifi- 
2.2 Callas
cant signal to determine the stability of the vehicle and it is the
main transversal force variable. Callas software is a realistic simulator validated by vehicle
Measuring sideslip angle would represent a disproportionate manufacturers including PSA, and research institutions includ-
cost in the case of an ordinary car, and it must therefore be ob- ing INRETS (”Institut national de recherche sur les transports
served or estimated. et leur sécurité”). The Callas model takes into account vertical
The literature describes several observers for sideslip angle. dynamics (suspension, tires), kinematics, elasto-kinematics,
For example, Kiencke in [2] or [3] presents linear and non- tire adhesion and aerodynamics.
linear observers with a bicycle model. Venhovens [10], use a
Kalman filter for a linear vehicle model.
The present study compares four observers for the sideslip an- 3 Vehicle models
gle on a conventional test with three different speeds. We are Lateral vehicle dynamics has been studied since the 50’s. In
particularly concerned with the stability of the observers and 1956 Segel presented a vehicle model with three degrees of
the model as the vehicle approaches the linear dynamic limits. freedom in order to describe lateral movements including roll
It also presents the results for three different sets of sensors: and yaw. If roll movement is neglected, a simple model known
yaw rate; vehicle speed; yaw rate and vehicle speed together. as the ”bicycle model” is obtained. This model is currently
We include some results concerning observability. Finally, it used for studies of lateral vehicle dynamics (yaw and sideslip).
presents some experimental results obtained with the Heudi- A nonlinear representation of the bicycle model is shown in

asyc experimental vehicle. All simulations have been per- Figure 2. The different notations are indicated in the appendix
formed using with Callas software developed by SERA-CD
6< >=?@, 9%, 8AC B$* B$FE$ @
(section 9). Some simplifications are available for the different D + GG H with

 

  I BC $D*+,
B B$EN*
C D
$MB,E,&P
+O,
 7J J
KL L
β
Q
Q
 B $ $ B, , LB $ NE $O , B, NE,O,R
δ

  ψ E M
FGG  E  FGG*+
  


 L δ
L L
  

3.2 Nonlinear model - NLM
ψ

 
δ

  The nonlinear bicycle model is described as:


!
S 6 =T C $DUVWXYZ[6W&VT\-V]XYZ[6W\
S
S & $[VT&6W&'$^
 ^ ]T\Z_[6W&VT\
S
S , [ ,^ ]
- &6W-'^T Z_[6W\`\ 
S
S
Figure 2: Bicycle model
"S
S6 =W CD$^TU&VWZ_[6W&VT\&V]Z_[6W\
models. Cornering stiffness is taken to be constant. But corner-
S -$[VT&6W& '$^^]T[\6XYZ[6W&VT\
S - , [ 6 - ',^ ] \ \
` 6
(4)
ing stiffness increases with tire pressure. When the car turns, S
S   & W ^T XY Z W & ]
S
S 
S 6 =] FGG$ $ [WZ_ T\&',$
$ U' $V [
V ,]\[&6 W-\`',^^]T\
the mass transfer on the external wheels increases tire pressure.
S
S
# - '  V 6 ' ^ [V
 T& W& ^T XYZ T
Figure 3 presents variations in cornering stiffness for different
simulation speeds. The difference is less than 10%.
6 <  >=?@and the input vec-
contact force models are to be found in the literature, including where the state vector@is:  a+
Tire/road forces are highly nonlinear. Various wheel-ground

a comparison between three different models by Stéphant in tor: 


V <%  $
b b , ?
[9]. In this paper, transversal forces are taken to be linear. This


assumption is reasonable when lateral acceleration of the vehi- 3.3 Extended nonlinear model - ENLM
cle is less than [4], limit of adhesion zone. Consequently,
In the extended nonlinear model, longitudinal forces and their
transversal forces can be written as: first derivatives become state variables with a random walk dy-
  (1)
namic (like constants parameters). This could be used for esti-
mating longitudinal forces, as in [8].
Rear and front tire sideslip angles are calculated as:
!$ %&&'$*)( 6ca+  >= b$ =b$ b, =bd
The state vector becomes: ,@
" V<%? and the input vector:

#, &-',*)+ (+ (2)


!
S 6
=T C$DU6eXYZ[6W&VT\-6fXYZ[6W\
S
S & $[VT&6W&'$^
, ,^ Z_[6W&VT\
^]T[\6
S
S -  6 - ' ]
 &W ^T Z_ W\`
[ \
S
5 cornering stiffness
x 10

S
1.6

S
S =W CD$^TU&6eZ_[6W&VT\&6fZ_[6W\
6
20km/h

S
S $[VT&6W&'$^ ]T\XYZ[6W&VT\
S -
1.55

1.5
60km/h
S
" , ,^] ^
- &W- ^T XYZ[6W\`&6]
 [ 6 ' \
S
S $ U'$VWZ_[VT\&',,[&6W-',^
(5)
S
S 6
=] FGG ^]T\
front
cornering stiffness (N/rad)

1.45 90km/h

S $ $ $ ^
rear

S - '  [
V 6 ' ] \XYZ[
V \
`
=e 6g  T& W& ^T T
20km/h

1.4
S
S
S 6
S
S
S 6
=g h
1.35 60km/h

S
#66
=f 6i
1.3 =i h
90km/h
1.25

1.2
3.4 Remarks
50 0 50 100 150 200 250
x position (m)

MATLAB software. The sampling rate is


.
All models have been implemented in a discrete form with
ms.
./01& 2/01& 3/01&
Figure 3: Right rear and front cornering stiffness for slalom at
&
jkl0mp
The nonlinear and extended nonlinear systems are undefined

jno 0m& 0m&


, and when . In practice, there is a problem of diver-
gence when . When speed is less than 1 ,
sideslip angle effects are negligible in comparison to the yaw
3.1 Linear model - LM rate.
Given the assumption of cornering at constant speed, with
small steering angle and sideslip angle, the linear model is: 4 Observers
456 76-89
: ;6 (3) Four different observers are used in this paper.
4.1 Linear observer (LO) This condition is equivalent to ”neutral steer” property of the
™
šp›œ3pl.œ2œž
vehicle. In the simulation case the system is observable be-
The linear observer used in this paper is a Luenberger observer cause (10)
[3]. It is applied to system described by equation (3).
5.2 Nonlinear system
4.2 Nonlinear observer (NLO)

qv u lwxvyz
In the nonlinear case, the observability definition is local and
r {
Ÿ 
uses the Lie derivative [7]. For system described by equation
r
s~ | l } xv { (4) and sensor set defined in section (??) the observability
vu lwxv ~z {€xv ~z {x|| ~{
r y y (6) function is:
r ~
t| l}xv ~{ ¢ 1xv { ¦
wxvyz{and }xv{are nonlinear functions in state and input. x
£˜ 1 {x
¥ {x yz
v {§
£
x˜ 1 v
¥1xv y {§
z
After linearization, with a pole placement technique, it is possi- ¡ l££
£ { §
§
§
£ §
(11)
ble to impose error dynamics. The system matrix of the closed- x
¤˜¥1 {x
v yz{¨
‚
loop system has constant poles . The observer is stable. x˜¥1{xvyz {
The gain matrix of the observer is computed by:
1xv{l©ljkand 1xv u
{l© lª
€xv~z w xv~z }xv
~{…† where : 
y {lƒ„ „ v y {‚…ƒ„v
„ (7) If this function is invertible at the current state and input, the
ƒˆ
…†lˆ‰xˆˆ‰{& system is observable. This function is invertible if the jacobian
«
with ‡is the pseudo-inverse: matrix has a full rank.


«l¬ (12)
4.3 Extended Kalman filter (EKF)
¬
The Kalman filter has been applied and described in many For system dsecribes by equation (5) the observability study is
studies. For example, Mohinder and Andrews [5] present a the same.
wide overview of Kalman filtering. In this paper, an extended For the nonlinear and extended nonlinear systems, the rank of
Kalman filter with measured input is used. The error measure- the observability matrix is respectively
ment covariance matrix R is determined by sensor variance. R
is a diagonal matrix, measurements are independent. The error
œlŒ­'® ¯° žlŒ±­'®
model covariance matrix Q is determined by model quality.
along the path. The computation is performed at each time step
4.4 Sliding mode observer (SMO) with the different sensor sets.

From [6], this kind of observer is useful when working with re- 6 Simulation Results
duced observation error dynamics, for a finite time convergence
for all observable states, and for robustness under parameter 6.1 Remarks

qv u lwxvyz
variations (with respect to conditions).
r { Values in the different tables and figures are calculated along
r |
s~ l } xv { the full path from the maximum error and the mean error
vu lwxv ~z {Šm‹ŒŽx|| ~{ between the estimated state and the measured one. Those er-
r
r ~ ~y (8)
t| l}xv{
rors are normalized by the maximum of state value along the
full path. For example, figure 4 give the error max and mean
‹ Žis as fol-
To cover chattering effects [1], the function mŒ
for the sideslip angle models and observers. Table 1 give the
maximum value of sideslip angle calculated by Callas. On fig-
lows:
m‹ŒŽx{l‘Œx{’.“” (9)
ure 7b) normalized maximum error of SMO for sideslip angle
is: 30 %. The normalized mean error is therefore 9 %.

5 Observability 6.2 Simulation conditions


5.1 Linear system
²Ÿ
Simulations were performed using three sets of sensors:

•<; ;7 ;7,  ;7– $?@ Œ


System describes by equation (3) is observable if the matrix ²Ÿ : Yaw rate only
has a rank equal to . The ²Ÿ  : Speed of center of gravity only

L— ˜
: Speed of center of gravity and yaw rate together
˜™l
observability condition is given by:
—  (10)
./01& 2/01& 3/01&
Tests took place in a chicane at three different speeds:
, and .
observer and model absolut error - 60km/h - side slip angle
it is 10 %. This indicates that the models are valid in respect of
0.18 EKF>0.058
NLM>0.129
LO>0.064
lateral movements. As regards sideslip angle, neither model is
NLO>0.062
0.16 LM>0.190 accurate. It would appear that observers are necessary to cor-
SMO>0.058
rect the estimations.
¶·´[½¾)(½\ ¶·´[½[a
¾*+\½\ ¶ [½[¾½\
··´´
0.14 error max

[=>\ ¶·»´ + ¶ \
¹¶º $ h ¶·»´
0.12

h ¼h h h ¼h h »h ¼h
(%)
|eps delta| (˚)

EKF>0.017
0.1 NLM>0.041

L 1.5
LO>0.020
NLO>0.0170
LM 17 39 - - - 10 99 257

¶·_[½¾)(½\40
0.08

¶·_[½[a
¾* ½\
LM>0.060

··_´[½[\
¶¶ ¾½\
¶·»´ ++\¼
SMO>0.017
NLM 2.5 18 0.5 0.6 0.7 1.1 67.2 236

[=>\
error mean

¹¶º $ h ¶·»´
0.06

h ¼h h h h h »h ¼h
(%)
0.04

0.02
LM L 0.6 4.8 10 - - - 3.1 31 78
NLM 0.8 5.1 10 0.3 0.3 0.4 0.6 21 71
0 2 4 6 8 10 12 14
time (s)

/01&, Ÿ 
Table 2: Models error for full simulation - max/mean
Figure 4: Sideslip angle error, 2
side slip angle - 60km/h
vehicle path
0
0.2
SMO
20km/h
1 EKF
60km/h LM
NLM
2 0.15
LO
(m)

90km/h
NLO
3 Callas
0.1
4

5
50 0 50 100 150 200 250 0.05
delta (˚)

(m)

acceleration at the CG
4 0

90km/h
transversal (m/(s^2))

2
0.05
60km/h
0 20km/h

0.1
2

4 0.15
2 0 2
longitudinal (m/(s^2)) 0 2 4 6 8 10 12 14
time (s)

./01&, 2/01&, Ÿ 
2/01& 3/01&
Figure 5: Path and acceleration for chicane at Figure 6: Sideslip angle,
,
6.3 Observers results for chicane at 20, 60 and 90
/01&
Figure 5 presents the simulation path and acceleration for the
different speeds. Table 1 gives the maximum values for speed ²Observers results for chicane at 20 /01&
of center of gravity, yaw rate and sideslip angle at the different
7a)shows the
 ./01 &. At 20 /0 1&, all nonlinear observers are highly
Figure results of the sideslip angle observation at
³´µ
speeds. Figure 6 shows the sideslip angle calculated using the
linear and nonlinear ( ) models and observers results. In
accurate in respect of sideslip angle (less than 1 % in max and
Figure 5 it can be seen that longitudinal acceleration is close
to zero, meaning that longitudinal forces are virtually nonex- ²
mean).
Observers results for chicane at 60
/01&
istent. The simulation by the nonlinear model with zero force
input seems to be a good simulation. Table 2 shows that a good /01&
Figure 6 shows simulated and estimated sideslip angle at 60
[=$\ ¶·´[a+ $\ ¶·¸´[\
¸·Z´>
¶ . A comparison of table 2 and figure 7b) shows that
¶ Z observers give a better approximation of sideslip angle than
¹ º $$ 2.8L
»hh¹¶
models. If the measurement is only the speed of the center of
5.6L
º $ 7.3
¼h¹¶  0.7

¶ºL 16.6 0.19


gravity, observers improve the accuracy of the sideslip angle.
L 9.9 24.9 0.21 But yaw rate measurement, with its substantially better mean
L ²
accuracy (10 %), would appear indispensable. /01&
Observers results for chicane at 90

3/01& /01&
Table 1: Maximum values for chicanes simulations Figure 7c) show the results of the sideslip angle observation at
approximation of speed is obtained from the nonlinear model. . The same remarks can be made as for 60 .
The error is less than 1 % for the three speeds (mean and max). Two explanations can be given for the errors. Table 2 shows
Throughout the path the Callas simulator driver aims to main- that the accuracy of the model decreases as speed increases.
The second explanation is that at 90 demands on tires
/01&
tain a constant speed. There are only small speed variations.
The greater the speed, the greater the yaw rate estimation error.
From table 2, mean error is 5 % at 60 . At 90 ,
/01& /01& are large. The maximum error occurs at maximum transversal
acceleration, when we reach the limit of linear approximation.
ppsi V delta vehicle path
G
1000
4 8 20
NLO NLO NLO
EKF EKF EKF 1200
SMO SMO OMG
3 LO 6 15 LO 1400
error max (%)

(m)
1600
2 4 10
1800

1 2 5 2000

2200
1300 1250 1200 1150 1100 1050 1000
0 0 0
1 2 3 1 2 3 1 2 3 (m)
Z Z Z
1,2,3 1,2,3 1,2,3 acceleration at the CG

1.5 3 4 3
NLO NLO NLO

transversal (m/(s^2))
EKF EKF EKF 2
SMO 2.5 SMO
SMO
3 1
LO LO
error mean (%)

1 2 0

1.5 2 1
2
0.5 1
1 3
0.5
2 0 2
longitudinal (m/(s^2))
0 0

h¹¶º $- max/mean
0
1 2 3 1 2 3 1 2 3
Z Z Z
1,2,3 1,2,3 1,2,3

a) Observers error for chicane at

20
ppsi
NLO
20
V
G

NLO
L 70
delta
NLO
Figure 8: Path and acceleration
EKF
SMO
EKF
SMO
60 EKF
SMO
7.2 Results
15 LO 15 LO
50
error max (%)

40
10 10
30
Table 3 gives maximum and mean error, normalized by max-
5 5
20 imum value, for linear and extended nonlinear systems along
10 the test path.
[=$\ ¶·´[a+ \
¶¸·Z´>
0 0 0

¶Z $
1 2 3 1 2 3 1 2 3
Z Z Z
1,2,3 1,2,3 1,2,3

L 14.0L
6 12 25
NLO NLO NLO
5
EKF
10
EKF EKF 16.6
SMO SMO 20 SMO

¶·´[½¾)(½\ ¶·´[½[a¾*+\½\
LO LO a) Maximum measurement values for experimental test
error mean (%)

4 8

¶·´[=>\
15
3

2
6

4
10 (%) ¶·´ +
1 2 5
LM 23 -

¶·_[½¾)(½\ ¶·_[½[a
¾ ½\
¶·´ *++\
NLM 34 28
»h¹¶º $- max/mean
0 0 0
1 2 3 1 2 3 1 2 3

¶·´[=>\
Z Z Z
1,2,3 1,2,3 1,2,3

b) Observers error for chicane at (%)

50
ppsi
NLO
30
V
G L 250
delta
NLO
LM 8.2 -
EKF
NLO
EKF EKF
NLM 5.4 11.2
25
40 SMO SMO 200 SMO b) Model error - max/mean
LO LO
error max (%)

20
30 150
15
20 100
10
10 50
Table 3: a) Maximum measurement values for experimental
5

0 0 0
test b) Model error - max/mean
1 2 3 1 2 3 1 2 3
Z Z
1,2,3 1,2,3

side slip angle - experimentation


15 15 150
NLO NLO NLO
EKF EKF EKF 2
SMO SMO SMO
LO LO EKF+-3σ
error mean(%)

10 10 100 1.5

1
5 5 50

0.5

¼¹ º $- max/mean
0 0 0
delta (˚)

c) Observers error for chicane at h ¶


1 2 3 1 2 3 1 2 3
Z Z Z
1,2,3 1,2,3 1,2,3
0.5

L 1

/ 1 7: Observer error for chicane Chicane at 20, 60 and


1.5

&- max/mean
SMO

90 0
Figure EKF
LM
2 NLM
LO
NLO
2.5

7 Road tests 190 200 210 220 230 240


time (s)
250 260 270 280 290

7.1 Test conditions

Figure 8 presents the vehicle trajectory and acceleration dur-


Figure 9: Sideslip angle, Ÿ 
ing the tests. Table 3a) gives the maximum values for vehicle
speed, taken as the mean of longitudinal speeds of the two rear Figure 8 shows that longitudinal acceleration is not negligible,
wheels, and maximum yaw rate. and that longitudinal forces are present. The NLM simulation
has zero force input. This explains the error obtained in the cd.com), within the framework of the ”Action de Recherche
nonlinear model. The approximation of yaw rate obtained from pour une COnduite sécurisée” project, financed by the PREDIT
the models has a mean error lower than 10 %. program.
Because STRADA does not have a sideslip angle sensor, we
do not have a validation measure for sideslip angle. Figure 10
9 Appendix - Notations

— À°¬&
gives the maximum and mean error for yaw rate and velocity
œ¿
³´
estimations. Figure 9 presents the sideslip angle observed dur- Front, rear wheel cornering stiffness
ing the tests, and the confidence interval at for the EKF. À
Longitudinal front, rear force in the vehicle frame
³Á À
Transversal front, rear force in the vehicle frame
³Â À
ppsi VG
35 60
Longitudinal front force in the front wheel frame
˜Ã
NLO NLO

³ À
30 EKF EKF
SMO 50 SMO

0
Transversal front force in the front wheel frame
25 LO
error max (%)

0m&
40
20

jk
15
30 CG to front, rear axle distance
10

5
20

10
© ÄÅ_ ÅÆ
Speed of center of gravity
State vector
0
1 2
Z1,2,3
3
0
1 2
Z1,2,3
3
Ÿ
Ç °¬ Ä
Measurement vector
12 50
È Steering angle
°¬
È
NLO NLO

Vehicle sideslip angle


°¬
EKF EKF
10 SMO 40 SMO

ªu 
LO

°¬m&
Front, rear wheel sideslip angle
8
error moy(%)

30
6

4
20 Yaw rate
2 10

0 0
1 2
Z1,2,3
3 1 2
Z1,2,3
3 References
[1] S Chabraoui. ”observateurs à modes glisssants dédiés
aux systèmes possédant des singularités d’observation”.
Figure 10: Observers error - max/mean Journées Doctorales d’Automatique, Toulouse, France,
Figure 9 shows that the linear observer is the least accurate be- September 2001.

path. All observers are in the


œ¿
cause constant speed hypothesis is false along the experimental
bandwidth of EKF. The real
[2] U. Kiencke and A. Daiß. ”observation of lateral vehi-
cle dynamics”. Control Eng. Practice, 5(8):1145–1150,
sideslip angle is in this confidence interval. The three nonlinear 1997.
observers are close to each other.
[3] Uwe Kiencke and Lars Nielsen. ”Automotive control
system”. Springer-Verlag, 2000.
8 Conclusion
[4] Daniel Lechner. ”Analyse du comportement dynamique
This study deals with four different sideslip angle observers des véhicules routiers légers : développement d’une
with three sets of sensor. It consists of two parts. The first part méthodologie appliquée à la sécurité primaire”. PhD
includes simulation results. We can see from the results that thesis, École centrale de Lyon, Octobre 2001.
the measurement of the speed of center of gravity is not a de-
terminant variable in the estimation of sideslip angle. But this [5] S. Grewal Mohinder and P. Andrews Angus. Kalman
filtering theory and practice. Prentice hall, 1993.
Ÿ
measure gives a little estimation improvement. The EKF ap-
plied with the sensor set gives less accurate estimations than
[6] Wilfrid Perruquetti and Jean-Pierre Barbot. Sliding
NLO and SMO. There are some convergence problems with the
mode control in engineering. Marcel Dekker, Inc., 2002.
NLO with non-optimal initial states. Nonlinear sideslip angle
observers (NLO, EKF and SMO) give approximately the same [7] H Nijmeijer and A. J. Van der Schaft. Nonlinear Dy-
results. All observers are satisfactory when lateral accelera- namical Control Systems. Springer-Verlag, 1990.
tion is low. In normal driving conditions, lateral acceleration
is often low. Observers can provide a good estimation. Along [8] Laura R. Ray. ”nonlinear tire force estimation and road
the different paths, all observers are stable. They all represent friction identification : Simulation and experiments”.
transients qualitatively. Future studies will take into account Automatica, 33(10):1819–1833, 1997.
the four wheels and vertical dynamics, as well as providing a [9] Joanny Stéphant, Ali Charara and Dominique Meizel.
better model for longitudinal forces. ”force model comparison on the wheel-ground contact
for vehicle dynamics”. Proc. IEEE Intelligent Vehicle
Acknowledgments Symposium - Versailles, juin 2002.

This study was done in collaboration with the research group [10] P.J.TH Venhovens and Karl Naab. ”vehicle dynamics es-
”DIagnostic et Véhicules Avancés” financed by the Picardie timation using kalman filters”. Vehicle System Dynam-
region, and with the help of SERA-CD (http://www.sera- ics, 32:171–184, 1999.

Você também pode gostar