La présentation est en train de télécharger. S'il vous plaît, attendez

La présentation est en train de télécharger. S'il vous plaît, attendez

2.1.7 Modèle Géométrique Direct Forward Kinematics

Présentations similaires


Présentation au sujet: "2.1.7 Modèle Géométrique Direct Forward Kinematics"— Transcription de la présentation:

1 2.1.7 Modèle Géométrique Direct Forward Kinematics
Coordonnées opérationelles (pos. & orientation de la main ou de l'outil) en fonction des variables robot {x,y,z, a } = F (q1, q2, … qi, …. qn )

2 Position & orientation d’un outil
q1 q2 L4 y x TCP q4 MGD complet « à la main » x = L1 c1 + L2c12 + L4c124 y = L1 s1 + L2s L4s124 z = q3 j = q1 + q2 + q4

3 MGD d’un robot à 6 ddl? La même démarche pour un robot à 6 ddl devient très difficile => utiliser les matrices homogènes! Exercice 9 !

4 Ex. 9b Rot. de q4 de autour de [ L1 + L2 , 0 ]T
Rot. de q2 de autour de [ L1 , 0 ]T Rot. de q1 de autour de [ 0 , 0 ]T 1.)

5 et L1 2 = L1 + L2 avec les définitions versine(q) = 1– cosq
Ex. 9b Rot. de q4 de autour de [ L1 + L2 , 0 ]T avec les définitions versine(q) = 1– cosq donc v4 = 1– cos q4 et L1 2 = L1 + L2

6 Ex. 9b MGD complet: =

7 Ex. 9b MGD complet: =

8 x x = L1 c1 + L2c12 + L4c124 y = L1 s1 + L2s12 + L4s124
Application du MGD L1 L2 y x L4 Ex. 10 q1 q2 L4 y x TCP x = L1 c1 + L2c12 + L4c124 y = L1 s1 + L2s L4s124

9 x Etablissement du MGD: Définir les variables robots
Définir leurs positions de référence Définir les paramètres du robot Enchainer les mouvements successifs (multiplication de matrices homogènes) L4 y L1 L2 x

10 MGD d’un robot 6ddl q3 q2 q6 q5 q4 q1 Variables robot Convention:
Partir de la base vers la main q1

11 2. Positions de référence
q2 q3 q5 q4 , q6 y z x q1 2. Positions de référence qi = 0 Les flèches indiquent le sens de rotation positif The arrows indicate positive rotation Le référentiel (x,y,z) est fixe (coordonnées opérationelles) Fixed coordinate frame!

12 z x y 3. Paramètres du robot q1 q5 q3 q2 D4 L2 D3 q4 , q6
Les axes q1 et q2 se croisent => L1=0 cross each other D4 Les axes q2 et q3 sont parallèles, dist. L2 q5 q3 Les axes q3 et q4 se croisent => L3=0 L2 Les axes q1 et q4 sont décalés sur l'axe q3 d'une distance D3 Distance between q1 and q4 along q3 : D3 D3 x y Les axes q4 et q5 se croisent => L4=0 q2 Les axes q3 et q5 sont décalés sur l'axe q4 d'une distance D4

13 Généralisation de la paramétrisation: Paramètres Denavit-Hartenberg
Les axes successifs sont reliés par les perpendiculaires communes, définissant ainsi des points de repère Pi q3 q1 P1 P2 P2' P3 L2 L1 Passage de l'axe 1 à l'axe 2: Déplacement de L1, rotation de a1 autour de L1 q2 Li: Link length ai: Twist angle Distance de Pi à Pi': Joint offset Di

14 4. Enchainement des mouvements
z q4 , q6 Rot. de q6 autour de l'axe z , décalée de p = [D3,0,0]' q5 D4 q3 L2 D3 x y q2

15 2. Rot. de q5 autour de l'axe x , décalé de p = [0,0, L2+D4]'
z q4 , q6 2. Rot. de q5 autour de l'axe x , décalé de p = [0,0, L2+D4]' q5 D4 q3 L2 D3 x y q2 et ainsi de suite pour K4 ,K3 , K2 , K1

16 MGD du robot 6ddl P(qi) = (K1 K2 K3 K4 K5 K6 ) P0 P0 q3 q2 q6 P(qi) q5

17 2.1.8 Représentation de l’orientation: Angles d'Euler
L'orientation est très souvent exprimée en angles autour de trois axes fixés au corps en mouvement. (Figures p ) Historiquement ce sont précession, nutation, rotation propre (axes z,x,z liés au corps) Généralisation: On trouve 12 jeux d'angles différents Orientation is often expressed as angles around body-fixed axes. Historically, these were first defined by Euler as precession, nutation and proper rotation of a gyroscope (top, Kreisel)

18 Orientation: Poignet à 3 axes concurrents
Wrist with three axes through a common intersection q5 q4 q6 Fig 10

