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

Bases théoriques: modélisation et contrôle 2.1 Cinématique/CinematicsBleuler 2.2 Jacobien/JacobianBouri 2.3 dynamique/DynamicsBouri 2.4 Contrôle/ControlBouri.

Présentations similaires


Présentation au sujet: "Bases théoriques: modélisation et contrôle 2.1 Cinématique/CinematicsBleuler 2.2 Jacobien/JacobianBouri 2.3 dynamique/DynamicsBouri 2.4 Contrôle/ControlBouri."— Transcription de la présentation:

1 Bases théoriques: modélisation et contrôle 2.1 Cinématique/CinematicsBleuler 2.2 Jacobien/JacobianBouri 2.3 dynamique/DynamicsBouri 2.4 Contrôle/ControlBouri

2 2.1 Cinematics Generic task of industrial robot: Move an object (tool, workpiece) Therefore: Need to study cinematics, i.e. geometry of motion Velocities, accelerations later Forces (statics & dynamics) later Tâche "générique" du robot industriel: Déplacer un objet (outil ou pièce) Donc: Etude de la cinématique, i.e. géometrie des mouvements Forces, statique & dynamique plus tard Temps, vitesses, accélérations plus tard

3 La cinématique peut représenter 80% de l'effort dans l'établissement du modèle d'un robot. Elle seule peut facilement faire l'objet de cours ou de livres entiers. Ce chapitre 2.1 nest qu'une introduction se limitant à l'essentiel. Cinematics may reach 80% of the effort to model a robot There are books and lectures on ro This is only an introduction to the bare essentials

4 Content 1.active & passive transformations 2.Translations & rotations 2D around coord. origin 3.Combination transl. & rot: Homogenous matrices 4.2D Rotations around any centerpoint 5.3D Rotations: Rot.-axis, quaternions 6.Homogenous matrices 7.Robot coordinates, direct cinematicsp9 Variables robot, Modèle géométrique direct 8.Euler anglesp13, p11 9.Inverse Cinematics Modèle géométrique inverse

5 2.1.7 Variables robot / Robot Coordinates Tout robot est controlé par des consignes angulaires ou linéaires envoyées aux actionneurs (moteurs). Ces angles ou positions sont les variables robots. Leur nombre n est le nombre de ddl du robot. A robot is controlled by angular or linear setpoints. These values are sent to the actuators (motors). These angular or linear values are called joint coordinates or joint variables { q 1, q 2, … q i, …. q n } ou/or { 1, 2, … i, …. n }.

6 Variables opérationelles Operational (or task) variables La tâche du robot se décrit dans dautres termes: Position et orientation de loutil, de lobjet à manipuler. Pour un corps rigide, il sera nécessaire de spécifier six variables, correspondants aux six ddl dun solide dans lespace. { x,y,z } = position dun point du solide, p.ex. du centre. Les trois paramètres restants peuvent être représenté par une grande variété de façons. The robot task is defined in other terms: It is position and orientation of the tool or workpiece to be manipulated. e.g. x,y,z of the tool center point, + Euler angles

7 Représentation de lorientation / Variables for orientation Parmi les plus communes: Angles autour de trois axes fixés au corps en mouvement. Vous connaissez au moins une telle représentation: Tangage, roulis, lacet sont liés aux axes d'un véhicule (avant, haut, directions latérales) (Roll–, Neig– und Gier–winkel) Fig. 13 p.13 Ces définitions peuvent se rapporter à l'observateur Usually, orientation is defined as rotation angles around axes fixed to the moving body: Roll, Pitch, Yaw are used for vehicles, Euler angles for gyroscopes, rectangular axes tied to approach direction for robots.

8 Wrist (Poignet) à 3 axes concurrents Fig 10 p. 11

9 Poignet à 3 axes: Angles dEuler Gruber p Fig 10b) p y x 6 Précession nutation rotation propre z Wrist

10 Modèle géométrique direct: ( Direct) or Forward Cinematics: Exprimer les variables opérationelles { x, y, z, } en fonction des variables robots { q 1, q 2, … q i, …. q n } Express the operationel (task level) variables { x, y, z, } as function of the joint variables { q 1, q 2, … q i, …. q n }

