SlideShare une entreprise Scribd logo
1  sur  10
1.Présentation du système balland beam et avantages:
Le systèmeest présenté par une bille placé sur une barre. La barre présente la
piste sur laquelle la bille est libre de rouler.
.Un élévateur est attaché a la barre d’uneextrémité et attaché a un
servomoteur de l’autre extremité.Quand le servo est commandé par le
microcontrôleur il tourned’un angle.𝜃 Quand l’angle .𝜃 changede la position
horizontalela forcede gravitécause la bille à tourner au long de la barre. Une
commande bien choisi va donner un systèmestable pour atteindre une
position désiré.
Le systèmeBall and Beam est idéale pour explorer divers concepts de contrôle
liés aux systèmes en boucle fermée instables.
Ilpeut être utilisé aussi pour démontrer des défis de contrôle du monde réel
tels que le contrôle du roulis des avions.
2.a.lagrangien :
Ball :
𝐾𝑏 =
1
2
∗ 𝑚 ∗ 𝑣2 +
1
2
∗ 𝐽𝑏 ∗ 𝜃̇ 2
1
2
∗ 𝐽𝑏 ∗ 𝜃̇ 2 =
1
2
∗ 𝐽𝑏 ∗ (
𝑥̇
𝑟
)2 =
1
2
∗ 𝐽𝑏 ∗
𝑥̇2
𝑟2
1
2
∗ 𝑚 ∗ 𝑣2 =
1
2
∗ 𝑚 ∗ 𝑥𝑏
2 +
1
2
∗ 𝑚 ∗ 𝑦𝑏
2
𝑥𝑏 = 𝑥 ∗ cos𝛼 => 𝑥̇ = 𝑥̇ ∗ cos𝛼 − 𝑥 ∗ 𝛼̇ ∗ sin 𝛼
𝑦𝑏 = 𝑥 ∗ sin 𝛼 => 𝑦̇ = 𝑥̇ ∗ sin 𝛼 + 𝑥 ∗ 𝛼̇ ∗ cos𝛼
𝑣2 = 𝑥𝑏
̇ 2
+ 𝑦𝑏
̇ 2
= (𝑥̇ ∗ cos𝛼 − 𝑥 ∗ 𝛼̇ ∗ sin 𝛼)2 + (𝑥̇ ∗ sin 𝛼 + 𝑥 ∗ 𝛼̇ ∗ cos𝛼)2
Ainsi :
𝐾𝑏 =
1
2
𝑚 ∗ 𝑥̇2 + 𝑥2 ∗ 𝛼̇ 2 +
1
2
∗ 𝐽𝑏 ∗
𝑥̇2
𝑟2
=
1
2
∗ (
𝐽𝑏
𝑟2
+ 𝑚) ∗ 𝑥̇2 +
1
2
∗ 𝑚 ∗ 𝑥2 ∗ 𝛼̇ 2
𝑃𝑏 = 𝑚 ∗ 𝑔 ∗ 𝑥 ∗ sin 𝛼
Beam:
𝐾𝐵 =
1
2
∗ 𝐽 ∗ 𝛼̇2
𝑃𝐵 = 𝑀 ∗ 𝑔 ∗
𝐿
2
∗ sin 𝛼
𝐿𝑎𝑔 = 𝐾 − 𝑃 = 𝐾𝐵 + 𝐾𝑏 − 𝑃𝑏 − 𝑃𝐵
𝐿𝑎𝑔 = (
1
2
∗ 𝑚 ∗ 𝑥2 +
1
2
∗ 𝐽) ∗ 𝛼̇2 +
1
2
∗ (
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̇2 − 𝑔 ∗ sin 𝛼 ∗ ( 𝑚 ∗ 𝑥 + 𝑀 ∗
𝐿
2
)
𝜕𝐿𝑎𝑔
𝜕𝑞
= (
𝜕𝐿𝑎𝑔
𝜕𝑥
𝜕𝐿𝑎𝑔
𝜕𝛼
) = (
𝑚 ∗ 𝑥 ∗ 𝛼̇ 2 − 𝑚 ∗ 𝑔 ∗ sin 𝛼
−𝑚 ∗ 𝑔 ∗ 𝑥 ∗ cos𝛼 − 𝑀 ∗ 𝑔 ∗
𝐿
2
∗ cos𝛼
)
𝜕𝐿𝑎𝑔
𝜕𝑞̇
= (
𝜕𝐿𝑎𝑔
𝜕𝑥̇
𝜕𝐿𝑎𝑔
𝜕𝛼̇
) = (
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̇
(𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̇
)
𝑑
𝑑𝑡
(
𝜕𝐿𝑎𝑔
𝜕𝑞̇
) = (
𝑑
𝑑𝑡
(
𝜕𝐿𝑎𝑔
𝜕𝑥̇
)
𝑑
𝑑𝑡
(
𝜕𝐿𝑎𝑔
𝜕𝛼̇
)
) = (
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̈
(𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇
)
𝜔 = 𝜏 ∗ 𝛼
Ainsi :
(
𝜕𝜔
𝜕𝑥
𝜕𝑤
𝜕𝛼
) = (
0
𝜏
) =
𝑑
𝑑𝑡
(
𝜕𝐿𝑎𝑔
𝜕𝑞̇
)−
𝜕𝐿𝑎𝑔
𝜕𝑞
Or
𝑑
𝑑𝑡
(
𝜕𝐿𝑎𝑔
𝜕𝑞̇
) −
𝜕𝐿𝑎𝑔
𝜕𝑞
= (
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̈ − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 + 𝑚 ∗ 𝑔 ∗ sin 𝛼
(𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ + 𝑔 ∗ cos(𝛼) ∗ (𝑀 ∗
𝐿
2
+ 𝑚 ∗ 𝑥)
)
D’oùle modèle dynamique dusystème estreprésenté par :
(𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ + (
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼) = 𝜏
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̈ + 𝑚 ∗ 𝑔 ∗ sin(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 = 0
2.b.Newton :
SoitR le repère absolu
Et soitR’ le repère relatif reliéàlabarre
On :
𝑎𝑎
⃗⃗⃗⃗ = 𝑎𝑟
⃗⃗⃗⃗ + 𝑎𝑒
⃗⃗⃗⃗ + 𝑎𝑐
⃗⃗⃗⃗
𝑎𝑒
⃗⃗⃗⃗ = (
𝑑Ω
(R′
R
)
⃗⃗⃗⃗⃗⃗⃗⃗
𝑑𝑡
)𝑅 ∧ O′
M
⃗⃗⃗⃗⃗⃗ + Ω
(R′
R
)
⃗⃗⃗⃗⃗⃗⃗⃗ ∧ (Ω
(R′
R
)
⃗⃗⃗⃗⃗⃗⃗⃗ ∧ O′
M
⃗⃗⃗⃗⃗⃗ )
𝑎𝑐
⃗⃗⃗⃗ = 2 ∗ (Ω
(R′
R
)
⃗⃗⃗⃗⃗⃗⃗⃗ ∧ 𝑣𝑟
⃗⃗⃗ )
O′
M
⃗⃗⃗⃗⃗⃗⃗⃗ = x ∗ i ,Ω
(
R′
R
)
⃗⃗⃗⃗⃗⃗⃗⃗⃗ = α̇ ∗ k
⃗ ,𝑣𝑟
⃗⃗⃗⃗ = ẋ ∗ i
⃗ ,𝑎𝑟
⃗⃗⃗⃗ = 𝑥̈ ∗𝑖
𝑎𝑒
⃗⃗⃗⃗ = α̈ ∗ k ∧ x ∗ i + α̇ ∗ k ∧ ( α̇ ∗ k ∧ x ∗ i) = α̈ ∗ x ∗ j − α̇2
∗ x ∗ i
𝑎𝑐
⃗⃗⃗⃗ = 2 ∗ (α̇ ∗ k ∧ ẋ ∗ i ) = 2 ∗ α̇ ∗ ẋ ∗ j
Ainsi
𝑎𝑎
⃗⃗⃗⃗ = 𝑥̈ ∗ 𝑖 + α̈ ∗ x ∗ j − α̇2
∗ x ∗ i + 2 ∗ α̇ ∗ ẋ ∗ j = (𝑥̈ − α̇2
∗ x) ∗ i + (α̈ ∗ x + 2 ∗ α̇ ∗ ẋ ) ∗ j
Appliquant maintenant le théorème fondamentalde la dynamique enrotationpour la bille :
𝐽𝑏 ∗ 𝜃̈ = 𝐹
𝑟 ∗ 𝑟 𝑎𝑣𝑒𝑐 𝜃 =
−𝑥
𝑟
=> 𝐹
𝑟 =
𝐽𝑏
𝑟2 ∗ 𝑥̈
Appliquant maintenant le théorème fondamentalde la dynamique entranslation pour la bille selon l’axe 𝑖 ∶
𝑚 ∗ 𝑎𝑎 = 𝐹𝑟 − 𝑚 ∗𝑔 ∗ sin𝛼 =
𝐽𝑏
𝑟2 ∗ 𝑥̈ − 𝑚 ∗𝑔 ∗ sin𝛼 = 𝑚 ∗(𝑥̈ − α̇ 2
∗ x)
Ainsi onobtientlaprèmiere equationdumodele dynamique :
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̈ + 𝑚 ∗ 𝑔 ∗ sin(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 = 0
Appliquant maintenant le théorème fondamentalde la dynamique enrotationpour la barre :
𝐽 ∗ 𝛼̈ = 𝜏 − 𝑁 ∗ 𝑥 − 𝑀 ∗
𝐿
2
∗ 𝑔 ∗cos(𝛼) => 𝑁 ∗ 𝑥 = −𝐽 ∗ 𝛼̈ + 𝜏 − 𝑀 ∗
𝐿
2
∗𝑔 ∗ cos(𝛼)
Appliquant maintenant le théorème fondamentalde la dynamique entranslation pour la bille selon l’axe 𝑗 ∶
𝑚 ∗ 𝑎𝑎 = 𝑁 − 𝑚 ∗ 𝑔 ∗ cos(𝛼) = 𝑚 ∗ α̈ ∗ x + 2 ∗ 𝑚 ∗α̇ ∗ ẋ
Ainsi :
−𝐽 ∗ 𝛼̈ + 𝜏 − 𝑀 ∗
𝐿
2
∗ 𝑔 ∗ cos(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝑔 ∗ cos(𝛼) − 𝑚 ∗ α̈ ∗ x2
− 2 ∗ 𝑚 ∗ α̇ ∗ ẋ ∗ x = 0
D’où on obtient la deuxieme equation du modele dynamique :
(𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ + (
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼) = 𝜏
3.Déterminons une représentation non linéaire de
système :
Soitle vecteurd’étatsuivant :
𝑋 = (
𝑥1
𝑥2
𝑥3
𝑥4
) = (
𝑥
𝑥̇
𝛼
𝛼̇
)
𝑥̇1 = 𝑥̇ = 𝑥2
𝑥̇2 = 𝑥̈ =
−𝑚 ∗ 𝑔 ∗ sin(𝛼) + 𝑚 ∗ 𝑥 ∗ 𝛼̇ 2
𝐽𝑏
𝑟2 + 𝑚
=
𝑚 ∗ (𝑥1 ∗ 𝑥4
2 − 𝑔 ∗ sin(𝑥3))
𝐽𝑏
𝑟2 + 𝑚
𝑥̇3 = 𝛼̇ = 𝑥4
𝑥̇4 = 𝛼̈ =
𝜏 − 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ − (
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼)
(𝑚 ∗ 𝑥2 + 𝐽)
𝑥̇4 =
𝜏 − 2 ∗ 𝑚 ∗ 𝑥1 ∗ 𝑥2 ∗ 𝑥4 − (
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥1) ∗ 𝑔 ∗ cos(𝑥3)
(𝑚 ∗ 𝑥1
2 + 𝐽)
Linéarisation de système :
Prenonsmaintenantle vecteurd’étatsuivant :
𝑋 = (
𝑥1
𝑥2
𝑥3
𝑥4
) = (
𝑥 − 𝑥0
𝑥̇ − 𝑥̇0
𝛼 − 𝛼0
𝛼̇ − 𝛼̇0
)
On a
𝑥̇0 = 0 ,𝛼0 = 0 , 𝛼̇0 = 0
Ainsi :
𝑋 = (
𝑥1
𝑥2
𝑥3
𝑥4
) = (
𝑥 − 𝑥0
𝑥̇
𝛼
𝛼̇
)
𝑋 = (
𝑥̇1
𝑥̇2
𝑥̇3
𝑥̇4
) =
(
𝑥2
𝑚 ∗ (𝑥1 ∗ 𝑥4
2 − 𝑔 ∗ sin(𝑥3))
𝐽𝑏
𝑟2 + 𝑚
𝑥4
𝜏 − 2 ∗ 𝑚 ∗ 𝑥1 ∗ 𝑥2 ∗ 𝑥4 − (
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥1)∗ 𝑔 ∗ cos(𝑥3)
(𝑚 ∗ 𝑥1
2 + 𝐽) )
= 𝑓(𝑥, 𝜏)
On a lesdeux équationsde dynamiques :
(𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ + (
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼) = 𝜏
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̈ + 𝑚 ∗ 𝑔 ∗ sin(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 = 0
On a :
𝐽(𝑞) = (
𝑚 ∗ 𝑥2 + 𝐽 0
0
𝐽𝑏
𝑟2 + 𝑚
)
𝐺(𝑞) = (
(
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼)
𝑚 ∗ 𝑔 ∗ sin(𝛼)
)
𝐷 = (
1 0
0 0
)
𝐻(𝑞,𝑞̇) = (
2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇
−𝑚 ∗ 𝑥 ∗ 𝛼̇2)
𝑑𝐺(𝑞)
𝑑𝑞
= (−(
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ sin(𝛼) 𝑚 ∗ 𝑔 ∗ cos(𝛼)
𝑚 ∗ 𝑔 ∗ cos(𝛼) 0
)
Soitle vecteurd’état:
𝜑 = 𝑞 − 𝑞é𝑞 = (
𝛼 − 𝛼é𝑞
𝑥 − 𝑥é𝑞
)
𝜑̇ = (
𝛼̇
𝑥̇
)
̇
𝑉 = 𝑈 − 𝑈é𝑞
−𝐽−1
(𝑞é𝑞) ∗
𝑑𝐺(𝑞)
𝑑𝑞 𝑞=𝑞é𝑞
= −
(
1
𝑚 ∗ 𝑥é𝑞
2 + 𝐽
0
0
1
𝐽𝑏
𝑟2 + 𝑚)
∗ (
− (
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ sin(𝛼é𝑞) 𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞)
𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞) 0
)
−𝐽−1(𝑞é𝑞) ∗
𝑑𝐺(𝑞)
𝑑𝑞 𝑞=𝑞é𝑞
= −
(
−(
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ sin(𝛼é𝑞)
𝑚 ∗ 𝑥é𝑞
2 + 𝐽
𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞)
𝑚 ∗ 𝑥é𝑞
2 + 𝐽
𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞)
𝐽𝑏
𝑟2 + 𝑚
0
)
𝐽−1(𝑞é𝑞) ∗ 𝐷 =
(
1
𝑚 ∗ 𝑥é𝑞
2
+ 𝐽
0
0
1
𝐽𝑏
𝑟2 + 𝑚
)
∗ (
1 0
0 0
) = (
1
𝑚 ∗ 𝑥é𝑞
2
+ 𝐽
0
0 0
)
𝑋̇ =
(
0
0
(
𝐿
2
∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ sin(𝛼é𝑞)
𝑚 ∗ 𝑥é𝑞
2 + 𝐽
−
𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞)
𝐽𝑏
𝑟2 + 𝑚
0
0
−𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞)
𝑚 ∗ 𝑥é𝑞
2 + 𝐽
0
1
0
0
0
0
1
0
0
)
+
(
0
0
1
𝑚 ∗ 𝑥é𝑞
2
+ 𝐽
0
0
0
0
0
)
𝑈
𝜕𝑓
𝜕𝑥
(𝑥, 𝜏) =
(
𝜕𝑥̇1
𝜕𝑥1
𝜕𝑥̇2
𝜕𝑥1
𝜕𝑥̇3
𝜕𝑥1
𝜕𝑥̇4
𝜕𝑥1
𝜕𝑥̇1
𝜕𝑥2
𝜕𝑥̇2
𝜕𝑥2
𝜕𝑥̇3
𝜕𝑥2
𝜕𝑥̇4
𝜕𝑥2
𝜕𝑥̇1
𝜕𝑥3
𝜕𝑥̇2
𝜕𝑥3
𝜕𝑥̇3
𝜕𝑥3
𝜕𝑥̇4
𝜕𝑥3
𝜕𝑥̇1
𝜕𝑥4
𝜕𝑥̇2
𝜕𝑥4
𝜕𝑥̇3
𝜕𝑥4
𝜕𝑥̇4
𝜕𝑥4)
=
(
0
𝑚∗𝑥4
2
𝐽𝑏
𝑟2+𝑚
0
𝜕𝑥̇4
𝜕𝑥1
1
0
0
−2∗𝑚∗𝑥1∗𝑥4
(𝑚∗𝑥1
2+𝐽)
0
−𝑚∗𝑔∗cos(𝑥3)
𝐽𝑏
𝑟2+𝑚
0
(𝐿
2
∗𝑀+𝑚∗𝑥1)∗𝑔∗sin(𝑥3)
(𝑚∗𝑥1
2+𝐽)
0
2∗𝑚∗𝑥1∗𝑥4
𝐽𝑏
𝑟2+𝑚
1
−2∗𝑚∗𝑥1∗𝑥2
(𝑚∗𝑥1
2+𝐽) )
Avec
𝜕𝑥̇4
𝜕𝑥1
=
(−2∗𝑚∗𝑥2∗𝑥4−𝑚∗𝑔∗cos(𝑥3))(𝑚∗𝑥1
2+𝐽)−2∗𝑚∗𝑥1∗(𝜏−2∗𝑚∗𝑥1∗𝑥2∗𝑥4−(𝐿
2
∗𝑀+𝑚∗𝑥1)∗𝑔∗cos(𝑥3))
(𝑚∗𝑥1
2+𝐽)2
𝜕𝑓
𝜕𝜏
(𝑥,𝜏) =
(
𝜕𝑥̇1
𝜕𝜏
𝜕𝑥̇2
𝜕𝜏
𝜕𝑥̇3
𝜕𝜏
𝜕𝑥̇4
𝜕𝜏 )
=
(
0
0
0
1
(𝑚 ∗ 𝑥1
2
+ 𝐽) )
𝜕𝑓
𝜕𝑥
(𝑥0,𝜏0) =
(
0
0
0
−𝑚 ∗ 𝑔
(𝑚 ∗ 𝑥0
2 + 𝐽)
1
0
0
0
0
−𝑚 ∗ 𝑔
𝐽𝑏
𝑟2 + 𝑚
0
0
0
0
1
0
)
𝜕𝑓
𝜕𝜏
(𝑥0, 𝜏0) =
(
0
0
0
1
(𝑚 ∗ 𝑥0
2
+ 𝐽) )
Ainsi on obtient le systèmelinéaire avec :
𝑥̇(𝑡) = 𝐴𝑥(𝑡) + 𝐵𝑢(𝑡)
𝑦(𝑡) = 𝐶𝑥(𝑡)
Avec :
𝐴 =
𝜕𝑓
𝜕𝑥
(𝑥0,𝜏0) ,𝐵 =
𝜕𝑓
𝜕𝜏
(𝑥0, 𝜏0) , 𝐶 = (1 0 0 0)
4.Commande PID :
Pour la commande on opte pour la commande pid ,pour cela commencant par déterminer la
fonction de tranfert du système :
On a l’équation du modèle dynamique suivante :
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̈ + 𝑚 ∗ 𝑔 ∗ sin(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 = 0
Une linéarisationde cette équationautourdupoint 𝛼 = 0 donne l’équation suivante:
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̈ = −𝑚 ∗ 𝑔 ∗ 𝛼
La relationqui relieentre l’angle de servomoteuretl’anglede labarre estla suivante :
𝛼 =
𝑑
𝐿
∗ 𝜃
Remplaconsdansl’equation(1):
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑥̈ = −𝑚 ∗ 𝑔 ∗
𝑑
𝐿
∗ 𝜃
Appliquons maintenantlatransformée de laplace :
(
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑋(𝑝) ∗ 𝑝2 = −𝑚 ∗ 𝑔 ∗
𝑑
𝐿
∗ 𝜃(𝑝)
D’oùon obtientlafonctionde transfertsuivante surlaquelle onferal’étude :
𝐹(𝑝) =
𝑋(𝑝)
𝜃(𝑝)
=
−𝑚 ∗ 𝑔 ∗ 𝑑
𝐿 ∗ (
𝐽𝑏
𝑟2 + 𝑚) ∗ 𝑝2
On cherche maintenantàdeterminerlescoefficientskp,ki etkddu correcteurpour obtenirle
comportementdésiré.
Ball_beam_partie théorique2.docx

Contenu connexe

Tendances

T. Masrour - cours dynamique des systèmes - vibrations -chapitre3-mmc
T. Masrour - cours dynamique des systèmes - vibrations -chapitre3-mmcT. Masrour - cours dynamique des systèmes - vibrations -chapitre3-mmc
T. Masrour - cours dynamique des systèmes - vibrations -chapitre3-mmctawfik-masrour
 
Lmd st3 m.r. février2008
Lmd st3 m.r.  février2008Lmd st3 m.r.  février2008
Lmd st3 m.r. février2008m.a bensaaoud
 
T. Masrour - cours dynamique des systèmes - vibrations - chapitre1-1ddl chapi...
T. Masrour - cours dynamique des systèmes - vibrations - chapitre1-1ddl chapi...T. Masrour - cours dynamique des systèmes - vibrations - chapitre1-1ddl chapi...
T. Masrour - cours dynamique des systèmes - vibrations - chapitre1-1ddl chapi...tawfik-masrour
 
Cours vibration 2016 prat
Cours vibration 2016 pratCours vibration 2016 prat
Cours vibration 2016 pratOumaimaBenSaid
 
Partie i vibrations et oscillateurs
Partie i   vibrations et oscillateursPartie i   vibrations et oscillateurs
Partie i vibrations et oscillateursOumaimaBenSaid
 
espace etudiant.licence 1er/2 anneé
espace etudiant.licence 1er/2 anneé espace etudiant.licence 1er/2 anneé
espace etudiant.licence 1er/2 anneé saoula khereddine
 

Tendances (10)

Vib 1 agm
Vib 1 agmVib 1 agm
Vib 1 agm
 
Vibration Mécanique
Vibration MécaniqueVibration Mécanique
Vibration Mécanique
 
T. Masrour - cours dynamique des systèmes - vibrations -chapitre3-mmc
T. Masrour - cours dynamique des systèmes - vibrations -chapitre3-mmcT. Masrour - cours dynamique des systèmes - vibrations -chapitre3-mmc
T. Masrour - cours dynamique des systèmes - vibrations -chapitre3-mmc
 
Lmd st3 m.r. février2008
Lmd st3 m.r.  février2008Lmd st3 m.r.  février2008
Lmd st3 m.r. février2008
 
T. Masrour - cours dynamique des systèmes - vibrations - chapitre1-1ddl chapi...
T. Masrour - cours dynamique des systèmes - vibrations - chapitre1-1ddl chapi...T. Masrour - cours dynamique des systèmes - vibrations - chapitre1-1ddl chapi...
T. Masrour - cours dynamique des systèmes - vibrations - chapitre1-1ddl chapi...
 
Cours vibration 2016 prat
Cours vibration 2016 pratCours vibration 2016 prat
Cours vibration 2016 prat
 
Partie i vibrations et oscillateurs
Partie i   vibrations et oscillateursPartie i   vibrations et oscillateurs
Partie i vibrations et oscillateurs
 
Asservis num
Asservis numAsservis num
Asservis num
 
espace etudiant.licence 1er/2 anneé
espace etudiant.licence 1er/2 anneé espace etudiant.licence 1er/2 anneé
espace etudiant.licence 1er/2 anneé
 
Synthèse juin 2000
Synthèse  juin 2000Synthèse  juin 2000
Synthèse juin 2000
 

Similaire à Ball_beam_partie théorique2.docx

Corrigé SERIE 2 cinématique du point.pptx
Corrigé SERIE 2 cinématique du point.pptxCorrigé SERIE 2 cinématique du point.pptx
Corrigé SERIE 2 cinématique du point.pptxMidoxotk
 
Exercices corrigés les matrices- djeddi kamel
Exercices corrigés les matrices- djeddi kamelExercices corrigés les matrices- djeddi kamel
Exercices corrigés les matrices- djeddi kamelKamel Djeddi
 
Chapitre 1 automatique de base
Chapitre 1 automatique de  baseChapitre 1 automatique de  base
Chapitre 1 automatique de basesimo927066
 
Chapitre 1 auto base
Chapitre 1 auto baseChapitre 1 auto base
Chapitre 1 auto basesimo927066
 
Rapport m3o brini_anouar
Rapport m3o brini_anouarRapport m3o brini_anouar
Rapport m3o brini_anouarAnwar Brini
 
Géométrie différentielle élémentaire pour la physique-Mostafa Bousder
Géométrie différentielle élémentaire pour la physique-Mostafa BousderGéométrie différentielle élémentaire pour la physique-Mostafa Bousder
Géométrie différentielle élémentaire pour la physique-Mostafa BousderMostafa Bousder
 
Corrigé TD chapitre I.pptx
Corrigé TD chapitre I.pptxCorrigé TD chapitre I.pptx
Corrigé TD chapitre I.pptxMidoxotk
 
Exercices corriges application_lineaire_et_determinants
Exercices corriges application_lineaire_et_determinantsExercices corriges application_lineaire_et_determinants
Exercices corriges application_lineaire_et_determinantssarah Benmerzouk
 
Rappel mathématique pour étudiant d'économie gestion
Rappel mathématique pour étudiant d'économie gestionRappel mathématique pour étudiant d'économie gestion
Rappel mathématique pour étudiant d'économie gestionAli Hachimi Kamali
 
chapitre_1espace_vectoriel.pdf
chapitre_1espace_vectoriel.pdfchapitre_1espace_vectoriel.pdf
chapitre_1espace_vectoriel.pdfLearnWithUs3
 
chapitre_1espatoriel.pdf
chapitre_1espatoriel.pdfchapitre_1espatoriel.pdf
chapitre_1espatoriel.pdfLearnWithUs3
 
Formulario de integrales de calculo integral
Formulario de integrales de calculo integralFormulario de integrales de calculo integral
Formulario de integrales de calculo integralUrielGomez45
 
formulario.pdf
formulario.pdfformulario.pdf
formulario.pdfSMITHE3
 
formulario de Calculo Diferencial e Integral
formulario de Calculo Diferencial e Integralformulario de Calculo Diferencial e Integral
formulario de Calculo Diferencial e IntegralEdgarBenites8
 
Cours Transformée de Laplace.pdf
Cours Transformée de Laplace.pdfCours Transformée de Laplace.pdf
Cours Transformée de Laplace.pdfSohaMoussaoui
 
alpha beta version word.docx
alpha beta version word.docxalpha beta version word.docx
alpha beta version word.docxYoussefOumhella
 

Similaire à Ball_beam_partie théorique2.docx (20)

Corrigé SERIE 2 cinématique du point.pptx
Corrigé SERIE 2 cinématique du point.pptxCorrigé SERIE 2 cinématique du point.pptx
Corrigé SERIE 2 cinématique du point.pptx
 
Exercices corrigés les matrices- djeddi kamel
Exercices corrigés les matrices- djeddi kamelExercices corrigés les matrices- djeddi kamel
Exercices corrigés les matrices- djeddi kamel
 
Maths Annexes
Maths AnnexesMaths Annexes
Maths Annexes
 
Chapitre 1 automatique de base
Chapitre 1 automatique de  baseChapitre 1 automatique de  base
Chapitre 1 automatique de base
 
Chapitre 1 auto base
Chapitre 1 auto baseChapitre 1 auto base
Chapitre 1 auto base
 
Rapport m3o brini_anouar
Rapport m3o brini_anouarRapport m3o brini_anouar
Rapport m3o brini_anouar
 
Géométrie différentielle élémentaire pour la physique-Mostafa Bousder
Géométrie différentielle élémentaire pour la physique-Mostafa BousderGéométrie différentielle élémentaire pour la physique-Mostafa Bousder
Géométrie différentielle élémentaire pour la physique-Mostafa Bousder
 
Corrigé TD chapitre I.pptx
Corrigé TD chapitre I.pptxCorrigé TD chapitre I.pptx
Corrigé TD chapitre I.pptx
 
Exercices corriges application_lineaire_et_determinants
Exercices corriges application_lineaire_et_determinantsExercices corriges application_lineaire_et_determinants
Exercices corriges application_lineaire_et_determinants
 
Rappel mathématique pour étudiant d'économie gestion
Rappel mathématique pour étudiant d'économie gestionRappel mathématique pour étudiant d'économie gestion
Rappel mathématique pour étudiant d'économie gestion
 
chapitre_1espace_vectoriel.pdf
chapitre_1espace_vectoriel.pdfchapitre_1espace_vectoriel.pdf
chapitre_1espace_vectoriel.pdf
 
chapitre_1espatoriel.pdf
chapitre_1espatoriel.pdfchapitre_1espatoriel.pdf
chapitre_1espatoriel.pdf
 
formulario.pdf
formulario.pdfformulario.pdf
formulario.pdf
 
Formulario de integrales de calculo integral
Formulario de integrales de calculo integralFormulario de integrales de calculo integral
Formulario de integrales de calculo integral
 
formulario.pdf
formulario.pdfformulario.pdf
formulario.pdf
 
formulario de Calculo Diferencial e Integral
formulario de Calculo Diferencial e Integralformulario de Calculo Diferencial e Integral
formulario de Calculo Diferencial e Integral
 
Cours Transformée de Laplace.pdf
Cours Transformée de Laplace.pdfCours Transformée de Laplace.pdf
Cours Transformée de Laplace.pdf
 
alpha beta version word.docx
alpha beta version word.docxalpha beta version word.docx
alpha beta version word.docx
 
Fic00126
Fic00126Fic00126
Fic00126
 
Exercice intégrales
Exercice intégralesExercice intégrales
Exercice intégrales
 

Ball_beam_partie théorique2.docx

  • 1. 1.Présentation du système balland beam et avantages: Le systèmeest présenté par une bille placé sur une barre. La barre présente la piste sur laquelle la bille est libre de rouler. .Un élévateur est attaché a la barre d’uneextrémité et attaché a un servomoteur de l’autre extremité.Quand le servo est commandé par le microcontrôleur il tourned’un angle.𝜃 Quand l’angle .𝜃 changede la position horizontalela forcede gravitécause la bille à tourner au long de la barre. Une commande bien choisi va donner un systèmestable pour atteindre une position désiré. Le systèmeBall and Beam est idéale pour explorer divers concepts de contrôle liés aux systèmes en boucle fermée instables. Ilpeut être utilisé aussi pour démontrer des défis de contrôle du monde réel tels que le contrôle du roulis des avions. 2.a.lagrangien :
  • 2. Ball : 𝐾𝑏 = 1 2 ∗ 𝑚 ∗ 𝑣2 + 1 2 ∗ 𝐽𝑏 ∗ 𝜃̇ 2 1 2 ∗ 𝐽𝑏 ∗ 𝜃̇ 2 = 1 2 ∗ 𝐽𝑏 ∗ ( 𝑥̇ 𝑟 )2 = 1 2 ∗ 𝐽𝑏 ∗ 𝑥̇2 𝑟2 1 2 ∗ 𝑚 ∗ 𝑣2 = 1 2 ∗ 𝑚 ∗ 𝑥𝑏 2 + 1 2 ∗ 𝑚 ∗ 𝑦𝑏 2 𝑥𝑏 = 𝑥 ∗ cos𝛼 => 𝑥̇ = 𝑥̇ ∗ cos𝛼 − 𝑥 ∗ 𝛼̇ ∗ sin 𝛼 𝑦𝑏 = 𝑥 ∗ sin 𝛼 => 𝑦̇ = 𝑥̇ ∗ sin 𝛼 + 𝑥 ∗ 𝛼̇ ∗ cos𝛼 𝑣2 = 𝑥𝑏 ̇ 2 + 𝑦𝑏 ̇ 2 = (𝑥̇ ∗ cos𝛼 − 𝑥 ∗ 𝛼̇ ∗ sin 𝛼)2 + (𝑥̇ ∗ sin 𝛼 + 𝑥 ∗ 𝛼̇ ∗ cos𝛼)2 Ainsi : 𝐾𝑏 = 1 2 𝑚 ∗ 𝑥̇2 + 𝑥2 ∗ 𝛼̇ 2 + 1 2 ∗ 𝐽𝑏 ∗ 𝑥̇2 𝑟2 = 1 2 ∗ ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̇2 + 1 2 ∗ 𝑚 ∗ 𝑥2 ∗ 𝛼̇ 2 𝑃𝑏 = 𝑚 ∗ 𝑔 ∗ 𝑥 ∗ sin 𝛼 Beam: 𝐾𝐵 = 1 2 ∗ 𝐽 ∗ 𝛼̇2 𝑃𝐵 = 𝑀 ∗ 𝑔 ∗ 𝐿 2 ∗ sin 𝛼 𝐿𝑎𝑔 = 𝐾 − 𝑃 = 𝐾𝐵 + 𝐾𝑏 − 𝑃𝑏 − 𝑃𝐵 𝐿𝑎𝑔 = ( 1 2 ∗ 𝑚 ∗ 𝑥2 + 1 2 ∗ 𝐽) ∗ 𝛼̇2 + 1 2 ∗ ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̇2 − 𝑔 ∗ sin 𝛼 ∗ ( 𝑚 ∗ 𝑥 + 𝑀 ∗ 𝐿 2 ) 𝜕𝐿𝑎𝑔 𝜕𝑞 = ( 𝜕𝐿𝑎𝑔 𝜕𝑥 𝜕𝐿𝑎𝑔 𝜕𝛼 ) = ( 𝑚 ∗ 𝑥 ∗ 𝛼̇ 2 − 𝑚 ∗ 𝑔 ∗ sin 𝛼 −𝑚 ∗ 𝑔 ∗ 𝑥 ∗ cos𝛼 − 𝑀 ∗ 𝑔 ∗ 𝐿 2 ∗ cos𝛼 )
  • 3. 𝜕𝐿𝑎𝑔 𝜕𝑞̇ = ( 𝜕𝐿𝑎𝑔 𝜕𝑥̇ 𝜕𝐿𝑎𝑔 𝜕𝛼̇ ) = ( ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̇ (𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̇ ) 𝑑 𝑑𝑡 ( 𝜕𝐿𝑎𝑔 𝜕𝑞̇ ) = ( 𝑑 𝑑𝑡 ( 𝜕𝐿𝑎𝑔 𝜕𝑥̇ ) 𝑑 𝑑𝑡 ( 𝜕𝐿𝑎𝑔 𝜕𝛼̇ ) ) = ( ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̈ (𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ ) 𝜔 = 𝜏 ∗ 𝛼 Ainsi : ( 𝜕𝜔 𝜕𝑥 𝜕𝑤 𝜕𝛼 ) = ( 0 𝜏 ) = 𝑑 𝑑𝑡 ( 𝜕𝐿𝑎𝑔 𝜕𝑞̇ )− 𝜕𝐿𝑎𝑔 𝜕𝑞 Or 𝑑 𝑑𝑡 ( 𝜕𝐿𝑎𝑔 𝜕𝑞̇ ) − 𝜕𝐿𝑎𝑔 𝜕𝑞 = ( ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̈ − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 + 𝑚 ∗ 𝑔 ∗ sin 𝛼 (𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ + 𝑔 ∗ cos(𝛼) ∗ (𝑀 ∗ 𝐿 2 + 𝑚 ∗ 𝑥) ) D’oùle modèle dynamique dusystème estreprésenté par : (𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ + ( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼) = 𝜏 ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̈ + 𝑚 ∗ 𝑔 ∗ sin(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 = 0 2.b.Newton :
  • 4. SoitR le repère absolu Et soitR’ le repère relatif reliéàlabarre On : 𝑎𝑎 ⃗⃗⃗⃗ = 𝑎𝑟 ⃗⃗⃗⃗ + 𝑎𝑒 ⃗⃗⃗⃗ + 𝑎𝑐 ⃗⃗⃗⃗ 𝑎𝑒 ⃗⃗⃗⃗ = ( 𝑑Ω (R′ R ) ⃗⃗⃗⃗⃗⃗⃗⃗ 𝑑𝑡 )𝑅 ∧ O′ M ⃗⃗⃗⃗⃗⃗ + Ω (R′ R ) ⃗⃗⃗⃗⃗⃗⃗⃗ ∧ (Ω (R′ R ) ⃗⃗⃗⃗⃗⃗⃗⃗ ∧ O′ M ⃗⃗⃗⃗⃗⃗ ) 𝑎𝑐 ⃗⃗⃗⃗ = 2 ∗ (Ω (R′ R ) ⃗⃗⃗⃗⃗⃗⃗⃗ ∧ 𝑣𝑟 ⃗⃗⃗ ) O′ M ⃗⃗⃗⃗⃗⃗⃗⃗ = x ∗ i ,Ω ( R′ R ) ⃗⃗⃗⃗⃗⃗⃗⃗⃗ = α̇ ∗ k ⃗ ,𝑣𝑟 ⃗⃗⃗⃗ = ẋ ∗ i ⃗ ,𝑎𝑟 ⃗⃗⃗⃗ = 𝑥̈ ∗𝑖 𝑎𝑒 ⃗⃗⃗⃗ = α̈ ∗ k ∧ x ∗ i + α̇ ∗ k ∧ ( α̇ ∗ k ∧ x ∗ i) = α̈ ∗ x ∗ j − α̇2 ∗ x ∗ i 𝑎𝑐 ⃗⃗⃗⃗ = 2 ∗ (α̇ ∗ k ∧ ẋ ∗ i ) = 2 ∗ α̇ ∗ ẋ ∗ j Ainsi 𝑎𝑎 ⃗⃗⃗⃗ = 𝑥̈ ∗ 𝑖 + α̈ ∗ x ∗ j − α̇2 ∗ x ∗ i + 2 ∗ α̇ ∗ ẋ ∗ j = (𝑥̈ − α̇2 ∗ x) ∗ i + (α̈ ∗ x + 2 ∗ α̇ ∗ ẋ ) ∗ j Appliquant maintenant le théorème fondamentalde la dynamique enrotationpour la bille : 𝐽𝑏 ∗ 𝜃̈ = 𝐹 𝑟 ∗ 𝑟 𝑎𝑣𝑒𝑐 𝜃 = −𝑥 𝑟 => 𝐹 𝑟 = 𝐽𝑏 𝑟2 ∗ 𝑥̈ Appliquant maintenant le théorème fondamentalde la dynamique entranslation pour la bille selon l’axe 𝑖 ∶ 𝑚 ∗ 𝑎𝑎 = 𝐹𝑟 − 𝑚 ∗𝑔 ∗ sin𝛼 = 𝐽𝑏 𝑟2 ∗ 𝑥̈ − 𝑚 ∗𝑔 ∗ sin𝛼 = 𝑚 ∗(𝑥̈ − α̇ 2 ∗ x) Ainsi onobtientlaprèmiere equationdumodele dynamique :
  • 5. ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̈ + 𝑚 ∗ 𝑔 ∗ sin(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 = 0 Appliquant maintenant le théorème fondamentalde la dynamique enrotationpour la barre : 𝐽 ∗ 𝛼̈ = 𝜏 − 𝑁 ∗ 𝑥 − 𝑀 ∗ 𝐿 2 ∗ 𝑔 ∗cos(𝛼) => 𝑁 ∗ 𝑥 = −𝐽 ∗ 𝛼̈ + 𝜏 − 𝑀 ∗ 𝐿 2 ∗𝑔 ∗ cos(𝛼) Appliquant maintenant le théorème fondamentalde la dynamique entranslation pour la bille selon l’axe 𝑗 ∶ 𝑚 ∗ 𝑎𝑎 = 𝑁 − 𝑚 ∗ 𝑔 ∗ cos(𝛼) = 𝑚 ∗ α̈ ∗ x + 2 ∗ 𝑚 ∗α̇ ∗ ẋ Ainsi : −𝐽 ∗ 𝛼̈ + 𝜏 − 𝑀 ∗ 𝐿 2 ∗ 𝑔 ∗ cos(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝑔 ∗ cos(𝛼) − 𝑚 ∗ α̈ ∗ x2 − 2 ∗ 𝑚 ∗ α̇ ∗ ẋ ∗ x = 0 D’où on obtient la deuxieme equation du modele dynamique : (𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ + ( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼) = 𝜏 3.Déterminons une représentation non linéaire de système : Soitle vecteurd’étatsuivant : 𝑋 = ( 𝑥1 𝑥2 𝑥3 𝑥4 ) = ( 𝑥 𝑥̇ 𝛼 𝛼̇ ) 𝑥̇1 = 𝑥̇ = 𝑥2 𝑥̇2 = 𝑥̈ = −𝑚 ∗ 𝑔 ∗ sin(𝛼) + 𝑚 ∗ 𝑥 ∗ 𝛼̇ 2 𝐽𝑏 𝑟2 + 𝑚 = 𝑚 ∗ (𝑥1 ∗ 𝑥4 2 − 𝑔 ∗ sin(𝑥3)) 𝐽𝑏 𝑟2 + 𝑚 𝑥̇3 = 𝛼̇ = 𝑥4 𝑥̇4 = 𝛼̈ = 𝜏 − 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ − ( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼) (𝑚 ∗ 𝑥2 + 𝐽)
  • 6. 𝑥̇4 = 𝜏 − 2 ∗ 𝑚 ∗ 𝑥1 ∗ 𝑥2 ∗ 𝑥4 − ( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥1) ∗ 𝑔 ∗ cos(𝑥3) (𝑚 ∗ 𝑥1 2 + 𝐽) Linéarisation de système : Prenonsmaintenantle vecteurd’étatsuivant : 𝑋 = ( 𝑥1 𝑥2 𝑥3 𝑥4 ) = ( 𝑥 − 𝑥0 𝑥̇ − 𝑥̇0 𝛼 − 𝛼0 𝛼̇ − 𝛼̇0 ) On a 𝑥̇0 = 0 ,𝛼0 = 0 , 𝛼̇0 = 0 Ainsi : 𝑋 = ( 𝑥1 𝑥2 𝑥3 𝑥4 ) = ( 𝑥 − 𝑥0 𝑥̇ 𝛼 𝛼̇ ) 𝑋 = ( 𝑥̇1 𝑥̇2 𝑥̇3 𝑥̇4 ) = ( 𝑥2 𝑚 ∗ (𝑥1 ∗ 𝑥4 2 − 𝑔 ∗ sin(𝑥3)) 𝐽𝑏 𝑟2 + 𝑚 𝑥4 𝜏 − 2 ∗ 𝑚 ∗ 𝑥1 ∗ 𝑥2 ∗ 𝑥4 − ( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥1)∗ 𝑔 ∗ cos(𝑥3) (𝑚 ∗ 𝑥1 2 + 𝐽) ) = 𝑓(𝑥, 𝜏) On a lesdeux équationsde dynamiques : (𝑚 ∗ 𝑥2 + 𝐽) ∗ 𝛼̈ + 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ ∗ 𝛼̇ + ( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼) = 𝜏 ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̈ + 𝑚 ∗ 𝑔 ∗ sin(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 = 0 On a : 𝐽(𝑞) = ( 𝑚 ∗ 𝑥2 + 𝐽 0 0 𝐽𝑏 𝑟2 + 𝑚 )
  • 7. 𝐺(𝑞) = ( ( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ cos(𝛼) 𝑚 ∗ 𝑔 ∗ sin(𝛼) ) 𝐷 = ( 1 0 0 0 ) 𝐻(𝑞,𝑞̇) = ( 2 ∗ 𝑚 ∗ 𝑥 ∗ 𝑥̇ −𝑚 ∗ 𝑥 ∗ 𝛼̇2) 𝑑𝐺(𝑞) 𝑑𝑞 = (−( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ sin(𝛼) 𝑚 ∗ 𝑔 ∗ cos(𝛼) 𝑚 ∗ 𝑔 ∗ cos(𝛼) 0 ) Soitle vecteurd’état: 𝜑 = 𝑞 − 𝑞é𝑞 = ( 𝛼 − 𝛼é𝑞 𝑥 − 𝑥é𝑞 ) 𝜑̇ = ( 𝛼̇ 𝑥̇ ) ̇ 𝑉 = 𝑈 − 𝑈é𝑞 −𝐽−1 (𝑞é𝑞) ∗ 𝑑𝐺(𝑞) 𝑑𝑞 𝑞=𝑞é𝑞 = − ( 1 𝑚 ∗ 𝑥é𝑞 2 + 𝐽 0 0 1 𝐽𝑏 𝑟2 + 𝑚) ∗ ( − ( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ sin(𝛼é𝑞) 𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞) 𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞) 0 ) −𝐽−1(𝑞é𝑞) ∗ 𝑑𝐺(𝑞) 𝑑𝑞 𝑞=𝑞é𝑞 = − ( −( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ sin(𝛼é𝑞) 𝑚 ∗ 𝑥é𝑞 2 + 𝐽 𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞) 𝑚 ∗ 𝑥é𝑞 2 + 𝐽 𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞) 𝐽𝑏 𝑟2 + 𝑚 0 ) 𝐽−1(𝑞é𝑞) ∗ 𝐷 = ( 1 𝑚 ∗ 𝑥é𝑞 2 + 𝐽 0 0 1 𝐽𝑏 𝑟2 + 𝑚 ) ∗ ( 1 0 0 0 ) = ( 1 𝑚 ∗ 𝑥é𝑞 2 + 𝐽 0 0 0 ) 𝑋̇ = ( 0 0 ( 𝐿 2 ∗ 𝑀 + 𝑚 ∗ 𝑥) ∗ 𝑔 ∗ sin(𝛼é𝑞) 𝑚 ∗ 𝑥é𝑞 2 + 𝐽 − 𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞) 𝐽𝑏 𝑟2 + 𝑚 0 0 −𝑚 ∗ 𝑔 ∗ cos(𝛼é𝑞) 𝑚 ∗ 𝑥é𝑞 2 + 𝐽 0 1 0 0 0 0 1 0 0 ) + ( 0 0 1 𝑚 ∗ 𝑥é𝑞 2 + 𝐽 0 0 0 0 0 ) 𝑈
  • 8. 𝜕𝑓 𝜕𝑥 (𝑥, 𝜏) = ( 𝜕𝑥̇1 𝜕𝑥1 𝜕𝑥̇2 𝜕𝑥1 𝜕𝑥̇3 𝜕𝑥1 𝜕𝑥̇4 𝜕𝑥1 𝜕𝑥̇1 𝜕𝑥2 𝜕𝑥̇2 𝜕𝑥2 𝜕𝑥̇3 𝜕𝑥2 𝜕𝑥̇4 𝜕𝑥2 𝜕𝑥̇1 𝜕𝑥3 𝜕𝑥̇2 𝜕𝑥3 𝜕𝑥̇3 𝜕𝑥3 𝜕𝑥̇4 𝜕𝑥3 𝜕𝑥̇1 𝜕𝑥4 𝜕𝑥̇2 𝜕𝑥4 𝜕𝑥̇3 𝜕𝑥4 𝜕𝑥̇4 𝜕𝑥4) = ( 0 𝑚∗𝑥4 2 𝐽𝑏 𝑟2+𝑚 0 𝜕𝑥̇4 𝜕𝑥1 1 0 0 −2∗𝑚∗𝑥1∗𝑥4 (𝑚∗𝑥1 2+𝐽) 0 −𝑚∗𝑔∗cos(𝑥3) 𝐽𝑏 𝑟2+𝑚 0 (𝐿 2 ∗𝑀+𝑚∗𝑥1)∗𝑔∗sin(𝑥3) (𝑚∗𝑥1 2+𝐽) 0 2∗𝑚∗𝑥1∗𝑥4 𝐽𝑏 𝑟2+𝑚 1 −2∗𝑚∗𝑥1∗𝑥2 (𝑚∗𝑥1 2+𝐽) ) Avec 𝜕𝑥̇4 𝜕𝑥1 = (−2∗𝑚∗𝑥2∗𝑥4−𝑚∗𝑔∗cos(𝑥3))(𝑚∗𝑥1 2+𝐽)−2∗𝑚∗𝑥1∗(𝜏−2∗𝑚∗𝑥1∗𝑥2∗𝑥4−(𝐿 2 ∗𝑀+𝑚∗𝑥1)∗𝑔∗cos(𝑥3)) (𝑚∗𝑥1 2+𝐽)2 𝜕𝑓 𝜕𝜏 (𝑥,𝜏) = ( 𝜕𝑥̇1 𝜕𝜏 𝜕𝑥̇2 𝜕𝜏 𝜕𝑥̇3 𝜕𝜏 𝜕𝑥̇4 𝜕𝜏 ) = ( 0 0 0 1 (𝑚 ∗ 𝑥1 2 + 𝐽) ) 𝜕𝑓 𝜕𝑥 (𝑥0,𝜏0) = ( 0 0 0 −𝑚 ∗ 𝑔 (𝑚 ∗ 𝑥0 2 + 𝐽) 1 0 0 0 0 −𝑚 ∗ 𝑔 𝐽𝑏 𝑟2 + 𝑚 0 0 0 0 1 0 ) 𝜕𝑓 𝜕𝜏 (𝑥0, 𝜏0) = ( 0 0 0 1 (𝑚 ∗ 𝑥0 2 + 𝐽) ) Ainsi on obtient le systèmelinéaire avec : 𝑥̇(𝑡) = 𝐴𝑥(𝑡) + 𝐵𝑢(𝑡) 𝑦(𝑡) = 𝐶𝑥(𝑡) Avec :
  • 9. 𝐴 = 𝜕𝑓 𝜕𝑥 (𝑥0,𝜏0) ,𝐵 = 𝜕𝑓 𝜕𝜏 (𝑥0, 𝜏0) , 𝐶 = (1 0 0 0) 4.Commande PID : Pour la commande on opte pour la commande pid ,pour cela commencant par déterminer la fonction de tranfert du système : On a l’équation du modèle dynamique suivante : ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̈ + 𝑚 ∗ 𝑔 ∗ sin(𝛼) − 𝑚 ∗ 𝑥 ∗ 𝛼̇2 = 0 Une linéarisationde cette équationautourdupoint 𝛼 = 0 donne l’équation suivante: ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̈ = −𝑚 ∗ 𝑔 ∗ 𝛼 La relationqui relieentre l’angle de servomoteuretl’anglede labarre estla suivante : 𝛼 = 𝑑 𝐿 ∗ 𝜃 Remplaconsdansl’equation(1): ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑥̈ = −𝑚 ∗ 𝑔 ∗ 𝑑 𝐿 ∗ 𝜃 Appliquons maintenantlatransformée de laplace : ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑋(𝑝) ∗ 𝑝2 = −𝑚 ∗ 𝑔 ∗ 𝑑 𝐿 ∗ 𝜃(𝑝) D’oùon obtientlafonctionde transfertsuivante surlaquelle onferal’étude : 𝐹(𝑝) = 𝑋(𝑝) 𝜃(𝑝) = −𝑚 ∗ 𝑔 ∗ 𝑑 𝐿 ∗ ( 𝐽𝑏 𝑟2 + 𝑚) ∗ 𝑝2 On cherche maintenantàdeterminerlescoefficientskp,ki etkddu correcteurpour obtenirle comportementdésiré.