Description du robot SCARA
Transcription
Description du robot SCARA
Calcul du Jacobien pour le Robot Scara Description du robot SCARA Le robot Scara est un robot avec 4 degrés de liberté. Exemple de deux robots SCARA. A gauche : KUKA KR 10 R600 – A droite : Stäubli RS 80 La sortie opérationnelle du Scara consiste aux 3 coordonnées translationnelles de l’outil et de l’orientation de ce dernier par rapport au repère de la base du robot Soit X le vecteur des coordonnées opérationnelles. Les coordonnées articulaires sont les coordonnées des 3 moteurs rotationnels et celle du moteur translationnel z. Soit q le vecteur de coordonnées généralisées (coordonnées articulaires) du SCARA, M. Bouri, 2008-2009 Robot SCARA avec ses 4 déplacements articulaires Le déplacement z est souvent placé acé après les deux rotations planaires pour avoir un robot plus léger et un axe z moins puissant. Cependant, d’autres configurations existent pour des applications d’envergures ou l y a besoin d’éviter certains obstacles en déplaçant des objets lourds (exemples (exe cidessous). Exemples de structures SCARA pour la manipulation d’objets lourds M. Bouri, 2008-2009 Calcul du Jacobien Les deux équations de base : J (q) L J Pn (q ) J ( q ) = P1 J O1 (q) L J On (q) r r r r R1 (ε 1 z 0 + (1 − ε 1 ) zˆ ⋅ r1,n +1 ) L Rn (ε n z 0 + (1 − ε n ) zˆ ⋅ rn ,n +1 ) J (q) = r r L (1 − ε 1 ) R1 z 0 (1 − ε n ) Rn z 0 r Ri z i J pi (q ) 0 Soit r = J Oi (q ) Ri zˆ ⋅ ri ,n +1 R zr0 n pour une articulation prismatique pour une articulation rotoïde Ou bien : r r r r r r r r ε 1 z1 + (1 − ε 1 ) z1 ∧ ( p n+1 − p1 ) L ε n z n + (1 − ε n ) z n ∧ ( p n +1 − p n ) J (q ) = r r (1 − ε 1 ) z1 (1 − ε n ) z n L r z i J pi (q ) 0 Soit r r = r J q ( ) Oi z i ∧ ( p n +1 − pi ) r zi pour une articulation prismatique pour une articulation rotoïde Ces deux expressions vont être utilisées pour l’établissement de la matrice Jacobienne : M. Bouri, 2008-2009 , , , , Première approche (éxpression2.2.14) Vecteurs unitaires zi , ! ! ! , ! , " # Articulations rotoïdes Articulations prismatiques $ $ Produits vectoriels : $ % $ $ $ ' & & " & & & & ) ( ( ( ( ( ( M. Bouri, 2008-2009 Deuxième approche (éxpression2.2.15) r r r r R1 (ε 1 z 0 + (1 − ε 1 ) zˆ ⋅ r1,n +1 ) L Rn (ε n z 0 + (1 − ε n ) zˆ ⋅ rn ,n +1 ) J (q) = r r L (1 − ε 1 ) R1 z 0 (1 − ε n ) Rn z 0 0 − 1 0 ẑ = 1 0 0 0 0 0 cos(θ1 ) − sin(θ1 ) 0 R1 = R1 = sin(θ1 ) cos(θ1 ) 0 0 0 1 0 1 cos(θ 2 ) − sin(θ 2 ) 0 R2 = sin(θ 2 ) cos(θ 2 ) 0 0 0 1 cos(θ1 + θ 2 ) − sin(θ1 + θ 2 ) 0 R2 = R2 = R1 ⋅ R2 = sin(θ1 + θ 2 ) cos(θ1 + θ 2 ) 0 0 0 1 0 3 0 1 cos(θ 3 ) − sin(θ 3 ) 0 R4 = sin(θ 3 ) cos(θ 3 ) 0 0 0 1 cos(θ1 + θ 2 + θ 3 ) − sin(θ1 + θ 2 + θ 3 ) 0 R4 = R4 = R3 ⋅ R4 = sin(θ1 + θ 2 + θ 3 ) cos(θ1 + θ 2 + θ 3 ) 0 0 0 1 0 0 3 ! ! ! , Articulations rotoïdes ! , Articulations prismatiques + · - · ., " * + · + · - · ., + · , + · + · - · ., 0 + · ., 1 23 ., 1 ., 1 23 23 M. Bouri, 2008-2009