11 Organisation du chapitre 2.1 cinématique 1.Transformations actives et passives 2.Translations et rotations 2D autour de lorigine 3.Combinaison transl. & rot: Matrices homogènes 4.Rotations 2D autour dun point arbitraire 5.Rotations 3D: Axe de rotation, quaternions 6.Représentation homogène 7.Variables robot, Modèle géométrique direct robot coordinates, forward cinematics 8.Angles dEuler 9.Modèle géométrique inverse (Inverse cinematics)

12 2.1.1 Première difficulté / Conceptual difficulty: Reférentiels multiples / Multiple reference frames Fixes (base du robot, table de travail, etc) En mouvement, donc solidaires au corps (élément du robot, poignet, outil, pièce,...) Fixed frame of reference (e.g. robot base, work table) Frame in motion, tied to a robot element such as wrist, tool, workpiece...

13 Cela mène à deux tâches de base: 1.Changement de position d'un objet dans un référentiel fixe: Transformation active 2.Changement de référentiel d'un objet fixe: Transformation passive (Gruber p.682) Two basic tasks: 1)Change of position of an object in a fixed frame of reference « Active Transformation » 2)Change of frame of reference without motion of object: « Passive Transformation »

14 2.1.2 Translation et rotations 2D autour de l'origine O Translation & rotation in 2D around origine O x y v 1 2 v t P (avant) P (après) C C Translation du point P de la position v 1 à la position v 2 v 2 = v 1 + t valid for any point of rigid body C Transformation active:

15 x y t P O2O2 Translation du référentiel O 1 vers O 2 v 2 = v 1 – t Transformation passive: O 1 (avant before) v1v1 v2v2 (après after)

16 Translation du Référentiel O 1 vers O 2 v 2 = v 1 – t Transf. active = inverse (passive): x y t P O 2 (après) O1O1 v1v1 v2v2 x y v 1 2 v t P (avant) P (après) C C Translation du point P de la position v 1 à la position v 2 v 2 = v 1 + t (avant) Active transformation is simply the mathematical inverse of passive transformation

17 Translation : Changement de position sans changement dorientation (tout les points changent de la même façon) Rotation : Changement dorientation, il existe un point fixe (centre de rotation)* ) Translation: Change of position without change of orientation Rotation: Change of orientation. There exists a fixed point (center of rotation) *) dans le cas de 2 dimensions

18 Rotation (active) autour de O dans le plan Axe (z) : toujours perpendiculaire au plan x y v 1 v 2 C (avant) C (après) O (2) P P Rotation axis always normal to the plane of motion

19 In polar coordinates (r, ) this rotation is trivial. In cartesian coordinates, we need some trigonometry: Pour passer directement de [x 1,y 1 ] à [x 2,y 2 ] en cordonnées cartésiennes, sans devoir calculer (r, ) à partir de [x 1,y 1 ], les théorèmes trigonométriques suivants sont nécessaires: cos(a+b) = cos(a)cos(b) – sin(a)sin(b) sin(a+b) = sin(a)cos(b) + cos(a)sin(b)

20 Appliquée aux sommes d'angles dans (2) donne: La matrice de rotation R contient l'angle. On l'appelle également Matrice des cosinus directeurs Matrix of direction cosines, rotation matrix

21 Rotation around O x y v 1 v 2 C (avant) C (après) O P P

22 Exercices 1a)R( = 0) = ? 1b)R(– ) = ? 1c)R( ) –1 = ? 1d)v 3 = R( )v 2 = R( )R( )v 1 = R(?)v 1 ? 1e)R( )R( ) = R( )R( ) ?

23 En transformant les vecteurs [1,0] T et [0,1] T, on constate que les colonnes de R forment un repère orthogonal tourné de par rapport au repère cartésien d'origine. (v 1. v 2 = 0, v i. v i = 1). Ces conditions impliquent R T =R –1 (matrice orthogonale). Le déterminant est nécessairement ||R|| = 1 Transformation of the unit vectors shows that the columns of R represent an orthogonal frame rotated w.r.t. the original frame. This implies the matrix orthogonality condition R T = R –1 Moreover, the determinant is 1.

