Professional Documents
Culture Documents
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 1/ 89
Plan (1A)
Bibliographie
Avant-propos
Chapitre 1 : Introduction à la robotique (1A)
Chapitre 2 : Mathématiques pour la robotique (1A)
Chapitre 3 : Géométrie et cinématique des robots (1A)
Chaı̂ne cinématique et Classification des robots
Modélisations géométriques (convention de Denavit-Hartenberg)
Modélisations cinématiques
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 2/ 89
Chapitre 3 : Géométrie et cinématique des robots
I.1 Introduction
q2 q3 3
2 4
q1 q4
1 5
6
q5 7
0
q6
Modélisation géométrique du robot médical AESOP (Automatic Endoscopic System for Optimal Positioning)
de la société Computer Motion (1999).
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 3/ 89
I.1 Introduction
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 4/ 89
Chapitre 3 : Géométrie et cinématique des robots
I.1 Introduction
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 5/ 89
La chaı̂ne cinématique
La chaı̂ne cinématique structure le système mécanique articulé et
correspond aux divers corps et liaisons (ou articulations) entre les corps.
Les liaisons sont passives ou actives (motorisées). La chaı̂ne peut être
ouverte (robot série), multiple ou fermée.
corps
liaisons
OT
Base
A gauche : une chaı̂ne ouverte. Au centre, une chaı̂ne multiple. A droite, une chaı̂ne fermée.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 6/ 89
Chapitre 3 : Géométrie et cinématique des robots
La chaı̂ne cinématique
Exemple de chaı̂ne cinématique en arbre (chaı̂ne multiple) : la chaı̂ne
cinématique de la pince à trois doigts BarrettHandTM de chez Barrett
Technology est une structure en arbre; Chaque doigt possède deux degrés
de liberté et les bases de deux des trois doigts peuvent être orientées pour
reconfigurer l’arbre (au total : 8 ddl).
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 7/ 89
La chaı̂ne cinématique
Exemple de chaı̂ne cinématique fermée : on obtient par exemple une
chaı̂ne cinématique fermée soit à partir d’une configuration particulière,
soit à partir de plusieurs systèmes mécaniques articulés en interaction ou
soit avec des robots parallèles.
Ci-dessous, deux robots à chaı̂nes simples et ouvertes maintiennent un
objet avec double contact unilatéral en A et B (le transfert est optimisé en
tenant compte des contraintes d’unilatéralité et de non-glissement aux
points de contact). L’ensemble forme alors une chaı̂ne cinématique
fermée.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 8/ 89
Chapitre 3 : Géométrie et cinématique des robots
La chaı̂ne cinématique
Le mouvement d’un robot bipède plan avec pieds bi-segmentaires (de type
patins) en phase de double appui est un autre exemple de chaı̂ne
cinématique fermée.
Ce système se déplace dans un plan, vertical et médian), a six
articulations actives et deux contacts unilatéraux. Le système fonctionne
alors comme un mécanisme de cinq barres à six articulations actives. Il est
par conséquent fortement sur-actionné tout en présentant un bouclage
réalisé par contacts unilatéraux.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 9/ 89
La chaı̂ne cinématique
Le mouvement de pédalage est un exemple de chaı̂ne cinématique fermée
(double boucle : ABCDOA, A’B’C’D’OA’). Le mouvement supposé plan
est représenté par un système à trois degrés de liberté (ddl), (degrees of
freedom - dof), et de six articulations actives : 2 hanches, 2 genoux et 2
chevilles.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 10/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 11/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 12/ 89
Chapitre 3 : Géométrie et cinématique des robots
Exemples de robots parallèles plans à 2 ddl de translation. Les articulations pivots sont les cercles blancs pour
celles actionnées et noirs pour les passives: RPRPR, RRRPR, RPRRPR, RRRRR, RRRRP et PRRRP.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 13/ 89
Le robot parallèle plan à 2 ddl DexTAR (Dextrous Twin-Arm Robot, Ecole de Technologie Supérieure de Montréal - RRRRR).
Link
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 14/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 15/ 89
Robot TRIPTERON de l’Université de Laval (Canada, Québec) à 3 ddl. Ce robot parallèle a une structure
équivalente à celle d’un robot cartésien, mais avec une inertie bien plus faible.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 16/ 89
Chapitre 3 : Géométrie et cinématique des robots
(à gauche) Robot parallèle ”Pick and Place” FlexPicker d’ABB. (à droite) Robot parallèle ”Pick and Place” F-Delta DD Bosch.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 17/ 89
(à gauche) Schéma de la plateforme de Gough-Stewart (6 ddl). (à droite) Robot parallèle F200iB de FANUC Robotics (6ddl).
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 18/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 19/ 89
Vues latérale et apicale d’un volume de travail (en jaune) pour un robot 3R.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 20/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 21/ 89
Cette partie est relative aux chaı̂nes ouvertes simples. Afin de dénombrer les
différentes architectures possibles, on ne considère que 2 paramètres ; le type
d’articulation : pivot/rotoı̈de (R) ou prismatique (P).
On convient d’appeler les 3 premiers ddl, le porteur du robot. Les ddl restants
forment le poignet, caractérisé par des dimensions beaucoup plus petites et
une plus faible masse.
Pour les chaı̂nes cinématiques ouvertes, le poignet est constitué d’un ensemble
d’articulations (2 ou 3 le plus souvent) et est relié d’une part au porteur,
d’autre part à l’outil monté sur l’organe terminal (parfois un capteur d’effort
est intercalé entre les deux). Un poignet sphérique (3R) est obtenu à partir de
trois articulations pivots (3 × 1R) d’axes concourants.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 22/ 89
Chapitre 3 : Géométrie et cinématique des robots
Porteur Poignet
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 23/ 89
(à gauche) Schématisation d’un porteur PPP. (à droite) Robot cartésien Toshiba BA-II.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 24/ 89
Chapitre 3 : Géométrie et cinématique des robots
(à gauche) Schématisation d’un porteur RRP sphérique. (à droite) Robot sphérique FANUC L-1000.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 25/ 89
(à gauche) Schématisation d’un porteur RRP SCARA. (au centre) Robot SCARA Epson G10-650.
(à droite) Robot SCARA d’Adept Technology.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 26/ 89
Chapitre 3 : Géométrie et cinématique des robots
(à gauche et au centre) Schématisation d’un porteur cylindrique RPP.
(à droite) Robot cylindrique SEIKO.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 27/ 89
Le porteur RRR (ou 3R) : 3 articulations pivots (dont les 2 dernières ont des
axes parallèles). Un robot doté d’un tel porteur et possédant un poignet est
appelé anthropomorphe.
Le terme anthropomorphe signifie qui a l’apparence humaine. Les robots
anthropomorphes n’ont pas vraiment l’apparence humaine mais sont plutôt des
robots poly-articulés dont les articulations (au moins 3 articulations R) sont
nommées tronc (body), épaule (shoulder), coude (elbow) et poignet (wrist).
Shoulder
Elbow
Body
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 28/ 89
Chapitre 3 : Géométrie et cinématique des robots
(à gauche) Robot PUMA 560 (Programmable Universal Machine for Assembly) d’Unimation, un des plus anciens robots au monde (1971
– GM et MIT). (au centre) Robot SCEMI 6P01. (à droite) Robot anthropomorphe Kuka KR1000 à 5 axes de rotation.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 29/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 30/ 89
Chapitre 3 : Géométrie et cinématique des robots
(a) (b)
(a) Robot manipulateur de type SCARA (RRP) : le robot Kuka KR5 R350 à 4 ddl : portée max=350 mm, course z = 320 mm, charge
admissible max=5 kg, répétabilité=0.015 mm, masse=20 kg, vitesse max=7.2 m/s (manipulation rapide et assemblage). (b) Robot
manipulateur Adept Viper S850 de type anthropomorphe (3R) (reach=850 mm, payload=2.5 kg, repeatability=0.03 mm).
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 31/ 89
(a) (b)
Deux robots manipulateurs anthropomorphes (3R) : (a) Le robot Kuka KR 1000 1300 TITAN PA à 6 ddl : portée max=3202 mm,
charge admissible max=1300 kg, répétabilité=0.2 mm, masse=4690 kg (emballage et palettisation). (b) Le robot Adept Viper
S1700D (reach=1717 mm,payload=20 kg,repeatability=0.06 mm).
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 32/ 89
Chapitre 3 : Géométrie et cinématique des robots
X = f (q)
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 33/ 89
Redondance (m < n)
Un robot est dit redondant (ou globalement redondant) si la dimension m de
l’espace opérationnel - correspondant au nombre de degrés de liberté de
l’organe terminal - est inférieur au nombre n de variables de l’espace articulaire.
C’est le cas notamment si sa structure présente une des propriétés suivantes :
Plus de 6 articulations,
Plus de trois articulations pivots d’axes concourants,
Plus de trois articulations pivots d’axes parallèles,
Plus de trois articulations prismatiques,
Deux axes d’articulations prismatiques parallèles,
Deux axes d’articulations pivots confondus.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 34/ 89
Chapitre 3 : Géométrie et cinématique des robots
Redondance (m < n)
Exemple : évitement d’obstacles
Robot plan à 6 ddl pour une trajectoire imposée de la position de l’organe terminal tout en évitant les obstacles.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 35/ 89
Robot manipulateur anthropomorphe STÄUBLI RX-160 à 6 ddl. La configuration verticale de l’image de droite est une redondance locale
car il y a clairement plusieurs façons (plusieurs choix d’articulations) de réaliser une rotation d’axe vertical de l’effecteur.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 36/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 37/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 38/ 89
Chapitre 3 : Géométrie et cinématique des robots
Comme l’espace de travail est un plan, tous les déplacements sont définis à
partir de 2 ddl de translation et 1 ddl de rotation. L’espace opérationnel du
vecteur X a donc au plus m = 3 composantes :
X = (X1 , X2 , X3 )T = (x2 , y2 , θ)T , mais il peut en avoir moins selon la tâche :
réaliser une tâche de positionnement de l’organe terminal en prenant
X = (x2 , y2 )T , et la consigne de position X? = (x?2 , y2? )T (θ quelconque),
réaliser une tâche d’orientation de l’organe terminal en prenant X = θ et
la consigne angulaire X ? = θ? , (vecteur (x2 , y2 )T quelconque),
réaliser d’autres tâches,
au-delà de m = 2 composantes prises de l’espace opérationnel dans cet
exemple pour construire le vecteur d’état X, le robot est considéré comme
sous-déterminé (ou sous-actionné) pour la tâche, car alors n < m.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 39/ 89
c2 −s2 0 a2 c2
1
s2 c2 0 a2 s2
T2 =
0
0 1 0
0 0 0 1
c12 −s12 0 a1 c1 + c12 a2
0 s12 c12 0 a1 s1 + s12 a2
T2 =0 T11 T2 =
0 0 1 0
0 0 0 1
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 40/ 89
Chapitre 3 : Géométrie et cinématique des robots
cθ1 −sθ1 0 0 1 0 0 a1 cθ1 −sθ1 0 a1 cθ1
sθ1 cθ1 0 0
0 0 1 0 0 = sθ1 cθ1 0 a1 sθ1
T1 =
0
0 1 0 0 0 1 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 41/ 89
cθi −sθi 0 0 1 0 0 0
i−1
sθi cθi 0 0 0 1 0 0
Ti =
0
.
0 1 0 0 0 1 di
0 0 0 1 0 0 0 1
1 0 0 ai 1 0 0 0
0
1 0 0 0
cαi −sαi 0
0 0 1 0 0 sαi c αi 0
0 0 0 1 0 0 0 1
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 42/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 43/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 44/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 45/ 89
~
yi est tel que le repère
(Ri ) est orthonormé et
yi = ~zi ∧ ~xi ),
direct (~
di est la distance de la
normale commune au
point Oi−1 selon la
direction de ~zi−1 ,
le point On est attaché
à (Cn ) (n variables
articulaires dans q).
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 46/ 89
Chapitre 3 : Géométrie et cinématique des robots
cθi −sθi cαi sθi sαi ai cθi
i−1 i−1
i−1
sθi cθi cαi −cθi sαi ai sθi Ri Oi
Ti = =
0 sαi cαi di 0T 1
0 0 0 1
i−1
La sous-matrice (3 × 3) supérieure gauche est la rotation Ri ,
La dernière colonne (3 premières composantes) est le vecteur de
−
−−−− →
translation entre les origines : i−1 Oi = Oi−1 Oi
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 47/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 48/ 89
Chapitre 3 : Géométrie et cinématique des robots
(Ci−1 ) → (Ci ) α a d θ
(0) → (1)
(1) → (2)
(2) → (3)
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 49/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 50/ 89
Chapitre 3 : Géométrie et cinématique des robots
1 0 0 0 1 0 0 0
0 1 0 0
1 0 0 1 0
T2 =
0 0 1 d2 0 −1 0 0
0 0 0 1 0 0 0 1
1
0 0 0
2
0 1 0 0
T3 =
0
0 1 d3
0 0 0 1
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 51/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 52/ 89
Chapitre 3 : Géométrie et cinématique des robots
(Ci−1 ) → (Ci ) α a d θ
(0) → (1)
(1) → (2)
(2) → (3)
(3) → (4)
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 53/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 54/ 89
Chapitre 3 : Géométrie et cinématique des robots
(1) → (2) π a2 0 θ2?
(2) → (3) 0 0 d?3 0
(3) → (4) 0 0 d4 θ4?
q = (θ1 , θ2 , d3 , θ4 ) T
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 55/ 89
c2 s2 0 c2 a2 c4 −s4 0 0
1
s2 −c2 0 s2 a2 3
s4 c4 0 0
T2 = T4 =
0 0 −1 0 0 0 1 d4
0 0 0 1 0 0 0 1
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 56/ 89
Chapitre 3 : Géométrie et cinématique des robots
c12−4 −s12−4 0 c1 a1 + c12 a2
0
s12−4 c12−4 0 s1 a1 + s12 a2
T4 =
0 0 −1 d1 − (d3 + d4 )
0 0 0 1
Toutes les rotations se font selon l’axe ~z. L’angle d’orientation θ vaut alors
θ = θ1 + θ2 − θ4 selon la direction ~z0 .
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 57/ 89
q = f −1 (X)
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 58/ 89
Chapitre 3 : Géométrie et cinématique des robots
c1 c23 −c1 s23 s1
0
R3 = s1 c23 −s1 s23 −c1
s23 c23 0
On voit que la dernière colonne fournit la valeur de θ1
de manière unique, alors que la dernière ligne ne donne
de manière unique que la somme des angles θ2 + θ3 :
c’est une redondance locale (singularité).
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 59/ 89
Ẋ = J(q) q̇
Ẋ peut se mettre sous la forme d’un torseur cinématique τ = Ẋ = (v, Ω)T qui
rassemble la vitesse de translation de On (fixe dans (Rn ) et origine de (Rn ))
par rapport à (R0 ) et la vitesse de rotation de (Rn ) par rapport à (R0 ).
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 60/ 89
Chapitre 3 : Géométrie et cinématique des robots
Remarques
Dans la formule Ẋ = J(q) q̇, Ẋ est donc la vitesse du corps rigide (Cn )
prise en l’origine de (Rn ), On , par rapport au corps (C0 ) attaché au
repère (R0 ). On la note précisément ainsi :
T
0 On 0
Ẋ = vn , Ωn
mais il faut indiquer aussi dans quel repère cette vitesse est exprimée. La
plupart du temps, on choisit le repère de base (R0 ) ou celui de l’outil. On
note alors 0 Ẋ = 0 J(q) q̇, pour une expression dans le repère de base (R0 )
T
0 0 0 On
Ẋ = ( vn ) , 0 (0 Ωn ) .
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 61/ 89
paramètres de D-H. C1
Calculer les expressions des composantes de 0 J(q)
dans le repère de base (R0 ) en fonction des Corps C0
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 62/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 63/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 64/ 89
Chapitre 3 : Géométrie et cinématique des robots
b
b Ra 03×3
Ga = b
03×3 Ra
où b Ra est la matrice de rotation entre les repères orthonormés (Rb ) et (Ra )
exprimée dans (Rb ). b Ga est une matrice (6 × 6) inversible.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 65/ 89
puisque
b 0 On b
( vn ) = Ra a (0 vnOn )
b 0
( Ωn ) = bR
a
a 0
( Ωn )
On a donc :
b b
Ẋ = Ga a Ẋ.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 66/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 67/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 68/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 69/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 70/ 89
Chapitre 3 : Géométrie et cinématique des robots
0 i−1 On
Vitesse de translation : le terme Ri−1 vi ci-dessus vaut
si l’articulation qi est glissière/prismatique : q̇i 0 zi−1 ,
si l’articulation qi est pivot/rotoı̈de : q̇i 0 zi−1 ∧ 0 Ri−1 i−1
On .
0 i−1
Vitesse de rotation : le terme Ri−1 Ωi ci-dessus vaut
si l’articulation qi est glissière/prismatique : 0 (vecteur nul),
si l’articulation qi est pivot/rotoı̈de : q̇i 0 zi−1 .
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 71/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 72/ 89
Chapitre 3 : Géométrie et cinématique des robots
cθi −sθi cαi sθi sαi ai cθi
i−1 i−1
i−1
sθi cθi cαi −cθi sαi ai sθi Ri Oi
Ti = =
0 sαi cαi di 0T 1
0 0 0 1
i−1
nous fournit Oi = (ai cθi , ai sθi , di )T , la différentiation de 0 On vaut alors :
ai cθi 0
∂ 0 On ∂ 0 ∂
= ( Ri−1 i−1 Oi ) = 0 Ri−1 ai sθi = d˙i 0 Ri−1 0
∂qi ∂di ∂di
di 1
= d˙i 0 Ri−1 i−1 zi−1 = d˙i 0 zi−1 .
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 73/ 89
si qi = θi est pivot/rotoı̈de :
0 0 i−1
0 zi−1 ∧ Ri−1 On
ji = 0
zi−1
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 74/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 75/ 89
(Ci−1 ) → (Ci ) α a d θ
(0) → (1)
(1) → (2)
(2) → (3)
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 76/ 89
Chapitre 3 : Géométrie et cinématique des robots
(Ci−1 ) → (Ci ) α a d θ
(0) → (1) − π2 0 d1 θ1?
(1) → (2) 0 0 d2 θ2?
(2) → (3) 0 0 d?3 0
T
q = (θ1 , θ2 , d3 )
0
J(q) = 0 j1 0 j2 0
j3
0
z0 ∧ (0 R0 0 O3 )
0
j1 = 0 car q1 = θ1 est une liaison pivot,
z0
0
z1 ∧ (0 R1 1 O3 )
0
j2 = 0 car q2 = θ2 est une liaison pivot,
z1
0
0 T
j3 = z2 0 car q3 = d3 est une liaison glissière.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 77/ 89
c1 −s1 0 1 0 0 c1 0 s1
0
R1 = s1 c1 0 0 0 −1 = s1 0 −c1
0 0 1 0 1 0 0 1 0
c2 −s2 0
1 s2
R2 = c2 0
0 0 1
c1 c2 −s1 −c1 s2
0 0
R2 = s1 c2 c1 −s1 s2 = R3
s2 0 c2
0
R0 = I3×3
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 78/ 89
Chapitre 3 : Géométrie et cinématique des robots
0 s1 0
0 0
z1 = R1 1 z1 = 0 R1 0 = −c1 ; i zi = 0
1 0 1
0 −c1 s2
0 0
z2 = R2 2 z2 = 0 R2 0 = −s1 s2
1 c2
0 0 0
1 0 + 1 R2 0 =
O3 = 0
d2 d3 d2 + c2 d3
0 0 0 s1 d2 − c1 s2 d3
0 0 + 0 R1 0 + 0 R2 0 =
O3 = −c1 d2 − s1 s2 d3
d1 d2 d3 d1 + c2 d3
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 79/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 80/ 89
Chapitre 3 : Géométrie et cinématique des robots
Efforts statiques
Si on note par fs , le torseur rassemblant toutes les composantes des efforts
statiques (vecteur à 6 composantes au plus : forces (Fx , Fy , Fz ) et moments
(Mx , My , Mz )) s’exerçant sur l’organe terminal, alors le vecteur des efforts τ
sur les articulations est relié à fs par la simple formule :
τ = J(q)T fs
Remarques :
τ doit tenir compte des pertes par frottements,
La relation τ = J(q)T fs est valable à vitesse constante.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 81/ 89
(à gauche) Capteur à jauge de contrainte MBA500 2 axes force (Fz ≤ 2 KN) et couple (Mz ≤ 55 Nm) de Futek est conçu pour
mesurer le couple de réaction simultanément à la mesure de force en traction et compression. Ce capteur couple/force est utilisé en
production industrielle, les assemblages robotique, la chirurgie robotisée, la neurologie et la réadaptation.
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 82/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 83/ 89
q̇ = J(q)−1 Ẋ
mais cela suppose que qu’il y ait autant d’articulations que de degrés de liberté
dans X (n = m), et qu’il n’y ait aucune dépendance entre les colonnes de
J(q). Pour les robots ne disposant pas d’autant d’articulations que de degrés
de liberté de l’organe terminal (n < m), la matrice jacobienne, en l’état, ne
peut être inversée. Pour le cas où n > m, q̇ peut être déterminé en utilisant la
pseudo-inverse (de droite) de J(q) si rang(J(q)) = m. Cette inverse de
dimensions (n × m) vaut :
et on a : q̇ = J † Ẋ + (I − J † J) b .
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 84/ 89
Chapitre 3 : Géométrie et cinématique des robots
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 85/ 89
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 86/ 89
Chapitre 3 : Géométrie et cinématique des robots
Singularités
Avec une matrice jacobienne J ∈ Rm×n le rang de J est toujours tel que :
Par exemple, avec le robot plan à n = 2 articulations, nous avons toujours que
rang(J) ≤ 2, et avec un robot anthropomorphe muni d’un poignet sphérique,
nous avons toujours rang(J) ≤ 6.
Le rang d’une matrice jacobienne de robot n’est pas forcément une valeur
constante, il dépend de la configuration des variables articulaires q. Ainsi, les
configurations pour lesquelles le rang de J est inférieur à la valeur maximum
sont appelées configurations singulières ou simplement singularités. Identifier
les singularités d’un robot est très important, pour de multiples raisons :
Les singularités représentent des configurations pour lesquelles certaines
directions de déplacement ne sont pas atteignables,
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 87/ 89
Singularités
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 88/ 89
Chapitre 3 : Géométrie et cinématique des robots
Singularités
Comme la chaı̂ne cinématique des manipulateurs anthropomorphes est
décomposée en un porteur et un poignet, on est amené souvent à distinguer les
singularités du premier (Jp ) ou du second (J0 ) : dans ce cas matrice
jacobienne (6 × 6) est triangulaire inférieure par blocs (3 × 3) :
J11 0
J = Jp Jo =
J21 J22
de déterminant det(J) = det(J11 ). det(J22 ).
Christophe DOIGNON c.doignon@unistra.fr Robotique et Recalage 3-D (FIP TIS, édition 2017) 89/ 89