Académique Documents
Professionnel Documents
Culture Documents
Notes de cours
Robotique
A.U 2023 - 2024
Sami Bennour
PRÉSENTATION GÉNERALE DU COURS
❑Mots Clés :
Robotique, MGD, MCD, Commande, Singularité, Dynamique
❑Prérequis :
• Savoir manipuler les matrices et les vecteurs
• Connaissance en cinématique et dynamique des mécanismes
❑Contenu du cours
• Chapitre 1 : Introduction Générale
• Chapitre 2 : Modélisation Géométrique des robots
• Chapitre 3 : Modèle Cinématique des manipulateurs
• Chapitre 4 : Analyse des efforts
• Chapitre 5 : Introduction à la commande des robots
• P. Borrel, Proc. IEEE Int. Conf. on Rob. And Aut. pp. 1180-1185, 1986.
• Ph. Wenger, IEEE Robotics and Automation, pages 442-447, 1992
• Ph. Wenger, D. Chablat, Syroco 1997, Nantes.
• F. Pierrot, Thèse de doctorat, Montpellier, France, 1991.
• J. Angeles, Fundamentals of Robotic Mechanical Systems, Springer, 1997.
• J-P. Merlet, Les robots parallèles, 2eme édition, HERMES, Paris, 1997.
• D. Chablat, Thèse de doctorat, Nantes, France, 1998.
• C. Innocenti, V. Parenti-Castelli, Robotics, Spatial Mechanisms and Mechanical Systems, ASME 1992.
• J. El Omri, Thèse de doctorat, Nantes, France, 1996.
• Ph. Wenger, ICAR’93, pages 649-654, Tokyo, Japon, 1993.
• R. Clavel, In 18th Int. Symp. on Industrial Robot, pages 91-100, Lausanne, 26-28 Avril 1988.
• F. Pierrot, P. Dauchez, et A. Fournier, In IEEE Int. Conf. on Robotics and Automation, pages 1288-1293, Sacramento,
11-14 Avril 1991.
• C. Gosselin, Thèse de doctorat, McGill, 1988.
• C. Gosselin, J. Angeles, IEEE Trans. on Robotics and Automation, Vol. 6, pages 281-290, 1990.
• C. Gosselin, J. Sefrioui, M. J. Richard, Tech. Mach. Theory, Vol. 27, No. 2, pages 107-119, 1992.
❑ DEFINITION
Le mot robot vient du Tchèque et se traduit par le mot « esclave ». Le robot est un
dispositif mécanique articulé, mû par des actionneurs et commandé par un calculateur,
capable d’imiter certaines fonctions humaines (taches) telles que la manipulation d’objets
ou la locomotion, avec des mouvements variables et programmables.
Le domaine de la robotique est né après la deuxième guerre mondiale mais son essor
n’est parvenu qu’après les années 60.
Consignes
PC PO
Informations
❑ LE ROBOT ET LA ROBOTIQUE
◆Dispositif mécanique articulé capable d’imiter certaines fonctions humaines telles que la
manipulation d’objets ou la locomotion, dans le but de se substituer à l’homme pour la
réalisation de certaines tâches matérielles.
❑ LE ROBOT ET LA ROBOTIQUE
La robotique est l’ensemble des activités
de construction et de mise en oeuvre des robots.
On qualifie quelquefois de « système robotisé »
tout dispositif « automatisé ». Ce dispositif comporte :
Une partie « opérationnelle » ou « opérative » qui réalise la tâche &
une partie « décisionnelle » ou « commande » qui contrôle la partie opérative
Puissance
SMA
Ef f ect eur
Calculat eur
(b)
(b)
Energie
Robots industriels Energie
(b)
H Commande Actionneurs Outil Tâche
H Commande Energie Actionneurs Outil Tâche
Capteurs
Internes
H CommandeCapteurs Actionneurs Outil Tâche
Internes
Capteurs (c)
capteurs internes ou capteurs dits
Internes
(c) « proprioceptifs
(c)
Sami Bennour Cours Robotique - A.UEnergie
2023 - 2024 8
Relation Homme - tâche
Capteurs
Internes
Energie
Capteurs
Robots « intelligents » Internes
Traitement
- Reconnaissance Capteurs
- Stratégie Externes
- I.A.
(d)
Perception de l’environnement » au moyen
de capteurs externes ou capteurs dits « extéroceptifs ».
Autres capteurs
Mode de
fonctionnement:
Le robot génère son
plan d’action
Manutention de pièces
transfert de pièces chargement de machines
Soudage - continu
Assemblage
Schéma ce contrôle
avec retour d’efforts
Découpe produit
agro-alimentaire
Palettisation
Manipulation de moules
Y
X
X X
Y
Y
Rectilinear DELTA Scara
Each element moves only 6 Axis - Rotation ZY moves only in one direction
Printer head can move in
in one direction A rotating circular print bed
any direction quickly
Each 3D printer uses its own kinematics that controls the movement of the mechanical parts: print beds and extruders
22
Y
X
Rectilinear
Each element moves only
in one direction
23
Z
XZ-Head, XY-
Head
| Platform : Y Axis
| Gantry : Z axis
| Hotend : X axis
Y
X
Rectilinear
Each element moves only
in one direction
24
Z
Crossed gantary
| Platform : Y Axis
| Gantry : Z axis
| Hotend : X axis
Y
X
Rectilinear
Each element moves only
in one direction
CORE XY - Crossed linear rail gantry design
Type 1
| Plate : Y Axis
25
| Gantry : Z axis
| Hotend : X axis
Y
X
Rectilinear
Each element moves only
in one direction CORE XY - Cross Belt design
26
Y
X
Rectilinear
Each element moves only
in one direction Belt 3D printers exhibit an "infinite" Z-axis in the form of a conveyor belt
27
X
Y
DELTA
Printer head can move in any
direction quickly DELTA design has an extruder that is mounted to three points connected to a print bed that doesn’t move.
Scara
6 Axis - Rotation
POLAR / 3d printer
30
Autres applications
Divertissement
Milieu hostile
– Militaire
– Nucléaire
– Exploration spatiale
– Exploration sous-marine
– Déminage
Médicales
Domestiques
Outils
Préhenseurs
Disciplines concernées
➢ Mécanique
➢ Électronique
➢ Automatique
➢ Informatique
➢ Sciences cognitives
Mais aussi…
➢ Philosophie et psychologie
➢ Cybernétique et mécatronique
➢ D’autres spécialités liées à l’application
• Architecture mécanique;
• Actionnement : pneumatique, électrique, hydraulique;
• Capteurs : position, effort, vision, tactile, accélération, …;
• Commande.
Valeurs typiques :
- Charge maximale
- Volume de travail
- Vitesse de travail
- Précision
- Répétabilité
Robot = SMA
• Ensemble de solides Si reliés entre eux par des liaisons.
• d.d.l : Nombre de mouvements indépendants possibles
entre solides.
• Dans le SMA certaines liaisons (articulations) seront
motorisées, on parlera alors de liaisons actives. Les
liaisons non motorisées seront appelées liaisons
passives.
génératrice tachymétrique*
qi
Codeur incrémental
Transmissions et réducteur
Schéma d’actionneur
Réducteurs Transmissions
Joint d’Oldham
Caractéristiques
- L'étendue de la mesure
- La sensibilité
- La rapidité
- La précision
Encodeur Optique
Potentiomètre
Télémètre Ultrason
Caméra vidéo
Télémètre IR
Capteur mécanique
Capteur
Capteur à jauges inductif
Schéma
d’asservissement
d’un axe de robot
Vi Axe Y (mm)
70.00
Vi
30.00
vdi vdi
vfi vfi PAUME
-10.00
-80.00 -40.00 0.00 40.00 80.00 120.00 160.00
di Ti-fi Ti t T/2 Ti t Axe X (mm)
Bus CAN
Consignes articulaires
Système maître-esclave
Télémanipulateur
qi
Syntaxeur qi
Boite à
boutons MEMOIRE
(2)
(1')
Unité de
CALCUL
Console
CAO
Apprentissage maître-esclave
Syntaxeur qi
Boite à
boutons MEMOIRE
(2)
(1')
Unité de
CALCUL
Console
CAO
restitution
Apprentissage
KCP
Langage Robot
Liaison
Firewire
Armoire KRC2
Le robot KUKA
Boitier de pilotage
Barrières de protection des 3 projecteurs lumineux
Changement
de fenêtre
FOR I=1 TO 6
$VEL_AXIS[I]=100
$ACC_AXIS[I]=100
ENDFOR
ey
Translation axe z
ax
tion
sla
T ran
Or
ien
tati
on
sui
van
tx
Transl
ation a
xe x
Programme de supervision
en Visual C++
Un environnement de
programmation et simulation
dédié spécifique au constructeur :
• KukaSim (Kuka);
• RobotStudio (ABB);
• Act/Weld…
De nombreux fabricants :
Kuka, Motoman, Fanuc,
Panasonic, Nacchi, ABB,
Staubli, Hitachi, …
http://www.robots.com/
Honda P3
1.60m 130kg
ASIMO
1.20m 54kg
Sony QRIO
58cm 7kg
Sony AIBO
DLR-Hit Hand
Sojourner Robot
Lg. 47 cm
Ht. 23 cm
La préhension
La dynamique des systèmes multicorps
Robotique humanoïde
La synthèse de mécanismes
La robotique mobile
y f g3
z x Théorie de la préhension
O bje ct f g2
fra me ◆ Etude de la stabilité
y
x
f g1 ◆ Synthèse de prise avec repositionnement
z External
force
Contrainte
tracteur-obstacle
Contrainte
remorque-obstacle
Simulation
Le logiciel SMAR Modélisation
Animation de
Robots
◆ Planification de trajectoires
pour les robots sériels
➢ Trouver une trajectoire amenant
le robot à la position but
Avancer vers
➢ Eviter les collisions le but
Contournement
d’obstacle
Composition en modules
◦ Modeleur
◦ Modélisation par maillons et
liaisons
◦ Utilisation de primitives en 3D
◦ Simulateur
◦ Détection de collisions
◦ Placement optimal
◦ Planification de trajectoires
◦ Aide à la conception
❑ DEFINITIONS
Avant de définir les caractéristiques à évaluer pour les manipulateurs, quelques définitions
sont nécessaires telle que la pose et les référentiels :
• Pose : c’est la configuration de l’organe terminal définie en position par les trois
coordonnées x, y et z et en orientation par les trois angles α, β et γ dans le volume de
travail.
Deux types de pose sont définis :
• Pose désirée: La configuration recherchée et imposée par un programme prédéfini par
l’utilisateur.
• Pose atteinte : La pose réalisée par le robot en réponse à une pose commandée ou
programmée.
Parmi les caractéristiques qui permettent d’évaluer les performances des robots, on trouve:
• Les caractéristiques générales
• Les caractéristiques de pose
• Les caractéristiques de trajectoire
• La complaisance statique
1. Caractéristiques Générales:
Les caractéristiques générales d’un robot sont la charge maximale transportée, le
volume de travail, la cinématique, le temps de déplacement et la résolution.
• La cinématique : ce sont les vitesses et les accélérations du robot. Trois types
de cinématiques sont définis ; par axe individuel, par résolution et de
trajectoire.
• Vitesse et accélération: par articulation individuelle ou de trajectoire.
• Temps de déplacement minimal: Il caractérise le temps s’écoulant entre deux
états stationnaires d’un robot, le temps de stabilisation étant inclus.
• Résolution: La résolution correspond au plus petit incrément de
mouvement qui peut être effectué par chaque axe ou articulation du robot.
Elle est en général spécifiée en millimètres ou en degrés.
1. Caractéristiques Générales:
1. Caractéristiques Générales:
Espace de travail
1. Caractéristiques Générales:
Espace de travail
2. Caractéristique de pose:
• Exactitude de pose locale
: Elle exprime l’écart entre
la pose commandée et la
pose atteinte en distance
et en orientation.
Exactitude de la pose
2. Caractéristique de pose:
• Exactitude de pose multidirectionnelle : Elle est caractérisée par la distance maximale
entre les barycentres des nuages de points correspondant aux différentes trajectoires et
par l’écart maximal entre les angles moyens correspondant aux différentes trajectoires.
2. Caractéristique de pose:
• Temps de stabilité : C’est la durée
nécessaire pour qu’une réponse de
l’OT décroisse à l’intérieure d’une
limite d’amplitude donnée après que
le système de commande indique que
la pose désirée est atteinte.
• Dépassement : C’est l’écart maximal
entre la pose commandée et la pose
atteinte par l’OT dans la phase
d’approche. Cet écart est pris en
compte à partir du moment où le
système de commande indique que la Stabilité et dépassement en position
pose est atteinte.
3. Caractéristique de trajectoire:
• Exactitude de trajectoire : Elle
caractérise l’aptitude d’un
robot à faire suivre son OT
une trajectoire identique à
celle commandée. Elle
s’exprime par la distance
entre la trajectoire désirée et
la ligne des barycentres des
trajectoires effectivement par
courue.
Exactitude de trajectoire
3. Caractéristique de trajectoire:
• Erreur de raccordement : Elle
caractérise les trajectoires
perpendiculaires et représente
l’écart entre une trajectoire
parcourue et celle désirée de
forme carré. Elle est définie par le
dépassement et l’arrondissement.
Erreur de raccordement
Robots mobiles
◦ Bipèdes, à pattes (tripodes,
hexapodes,…)
Robots Humanoïdes;
Microrobots;
Préhenseurs, Mains robotiques;
Robots parallèles Les enjeux :
- Locomotion, dextérité
Robots manipulateurs - Perception de l’environnement
- Autonomie, « intelligence »
- Interface avec l’homme
-…
Structure d’un
robot parallèle
▪ Translateurs
▪ Spatiaux
❑ PORTEUR CARTÉSIEN
Structure cartésienne (portique) ± 21 % du marché
soit:
◦ petit et très précis,
◦ très coûteux, à mi-chemin entre robot et pont-roulant pour
des charges pouvant aller jusqu'à 200k
V = L3
❑ PORTEUR CYLINDRIQUE
V = 9 L3
Type Cylindrique : RPP
❑ PORTEUR SCARA
V = 9 L3
❑ PORTEUR SPHÉRIQUE
± en voie de disparition
V = 28 L3
± 67 % du marché
V = 32 L3
❑ SYSTÈMES DE COORDONNÉES
Système de coordonnées
de l’atelier (X1, Y1, Z1)
Système de coordonnées
de la base (X2, Y2, Z2)
Système de coordonnées
de l’interface mécanique
(X3, Y3, Z3)
Système de coordonnées
de l’outil (X4, Y4, Z4)
Système de coordonnées
de l’instrumentation de
mesure (X5, Y5, Z5)
❑ INTRODUCTION
Ainsi l’expression d’un vecteur 𝑉𝑗 , exprimé dans 𝑅𝑗 , dans le repère 𝑅𝑖 est donnée par
: 𝑉 = 𝑖𝐴 ∙ 𝑉
𝑗 𝑗 𝑖
La matrice 𝑖𝐴𝑗 est une matrice orthogonale. Ainsi la relation suivante est vérifiée :
−1 𝑇
𝑖 𝑗 𝑗
𝐴𝑗 = 𝐴𝑖 = 𝐴𝑖
𝑖
𝑖
𝑇𝑗 = 𝐴𝑗 𝑝Ԧ𝑖𝑗 une matrice 4x4 qui représente la matrice de passage homogène de 𝑅 à 𝑅 .
𝑖 𝑗
0 1
𝑗
On peut démontrer que la matrice inverse de la matrice 𝑖 𝑇𝑗 , notée 𝑇𝑖 , est donnée par :
𝑗 𝑗
𝑗
𝑇𝑖 = 𝐴𝑖 − 𝐴𝑖 ∙ 𝑝Ԧ𝑖𝑗
0 1
0 0 0 𝑎
i 0 0 0 𝑏
• Cas de translation simple : 𝑇j =
0 0 0 𝑐
0 0 0 1
Puisque chaque transformation se fait par rapport aux axes fixes, on utilisera la prémultiplication pour
trouver la transformation résultante :
𝐶
𝒖
𝑃 ∅ 𝐶
𝜶 𝑃∗ 𝑎
𝑧Ԧ0
𝑽 ∅ 𝑎
𝑽∗ 𝒃𝟐 𝒃𝟏
∆𝑽
𝑦Ԧ0 𝑃
𝑂
𝑃∗
𝑥Ԧ0
𝑽∗ = 𝑅𝑜𝑡 𝒖, ∅ ∙ 𝑽
Avec :
0 −𝒖3 𝒖2
𝑻
𝑼 = 𝒖3 0 −𝒖1 𝒖 = 𝒖1 𝒖2 𝒖3
−𝒖2 𝒖1 0
Soit le vecteur 𝑽∗ obtenu après rotation du vecteur 𝑽, d’un angle ∅ autour du vecteur
unitaire 𝒖.
Nous pouvons écrire : 𝑽∗ = ∆𝑽 + 𝑽
∆𝑽 = 𝒃1 + 𝒃2
𝒖⋀𝑽
𝒃1 = a ∙ sin ∅ = sin ∅ ∙ 𝒖⋀𝑽
𝒖⋀𝑽
Cette dernière formule est appelée formule de Rodrigues, elle s’exprime sous forme matricielle
par :
𝑽∗ = 𝑰3 ∙ 𝑽 + sin ∅ ∙ 𝑼 ∙ 𝑽 + 1 − cos ∅ ∙ 𝑼2 ∙ 𝑽
−𝑢32 − 𝑢22 𝑢1 𝑢2 𝑢1 𝑢3
𝑡𝑟 𝑢1 𝑢2 −𝑢32 − 𝑢12 −𝑢1 = −2 𝑢12 + 𝑢22 + 𝑢32 = −2
𝑢1 𝑢3 𝑢2 𝑢3 −𝑢22 − 𝑢12
Ce qui signifie que : 𝑡𝑟 𝐀 = 3 − 2 ∙ 1 − cos ∅ = 1 + 2 ∙ cos ∅
Et par la suite :
𝑡𝑟 𝐀 − 1
∅ = ∓cos −1
2
𝑲
On en déduit que : 𝒖=
𝑲
(La division par 𝑲 est considérée parce que 𝒖 est unitaire). Chercher 𝒖 , revient à chercher
𝑲 qui satisfait la condition ci-haut. Reste le problème de signe car nous avons :
𝑅𝑜𝑡 𝒖, ∅ = 𝑅𝑜𝑡 −𝒖, −∅ et 𝑅𝑜𝑡 𝒖, −∅ = 𝑅𝑜𝑡 −𝒖, ∅
D’où le vecteur 𝒖 et l’angle ∅ sont définis seulement à un signe près.
1 1 −1
𝐀𝒔𝒚𝒎 = 𝐀 + 𝐀𝑻 = 𝐀−1 + 𝐀𝑻
2 2
𝑢1 𝑎32 − 𝑎23
1
Nous pouvons ainsi déduire par identification que: sin ∅ ∙ 𝑢2 = ∙ 𝑎13 − 𝑎31
𝑢3 2 𝑎 −𝑎
21 12
1 2 2 2
Et que la norme: sin ∅ ∙ 𝒖 = ∙ 𝑎32 − 𝑎23 + 𝑎13 − 𝑎31 + 𝑎21 − 𝑎12
2
3
𝑢1 −
5
𝟏 𝜋
On aura 𝑢
sin ∅ ∙ 2 = ∙ − 4 ֜ sin ∅ = 1 ֜ ∅ = ±
𝟐 2
𝑢3 5
0
Puisque cos ∅ est dans ce cas nul, nous fixons un choix pour ∅ et nous déterminons le vecteur 𝒖
𝜋
correspondant. Par exemple si nous choisissons ∅ = − ֜ sin ∅ = −1 , alors le vecteur 𝒖
2
3
5
correspondant sera : 𝒖 = 4
5
0
𝒊−𝟏
𝑻𝒊 = 𝑹𝒐𝒕 𝒛𝒊−𝟏 , 𝜽𝒊 × 𝑻𝒓𝒂𝒏𝒔 𝒛𝒊−𝟏 , 𝒅𝒊 × 𝑻𝒓𝒂𝒏𝒔 𝒙𝒊 , 𝒂𝒊 × 𝑹𝒐𝒕 𝒙𝒊 , 𝜶𝒊
𝟎
𝐓𝐧 représente la position et l’orientation de l’organe terminal
𝟎
𝐓𝐧 = 𝐧 𝐨 𝐚 𝐩
𝟎 𝟎 𝟎 𝟏
Avec :
• 𝒑 le vecteur position de l’organe terminal
• 𝒏 le vecteur représentant la direction normale à l’OT
• 𝒐 le vecteur représentant la direction de glissement de l’OT
• 𝒂 le vecteur représentant la direction d’approche de l’OT
Définition du problème
On donne : les variables articulaires et la géométrie du robot.
Trouver : la position et l’orientation de l’organe terminal.
Méthode de solution
Puisque toutes les 𝑖−1𝑇𝑖 sont données la position de l’organe terminal est donnée par
l’équation.
𝑥Ԧ1 𝑧Ԧ1
𝑎2 𝑧Ԧ2
𝑂1 Tableau des paramètres de D-H:
𝑥Ԧ2 𝜃𝑖 𝑑𝑖 𝑎𝑖 𝛼𝑖
𝑎1 𝑂2 𝑎3
𝑥Ԧ0 𝑑1 𝑧Ԧ3
1 0 𝑑1∗ 𝑎1 0
𝑧Ԧ0 2 θ2∗ 0 𝑎2 0
3 θ3∗ 0 𝑎3 0
𝑂0 𝑂3
𝑥Ԧ3 0 0 1 2
𝑇3 = 𝑇1 ∙ 𝑇2 ∙ 𝑇3
Figure 16: Robot sériel PRR
𝑎1 + 𝑎2 𝑐𝑜𝑠 𝜃2 + 𝑎3 𝑐𝑜𝑠 𝜃2 + 𝜃3
𝑎2 𝑠𝑖𝑛 𝜃2 + 𝑎3 𝑠𝑖𝑛 𝜃2 + 𝜃3
𝑂0 𝑂3 𝑑1
=
𝛾Ԧ3 0
0
𝜃2 + 𝜃3
𝑂0
0 0 1 2
𝑇3 = 𝑇1 ∙ 𝑇2 ∙ 𝑇3
Figure 17: Robot sériel RRR ou 3R
Ayant écrit le modèle géométrique direct (MGD) d’un manipulateur on obtient une
relation de la forme :
𝑿=𝒇 𝒒
𝒒 = 𝒇−1 𝑿
𝑛𝑥 𝑜𝑥 𝑎𝑥 𝑝𝑥
𝑛 𝑜𝑦 𝑎𝑦 𝑝𝑦
𝐀𝟎 = 𝑦
𝑛𝑧 𝑜𝑧 𝑎𝑧 𝑝𝑧
0 0 0 1
Le problème du MGI est de trouver les variables articulaires en fonction des variables
opérationnelles à partir de la relation : 𝐀 𝟎 = 𝟎𝐓𝐧
Paul (1981) a proposé de prémultiplier successivement les 2 membres de l’équation
précédente par 𝐢𝐓𝐢−𝟏 pour « i » variant de 1 à n-1.
𝟏
𝐓𝟎 × 𝐀 𝟎 = 𝐀 𝟏 = 𝟏𝐓𝟎 × 𝟎𝐓𝟏 × 𝟏𝐓𝟐 × 𝟐𝐓𝟑 × ⋯ × 𝐢−𝟏𝐓𝐢 × ⋯ × 𝐧−𝟏𝐓𝐧
On obtient :
𝐀 𝟏 = 𝟏𝐓𝟐 × 𝟐𝐓𝟑 × ⋯ × 𝐢−𝟏𝐓𝐢 × ⋯ × 𝐧−𝟏𝐓𝐧
Le membre à gauche est fonction de 𝑞1 seulement alors que celui de droite est fonction
de 𝑞2 , 𝑞3 , … , 𝑞𝑛 .
𝑞1 est obtenu par identification entre les éléments des deux matrices.
2ème étape : On multiplie de part et d’autre la relation obtenue dans la première étape
par 𝟐𝐓𝟏 , on obtient : 𝟐𝐓𝟏 × 𝐀 𝟏 = 𝐀 𝟐 = 𝟐𝐓𝟑 × ⋯ × 𝐢−𝟏𝐓𝐢 × ⋯ × 𝐧−𝟏𝐓𝐧
Nous aurons 𝑞2 = 𝑓 𝑞3 , … , 𝑞𝑛 .
𝟎
En multipliant de part et d’autre par 𝐑 𝟑 on obtient :
3
𝐑 0 × 𝐑 = 𝐑 3 = 3𝐑 4 × 4𝐑 5 × 5 𝐑 6
𝟒
𝐑 𝟑 × 𝐑 𝟑 = 𝐑 𝟒 = 𝟒𝐑 𝟓 × 𝟓𝐑 𝟔 ֜ 𝑞4
𝟓
𝐑 𝟒 × 𝐑 𝟒 = 𝐑 𝟓 = 𝟓𝐑 𝟔 ֜ 𝑞5 et 𝑞6
𝜃𝑖 𝑑𝑖 𝑎𝑖 𝛼𝑖
𝜋
1 𝑞1 0 a 2
2 𝑞2 + 𝜋2 0 b 0
𝜋
3 𝑞3 0 c 2
4 𝑞4 d 0 −𝜋2
𝜋
5 𝑞5 0 0 2
6 𝑞6 0 0 0
𝑐1 0 𝑠1 𝑎 ∙ 𝑐1 −𝑠2 −𝑐2 0 −𝑏 ∙ 𝑠2 𝑐3 0 𝑠3 𝑐 ∙ 𝑐3
𝟎 𝑠 0 −𝑐1 𝑎 ∙ 𝑠1 𝟏 𝑐2 −𝑠2 0 𝑏 ∙ 𝑐2 𝟐 𝑠 0 −𝑐3 𝑐 ∙ 𝑠3
𝐓𝟏 = 1 ; 𝐓𝟐 = ; 𝐓𝟑 = 3
0 1 0 0 0 0 1 0 0 1 0 0
0 0 0 1 0 0 0 1 0 0 0 1
𝑐4 0 −𝑠1 0 𝑐5 0 −𝑠5 0 𝑐6 −𝑠6 0 0
𝟑 𝑠 0 𝑐1 0 𝟒 𝑠 0 𝑐5 0 𝟓 𝑠 𝑐6 0 0
𝐓𝟒 = 4 ; 𝐓𝟓 = 5 ; 𝐓𝟔 = 6
0 −1 0 d 0 −1 0 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1
𝑛𝑥 𝑜𝑥 𝑎𝑥 𝑝𝑥
𝑛 𝑜𝑦 𝑎𝑦 𝑝𝑦
𝐀𝟎 = 𝑦
𝑛𝑧 𝑜𝑧 𝑎𝑧 𝑝𝑧
0 0 0 1
Plus explicitement le MGD s’écrit :
𝑛𝑥 = 𝑐1 𝑠6 𝑠4 𝑠23 − 𝑐6 𝑠5 𝑐23 + 𝑐5 𝑐4 𝑠23 + 𝑠1 𝑠6 𝑐4 + 𝑐6 𝑐5 𝑠4
𝑛𝑦 = 𝑠1 𝑠6 𝑠4 𝑠23 − 𝑐6 𝑠5 𝑐23 + 𝑐5 𝑐4 𝑠23 + 𝑐1 𝑠6 𝑐4 + 𝑐6 𝑐5 𝑠4
𝑛𝑧 = 𝑐6 𝑐5 𝑐4 𝑐23 − 𝑠5 𝑠23 − 𝑠6 𝑠4 𝑐23
𝑥 𝑃𝑥 0
𝑦 𝑃 0
Calcul du MGI : Nous avons 𝐗 = = 𝑦 = 𝟎𝐓𝟏 × 𝟏𝐓𝟐 × 𝟐𝐓𝟑 ×
𝑧 𝑃𝑧 0
1 1 1
0
0
• Etape 1 : Calcul de 𝑞1 ➔ 𝟏
𝐓𝟎 × 𝐗 = 𝐗 𝟏 = 𝟏𝐓𝟐 × 𝟐𝐓𝟑 ×
0
1
𝑐1 𝑠1 0 −𝑎 𝑥 𝑥𝑐1 + 𝑦𝑠1 − 𝑎 −𝑏𝑠2 − 𝑐𝑐2 𝑠3 + 𝑐𝑠2 𝑐3
0 0 1 0 𝑦 𝑧 𝑏𝑐2 − 𝑐𝑐2 𝑐3 − 𝑐𝑠2 𝑠3
= =
𝑠1 −𝑐1 0 0 𝑧 𝑥𝑠1 − 𝑦𝑐1 0
0 0 0 1 1 1 1
• Etape 2 : Calcul de 𝑞2 et 𝑞3
0
𝟐 0
𝐓𝟏 × 𝐗 𝟏 = 𝟐𝐓𝟑 ×
0
1
−𝑠2 𝑐2 0 −𝑏 𝑥1 −𝑥1 𝑠2 + 𝑦1 𝑐2 − 𝑏 𝑐𝑐3
−𝑐2 −𝑠2 0 0 𝑦1 −𝑥1 𝑐2 − 𝑦1 𝑠2 𝑐𝑠3
= =
0 0 1 0 𝑧1 𝑧1 0
0 0 0 1 1 1 1
2 2 2
−𝑐 2 + 𝑥12 + 𝑦12 + 𝑏 2
𝑐 = −𝑥1 𝑠2 + 𝑦1 𝑐2 − 𝑏 + 𝑥1 𝑐2 + 𝑦1 𝑠2 ֜𝑦1 𝑐2 − 𝑥1 𝑠2 = =𝜆
2𝑏
𝑦1 𝑦1
Posons : cos 𝛼 = et sin 𝛼 =
𝑥12 +𝑦12 𝑥12 +𝑦12
𝜆 𝜆
On obtient : cos 𝛼 𝑐2 − sin 𝛼 𝑠2 = ֜ 𝑐 𝑞2 + 𝛼 =
𝑥12 +𝑦12 𝑥12 +𝑦12
𝜆 𝜆
Si −1 ≤ ≤ 1 alors 𝑞2 = ± cos−1 −𝛼
𝑥12 +𝑦12 𝑥12 +𝑦12
−𝑥1 𝑠2 +𝑦1 𝑐2 −𝑏
𝑐3 =
𝑐
On revient aux deux équations de départ pour déduire :ቐ −𝑥1 𝑐2 −𝑦1 𝑠2 ֜𝑎𝑡𝑎𝑛2 𝑠3 ; 𝑐3
𝑠3 =
𝑐