24 Rotation passive autour de O dans le plan Axe: toujours perpendiculaire au plan (z) O x1x1 y1y1 x2x2 y2y2 P

25 Transformations passives = inverse des transformations actives Translation du Référentiel O 1 vers O 2, même position! v 2 = v 1 – t Translation du point P de la position v 1 à la position v 2 v 2 = v 1 + t Rotation du point P de la position v 1 à la position v 2 Rotation du référentiel même vecteur!

26 Translation: Addition vectorielle Rotation: Multiplication matricielle Il serait utile davoir la même opération mathématique pour tout changement de position, que ce soit translation ou orientation A unified operation would be useful

27 Nécessité de combiner rotations et translations dans une seule opération Rotation autour de points arbitraires: Rotation around any point? x y O P Centre de rotation? P Need for unified operation for transl. & rotation

28 Solution: Homogenous coordiates représentation homogène Cette combinaison est obtenue de la façon suivante: 1.On ajoute un "facteur d'échelle" 1 à chaque vecteur 2.On ajoute le vecteur de translation à droite de R 3.On ajoute la ligne [0 0 1] sous R v 2 = v 1 + t v 2 = T v 1

29 donc Question: Est-ce rot-transl ou transl-rot? Réponse: Trouvez vous-même!

30 A retenir: Les vecteurs en représentation homogène contiennent un élément de plus que le nombre de dimensions géometriques. Les matrices en représentation homogène contiennent une ligne et une colonne de plus que le nombre de dimensions géometriques. Remember: Vectors in homogenous form have one element more than the number of geometric coordinates: The scale factor (in our case always 1) Homogenous matrices thus have one line and one column more than the number of coordinates. Last line: 0 0 1, last column [ t, 1]

31 Exemple: Enchainement de deux transformations Sans représentation homogène: v 2 = R( ) v 1 + t 1 v 3 = R( ) v 2 + t 2 =R( ) R( ) v 1 + R( ) t 1 + t 2 avec représentation homogène: (ex.2)

32 Solution ex. 2

33 Ex 3a: Rotation pure? Translation pure? Identité? 3b) Translation puis rotation 3c) Inverse?? (Faites le contrôle!)

34 Solutions 3b) Translation puis rotation 3c) Rotation puis translation -t

35 2.1.4 Rotation 2D autour de points arbitraires: x y O Centre de rotation? P O

36 1. Translation de P vers lorigine x y O P O

37 2. Rotation autour de lorigine x y O O

38 3. Translation vers P dorigine x y O P O (9)

39 Cette expression met en évidence quune rotation autour de P est équivalente à une rotation autour de O suivie dune translation P–RP A linverse, on peut trouver un centre de rotation pour toute combinaison de translation et rotation. This shows that rotation around P is equivalent to rotation around O and a translation p-Rp Conversely a center of rotation can be found for any combination of transl. & rotation

40 Exercice 4 4a) Le paragraphe précédent est-il entièrement correct? 4b) Trouver le centre de rotation 1.) par un dessin, 2.) à l'aide de la formule précédente 3.) en cherchant un vecteur propre de la matrice homogène. 4c) Trouver la matrice homogène qui décrit une rotation de 60° autour d'O 4d) Trouver la matrice homogène qui décrit une translation de un en direction x, puis une rotation de 60° autour d'O 4e) Trouver la matrice homogène qui décrit une rotation de 60° autour de [1,1] T. 4.f) Un objet avec deux points v 1, w 1 est déplacé de sorte que ces points se retrouvent aux locations v 2, w 2. v 1 = [1,0] T, w 1 = [1,1] T, v 2 = 0.5 [1–3,1–3] T, w 2 = 0.5 [2–3,1] T Trouver la matrice homogène,, p (solution graphique) qui décrit ce déplacement.


Télécharger ppt "Bases théoriques: modélisation et contrôle 2.1 Cinématique/CinematicsBleuler 2.2 Jacobien/JacobianBouri 2.3 dynamique/DynamicsBouri 2.4 Contrôle/ControlBouri."

Présentations similaires


Annonces Google