19 Poignet à 3 axes: Angles d’Euler Gruber p. 209
q5 q4 q4= y q5= j y x q6 = ϑ z Poignet à 3 axes: Angles d’Euler Gruber p. 209 ( y, j, q ) Précession nutation rotation propre axes z,x,z (corps) body-fixed Fig 10b) p. 11 Fig 12) p. 13

20 Poignet cardanique: Fig. 13 P 2.1.-13
Roulis (roll) j aut. axe x, direction d'approche tangage (pitch) J aut. axe y lacet (yaw) y aut. axe z Angles d'Euler (x,y,z), axes liés au corps q5 q4 q6 Cardanic wrist

21 P(qi) = (K1 K2 K3 K4 K5 K6 ) P0 MGD: Comment trouver les angles (j, J, y) par rapport à des axes fixes x,y,z? R1 R2 R3 R4 R5 R6 = Rtot = Rtot = Rz Ry Rx =

22 Solution: j = Atan2(±r32,±r33) y = Atan2(±r21,±r11)

23 2.1.9 MGI Tâche pratique: Quelles variables pour qi un P donné?
z x q2 q4 q6 q5 q1 q3 y P(qi) On cherche qi(P) , donc la fonction inverse du MGD P(qi)

24 Modèle Géométrique Inverse (indirect) Inverse Cinematics, rückwärts Kinematik
Problème mathématiquement difficile! Exemple très simple: L2 q1 q2 x L1 MGD x = L1 c1 + L2c12 y = L1 s1 + L2s12 Donnés x & y, quels sont q1 et q2 ?

25 1. Remplacer cos(q1 + q2) par cosq1 et cosq2
x = L1 c1 + L2c12 = L1 c1 + L2c1c2 – L2s1s2 y = L1 s1 + L2s12 = L1 c1 + L2s1c2 + L2c1s2 2. L'introduction des sinus nécessite d'ajouter les relations entre sinus et cosinus s12 + c12 = 1 s22 + c22 = 1 4 équations, 4 inconnues mais des équations quadratiques!

26 Nous constatons donc que le MGI est beaucoup plus complexe que le MGD!
Les équations sont non-linéaires Des solutions analytiques générales comme dans le cas d'équ. linéaires sont inconnues Solutions multiples possibles! Infinité de solutions possible (redondance)

27 Note Robot redondant: Plus de ddl que nécessaires au positionement Raison: Accessabilité Applications typiques: Soudure, peinture sur des éléments complexes (carosserie d'auto)

28 Solution des 4 équations:
(x2 + y2) = L12 + L L1 L2 c2 Cela donne cos(q2) et donc deux angles q2 Exercice: Trouvez q1

29 Robot à 6 ddl Position: On peut trouver le MGI en combinant deux fois l'exemple planaire qui vient d'être fait. Nous avons donc déjà 2x2=4 postures possibles

30

31 donc R(q4,q5,q6) = R(base)–1 R(consigne)
MGI du robot à 6 ddl Orientation: Les angles sont des angles d'Euler par rapport à l'orientation du troisième membre. R(consigne) = R(base) R(q4,q5,q6) donc R(q4,q5,q6) = R(base)–1 R(consigne) Postures? (nombre de solutions?)

32 Postures du poignet q5 q4 q6 q5 => -q5 q4 => q4±p q6 => q6±p

33 Récapitulation MGD et MGI
Le MGD se trouve de façon systématique. (Paramètres Denavit Hartenberg, matrices homogènes) Il y a toujours une solution dans le domaine de travail Le MGI ne peut pas se calculer systématiquement dans tous les cas (besoin d'astuces) Solutions multiples (postures) possible Nombre de solutions inconnu en général! Méthodes numériques ne donnent pas toutes les solutions

34 Robots parallèles? q3 q1 q2 f MGD: Données q1, q2, q3,
(x, y) f q3 q1 q2 MGD: Données q1, q2, q3, Quels sont (x, y, f) ?

35 Solution:

36 Constat: Pour les robots parallèles, c'est le modèle géométrique direct MGD qui aura plusieurs solutions. On les appelle les "contorsions"

37 MGI? q3 q1 q2 f MGI: Données (x, y, f) , Quels sont q1, q2, q3 ?

38 MGI (x, y) f A l'évidence, il n'y a qu'une seule solution.

39 Fin section 2.1 "Cinématique"
Robots sériels: Le MGD a une seule solution; méthode "infaillible" existe Le MGI a des solutions multiples! (Les postures) Robots parallèles, c'est juste l'inverse: Le MGD a des solutions multiples! (Les contorsions) Le MGI n'a qu'une solution, souvent facile à trouver Ces questions sont objet de recherche en robotique. (publications, conférences...)


Télécharger ppt "2.1.7 Modèle Géométrique Direct Forward Kinematics"

Présentations similaires


Annonces Google