Académique Documents
Professionnel Documents
Culture Documents
III : CINEMATIQUE DES ROBOTS
DEFINITION
Dans le chapitre précédent on a introduit le modèle géométrique qui concernait
uniquement la pose. Dans ce chapitre on déduira le modèle cinématique. Ce dernier
consiste à trouver une relation entre le mouvement différentiel de l’OT et le mouvement
des articulations du robot.
𝒅𝑿 𝜕𝒇 𝒅𝒒
· 𝑱 𝒒 ·𝒒
𝒅𝒕 𝜕𝒒 𝒅𝒕
Alors pour calculer 𝐉 𝐪 il suffit de connaître les équations 𝑓 avec i = 1, n ainsi que leur
dérivée par rapport aux variables articulaires 𝑞 .
𝐗
Le vecteur représente le torseur distributeur des vitesses de l’OT.
On note 𝐕 𝑂 ∈ 𝑖 ⁄0 𝐕
On a :
𝑽 𝑶𝒊 ∈ 𝒊 1⁄0 𝑽 𝑶𝒊 ∈𝒊 1⁄0 𝝎𝒊 𝑶𝒊 𝑶𝒊
De même :
𝒊
𝑽 𝑶𝒊 ∈ 𝒊⁄𝒊 1 𝑽 𝑶𝒊 ∈ 𝒊⁄𝒊 1 𝝎𝒊 𝑶𝒊 𝑶𝒊
On arrive finalement à :
𝑽𝒊 𝑽𝒊 𝑽 𝑶𝒊 ∈ 𝒊⁄𝒊 1 𝝎𝒊 𝑶𝒊 𝑶𝒊
ω q z⃗ ω
𝟎𝑽 𝟎𝑽 𝟎𝝎 𝑶𝒊
𝒊 𝒊 𝟏 𝒊 𝟏 𝑶𝒊
ω ω
𝟎𝑽 𝟎𝑽 𝑽 𝑶𝒊 ∈ 𝒊⁄𝒊 𝟏 𝟎𝝎 𝑶𝒊
𝒊 𝒊 𝟏 𝟏 𝒊 𝟏 𝟏 𝑶𝒊
En utilisant ces équations on peut faire l’analyse cinématique complète du robot. Les
conditions de départ sont pour i =1 :
𝟎
𝝎𝟎 𝟎
𝟎
𝑽𝟎 𝟎
𝜹𝒒 𝑱 · 𝜹𝑿
δq∗ J J J · δX
En effet, on démontre mathématiquement que cette solution minimise le scalaire
𝑒 𝐉 · 𝛿𝒒∗ 𝛿𝑿𝒅 𝐉 · 𝛿𝒒∗ 𝛿𝑿𝒅 , qui n’est autre que l’écart entre le mouvement
réel et le mouvement désiré.
Exemple : les robots 5 axes se limitent à des taches bien déterminées comme la peinture
le soudage.
𝐉𝐓 · 𝐗 𝐉𝐓𝐉 · 𝐪
𝐪 𝐉𝐓 𝐉 𝐉𝐓 · 𝐗
𝐪 𝐉 ·𝐗
𝐉 , est appelé pseudo‐inverse gauche car: 𝐉 𝐉 𝑰
Exemple : les robots 5 axes se limitent à des taches bien déterminées comme la peinture
le soudage.
𝑥⃗
𝑥 0 𝑎 𝑆 𝑎 𝑆 𝑎 𝑆 𝑑 𝑎 𝑂 𝑎
𝑦 0 𝑎 𝐶 𝑎 𝐶 𝑎 𝐶 𝑥⃗ 𝑑
· 𝜃
𝑧 1 0 0 𝑧⃗
𝛾 0 1 1 𝜃 𝑧⃗
Tout calcul fait on obtient : 𝑂 𝑂
0 0 1 0 𝑥⃗
𝑎 𝑆 𝐶 𝑎 𝑆 𝑆 𝑎 𝐶 𝑎 𝐶 𝐶 𝐶 𝑎 𝐶
0
𝑱 𝐿 𝐿 𝐿
𝐴·𝑆 𝐵·𝑆 𝐴·𝐶 𝐵·𝐶 𝑎 𝑎 𝐶
0
𝐿 𝐿 𝐿
Avec :𝐴 𝑎 𝑎 𝑎 𝐶 1; 𝐵 𝑎 𝑎 𝑎 𝐶 ;𝐿 𝑎 1 𝐶 1
1 0 0 0 0 1 0
𝑱 ·𝑱 0 2,86 3,31 ; 𝑱 · 𝑱 ·𝑱 0,51 1,55 0 0,446
0 3,31 4,63 0,264 1,69 0 1,317
𝑑 0,5018
1
0,4962
Ce qui donne : 𝜃 1,28 ; en multipliant 𝑱 · 𝒒
1
𝜃 3
1,72
Alors : 𝑱 · 𝒒 𝑿 1,38 · 10 Cette erreur dépendra de la configuration.
Méthode de résolution:
1ère méthode pseudo‐inverse :
𝟏
𝑿 𝑱·𝒒 ⇒ 𝒒 𝑱𝑻 𝑱 · 𝑱𝑻 ·𝑿 ⇒ 𝒒 𝑱 ·𝑿
𝑿 𝑱 ·𝒒 𝑱 ·𝒒
𝑱 matrice carrée de dimension (m,m)
𝑱 matrice de dimension (m,n‐m)
𝒒 inconnues principales (m)
𝒒 inconnues secondaires (n‐m)
D’où :
𝐉 𝐗 𝐉𝐡 𝐪𝐡 𝐪𝐩
On doit ici donner en plus 𝑿 , les éléments de 𝒒 que l’on choisissant d’une façon guidée
par exemple contourner des obstacles. On peut également les annuler.
Méthode pseudo‐inverse :
Pour le robot 3P plan :
1
𝑞 2 0 𝑥
𝑞 0 1 · 𝑦
𝑞 1
2 0
Si 𝑥 1 𝑒𝑡 𝑦 1 on trouve 𝑞 ⁄ ;𝑞 1 𝑒𝑡 𝑞 ⁄