Mii 00013
Mii 00013
Mii 00013
THEME
Promotion: 2010/2011
Sommaire
Introduction générale………………………………………………………….1
Chapitre 1 : Description et modélisation du système pendule - chariot
1.1. Introduction…………………..............…………………………………………………..2
1.2. Description………………………………………………………………………………..2
2.1. Introduction……..…..……………………………………………………………………8
2.4. Conclusion……….………………………………………………………………………15
3.1. Introduction……..…..…………………………………………………………………..16
Conclusion générale…………………………………………………………………….24
Bibliographie……………………………………………………………………………...25
Introduction générale
Introduction générale
1
CHAPITRE 1: Description et modélisation du système pendule - chariot
CHAPITRE 1
1.1. Introduction :
Dans ce chapitre nous allons décrire et modéliser le système pendule - chariot, objet de notre
étude de commande. La section 2 portera sur la description physique du système pendule -
chariot, la section 3 présentera la modélisation mathématique, et la section 4 traitera la
linéarisation du modèle non linéaire du pendule autour du point d'équilibre choisi. La section 5
étudie la stabilité du système en boucle ouverte et la section 6 conclut le chapitre.
1.2. Description
Le système considéré est un pendule simple monté sur un chariot. Le mouvement du chariot doit
maintenir le pendule dans sa position d'équilibre instable (masse dirigée vers le haut). Voici un
schéma du dispositif.
Fc
2
CHAPITRE 1: Description et modélisation du système pendule - chariot
d æç ¶L ö÷ ¶L
ç ÷- = ui , i = 1..n (1.1)
dt çè ¶qi ÷ø÷ ¶qi
.
où qi est i-ième coordonnée généralisée, q i est la première dérivée de qi , L = Ec - E p est le
Lagrangien du système, est ui est la i-ième force généralisée qui agit sur qi .
x
y m
q V
lq
l
u(F
t)
M x
Fc
3
CHAPITRE 1: Description et modélisation du système pendule - chariot
De même
¶L
= (ml 2 + J )q + mlx cos q
¶q (1.9)
¶ ¶L
= (ml 2 + J )q + mlx cos q - ml qx sin q
¶t ¶q
et
¶L
= -ml qx sin q + m lg sin q (1.10)
¶q
On a
¶ ¶L ¶L
- =0 (1.11)
¶t ¶q ¶q
Ce qui donne:
(ml 2 + J )q + mlx cos q - mgl sin q = 0 (1.12)
Enfin, les équations de mouvement du chariot-pendule sont:
(ml 2 + J )q + mlx cos q - mgl sin q = 0
(1.13)
(m + M )x + ml q cos q - ml q 2 sin q = F - Fc
Soit encore:
é ml cos q (ml 2 + J )ù éxù é mgl sin q ù é0 ù
ê úê ú = ê ú + ê ú (F - F )
ê ú ê ú ê 2 ú ê1 ú c (1.14)
(m + M ) ml cos q q ml q sin q
ëê ûú ëê ûú ëê ûú êë úû
Soit
-1
éxù é ml cos q (ml 2 + J )ù æç é mgl sin q ù é0ù ö
ê ú=ê ú çê ú + ê ú (F - F )÷÷÷
ê ú ê ú çê ú ê ú c ÷ (1.15)
êëqûú êë(m + M ) ml cos q úû èçç ëêml q sin q ûú êë1 úû ÷
2
ø÷
é .2
ù é
éxù ê l 2m 2 1-(cos2 q +) mMl 2 +J (m +M ) - l 2m 2 1-cos
ml 2 +J lm q sin q gl 2m 2 cos q sin q
ú ml 2 +J ù
ê ú=ê ( ) ( 2
q )+mMl +J (m +M ) ú
2
ê l m (1-cos q)+mMl 2 +J (m +M ) ú
2 2 2
ê ú ê ú + êê ú (F - Fc )
êëq ûú ê 2 2 (M2+m ) glm sin q .2
l 2m 2 q cos q sin q ú
-lm cos q ú
êë l m (1-cos q)+mMl 2 +J (m +M ) - l 2m 2 (1-cos2 q)+mMl 2 +J (m +M ) úû ëê ( ) ûú
2 2 2 2
l m 1-cos q + mMl +J (m + M )
(1.16)
4
CHAPITRE 1: Description et modélisation du système pendule - chariot
é 2 .2
ù
éxù ê (ml 2+J )lm q q - 2gl 2m 2q ú é 2ml 2 +J ù
ê ú=ê mMl +J ( m + M ) mMl +J (m + M ) ú + êê mMl +J (m +M ) úú (F - Fc ) (1.17)
ê ú ê (M +m ) glmq ú ê 2 -lm
êëq úû ê 2 mMl +J (m +M ) úû
.2
- l 2m 2 q q ú
ë mMl +J (m +M ) mMl +J (m +M ) û ë
2
. .
En prenant comme variables d'état x 1 = x , x 2 = x , x 3 = q, x 4 = q , les équations d'état non
linéaires du système pendule - chariot sont données par:
é x. 1 ù é x2 ù é 0 ù
ê ú ê ú ê ú
ê . ú ê (ml 2 +J )lm ú
êx 2 ú ê mMl 2 +J (m +M ) x 3x 42 - mMl 2 gl+Jm(m +M ) x 3 ú êê mMl 2ml+J+(mJ +M ) úú
2 2 2
5
CHAPITRE 1: Description et modélisation du système pendule - chariot
é0 1 0 0ù
ê ú
ê0 0 -0.3633 0úú
ê
A=ê ú
ê0 0 0 1ú
ê ú
ê0 0 15.26 0ú
ë û
le polynôme caractéristique est donné par.
lI - A = l 4 - 15.26l 2 = l 2 (l 2 - 15.26)
D'où nous avons l1 = l2 = 0,l3 = 3.9,l4 = -3.9 ; donc deux valeurs propres nulles et une
valeur propre positive. Le système est donc instable à ce point d'équilibre.
Ce résultat est confirmé par la réponse en boucle ouverte montrée sur la figure 1.3.
700
600
500
400
θ(t)
300
200
100
0
0 0.5 1 1.5 2
t (sec)
-2
-4
-6
x(t)
-8
-10
-12
-14
-16
0 0.5 1 1.5 2
t (sec)
6
CHAPITRE 1: Description et modélisation du système pendule - chariot
1.6. Conclusion
Ce chapitre a permet d'établir le modèle du système étudié. La linéarisation a permet d'obtenir
un modèle d'état linéaire autour du point d'équilibre considéré. L'analyse de stabilité a montré
que le système est instable, et nécessite donc une correction pour fonctionner proprement.
7
CHAPITRE 2: Commande par placement de pôles
CHAPITRE 2
2.1. Introduction
Dans cette section nous présenterons une méthode de commande appelée la technique du
placement de pôles. Nous supposerons que toutes les variables d'état sont mesurables et sont
disponibles pour la rétroaction. Si le système considéré est complètement contrôlable, alors les
pôles du système en boucle fermée peuvent être placés à n'importe quel endroit désiré au moyen
d'un retour d'état à travers une matrice de gain approprié.
Placement
de pôles
Re
Pôles en BO
Pôles en BF
8
CHAPITRE 2: Commande par placement de pôles
u = -Kx (2.2)
Ce qui signifie que le signal de commande est déterminé par le vecteur d'état instantané. Une
telle loi de commande est appelée retour d'état. La matrice K de dimension (1 ´ n ) est
appelée matrice de gain.
La figure 2.2 montre le système défini par l'équation (2.1), en boucle ouverte puis en boucle
fermée, sous l'effet de la loi de commande (2.2).
u x x
B
+
Ä ò B
+
Ä ò
+ +
u
A A
-K
a b
Figure 2.2. (a) Système en boucle ouverte, (b) Système en boucle fermée avec u = -Kx .
2.2.1 Contrôlabilité
Le système décrit par l'équation (2.1) est dit contrôlable à t = t0 s'il est possible de construire
un signal de commande sans contrainte qui transférera l'état initial à n'importe quel état final
dans un intervalle fini de temps t0 £ t £ t1 .
Si chaque état est contrôlable, alors le système est dit complètement contrôlable.
La condition nécessaire et suffisante pour que le système (2.1) est complètement contrôlable, est
que le rang de la matrice (n ´ n ):
9
CHAPITRE 2: Commande par placement de pôles
Pour les systèmes d'ordre inférieur ou égal à 3, on peut substituer le gain K = éêk1 k2 ... kn ùú
ë û
directement dans le polynôme de caractéristique de sI - [A - BK ] . Si le comportement désiré
est spécifié à travers la sélection de n valeurs propres désirées m1, m2 ,..., mn , alors le polynôme
caractéristique désiré en boucle fermée est donné par:
pBF (s ) = (s - m1 )(s - m2 )...(s - mn ) = s n + a1s n -1 + ... + an -1s + an (2.6)
Comme le système en boucle fermée doit avoir comme pôles ceux du polynôme désiré pBF (s ) ,
l'égalité suivante doit être vérifiée:
sI - [A - BK ] = pBF (s ) = s n + a1s n -1 + ... + an -1s + an (2.7)
Ce qui donne comme solution les éléments du vecteur gain k1, k2 ,..., kn .
Forme contrôlable
Si le système est contrôlable (qui est la condition nécessaire et suffisante pour le placement des
pôles), on peut définir la transformation d'état x = Tz , avec la matrice de transformation
T = MW , avec
éan -1 an -2 a1 1 ù
ê ú
êan -2 a1 1 0úú
ê
ê ú
W =ê . ú
ê ú
ê a1 1 . 0 ú
ê ú
ê 1 0 0 0úú
êë û
Et
sI - A = s n + a1s n -1 + ... + an -1s + an .
Alors le vecteur gain est donné par la formule:
10
CHAPITRE 2: Commande par placement de pôles
x1
Mesure des
variables d'état
u
x3 x
Fc
-K
Figure 2.3. Schéma de commande par placement de pôles du système pendule chariot.
Les résultats de simulation pour un frottement nul, sont donnés par la figure 2.4. On peut
remarquer qu'après un bref transitoire les positions du pendule et du chariot se stabilisent à la
position désirée. La commande est un peu forte, mais c'est le prix à payer pour une dynamique
rapide qui permet de minimiser les oscillations du pendule.
11
CHAPITRE 2: Commande par placement de pôles
0.6 1
0.5
0.5
0.4
0.3 0
0.2
-0.5
dθ(t)/dt
θ(t)
0.1
-1
0
-0.1 -1.5
-0.2
-2
-0.3
-0.4 -2.5
0 2 4 6 8 10 0 2 4 6 8 10
t (sec) t (sec)
1.6 3
1.4 2.5
2
1.2
1.5
1
1
dx(t)/dt
x(t)
0.8
0.5
0.6
0
0.4
-0.5
0.2 -1
0 -1.5
0 2 4 6 8 10 0 2 4 6 8 10
t (sec) t (sec)
60
50
40
30
u(t)
20
10
-10
-20
0 2 4 6 8 10
t (sec)
12
CHAPITRE 2: Commande par placement de pôles
0.6 0.5
0.5
0
0.4
0.3 -0.5
0.2
dθ(t)/dt
θ(t)
-1
0.1
0 -1.5
-0.1
-2
-0.2
-0.3 -2.5
0 2 4 6 8 10 0 2 4 6 8 10
t (sec) t (sec)
2 2.5
2
1.5
1.5
1
1
dx(t)/dt
x(t)
0.5 0.5
0
0
-0.5
-0.5
-1
-1 -1.5
0 2 4 6 8 10 0 2 4 6 8 10
t (sec) t (sec)
60
50
40
30
u(t)
20
10
-10
-20
0 2 4 6 8 10
t (sec)
13
CHAPITRE 2: Commande par placement de pôles
Avec : K = éêk1 k2 k 3 k 4 k5 ùú
ë û
Où le terme k5 est lié à l'action intégrale.
Le système augmenté décrit par l'équation (2.12) est toujours contrôlable.
Le comportement désiré est spécifié à travers la sélection de n + 1 valeurs propres désirées
m1, m2,..., mn +1 , alors le polynôme caractéristique désiré en boucle fermée est donné par:
Les résultats de simulation pour un frottement sec, sont donnés par la figure 2.6. On peut
remarquer qu'après un bref transitoire les positions du pendule et du chariot se stabilisent à la
position désirée. La commande est sensiblement augmentée à cause de l'action intégrale qui doit
être limitée en pratique.
14
CHAPITRE 2: Commande par placement de pôles
0.6 1
0.5
0.4 0
-0.5
0.2 -1
dθ(t)/dt
-1.5
θ(t)
0 -2
-2.5
-0.2 -3
-3.5
-0.4 -4
0 5 10 15 0 5 10 15
t (sec) t (sec)
1.4 4
1.2
3
1
0.8
2
0.6
dx(t)/dt
x(t)
0.4 1
0.2
0
0
-0.2
-1
-0.4
-0.6 -2
0 5 10 15 0 5 10 15
t (sec) t (sec)
200
150
100
u(t)
50
-50
0 5 10 15
t (sec)
2.4. Conclusion
Dans ce chapitre nous avons montré qu'il est possible de stabiliser le système pendule chariot,
non linéaire et instable, à l'aide d'une commande linéaire qui est le placement des pôles.
L'introduction de l'action intégrale a permet d'éliminer l'effet du frottement sec et la convergence
des états du système vers le point d'équilibre désiré.
15
CHAPITRE 3: Commande linéaire quadratique
CHAPITRE 3
3.1. Introduction
Dans ce chapitre nous allons étudier l’application de la commande linéaire quadratique (LQR) à la
stabilisation du système pendule chariot. Nous commencerons par rappeler le principe de la commande
LQR. Nous verrons ensuite son application au système étudié. Enfin, nous discuterons l'introduction
d'une action intégrale pour éliminer l'effet du frottement sec.
Le problème (3.3) est un problème d'optimisation sous contrainte. Il peut être transformé en un
problème d'optimisation sans contraintes comme suit:
1 ¥ T
J *(x 0 , u ) = ò
2 0
(
x Qx + uT Ru + lT (Ax + Bu - x ) dt
.
) (3.4)
16
CHAPITRE 3: Commande linéaire quadratique
u = -R-1BT Px (t ) (3.5)
La matrice P est alors obtenue en résolvant l'équation algébrique de Riccati suivante:
PA + AT P - PBR-1BT P + Q = 0 (3.6)
Il est intéressant de noter que la commande optimale obtenue s'écrit comme un retour d'état
u(t ) = -Kx (t ) avec K = R-1BT P (3.7)
La différence avec la commande par placement de pôles apparaît dans le fait que la matrice de
gain K est calculé en fonction des contraintes imposées sur le système, contraintes qui
s'expriment à travers les pondérations R et Q .
donne:
17
CHAPITRE 3: Commande linéaire quadratique
18
CHAPITRE 3: Commande linéaire quadratique
0.6 0.5
0.5
0
0.4
0.3 -0.5
0.2
dθ(t)/dt
θ(t)
-1
0.1
0 -1.5
-0.1
-2
-0.2
-0.3 -2.5
0 5 10 15 0 5 10 15
t (sec) t (sec)
1.6 3
1.4 2.5
1.2
2
1
1.5
0.8
dx(t)/dt
x(t)
1
0.6
0.5
0.4
0
0.2
0 -0.5
-0.2 -1
0 5 10 15 0 5 10 15
t (sec) t (sec)
70
60
50
40
30
u(t)
20
10
-10
-20
0 5 10 15
t (sec)
19
CHAPITRE 3: Commande linéaire quadratique
0.6 0.5
0.5
0
0.4
0.3 -0.5
0.2
dθ(t)/dt
θ(t)
-1
0.1
0 -1.5
-0.1
-2
-0.2
-0.3 -2.5
0 2 4 6 8 10 0 2 4 6 8 10
t (sec) t (sec)
2 2.5
2
1.5
1.5
1
1
dx(t)/dt
x(t)
0.5 0.5
0
0
-0.5
-0.5
-1
-1 -1.5
0 2 4 6 8 10 0 2 4 6 8 10
t (sec) t (sec)
70
60
50
40
30
u(t)
20
10
-10
-20
0 2 4 6 8 10
t (sec)
20
CHAPITRE 3: Commande linéaire quadratique
Avec
é 0 1 0 0 0ù é 0 ù
ê ú ê ú
ê-0.3633 0 0 0 0úú ê 0.4938 ú
ê ê ú
ê ú ê ú
Aa = ê 0 0 0 1 0ú , Ba = ê 0 ú
ê ú ê ú
ê 15.26 0 0 0 0ú ê-0.7407 ú
ê ú ê ú
ê 0 0 1 0 0úú ê 0 ú
êë û êë úû
Et
T
x = éêx 1 x 2 x 3 x 4 x 5 ùú
ë û
Pour stabiliser le système nous avons choisi les pondérations suivantes:
é50 0 0 0 0 ù
ê ú
ê 0 10 0 0 0 ú
ê ú
ê ú
Q=ê 0 0 50 0 0 ú , r = 0.03
ê ú
ê 0 0 0 10 0 ú
ê ú
ê 0 0 0 0 10ú
êë úû
Le choix de la matrice Q indique que nous mettons plus de poids sur les positions du chariot et
du pendule, et ceci pour une meilleure performance.
Le calcul sous matlab avec la commande
[K,P,Poles_BF] = lqr(Aa,Ba,Q,r);
donne:
é 87.4059 41.0010 117.4227 29.7938 30.3318ù
ê ú
ê 41.0010 28.9676 86.1496 21.5545 13.4965 ú
ê ú
P = êê117.4227 86.1496 294.6500 68.0574 38.2250úú
ê 29.7938 21.5545 68.0574 17.1961 9.7371 úú
ê
ê 30.3318 13.4965 38.2250 9.7371 33.2662úúû
êë
Le vecteur gain:
K = [-60.7354 -55.3781 -262.33 -69.7889 -18.2574 ]
21
CHAPITRE 3: Commande linéaire quadratique
Les résultats de simulation pour un frottement sec, sont donnés par la figure 3.3. On peut
remarquer que les positions du pendule et du chariot se stabilisent à la position désirée après un
bref transitoire de 5secs. Les dépassements et les temps d'établissement sont sensiblement plus
grands que ceux obtenus avec le placement des pôles; mais ceci est prévisible puisque nous
avons diminué l'effort de commande avec le choix de r = 0.03 .
0.6
1
0.4
0
0.2
-1
dθ(t)/dt
θ(t)
0 -2
-0.2 -3
-0.4 -4
0 2 4 6 8 10 0 2 4 6 8 10
t (sec) t (sec)
1.4 4
1.2
3
1
0.8
2
0.6
dx(t)/dt
x(t)
0.4 1
0.2
0
0
-0.2
-1
-0.4
-0.6 -2
0 5 10 15 0 2 4 6 8 10
t (sec) t (sec)
200
150
100
u(t)
50
-50
0 2 4 6 8 10
t (sec)
22
CHAPITRE 3: Commande linéaire quadratique
3.6. Conclusion
La commande LQR a montré son efficacité dans la stabilisation du système pendule chariot, non
linéaire et instable. Le réglage de la commande est plutôt simple, puisque les deux paramètres de
pondération sont les seuls à définir par l'utilisateur pour obtenir un compromis entre les
performances souhaitées et l'effort de commande admis.
23
Conclusion générale
Conclusion générale
24
Bibliographie
Bibliographie
[1] N. Goléa, Commande dans l’espace d’état, cours de Masters Génie électrique &
Informatique industriel M1, Université d’Oum El Bouaghi, Algérie, 2010/2011.
[2] D. Xue, Y-Q. Chen, D. P. Atherton Linear Feedback Control: Analysis and Design
with MATLAB, SIAM, USA 2007.
[3] R. L. Williams and D. A. Lawrence, Linear state-space control systems, John Wiley
& Sons, USA, 2007.
[4] Matlab 7 Mathworks®.
31