Cours Bases de la Robotique (MICRO 450)
Corrigé 7 – Dynamique 2
09.11.2018
Solution 7.1 :
Q1 : MODELISATION DYNAMIQUE PAR L’APPROCHE DE LAGRANGE:
Résumé de l’approche :
1. Décrire le robot
a. Identifier l’outil et les articulations diverses.
b. Identifier les segments du robot.
2. Définir le référentiel de base du robot.
3. Définir les sens positif et négatif de chaque articulation.
4. Ecrire les Jacobiens locaux ramenés à chaque segment.
5. Déduire la matrice d’inertie
a. Grâce aux éléments inertiels de chaque segment (masse et tenseur d’inertie).
b. Grâce aux Jacobiens ramenés aux segments (point 4).
6. Déduire les différentes composantes de l’équation dynamique (Coriolis, Centrifuge et
Gravité).
Exemple du « Robot cartésien à 2 axes »:
La première opération à effectuer concerne le choix des axes du référentiel du robot. Par la suite,
le référencement de chaque axe articulaire doit être effectué.
L’objectif est de trouver le modèle dynamique de ce robot cartésien.
𝑧 ⃗ et 𝑧 ⃗ sont les vecteurs directeurs dans la direction des 2 mouvements articulaires 1 et 2.
Pour trouver le modèle dynamique de ce robot, nous commencerons par établir la matrice
d’inertie (eq. 2.11 du cours).
Soit :
B(q) = ∑ (𝑚 𝐽 𝐽 + 𝐽 𝑅 𝐼 𝑅 𝐽 ) (2.11)
𝐽 sont les matrices Jacobiennes pour les translations arrêtées à l’articulation "i”.
0 0 0 1
( ) ( )
𝐽 = 0 0 𝐽 = 0 0
1 0 1 0
(𝟏) (𝟏) (𝟐) (𝟐)
𝑱𝑷,𝟏 𝑱𝑷,𝟐 𝑱𝑷,𝟏 𝑱𝑷,𝟐
Link (1) Link (2)
1
Cours Bases de la Robotique (MICRO 450)
0 0
Il n’y’a aucune rotation 𝐽 =𝐽 = 0 0
0 0
B(q) = 𝑚 𝐽 𝐽 + 𝑚 𝐽 𝐽
0 0 0 1
0 0 1 0 0 1
=𝑚 0 0 +𝑚 0 0
0 0 0 1 0 0
1 0 1 0
𝑚 +𝑚 0
B(q) =
0 𝑚
Les termes de la matrice d’inertie sont constants. Ceci signifie qu’il n’y a aucun couplage inertiel et
que l’inertie ne varie pas en fonction de la posture du robot.
Concernant le terme de la gravité,
0
( )
𝑔 (𝑞) = ∑ (𝑚 𝑔 𝐽, ) g= 0 (Eq 2.22)
−𝑔
Soit:
( ) ( )
𝑔 (q) = 𝑚 𝑔 𝐽 , + 𝑚 𝑔 𝐽 ,
( ) ( )
𝑔 (q) = 𝑚 𝑔 𝐽 , + 𝑚 𝑔 𝐽 ,
0 0
𝑔 (q) = 𝑚 [0 0 − 𝑔 ] 0 + 𝑚 [0 0 − 𝑔 ] 0
1 1
= −(𝑚 + 𝑚 )𝑔
0 1
𝑔 (q) = 𝑚 [0 0 − 𝑔 ] 0 + 𝑚 [0 0 − 𝑔 ] 0 = 0
0 0
Modèle dynamique complet :
τ = (𝑚 + 𝑚 )𝑞 ̈ − 𝑔 (𝑞) = (𝑚 + 𝑚 )𝑞 ̈ + (𝑚 + 𝑚 ) 𝑔
τ = 𝑚 𝑞 ̈ − 𝑔 (𝑞) = 𝑚 𝑞 ̈
Q2 : Que conclure par rapport à ce modèle ?
1. Les termes de la matrice d’inertie sont constants.
2. Les dynamiques de l’axe 1 et de l’axe 2 sont totalement découplées.
3. Les régulateurs de chaque axe sont indépendants de la position de travail (𝑞 , 𝑞 ).
2
Cours Bases de la Robotique (MICRO 450)
Q3 : Le modèle inverse a priori
M.D inverse
τ = (𝑚 + 𝑚 )𝑞 ̈ + (𝑚 + 𝑚 ) 𝑔
q Γ =τ
τ = 𝑚 𝑞̈
q Γ =τ
Q4 : Modèle dynamique direct
Les équations précédentes sont des expressions algébriques : M.D direct
τ = f (q , q̈ ) τ q
τ = f (q , q̈ )
τ q
𝑞̈ = −𝑔 , 𝑞̈ =
Soient 2 équations différentielles du 2ème ordre.
Soit sous la forme d’état (positions, vitesses) :
𝑥 =𝑞 𝑥 = 𝑞
𝑥 = 𝑞̇ 𝑥 = 𝑞̇
Les variables d’état sont les variables intégrales qui permettent d’intégrer le système.
3
Cours Bases de la Robotique (MICRO 450)
Solution 7.2 :
MODELISATION DYNAMIQUE par la méthode de Newton Euler
Approche :
1. Décrire le robot
a. Identifier le point outil (TCP) et les articulations diverses.
b. Identifier les segments du robot.
2. Définir le référentiel de base du robot.
3. Définir les sens positif et négatif de chaque articulation.
4. Ecrire les équations de Newton et d’Euler pour chaque segment.
5. Résoudre le système d’équations formé et déduire le modèle dynamique formé par
l’expression des couples articulaires pour chaque segment.
Exemple du « Robot cartésien à 2 axes »:
La première opération à effectuer concerne le choix des axes du référentiel du robot. Par la suite, le
référencement de chaque axe articulaire doit être effectué.
Corps Ø (bâti) : 𝑣 Ø = 𝑣̈ Ø = ω = ω̇ = 0
Corps 1 (Segment 1):
0 0
𝑣 = 0 , v̇ = 0 , ω =̇ ω = 0
ḋ 𝑑̈
f τ
f = f , f = f
τ f
Equ.1 f ⃗ − f ⃗ + m 𝑔⃗ − m v̇ =0
f f 0 0
f − f +m 0 −m 0 =0
f f −𝑔 𝑑̈
f =f et f =f
τ −f − m 𝑔 − m 𝑑̈ = 0
4
Cours Bases de la Robotique (MICRO 450)
Corps 2 (Segment 2):
ḋ 𝑑̈
v = 0 , v̇ = 0
0 0
Equ. Segment 2 f ⃗ − f ⃗ + m 𝑔⃗ − m v̇ =0
f f 0 𝑑̈
f − f +m 0 −m 0 =0
f f − 𝑔0 𝑑̈
Force nulle car pas de
f ⃗ + m 𝑔⃗ − m 𝑣̇ = 0 corps 3
𝑓 = 𝑚 𝑑̈ = 𝜏 (1)
f = 0, f = m g + m 𝑑̈
𝜏 = 𝑚 𝑔 + 𝑚 𝑑̈ + 𝑚 𝑔 + 𝑚 𝑑̈ (2)
