Académique Documents
Professionnel Documents
Culture Documents
Introduction à la Robotique
Bernard BAYLE
Ecole Nationale Supérieure de Physique de Strasbourg
Plan
Plan
Points
Notations
R = (O, x, y, z) repère orthonormé direct cartésien, selon la
convention de Gibbs.
Points
Notations
R = (O, x, y, z) repère orthonormé direct cartésien, selon la
convention de Gibbs.
Points
Notations
R = (O, x, y, z) repère orthonormé direct cartésien, selon la
convention de Gibbs.
Points
Notations
R = (O, x, y, z) repère orthonormé direct cartésien, selon la
convention de Gibbs.
Solides
Solides
Hypothèse
Les solides considérés seront tous indéformables.
Solides
Hypothèse
Les solides considérés seront tous indéformables.
Mouvement rigide d’un solide : mouvement de chacun de
ses points
Solides
Hypothèse
Les solides considérés seront tous indéformables.
Mouvement rigide d’un solide : mouvement de chacun de
ses points
Situation d’un solide : position et orientation dans R d’un
repère lié à ce solide
Transformations rigides
Transformations rigides
Transformations rigides
Transformations rigides
Matrices de rotation
Notations
R0 = (O, x 0 , y 0 , z 0 ) orthonormé direct
x 0 , y 0 , z 0 : coordonnées de x 0 , y 0 et z 0 dans R :
0 0 1
x 0 .x
0 1 0 0 1
y .x z .x
0 0 0
x = @x .y A , y = @y .y A et z = @z 0 .y A .
0 0
x 0 .z y 0 .z z 0 .z
Matrices de rotation
Notations
R0 = (O, x 0 , y 0 , z 0 ) orthonormé direct
x 0 , y 0 , z 0 : coordonnées de x 0 , y 0 et z 0 dans R :
0 0 1
x 0 .x
0 1 0 0 1
y .x z .x
0 0 0
x = @x .y A , y = @y .y A et z = @z 0 .y A .
0 0
x 0 .z y 0 .z z 0 .z
Définition
R = (x 0 y 0 z 0 ) de dimension 3 × 3 est appelée matrice de
rotation du repère R vers le repère R0 .
. . . ou encore matrice de passage ou matrice de changement de base.
Matrices de rotation
Intérêts :
Matrices de rotation
Intérêts :
rend compte du changement de base des coordonnées
d’un point
z0 z
y0
O
y
x
M x0
Matrices de rotation
Intérêts :
rend compte du changement de base des coordonnées
d’un point
rend compte de la rotation d’un repère lié à un solide de R
en R0
z0 z
y0
O
y
x x0
M
mz0
mz0
Conséquence
Formule de changement de base (rotation) : m = Rm0
Bernard BAYLE Introduction à la Robotique
Représentation des transformations rigides Notations et définitions
Description des bras manipulateurs Rotations
Modélisation des bras manipulateurs Transformations rigides
y0 Première analyse
O
y
x
Changement de repère des
M x0
coordonnées du point
z0 z
Seconde analyse
y0
O
Rotation d’un solide S autour de O,
y
de matrice R
x x0
M . . . alors m0 = coordonnées initiales de M dans R
et m =coordonnées finales dans R.
Exemple
y
x0
y0
θ
O z = z0 x
√
M de coordonnées initiales ( 3 0 1)T .
Coordonnées du point transformé par une rotation
R(z, θ) ?
Solution
√ √
cos θ − sin θ 0 3 √3 cos θ
m = sin θ cos θ 0 0 = 3 sin θ .
0 0 1 1 1
Application numérique : à titre d’exemple, pour θ = π3 , on trouve
√
3 3
m=( 2 2 1)T .
Remarque
Coordonnées d’un vecteur = différence des coordonnées de
deux points de R3 .
On peut appliquer la rotation à un vecteur de coordonnées
v = m − n dans R :
soit, en posant v 0 = m0 − n0 :
v = Rv 0 .
Notation
Les matrices identités, quel que soit leur ordre sont notées I.
Notation
Les matrices identités, quel que soit leur ordre sont notées I.
Orthogonalité : R T R = I et det R = 1.
Notation
Les matrices identités, quel que soit leur ordre sont notées I.
Orthogonalité : R T R = I et det R = 1.
Elément neutre : matrice identité d’ordre 3.
Notation
Les matrices identités, quel que soit leur ordre sont notées I.
Orthogonalité : R T R = I et det R = 1.
Elément neutre : matrice identité d’ordre 3.
Inverse unique : R −1 = R T .
Notation
Les matrices identités, quel que soit leur ordre sont notées I.
Orthogonalité : R T R = I et det R = 1.
Elément neutre : matrice identité d’ordre 3.
Inverse unique : R −1 = R T .
Combinaison de deux rotations successives R1 et R2 :
rotation R1 R2 .
Combinaison de rotations
Notations
Soient R0 et R00 les repères résultant des deux rotations
successives R1 et R2 du repère fixe R.
Non-commutativité de la rotation
R1 R2 6= R2 R1 .
Deux cas se présentent pour combiner deux rotations :
Combinaison de rotations
Notations
Soient R0 et R00 les repères résultant des deux rotations
successives R1 et R2 du repère fixe R.
Non-commutativité de la rotation
R1 R2 6= R2 R1 .
Deux cas se présentent pour combiner deux rotations :
seconde rotation par rapport au repère résultant de la
première rotation : (R00 résulte de la rotation de R0 autour
d’un axe lié à R0 )
Combinaison de rotations
Notations
Soient R0 et R00 les repères résultant des deux rotations
successives R1 et R2 du repère fixe R.
Non-commutativité de la rotation
R1 R2 6= R2 R1 .
Deux cas se présentent pour combiner deux rotations :
seconde rotation par rapport au repère résultant de la
première rotation : (R00 résulte de la rotation de R0 autour
d’un axe lié à R0 )
seconde par rapport au même repère, fixe (R00 résulte de
la rotation de R0 autour d’un axe lié à R)
Notations
M de coordonnées respectives m, m0 , m00 dans R, R0 et R00
m = R1 R2 m00 .
Notations
M de coordonnées respectives m, m0 , m00 dans R, R0 et R00
Exemple
z z0
π
M y0
x 00
O
x0
x
π
4
z 00
√
m00 = ( 2 0 0)T dans R00 : coordonnées de M dans R ?
Solution
√
2
√ √
−√ 22 0 −1 0 0 2 −1
√22
m= 2 0 1 0 0 = −1 .
2 2 0
0 0 1 0 0 −1 0 0
Rotations successives
Problème de rotations successives d’un point : la
transformation d’un point de coordonnées initiales m00 dans R
donne un point intermédiaire, qui, transformé par la seconde
rotation donne un point de coordonnées m dans R par R2 .
Notations
M de coordonnées respectives m, m0 , m00 dans R, R0 et R00
Exemple
z z0
M
O x 00
y
x0
x
π
4
00
z
√
m00 = ( 2 0 0)T dans R00 : coordonnées de M dans R ?
Solution
√2 √ √
−√ 22
−1 0 0 0 2 −1
√2
m = 0 1 0 2 2 0 = 1 .
2 2 0
0 0 −1 0 0 1 0 0
Notation
Rotation d’un repère R vers un repère R0 de matrice de
rotation R, de dimension 3 × 3, à valeurs dans R.
xx yx zx
R = xy yy zy
xz yz zz
Définition
Eléments de R=cosinus directeurs . . . ils représentent les coordonnées
des trois vecteurs de la base R0 exprimés dans R.
Remarque (1)
Les colonnes de R sont orthogonales entre elles et par
conséquent la connaissance de deux colonnes suffit :
xx ∗ zx
R = xy ∗ zy .
xz ∗ zz
Définition
Six paramètres restants = cosinus directeurs incomplets.
Remarque (2)
Six paramètres liés entre eux par trois relations :
xx zx + xy zy + xz zz = 0
xx2 + xy2 + xz2 = 1
zx2 + zy2 + zz2 = 1
Conclusion
Jeu de trois paramètres : angles d’Euler, angles de roulis,
tangage, lacet, etc.
Définition
Angles d’Euler classiques = trois rotations successives :
ψ yθ yϕ
yψ ϕ
y
θ
x xψ xθ xϕ
soit :
0 10 10 1
cos ψ − sin ψ 0 1 0 0 cos ϕ − sin ϕ 0
R = @ sin ψ cos ψ 0A @0 cos θ − sin θA @ sin ϕ cos ϕ 0A
0 0 1 0 sin θ cos θ 0 0 1
0 1
cos ψ cos ϕ − sin ψ cos θ sin ϕ − cos ψ sin ϕ − sin ψ cos θ cos ϕ sin ψ sin θ
= @sin ψ cos ϕ + cos ψ cos θ sin ϕ − sin ψ sin ϕ + cos ψ cos θ cos ϕ − cos ψ sin θA
sin θ sin ϕ sin θ cos ϕ cos θ
ψ = atan2(zx , −zy )
θ = acos zz
ϕ = atan2(xz , yz )
si zz = ±1 :
θ = π(1 − zz )/2
ψ + zz ϕ = atan2(yx , xx )
et donc ψ et ϕ sont indéterminés.
Bernard BAYLE Introduction à la Robotique
Représentation des transformations rigides Notations et définitions
Description des bras manipulateurs Rotations
Modélisation des bras manipulateurs Transformations rigides
Définition
Angles de roulis, tangage et lacet : trois rotations successives :
γ y
β
x
soit :
0 10 10 1
cos α − sin α 0 cos β 0 sin β 1 0 0
R = @ sin α cos α 0A @ 0 1 0 A @0 cos γ − sin γ A
0 0 1 − sin β 0 cos β 0 sin γ cos γ
0 1
cos α cos β − sin α cos γ + cos α sin β sin γ sin α sin γ + cos α sin β cos γ
= @ sin α cos β cos α cos γ + sin α sin β sin γ − cos α sin γ + sin α sin β cos γ A
− sin β cos β sin γ cos β cos γ
α = atan2(xy , xxq)
β = atan2(−xz , xx2 + xy2 )
γ = atan2(yz , zz )
si β = ± π2 :
α − signe(β) γ = atan2(zy , zx )
(ou α − signe(β) γ = −atan2(yx , yy )
et donc α et γ sont indéterminés.
Bernard BAYLE Introduction à la Robotique
Représentation des transformations rigides Notations et définitions
Description des bras manipulateurs Rotations
Modélisation des bras manipulateurs Transformations rigides
Définition
Transformation rigide : combinaison d’une paire (p, R) avec p
la translation de l’origine du repère lié au solide S en
mouvement et R la rotation d’un repère lié à ce solide.
z0
z
y0
O0
p
O x0
y
M
x
Notations
Soient m = (mx my mz )T et m0 = (mx0 my0 mz0 )T les
coordonnées d’un point M respectivement dans R et R0 .
Expression de la transformation
Transformation rigide : translation p du repère R, puis rotation
R du repère obtenu vers R0 :
m = p + Rm0
Définition
Pour représenter la transformation rigide sous forme linéaire,
on introduit les coordonnées homogènes du point M :
m̄ = (mx my mz 1)T = (m 1)T .
0
m R p m
=
1 0 1 1
Conséquence
0 R p
m̄ = T m̄ avec T =
0 1
La matrice T est dite matrice de passage homogène.
Bernard BAYLE Introduction à la Robotique
Représentation des transformations rigides Notations et définitions
Description des bras manipulateurs Rotations
Modélisation des bras manipulateurs Transformations rigides
Notations
Soient T , T1 et T2 représentant les transformations rigides
(p, R) (p1 , R1 ) et (p2 , R2 ).
Notations
Soient T , T1 et T2 représentant les transformations rigides
(p, R) (p1 , R1 ) et (p2 , R2 ).
R1 R2 R1 p2 + p1
Combinaison : T1 T2 = .
0 1
Notations
Soient T , T1 et T2 représentant les transformations rigides
(p, R) (p1 , R1 ) et (p2 , R2 ).
R1 R2 R1 p2 + p1
Combinaison : T1 T2 = .
0 1
Elément neutre : matrice identité d’ordre 4.
Notations
Soient T , T1 et T2 représentant les transformations rigides
(p, R) (p1 , R1 ) et (p2 , R2 ).
R1 R2 R1 p2 + p1
Combinaison : T1 T2 = .
0 1
Elément neutre :matrice identit é d’ordre 4.
R T T
−R p
Inverse : T −1 = .
0 1
Plan
Hypothèse
On ne considère ici que les systèmes mécaniques composés
de chaı̂nes cinématiques polyarticulées ouvertes, appelés bras
manipulateurs série.
Définition
Bras manipulateur : n corps mobiles rigides reliés par n liaisons
rotoı̈des et prismatiques
bâti
(corps C0 ) liaison liaison liaison liaison liaison
L1 L2 L3 Ln−1 Ln
αi−1 zi
xi
Oi
zi z i−1
ri
Oi−1 x i−1 zi
ai−1 xi
Ωi−1
θi
x i−1
axe liaison
axe liaison
Li−1
Li
αi−1 zi
xi
Oi
zi z i−1
ri
Oi−1 x i−1 zi
ai−1 xi
Ωi−1
θi
x i−1
axe liaison
axe liaison
Li−1
Li
αi−1 zi
xi
Oi
zi z i−1
ri
Oi−1 x i−1 zi
ai−1 xi
Ωi−1
θi
x i−1
axe liaison
axe liaison
Li−1
Li
αi−1 zi
xi
Oi
zi z i−1
ri
Oi−1 x i−1 zi
ai−1 xi
Ωi−1
θi
x i−1
axe liaison
axe liaison
Li−1
Li
αi−1 zi
xi
Oi
zi z i−1
ri
Oi−1 x i−1 zi
ai−1 xi
Ωi−1
θi
x i−1
axe liaison
axe liaison
Li−1
Li
Convention
Repère R0 : libre, en suivant des considérations de
simplicité.
rn+1
zn
On+1
z
On
xn
O
y an
Convention
Repère R0 : libre, en suivant des considérations de
simplicité.
Point On+1 : associé à l’organe terminal (OT).
rn+1
zn
On+1
z
On
xn
O
y an
Convention
Repère R0 : libre, en suivant des considérations de
simplicité.
Point On+1 : associé à l’organe terminal (OT).
Repère Rn : tel que On+1 ∈ (On , x n , z n ).
rn+1
zn
On+1
z
On
xn
O
y an
ri
Oi−1 x i−1 zi
ai−1 xi
Ωi−1
θi
x i−1
axe liaison
axe liaison
Li−1
Li
axe liaison
axe liaison
Li−1
Li
axe liaison
axe liaison
Li−1
Li
Exemple
Ici commencent les travaux dirigés. . .
Tansformation rigide
soit :
cos θi − sin θi 0 ai−1
cos αi−1 sin θi cos αi−1 cos θi − sin αi−1 −ri sin αi−1
Ti−1, i =
sin αi−1 sin θi
sin αi−1 cos θi cos αi−1 ri cos αi−1
0 0 0 1
Tansformation rigide
Plan
Configuration
Définition
Configuration d’un système mécanique : repère la position de
tous ses points dans un repère donné.
Situation
Définition
Situation d’un solide : position et orientation de ce solide dans
un repère donné.
Définition
Modèle géométrique direct (MGD) d’un bras manipulateur :
situation de son OT en fonction de sa configuration :
f : N −→ M
q 7−→ x = f (q).
Cas général
On exprime x = (x1 x2 x3 x4 x5 x6 )T , avec (x1 x2 x3 )T
coordonnées de position dans R0 et (x4 x5 x6 )T coordonnées
d’orientation, en fonction de q = (q1 q2 . . . qn )T .
. . . souvent on s’arrête aux cosinus directeurs incomplets
Calcul du MGD
Calcul du MGD
x1 = px + an xx + rn+1 zx
x2 = py + an xy + rn+1 zy
x3 = pz + an xz + rn+1 zz
Règles pratiques
Calcul de la position de On et des cosinus directeurs
incomplets :
Règles
On note, pour i, j, . . . compris entre 1 et n :
Si = sin qi
Ci = cos qi
Si+j = sin (qi + qj )
Ci+j = cos (qi + qj )
Règles pratiques
Calcul de la position de On et des cosinus directeurs
incomplets :
Règles
Chaque nouvelle opération : une variable intermédiaire.
Règles pratiques
Calcul de la position de On et des cosinus directeurs
incomplets :
Règles
Calcul du produit à rebours : pas de calcul de la seconde co-
lonne des différentes matrices.
Règles pratiques
Calcul de la position de On et des cosinus directeurs
incomplets :
Règles
Deux transformations se composent aisément : on effectue
tout d’abord leur produit (exemple : deux rotations successives
d’axes parallèles).
Exemple
Suite des travaux dirigés. . .
Définition
Modèle géométrique inverse (MGI) : la ou les configurations
correspondant à une situation de l’OT donnée :
f −1 : M −→ N
x 7−→ q = f −1 (x).
Résolubilité
Existence d’un nombre fini de solutions :
Si n < m : pas de solution.
Si n = m : nombre fini de solutions (en général).
Si n > m : infinité de solutions.
Calcul
Résolution du MGI
Pas de méthode analytique systématique pour calculer le MGI .
px = x1 − an xx − rn+1 zx ,
py = x2 − an xy − rn+1 zy ,
pz = x3 − an xz − rn+1 zz .
Exemple
Suite des travaux dirigés. . .
Définition
Modèle cinématique direct (MCD) : relation entre les vitesses
opérationnelles ẋ et les vitesses généralisées q̇ :
ẋ = J q̇,
Calcul
Calcul générique du MCD hors programme. . .
Pour des structures simples, le MCD peut être obtenu par
simple dérivation du MGD.
Exemple
Fin des travaux dirigés ?