Robotique
Robotique
Robotique
fondamental
David.Daney sophia.inria.fr
D. Daney INRIA
Cours Robotique
200x
1 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
2 / 165
Il y a 4000 ans, Talos, lhomme de cuivre, option catapultes et lance amme. Le Dieu Hphatos la forg et offert au roi Minos en Crte pour dfendre cette le des envahisseurs. Talos Selon le chant XVIII de lIliade (Homre, IXe sicle avant J.C.) Hphastos (Vulcain) fut le premier fabricant de cratures articielles "techniques". Mythe de Pigmalion, jeune roi de Chypre, un homme "cre" la vie. 384-322 av JC Aristote, Machines pour accomplir nos tches Aristote
D. Daney INRIA Cours Robotique 200x 3 / 165
Automate, Heron
D. Daney INRIA
Cours Robotique
200x
4 / 165
809, le sultan Haroun Al-Rachid offre Charlemagne le premier automate mcanique (horloge). n 12ime, les fontaines dAl-Jazari pour le confort de lhomme. (systme pouvant nous rappeler la chasse deau de nos toilettes) 1193-1280 Lvque Albert le Grand aurait pass trente ans construire un robot fait de mtal et de bois que son lve, le futur saint Thomas dAquin, persuad que cela avait quelque chose voir avec le dmon, envoya au feu Fontaine, Al-Jazari
D. Daney INRIA Cours Robotique 200x 5 / 165
Horloge, Venise
D. Daney INRIA
1576-1626 Salomon de Caus, mcanismes hydrauliques et la premire machine programmable. Automate hydraulique, Salomon de Caus 1642 Pascal invente la Pascaline, premire calculatrice. n XVII Thomas Hobbes estime que penser et calculer ne font quun. Ren Descartes assimile le corps des animaux un automate.
La Pascaline
D. Daney INRIA Cours Robotique 200x 7 / 165
1721-1790 Pierre Jacquet-Droz, Un crivain, un dessinateur et une joueuse de tympanon (piano simpli).
La joueuse de tympanon
"Sa poitrine se soulve et sabaisse comme dans la respiration, sa tte remue, ses yeux regardent tantt ses mains, tantt la musique, et tantt les auditeurs ; elle se penche sur la partition comme pour mieux lire ou couter, et la n de la partition elle salue poliment"
D. Daney INRIA
Cours Robotique
200x
8 / 165
D. Daney INRIA
Cours Robotique
200x
9 / 165
et les doigts jouent une douzaine de mlodies la te traversire ; le Canard, qui peut picorer du grain, boire et jecter des crottes (dixit Vaucanson) ;
un joueur de tambourin et de ageolet (genre de te
Le canard
D. Daney INRIA
10 / 165
Machine tisser
D. Daney INRIA
D. Daney INRIA
Cours Robotique
200x
12 / 165
RUR
D. Daney INRIA
Enigma
D. Daney INRIA
Cours Robotique
200x
14 / 165
1970 Shakey, Stanford Research Institute. 1947 premier manipulateur lectrique tlopr. 1954 premier robot programmable. 1961 apparition dun robot sur une chane de montage de General Motors.
1961 premier robot avec contrle en effort. 1963 : utilisation de la vision pour commander un robot.
Cours Robotique 200x 15 / 165
D. Daney INRIA
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
16 / 165
Dnitons
Un robot est un systme mcanique poly-articul m par des actionneurs et command par un calculateur qui est destin effectuer une grande varit de tches. "Un appareil automatique qui peut effectuer des fonctions normalement effectuer par des humains." Traduit du dictionnaire Websters "Appareil automatique capable de manipuler des objets ou dexcuter des oprations selon un programme xe ou modiable." Petit Larousse "Un manipulateur reprogrammable multifonctionnel concu pour deplacer des matriaux,des outils, des pices ou des composantes spcialiss travers une srie de mouvements programms pour effectuer une tache prcise." Robot Institut de robotique dAmrique,1979 "A robot is a machine designed to execute one or more tasks repeatedly, with speed and precision." whatis.com
D. Daney INRIA
Cours Robotique
200x
17 / 165
Dnitons
"Manipulateur command en position, reprogrammable, polyvalent, plusieurs degrs de libert, capable de manipuler des matriaux, des pices, des outils et des dispositifs spcialiss, au cours de mouvements variables et programms pour lexcution dune varit de tches. Il a souvent lapparence dun ou plusieurs bras se terminant par un poignet. Son unit de commande utilise, notamment, un dispositif de mmoire et ventuellement de perception et dadaptation lenvironnement et aux circonstances. Ces machines polyvalentes ont gnralement tudies pour effectuer la mme fonction de faon cyclique et peuvent tre adaptes dautres fonctions sans modication permanente du matriel." AFNOR Association Franaise de Normalisation
D. Daney INRIA
Cours Robotique
200x
18 / 165
Gnration 3
Dnition
D. Daney INRIA
Capteurs proprioctifs
Robot
Structure mcanique
Systme de dcision
Systme de commande
Systme de communication
Environnement
Cours Robotique
Actionneurs
Informations exteroceptifs
200x 19 / 165
Robotique mobile
Robots mobiles
Robots volants
AirRobot GmbH & Co.KG Problmes de commande Intgration des informations fournies par des capteurs
Robotique bio-inspire
Bipde oiseau
D. Daney INRIA Cours Robotique
Quadipode
200x 21 / 165
Robot mobile
Delta, ABB
D. Daney INRIA
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
24 / 165
Domaines dexpertises
Analyse numrique, Optimisation, Gomtrie algrique, Algorithmique, Mcanique Automatique Informatique Mathmatique applique Vision par ordinateur, Traitement dimages, Intelligence articielle, CAO, Mcatronique, Psychologie , Expertise Mdicale ...
D. Daney INRIA
Cours Robotique
200x
25 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
26 / 165
Domanes dapplications
de la robotique industrielle la robotique de service
Pour une grande majorit des robots ... tche simple tche rptitive (grande srie) qualit sur la tche (vitesse, prcision) pnibilit de la tche (peinture, charge lourde, environnement hostile, ...). Lavenir est lautonomie ... tche complexe interaction avec lenvironement (+ utilisateur) module de dcision (+ scurit)
D. Daney INRIA
Cours Robotique
200x
27 / 165
La robotique industrielle
Automobile
Robot soudeur
Robot peintre
Chane dassemblage
D. Daney INRIA Cours Robotique 200x 28 / 165
La robotique industrielle
Chane de production (industrie)
Environnement hostile
Nuclaire
Figure: Tlopration
Cours Robotique
200x
30 / 165
Environnement hostile
Exploration spatiale
Canadarm 1 et 2
Beagle 2
Cours Robotique 200x 31 / 165
Environnement hostile
Exploration sous-marine
D. Daney INRIA
Cours Robotique
200x
32 / 165
Agriculture
Tracteur autonome
Scurit, Militaire
Demineur
D. Daney INRIA
Cours Robotique
200x
34 / 165
Service la clientle
Aspirateur
CyCab
D. Daney INRIA
Cours Robotique
200x
35 / 165
Loisirs
Aibo, Sony
Robot Cup
D. Daney INRIA
Cours Robotique
200x
36 / 165
Humnode
Robot visage
P3 et Asimo, Honda
Expression du visage
D. Daney INRIA Cours Robotique 200x 37 / 165
Mdicale
Manipulateur pharmacetique
D. Daney INRIA Cours Robotique
Mlangeur pharmacetique
200x 38 / 165
Chirurgie
Physik Instrumente
D. Daney INRIA Cours Robotique
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
40 / 165
Degrs de libert
dans lespace
Combien de degrs de liberts a un solide dans lespace ? ou encore... Combien de paramtres indpendants (nombre minimal) sont-ils ncessaires pour dnir la situation (positionnement) du solide dans lespace (par rapport un repre de rfrence) ?
D. Daney INRIA
Cours Robotique
200x
41 / 165
Degrs de libert
dans lespace
3 en position 3 en orientation
P Z P Z
Y X X
D. Daney INRIA
Cours Robotique
200x
42 / 165
Degrs de libert
dans lespace
3 en position 3 en orientation
P Z P Z
Y X X
D. Daney INRIA
Cours Robotique
200x
42 / 165
Degrs de libert
dans lespace
3 en position 3 en orientation
P Z P Z
Y X X
D. Daney INRIA
Cours Robotique
200x
42 / 165
D. Daney INRIA
Cours Robotique
200x
43 / 165
Quels sont les degrs de libert de la "brosse effacer" se dplaant sur le tableau ?
D. Daney INRIA
Cours Robotique
200x
44 / 165
Quels sont les degrs de libert de la "brosse effacer" se dplaant sur le tableau ?
D. Daney INRIA
Cours Robotique
200x
44 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
45 / 165
Un exemple simple
Toto le petit robot
Roues
Il tourne
Dplacements de Toto.
Dans le plan, quel sont les coordonnes dun solide ? Quel sont les degrs de libert du robot ? Est-ce quivalent ?
Un exemple simple
Positionnement dun objet
A partir dune position initiale, le robot tourne de puis avance de t . Donner sa nouvelle position
Y
Position initiale X = t cos() Y = t sin() =
Y
ou bien
t
Position initiale
D. Daney INRIA Cours Robotique 200x 47 / 165
1 t . cos() X = @ t . sin() A
Un exemple simple
Positionnement dun objet
A partir dune position initiale, le robot tourne de puis avance de t . Donner sa nouvelle position
Y
Position initiale X = t cos() Y = t sin() =
Y
ou bien
t
Position initiale
D. Daney INRIA Cours Robotique 200x 47 / 165
1 t . cos() X = @ t . sin() A
Un exemple simple
Dplacement dun robot
Question: A partir dune position initiale, le robot tourne de puis avance de t puis tourne de puis avant de d . Donner son positionement.
D. Daney INRIA
Cours Robotique
200x
48 / 165
Un exemple simple
Dplacement dun robot
p y
u j
T
v
C
t
(2)
Un exemple simple
Dplacement dun robot
D V
x
V = T O + D O
+
(3)
C T O
i
1 t . cos + pO @ t . sin + q A O +
D. Daney INRIA Cours Robotique 200x
(4)
50 / 165
Dterminer D dans O
1/2
D V
x
sin
y j
cos
cos
x i
sin
D. Daney INRIA
Cours Robotique
200x
51 / 165
Dterminer D dans O
2/2
eq. (6) eq. (5) eq. (3) cos cos sin V = T O + D O = t . + p. + q. sin sin cos eq. (2) eq. (7) V = = cos cos sin + d . cos . + d . sin . sin sin cos cos cos ( + ) t. + d. sin sin ( + ) t. (8) (9) (7)
D. Daney INRIA
Cours Robotique
200x
52 / 165
Dterminer D dans O
Forme matricielle
D V
x
cos sin
y =
O
sin cos
= = =
sin
y j
cos
cos
x i
sin
= = =
Cours Robotique
p. x + q . y O O cos sin p. + q. sin cos cos sin p sin cos q cos sin D C sin cos x y D O O
C
R. D
D. Daney INRIA
200x
53 / 165
Dterminer D dans O
Forme matricielle
D V
x
cos sin
y =
O
sin cos
= = =
sin
y j
cos
cos
x i
sin
= = =
Cours Robotique
p. x + q . y O O cos sin p. + q. sin cos cos sin p sin cos q cos sin D C sin cos x y D O O
C
R. D
D. Daney INRIA
200x
53 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
54 / 165
Changement de repre
Cas plan
j C O i
Changement de repre
Cas plan
Remarque : La matrice R est une matrice orthogonal qui a des proprit: det(R ) R
1
= = =
1 R cos sin
t
Soit VC un vecteur exprim dans C et VO sa valeur dans O . VO VC = = R .VC + P R t .VO R t .P (13) (14)
D. Daney INRIA
Cours Robotique
200x
56 / 165
Changement de repre
Cas plan
Remarque : La matrice R est une matrice orthogonal qui a des proprit: det(R ) R
1
= = =
1 R cos sin
t
Soit VC un vecteur exprim dans C et VO sa valeur dans O . VO VC = = R .VC + P R t .VO R t .P (13) (14)
D. Daney INRIA
Cours Robotique
200x
56 / 165
Changement de repre
Cas Spatial
Soit le repre de base 0 et le repre C . La position P du repre C par rapport 0 . La matrice dorientation R du repre C par rapport 0 . Soit VC un vecteur exprim dans C et VO sa valeur dans O . VO VC = = R .VC + P R .VO R .P
t t
(15) (16)
D. Daney INRIA
Cours Robotique
200x
57 / 165
Rx (x )
Ry (y )
Rz (z )
1 1 0 0 @0 cos x sin x A 0 sin x cos x 0 1 cos x 0 sin x @ 0 1 0 A sin x 0 cos x 0 1 cos z sin z 0 @ sin x cos x 0A 0 0 1
R R
= =
D. Daney INRIA
Cours Robotique
200x
58 / 165
Rx (x )
Ry (y )
Rz (z )
1 1 0 0 @0 cos x sin x A 0 sin x cos x 0 1 cos x 0 sin x @ 0 1 0 A sin x 0 cos x 0 1 cos z sin z 0 @ sin x cos x 0A 0 0 1
R R
= =
D. Daney INRIA
Cours Robotique
200x
58 / 165
Rx ().Ry ().Rz ( )
cos cos sin sin cos + cos sin cos sin cos + sin sin
cos sin cos cos sin sin sin cos sin sin + sin cos
D. Daney INRIA
Cours Robotique
200x
59 / 165
avec a = 1 cos
D. Daney INRIA
Cours Robotique
200x
60 / 165
2(Q1 Q2 Q3 ) 2 2 1 Q2 1 + Q2 Q3 2(Q2 Q3 + Q1 )
1 2(Q1 Q3 + Q2 ) 2(Q2 Q3 Q1 ) A 2 2 1 Q2 1 Q2 + Q3
D. Daney INRIA
Cours Robotique
200x
61 / 165
2 2 Q0 + Q2 1 Q2 Q3 R= 2(Q1 Q2 + Q0 Q3 ) 2(Q3 Q1 Q0 Q2 )
2(Q1 Q3 + Q0 Q2 ) 2(Q2 Q3 Q0 Q1 ) 2 2 Q0 Q2 1 Q2 + Q3
= cos
D. Daney INRIA
Cours Robotique
200x
63 / 165
D. Daney INRIA
Cours Robotique
200x
63 / 165
D. Daney INRIA
Cours Robotique
200x
63 / 165
3 R34,P 34 V 4
0
V3 V2 V1 V0
D. Daney INRIA
= = = =
R34 .V + P34 R23 .V3 + P23 = R23 .(R34 .V + P34 ) + P23 R12 .(R23 .(R34 .V + P34 ) + P23 ) + P12 R01 .(R12 .(R23 .(R34 .V + P34 ) + P23 ) + P12 ) + P01
Cours Robotique 200x 64 / 165
(17)
D. Daney INRIA
Cours Robotique
200x
65 / 165
1 P1 P2 C C P3 A 1 44
Vi Vj = Hi ,j . 1 41 1 41
D. Daney INRIA
Cours Robotique
200x
66 / 165
1 P1 P2 C C P3 A 1 44
Vi Vj = Hi ,j . 1 41 1 41
D. Daney INRIA
Cours Robotique
200x
66 / 165
1 P1 P2 C C P3 A 1 44
Vi Vj = Hi ,j . 1 41 1 41
D. Daney INRIA
Cours Robotique
200x
66 / 165
Matrices homognes
V P
R() V
V = R ()V + P
Matrice Homogne: 0 R1,1 R1,2 P1 Hi ,j = @ R2,1 R2,2 P2 0 0 1 0 cos sin cos = @ sin 0 0
1 A
33
1 P1 P2 A 1
D. Daney INRIA
Cours Robotique
200x
67 / 165
Matrices homognes
V P
R() V
V = R ()V + P
Matrice Homogne: 0 R1,1 R1,2 P1 Hi ,j = @ R2,1 R2,2 P2 0 0 1 0 cos sin cos = @ sin 0 0
1 A
33
1 P1 P2 A 1
D. Daney INRIA
Cours Robotique
200x
67 / 165
Matrices homognes
Plusieurs changements de repres successifs
R12,P 12 R01,P 01 1
H12
H01
0
V3 V2 V1 V0 ou alors = = = =
R23,P 23 V 0
H23
H34 R34,P 34
4
R34 .V + P34 R23 .V3 + P23 = R23 .(R34 .V + P34 ) + P23 R12 .(R23 .(R34 .V + P34 ) + P23 ) + P12 R01 .(R12 .(R23 .(R34 .V + P34 ) + P23 ) + P12 ) + P01 V0 V = H01 .H12 .H23 .H34 . 1 1
D. Daney INRIA
Cours Robotique
200x
68 / 165
Matrices homognes
Plusieurs changements de repres successifs
R12,P 12 R01,P 01 1
H12
H01
0
V3 V2 V1 V0 ou alors = = = =
R23,P 23 V 0
H23
H34 R34,P 34
4
R34 .V + P34 R23 .V3 + P23 = R23 .(R34 .V + P34 ) + P23 R12 .(R23 .(R34 .V + P34 ) + P23 ) + P12 R01 .(R12 .(R23 .(R34 .V + P34 ) + P23 ) + P12 ) + P01 V0 V = H01 .H12 .H23 .H34 . 1 1
D. Daney INRIA
Cours Robotique
200x
68 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
69 / 165
Une liaison entre deux solides est une relation de contact entre deux solides. Degrs de libert dune liaison : Cest le nombre de dplacements lmentaires indpendants autoriss par cette liaison. Classe dune liaison : Cest le nombre de dplacements lmentaires interdits. On notera que pour une liaison, la somme des degrs de libert et de la classe de la liaisons est gale 6.
D. Daney INRIA
Cours Robotique
200x
70 / 165
D. Daney INRIA
Cours Robotique
200x
71 / 165
contact ponctuel
contact linique
contact linique
contact surfacique
contact surfacique
D. Daney INRIA
Cours Robotique
200x
72 / 165
contact ponctuel
contact linique
contact linique
contact surfacique
contact surfacique
D. Daney INRIA
Cours Robotique
200x
72 / 165
contact ponctuel
contact linique
contact linique
contact surfacique
contact surfacique
D. Daney INRIA
Cours Robotique
200x
72 / 165
Nom de la liaison
Reprsentations planes
Perspective
mobilits
Encastrement de centre B
0 1 0 @ 0A 0
0 1 0 @0A 0
Anim
1 Tx @0A 0
0 1 0 @0A 0
Anim
0 1 0 @0A 0
1 Rx @0A 0
Anim
D. Daney INRIA
Cours Robotique
200x
73 / 165
Nom de la liaison
Reprsentations planes
Perspective
mobilits
Encastrement de centre B
0 1 0 @ 0A 0
0 1 0 @0A 0
Anim
1 Tx @0A 0
0 1 0 @0A 0
Anim
0 1 0 @0A 0
1 Rx @0A 0
Anim
D. Daney INRIA
Cours Robotique
200x
73 / 165
Nom de la liaison
Reprsentations planes
Perspective
mobilits
Encastrement de centre B
0 1 0 @ 0A 0
0 1 0 @0A 0
Anim
1 Tx @0A 0
0 1 0 @0A 0
Anim
0 1 0 @0A 0
1 Rx @0A 0
Anim
D. Daney INRIA
Cours Robotique
200x
73 / 165
Nom de la liaison
Reprsentations planes
Perspective
mobilits
1 Tx @0A 0 0 1 0 @ Ty A 0 1 Tx @ Ty A 0 0 0 1 0 @ 0A 0 0
Anim
Anim
Anim
Rotule de centre O
Anim
D. Daney INRIA
Cours Robotique
200x
74 / 165
Nom de la liaison
Reprsentations planes
Perspective
mobilits
1 Tx @0A 0 0 1 0 @ Ty A 0 1 Tx @ Ty A 0 0 0 1 0 @ 0A 0 0
Anim
Anim
Anim
Rotule de centre O
Anim
D. Daney INRIA
Cours Robotique
200x
74 / 165
Nom de la liaison
Reprsentations planes
Perspective
mobilits
1 Tx @0A 0 0 1 0 @ Ty A 0 1 Tx @ Ty A 0 0 0 1 0 @ 0A 0 0
Anim
Anim
Anim
Rotule de centre O
Anim
D. Daney INRIA
Cours Robotique
200x
74 / 165
Nom de la liaison
Reprsentations planes
Perspective
mobilits
1 Tx @0A 0 0 1 0 @ Ty A 0 1 Tx @ Ty A 0 0 0 1 0 @ 0A 0 0
Anim
Anim
Anim
Rotule de centre O
Anim
D. Daney INRIA
Cours Robotique
200x
74 / 165
0 1 0 @0A 0
1 0 @Ry A Rz
Anim
1 Tx @0A 0
1 Rx @Ry A Rz
Anim
1 Tx @Ty A 0
1 Rx @0A Rz
Anim
1 Tx @Ty A 0
1 Rx @Ry A Rz
Anim
D. Daney INRIA
Cours Robotique
200x
75 / 165
0 1 0 @0A 0
1 0 @Ry A Rz
Anim
1 Tx @0A 0
1 Rx @Ry A Rz
Anim
1 Tx @Ty A 0
1 Rx @0A Rz
Anim
1 Tx @Ty A 0
1 Rx @Ry A Rz
Anim
D. Daney INRIA
Cours Robotique
200x
75 / 165
0 1 0 @0A 0
1 0 @Ry A Rz
Anim
1 Tx @0A 0
1 Rx @Ry A Rz
Anim
1 Tx @Ty A 0
1 Rx @0A Rz
Anim
1 Tx @Ty A 0
1 Rx @Ry A Rz
Anim
D. Daney INRIA
Cours Robotique
200x
75 / 165
0 1 0 @0A 0
1 0 @Ry A Rz
Anim
1 Tx @0A 0
1 Rx @Ry A Rz
Anim
1 Tx @Ty A 0
1 Rx @0A Rz
Anim
1 Tx @Ty A 0
1 Rx @Ry A Rz
Anim
D. Daney INRIA
Cours Robotique
200x
75 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
76 / 165
D. Daney INRIA
Cours Robotique
200x
77 / 165
D. Daney INRIA
Cours Robotique
200x
77 / 165
Articulation de ddl 2
Dans la plupart des cas, pour modliser une articulation de ddl 2, nous nous ramenerons une succession darticulations P ou R. Exemples :
D. Daney INRIA
Cours Robotique
200x
78 / 165
Articulation de ddl 2
Dans la plupart des cas, pour modliser une articulation de ddl 2, nous nous ramenerons une succession darticulations P ou R. Exemples :
D. Daney INRIA
Cours Robotique
200x
78 / 165
Figure: Chane cinmatique RPRP Une chane cinmatique sera dnie par une succession darticulations rotodes ou prismatiques.
D. Daney INRIA Cours Robotique 200x 79 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
80 / 165
Base
Description Gnrale
Un exemple
D. Daney INRIA
Cours Robotique
200x
81 / 165
Vocabulaire
Actionneur, moteur Axe, articulation Corps, segment Organe terminal Effecteur, outil Base
Vocabulaire
Coordonnes gnralis X = [P , R ] (position P / orientation R ) Coordonnes articulaire q (consignes donnes aux moteurs : soit rotation autour dun axe soit translation suivant un axe) Paramtres gomtriques qui dnissent de faon statique les dimension du robot
D. Daney INRIA
Cours Robotique
200x
83 / 165
D. Daney INRIA
Cours Robotique
200x
84 / 165
Robot redondant
le nombre de degrs de libert de lorgane terminal < nombre variables articulaires actives (darticulations motorises). plus de 6 articulations plus de trois articulations rotodes daxes concourants plus de trois articulations rotodes daxes parallles plus de trois articulations prismatiques deux axes darticulations prismatiques parallles deux axes darticulations rotodes confondus
D. Daney INRIA
Cours Robotique
200x
85 / 165
Robot redondant
le nombre de degrs de libert de lorgane terminal < nombre variables articulaires actives (darticulations motorises). plus de 6 articulations plus de trois articulations rotodes daxes concourants plus de trois articulations rotodes daxes parallles plus de trois articulations prismatiques deux axes darticulations prismatiques parallles deux axes darticulations rotodes confondus
D. Daney INRIA
Cours Robotique
200x
85 / 165
Quelque soit le robot (redondant ou non), il se peut quil existe certaines congurations dites singulires telle que le nombre de degrs de libert de lorgane terminal soit infrieur la dimension de lespace oprationnel (espace dans lequel on reprsente les ddl de lOT). deux axes darticulations prismatiques se retrouvent parallles deux axes darticulations rotodes se retrouvent confondus
D. Daney INRIA
Cours Robotique
200x
86 / 165
Quelque soit le robot (redondant ou non), il se peut quil existe certaines congurations dites singulires telle que le nombre de degrs de libert de lorgane terminal soit infrieur la dimension de lespace oprationnel (espace dans lequel on reprsente les ddl de lOT). deux axes darticulations prismatiques se retrouvent parallles deux axes darticulations rotodes se retrouvent confondus
D. Daney INRIA
Cours Robotique
200x
86 / 165
ddl 2 3 4 5 6
D. Daney INRIA
Cours Robotique
200x
87 / 165
Porteur
Poignet ...
D. Daney INRIA
Cours Robotique
200x
88 / 165
Type de robot
D. Daney INRIA
Cours Robotique
200x
89 / 165
Caractristique
D. Daney INRIA
Cours Robotique
200x
91 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
92 / 165
Un exemple
D. Daney INRIA
Cours Robotique
200x
93 / 165
La plate-forme de Gough
D. Daney INRIA Cours Robotique 200x 94 / 165
La plate-forme de Gough
C Mobile Bi Li Segments
li
Base
Ai
D. Daney INRIA
Cours Robotique
200x
95 / 165
Exemple de dplacement
DDL Gough Cercles, Poignet actif (INRIA) Hexapode CMW Alcatel Dploiement
D. Daney INRIA
Cours Robotique
200x
96 / 165
Caractristiques
Il a une meilleure prcision (rigidit, accumulation des erreurs) Il peut transporter de lourdes charges Il a de bonnes performances dynamiques Son espace de travail est plus limit (que pour les robots srie) Son tude est Complexe
D. Daney INRIA
Cours Robotique
200x
97 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
98 / 165
Dterminer: Les coordonnes gnralises (X ) en fonction des coordonnes articulaire (q ): X = FMGD (q1 , q2 , . . . , qi , ) avec les paramtres gomtriques (paramtres qui dnissent la gomtrie du robot srie).
D. Daney INRIA
Cours Robotique
200x
99 / 165
Le MGD
exemple
Repre mobile
t3 t2 t1 1
Repre base
3 2
Associer chacune des articulations un repre Dterminer le positionnement (matrice R , vecteur P ) de chaque repres par rapport au prcedent. Metter ces changements de repres sous la forme de matrice homogne Montrer comment calculer le MGD de ce mcanisme
mcanisme 3R plan
Le MGD
exemple
Repre mobile
t3 t2 t1 1
Repre base
3 2
Associer chacune des articulations un repre Dterminer le positionnement (matrice R , vecteur P ) de chaque repres par rapport au prcedent. Metter ces changements de repres sous la forme de matrice homogne Montrer comment calculer le MGD de ce mcanisme
mcanisme 3R plan
Le MGD
solution
Identier les coordonnes articulaires Solution: q1 = 1 , q2 = 2 , q3 = 3 Identier les paramtres gomtriques qui dnissent le mcanisme Solution: = {t1 , t2 , t3 }
D. Daney INRIA
Cours Robotique
200x
101 / 165
Le MGD
solution
Identier les coordonnes articulaires Solution: q1 = 1 , q2 = 2 , q3 = 3 Identier les paramtres gomtriques qui dnissent le mcanisme Solution: = {t1 , t2 , t3 }
D. Daney INRIA
Cours Robotique
200x
101 / 165
Le MGD
Solution
Repre mobile
t3 3 t2 2 t1 1
D. Daney INRIA
Repre base
mcanisme 3R plan
Cours Robotique 200x 102 / 165
Le MGD
Solution
Dterminer le positionnement (matrice R , vecteur P ) de chaque repres par rapport au prcedent. Ri ,j = cos j sin j Ti ,j = sin j cos j
Repre mobile
t3 3 T 2,3 R 2,3
2
tj . cos j tj . sin j i 0, 1, 2, j 1, 2, 3
t2 t1
0 1
2 T1,2 R1,2
T 0,1 R 0,1
Repre base
mcanisme 3R plan
D. Daney INRIA Cours Robotique
Hi ,j =
Ri ,j 00
Ti ,j 1
200x 103 / 165
Le MGD
Solution
Dterminer le positionnement (matrice R , vecteur P ) de chaque repres par rapport au prcedent. Ri ,j = cos j sin j Ti ,j = sin j cos j
Repre mobile
t3 3 T 2,3 R 2,3
2
tj . cos j tj . sin j i 0, 1, 2, j 1, 2, 3
t2 t1
0 1
2 T1,2 R1,2
T 0,1 R 0,1
Repre base
mcanisme 3R plan
D. Daney INRIA Cours Robotique
Hi ,j =
Ri ,j 00
Ti ,j 1
200x 103 / 165
Le MGD
Solution
Repre mobile 3
t3
3 T 2,3 R 2,3
2
t2 T1,2 2 R1,2 t1
0 1
T 0,1 R 0,1
Repre base
sin (1 2 3 cos (1 + 2 + 3 ) 0
+ t2 . sin (1 + 2 ) + t3 . sin (1 + 2 + 3 ) 1
Le MGD
Solution
Repre mobile 3
t3
3 T 2,3 R 2,3
2
t2 T1,2 2 R1,2 t1
0 1
T 0,1 R 0,1
Repre base
sin (1 2 3 cos (1 + 2 + 3 ) 0
+ t2 . sin (1 + 2 ) + t3 . sin (1 + 2 + 3 ) 1
P X=( 0R 00 1)
q1 Repre de base
D. Daney INRIA
q2
q3
q4
Repre mobile
Cours Robotique
200x
105 / 165
Dans lespace, nous utiliserons le formalisme de Denavit-Hartenberg 1 Placer les repres 2 Dnir les variables articulaires et les paramtres gomtriques 3 Dnir les matrices de transformes homognes 4 Multiplier ces matrices
D. Daney INRIA
Cours Robotique
200x
106 / 165
Formalisation de Khalil 96 Li une liaison rotode ou prismatique parfaite cest--dire suivant un seul axe, donc reprsente par un seul paramtre. (Oi , xi , yi , zi ) le repre li la liaison i . Oi 1 est le pied de la perpendiculaire commune avec laxe des liaisons Li 1 et Li sur laxe Li . xi 1 est le vecteur unitaire de cette perpendiculaire commune oriente de Li 1 Li . zi 1 le vecteur unitaire port par laxe de la liaison Li 1 orient arbitrairement. yi 1 est dduit de xi 1 et zi 1 . Pour i = 0, z0 verticalement ascendant et x0 perpendiculaire laxe L1 . Pour i = n, On sur laxe Ln et zn port par laxe de la liaison n.
D. Daney INRIA Cours Robotique 200x 107 / 165
zi +1 ai
zi +1 zi
xi +1 xi
i
xi +1
zi bi
xi
zi 1
xi 1
a PRP kinematic chain : ai , bi , i , i Denavit-Hartenberg parameters associated with the revolute joint i
D. Daney INRIA Cours Robotique 200x 108 / 165
xi +1 xi
i
xi +1
zi bi
xi
zi 1
xi 1
Figure: a PRP kinematic chain : ai , bi , i , i Denavit-Hartenberg parameters associated with the revolute joint i
D. Daney INRIA Cours Robotique 200x 109 / 165
An homogeneous matrix (Hi ) describe the transformation (position/orientation) between two consecutive frames i and i +1 . This matrix is dene by four DH-parameters ai , bi , i , i such that: Hi = R(i , zi ).T (bi , zi ).T (ai , xi +1 ).R(i , xi +1 ) pi Ri = 0 0 0 1 with the orientation matrix : cos(i ) cos(i ). sin(i ) sin(i ). sin(i ) Ri = sin(i ) cos(i ). cos(i ) sin(i ). cos(i ) 0 sin(i ) cos(i ) and the position vector: ai . cos(i ) pi = ai . sin(i ) bi
D. Daney INRIA Cours Robotique 200x 110 / 165
Calculer le MDG
Dterminer: X = FMGD (q1 , q2 , . . . , qi , ) Repre mobile La transformation homogne entre le repre 0 et le repre mobile n est obtenue telle que : HCK = H0 .H1 . . . Hn Il faut projeter HCK sur X = [Tx , Ty , Tz , Rx , Ry , Rz ]
P X=( 0R 00 1)
q1 Repre de base
q2
q3
q4
D. Daney INRIA
Cours Robotique
200x
111 / 165
Nous souhaitons obtenir X = [Tx , Ty , Tz , Rx , Ry , Rz ] en fonction de des lment de la matrice HCK . Pour la position ... HCK 1,4 Tx Ty = HCK 2,4 Tz HCK 3,4
D. Daney INRIA
Cours Robotique
200x
112 / 165
Rx = arctan Ry = arctan
HCK 3,2 .HCK 1,1 HCK 3,1 .HCK 1,2 HCK 1,1 .HCK 2,2 HCK 1,2 .HCK 2,1 HCK 1,3 HCK 2,3 .HCK 3,1 HCK 2,1 .HCK 3,3 HCK 2,3 .HCK 3,2 HCK 2,2 .HCK 3,3
Cours Robotique 200x 113 / 165
Rz = arctan
D. Daney INRIA
P X=( 0R 00 1)
q q1 Repre de base
q3
2
q4
Repre mobile
Dterminer: [q1 , q2 , . . . , qn ] = FMGI (X , ) avec les paramtres gomtriques (paramtres qui dnissent la gomtrie du robot srie).
D. Daney INRIA Cours Robotique 200x 114 / 165
Le MGI
exemple
Repre mobile
t3 3 T 2,3 R 2,3
2
X = ... 0 1 t1 . cos 1 + t2 . cos (1 + 2 ) + t3 . cos (1 + 2 + 3 ) @ t1 . sin 1 + t2 . sin (1 + 2 ) + t3 . sin (1 + 2 + 3 ) A 1 + 2 + 3 Calculer le MGI, cest dterminer: [1 , 2 , 3 ] = FMGI (X1 , X2 , X3 , ) avec = [t1 , t2 , t3 ]
t2 T1,2 2 R1,2 t1
0 1
T 0,1 R 0,1
Repre base
mcanisme 3R plan
D. Daney INRIA
Cours Robotique
200x
115 / 165
Le MGI exemple
rsolution Gomtrique 1/2
Repre mobile
Repre mobile
t3 3
t3 3 t2 t1
Repre base
Repre base
D. Daney INRIA
Cours Robotique
200x
116 / 165
Le MGI exemple
rsolution Gomtrique 1/2
Repre mobile
Repre mobile
t3 3
t3 3 t2 t1
Repre base
Repre base
D. Daney INRIA
Cours Robotique
200x
116 / 165
Le MGI exemple
rsolution Gomtrique 2/2
Repre mobile
3 2 2 1 1 3
Repre base
D. Daney INRIA
Cours Robotique
200x
117 / 165
Le MGI exemple
rsolution Algbrique 1
t1 . cos 1 + t2 . cos (1 + 2 ) + t3 . cos (1 + 2 + 3 ) X1 = 0 t1 . sin 1 + t2 . sin (1 + 2 ) + t3 . sin (1 + 2 + 3 ) X2 = 0 1 + 2 + 3 = X3 t1 . cos 1 + t2 . cos (1 + 2 ) + t3 . cos X3 X1 = 0 t1 . sin 1 + t2 . sin (1 + 2 ) + t3 . sin X3 X2 = 0
(18)
(19)
118 / 165
Le MGI exemple
rsolution Algbrique 2
sachant que pour lquation X . sin + Y . cos = Z : YZ X X 2 + Y 2 Z 2 cos = X2 + Y2 XZ + Y X 2 + Y 2 Z 2 sin = X2 + Y2 avec = +/ 1. On en dduit donc 1 puis 1 + 2 2 (en utilisant eq. (18)), puis enn 3 .
D. Daney INRIA Cours Robotique 200x 119 / 165
f(x) f(y) x
f(x)
Mthode de Newton 1670 Nous cherchons dterminer x tel que f (x ) = 0, Nous connaissons une approximation de x not x0 . Nous avons f (x0 ) f (x ) = f (x0 ).(x0 x ) avec f (x ) = 0 nous obtenons :
y
f (x + h ) limh f (x )h
= f (x )
x = x0
f (x0 ) f (x0 )
D. Daney INRIA
Cours Robotique
200x
120 / 165
f(x) f(y) x
f(x)
Mthode de Newton 1670 Nous cherchons dterminer x tel que f (x ) = 0, Nous connaissons une approximation de x not x0 . Nous avons f (x0 ) f (x ) = f (x0 ).(x0 x ) avec f (x ) = 0 nous obtenons :
y
f (x + h ) limh f (x )h
= f (x )
x = x0
f (x0 ) f (x0 )
D. Daney INRIA
Cours Robotique
200x
120 / 165
f(x) f(y) x
f(x)
Mthode de Newton 1670 Nous cherchons dterminer x tel que f (x ) = 0, Nous connaissons une approximation de x not x0 . Nous avons f (x0 ) f (x ) = f (x0 ).(x0 x ) avec f (x ) = 0 nous obtenons :
y
f (x + h ) limh f (x )h
= f (x )
x = x0
f (x0 ) f (x0 )
D. Daney INRIA
Cours Robotique
200x
120 / 165
Rsolution numrique
Newton
0.4
0.2
0.5
0.5
0.2
0.4
x 3 0.5 x + 0.1 = 0
-0.4 11.4 7.6095 5.0871 3.4121 2.3048 1.5799 1.1143 0.8270 0.6645 0.5903 0.5710 0.5696
D. Daney INRIA
Cours Robotique
200x
121 / 165
Rsolution numrique
Newton
Calculer
Rsoudre lquation x 2 N = 0 xk +1 = xk
x 2 N 2.x N xk
xk + 1 = 1 2 (xk +
D. Daney INRIA
Cours Robotique
200x
122 / 165
Rsolution numrique
Newton
Calculer
Rsoudre lquation x 2 N = 0 xk +1 = xk
x 2 N 2.x N xk
xk + 1 = 1 2 (xk +
D. Daney INRIA
Cours Robotique
200x
122 / 165
Rsolution numrique
Newton
Calculer
Rsoudre lquation x 2 N = 0 xk +1 = xk
x 2 N 2.x N xk
xk + 1 = 1 2 (xk +
D. Daney INRIA
Cours Robotique
200x
122 / 165
Rsolution numrique
Newton
Calculer
Rsoudre lquation x 2 N = 0 xk +1 = xk
x 2 N 2.x N xk
xk + 1 = 1 2 (xk +
D. Daney INRIA
Cours Robotique
200x
122 / 165
Rsolution numrique
Newton
Calculer
Rsoudre lquation x 2 N = 0 xk +1 = xk
x 2 N 2.x N xk
xk + 1 = 1 2 (xk +
D. Daney INRIA
Cours Robotique
200x
122 / 165
Mthode classique (1970-1980) Utilisable par la plupart des robots industriels Rsolution simple, utilisation de modle de rsolution Mthode algbrique (Raghavan et Roth 1990) Technique de llimination dyalitique Mthode numrique (Newton) Quand on ne sait pas faire Problme de lunicit des solutions
D. Daney INRIA
Cours Robotique
200x
123 / 165
1 Dvelopper lensemble des quations possibles HX H1,0 .HX H2,1 .H1,0 .HX H3,2 .H2,1 .H1,0 .HX H4,3 .H3,2 .H2,1 .H1,0 .HX H5,4 .H4,3 .H3,2 .H2,1 .H1,0 .HX
1 avec Hi ,j = Hj ,i
= = = = = =
H0,1 .H1,2 .H2,3 .H3,4 .H4,5 .H5,6 H1,2 .H2,3 .H3,4 .H4,5 .H5,6 H2,3 .H3,4 .H4,5 .H5,6 H3,4 .H4,5 .H5,6 H4,5 .H5,6 H5,6
D. Daney INRIA
Cours Robotique
200x
124 / 165
cos =
sin =
X2 + Y2 p XZ + Y X 2 + Y 2 Z 2 X2 + Y2
avec
= +/ 1
Remarques Si le poignet est daxes concourants (rotule), la rsolution est plus simple. De la mme faon, si la chane cinmatique possde 3R axes concourants ou 3 articulations prismatiques (qqsoit leurs positions) le MGI est simpli Le nombre de solutions du MGI dun robot 6 liaisons varie mais 16. (16 pour RRRRRR)
D. Daney INRIA Cours Robotique 200x 125 / 165
sin =
2 On utilise une mthode dlimination algbrique pour liminer 5 variables parmi les 6 3 On obtient un polynme de degr 16 4 Les racines de ce polynmes nous fournissent les solutions
D. Daney INRIA
Cours Robotique
200x
126 / 165
On utilise un schma de Newton multivari : Xk +1 = Xk J 1 (XK )F (Xk ) Avec F = [f1 , . . . , fn ]T , X = [x1 , . . . , xn ]T et J la jacobienne du systme dnie par : f1 f1 f1 ... x1 x2 xn f2 f2 f2 ... x1 x2 xn . . . J= . ... ... . f . n1 . . . fn1 fn1 x1 xn1 xn fn fn fn . . . x x1 xn n 1 Attention ! ne fournit quune seule solution
D. Daney INRIA
Cours Robotique
200x
127 / 165
R .bi
ai
= P + R .bi ai
D. Daney INRIA
Cours Robotique
200x
128 / 165
X =
=0 =0 =0 =0 =0 =0
Mthodes numriques [Newton, continuation, analyse par interval] Mthodes algbriques [Groebner, resultant]
D. Daney INRIA Cours Robotique 200x 129 / 165
X =
=0 =0 =0 =0 =0 =0
Mthodes numriques [Newton, continuation, analyse par interval] Mthodes algbriques [Groebner, resultant]
D. Daney INRIA Cours Robotique 200x 129 / 165
X =
=0 =0 =0 =0 =0 =0
Mthodes numriques [Newton, continuation, analyse par interval] Mthodes algbriques [Groebner, resultant]
D. Daney INRIA Cours Robotique 200x 129 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
130 / 165
D. Daney INRIA
Cours Robotique
200x
131 / 165
D. Daney INRIA
Cours Robotique
200x
132 / 165
Repre mobile
t3
3 T 2,3 R 2,3
2
t2 T1,2 2 R1,2 t1
0 1
T 0,1 R 0,1
Repre base
mcanisme 3R plan
1 0 1 Px t1 . cos 1 + t2 . cos (1 + 2 ) + t3 . cos (1 + 2 + 3 ) X = @Py A = @ t1 . sin 1 + t2 . sin (1 + 2 ) + t3 . sin (1 + 2 + 3 ) A 1 + 2 + 3 Nous obtenons cette matrice en drivant les quations du MGD.
D. Daney INRIA Cours Robotique 200x 133 / 165
1 C A
0 = @
t1 . sin 1 t2 . sin (1 + 2 ) t3 . sin (1 + 2 + 3 ) t1 . cos 1 + t2 . cos (1 + 2 ) + t3 . cos (1 + 2 + 3 ) 1 1 ... t3 . sin (1 + 2 + 3 ) ... t3 . cos (1 + 2 + 3 ) A ... 1
D. Daney INRIA
Cours Robotique
200x
134 / 165
Pour les robots sries, cette drivation peut tre trs complique et difcile manipuler. Il existe une mthode systmatique pour calculer une jacobienne dite cinmatique. X = Jc (q )q (21)
avec X , torseur cinmatique du repre terminal n . Une projection permet de passer des vitesses des coordonnes oprationnelles aux vitesses de translation, rotation.
D. Daney INRIA
Cours Robotique
200x
135 / 165
Elle passe par les calculs des vitesses de translation Vk ,n et de rotation wk ,n k de larticulation k , induites sur le repre terminal n par la vitesse q X = [Vk ,n , wk ,n ]T Prismatique Vk ,n wk ,n Rotode Vk ,n wk ,n = = = = k ak q 0 (22)
k (ak Lk ,n )q ak qk
(23)
avec ak le vecteur unitaire port par laxe zk de larticulation k et Lk ,n le vecteur dorigine Ok et dextrmit On .
D. Daney INRIA
Cours Robotique
200x
136 / 165
D. Daney INRIA
Cours Robotique
200x
137 / 165
D. Daney INRIA
Cours Robotique
200x
138 / 165
D. Daney INRIA
Cours Robotique
200x
139 / 165
Le nombre de degrs de libert de lorgane terminal dun manipulateur est gale au rang de la jacobienne cinmatique. (rang = dimension de la plus grande sous-matrice carr inversible)
D. Daney INRIA
Cours Robotique
200x
140 / 165
= J (q )q Pour les robots sries X Si pour une conguration det (J (q )) = 0, alors il y a singularit. Le robot perd localement la possibilit dengendrer une vitesse le long ou autour de certaines direction. ou Le robot est en limite de lespace de travail. (limite structurel)
D. Daney INRIA
Cours Robotique
200x
141 / 165
= Jinv (X )X Pour la plate-forme de Gough q Si pour une conguration det (Jinv (X )) = 0, il y a singularit. Il existera des non nulles pour lesquelles les vitesse articulaires q sont nulles. Au vitesses X voisinnage de telle conguration le robot peut effectuer des mouvements innitsimaux sans modication de commande. en consquence certains ddl deviennent non commandables. ou
T Sachant que F = Jinv si det(Jinv ) 0 alors .
D. Daney INRIA
Cours Robotique
200x
142 / 165
Notion de singularits
D. Daney INRIA
_ + Vq _=0 UX
(24)
143 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
144 / 165
Modle statique
Le modle statique dcrit les couples et forces que doivent fournir les actionneurs dun robot pour que lorgane terminal puisse exercer un effort statique F sur son environement : Pour les robots srie, nous obtiendrons facilement le modle directe: = JT F avec J la jacobienne cinmatique du mcanisme. Pour les robots parallles, nous obtiendrons facilement le modle inverse : F = J T avec J 1 la jacobienne inverse cinmatique du mcanisme.
D. Daney INRIA
Cours Robotique
200x
145 / 165
Modle statique
An dobtenir le modle inverse pour les robots sries directe pour les robots parallles Le problme revient inverser la matrice J T ou bien J T .
D. Daney INRIA
Cours Robotique
200x
146 / 165
Outline
1
Introduction Historique Les robots Domaines dexpertises Domanes dapplications Reprsentation des transformations et des mouvements rigides Notion de degrs de libert Un exemple simple Reprsentation des transformations rigides Les manipulateurs Notion de liaisons Les chanes cinmatiques Les robot sries Les robots parallles Les modles des robots manipulateurs Le Modle Gomtrique Direct/Inverse Les Modles Cinmatiques Direct/Inverse Le Modle Statique Les Modles Dynamiques Notions complementaires des robots
D. Daney INRIA
Cours Robotique
200x
147 / 165
Modle dynamique
robot srie
, efforts actionneurs A, matrice dinertie C , efforts centrifuges et de coriolis Q (p), couple/forces de gravit ), frottements visqueux F (q ) frottements secs H signe(q
D. Daney INRIA
Cours Robotique
200x
148 / 165
Formalisme de Newton-Euler Formalisme de Lagrange Il est bas sur lexpression des torseurs dynamiques (forces et moments) appliqus aux centres de gravits de chaque articulation. Un algorithme itratif permet alors dexprimer le modles dynamique. Trs couteux (40000 oprations pour un RRPRRR). Moins couteux (400 oprations pour un RRPRRR). Attention, une identication des paramtres dynamiques est souvent ncessaire.
D. Daney INRIA
Cours Robotique
200x
149 / 165
Dnitions Soit, Q , lespace articulaire dnie par : Q = {q = [q1 , . . . , qn ]|qi Min qi qi Max , i = 1, . . . , n} Lespace de travail (W ) dun robot est limage de Q par le modle gomtrique direct : W = FMGD (Q )
D. Daney INRIA
Cours Robotique
200x
150 / 165
Dnitions Soit, Q , lespace articulaire dnie par : Q = {q = [q1 , . . . , qn ]|qi Min qi qi Max , i = 1, . . . , n} Lespace de travail (W ) dun robot est limage de Q par le modle gomtrique direct : W = FMGD (Q )
D. Daney INRIA
Cours Robotique
200x
150 / 165
D. Daney INRIA
Cours Robotique
200x
151 / 165
D. Daney INRIA
Cours Robotique
200x
151 / 165
Problmes Difcile reprsenter. Rpresentation orientation constante Difcile obtenir. En pratique, il est ncessaire dajouter des contraintes (dbattements articulaires, singularits, obstacles, ...). Exemple : dnir une trajectoire o tous les positionnemnt successifs sont possibles
dbattement articulaires passif et actif collision sans singularit (pas forcement la frontire de W) orientation possible (toutes orientations : espace dextre) prcision
D. Daney INRIA
Cours Robotique
200x
152 / 165
Problmes Difcile reprsenter. Rpresentation orientation constante Difcile obtenir. En pratique, il est ncessaire dajouter des contraintes (dbattements articulaires, singularits, obstacles, ...). Exemple : dnir une trajectoire o tous les positionnemnt successifs sont possibles
dbattement articulaires passif et actif collision sans singularit (pas forcement la frontire de W) orientation possible (toutes orientations : espace dextre) prcision
D. Daney INRIA
Cours Robotique
200x
152 / 165
Gomtrie algorithmique, intersection de volumes Recherche de points particuliers + Segmentation de lespace de travail Utilisation des courbes de singularits
D. Daney INRIA
Cours Robotique
200x
153 / 165
. q
...dq ... q
1
J 1 . q
. X 2 1
Notion de conception
Dterminer les paramtres gomtriques tel que les proprits des robots soient optimiss :
max C
avec paramtres gomtriques et un ou plusieurs critres de conception C = F{Espace de travail, localisation des singularit, rigidit, prcision, etc} Utilisation de loptimisation numrique.
D. Daney INRIA
Cours Robotique
200x
155 / 165
"talonnage" = "Calibration" = "Calibrage" Problme : Rel = Thorique Causes : Erreurs de fabrication et dassemblage du manipulateur Consquences : Dterioration de la commande But : Amliorer de la prcision de positionnement Comment : talonnage du robot
D. Daney INRIA
Cours Robotique
200x
156 / 165
"talonnage" = "Calibration" = "Calibrage" Problme : Rel = Thorique Causes : Erreurs de fabrication et dassemblage du manipulateur Consquences : Dterioration de la commande But : Amliorer de la prcision de positionnement Comment : talonnage du robot
D. Daney INRIA
Cours Robotique
200x
156 / 165
"talonnage" = "Calibration" = "Calibrage" Problme : Rel = Thorique Causes : Erreurs de fabrication et dassemblage du manipulateur Consquences : Dterioration de la commande But : Amliorer de la prcision de positionnement Comment : talonnage du robot
D. Daney INRIA
Cours Robotique
200x
156 / 165
"talonnage" = "Calibration" = "Calibrage" Problme : Rel = Thorique Causes : Erreurs de fabrication et dassemblage du manipulateur Consquences : Dterioration de la commande But : Amliorer de la prcision de positionnement Comment : talonnage du robot
D. Daney INRIA
Cours Robotique
200x
156 / 165
"talonnage" = "Calibration" = "Calibrage" Problme : Rel = Thorique Causes : Erreurs de fabrication et dassemblage du manipulateur Consquences : Dterioration de la commande But : Amliorer de la prcision de positionnement Comment : talonnage du robot
D. Daney INRIA
Cours Robotique
200x
156 / 165
"talonnage" = "Calibration" = "Calibrage" Problme : Rel = Thorique Causes : Erreurs de fabrication et dassemblage du manipulateur Consquences : Dterioration de la commande But : Amliorer de la prcision de positionnement Comment : talonnage du robot
D. Daney INRIA
Cours Robotique
200x
156 / 165
"talonnage" = "Calibration" = "Calibrage" Problme : Rel = Thorique Causes : Erreurs de fabrication et dassemblage du manipulateur Consquences : Dterioration de la commande But : Amliorer de la prcision de positionnement Comment : talonnage du robot
D. Daney INRIA
Cours Robotique
200x
156 / 165
Paramtres Gomtriques
Donnes (mesures) Inconnues
P R MGD P R MGI
Paramtres Gomtriques
Donnes Inconnues
D. Daney INRIA
Cours Robotique
200x
157 / 165
Paramtres Gomtriques
Donnes (mesures) Inconnues
P R
D. Daney INRIA
Cours Robotique
200x
158 / 165
Paramtres Gomtriques
Donnes (mesures) Inconnues
P R
D. Daney INRIA
Cours Robotique
200x
159 / 165
Paramtres Gomtriques
Donnes (mesures) Inconnues
P R
D. Daney INRIA
Cours Robotique
200x
160 / 165
Problmes :
Identiabilit Recherche de points particuliers + Segmentation de lespace de travail Utilisation des courbes de singularits
D. Daney INRIA
Cours Robotique
200x
161 / 165
D. Daney INRIA
Cours Robotique
200x
162 / 165
Gnration de mouvements
qf
Gnration de mouvement en q i q d
qd (t)
Asservissement
Gnration de mouvement en X
X(t)
Xi
qd (t) + MGI qi
MGD
Asservissement
D. Daney INRIA
Cours Robotique
200x
163 / 165
Gnration de mouvements
Espace oprationnel Espace articulaire + Peu de calculs (pas de MGI, MDG) + Pas de problme de singularits + les contraintes de vitesses et de couples maximaux directement dductibles des limites physiques des actionneurs Peu de contrle sur la trajectoire de lOT (collisions) Pour dplacements rapides sans obstacles + Contrle sur la trajectoire de lOT (collisions) calculs lourds (MGI, MDG) problme de singularits Vrication de la trajectoire (dans lespace de travail) les contraintes de vitesse et de couples varient en fonction de la trajec. : on utilise des valeurs moyennes (peu efcaces) Pour dplacements prcis, avec obstacles
D. Daney INRIA
Cours Robotique
200x
164 / 165
Kp KI +
qd +
+ +
Robot .
KV
Du modle dynamique dune articulation on en dduit : Kpj = 3aj wj2 Kvj + Fvj = 3aj wj KIj = 3aj wj3
D. Daney INRIA
Cours Robotique
200x
165 / 165