Académique Documents
Professionnel Documents
Culture Documents
Vision 3D - application Modèles de robots M.Mallem 1 Vision 3D - application Modèles de robots M.Mallem 2
à la robotique à la robotique
Vision 3D et robotique :
Mise en contexte 1. Définition d’un robot
Rc
Robot : Système complexe capable, grâce à ses fonctions de manipulation et
(ou) de locomotion, de remplacer l'homme, dans la réalisation de tâches
répétitives, dangereuses ou inaccessibles, voire distraire ou accompagner
l’homme.
Robot = bras manipulateur / base mobile / bras manipulateur monté sur 1 base
Ro mobile,+ motorisation + système de perception + programmation et interface
Re homme machine.
Rr
Un robot est conçu pour réaliser des tâches entièrement autonome ou sous le
Tre? contrôle d'un opérateur humain.
RC : repère de la caméra
Origine du terme Robot : robota(slave) = travailleur terne: Pièce de théatre,
Rr : repère du robot "Rossum's Universal Robot " du romancier tchèque Karel Capek (1921),
Re : repère effecteur portant sur des êtres artificiels anthropomorphes répondant parfaitement aux
ordres de leur maîtres.
Vision 3D - application ModèlesR
deorobots : repère environnement
M.Mallem 3 Vision 3D - application Modèles de robots M.Mallem 4
à la robotique à la robotique
Différentes robotiques Les disciplines de la Robotique
Types de Tâches Domaines d’application
robotiques
Manufacturière Manipulation d’outils : Industries automobiles,
/Substitution : Soudure, collage, aéronautique,
-tâches simples, projection, peinture,… agroalimentaire,
répétitives pharmaceutique,…
-environnement Manipulation de
Génie Informatique
structuré, pré pièces : assemblage, 5
modélisé. manutention,… Génie Mécanique Robotique
Non Surveillance, Sécurité civile, militaire, 6 7 4
manufacturière / Intervention, agricole, minier, services,
coopération Installation, BTP, spatial, sous-marin,
homme-machine : maintenance, nucléaire, médical,…
1 2 3 Génie Electrique
-tâches complexes Manipulation,
-environnement téléopération,…
non entièrement
structuré
Vision 3D - application Modèles de robots M.Mallem 5 Vision 3D - application Modèles de robots M.Mallem 6
à la robotique à la robotique
e x té ro c e p tifs . é ta t d e
l’e n v iro n n e m e n t
A P P A R E IL A c tio n n e u rs : A C T IO N s u r la
M O T E U R . é le c triq u e s s tru c tu re
Plan - Stratégie
. h y d ra u liq u e s
. p n e u m a tiq u e s
Décision
Décision
E F F E C T E U R .P in c e p o u r s a is ie A C T IO N s u r le s
d ’o b je t o b je ts d e
.T o r c h e d e s o u d u r e l’e n v iro n n e m e n t d u Direct("Play Back")
.P o r te o u tils ro b o t
... Apprentissage
S Y S T E M E D E .C a lc u la te u r C O M M A N D E Indirect : poignet de commande
C O M M A N D E .S tr a té g ie s d e C O N T R O L E
c o m m a n d e D E C IS IO N Boite à boutons
.N iv e a u x d e
IH M
c o m m a n d e
.M a té r ie l : o r g a n e d e IN F O R M A T IO N S su r Programmation : Analytique : langage de robot Action
Action
s a is ie (s y n ta x e u r, la tâ c h e d u ro b o t
b r a s m a îtr e ...) P R O G R A M M A T IO N
.L o g ic ie l d e C A O - h o rs lig n e /e n lig n e
R o b o tiq u e CAO
Vision 3D - application Modèles de robots M.Mallem 7 Vision 3D - application Modèles de robots M.Mallem 8
à la robotique à la robotique
Quelques Liens Parc mondial de robots
http://www.ifr.org/
http://www.jara.jp/e/h/jara01.html
http://www.euron.org/
http://www.lesrobots.org/
Vision 3D - application Modèles de robots M.Mallem 9 Vision 3D - application Modèles de robots M.Mallem 10
à la robotique à la robotique
C4 C5
A5
A4
C3 A6
C6
A3
C2
A2
C1
A1
Vision 3D - application Modèles de robots M.Mallem 11 Vision 3D - application Modèles de robots M.Mallem 12
à la robotique à la robotique
Chaîne fermée – robot série Définitions
Structure de base Poignet + effecteur Structure de base Poignet + effecteur
A4 C4 C5 C4 C5
A5 A5
Rn
A4 A4
C3 A6 C3 A6
Ri
C3
C6 C6
A3 A3 A3
C2 C2
X = (x1 , x2 …xm )t : coordonnées opérationnelles ,
C2
Q = (q1 , q2 …qn )t : coordonnées articulaires,
A2 A2 A2
n n
f (Q ) = ∏ Ti −1,i = Ton ( x n y n z n O n ) = X f (Q ) = ∏ Ti −1,i = Ton ( x n y n z n O n ) = X
i =1 i =1
Vision 3D - application Modèles de robots M.Mallem 15 Vision 3D - application Modèles de robots M.Mallem 16
à la robotique à la robotique
Coordonnées homogènes Coordonnées homogènes : Utilisation
Représentation mathématique permettant de rendre linéaires ⎡X ⎤ ⎢ ⎥
⎡X ⎤
(calcul matriciel) certaines opérations courantes en vision, 1. On passe des coord. cartésiennes aux ⎢Y ⎥ ⇒ ⎢Y ⎥
⎢ ⎥ ⎢Z ⎥
robotique et infographie. coord. homogènes en ajoutant un "1" ⎢⎣ Z ⎥⎦ ⎢ ⎥
~ ~ ⎣1⎦
Par exemple : AX + B = Y ⇔ CX = Y
comme 4e élément au vecteur.
On ajoute simplement une dimension aux coordonnées ⎡ X '⎤ ⎡X ⎤
⎢Y ' ⎥ ⎢ ⎥
⎢ ⎥ = M 4X 4 ⎢Y ⎥
⎡ X '⎤ 2. On effectue les opérations (définies par ⎢ Z '⎥ ⎢Z ⎥
⎡X ⎤ ⎢ ⎥
⎢ ⎥
⎣W ⎦
⎢ ⎥
⎣1⎦
~ ⎢Y ' ⎥ une matrice 4x4).
P = ⎢⎢ Y ⎥⎥ Î P =
⎢ Z '⎥ ⎡ X '⎤
⎢⎣ Z ⎥⎦ ⎢ ⎥ ⎡ X ' '⎤ ⎢ W ⎥
3. On revient aux coordonnées cartésiennes ⎢Y '' ⎥ ⎢ Y ' ⎥
⎣W ⎦ ⎢ ⎥=⎢ ⎥
en divisant tous les éléments du vecteur ⎢ Z ''⎥ ⎢W ⎥
⎢ ⎥ ⎢ Z' ⎥
• X'=X Y'=Y Z'=Z lorsque W = 1 1 ⎢ W⎥
résultant par W (à la condition que W≠0). ⎣ ⎦
⎢1⎥
⎣ ⎦
Vision 3D - application Modèles de robots M.Mallem 17 Vision 3D - application Modèles de robots M.Mallem 18
à la robotique à la robotique
Rotation
Translation
Changement d'échelle ("scaling")
Projection
Vision 3D - application Modèles de robots M.Mallem 19 Vision 3D - application Modèles de robots M.Mallem 20
à la robotique à la robotique
Coordonnées homogènes :
Coordonnées homogènes : Utilisation Transformations d’intérêt
⎡X ⎤
⎡X ⎤ ⎢ ⎥
1. On passe des coord. cartésiennes aux ⎢Y ⎥ ⇒ ⎢Y ⎥
⎢ ⎥ ⎢Z ⎥
Rotation
coord. homogènes en ajoutant un "1" ⎢⎣ Z ⎥⎦ ⎢ ⎥
⎣1⎦
comme 4e élément au vecteur. ⎡1 0 0 0⎤ ⎡ cos( β ) 0 sin( β ) 0⎤ ⎡cos(γ ) − sin(γ ) 0 0⎤
⎡ X '⎤ ⎡X ⎤
⎢Y ' ⎥ ⎢ ⎥ ⎢0 cos(α ) − sin(α ) 0⎥⎥ ⎢ 0 1 0 0⎥⎥ ⎢ sin(γ ) cos(γ ) 0 0⎥⎥
⎢ ⎥ = M 4X 4 ⎢Y ⎥ RX (α ) = ⎢ RY ( β ) = ⎢ RZ (γ ) = ⎢
⎢ Z '⎥ ⎢Z ⎥ ⎢0 sin(α ) cos(α ) 0⎥ ⎢− sin( β ) 0 cos( β ) 0⎥ ⎢ 0 0 1 0⎥
2. On effectue les opérations (définies par ⎢ ⎥ ⎢ ⎥ ⎢ ⎥ ⎢ ⎥ ⎢ ⎥
⎣W ⎦ ⎣1⎦ ⎣0 0 0 1⎦ ⎣ 0 0 0 1⎦ ⎣ 0 0 0 1⎦
une matrice 4x4).
R XYZ (α , β , γ ) = R X (α ) RY ( β ) RZ (γ )
⎡ X '⎤
⎡ X ' '⎤ ⎢ W ⎥ ⎡ cos( β ) cos(γ ) cos( β ) sin(γ ) sin( β ) 0⎤
3. On revient aux coordonnées cartésiennes ⎢Y '' ⎥ ⎢ Y ' ⎥ ⎢ sin(α ) sin( β ) cos(γ ) + cos(α ) sin(γ ) − sin(α ) sin( β ) sin(γ ) + cos(α ) cos(γ ) − sin(α ) cos( β ) 0⎥⎥
⎢ ⎥=⎢ ⎥ RXYZ (α , β , γ ) = ⎢
en divisant tous les éléments du vecteur ⎢ Z ''⎥ ⎢W ⎥ ⎢− cos(α ) sin( β ) cos(γ ) + sin(α ) sin(γ ) cos(α ) sin( β ) sin(γ ) + sin(α ) cos(γ ) cos(α ) cos( β ) 0⎥
⎢ ⎥ ⎢ Z' ⎥ ⎢
0 0 0 1⎦
⎥
1 ⎢ W⎥ ⎣
résultant par W (à la condition que W≠0). ⎣ ⎦
⎢1⎥
⎣ ⎦
Vision 3D - application Modèles de robots M.Mallem 21 Vision 3D - application Modèles de robots M.Mallem 22
à la robotique à la robotique
Le MGI permet d'effectuer une commande en absolu de l'effecteur du robot. Le MDD Æun contrôle en relatif du robot.
Æ linéarisation de la fonction f (MGD)
C'est la fonction f-1 , si elle existe, qui exprime la configuration du robot(Q)
en fonction de la situation(X :position+orientation) de l'effecteur: dX= J(Q) dQ où dX : différentielle des coordonnées
opérationnelles,
f-1: X ÆQ = f-1 (X) dQ : différentielle des coordonnées
articulaires,
Le calcul du MGI est obtenu à partir du MGD soit en inversant la matrice Ton J(Q) : matrice jacobienne du robot
soit en determinant, par substitution , Q . manipulateur.
Vision 3D - application Modèles de robots M.Mallem 27 Vision 3D - application Modèles de robots M.Mallem 28
à la robotique à la robotique
Modèle différentiel direct (MDD) Modèle différentiel direct (MDD)
ou f i = xi (i = 1..m )
a) Calcul indirect de J(Q) (méthode analytique) :
⎛ ∂f 1 ∂ f 1 ∂f ⎞
Soit la matrice des dérivées partielles de f / coordonnées ⎛ dx1 ⎞ ⎜ . . 1 ⎟ ⎛ dq1 ⎞
⎜ ⎟ ⎜ ∂q1 ∂q 2 ∂q n ⎟ ⎜ ⎟
articulaires: ⎜ dx 2 ⎟ ⎜ ⎜ dq ⎟
⎜ ⎟ . . ⎟⎜ 2⎟
J (Q ) =
∂f
(Q ) d X = J ij (Q ).d Q ⇔ . =⎜ ⎟. .
∂Q ⎜ ⎟ ⎜. . ⎟⎜ ⎟
J ij (Q ) =
∂f i
(Q ) (i = 1..m ; j = 1..n )
⎜. ⎟ ⎜ ⎟ ⎜ . ⎟
∂q j ⎜ ⎟ ⎜ ∂f m ∂ f m . . ∂ f m ⎟ ⎜ ⎟
⎝ dx m ⎠ ⎜ ∂q ∂q ⎟
∂q n ⎠ ⎝ dq n ⎠
Il s'agit du calcul des dérivées partielles des éléments ⎝ j 2
J + = ( J t .J ) −1 .J t
Vision 3D - application Modèles de robots M.Mallem 35 Vision 3D - application Modèles de robots M.Mallem 36
à la robotique à la robotique
Principaux porteurs Principaux porteurs
6.1.1.Structure RPP ou PRP 6.1.2 Structure RRR
Exemples : VERSATRAN "Séries E et F" Exemples : CINCINNATI-MILACRON "T3",
RENAULT "V80", UNIMATION "Unimate 6000"…
Ce type de structure est bien adaptée à un repérage de Ce type de structure est bien adaptée à un repérage de
l'O.T.(Organe Terminal) en coordonnées cylindriques. l'O.T. dans un système de coordonnées qualifiées
Volume = d'anthropomorphes par analogie avec le bras humain.
Volume =
Vision 3D - application Modèles de robots M.Mallem 37 Vision 3D - application Modèles de robots M.Mallem 38
à la robotique à la robotique
Vision 3D - application Modèles de robots M.Mallem 39 Vision 3D - application Modèles de robots M.Mallem 40
à la robotique à la robotique
Principaux porteurs Redondance de robot
6.1.5. Structure RPR ou PRR ou RRP
Exemples : RENAULT "Horizontal 80" 6.2.1. Indices de mobilité et de liberté
.INDICE DE MOBILITE (IM) DE ROBOT = nombre
d’articulations rotoïde/prismatique du bras du robot
(Dimension de l’espace articulaire/configurations (q))
Vision 3D - application Modèles de robots M.Mallem 41 Vision 3D - application Modèles de robots M.Mallem 42
à la robotique à la robotique
fsi
Vision 3D - application Modèles de robots M.Mallem 43 Vision 3D - application Modèles de robots M.Mallem 44
à la robotique à la robotique
Modèles de la structure de base du robot Structure de base PRP
Z
Z L 2+T 2
T 1
z
z Y
O y
M θ1 L
R x
O y Y X
θ2
x
θ1 L
1 . T r a n fo r m a te u r d e c o o r d o n n é e s d ir e c t :
⎛ x ⎞ ⎛ T1 ⎞ ⎛ ( L 2 + T 2 )cθ 1 ⎞
⎜ ⎟ ⎜ ⎟ ⎜ ⎟
X = f (q ) ⇔ ⎜ y ⎟ = f ⎜θ 1 ⎟ = ⎜ (L 2 + T 2)sθ 1 ⎟
X ⎜ z ⎟ ⎜T ⎟ ⎜T ⎟
⎝ ⎠ ⎝ 2 ⎠ ⎝ 1 ⎠
θ2 z2
l1 L1
z
L2 Y
⎛ dx ⎞ ⎛⎜ ⎞
⎟ O y
⎜ ⎟
dX = J ( q ).dq ⇔ ⎜ dy ⎟ = ⎜ ⎟ z1
⎜ dz ⎟ ⎜⎜ ⎟ x θ1 L
⎝ ⎠ ⎝ ⎟
⎠ X
avec L = l 2 c (π / 2 − θ 2 ) + l3 c (θ 2 + θ 3 − 3π / 2 )
⎛ dT1 ⎞ ⎛ ⎞
⎜ ⎟ ⎜ ⎟ Cette application est non linéaire et non bijective
dq = J −1 (q ).dX ⇔ ⎜ dθ1 ⎟ = ⎜ ⎟
Vision 3D - application ⎜ dT ⎟ ⎜ Modèles de robots ⎟ M.Mallem 47 Vision 3D - application Modèles de robots M.Mallem 48
à la robotique ⎝ 2⎠ ⎝ ⎠ à la robotique
Equations Types
Equations Types
[Khalil&Dombre1998]
Vision 3D - application Modèles de robots M.Mallem 49 Vision 3D - application Modèles de robots M.Mallem 50
à la robotique à la robotique
Vision 3D - application Modèles de robots M.Mallem 51 Vision 3D - application Modèles de robots M.Mallem 52
à la robotique à la robotique
Equations Types Equations Types
Vision 3D - application Modèles de robots M.Mallem 53 Vision 3D - application Modèles de robots M.Mallem 54
à la robotique à la robotique
Vision 3D - application Modèles de robots M.Mallem 55 Vision 3D - application Modèles de robots M.Mallem 56
à la robotique à la robotique
Architecture de poignets
Equations Types
[Delignieres1987]
Vision 3D - application Modèles de robots M.Mallem 57 Vision 3D - application Modèles de robots M.Mallem 58
à la robotique à la robotique
zi-1 xi
αi
θi
ri
ai
⎛1 0 0 ai ⎞ ⎛ cθ i − sθ 0 0⎞
⎜ ⎟⎜ i
⎟
⎜0 cα − sα− ri s α i ⎟ ⎜ s θ i cθ 0 0⎟
T i − 1 ,i = ⎜ i i
⎟ .⎜
i
0 sα cα i r c α i ⎟ ⎜ 0 0 1 0⎟
⎜ i i ⎟
⎜0 0 0 1 ⎟⎜ 0 0 0 1 ⎟⎠
⎝ ⎠⎝
⎛ cθ i − sθ i 0 ai ⎞
⎜ ⎟
⎜ cα i sθ cα icθ i − sα i − ri s α i ⎟
= ⎜ i
sα i sθ sα icθ i cα i ri c α i ⎟
⎜ i ⎟
⎜ 0 0 0 1 ⎟
⎝ ⎠
Règles de construction des repères associés aux articulations
du robot :
. Considérer le robot dans une configuration initiale("zéro") qui
simplifie les calculs(q=0)
. Tout axe zi doit être placé le long de l'articulation i .
. A chaque articulation i est associé un repère Ri dont
l'emplacement doit être judicieusement choisi pour simplifier les
calculs.
. L'axe xi-1 doit être porté par la perpendiculaire commune aux
Vision 3D - application Modèles de robots M.Mallem 61
axes zi-1 et zi
Vision 3D - application Modèles de robots M.Mallem 62
à la robotique à la robotique
Z3, Z4, Z6
Paramètre\ i 1 2 3 4 5 6
σi 0 1 1 0 0 0
X2 O2
O3, O4, O5, O6
αi 0 0 -π/2 0 -π/2 π/2
X3, Z5
ai 0 0 0 0 0 0
θi q1 0 0 q4 q5 q6
ri 0 q2 q3 0 0 0
qi selon fig. 0 >0 >0 -π/2 0 0
Z0, Z1
O0, O1
q i = σ iθ i + σ i ri
X0, X1
Vision 3D - application Modèles de robots M.Mallem 63 Vision 3D - application Modèles de robots M.Mallem 64
à la robotique à la robotique
Modélisation de robot à 6 ddl:
Modélisation de robot à 6 ddl: Scemi
Versatran
M a t r ic e s d e p a s s a g e : 8.3 Robot SCEMI (6R)
⎛ c1 − s1 0 0 ⎞ ⎛ 1 0 0 0 ⎞ Z0, X3
⎜ ⎟ ⎜ ⎟ X4, X5, X6
0 0 ⎟ 0 1 0 0
T 01
⎜ s
= ⎜ 1
0
c1
0 1 0 ⎟ ; T 12 = ⎜
⎜
0 0 1
⎟
q 2 ⎟
; X1, X2
O3
Z4, Z6
.
⎜ ⎟ ⎜ ⎟
⎜ 0 0 0 ⎟
1 ⎠ ⎜ 0 0 0 1 ⎟⎠
O0,O1,O
O4, O5, O6
O7
⎝ ⎝
X0, Z3 Z5
⎛ 1 0 0 0 ⎞ ⎛ c 4 − s 0 0 ⎞
⎜ ⎟ ⎜ 4
⎟
⎜ 0 0 1 q 3 ⎟ 0 0 ⎟
T 23 = ⎜
0 − 1 0 0 ⎟
T 34 = ⎜ 4
⎜ s
0
c 4
0 1 0 ⎟
;
⎜ ⎟ ⎜ ⎟
⎜ 0 0 0 1 ⎟⎠ ⎜ 0 0 0 1 ⎟⎠
⎝ ⎝
⎛ c5 − s 0 0 ⎞ ⎛ c6 − s 0 0 ⎞
⎜ 5
⎟ ⎜ 6
⎟
⎜ 0 0 1 0 ⎟ 0 0 − 1 0 ⎟
T 45 = ⎜
− s − c 0 0 ⎟
; T 56 =
⎜
⎜ s c 0 0 ⎟
⎜ 5 5 ⎟ ⎜ 6 6 ⎟
⎜ 0 0 0 ⎟
1 ⎠ ⎜ 0 0 0 1 ⎟⎠
⎝ ⎝
où
cos( q i ) = c i ; sin( q i ) = s i
Vision 3D - application Modèles de robots M.Mallem 65 Vision 3D - application Modèles de robots M.Mallem 66
à la robotique à la robotique
( xr 6 r
6 r
T 06 = ∏ T i − 1 , i = y6 z6 O 6 )/ Ro
i=1
⎛ px ⎞ ⎛ xx ⎞ ⎛ z ⎞
Matrices de passage (à compléter) : ⎜ ⎟ r ⎜ ⎟ r ⎜ x
⎟
O 6 / Ro = ⎜ p y ⎟ et x6 = ⎜ x y ⎟; z 6 = ⎜ z y ⎟
⎜⎜ ⎟⎟ ⎜⎜ ⎟⎟ ⎜⎜ ⎟⎟
⎝ p z ⎠ ⎝ xz ⎠ ⎝ z z ⎠
⎛ c1 − s1 0 0⎞ ⎛ c2 − s2 0 0⎞ :
⎜ ⎟ ⎜ ⎟ Pince définie dans R 7
0 0⎟ ⎜ 0 0 −1 0⎟ r r r r r
T 01
⎜s
= ⎜ 1
0
c1
0 1 0⎟
; T 12 = ⎜
s c2 0 0⎟
; O 6O 7 = r 7 z 6 et x 7 = x6; z7 = z6
⎜ ⎟ ⎜ 2 ⎟ ⎛ x ⎞ ⎛ p + r7 z ⎞
⎜ 0 ⎜ ⎟ ⎜ x x
⎟
⎝ 0 0 1 ⎟⎠ ⎜ 0
⎝ 0 0 1 ⎟⎠ O 7 / Ro = ⎜ y ⎟ = ⎜ p y + r7 z y ⎟
⎜ z ⎟ ⎜⎜ ⎟⎟
⎛ c3 − s3 0 a3 ⎞ ⎛ c4 − s4 0 0 ⎞ ⎝ ⎠ ⎝ p z + r7 z z ⎠
⎜ ⎟ ⎜ ⎟
0 0 ⎜ 0 0 − 1 − r4
T 23
⎜s
= ⎜ 3
0
c3
0 1 0
⎟
⎟ T 34 = ⎜s c4 0 0
⎟
⎟ ; Le M GD est exprimé par :
⎜ ⎟ ⎜ 4 ⎟
⎜ 0 0 0 1 ⎟ ⎜ 0 0 0 1 ⎟ ⎛ xx yx z x x ⎞
⎝ ⎠ ⎝ ⎠ ⎜ ⎟
r r r ⎜x yy zy y ⎟
⎛ c5 − s5 0 0⎞ ⎛ c6 − s6 0 0⎞ T07 = ( x 7 y7 z7 O7 ) = ⎜ y
⎜ ⎟ ⎜ ⎟ xz yz zz z ⎟
⎜ ⎟
⎜ 0 0 1 0⎟ ⎜ 0 0 −1 0⎟ ⎜ 0 0 1 ⎟⎠
T 45 = ⎜
− s5 − c5 0 0⎟
;
T 56 = ⎜
0 0⎟
⎝ 0
⎜ ⎟
s
⎜ 6
c6
⎟ ⎛ c1c 4 c 5 c 6 − c1 s 4 s 6 + s1 s 5 c 6 − c1c 4 c 5 s 6 − c1 s 4 c 6 + s1 s5 s 6 c1c 4 s 5 − s1c 5 − s1 q 3 + r7 z x ⎞
⎜ ⎟
⎜ 0 0 0 1 ⎟⎠ ⎜ 0 0 0 1 ⎟⎠ ⎜ s c c c − s1 s 4 s 6 − c1 s 5 c 6 − s1c 4 c 5 s 6 − s1 s 4 c 6 − c1 s 5 s 6 s1c 4 s 5 + c1c 5 c1 q 3 + r7 z y ⎟
⎝ ⎝ =⎜ 1 4 5 6
Vision 3D - application Modèles de robots M.Mallem 69 Vision 3D - −application
s 4 c5 s 6 − c 4 s 6 s 4 c 5 sModèles
6 − c4 c6
de robots − s 4 s5 q 2 + r7 z z ⎟ M.Mallem 70
⎜ ⎟
à la robotique à la robotique
⎜ 0 0 0 1 ⎟
⎝ ⎠
Vision 3D - application Modèles de robots M.Mallem 71 Vision 3D - application Modèles de robots M.Mallem 72
à la robotique à la robotique
⎛ ⎞ ⎛ ⎞
MDD du
⎜ Robot
⎟ ⎜ VERSATRAN
⎟ (RPPRRR) dp x dq 1
MDD
Ainsi la du Robot
différenti elle de positionVERSATRAN
du poignet est : (RPPRRR)
⎜ dp y ⎟ ⎜ dq 2 ⎟
⎜ ⎟ ⎜ ⎟ dp x = − p y dq1 − s1dq3 = −c1q3 dq1 − s1dq3
⎜ ⎟
dq
J .⎜ ⎟
dp z 3
dp = J . dq ⇔ = dp y = p x dq1 + c1dq3 = − s1q3 dq1 + c1dq3
⎜ dϕ x ⎟ ⎜ dq 4 ⎟
⎜ ⎟ ⎜ ⎟ dp z = dq2
⎜ dϕ y
⎟ ⎜
dq 5
⎟ la différentielle d ' orientation du poignet est :
⎜ ⎟ ⎜ ⎟
⎝ dϕ z ⎠ ⎝ dq 6 ⎠ dϕ x = − s1dq4 − c1s4 dq5 + z x dq6 = − s1dq4 − c1s4 dq5 + (c1c4 c5 − s1c5 ) dq6
⎛ r
× O O
r r r
× O
r
× O
r
× O ⎞
⎜ ⎟
z z z z O z O z O
= 1 1 6 2 3 4 4 6 5 5 6 6 6 6
dϕ y = c1dq4 − s1s4 dq5 + z y dq6 = c1dq4 − s1s4 dq5 + ( s1c4 s5 + c1c5 ) dq6
J r r
⎝ ⎠
r r r r
z 0 0 z z z
1 4 5 6
⎛0 ⎞
r r r ⎜ ⎟ r r dϕ z = dq1 − c4 dq5 + z z dq6 = dq1 − c4 dq5 − s4 s5 dq6
avec z 0 = z 1 = z 2 = ⎜ 0 ⎟ ; z 3 = z 4 ∀ q i et O 4 = O 5 = O 6
⎜1 ⎟
⎝ ⎠ / Ro à partir dp et de d ϕ on obtient :
D ' où :
⎛ dx = dϕ y x z − dϕ z x y
⎞
⎛ r
× O
r r r
0
r
0
r
0 ⎞
r ⎜ x
⎟
⎜ ⎟
z O z z
0 0 6 0 3
= ⎜ dx = dϕ z xx − dϕ x xz ⎟
=
d x 7 = d x 6 = dϕ × x6
J r r
⎝ ⎠
r r r r
z 0 0 z z z
1 4 5 6
⎜ ⎟
y
⎛0 ⎞ ⎛ − s1 ⎞ ⎛ − c1 s 4 ⎞ ⎛ z ⎞ ⎛ p ⎜ dx = d ϕ x x y − d ϕ y x x ⎟⎠
r ⎜ ⎟ r ⎜ ⎟ r ⎜ ⎟ r ⎜ x ⎟ ⎜ x ⎝ z
z0/ = ⎜0 ⎟ ; z3/ = ⎜ c1 ⎟ ; z5/ = ⎜ − s1 s 4 ⎟ ; z6 = ⎜ z ⎟ et O 0 O = ⎜ p
6 / Ro ⎛ dz ⎞
avec
Ro
⎜1 ⎟
Ro
⎜0 ⎟
Ro
⎜⎜ ⎟⎟ / Ro
⎜
y
⎟ ⎜
y
= dϕ y zz − dϕ z z
⎝ ⎠ ⎝ ⎠ − c4 ⎝ z ⎠ ⎝ p ⎜ x y
⎟
⎝ ⎠ z z r
d z 7 = d z 6 = dϕ × z6 = ⎜ dz = dϕ z zx − dϕ x zz ⎟
⎜ ⎟
y
D ' où :
⎜ dz z = dϕ x z y − dϕ y z x ⎠
⎟
⎛− p y 0 − s1 0 0 ⎞ 0 ⎝
⎜ ⎟
⎜ px 0 c1 0 0 ⎟ 0 ⎛ dx ⎞ ⎛ dp + a 7 x x + r7 z x ⎞
⎜0 ⎟ ⎜ ⎟ ⎜ x
⎟
1 0 0 0 0 d ( O 0 O 7 ) = ⎜ dy ⎟ = ⎜ dp + a 7 x y + r7 z y ⎟
J = ⎜ ⎟ y
0 0 0 − s1 − c1 s 4 ⎜ dz ⎟ ⎜⎜ ⎟⎟
Vision⎜⎜ 3D - application zx ⎟
Modèles de robots M.Mallem 73 Vision 3D - application
⎝ ⎠ ⎝ dp + a 7 x zModèles
+ r 7 z z de
⎠ robots M.Mallem 74
zy ⎟
z
0 0 0 c1 − s1 s 4
à la robotique
⎜⎜ ⎟ à la robotique
⎝1 0 0 0 − c4 z z ⎟⎠
Æq3 ? Æq4 ?
Æq1 ? Æ q6 ?
Vision 3D - application Modèles de robots M.Mallem 75 Vision 3D - application Modèles de robots M.Mallem 76
à la robotique à la robotique
MDI du Robot VERSATRAN (RPPRRR) MDI du Robot VERSATRAN (RPPRRR)
Æ dq3 ? déduit de q1, dpx et dpy Æ dq6 ?déduit de q4, q1, q5, dϕx, dϕy et dϕz
dq 3 = − s 1 dp x + c 1 dp y
dq 6 = c 4 ( c1 d ϕ x + s 1 d ϕ y ) + s 4 ( dq 1 − dϕ z ) s5 avec s5 ≠ 0
Æ dq1 ? déduit de q1, q3, dpx et dpy Æ q4 ? déduit de q5, q1, dq6, dϕx et dϕy
dq 1 = − ( c 1 dp x + s 1 dp y ) q3 avec q3 ≠ 0 dq 4 = − s1 d ϕ x + c1 d ϕ y − c 5 dq 6
Vision 3D - application Modèles de robots M.Mallem 77 Vision 3D - application Modèles de robots M.Mallem 78
à la robotique à la robotique
ROBOT
(effecteur)
Génération de Modèles cinématique et dynamique du robot
trajectoire
Qn
ARTICULATION
(actionneur)
Asservissement des
articulations
Vision 3D - application Modèles de robots M.Mallem 79 Vision 3D - application Modèles de robots M.Mallem 80
à la robotique à la robotique
TD robot manipulateur planaire à 4 ddl
Bibliographie
Le robot SCARA (IBM), représenté ci-dessous, est constitué d’un porteur de type
torique(RRR) et d’un poignet à un degré de liberté. Ce robot est utilisé pour
effectuer des tâches d’assemblage planaire. Wisama Khalil et Etienne Dombre
Déterminer les paramètres de Denavit-Hartenberg, selon la figure ci-dessus.
Calculer les modèles géométriques et différentiels direct et inverse du poignet de
« Modélisation Identification et Commande
ce robot.
Quelles sont les configurations singulières de ce robot.
de robots » - Collection Robotique Hermès
Z0, Z1 Z2
1999
Z3, Z4
X0, X1 X2 X3, X4
Vision 3D - application Modèles de robots M.Mallem 81 Vision 3D - application Modèles de robots M.Mallem 82
à la robotique à la robotique