UFR des Sciences, Département EEA M1 EEAII Parcours ViRob Fabio MORBIDI E-mail: [email protected]! http://home.mis.u-picardie.fr/~fabio/Teaching.html Année Universitaire 2014/2015 Plan du cours Chapitre 1 : Généralités 1.1 Définitions 1.2 Constituants d’un robot 1.3 Classification des robots 1.4 Caractéristiques d’un robot 1.5 Les générations de robot 1.6 Programmation des robots 1.7 Utilisation des robots Chapitre 2 : Degrés de liberté - Architecture 2.1 Positionnement • Rotation et représentation de la rotation • Attitude et matrices homogènes 2 Plan du cours 2.2 Cinématique • Vitesse d’un solide • Vecteur vitesse de rotation • Mouvement rigide • Torseur cinématique Chapitre 3 : Modélisation d’un robot 3.1 Modèle géométrique • Convention de Denavit-Hartenberg • Modèle géométrique direct • Modèle géométrique inverse 3.2 Modèle cinématique • Jacobien direct d’un robot • Jacobien inverse d’un robot 3.3 Modèle dynamique • Equation d’Euler-Lagrange 3 Modèle dynamique d’un robot • Le modèle dynamique d’un manipulateur est important pour: • La simulation du mouvement • Analyser la structure d’un robot • Le développement d’algorithmes de contrôle • Il y a deux méthodes pour déterminer les équations du mouvement d’un manipulateur dans l’espace articulaire: 1. La méthode basée sur la formulation de Lagrange • Conceptuellement simple et systématique 2. La méthode basée sur la formulation de Newton-Euler (on trouve la résultante des forces qui s'exercent sur un segment générique du manipulateur) • Elle produit un modèle de façon récursive • Plus avantageuse du point de vue computationnel que la formulation de Lagrange • De manière similaire au cas cinématique, on peut encore définir: ¨ (t)) • Un problème dynamique direct (trouver les accelerations q • Un problème dynamique inverse (trouver les couples articulaires τ (t)) 4 Modèle dynamique: formulation de Lagrange • Le modèle dynamique d’un manipulateur nous permet de décrire la relation entre les couples des actionneurs sur les articulations et le mouvement de la structure. • Avec la formulation de Lagrange les équations de mouvement peuvent être déterminées d’une façon systématique et indépendamment du référentiel que nous avons choisi. • Lorsque les variables qi , i ∈ {1, . . . , n} “coordonnées généralisées” ont été fixées (elle décrivent la position des segments d’un manipulateur à n DDL), le lagrangien L du système peut être défini en fonction des coordonnées généralisées, de la manière suivante: L = T −U Énergie cinétique totale Énergie potentielle totale 5 Modèle dynamique: formulation de Lagrange • Les équations de Lagrange (ou d’Euler-Lagrange) sont exprimées par: où d ∂L ∂L − = ξi , dt ∂ q˙i ∂ qi i ∈ {1, . . . , n} ξi est la force généralisée associée à la coordonnée généralisée qi • Sous une forme compacte, nous pouvons réécrire les équations de Lagrange comme: d dt � ∂L ∂ q˙ �T − � ∂L ∂q �T = ξ où, pour un manipulateur (à chaîne ouverte), les coordonnées généralisées sont réunies dans le vecteur des variables articulaires q • Les contributions aux forces généralisées sont données par les forces non-conservatives dans le système: • Les couples des actionneurs sur les articulations • Les forces de frottement sur les articulations • Les couples sur les articulations générées par les forces de contact de l’effecteur avec l’environnement 6 Modèle dynamique: formulation de Lagrange • Les équations de Lagrange: d ∂L ∂L − = ξi , dt ∂ q˙i ∂ qi i ∈ {1, . . . , n} nous fournissent une relation entre les forces généralisées ξi appliquées au manipulateur, et les positions, vitesses et accelerations des variables articulaires, c’est-à-dire qi , q˙i , q¨i , i ∈ {1, . . . , n} • Ces équations nous permettent de déterminer le modèle dynamique d’un robot à partir de l’énergie cinétique et potentielle du système Joseph-Louis Lagrange (1736-1813) 7 Modèle dynamique: formulation de Lagrange Exemple [Pendule inversé actionné par un moteur électrique] r moteur F θm θ rm � I m , Fm I, F r, rm : longueur de la tige : moment d'inertie du servomoteur autour de l’axe de rotation et son coefficient de frottement visqueux : moment d'inertie de la tige et son coefficient de frottement visqueux : rayon des engrenages côté tige et côté moteur kr = r/rm : braquet θ, θm : position angulaire de l’axe du moteur et de l’axe de la tige (si θ = 0, la tige m, g : masse de la tige et accélération de la pesanteur cm : couple engendrée par le moteur pointe vers le bas) 8 Modèle dynamique: formulation de Lagrange Exemple [Pendule inversé actionné par un moteur électrique] r moteur F θm θ rm Si on choisit θ comme coordonnée généralisée, l’énergie cinétique du système est: T = 1 ˙2 1 I θ + Im kr2 θ˙2 2 2 En outre, l’énergie potentielle du système (définie à une constante près) est: U = m g � (1 − cos θ) 9 Modèle dynamique: formulation de Lagrange Exemple [Pendule inversé actionné par un moteur électrique] Le lagrangien du système est donc: L = T −U = 1 ˙2 1 I θ + Im kr2 θ˙2 − m g � (1 − cos θ) 2 2 Si on utilise cette expression dans l’equation de Lagrange suivante (nous avons une seule coordonnée généralisée, l’angle θ ): d ∂L ∂L − = ξ dt ∂ θ˙ ∂θ on trouve: (I + Im kr2 ) θ¨ + m g � sin θ = ξ La force généralisée ξ est donnée par plusieurs de contributions: la couple d’actionnement au côté tige, et les couples de frottement visqueux −F θ˙ , −Fm kr2 θ˙ (la dernière couple a été reportée au côté tige): ξ = τ − F θ˙ − Fm kr2 θ˙ 10 Modèle dynamique: formulation de Lagrange Exemple [Pendule inversé actionné par un moteur électrique] Conclusion: Nous trouvons ainsi le modèle dynamique complet du système, sous la forme d’une équation différentielle ordinaire du second ordre: (I + Im kr2 ) θ¨ + (F + Fm kr2 ) θ˙ + m g � sin θ = τ On verra la prochaine leçon comment calculer l’énergie cinétique et l’énergie potentielle d’un un manipulateur générique avec n segments rigides, pour trouver son modèle dynamique (les “équations du mouvement’’) avec la formulation de Lagrange. 11
© Copyright 2024