Académique Documents
Professionnel Documents
Culture Documents
THÈSE
par
Pierre-Emmanuel DUMONT
Composition du jury
http://www.univ-lille1.fr/bustl
Thèse de Pierre-Emmanuel Dumont, Lille 1, 2006
! " #" $ % &%" '()*+
,- .
/
.-
0
1
2
/
3 2 #32+ 4 /
5
6
4 /
7-
/ 8
9
. 3 & "
"-:
. ; <
%
&
-
=
.
3777 % 2
8
;
>?
%
/ &%
;
%
@A 2
.-
B
/
7- 4
: %
@A
-
4 / /
3 2 8
http://www.univ-lille1.fr/bustl
Thèse de Pierre-Emmanuel Dumont, Lille 1, 2006
' #
( )
-: 7
/
/
-:
-
-: 8B
-:
-:
/
5
5 5
5
-: # +
C
8
5 -:
#><" 9
> < "-+
><"
-: /
7
8
/ 7
#+
:
-:
7 -: 6
-:
- 5
D
/
.
/ -
-:
4
L3 FII(M
-:
L; FII)M $
L; FII)M 5 - -:
7
%<,&2 #% < , & 2-+
8
/
F
5 -:
L; FIIKM
" -:
;
.
8
><"
?
> " .
FIII FII* #
N
+
(
- : ; B
#
F+ ><"
5 8
FIII
-
" .
II " .
IH " .
I*
H * K
K K H
.
( F H
% I ( F
( O &
/ " .
><"
" .
II " .
IH " .
I*
K G F
%
5 ) * (I
F O &
/ " .
><"
#
+ 2
-: 8
D
#
+ B
#
. 5
-:
B -:
-:
-:
/
; ? -:
B
L. (GGEM 9 -:
#><" 9
> <8
"-+ #.><" 9 . > < "-+
.><"
?
-:
><" 9
O
/
/
=
/
/
5
O
.
B
/
;
:
E
-:
;
B
2
><"
5
/ 5
. .><"
9
O
O -:
O
/
-:
2 /
: 8
:
7
L (GGHM : 8
B
/
'
-: 9
" -:
T0(s) T1(s) Tn(s) T0(s)
-: T1(s) Tn(s)
: 9 88
K -: Ti (s)[I + K(s)Ti (s)]−1 #R i = 1, . . . , n+ V ;
:
/
-: :
5 ((
n -:
Tn(s)
Défaut
Consigne T1(s)
+ Sortie
-
T0(s)
K(s)
25 :
.><"
L (GGEM
7
5
: θ
/
P 2
5
: : θ
:
θ
-:
B 5 (F 9
J
9
Consigne Régulateur u y
Procédé
+ ajustable +
- +
Performance
désirée
Comparaison Mécanisme
Décision d'adaptation
Mesure de
performance
Générateur Controleur de la
de consigne chaîne d’action Actionneur système capteur y
reconfigurable
Controleur de la
chaine de retour
reconfigurable
Mécanisme de
reconfiguration du
contrôleur
O $
5
-:
>;
-:
: ><"
58
C ;
8
: /
><"
-:
8
8-:
:
8/8 8
D -:
6 /
8
5
.
5
/)0
1
=
5
C ;
7
8
/
C
5 : -: : B
8/8
{Af , Bf , Cf } B
Kf : 8
5 ;
>;
{Af , Bf , Cf }
8/8 : -:
R
;
:
8
L, @AT
@ (GGEM LY
4 FIIHM
C8
5
:
:
/
C 8 B
L (GGEM L& FIIIM LY
4 FII(M
-
1
$
:
- -: :
: B
/
B
5
:
" -: B
5
: 5
5
:
/
B L,A
FIIFM L<
FIIHM LW 3 FIIHM
/
385 S><
/
# +
8
C
.><"
C 5
=
/
8
.><"
B
C
5
><"
L"
FII)M
C .X
/
5
$
: 7
/ ><"
B : /
#
+ ;
B 9
O
5
B
O
C
B
O
B
O
O
O 5
-:
/ :
8
-
#
+ /
#
-
8
+ 7
/ 5 N
;
/
*
/ -: 6
. - 5
9
O >
-: $ -:
8
#
: -:+ -:
O ;
t t t
a) défaut abrupt b) défaut intermittent c) défaut graduel
#
+ 9
O
O : -:
O ;
O
B 5
.
/
R
5 :
(G
Rétroaction du
régulateur Perturbation Dysfonctionnement
processus capteurs
Défaillance
contrôleur Unité en
u régime Capteurs y
Actionneurs
transitoire
Défaillances
d’actionneurs Défaillances
de structure
Système de
diagnostic
[
6
9
- -: /
;
R
: :
: 8 B :
2
P
5 (*
2 -:
C
2
-
LXA FIIHM 9
O
:
O
J :
B S
O ;
B
#
+
9
# +
#
:+
#
/
/
+
-:
LXA8
FI
1
7 2
-
8
B -:
7
-:
& / 5 (E
L<
FIIKM 2
-
:
8
:
-
: - 8
-
*
3
;
8
- D / #
-+ P
8
"
/
5
L (GG*M 2
-:
-:
Z L (GEEM L<A " (G'KM
8
L; (GGIM L; (GGEM L, FIIIM
:
-:
:
*
3
N
O -
9 -
Q
2
/
: : -
#
+
8
1
@ B
8
>
R
;
:
- :
O
9
-
:
#
+
: : 8
/ -
#
+ 2
:
6
- -
#.+
# .+ / 8
# +
- 2 )
4
/ :
-: - 8
F)
défauts perturbations
u y
Système
T n Vecteur paramètre nominal
+
Modèle Estimation Tˆ r Logique de Localisation
du paramétrique
système temps réel
- décision
+
gain
erreur -
modèle Sortie
reconstruite
Estimateur
H 2
L" FIIHM 9 : 7 8
/
#L
T (G'IM L
T 0A- (G')M L.
(GG(M
L (G'*M L. " (GEEM L% (GG*M+ 78
# -:+
B
8
- #%%+
/
: #
+
2 L (GG'M
-: 9
ẋ(t) = Ax(t) + Bu(t)
y(t) = Cx(t)
#()+
R x ∈ Rn
u ∈ Rm
y ∈ Rp
A ∈ Rn ∗ Rn B ∈ Rn ∗ Rm C ∈ Rp ∗ Rn 2
/ : ()
FE
% 9
8
>A 0^
/
L>A 0^ (G'GM .
8
L; (GGGM L
(GGHM
L (GG(M L.
(GG(M
; B
; L"T
A (GGHM L; (GG)M
L; (GGKM
-
:
B
. L (GGKM
- :
F'
Fenêtre Fenêtre
d’observation d’observation
Uf Yf
WQ
- + W
r(t)
R L
i
: I
e
1
ẋ1 = − R
L x1 + L u1
ẋ2 = − Jf x2 + K
#((I+
J x1 u2
HI
!
;: -:
/ -
-
#;
+
-: 8 #
+ $ :
/
#
+
:
/
e1 e2 e3 e1 e2 e3
r1 1 0 0 r1 0 1 0
r2 0 1 0 r2 1 0 1
r3 0 0 1 r3 1 1 1
(a) (b)
Commutation commandée
par le module de
reconfiguration reconfiguration
Contrôleur :
Sans défaut
CN
surveillance
défaut n°1
Cf1 y
actionneurs système capteurs
r défaut n°2
+-
Cf2
Cfn
défaut n°i
;
5
Bf
9
Bf = Bs BF
R BS
n × (m − k)
BF
n × (k)
k
2
7
+
O t ∈ [td; ∞[ 9 -:
5
C
C
HK
9
O
#.><"+
O
#><"+
&
9 ><"
><"
B
:
8
# / :+
" -: :
:
- -:
2
5 # /
H*
HE
9
*1 !
Θ '
n (
%
(C, A)
-: 58
2 -:
/ 9
5
)
*
ẋ1 = 2ux2 + 3x1
ẋ2 = u #FH+
y = x1
#
x1 '
x2
#
* x2 = (ẏ − 3y)/2u
u = 0 "
#
'
#
% u
+
, !
/
5
B -:
7
:
:
-: .
/
L&77 "
(GGIM
% * 5
L3 U (GEEM
*1
*
ẋ(t) = f (x, u)
y = h(x)
#F)+
HG
$
: L @ FIIHM 8
-: 9
)
* ⎛ ⎞
∂h
∂x
⎜ ⎟
⎜ ∂Lf
⎟
⎜
Obs = ⎜
⎜
h ∂x
⎟
⎟
⎟
#FE+
⎝ ⎠
∂Ln−1
f
h ∂x
1
!
1
%
*
rang(Obs) = n #F'+
- Lf h
!
/$
!
.0
p ∗ n
)I
;
9
L0f hi (x) = hi (x)
Lf (Lf hi (x)) = L2f hi (x)
#F(I+
$
: F 9
!
1
%
/Rn0
/Im(Obs)0
/))
;
6
J 8
8
/ E
5
;
8
9
! . ' E
% .
E
/Im(obs)0
:
- 5 -:
-:
8
x0 B /
5
u(t) > 5
9
)(
: .
-:
-: 9
x(k + 1) = 0 #F((+
-:
:
9
/
.
@
/ 8
- -: "
&
/
7
;
:
Δ3 ΔN +1 B
9
m
ΔN +1 = ΔN + [f, ΔN ] + [gi , ΔN ] #F(*+
i=1
/ k = k Δk +1 = Δk # k = N − 1 R N
+
:
/
-: .
6 Δk
/
#RN +
#Δk +
;
)H
#
+ 5
B
8 /
/
P
8
8
&
-: 9
⎧
⎪
⎪
⎨ ẋ(t) = f (x, u)
⎪
y(t) = h(x(t)) #F(E+
⎪
⎩ z(t) = e(x(t))
R x(t) ∈ Rn
u(t) ∈ Rm
y(t) ∈ Rp
z(t) ∈ Rq
/ #
q ≤ n+
))
L,
U
(G'EM 8
-:
8
)K
⎛ ∂hi
⎞
∂x
⎜ ⎟
⎜ ∂Lf hi ⎟
⎜
vi = rang ⎜
⎜
∂x
⎟
⎟=n
⎟
#FFI+
⎝ ⎠
∂Ln−1
f hi
∂x
⎛ ∂hi
⎞
∂x
⎜ ⎟
⎜ ∂Lf hi ⎟
⎜ ⎟
OBS(i, α) = ⎜
∂x
⎟
α > 1
⎜
⎝ ⎟
⎠
∂Lα−1
f hi
∂x
.
8
2
8
@
8
+ :
+
*1 & )
i %% /i ∈ Ic 0 . Γi
vi # - vi
# $
6
! . Γi *
⎛ ∂hi
⎞
∂x
⎜ ⎟
⎜ ∂Lf hi
⎟
⎜
Γi = Im ⎜
⎜
∂x
⎟
⎟
⎟
#FFH+
⎝ v −1
⎠
∂Lfi hi
∂x
rang
E
OBS(i, vi )
= rang(OBS(i, vi )) #FF)+
- OBS(i, vi ) $
$
7
" vi = n -:
:
i
ΓI
Ic 9
c
rang
E
OBS(Ic , v)
= rang(OBS(Ic , v)) #FF*+
- OBS(Ic , v) $
$
7
8 (
* !
4 %
8
*
dim(ΓIc ) = n #FFE+
+
" J 8
Ic Ic \ J
8
Ic ;
-:
*1 3 3.
/390 * 2 Ic
3.
#
*
⎧
⎪
⎨ Im(E) ⊆ ΓIc
⎪
∀J ⊂ Ic ,
⎪
et #FF'+
⎪
⎩ Im(E) ⊆ Γ
Ic \J
&
-: 6
9
⎧
⎪ m
⎪
⎪ ẋ(t) = f (x(t)) + gi (x(t))u(t)
⎨
⎪ y(t) = h(x(t))
i=1
#FH(+
⎪
⎪
⎩
z(t) = e(x(t))
R x(t) ∈ Rn
u(t) ∈ Rm
y(t) ∈ Rp
z(t) ∈ Rq
/ #
q ≤ n+
f gi h e 2
gi
g
: 9 g = [ g1 g2 . . . gm ]
)
%
.
%
gi (x) =
Δk
*
)
*
Δ0 = Span{gi } #FH)+
&
# Δ0 !
f gi
Δ1 = Δ0 + [f, Δ0 ]} #FHK+
[f, gi ](x) = ∂g∂x f (x) − ∂f
i
∂x gi (x) 3
# Δ2 *
0
-: FH(
*1 " 2
.
μ
'
Ia
*
T
ACC(Ia , μ) = ACC(1, μ1 ) ACC(2, μ2 ) . . . ACC(m, μm ) #FH'+
*
rang
E
ACC(Ia , μ)
= rang(ACC(Ia , μ)) #FHG+
- ACC(i, α) = []
α = 0
ACC(i, α) = Δα−1 Δα−1
i
α≥1
KI
2
8
8
8
+ :
-:
/
+
*1 )
i
%% /i ∈ Ia0
.
Γi
vi # - vi
# $
1
! . Γi Δk *
i
ΓI
Ia 9
a
"
* !
4 %
*
dim(ΓIa ) = n #F)(+
K(
Ia
Ia 8
Ia
E
*1 & 3
3.
4 /3)0 * 2
Ic
3.
4 #
3.
3. 2 3.
4
3 !
/0
:% *
!
*
;
'
4
/0
;
' #
'
'
4
"
7
5 -:
e(x)
Ia \ {j}
B
5 9
Im(E) ⊆ Γ1 ⊕ ... ⊕ Γj−1 ⊕ Γj+1 ⊕ ... ⊕ Γm #F))+
KF
1
t1,2 t1,4
t1,3
2 3 4
t2,6 t3,5 t3,7 t4,6
t2,5 t4,7
5 6 7
KH
1
t1,2 t1,4
t1,3
2 3 4
t2,6 t3,5 t3,7 t4,6
t2,5 t4,7
5 6 7
=
#
5 FH+ 2 ?
#I _
( _
+
2% 2 2 #I _ 2 ( _ 2% 2 +
"
/
e
B
0 : Capteur défaillant 0 : EI
1 : Capteur sain 1 : ER ou EM
5
;
5
/
(J, e) R J 8
e
-8
: - 2
:
*1
*1
* !
df (J, e)
(J, e)
J %
'
e * df (J, e) = |J| − min
i
|EMi |# - EMi
.
%%
J
KK
F 2 b c
/
e =
/ a 6
a / {b, c}
2
/ :
$ #
+
*1
* ! dF (J, e)
(J, e)
J %
'
e# %%
"
% #
* dF (J, e) = |J| − max
i
|EIi | − 1
! 2
> 9
O
(J, e) B
j
j
O
(J, e)
j
/ 8
2
(
5
1)
K*
y1 y2
c1 c2
Ic
8
/ z = e(x) = E.x = x E = 0 0 1
x1 1 0 0
3
/
5
-Q 8
: 5
&
-:
-
@
/ 3
&
B
: F -:
x u
z /
x u
))
KE
;: 5 G :
: K F(
8
#+ 8 #&+ 2
8
(3, 0)
(2, 1) &
(1, 2)
(0, 3) &
F( O
8
;
5
8 μ = (1, 2) &
9
T
OBS(Ic , μ) = OBS(1, 1) OBS(2, 2) #F)G+
OBS(1, 1) =
∂h2
∂h1 ∂x
∂x OBS(2, 2) = ∂Lf h2
∂x
⎛ ⎞
1 0 0
⎜ ⎟
OBS(Ic , μ) = ⎜ ⎟
⎝ 0 1 0 ⎠ #FKI+
0 0 2
9
rang
E
OBS(Ic , μ)
#FK(+
= rang(OBS(Ic , μ))
8 / E
@
K'
1
t1,2 t1,3
2 3
t2,4 t3,4
2+
,
{} 286
+
!
5
;: 5 FF F(
Ic
/ (
8
E
KG
"
-:
/
/
; %<,&2 : /
*I
;< )
;
: 9
⎧
⎪
⎨ y1 (k) = x2 (k) = x1 (k − 1) = −x2 (k − 2) + x6 (k − 2)
⎪
⎪
y2 (k) = x3 (k) = x2 (k − 1) = x1 (k − 2) #FKK+
⎪
⎩ y (k) = x (k) = x (k − 1) = 2x (k − 2)
3 4 5 1
&
: y(k) x2(k) x3(k) x4(k)
x1 (k − 1) x5 (k − 1) x6 (k − 2)
x(k − 2) B / k #=
/ y(k)+
k k − 2
B
x(k − 2) B / k =
/ y(k)
" :
# +
k k + 1
$ -: y3
;
/
-:
2
xk−1 B / k + 1
5 :
3
-:
/ B / k + 1
F)( =
/ FKK
/ k FF
x2 (k) x1 (k − 1) x6 (k − 2)
x3 (k) x5 (k − 1)
x4 (k)
x2 (k + 1) x2 (k) x1 (k − 1) x6 (k − 2)
x3 (k + 1) x3 (k) x5 (k − 1)
x4 (k) x6 (k − 1)
x1 (k)
x2 (k + 2) x2 (k + 1) x2 (k) x1 (k − 1) x6 (k − 2)
x3 (k + 2) x3 (k + 1) x3 (k) x5 (k − 1)
x1 (k + 1) x4 (k) x6 (k − 1)
x1 (k)
x6 (k)
R x(t) ∈ Rn
u(t) ∈ Rm
y(t) ∈ Rp
z(t) ∈ Rq
/ #
q ≤ n+
Ic 8
*
< )
5
%<,&2
Ic :
/
8
FH(
.
8 μ = μ1 . . . μp
9
μ = max μi
i∈Ic
#FK'+
*1 )
M (Ic ) .
' Ic
2 <
' M (Ic )
- )
max
i∈I
(Δi ) = ∞# Ic
c
Ic
- )
max
i∈I
(Δi ) = ∞# Ic
c
Ic ' 3 df (Ic , E) ≥ 1 *
; )
Δ = ∞# dF (Ic , E) ≥ 1
; )
Δ < ∞# dF (Ic , E) = 0
*)
2
Ic
i %<,&2
i Δi
/ # +
5 -:
-: N /
2
7 / B
.
%<,&2 -: Δ
/ # +
5 -:
N /
/
B
2
⎛ ⎞
0 −1 0 0 0 1
⎜ ⎟
⎜ 1 0 0 0 0 0 ⎟ ⎛ ⎞ ⎛ ⎞
⎜ ⎟
⎜ ⎟ C1 0 1 0 0 0 0
⎜ 0 0 0 0 ⎟
R A=⎜
⎜
0 1 ⎟
⎟ C = ⎜⎜⎝ C2 ⎟⎟⎠ = ⎜⎜⎝ 0 ⎟
0 1 0 0 0 ⎟
⎠ E
⎜ 0 0 0 0 1 0 ⎟
⎜ ⎟ C3 0 0 0 1 0 0
⎜ 2 0 0 0 0 0 ⎟
⎝ ⎠
0 2 0 0 0 0
6
/ z q = n = 6
-: p = 3
Ic
Ic
.
%<,&2 -:
c
8 #
8
+ FK
5
8
M (Ic)
*K
(
F
H
μ1 μ2 μ3
I ( K
I F )
I ) F
( ( )
H ( F
FK O X
8
;< )
μ1 μ2 μ3 μ = max μi
i∈Ic
I ( K K
I F ) )
I ) F )
( ( ) )
H ( F H
F* O ; B
B 9 s = 3
5
F)(
**
. ⎛
⎞
⎛i ⎞
μ⎛i ⎞
μi = {μ(i), μ ∈ M (Ic)} 9
0 1 5
⎜ ⎟ ⎜ ⎟ ⎜ ⎟
⎜ 0 ⎟ ⎜ 2 ⎟ ⎜ 4 ⎟
⎜ ⎟ ⎜ ⎟ ⎜ ⎟
⎜ ⎟
⎜ ⎟
μ1 = ⎜ 0 ⎟ μ2 = ⎜ 4 ⎟
⎜ ⎟ ⎜ ⎟
⎜ ⎟
μ3 = ⎜ 2 ⎟
⎜ ⎟
⎜ 1 ⎟ ⎜ 1 ⎟ ⎜ 4 ⎟
⎝ ⎠ ⎝ ⎠ ⎝ ⎠
3 1 2
1
F*I
μ = 0 μ2 = 1 μ3 = 2 >
O
( μ1 = 0
Δ1 = ∞
/
1
8 -: 5
Ic \ c1 7
2 2
O
F H μ = 1 μ = 2
Δ2 = s − μ = 2 Δ3 = s − μ3 = 1
3
/ :
F H @ 7 /
B
F (
2
Ic Δ = min (Δi ) = 1
/
7 /
i∈I c
max (Δi ) = ∞ Δ = 1 < ∞
=
: F
Ic
Ic /
i∈Ic
:
.
8B /
5
8 L
FII)M
$ %<,&2 B
7 :
B 8
5 -:
:
-
5
? % &% 8
-
L, (GGGM
4/
?
:
:
%
/
8
%
: :
=
/
#)
) F
+
/
/
. /
*G
2
-
#-
+ 25 -: 6
3
&1
$
: &
8
/
-
%
-
8
"
C
"
<
"
< #"<F+
> H(
:
/
#FI AP
+
%
/ 9
O : / -
O
8/8
L, (GGGM
EI
!
! "
# $
% & # ' ! ! "
& ( &)
O
C
O ."
x y
O
"
#
5
HFF+
&
%
:
C
8
9
O )
# +
C
O ) /
# + /
O F
# +
7 7-
A
%
/
C :
-
7
O A 9 .
: B
:
;
/
-8
-: 2 5
/ -
8
*1
.
"
- / 8
8
/
8
-
/
L (GGFM 9
O
O
:
EH
-
/
.
8/ 8
/ 5 9
/
J 5
8
ω.R − V
G=
V
R ω R - V
7
.
7
J
2o 5o
: =
/
HFF
-
8
8
-:
; :
: 8
EK
$ :
6
5
- #:
+ :
5:
J
; L; (GEIM L.
7A "
(GG(M
L < (GGGM L @A FIIFM
:
7
J
:
.
:
-
- 8
:
:
: -
L; (GEIM
-
: 8
.
E*
. %
-
: 9
O #
+
O
/ FI AP
#
%+
O :
#
+
O
9 -
#5 eHFF+
/
Z
-
EE
$
#5 HK+
b
a
Dr
Fx1
Fx 3
Fy 3 Df
Dr
Fx 4
Fy 4 Fx 2 Fy1
Df
y
Fy 2
x
HK O ;
>
ieme ∈ [1, 2]
6
Ji fi
-:
# b
+ 5
θ i θi
dx vx ax
P
E'
+)
$
%
&
9 -:
8
8
- -:
88
5
P
O
1 9 U1
1
2
1 9
J1 θ̈1 + f1 θ̇1 = U1 + RFx1 cos αf + RFy1 sin αf
EG
8
Fx + Fx + Fx + Fx
Fy +
1 2 3 4 1
7
-
O 9
M ax = −(Fx + Fx ) cos αf − (Fx + Fx ) cos αr − (Fy + Fy ) sin αf − (Fy + Fy ) sin αr #HF+
1 2 3 4 1 2 3 4
Fy2 ) sin αf D
O
9 Uf
:
9
Jf α¨f + ff α˙f + kf αf = Uf − (Fx1 + Fx2 ) cos αf D − (Fy1 + Fy2 ) sin αf D #H)+
; B :
:
9
Jr α¨r + fr α˙r + kr αr = Ur − (Fx3 + Fx4 ) cos αr D − (Fy3 + Fy4 ) sin αr D #HK+
'I
800
600
400
200
Fxi en N
0
−200
−400
−600
−800
−1000
−1 −0.5 0 0.5 1
Gi normalisé
H* O
8
Fxi
5!
2
8
:
Iz Γ̇ =
M (Fext ) R M (Fext )
/
Fx4 ) sin αr + d
2 (Fx1 − Fx2 ) cos αf + d
2 (Fx3 − Fx4 ) cos αr
O
P
7
9 a(Fy + Fy ) cos αf − b(Fy + Fy ) cos αr #
1 2 3 4
P
7
+
> 9
Iz Γ̇ = −a(Fx1 + Fx2 ) sin αf + a(Fy1 + Fy2 ) cos αf + b(Fx3 + Fx4 ) sin αr − b(Fy3 + Fy4 ) cos αr
+ d2 (Fx1 − Fx2 ) cos αf + d2 (Fx3 − Fx4 ) cos αr
#H*+
5
? " / 5
HFF
HFF
8
HFF
" L
FII(M
8
5 H*
B 9
Fx = α0 sign(Gi ) − α1 e−β(|G |) sign(Gi ) − α2 (Gi )
i
! ! !
i
#HE+
f. sec adhérence glissement
'(
9
#HG+
Fy = Fy = α0 sign(αf ) − α1 e−β (|α |) sign(αf ) − α2 (αf )
1 2
f
" u
-: 9
T
u= u1 u2 u3 u4 uf ur
θ˙1θ˙2θ˙3 θ˙4
dx dy ."
: αf αr
5
Γ
25
-: 9
T
x= θ˙1 θ˙2 θ˙3 θ˙4 vx dx vy dy αf
˙ αf α˙r αr Γ
'F
2
#sin αf = αf sin αr =
αr cos αf = 1 cos αr = 1+ H( HF HH H) HK H* -
6
9
ẋ = f (x) + B.u
y = C.x
#H((+
R
⎛ RFx1 RFy1 x10
⎞
− Jf11 x1 +
J1 +
⎜ J1 ⎟
⎜ RF RF x
− Jf22 x2 + J2x2 + yJ22 10 ⎟
⎜ ⎟
⎜ RF RF x ⎟
⎜ − Jf33 x3 + J3x3 + yJ33 12 ⎟
⎜ ⎟
⎜ RF RF x ⎟
⎜ − Jf44 x4 + J4x4 + yJ44 12 ⎟
⎜ ⎟
⎜ +Fx2
− Fx1M − Fx3M +Fx4 F +F F +F
− y1M y2 x10 − y3M y4 x12 ⎟
⎜ ⎟
⎜ ⎟
⎜ x5 ⎟
⎜ ⎟
⎜ F +F Fx3 +Fx4 Fy1 +Fy2 Fy3 +Fy4 ⎟
f (x) = ⎜ − x1M x2 x10 − x12 + + ⎟
⎜ M M M ⎟
⎜ ⎟
⎜ x7 ⎟
⎜ Fx1 +Fx2 Fy1 +Fy2 ⎟
⎜ f
− Jff x9 −
kf
x10 − D − x10 D ⎟
⎜ Jf Jf Jf ⎟
⎜ ⎟
⎜ x9 ⎟
⎜ ⎟
⎜ Fx3 +Fx4 Fy3 +Fy4 ⎟
⎜ − Jfrr x11 − kr
Jr x12 − D − x12 D ⎟
⎜ Jr Jr ⎟
⎜ x11 ⎟
⎝ ⎠
a
Iz (−Fx1 − Fx2 + Fy1 + Fy2 )x10 + b
Iz (Fx3 + Fx4 − Fy3 − Fy4 )x12 + d
2Iz (Fx1 − Fx2 + Fx3 − Fx4 )
#H(F+
⎛ ⎞
1 0 0 0 0 0 0 0 0 0 0 0 0
⎜ ⎟
⎜ 0 1 0 0 0 0 0 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 1 0 0 0 0 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 0 1 0 0 0 0 0 0 0 0 0 ⎟
⎜ ⎟
C=⎜
⎜ 0 0 0 0 0 1 0 0 0 0 0 0 0 ⎟
⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 0 1 0 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 0 0 0 1 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 0 0 0 0 0 1 0 ⎟
⎝ ⎠
0 0 0 0 0 0 0 0 0 0 0 0 1
'H
⎛ ⎞
1/J1 0 0 0 0 0
⎜ ⎟
⎜ 0 1/J2 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 1/J3 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 0 1/J4 0 0 ⎟
⎜ ⎟
⎜ 0 ⎟
⎜ 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
B=⎜ 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 ⎟
⎜ 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 1/Jf 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 1/Jr ⎟
⎜ 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 ⎟
⎝ ⎠
0 0 0 0 0 0
- / : - %
- -:
8
/
3
7 / B 8
1 B
5
-: %<,&2 Ic
5 6 1 / 5
1
∞ %<,&2 Ic 1 Ic
1 1
'K
%<,&2 B 7
%<,&2 Ic / K
Ic
:
2 2
5
-
><2 #> <8
2+
5 /
&
3
; B - %
:
5 -
%
/
& 5
B
7
T
&
z = x5 x6 x7 x8 x13
/
2
C 5 7
#x6 x8+ /
#x5 x7+
#x13+
" / - -:
:
7
# {u1, u3} {u2, u4}+ 8
/
;
)
{u1, u2, u3, u4, u5}
#
:+ 2
{u1, u2, u3, u4}
8
'*
"
%
;
;
5
% / Q
7
/
; : :
#eH)(+
/
%
B
:
7
7
/
/
5
7
C
-:
7
/
+
' )
$
B
L> &8- (GGKM L (GGKM L @ FIIHM &
'E
⎪
i=1 #H(H+
⎩ y = h(x)
=
/ 5 / )( -: H()
9
p
ẏi = Lf hi (x) + Lg hi (x).uk k
#H(K+
k=1
yi
9
p
p
ÿi = Lf (Lf hi (x)) + Lgk (Lf hi (x)).uk = L2f hi (x) + Lgk Lf hi (x).uk #H(*+
k=1 k=1
2 / Lg Lf hi(x) = 0 ∀k ∈ {1, ..., p} 7/
k
-: :
/
l #l ≥ 2+ 9
p
yil = Llf hi (x)) + Lgk Ll−1
f hi (x).uk #H(E+
k=1
''
rang(Δ(x)) = p
yi = 1 0 . . . 0 .zi #HFK+
'G
;
R
Δ(x) k / -: # i=1
p
ρi =
k < n+
8 8 #p = 1+
B
: LU
FIIFM 9
⎛ ⎞
h(x)
⎜
⎜
⎜
⎟
⎟
⎟
⎜ ⎟
⎜ Lk−1 h (x) ⎟
⎜
z = Φ(x) = ⎜ f
⎜ Ψ1 (x)
i ⎟
⎟
⎟
#HFE+
⎜
⎜
⎜ ⎟
⎟
⎟
⎝ ⎠
Ψn−k (x)
R
Ψi(x) 5
R xe
-: #H(H+# f (xe) = 0+ 9
⎧
⎨ Ψi (xe ) = 0
⎩
n
∂Ψi (x) ∀i ∈ {1, ..., n − k} #HF'+
∂x gi (x) = 0
i
i=1
;
5
#-
- @+
/ - Ψ1 Ψn−k
n − k
9 "
ui = vi dt ⇔ u̇i = vi #HFG+
ui vi
9
-
3 AB
# >>C 9 -:
9
⎧
⎪ 2+x2
⎪
⎪ x˙1 = −x1 + 1+x32 u
⎪
⎪ 3
⎨
⎪
x˙2 = x3
#HHI+
⎪
⎪ x˙3 = x1 x3 + u
⎪
⎪
⎩ y=x
2
8 : %
/ 'H 6
G(
⎛ ⎞
1 0 0 0 0 0 0 0 0 0 0 0 0
⎜ ⎟
⎜ 0 1 0 0 0 0 0 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 1 0 0 0 0 0 0 0 0 0 0 ⎟
Cu = ⎜
⎜
⎟
⎟
⎜ 0 0 0 1 0 0 0 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 0 0 0 1 0 0 0 ⎟
⎝ ⎠
0 0 0 0 0 0 0 0 0 0 0 1 0
:
/
⎧
⎪
⎪ ẏu1 = ẋ1 = − Jf11 x1 +
RFx1
+
RFy1 x10
+ u1
⎪
⎪ J1 J1 J1
⎪
⎪ RFx2 RFy2 x10
⎪
⎪ ẏu2 = ẋ2 = − Jf22 x2 + + + u2
⎪
⎪
J2 J2 J2
⎨ ẏ RFx3 RFy3 x12
− Jf33 x3
#HH'+
u3
u3 = ẋ3 = + J3 + J3 + J3
⎪
⎪ ẏu4 = ẋ4 = − Jf44 x4 +
RFx4
+
RFy4 x12
+ u4
⎪
⎪ J4 J4 J4
⎪
⎪
⎪
⎪ ẏu5 = ẋ10 = x9
⎪
⎪
⎩ ẏ = ẋ12 = x11
u6
: 8
:
ρ1 = ρ2 = ρ3 = ρ4 = 1
.
yu yu
5 6
f kf Fx1 +Fx2 F +F
D − y1Jf y2 x10 D + Juf5
ÿu5 = x˙9 = − Jff x9 − Jf x10 − Jf
F +F F +F #HHG+
ÿu6 = x˙11 = − Jfrr x11 − Jkrr x12 − x3Jr x4 D − y3Jr y4 x12 D + uJr6
ρ6 / F
ρ5 = ρ6 = 2
GF
⎪
L h (x)
⎛ f 6
Lg L0f h1 (x)
f (x)
⎞ ⎛ 11 ⎞ #H)I+
⎪
⎪ 1/J1 0 0 0 0 0
⎪
⎪ ⎜ ⎟ ⎜ ⎟
⎪
⎪ ⎜ 0 ⎟ ⎜ ⎟
⎪
⎪ ⎜ Lg Lf h2 (x) ⎟ ⎜ 0 1/J2 0 0 0 0 ⎟
⎪
⎪ ⎜ ⎟ ⎜ ⎟
⎪
⎪ ⎜ Lg L0f h3 (x) ⎟ ⎜ 0 0 1/J3 0 0 0 ⎟
⎪ Δ(x) = ⎜
⎪ ⎟=⎜ ⎟
⎪
⎪ ⎜ 0 h (x) ⎟ ⎜ ⎟
⎪
⎪ ⎜ L g L 4 ⎟ ⎜ 0 0 0 1/J4 0 0 ⎟
⎪
⎪ ⎜ f ⎟ ⎜ ⎟
⎪
⎪ ⎜ Lg L1 h5 (x) ⎟ ⎜ 0 ⎟
⎪
⎪ ⎝ f ⎠ ⎝ 0 0 0 1/Jf 0 ⎠
⎪
⎩ 1
Lg Lf h6 (x) 0 0 0 0 0 1/Jr
u = α(x) + β(x).v
: HF( ⎛ ⎞
J1 f1 (x)
⎜ ⎟
⎜ J2 f2 (x) ⎟
⎜ ⎟
⎜ ⎟
⎜ J3 f3 (x) ⎟
α(x) = − ⎜
⎜
⎟
⎟ #H)(+
⎜ J4 f4 (x) ⎟
⎜ ⎟
⎜ Jf f9 (x) ⎟
⎝ ⎠
Jr f11 (x)
⎛ ⎞
J1 0 0 0 0 0
⎜ ⎟
⎜ 0 J2 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 ⎟
β(x) = ⎜
⎜
0 0 J3 0 0 ⎟
⎟ #H)F+
⎜ 0 0 0 J4 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 Jf 0 ⎟
⎝ ⎠
0 0 0 0 0 Jr
v 5
9
⎛ ⎞ ⎛ ⎞
v1 ẏu1
⎜ ⎟ ⎜ ⎟
⎜ v2 ⎟ ⎜ ẏu2 ⎟
⎜ ⎟ ⎜ ⎟
⎜ ⎟ ⎜ ⎟
⎜ v3 ⎟ ⎜ ẏu3 ⎟
v=⎜
⎜
⎟=⎜
⎟ ⎜
⎟
⎟ #H)H+
⎜ v4 ⎟ ⎜ ẏu4 ⎟
⎜ ⎟ ⎜ ⎟
⎜ v5 ⎟ ⎜ ÿu5 ⎟
⎝ ⎠ ⎝ ⎠
v6 ÿu6
GH
GK
> x2
C
#$x2 → 0+
6
li 6
#y# → 0+ 2 li B 5 7
<
/
5
B
%
B
G*
"
-:
v = −K.z + H.r
C . -: H)K
9 ż = (Az − Bz .K)z
=
/
-:
r
: -:
#e H)(+ #e H)(+
#e H)(+ B :
5 HE
réf H v u
+
-
E +
+
B +
+ ³ C y
K f (x)
+
4
%
-:
?
8
;
-: 7
/
;
-:
5 HE 5
7
7 7
/
-:
5 H'
" 5 H'
9
.5
7
C 2
9
GE
yest Estimateur de la u
position de RobuCar
xest y
G'
T1des
T2 des
vdes 1/R T3 des
trajdes
T4 des
ydes
xest ydes Hy
+ PID D f des
-
xest
yest
.
/ :
B
X
8B
& 9
J1 θ̈1 + f1 θ̇1 − RFx − RFy αf − u1 = 0 #H*H+ 1 1
G1 = Rθ˙v−v y = θ˙1 θ˙2 θ˙3 θ˙4 dx dy αf αr Γ T
1
x
x
Fx = α0sign( Rẏẏ−ẏ ) − α1e−β(| |)sign( Rẏẏ−ẏ ) − α2( Rẏẏ−ẏ )
Rẏ1 −ẏ5
1 5 ẏ1 1 5 1 5
1 1 1 1
Fy = α0sign(y7 − ẏ +yẏ a ) − α1e−β (|y − |)sign(y7 − ẏ +yẏ a ) − α2(y7 − ẏ +yẏ a )
ẏ6 +y9 a
6 9 7 6 9 6 9
ẏ5
1
Rẏ1 −ẏ5
−β(| |)
J1 ẏ1 + f1 y1 − R(α0 sign( Rẏ1ẏ−
1
ẏ5
) − α1 e ẏ1
sign( Rẏ1ẏ−
1
ẏ5
) − α2 ( Rẏ1ẏ−
1
ẏ5
))
ẏ +y a
ẏ6 +y9 a −β (|y7 − 6 ẏ 9 |) ẏ6 +y9 a ẏ6 +y9 a
−R(α0 sign(y7 − ẏ5 ) − α1 e 5 sign(y7 − ẏ5 ) − α2 (y7 − ẏ5 ))y7 − u1 = 0
#H*)+
>
9
Rẏ1 −ẏ5
−β(| |)
r1 = J1 ẏ1 + f1 y1 − R(α0 sign( Rẏ1ẏ−
1
ẏ5
) − α1 e ẏ1
sign( Rẏ1ẏ−
1
ẏ5
) − α2 ( Rẏ1ẏ−
1
ẏ5
))
ẏ6 +y9 a
ẏ6 +y9 a −β (|y7 − |) ẏ6 +y9 a ẏ6 +y9 a
−R(α0 sign(y7 − ẏ5 ) − α1 e ẏ5
sign(y7 − ẏ5 ) − α2 (y7 − ẏ5 ))y7 − u1
#H*K+
; B : K
X
9
Rẏ1 −ẏ5
−β(| |)
r1 = J1 ẏ1 + f1 y1 − R(α0 sign( Rẏ1ẏ−
1
ẏ5
) − α1 e ẏ1
sign( Rẏ1ẏ−
1
ẏ5
) − α2 ( Rẏ1ẏ−
1
ẏ5
))
ẏ6 +y9 a
ẏ6 +y9 a −β (|y7 − |) ẏ6 +y9 a ẏ6 +y9 a
−R(α0 sign(y7 − ẏ5 ) − α1 e ẏ5
sign(y7 − ẏ5 ) − α2 (y7 − ẏ5 ))y7 − u1
Rẏ2 −ẏ5
−β(| |)
r2 = J2 ẏ2 + f2 y2 − R(α0 sign( Rẏ2ẏ−
2
ẏ5
) − α1 e ẏ2 sign( Rẏ2ẏ−
2
ẏ5
) − α2 ( Rẏ2ẏ−
2
ẏ5
))
ẏ +y a
ẏ6 +y9 a −β (|y7 − 6 ẏ 9 |) ẏ6 +y9 a ẏ6 +y9 a
−R(α0 sign(y7 − ẏ5 ) − α1 e 5 sign(y7 − ẏ5 ) − α2 (y7 − ẏ5 ))y7 − u2
Rẏ3 −ẏ5
−β(| |)
r3 = J3 ẏ3 + f3 y3 − R(α0 sign( Rẏ3ẏ−
3
ẏ5
) − α1 e ẏ3
sign( Rẏ3ẏ−
3
ẏ5
) − α2 ( Rẏ3ẏ−
3
ẏ5
))
ẏ6 −y9 b
ẏ6 −y9 b −β (|y8 − |) ẏ6 −y9 b ẏ6 −y9 b
−R(α0 sign(y8 − ẏ5 ) − α1 e ẏ5
sign(y8 − ẏ5 ) − α2 (y8 − ẏ5 ))y8 − u3
Rẏ4 −ẏ5
−β(| |)
r4 = J4 ẏ4 + f4 y4 − R(α0 sign( Rẏ4ẏ−
4
ẏ5
) − α1 e ẏ4
sign( Rẏ4ẏ−
4
ẏ5
) − α2 ( Rẏ4ẏ−
4
ẏ5
))
ẏ −y b
ẏ6 −y9 b −β (|y8 − 6 ẏ 9 |) ẏ6 −y9 b ẏ6 −y9 b
−R(α0 sign(y8 − ẏ5 ) − α1 e 5 sign(y8 − ẏ5 ) − α2 (y8 − ẏ5 ))y8 − u4
(I(
u1 u2 u3 u4 u5 u6
r1 1 0 0 0 0 0
r2 0 1 0 0 0 0
r3 0 0 1 0 0 0
r4 0 0 0 1 0 0
r5 0 0 0 0 1 0
r6 0 0 0 0 0 1
H(H O
Rẏ1 −ẏ5
−β(| |)
r5 = Jf ÿ7 + ff y˙7 + kf y7 − D(α0 sign( Rẏ1ẏ−
1
ẏ5
) − α1 e ẏ1 sign( Rẏ1ẏ−
1
ẏ5
) − α2 ( Rẏ1ẏ−
1
ẏ5
)
Rẏ −ẏ
−β(| 2ẏ 5 |)
+α0 sign( Rẏ2ẏ−
2
ẏ5
) − α1 e 2 sign( Rẏ2ẏ−
2
ẏ5
) − α2 ( Rẏ2ẏ−
2
ẏ5
))
ẏ +y a
ẏ6 +y9 a −β (|y7 − 6 9 |)
−Dy7 (α0 sign(y7 − ẏ5 ) − α1 e
ẏ5
sign(y7 − ẏ6 +y 9a
ẏ5 ) − α2 (y7 −
ẏ6 +y9 a
ẏ5 )
ẏ6 +y9 a
ẏ6 +y9 a −β (|y7 − ẏ |)
+α0 sign(y7 − ẏ5 ) − α1 e
5 sign(y7 − ẏ6 +y 9a
ẏ5 ) − α2 (y7 −
ẏ6 +y9 a
ẏ5 )) − u5
Rẏ3 −ẏ5
−β(| |)
r6 = Jr ÿ8 + fr y˙8 + kr y8 − D(α0 sign( Rẏ3ẏ−
3
ẏ5
) − α1 e ẏ3
sign( Rẏ3ẏ−
3
ẏ5
) − α2 ( Rẏ3ẏ−
3
ẏ5
)
Rẏ4 −ẏ5
−β(| |)
+α0 sign( Rẏ4ẏ−
4
ẏ5
) − α1 e ẏ4
sign( Rẏ4ẏ−
4
ẏ5
) − α2 ( Rẏ4ẏ−
4
ẏ5
))
ẏ −y b
ẏ6 −y9 b −β (|y8 − 6 9 |)
−Dy8 (α0 sign(y8 − ẏ5 ) − α1 e
ẏ5
sign(y8 − ẏ6 −y 9b
ẏ5 ) − α2 (y8 −
ẏ6 −y9 b
ẏ5 )
ẏ6 −y9 b
ẏ6 −y9 b −β (|y8 − |)
sign(y8 − ẏ6 −y ẏ6 −y9 b
9b
+α0 sign(y8 − ẏ5 ) − α1 e
ẏ5
ẏ5 ) − α2 (y8 − ẏ5 )) − u5
+
T1des
T3 des
+
vdes k1
1/R + T2 des
T4 des
-
trajdes k2
ydes Contrôleur
xest ydes
0 D f des
xest
+
- Hy
yest
F
: #
6+
:
H "
#
)+ -:
8B
(I)
Consignes en vitesses de
rotation des roues et dérivés
d’ angle de braquage:
§ x *·
¨ T s1 ¸
¨ x *¸
vdes ¨T ¸
¨ s2 * ¸ Système linéarisé par
Planification de ¨ Tx ¸ bouclage linéarisant
trajdes trajectoire muni de ¨ s3 ¸
¨ x *¸ et commandé par
différents modes de
¨ T s4 ¸ retour d’état
commande ¨ x *¸
¨D f ¸
¨ x *¸
¨D ¸
© r ¹
yest Estimateur de la u
xest position de RobuCar y
-
Z: : -: B
#
#++
(IK
5
#+
;
-:
#+ -:
(I*
%
/ R -:
6
/
N
7
7
/
8
5 )( )F
/ : 5
5 )H
: %8
"2%8;
8 9
i = 1..4 fi = 2N ms Ji = 1kgm2
ff = fr = 0.003N ms Jf = Jr = 1kgm2 kf = kr = 5N m Iz = 82kgm2 M = 350kg
L = 1.205m a = L/3 b = 2L/3 R = 0.35m
α0 = α0 = 1200N α1 = α1 = 1200N α2 = α2 = 700N β = β = 14
.
-
7
(IE
M : angle de lacet
le
h icu
Vé
(I'
- 9
O
#
2+
O
#
5+
25
-:
/
-
.
5 )) 7
-:
@
#
5 )K+
5
7
.; / %
: 5 )*
: 5 )E
(IG
)K O
-:
((I
)G O 2 -:
((F
( /
-: 9
O t ∈ [0; tf [ 9 -:
O t ∈ [tf ; td[ 9 -:
9
5 #
7
+
O t ∈ [td; ∞[ 9 -:
5
C
C
+ 3%
2
#
8
+ / 0.3 r1 / r4 / 0.1
r5 r6
/ td = 21.05s
:
5
-:
8B
5
%
5 5 )(( 7
7
B #
5
)(F+
5 -: /
#
((H
)(I O 2 /
; #
2+ / t = 21s
+ 5 )(H
$
#
(()
((K
((*
&
?
-
5 )(*
7
9
((E
+1
2
4
C /
/
#
5 )(E+
-
5
7
(('
((G
(FI
(F(
(FF
2
/ Z
5
/
:
58
.; # 7
+
(FH
(F*
-:
7
7
/
#+
-
5
/
$
8B =
/ `8`
.
-: 2
:
5
7
7
/
:
Z
7
B
B / FK
7
.
7
;
5
/
#+
Z
(FE
(F'
(FG
-: 6
;
.
5
/
/
8
/
5
C -
; :
-
D
-: /
8
/
-:
8
7
(HI
/
: 2
8
> " .
#
N
+ )( : ><" /
#
+
" .
II " .
IH " .
I*
I F F
) F (I
)( O &
/ " .
><"
&
><" /
-
5
-:
:+
B
5
8
=
/ B
/
;
-: /
: /
-
><"
/
B
25
/ -
2
5
(HF
!
L7
(GGHM U3
<
:
& .-
#&.+ (GGH
L
3 FIIFM
> <
-
- 8
-
333
) #
9
FIIF
L
FII)M
3 ;
8
!
>>>.>>7# 1> FII)
L (GG)M 9
%
<
:
$ <
: #$<+
(GG)
L
FIIFM "
'
$
. *
'
%
<
:
$ "
<
FIIF
L,
U
(G'EM " %
J - 8
- 8
-
333 " 8HF 9GFIO
GFF (G'E
L,A FIIHM
4
&
D . " FIIH
L,A FII(M
&2
8
"
F*I*OF*FI FII(
L, @AT
@ (GGEM 4 ! 8
5 Z
333 ) K#F+ 9F(EO
FFG (GGE
L, (GGIM . "#$ % 4. %
4. &
> '
"
% *
(GGI
(HH
L,A
FIIFM 4; ( %U ) 8 Z
E
#
# &
FK#)+ 9E(FOEF) FIIF
L,
(GGEM % "
/
$ <
: #$<+ (GGE
L, FIIIM & 3 ) ; 9
"5
.E3)" H)#K+ 9*'GOEI' FIII
L, 3 A (G'GM % %<
J
"
"" E FE#(I+ 9()I*O()(( (G'G
L, 3 A (GGIM % %<
"
-
"
"" E F'#'+ 9(KI)O(KI' (GGI
L
L; FII)M .2 "
4
%
> -
-
M
5N
5
# M55>1 FII)
L; FII)M .2 "
4
%
&
-
-
" &
JK # "&>1 FII)
L; FIIKM .2 "
4
%
5
7
1st JK = NK
) F D # =3) >7 FIIK
L; FIIKM .2 "
4
%
58
9
"
#
333 93&>7
FIIK
L; FII*M .2 "
4
%
>
333
#
>? FII*
L; FII*M .2 "
4
% ) %
%
58
7
6th
D" )
D &
#
)
)
5# )5>? FII*
L28& (G''M 2 5$6 2
-
9
333
"
8HH 9((I*O(((K (G''
L> &8- (GGKM 4 ; 6 $%
)
.
# * 2 (GGK
L>A (G'EM . > -
- 8 -
)
#
KN. ( 9HKOG' (G'E
L>A (GG'M . <
@@-
!D" KGO'E (GG'
L>A 0^ (G'GM . 4 7 :
K.
N
.
3 2T (G'G
L> (GGGM 0 >4 %
- T -
- 3 # 3LL (GGG
L
>A (GGEM 2 ! . ;
8
9 - 3 5
K#K+ 9**HO*EI (GGE
L, (GGGM ! . ! 3 )
. $!
-
&% %
C8 % <
&% (GGG
L (GG*M " !
5
" ! & &
% ( (GG*
(H*
J
8 -
333 ) (H#H+ 9)GHO
)GG FIIK
LU
(G'IM <
!
) .
83 (G'I
LU
FIIFM 3U =
) #
.
3 FIIF
LUTAA (GGHM 3 %
h∞8 9 <
"
FG 9FKKOFEH (GGH
L (GGHM ; %
; &% %
P-
3
3L8 (HIO(EI (GGH
L (GGEM ; % )2
(GGE
L
FII(M &
"
=
"
:.
% N
"
:
<
:
%2 $ - FII(
L (G'*M f " % * J-
-
- "
FF#H+ 9HHHOH)) (G'*
L (GE(M ;
333 " .
(*#*+ 9KG*O*IF (GE(
L (GG)M 4> ) ) % Z
- 8
D" )
: &
(GG)
L
(GE*M %"3 )
% ; " %
5
8
ZT -
3
5 &
&
(K#(+ (GE*
L
FIIHM ) 4 , W ' "
D
) * )
"
)
. ! =
)
F'E " FIIH
L (GEEM 2 )
@@-
8
- D,, F* 9(('FO((G( (GEE
L @ FIIHM 34 )/ =
) 0-8
FIIH
L (G'*M )
-
8
5
333 "
H(#G+ (G'*
(H'
L
.
7A (GGEM 4. ) 3, .
%
-
M
) &
) FE 9HHGOH)F (GGE
L @A FIIFM % ) 9
<
:
$ X8"8S88W FIIF
L
FII(M ) ! # "
<
FII(
L J (GGIM 0; ) U + 8 T
5 Z
-
><P>8(* E
# & (H#*+ 9G*GOGE* (GGI
L "
(GG*M )2 4
-8
:
9
-: &
(GG*
L (GG*M ) .
;0 !
13th
D" J (GG (GG*
L (GGEM 4 )( <3 ! 2 "% %8
8
A
333 )
K#(+ 9(IIO(IG (GGE
L&77 "
(GGIM 3 6
X
=
&
) "8X (GGI
L& (GGHM 3 6
&
>
8
@
333
) # 9
(GGH
L& FIIIM 3 6 ;
> ; >
-
- 9
T
333 ) 9.
,
FI#(+ 9HHO)G FIII
LJ
(GGHM W +
A
Z
- E
# & (*#(+ 9(((O((E (GGH
LJ
U (GG(M W + U ;
Z
-
A E
# & ()#K+ 9GIHOG(( (GG(
LJ
% FIIHM 2 + & &
<
8
8 T
3
5
(F#(F+ 9(KEKO
(KG' FIIH
LJ (GGHM +
# <
%J&2
333
) # 9
(GGH
L.
7A (GG*M 3, .
<
-
? D
)
" L? *
3
(GG*
L.
7A ,A (GGEM 3, .
4
- T
8
M
) &
) FE 9FH)OF)G (GGE
(HG
L.
7A "
(GG(M 3, .
%" # "
-
- -
9 T
M
) &
FI 9(F(O(E* (GG(
L. (GGEM %4 .
>
(GGE
D" )L8
F 9(IHHO(IKK (GGE
L.
(GG(M %4 .
4 8
T
-
8
: 3 &
)O D
( 9('HOFII (GG(
L.
(GG(M %4 .
4 T -
D"P
9") ) )5L ( 9FH'OFKK (GG(
L. (G'GM %4 .
. %& D
.
.
3 (G'G
L. (G'EM % .
- @
- 8
A
"
FH#(+ 9HHO)I (G'E
L. " (GEEM 42 .
<
-
T
- AT 3
Q
# " 1
F((KOF(F( (GEE
L% (GG*M 4 &
; )/ <
-8
: C )
9
(GG*
L% (GG(M "" & <" . X, *%% J
-
"
"" E FG 9G)FOG)H (GG(
L%
FIIKM & & %5 >;
Z
L"
A (GGHM ; X 2
333
) # 9
)I*O)(( (GGH
L"
FII)M 4W &2
-
-
E
# # &
FE#)+ 9E'EO
EG) FII)
L" FIIHM "
%4 .
9. D &
&
)
$
% " FIIH
L" FIIIM ! 3 ) 2
8
6 - 9
= NK ) FIII
L"T
A (GGHM
4. X /#
-
12th
D" J K 9KHKOK)F
(GGH
L"T
A
FII(M
! >
" :
N
FK 9(O(( FII(
L"T
A (GGGM
>
- - 6
333 &
HK'(OHK'*
(GGG
L"T
A FII)M
" TA
E
(' 9KKOEF FII)
L"@A- FIIFM % &%
U ", ,$
& -
3
FIIF
L<A " (G'KM < >@@- 5
-
333
#
(K#(+ 9((*O(HF (G'K
L<
FIIHM ; ;
4 .
- 5th
D" ) D &
#
)
)
5 (K(O(K* FIIH
L<
FIIKM %
% * 9
#
# 5
& #
2 A FIIK
L$A (GE'M X 3
"
-
9
: (GE'
L$A (G'HM X 3
5
5
) (G'H
()(
LX
A (G*GM X *( " -
-
3
)
F) 9G)EOGKK (G*G
LXA FIIHM X *
% &% U 9
" ( T
. 9 S 8
3
FIIH
LX- XT
(G'FM * % U *
@
333 " #K+ 9(I'KO(IGK (G'F
LXT
(G')M & *
%0 .0
- 5 9
- E
# # &
FFFOFHI (G')
L0
(G'EM ,
4 "3 ' - 8
# E )K#*+ 9F(IGOF(HF (G'E
L0
YA (G'*M ,
"3 ' J -
-
8
5
7 & G*(OG**
(G'*
L0A (GEGM ,U 2 ! >
8
A
-
E
# &
F#)+ 9H(HOH(G (GEG
L0 (G''M 4 <
- T
"
FF(HOFF(' (G''
L0A- (GE*M " % -
-
()H
())
"
#!
/
%
8
:
% 5 ?
%
#> (+ -
8 8
"
C "
<
"
< #"<F+
!
! "
# $
% & # ' ! ! "
& ( &)
%
:
C
8
#5 H+
) O
9
=
C
8
&I &( 8
3P
5
7
#
+ C
&(
9
.
5 K
.
/ J"8>2<
: < %
8
:
/ - /
Z
C
-
8
8
%
()E
+
%
/ 9
O : / - "FF(8HI(I* 5 *#+
"U
9
Z
7 :
.
/ L% FIIIM
O
5 *#+
8
/8 L, (GGGM
O
5 *#
+
C 2
/
O ."
x y
O
"
#
5
()'
) !!*&
+) , !* *
) , +
*
#
#
!
()G
C
B
:
/ B
5 E
C /
8
)'X
.
/
C .0 #. 0
+ / <P% # ;%+ .0
/
5 .
C
/
<P%
.0
-
/
:
-
# .0 +
(PFG
(KI
, !*)
%
7-
A
#5 '+ /
C 8
:
(K(
-
7
O A 9 .
: B
:
(KF
$
#
. : 6
/ 'H
8 9
ẋ = f (x) + B.u
y = C.x
#,(+
R
⎛ RFx1 RFy1 x10
⎞
− Jf11 x1 +
J1 +
⎜ J1
⎟
⎜ f2 RFx2
− J2 x2 + J2 + J2
RFy2 x10 ⎟
⎜ ⎟
⎜ RF RF x ⎟
⎜ − Jf33 x3 + J3x3 + yJ33 12 ⎟
⎜ ⎟
⎜ RF RF x ⎟
⎜ − Jf44 x4 + J4x4 + yJ44 12 ⎟
⎜ ⎟
⎜ +Fx2
− Fx1M − Fx3M +Fx4 F +F F +F
− y1M y2 x10 − y3M y4 x12 ⎟
⎜ ⎟
⎜ ⎟
⎜ x5 ⎟
⎜ ⎟
⎜ F +F Fx3 +Fx4 Fy1 +Fy2 Fy3 +Fy4 ⎟
f (x) = ⎜ − x1M x2 x10 − x12 + + ⎟
⎜ M M M ⎟
⎜ ⎟
⎜ x7 ⎟
⎜ Fx1 +Fx2 Fy1 +Fy2 ⎟
⎜ f
− Jff x9 −
kf
x10 − D − x10 D ⎟
⎜ Jf Jf Jf ⎟
⎜ ⎟
⎜ x9 ⎟
⎜ ⎟
⎜ Fx3 +Fx4 Fy3 +Fy4 ⎟
⎜ − Jfrr x11 − kr
Jr x12 − D − x12 D ⎟
⎜ Jr Jr ⎟
⎜ x11 ⎟
⎝ ⎠
a
Iz (−Fx1 − Fx2 + Fy1 + Fy2 )x10 + b
Iz (Fx3 + Fx4 − Fy3 − Fy4 )x12 + d
2Iz (Fx1 − Fx2 + Fx3 − Fx4 )
#,F+
(KH
⎛ ⎞
1 0 0 0 0 0 0 0 0 0 0 0 0
⎜ ⎟
⎜ 0 1 0 0 0 0 0 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 1 0 0 0 0 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 0 1 0 0 0 0 0 0 0 0 0 ⎟
⎜ ⎟
C=⎜
⎜ 0 0 0 0 0 1 0 0 0 0 0 0 0 ⎟
⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 0 1 0 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 0 0 0 1 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 0 0 0 0 0 1 0 ⎟
⎝ ⎠
0 0 0 0 0 0 0 0 0 0 0 0 1
⎛ ⎞
1/J1 0 0 0 0 0
⎜ ⎟
⎜ ⎟
⎜ 0 1/J2 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 1/J3 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 0 1/J4 0 0 ⎟
⎜ ⎟
⎜ 0 ⎟
⎜ 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ ⎟
B=⎜ 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 ⎟
⎜ 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 1/Jf 0 ⎟
⎜ ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 1/Jr ⎟
⎜ 0 0 0 0 0 ⎟
⎜ ⎟
⎜ 0 0 0 0 0 0 ⎟
⎝ ⎠
0 0 0 0 0 0
f
9
3.84e6 0 0 0 −3.90e6 0 −121.18 0 0 182.88 0 0 −97.35
0 3.86e6 0 0 −3.92e6 0 −121.18 0 0 182.88 0 0 −97.35
0 0 3.82e6 0 −3.89e6 0 −42.68 0 0 0 0 −740.83 17.14
0 0 0 3.83e6 −3.90e6 0 −42.68 0 0 0 0 −740.83 17.14
−3.14e4 −3.15e4 −3.12e4 −3.13e4 1.27e5 0 2.67 0 0 −2.99 0 12.091.31
0 0 0 0 1 0 0 0 0 0 0 0 0
−1.57e3 −1.58e3 −311.93 −312.96 3.84e3 0 −109.25 0 0 5.72e4 0 5.69e4 −3.80
0 0 0 0 0 0 1 0 0 0 0 0 0
−1.10e4 −1.10e4 0 0 2.23e4 0 0.69 0 −0.00 −6.04 0 0 0.56
0 0 0 0 0 0 0 0 1 0 0 0 0
0 0 −1.09e4 −1.09e4 2.22e4 0 0.24 0 0 0 −0.00 −0.77 −0.10
0 0 0 0 0 0 0 0 0 0 1 0 0
6.16e4 −7.27e4 6.71e4 −6.63e4 1.03e4 0 −16.21 0 0 1.96e5 0 −9.76e4 −156.98
4)
5 *& !
! +5
! ( !*
67,
&* ( (# %)
(KK
5 &
/
(+!* " ! 8 1
9
&*
!
(
( &:
* ** !
8 1
/
4
;
(* *(
**
!
(
8(
!
4
"
*!*
*(
! / *
+
!
9 " ! /
* <# 4
"
!1
(
9
&*
!
(
* 1* * <# " /
"
*(
4 5
*
#! 1 +
** * * *
( 8 !1
4
;
8 &* *(
*! /9
!
((! ( = ( ! /
9
&*
! > !
!1
4 5:
>
/!
9
&*
?
*+
+
> ( *(
4 . 9
* !
(!
/ 1*
/!
** *
( / ** ! 8 !1
*(
#+4 ;
*(
!# <#
(( "! >
! ! " 8(! * +54
!
*!
! *(
9* "
#
" 4 (&
9
<* ( !
9
&* > !
!1
** ! 8 1
*
(
! 4 ,<
*
? >
!
!
(
*
!
8 1
#
9* "
!
! ! " <#:
( /
+
+ ! !
6
;
@ 1 * 9 @
A 6 5 .9
*
A65.) 1
9
*4
<
(
4 01
9
+ #
1 9 1 1*
9
*
# ( A65.
9
* +
4 A 9 <#
#9
((
8( *
+5)4 <
+5
* +9 C
9
*
B # 1 #
9*
1 9@4
9
* 9
<*
+ 9
1
A65.
(
4 . *
1 ?9 B #
(
(
1
# # 1
4
+
+ 9 + 9