Escolar Documentos
Profissional Documentos
Cultura Documentos
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
ψ
δ
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:
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)
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
lx{& system is observable. This function is invertible if the jacobian
«
with is the pseudo-inverse: matrix has a full rank.
v¡
«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 {mx|| ~{ 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:
mx{lx{. (9)
ure 7b) normalized maximum error of SMO for sideslip angle
is: 30 %. The normalized mean error is therefore 9 %.
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
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
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
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
10 10 100 1.5
1
5 5 50
0.5
¼¹ º $- max/mean
0 0 0
delta (˚)
L 1
&- max/mean
SMO
90 0
Figure EKF
LM
2 NLM
LO
NLO
2.5
³ À
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
ª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.
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.