Robotique Modélisation et commande des robots manipulateurs - AVR
Robotique Modélisation et commande des robots manipulateurs - AVR
Robotique Modélisation et commande des robots manipulateurs - AVR
You also want an ePaper? Increase the reach of your titles
YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.
<strong>Robotique</strong><br />
Modélisation <strong>et</strong> <strong>commande</strong> <strong>des</strong> <strong>robots</strong> <strong>manipulateurs</strong><br />
Bernard BAYLE<br />
Télécom Physique Strasbourg
Plan<br />
1 Transformations <strong>et</strong> <strong>des</strong> mouvements rigi<strong>des</strong><br />
Notations <strong>et</strong> définitions<br />
Rotations<br />
Transformations rigi<strong>des</strong><br />
Mouvements rigi<strong>des</strong><br />
2 Description <strong>des</strong> bras <strong>manipulateurs</strong><br />
Chaîne cinématique d’un bras manipulateur<br />
Paramètres de Denavit-Hartenberg modifiés<br />
Relations géométriques<br />
Relations cinématiques<br />
3 Modélisation <strong>des</strong> bras <strong>manipulateurs</strong><br />
Configuration <strong>et</strong> situation d’un bras manipulateur<br />
Modèle géométrique direct<br />
Modèle géométrique inverse<br />
Modèle cinématique direct
Plan<br />
1 Transformations <strong>et</strong> <strong>des</strong> mouvements rigi<strong>des</strong><br />
Notations <strong>et</strong> définitions<br />
Rotations<br />
Transformations rigi<strong>des</strong><br />
Mouvements rigi<strong>des</strong><br />
2 Description <strong>des</strong> bras <strong>manipulateurs</strong><br />
Chaîne cinématique d’un bras manipulateur<br />
Paramètres de Denavit-Hartenberg modifiés<br />
Relations géométriques<br />
Relations cinématiques<br />
3 Modélisation <strong>des</strong> bras <strong>manipulateurs</strong><br />
Configuration <strong>et</strong> situation d’un bras manipulateur<br />
Modèle géométrique direct<br />
Modèle géométrique inverse<br />
Modèle cinématique direct
Points<br />
Notations<br />
R = (O, x, y, z) repère orthonormé direct cartésien, selon la<br />
convention de Gibbs.
Points<br />
Notations<br />
R = (O, x, y, z) repère orthonormé direct cartésien, selon la<br />
convention de Gibbs.<br />
Position d’un point M : vecteur m de coordonnées ∈ R 3 :<br />
⎛ ⎞<br />
m x<br />
m = ⎝m y<br />
⎠<br />
m z
Points<br />
Notations<br />
R = (O, x, y, z) repère orthonormé direct cartésien, selon la<br />
convention de Gibbs.<br />
Position d’un point M : vecteur m de coordonnées ∈ R 3 :<br />
⎛ ⎞<br />
m x<br />
m = ⎝m y<br />
⎠<br />
m z<br />
Mouvement d’un point : courbe paramétrée m(t) de R 3
Points<br />
Notations<br />
R = (O, x, y, z) repère orthonormé direct cartésien, selon la<br />
convention de Gibbs.<br />
Position d’un point M : vecteur m de coordonnées ∈ R 3 :<br />
⎛ ⎞<br />
m x<br />
m = ⎝m y<br />
⎠<br />
m z<br />
Mouvement d’un point : courbe paramétrée m(t) de R 3<br />
Trajectoire d’un point : support du mouvement
Soli<strong>des</strong><br />
Solide indéformable : pour toute paire de points de ce<br />
solide de coordonnées m <strong>et</strong> n :<br />
||m(t) − n(t)|| = ||m(0) − n(0)|| = constante
Soli<strong>des</strong><br />
Solide indéformable : pour toute paire de points de ce<br />
solide de coordonnées m <strong>et</strong> n :<br />
||m(t) − n(t)|| = ||m(0) − n(0)|| = constante<br />
Hypothèse<br />
Les soli<strong>des</strong> considérés seront tous indéformables.
Soli<strong>des</strong><br />
Solide indéformable : pour toute paire de points de ce<br />
solide de coordonnées m <strong>et</strong> n :<br />
||m(t) − n(t)|| = ||m(0) − n(0)|| = constante<br />
Hypothèse<br />
Les soli<strong>des</strong> considérés seront tous indéformables.<br />
Mouvement rigide d’un solide : mouvement de chacun de<br />
ses points
Soli<strong>des</strong><br />
Solide indéformable : pour toute paire de points de ce<br />
solide de coordonnées m <strong>et</strong> n :<br />
||m(t) − n(t)|| = ||m(0) − n(0)|| = constante<br />
Hypothèse<br />
Les soli<strong>des</strong> considérés seront tous indéformables.<br />
Mouvement rigide d’un solide : mouvement de chacun de<br />
ses points<br />
Situation d’un solide : position <strong>et</strong> orientation dans R d’un<br />
repère lié à ce solide
Transformations rigi<strong>des</strong><br />
Transformation rigide : résultat d’un mouvement rigide<br />
amenant un solide d’une situation initiale à une situation<br />
finale.
Transformations rigi<strong>des</strong><br />
Transformation rigide : résultat d’un mouvement rigide<br />
amenant un solide d’une situation initiale à une situation<br />
finale.<br />
Application qui transforme les coordonnées <strong>des</strong> points du<br />
solide de leur position initiale vers leur position finale.
Transformations rigi<strong>des</strong><br />
Transformation rigide : résultat d’un mouvement rigide<br />
amenant un solide d’une situation initiale à une situation<br />
finale.<br />
Application qui transforme les coordonnées <strong>des</strong> points du<br />
solide de leur position initiale vers leur position finale.<br />
Application = transformation rigide Ssi elle conserve à la<br />
fois les distances <strong>et</strong> l’orientation.
Transformations rigi<strong>des</strong><br />
Transformation rigide : résultat d’un mouvement rigide<br />
amenant un solide d’une situation initiale à une situation<br />
finale.<br />
Application qui transforme les coordonnées <strong>des</strong> points du<br />
solide de leur position initiale vers leur position finale.<br />
Application = transformation rigide Ssi elle conserve à la<br />
fois les distances <strong>et</strong> l’orientation.<br />
Conséquence<br />
Un repère orthonormé direct reste orthonormé direct par<br />
application d’une transformation rigide.
Matrices de rotation<br />
Notations<br />
R ′ = (O, x ′ , y ′ , z ′ ) orthonormé direct<br />
x ′ , y ′ , z ′ : coordonnées de x ′ , y ′ <strong>et</strong> z ′ dans R :<br />
⎛<br />
x ′ ⎞ ⎛<br />
.x<br />
y ′ ⎞ ⎛<br />
.x<br />
z ′ ⎞<br />
.x<br />
x ′ = ⎝x ′ .y⎠ , y ′ = ⎝y ′ .y⎠ <strong>et</strong> z ′ = ⎝z ′ .y⎠ .<br />
x ′ .z<br />
y ′ .z<br />
z ′ .z
Matrices de rotation<br />
Notations<br />
R ′ = (O, x ′ , y ′ , z ′ ) orthonormé direct<br />
x ′ , y ′ , z ′ : coordonnées de x ′ , y ′ <strong>et</strong> z ′ dans R :<br />
⎛<br />
x ′ ⎞ ⎛<br />
.x<br />
y ′ ⎞ ⎛<br />
.x<br />
z ′ ⎞<br />
.x<br />
x ′ = ⎝x ′ .y⎠ , y ′ = ⎝y ′ .y⎠ <strong>et</strong> z ′ = ⎝z ′ .y⎠ .<br />
x ′ .z<br />
y ′ .z<br />
z ′ .z<br />
Définition<br />
R = (x ′ y ′ z ′ ) de dimension 3 × 3 est appelée matrice de<br />
rotation du repère R vers le repère R ′ .<br />
. . . ou encore matrice de passage ou matrice de changement de base.
Matrices de rotation<br />
Intérêts :
Matrices de rotation<br />
Intérêts :<br />
rend compte du changement de base <strong>des</strong> coordonnées<br />
d’un point<br />
z ′<br />
z<br />
O<br />
y ′<br />
y<br />
x<br />
M<br />
x ′
Matrices de rotation<br />
Intérêts :<br />
rend compte du changement de base <strong>des</strong> coordonnées<br />
d’un point<br />
rend compte de la rotation d’un repère lié à un solide de R<br />
en R ′<br />
z ′<br />
z<br />
x<br />
O<br />
M<br />
x ′<br />
y ′<br />
y
Rotation d’un point appartenant à un solide<br />
Notations<br />
m = (m x m y m z ) T <strong>et</strong> m ′ = (m ′ x m ′ y m ′ z) T : coordonnées de M<br />
respectivement dans R <strong>et</strong> R ′ .
Rotation d’un point appartenant à un solide<br />
Notations<br />
m = (m x m y m z ) T <strong>et</strong> m ′ = (m ′ x m ′ y m ′ z) T : coordonnées de M<br />
respectivement dans R <strong>et</strong> R ′ .<br />
Alors :<br />
m = m ′ xx ′ + m ′ yy ′ + m ′ zz ′
Rotation d’un point appartenant à un solide<br />
Notations<br />
m = (m x m y m z ) T <strong>et</strong> m ′ = (m ′ x m ′ y m ′ z) T : coordonnées de M<br />
respectivement dans R <strong>et</strong> R ′ .<br />
Alors :<br />
m = m xx ′ ′ + m yy ′ ′ + m zz ′ ′<br />
⎛<br />
= ( x ′ y ′ z ′) m ′ ⎞<br />
x<br />
⎝m y<br />
′ ⎠<br />
m z<br />
′
Rotation d’un point appartenant à un solide<br />
Notations<br />
m = (m x m y m z ) T <strong>et</strong> m ′ = (m ′ x m ′ y m ′ z) T : coordonnées de M<br />
respectivement dans R <strong>et</strong> R ′ .<br />
Alors :<br />
m = m xx ′ ′ + m yy ′ ′ + m zz ′ ′<br />
⎛<br />
= ( x ′ y ′ z ′) m ′ ⎞<br />
x<br />
⎝m y<br />
′ ⎠<br />
m z<br />
′<br />
Conséquence<br />
Formule de changement de base (rotation) : m = Rm ′
Rotation d’un point appartenant à un solide<br />
z ′<br />
z<br />
x<br />
O<br />
M<br />
x ′<br />
y ′<br />
y<br />
Première analyse<br />
Changement de repère <strong>des</strong><br />
coordonnées du point<br />
x<br />
z ′<br />
O<br />
z<br />
y ′<br />
y<br />
x ′<br />
M<br />
Seconde analyse<br />
Rotation d’un solide S autour de O,<br />
de matrice R<br />
. . . alors m ′ = coordonnées initiales de M dans R<br />
<strong>et</strong> m =coordonnées finales dans R.
Rotation d’un point appartenant à un solide<br />
Exemple<br />
M<br />
y<br />
x ′<br />
y ′ θ<br />
O z = z ′<br />
x<br />
M de coordonnées initiales ( √ 3 0 1) T .<br />
Coordonnées du point transformé par une rotation<br />
R(z, θ)
Rotation d’un point appartenant à un solide<br />
Solution<br />
⎛<br />
⎞ ⎛√ ⎞ ⎛√ ⎞<br />
cos θ − sin θ 0 3<br />
√ 3 cos θ<br />
m = ⎝ sin θ cos θ 0⎠<br />
⎝ 0 ⎠ = ⎝ 3 sin θ ⎠ .<br />
0 0 1 1<br />
1<br />
Application numérique : à titre d’exemple, pour θ = π 3<br />
, on trouve<br />
√<br />
m = ( 3 3<br />
2 2 1)T .
Rotation d’un vecteur<br />
Remarque<br />
Coordonnées d’un vecteur = différence <strong>des</strong> coordonnées de<br />
deux points de R 3 .<br />
On peut appliquer la rotation à un vecteur de coordonnées<br />
v = m − n dans R :<br />
soit, en posant v ′ = m ′ − n ′ :<br />
m − n = Rm ′ − Rn ′ = R(m ′ − n ′ ),<br />
v = Rv ′ .
Propriétés <strong>des</strong> rotations<br />
Notation<br />
Les matrices identités, quel que soit leur ordre sont notées I.
Propriétés <strong>des</strong> rotations<br />
Notation<br />
Les matrices identités, quel que soit leur ordre sont notées I.<br />
Orthogonalité : R T R = I <strong>et</strong> d<strong>et</strong> R = 1.
Propriétés <strong>des</strong> rotations<br />
Notation<br />
Les matrices identités, quel que soit leur ordre sont notées I.<br />
Orthogonalité : R T R = I <strong>et</strong> d<strong>et</strong> R = 1.<br />
Elément neutre : matrice identité d’ordre 3.
Propriétés <strong>des</strong> rotations<br />
Notation<br />
Les matrices identités, quel que soit leur ordre sont notées I.<br />
Orthogonalité : R T R = I <strong>et</strong> d<strong>et</strong> R = 1.<br />
Elément neutre : matrice identité d’ordre 3.<br />
Inverse unique : R −1 = R T .
Propriétés <strong>des</strong> rotations<br />
Notation<br />
Les matrices identités, quel que soit leur ordre sont notées I.<br />
Orthogonalité : R T R = I <strong>et</strong> d<strong>et</strong> R = 1.<br />
Elément neutre : matrice identité d’ordre 3.<br />
Inverse unique : R −1 = R T .<br />
Combinaison de deux rotations successives R 1 <strong>et</strong> R 2 :<br />
rotation R 1 R 2 .
Combinaison de rotations<br />
Notations<br />
Soient R ′ <strong>et</strong> R ′′ les repères résultant <strong>des</strong> deux rotations<br />
successives R 1 <strong>et</strong> R 2 du repère fixe R.<br />
Non-commutativité de la rotation<br />
R 1 R 2 ≠ R 2 R 1 .<br />
Deux cas se présentent pour combiner deux rotations :
Combinaison de rotations<br />
Notations<br />
Soient R ′ <strong>et</strong> R ′′ les repères résultant <strong>des</strong> deux rotations<br />
successives R 1 <strong>et</strong> R 2 du repère fixe R.<br />
Non-commutativité de la rotation<br />
R 1 R 2 ≠ R 2 R 1 .<br />
Deux cas se présentent pour combiner deux rotations :<br />
seconde rotation par rapport au repère résultant de la<br />
première rotation : (R ′′ résulte de la rotation de R ′ autour<br />
d’un axe lié à R ′ )
Combinaison de rotations<br />
Notations<br />
Soient R ′ <strong>et</strong> R ′′ les repères résultant <strong>des</strong> deux rotations<br />
successives R 1 <strong>et</strong> R 2 du repère fixe R.<br />
Non-commutativité de la rotation<br />
R 1 R 2 ≠ R 2 R 1 .<br />
Deux cas se présentent pour combiner deux rotations :<br />
seconde rotation par rapport au repère résultant de la<br />
première rotation : (R ′′ résulte de la rotation de R ′ autour<br />
d’un axe lié à R ′ )<br />
seconde par rapport au même repère, fixe (R ′′ résulte de<br />
la rotation de R ′ autour d’un axe lié à R)
Premier cas<br />
Problème de changement de base<br />
Seconde rotation par rapport au repère résultant de la première<br />
rotation : problème de changement de base.<br />
Notations<br />
M de coordonnées respectives m, m ′ , m ′′ dans R, R ′ <strong>et</strong> R ′′<br />
Combinaison : premier cas<br />
Comme m = R 1 m ′ <strong>et</strong> m ′ = R 2 m ′′ , alors :<br />
m = R 1 R 2 m ′′ .
Premier cas<br />
Problème de changement de base<br />
Seconde rotation par rapport au repère résultant de la première<br />
rotation : problème de changement de base.<br />
Notations<br />
M de coordonnées respectives m, m ′ , m ′′ dans R, R ′ <strong>et</strong> R ′′<br />
Combinaison : premier cas<br />
Coordonnées m de M dans R = résultat <strong>des</strong> deux rotations<br />
successives appliquées à un point de coordonnées initiales m ′′
Premier cas<br />
Exemple<br />
z z ′<br />
M<br />
π<br />
x ′′<br />
y ′<br />
O<br />
x ′<br />
x<br />
π<br />
4<br />
z ′′<br />
m ′′ = ( √ 2 0 0) T dans R ′′ : coordonnées de M dans R
Premier cas<br />
Solution<br />
⎛ √ √ ⎞<br />
2<br />
⎜<br />
2<br />
− 2<br />
⎛<br />
⎞ ⎛√ ⎞ ⎛ ⎞<br />
2<br />
0 −1 0 0<br />
√ √ 2 −1<br />
m = ⎝ 2 2<br />
⎟<br />
2 2<br />
0⎠<br />
⎝ 0 1 0 ⎠ ⎝ 0 ⎠ = ⎝−1⎠ .<br />
0 0 1 0 0 −1 0 0<br />
Soit la combinaison <strong>des</strong> deux rotations suivantes :<br />
une première rotation d’un angle π 4<br />
autour de z<br />
une seconde rotation d’un angle π autour de l’axe y ′
Second cas<br />
Rotations successives<br />
Problème de rotations successives d’un point : la<br />
transformation d’un point de coordonnées initiales m ′′ dans R<br />
donne un point intermédiaire, qui, transformé par la seconde<br />
rotation donne un point de coordonnées m dans R par R 2 .<br />
Notations<br />
M de coordonnées respectives m, m ′ , m ′′ dans R, R ′ <strong>et</strong> R ′′<br />
Combinaison : second cas<br />
Conséquence :<br />
m = R 2 (R 1 m ′′ )
Second cas<br />
Exemple<br />
z z ′<br />
O<br />
x ′<br />
y<br />
x ′′<br />
π<br />
M<br />
x<br />
π<br />
4<br />
z ′′<br />
m ′′ = ( √ 2 0 0) T dans R ′′ : coordonnées de M dans R
Second cas<br />
Solution<br />
⎛<br />
⎞ ⎛ √ √ ⎞<br />
−1 0 0 2<br />
m = ⎝ 0 1 0 ⎠ ⎜<br />
2<br />
− 2<br />
⎛√ ⎞ ⎛ ⎞<br />
2<br />
0<br />
√ √ 2 −1<br />
⎝ 2 2<br />
⎟<br />
2 2<br />
0⎠<br />
⎝ 0 ⎠ = ⎝ 1 ⎠ .<br />
0 0 −1 0 0 1 0 0<br />
Soit la combinaison <strong>des</strong> deux rotations suivantes :<br />
une première rotation d’un angle π 4<br />
autour de z<br />
une seconde rotation d’un angle π autour de l’axe y
Orientation d’un solide dans l’espace<br />
Matrice de rotation <strong>et</strong> cosinus directeurs<br />
Notation<br />
Rotation d’un repère R vers un repère R ′ de matrice de<br />
rotation R, de dimension 3 × 3, à valeurs dans R.<br />
Définition<br />
⎛ ⎞<br />
x x y x z x<br />
R = ⎝x y y y z y<br />
⎠<br />
x z y z z z<br />
Eléments de R=cosinus directeurs . . . ils représentent les coordonnées<br />
<strong>des</strong> trois vecteurs de la base R ′ exprimés dans R.
Orientation d’un solide dans l’espace<br />
Cosinus directeurs incompl<strong>et</strong>s<br />
Remarque<br />
Les colonnes de R sont orthogonales entre elles <strong>et</strong> par<br />
conséquent la connaissance de deux colonnes suffit :<br />
⎛ ⎞<br />
x x ∗ z x<br />
R = ⎝x y ∗ z y<br />
⎠ .<br />
x z ∗ z z<br />
Définition<br />
Six paramètres restants = cosinus directeurs incompl<strong>et</strong>s.
Orientation d’un solide dans l’espace<br />
Repérage minimal<br />
Remarque<br />
Six paramètres liés entre eux par trois relations :<br />
x x z x + x y z y + x z z z = 0<br />
xx 2 + xy 2 + xz 2 = 1<br />
zx 2 + zy 2 + zz 2 = 1<br />
Conclusion<br />
Jeu de trois paramètres : angles d’Euler, angles de roulis,<br />
tangage, lac<strong>et</strong>, <strong>et</strong>c.
Orientation d’un solide dans l’espace<br />
Angles d’Euler classiques<br />
Définition<br />
Angles d’Euler classiques = trois rotations successives :<br />
R(z, ψ), R(x ψ , θ) puis R(z θ , ϕ)<br />
avec ψ, θ <strong>et</strong> ϕ : précession, nutation <strong>et</strong> rotation propre.<br />
z<br />
z ψ<br />
z θ<br />
ψ<br />
y y ψ<br />
y θ<br />
ϕ<br />
z ϕ<br />
y ϕ<br />
x ϕ<br />
x<br />
x ψ<br />
θ<br />
x θ
Orientation d’un solide dans l’espace<br />
Angles d’Euler classiques<br />
Chaque nouvelle rotation effectuée par rapport à un repère<br />
ayant tourné :<br />
R = R(z, ψ) R(x ψ , θ) R(z θ , ϕ)<br />
soit :<br />
R =<br />
=<br />
⎛<br />
⎞ ⎛<br />
cos ψ − sin ψ 0<br />
⎝ sin ψ cos ψ 0⎠<br />
⎝ 1 0 0<br />
⎞ ⎛<br />
⎞<br />
cos ϕ − sin ϕ 0<br />
0 cos θ − sin θ⎠<br />
⎝ sin ϕ cos ϕ 0⎠<br />
0 0 1 0 sin θ cos θ 0 0 1<br />
⎛<br />
⎞<br />
cos ψ cos ϕ − sin ψ cos θ sin ϕ − cos ψ sin ϕ − sin ψ cos θ cos ϕ sin ψ sin θ<br />
⎝sin ψ cos ϕ + cos ψ cos θ sin ϕ − sin ψ sin ϕ + cos ψ cos θ cos ϕ − cos ψ sin θ⎠<br />
sin θ sin ϕ sin θ cos ϕ cos θ
Orientation d’un solide dans l’espace<br />
Angles d’Euler classiques<br />
Transformation inverse = angles d’Euler à partir <strong>des</strong> cosinus<br />
directeurs :<br />
si z z ≠ ±1 :<br />
si z z = ±1 :<br />
ψ = atan2(z x , −z y )<br />
θ = acos z z<br />
ϕ = atan2(x z , y z )<br />
θ = π(1 − z z )/2<br />
ψ + z z ϕ = atan2(−y x , x x )<br />
<strong>et</strong> donc ψ <strong>et</strong> ϕ sont indéterminés.
Orientation d’un solide dans l’espace<br />
Angles de roulis, tangage <strong>et</strong> lac<strong>et</strong><br />
Définition<br />
Angles de roulis, tangage <strong>et</strong> lac<strong>et</strong> : trois rotations successives :<br />
R(x, γ), R(y, β) puis R(z, α)<br />
avec γ, β, <strong>et</strong> α angles de roulis, tangage <strong>et</strong> lac<strong>et</strong>.<br />
z<br />
α<br />
x<br />
γ<br />
y<br />
β
Orientation d’un solide dans l’espace<br />
Angles de roulis, tangage <strong>et</strong> lac<strong>et</strong><br />
Chaque nouvelle rotation étant effectuée par rapport à un axe<br />
du repère fixe R :<br />
R = R(z, α) R(y, β) R(x, γ)<br />
soit :<br />
R =<br />
=<br />
⎛<br />
⎞ ⎛<br />
⎞ ⎛<br />
cos α − sin α 0 cos β 0 sin β<br />
⎝ sin α cos α 0⎠<br />
⎝ 0 1 0 ⎠ ⎝ 1 0 0<br />
⎞<br />
0 cos γ − sin γ⎠<br />
0 0 1 − sin β 0 cos β 0 sin γ cos γ<br />
⎛<br />
⎞<br />
cos α cos β − sin α cos γ + cos α sin β sin γ sin α sin γ + cos α sin β cos γ<br />
⎝ sin α cos β cos α cos γ + sin α sin β sin γ − cos α sin γ + sin α sin β cos γ⎠<br />
− sin β cos β sin γ cos β cos γ
Orientation d’un solide dans l’espace<br />
Angles de roulis, tangage <strong>et</strong> lac<strong>et</strong><br />
Transformation inverse = angles de roulis, tangage <strong>et</strong> lac<strong>et</strong> à<br />
partir <strong>des</strong> cosinus directeurs :<br />
si β ≠ ± π 2 : α = atan2(x y , x x<br />
√<br />
)<br />
β = atan2(−x z , xx 2 + xy 2 )<br />
γ = atan2(y z , z z )<br />
si β = ± π 2 : α − signe(β) γ = atan2(z y , z x )<br />
ou α − signe(β) γ = −atan2(y x , y y )<br />
<strong>et</strong> donc α <strong>et</strong> γ sont indéterminés.
Matrices de passage homogènes<br />
Définition<br />
Transformation rigide : combinaison d’une paire (p, R) avec p<br />
la translation de l’origine du repère lié au solide S en<br />
mouvement <strong>et</strong> R la rotation d’un repère lié à ce solide.<br />
z ′ y ′<br />
z<br />
x<br />
O<br />
y<br />
p<br />
O ′<br />
x ′<br />
M
Matrices de passage homogènes<br />
Notations<br />
Soient m = (m x m y m z ) T <strong>et</strong> m ′ = (m ′ x m ′ y m ′ z) T les<br />
coordonnées d’un point M respectivement dans R <strong>et</strong> R ′ .<br />
Expression de la transformation<br />
Transformation rigide : translation p du repère R, puis rotation<br />
R du repère obtenu vers R ′ :<br />
m = p + Rm ′
Matrices de passage homogènes<br />
Définition<br />
Pour représenter la transformation rigide sous forme linéaire,<br />
on introduit les coordonnées homogènes du point M :<br />
¯m = (m x m y m z 1) T = (m 1) T .<br />
( ) m<br />
=<br />
1<br />
( R p<br />
0 1<br />
) ( ) m<br />
′<br />
1<br />
Conséquence<br />
¯m = T ¯m ′ avec T =<br />
( ) R p<br />
0 1<br />
La matrice T est dite matrice de passage homogène.
Propriétés <strong>des</strong> transformations rigi<strong>des</strong><br />
Notations<br />
Soient T , T 1 <strong>et</strong> T 2 représentant les transformations rigi<strong>des</strong><br />
(p, R) (p 1 , R 1 ) <strong>et</strong> (p 2 , R 2 ).
Propriétés <strong>des</strong> transformations rigi<strong>des</strong><br />
Notations<br />
Soient T , T 1 <strong>et</strong> T 2 représentant les transformations rigi<strong>des</strong><br />
(p, R) (p 1 , R 1 ) <strong>et</strong> (p 2 , R 2 ).<br />
Combinaison : T 1 T 2 =<br />
( )<br />
R1 R 2 R 1 p 2 + p 1<br />
.<br />
0 1
Propriétés <strong>des</strong> transformations rigi<strong>des</strong><br />
Notations<br />
Soient T , T 1 <strong>et</strong> T 2 représentant les transformations rigi<strong>des</strong><br />
(p, R) (p 1 , R 1 ) <strong>et</strong> (p 2 , R 2 ).<br />
Combinaison : T 1 T 2 =<br />
( )<br />
R1 R 2 R 1 p 2 + p 1<br />
.<br />
0 1<br />
Elément neutre : matrice identité d’ordre 4.
Propriétés <strong>des</strong> transformations rigi<strong>des</strong><br />
Notations<br />
Soient T , T 1 <strong>et</strong> T 2 représentant les transformations rigi<strong>des</strong><br />
(p, R) (p 1 , R 1 ) <strong>et</strong> (p 2 , R 2 ).<br />
Combinaison : T 1 T 2 =<br />
( )<br />
R1 R 2 R 1 p 2 + p 1<br />
.<br />
0 1<br />
Elément neutre :<br />
(<br />
matrice identité d’ordre 4.<br />
R<br />
Inverse : T −1 T<br />
−R<br />
=<br />
T )<br />
p<br />
.<br />
0 1
Vecteur vitesse de rotation<br />
Définition<br />
Prise en compte du temps : mouvement rigide. Vecteur vitesse<br />
de rotation Ω porté par l’axe instantané de rotation du solide S,<br />
dirigé suivant le principe du tire-bouchon<br />
Ω<br />
z ′<br />
z<br />
x<br />
O<br />
OM<br />
x ′<br />
y ′<br />
y<br />
v M<br />
M
Vitesse d’un point lié à un solide<br />
Rotations pures<br />
Soit Ω le vecteur vitesse de rotation du solide S <strong>et</strong> v M la vitesse<br />
de M appartenant à S, de coordonnées v M .<br />
Expression de la vitesse<br />
v M = Ω × OM,<br />
soit v M = Ω × m = ˆΩ m,<br />
avec :<br />
⎛<br />
⎞<br />
0 −Ω z Ω y<br />
ˆΩ = ⎝ Ω z 0 −Ω x<br />
⎠<br />
−Ω y Ω x 0
Vitesse d’un point lié à un solide<br />
Cas général<br />
Mouvement rigide : combinaison d’une translation <strong>et</strong> d’une<br />
rotation.<br />
Expression de la vitesse<br />
v M = ṗ + ˆΩ m.
Plan<br />
1 Transformations <strong>et</strong> <strong>des</strong> mouvements rigi<strong>des</strong><br />
Notations <strong>et</strong> définitions<br />
Rotations<br />
Transformations rigi<strong>des</strong><br />
Mouvements rigi<strong>des</strong><br />
2 Description <strong>des</strong> bras <strong>manipulateurs</strong><br />
Chaîne cinématique d’un bras manipulateur<br />
Paramètres de Denavit-Hartenberg modifiés<br />
Relations géométriques<br />
Relations cinématiques<br />
3 Modélisation <strong>des</strong> bras <strong>manipulateurs</strong><br />
Configuration <strong>et</strong> situation d’un bras manipulateur<br />
Modèle géométrique direct<br />
Modèle géométrique inverse<br />
Modèle cinématique direct
Types de bras <strong>manipulateurs</strong> considérés<br />
Hypothèse<br />
On ne considère ici que les systèmes mécaniques composés<br />
de chaînes cinématiques polyarticulées ouvertes, appelés bras<br />
<strong>manipulateurs</strong> série.
Description <strong>des</strong> chaînes cinématiques ouvertes<br />
Définition<br />
Bras manipulateur : n corps mobiles rigi<strong>des</strong> reliés par n liaisons<br />
rotoï<strong>des</strong> <strong>et</strong> prismatiques<br />
corps corps corps corps<br />
C 1 C 2 C n−1 C n<br />
bâti<br />
(corps C 0)<br />
liaison liaison liaison liaison liaison<br />
L 1 L 2 L 3 L n−1 L n
Paramètres de Denavit-Hartenberg modifiés<br />
Notations<br />
i-ème corps : repère R i = (O i , x i , y i<br />
, z i ), avec<br />
i = 0, 1, . . . , n.<br />
αi−1<br />
z i<br />
x i<br />
Oi<br />
z i<br />
z i−1<br />
ri<br />
Oi−1<br />
x i−1<br />
z i<br />
ai−1<br />
Ωi−1<br />
x i−1<br />
x i<br />
θi<br />
axe liaison<br />
Li−1<br />
axe liaison<br />
Li
Placement <strong>des</strong> repères R 1 à R n−1<br />
αi−1<br />
z i<br />
x i<br />
Oi<br />
z i<br />
z i−1<br />
ri<br />
Oi−1<br />
x i−1<br />
z i<br />
ai−1<br />
Ωi−1<br />
x i−1<br />
x i<br />
θi<br />
axe liaison<br />
Li−1<br />
axe liaison<br />
Li<br />
O i−1 est le pied de la perpendiculaire commune à L i−1 <strong>et</strong> L i sur<br />
L i−1 (axes parallèles, choix arbitraire de la perpendiculaire<br />
commune).
Placement <strong>des</strong> repères R 1 à R n−1<br />
αi−1<br />
z i<br />
x i<br />
Oi<br />
z i<br />
z i−1<br />
ri<br />
Oi−1<br />
x i−1<br />
z i<br />
ai−1<br />
Ωi−1<br />
x i−1<br />
x i<br />
θi<br />
axe liaison<br />
Li−1<br />
axe liaison<br />
Li<br />
x i−1 : vecteur unitaire de la perpendiculaire commune, orienté<br />
de L i−1 vers L i (axes concourants ou confondus : orientation<br />
arbitraire).
Placement <strong>des</strong> repères R 1 à R n−1<br />
αi−1<br />
z i<br />
x i<br />
Oi<br />
z i<br />
z i−1<br />
ri<br />
Oi−1<br />
x i−1<br />
z i<br />
ai−1<br />
Ωi−1<br />
x i−1<br />
x i<br />
θi<br />
axe liaison<br />
Li−1<br />
axe liaison<br />
Li<br />
z i−1 : vecteur unitaire de L i−1 , librement orienté (débattements<br />
positifs <strong>et</strong> symétriques).
Placement <strong>des</strong> repères R 1 à R n−1<br />
αi−1<br />
z i<br />
x i<br />
Oi<br />
z i<br />
z i−1<br />
ri<br />
Oi−1<br />
x i−1<br />
z i<br />
ai−1<br />
Ωi−1<br />
x i−1<br />
x i<br />
θi<br />
axe liaison<br />
Li−1<br />
axe liaison<br />
Li<br />
y i−1<br />
: tel que le repère R i−1 soit orthonormé direct.
Placement <strong>des</strong> repères R 0 <strong>et</strong> R n<br />
Convention<br />
Repère R 0 : libre, en suivant <strong>des</strong> considérations de<br />
simplicité.<br />
r n+1<br />
z<br />
O<br />
y<br />
z n<br />
O n<br />
O n+1<br />
x n<br />
a n<br />
x
Placement <strong>des</strong> repères R 0 <strong>et</strong> R n<br />
Convention<br />
Repère R 0 : libre, en suivant <strong>des</strong> considérations de<br />
simplicité.<br />
Point O n+1 : associé à l’organe terminal (OT).<br />
r n+1<br />
z<br />
O<br />
y<br />
z n<br />
O n<br />
O n+1<br />
x n<br />
a n<br />
x
Placement <strong>des</strong> repères R 0 <strong>et</strong> R n<br />
Convention<br />
Repère R 0 : libre, en suivant <strong>des</strong> considérations de<br />
simplicité.<br />
Point O n+1 : associé à l’organe terminal (OT).<br />
Repère R n : tel que O n+1 ∈ (O n , x n , z n ).<br />
r n+1<br />
z<br />
O<br />
y<br />
z n<br />
O n<br />
O n+1<br />
x n<br />
a n<br />
x
Paramètres de Denavit-Hartenberg modifiés<br />
α i−1<br />
z i<br />
α i−1 : angle algébrique entre z i−1<br />
<strong>et</strong> z i , mesuré autour de x i−1 .<br />
z i<br />
z i−1<br />
O i<br />
x i<br />
r i<br />
O i−1<br />
Ω i−1<br />
L i<br />
x i−1<br />
z i<br />
a i−1<br />
x i<br />
x i−1<br />
θ i<br />
axe liaison<br />
L i−1<br />
axe liaison
Paramètres de Denavit-Hartenberg modifiés<br />
z i<br />
α i−1<br />
z i−1<br />
x i−1<br />
z i<br />
O i<br />
r i<br />
z i<br />
x i<br />
α i−1 : angle algébrique entre z i−1<br />
<strong>et</strong> z i , mesuré autour de x i−1 .<br />
a i−1 : distance arithmétique de la<br />
perpendiculaire commune aux<br />
axes <strong>des</strong> liaisons L i−1 <strong>et</strong> L i<br />
mesurée le long de x i−1 .<br />
O i−1<br />
Ω i−1<br />
L i<br />
a i−1<br />
x i<br />
x i−1<br />
θ i<br />
axe liaison<br />
L i−1<br />
axe liaison
Paramètres de Denavit-Hartenberg modifiés<br />
z i<br />
α i−1<br />
z i−1<br />
x i−1<br />
z i<br />
a i−1<br />
O i<br />
r i<br />
z i<br />
x i<br />
x i−1<br />
x i<br />
θ i<br />
α i−1 : angle algébrique entre z i−1<br />
<strong>et</strong> z i , mesuré autour de x i−1 .<br />
a i−1 : distance arithmétique de la<br />
perpendiculaire commune aux<br />
axes <strong>des</strong> liaisons L i−1 <strong>et</strong> L i<br />
mesurée le long de x i−1 .<br />
θ i : angle algébrique entre x i−1 <strong>et</strong><br />
x i , mesuré autour de z i .<br />
O i−1<br />
Ω i−1<br />
L i<br />
axe liaison<br />
L i−1<br />
axe liaison
Paramètres de Denavit-Hartenberg modifiés<br />
z i<br />
α i−1<br />
z i−1<br />
z i<br />
O i<br />
r i<br />
O i−1 x i−1<br />
z i<br />
a i−1<br />
x i<br />
x i−1<br />
θ i<br />
axe liaison<br />
L i−1<br />
axe liaison<br />
L i<br />
Ω i−1<br />
x i<br />
α i−1 : angle algébrique entre z i−1<br />
<strong>et</strong> z i , mesuré autour de x i−1 .<br />
a i−1 : distance arithmétique de la<br />
perpendiculaire commune aux<br />
axes <strong>des</strong> liaisons L i−1 <strong>et</strong> L i<br />
mesurée le long de x i−1 .<br />
θ i : angle algébrique entre x i−1 <strong>et</strong><br />
x i , mesuré autour de z i .<br />
r i : distance algébrique du point<br />
O i à la perpendiculaire, mesuré<br />
le long de z i .
Exemple<br />
Ici commencent les travaux dirigés. . .
Tansformation rigide<br />
Transformation rigide paramétrée :<br />
⎛<br />
⎞ ⎛<br />
⎞ ⎛<br />
⎞ ⎛<br />
⎞<br />
1 0 0 0 1 0 0 a i−1 cos θ i − sin θ i 0 0 1 0 0 0<br />
T i−1, i = ⎜0 cos α i−1 − sin α i−1 0<br />
⎟ ⎜0 1 0 0<br />
⎟ ⎜ sin θ i cos θ i 0 0<br />
⎟ ⎜0 1 0 0<br />
⎟<br />
⎝0 sin α i−1 cos α i−1 0⎠<br />
⎝0 0 1 0 ⎠ ⎝ 0 0 1 0⎠<br />
⎝0 0 1 r i<br />
⎠<br />
0 0 0 1 0 0 0 1 0 0 0 1 0 0 0 1<br />
} {{ } } {{ } } {{ } } {{ }<br />
R(x i−1 , α i−1 )<br />
translation de a i−1 x i−1<br />
R(z i , θ i )<br />
translation de r i z i<br />
soit :<br />
⎛<br />
⎞<br />
cos θ i − sin θ i 0 a i−1<br />
T i−1, i = ⎜cos α i−1 sin θ i cos α i−1 cos θ i − sin α i−1 −r i sin α i−1<br />
⎟<br />
⎝ sin α i−1 sin θ i sin α i−1 cos θ i cos α i−1 r i cos α i−1<br />
⎠<br />
0 0 0 1
Tansformation rigide<br />
Transformation rigide paramétrée :<br />
⎛<br />
⎞ ⎛<br />
⎞ ⎛<br />
⎞ ⎛<br />
⎞<br />
1 0 0 0 1 0 0 a i−1 cos θ i − sin θ i 0 0 1 0 0 0<br />
T i−1, i = ⎜0 cos α i−1 − sin α i−1 0<br />
⎟ ⎜0 1 0 0<br />
⎟ ⎜ sin θ i cos θ i 0 0<br />
⎟ ⎜0 1 0 0<br />
⎟<br />
⎝0 sin α i−1 cos α i−1 0⎠<br />
⎝0 0 1 0 ⎠ ⎝ 0 0 1 0⎠<br />
⎝0 0 1 r i<br />
⎠<br />
0 0 0 1 0 0 0 1 0 0 0 1 0 0 0 1<br />
} {{ } } {{ } } {{ } } {{ }<br />
R(x i−1 , α i−1 )<br />
translation de a i−1 x i−1<br />
R(z i , θ i )<br />
translation de r i z i<br />
qui prend la forme :<br />
T i−1, i =<br />
( )<br />
Ri−1, i p i−1, i<br />
0 1<br />
où R i−1, i représente la rotation entre les repères R i−1 <strong>et</strong> R i <strong>et</strong><br />
p i−1, i la translation entre ces mêmes repères.
Liaison prismatique<br />
ṗ i<br />
= ˙q i z i<br />
O n<br />
˙q i z i<br />
O i<br />
axe liaison<br />
L i<br />
Vitesse du point O n <strong>et</strong> vitesse de rotation de R n :<br />
ṗ i<br />
= ˙q i z i ,<br />
Ω i = 0.
Liaison rotoïde<br />
p i<br />
= ˙q i z i × p i,n<br />
O n<br />
p i,n<br />
Ω i = ˙q i z i<br />
O i<br />
axe liaison<br />
L i<br />
Vitesse du point O n <strong>et</strong> vitesse de rotation de R n :<br />
ṗ i<br />
= ˙q i z i × p i,n<br />
,<br />
Ω i = ˙q i z i .
Relations cinématiques, cas général<br />
Notations<br />
Liaison identifiée par le paramètre σ i <strong>et</strong> son complément à 1 ¯σ i :<br />
{<br />
0, pour une liaison rotoïde,<br />
σ i =<br />
1, pour une liaison prismatique.<br />
Vitesses du repère de l’organe terminal en O n<br />
ṗ i<br />
= (σ i z i + ¯σ i z i × p i,n<br />
) ˙q i ,<br />
Ω i = (¯σ i z i ) ˙q i .
Plan<br />
1 Transformations <strong>et</strong> <strong>des</strong> mouvements rigi<strong>des</strong><br />
Notations <strong>et</strong> définitions<br />
Rotations<br />
Transformations rigi<strong>des</strong><br />
Mouvements rigi<strong>des</strong><br />
2 Description <strong>des</strong> bras <strong>manipulateurs</strong><br />
Chaîne cinématique d’un bras manipulateur<br />
Paramètres de Denavit-Hartenberg modifiés<br />
Relations géométriques<br />
Relations cinématiques<br />
3 Modélisation <strong>des</strong> bras <strong>manipulateurs</strong><br />
Configuration <strong>et</strong> situation d’un bras manipulateur<br />
Modèle géométrique direct<br />
Modèle géométrique inverse<br />
Modèle cinématique direct
Configuration<br />
Définition<br />
Configuration d’un système mécanique : repère la position de<br />
tous ses points dans un repère donné.<br />
Cas d’un bras manipulateur<br />
Configuration d’un bras manipulateur : vecteur q de n<br />
coordonnées indépendantes appelées coordonnées<br />
généralisées, appartenant à l’espace <strong>des</strong> configurations N .<br />
Coordonnées généralisées : angles de rotation pour les<br />
liaisons rotoï<strong>des</strong>, valeurs <strong>des</strong> translations pour les liaisons<br />
prismatiques.
Situation<br />
Définition<br />
Situation d’un solide : position <strong>et</strong> orientation de ce solide dans<br />
un repère donné.<br />
Cas d’un bras manipulateur<br />
Situation de l’OT du bras manipulateur : vecteur x de m<br />
coordonnées opérationnelles indépendantes appartenant à<br />
l’espace opérationnel M, de dimension m 6. Définition de la<br />
situation selon le problème (plan, positionnement seul . . .) <strong>et</strong> le<br />
paramétrage choisi (orientation notamment).
Modèle géométrique direct<br />
Définition<br />
Modèle géométrique direct (MGD) d’un bras manipulateur :<br />
situation de son OT en fonction de sa configuration :<br />
f : N −→ M<br />
q ↦−→ x = f (q).<br />
Cas général<br />
On exprime x = (x 1 x 2 x 3 x 4 x 5 x 6 ) T , avec (x 1 x 2 x 3 ) T<br />
coordonnées de position dans R 0 <strong>et</strong> (x 4 x 5 x 6 ) T coordonnées<br />
d’orientation, en fonction de q = (q 1 q 2 . . . q n ) T .<br />
. . . souvent on s’arrête aux cosinus directeurs incompl<strong>et</strong>s
Calcul du MGD<br />
Orientation extraite de la matrice de rotation entre les<br />
repères bâti <strong>et</strong> OT.
Calcul du MGD<br />
Orientation extraite de la matrice de rotation entre les<br />
repères bâti <strong>et</strong> OT.<br />
Position (x 1 x 2 x 3 ) T du point O n+1 déduite de la position<br />
(p x p y p z ) T du point O n dans R 0 , compte tenu <strong>des</strong><br />
coordonnées (a n 0 r n+1 ) T de O n+1 dans R n :<br />
x 1 = p x + a n x x + r n+1 z x<br />
x 2 = p y + a n x y + r n+1 z y<br />
x 3 = p z + a n x z + r n+1 z z
Règles pratiques<br />
Calcul de la position de O n <strong>et</strong> <strong>des</strong> cosinus directeurs<br />
incompl<strong>et</strong>s :<br />
T 0,n (q) = T 0,1 (q 1 ) T 1,2 (q 2 ) . . . T n−1,n (q n ).<br />
Règles<br />
On note, pour i, j, . . . compris entre 1 <strong>et</strong> n :<br />
S i = sin q i<br />
C i = cos q i<br />
S i+j = sin (q i + q j )<br />
C i+j = cos (q i + q j )
Règles pratiques<br />
Calcul de la position de O n <strong>et</strong> <strong>des</strong> cosinus directeurs<br />
incompl<strong>et</strong>s :<br />
T 0,n (q) = T 0,1 (q 1 ) T 1,2 (q 2 ) . . . T n−1,n (q n ).<br />
Règles<br />
Chaque nouvelle opération : une variable intermédiaire.
Règles pratiques<br />
Calcul de la position de O n <strong>et</strong> <strong>des</strong> cosinus directeurs<br />
incompl<strong>et</strong>s :<br />
T 0,n (q) = T 0,1 (q 1 ) T 1,2 (q 2 ) . . . T n−1,n (q n ).<br />
Règles<br />
Calcul du produit à rebours : pas de calcul de la seconde<br />
colonne <strong>des</strong> différentes matrices.
Règles pratiques<br />
Calcul de la position de O n <strong>et</strong> <strong>des</strong> cosinus directeurs<br />
incompl<strong>et</strong>s :<br />
T 0,n (q) = T 0,1 (q 1 ) T 1,2 (q 2 ) . . . T n−1,n (q n ).<br />
Règles<br />
Deux transformations se composent aisément : on effectue tout<br />
d’abord leur produit (exemple : deux rotations successives<br />
d’axes parallèles).
Exemple<br />
Suite <strong>des</strong> travaux dirigés. . .
Modèle géométrique inverse<br />
Définition<br />
Modèle géométrique inverse (MGI) : la ou les configurations<br />
correspondant à une situation de l’OT donnée :<br />
f −1 : M −→ N<br />
x ↦−→ q = f −1 (x).<br />
Résolubilité<br />
Existence d’un nombre fini de solutions :<br />
Si n < m : pas de solution.<br />
Si n = m : nombre fini de solutions (en général).<br />
Si n > m : infinité de solutions.
Calcul<br />
Résolution du MGI<br />
Pas de méthode analytique systématique pour calculer le MGI.<br />
Le mieux est de reprendre les équations du MGD <strong>et</strong> de mener le<br />
calcul à l’envers. Dans le cas où n = 6, l’existence d’un poign<strong>et</strong><br />
sphérique perm<strong>et</strong> de débuter la résolution par :<br />
p x = x 1 − a n x x − r n+1 z x ,<br />
p y = x 2 − a n x y − r n+1 z y ,<br />
p z = x 3 − a n x z − r n+1 z z .<br />
Ensuite résolution au cas par cas pour exprimer les q i , pour<br />
i = 1, 2, . . . , n en fonction de p x , p y , p z <strong>et</strong> <strong>des</strong> cosinus<br />
directeurs.
Exemple<br />
Suite <strong>des</strong> travaux dirigés. . .
Modèle cinématique direct<br />
Définition<br />
Modèle cinématique direct (MCD) : relation entre les vitesses<br />
opérationnelles ẋ <strong>et</strong> les vitesses généralisées ˙q :<br />
ẋ = J ˙q<br />
où J est matrice jacobienne de la fonction f , de dimension<br />
m × n :<br />
J : T q N −→ T x M<br />
˙q ↦−→ ẋ = J ˙q, où J = ∂f<br />
∂q .
Modèle cinématique direct<br />
Calcul<br />
Dérivation du MGD pour les structures simples sinon . . .<br />
Premier temps : vitesse de O n <strong>et</strong> vitesse de rotation de R n<br />
ṗ =<br />
Ω =<br />
n∑<br />
(σ i z i + ¯σ i z i × p i,n<br />
) ˙q i ,<br />
i=1<br />
n∑<br />
(¯σ i z i ) ˙q i .<br />
i=1
Modèle cinématique direct<br />
Calcul<br />
Dérivation du MGD pour les structures simples sinon . . .<br />
Premier temps : vitesse de O n <strong>et</strong> vitesse de rotation de R n<br />
Sous forme vectorielle :<br />
(ṗ )<br />
= J<br />
Ω g ˙q<br />
( )<br />
σ1 z<br />
J g = 1 + ¯σ 1 z 1 × p 1,n<br />
σ 2 z 2 + ¯σ 2 z 2 × p 2,n<br />
. . . σ nz n + ¯σ nz n × p n,n<br />
¯σ 1 z 1 ¯σ 2 z 2 . . . ¯σ nz n
Modèle cinématique direct<br />
Calcul<br />
Dérivation du MGD pour les structures simples sinon . . .<br />
Premier temps : vitesse de O n <strong>et</strong> vitesse de rotation de R n<br />
Dans R 0 : (ṗ )<br />
= J<br />
Ω g ˙q
Modèle cinématique direct<br />
Calcul<br />
Dérivation du MGD pour les structures simples sinon . . .<br />
Second temps : calcul de la vitesse du point O n+1 <strong>et</strong> <strong>des</strong><br />
dérivées <strong>des</strong> paramètres d’orientation du repère R n<br />
Position de O n+1 :<br />
⎛ ⎞ ⎛ ⎞ ⎛ ⎞ ⎛ ⎞<br />
x 1 p x x x<br />
z x<br />
⎝x 2<br />
⎠ = ⎝p y<br />
⎠ + a n<br />
⎝x y<br />
⎠ + r n+1<br />
⎝z y<br />
⎠<br />
x 3 p z x z z z
Modèle cinématique direct<br />
Calcul<br />
Dérivation du MGD pour les structures simples sinon . . .<br />
Second temps : calcul de la vitesse du point O n+1 <strong>et</strong> <strong>des</strong><br />
dérivées <strong>des</strong> paramètres d’orientation du repère R n<br />
Vitesse de O n+1 :<br />
⎛<br />
⎝<br />
⎛ ⎞ ⎛ ⎞ ⎛ ⎛ ⎞ ⎛ ⎞⎞<br />
ṗ x Ω x<br />
x x<br />
z x<br />
⎠ = ⎝ṗ y<br />
⎠ + ⎝Ω y<br />
⎠ × ⎝a n<br />
⎝x y<br />
⎠ + r n+1<br />
⎝z y<br />
⎠⎠<br />
ṗ z Ω z x z z z<br />
⎞<br />
ẋ 1<br />
ẋ2<br />
ẋ3
Modèle cinématique direct<br />
Calcul<br />
Dérivation du MGD pour les structures simples sinon . . .<br />
Second temps : calcul de la vitesse du point O n+1 <strong>et</strong> <strong>des</strong><br />
dérivées <strong>des</strong> paramètres d’orientation du repère R n<br />
⎛<br />
⎝<br />
⎛ ⎞ ⎛ ⎞<br />
ṗ x Ω x<br />
⎠ = ⎝ṗ y<br />
⎠ + D ⎝Ω y<br />
⎠<br />
ṗ z Ω z<br />
⎞<br />
ẋ 1<br />
ẋ2<br />
ẋ3<br />
avec :<br />
⎛<br />
0 a n x z + r n+1 z z<br />
⎞<br />
−a n x y − r n+1 z y<br />
D = ⎝−a n x z − r n+1 z z 0 a n x x + r n+1 z x<br />
⎠ .<br />
a n x y + r n+1 z y −a n x x − r n+1 z x 0
Modèle cinématique direct<br />
Calcul<br />
Dérivation du MGD pour les structures simples sinon . . .<br />
Second temps : calcul de la vitesse du point O n+1 <strong>et</strong> <strong>des</strong><br />
dérivées <strong>des</strong> paramètres d’orientation du repère R n<br />
Dérivées <strong>des</strong> paramètres d’orientation du repère R n :<br />
⎛ ⎞<br />
ẋ 4<br />
⎛ ⎞<br />
⎜ ẋ5<br />
Ω x<br />
⎟<br />
⎝. . . ⎠ = C ⎝Ω y<br />
⎠<br />
Ω<br />
ẋ z<br />
m
Modèle cinématique direct<br />
Finalement :<br />
MCD :<br />
( ) (ṗ )<br />
I D<br />
ẋ =<br />
=<br />
0 C Ω<br />
matrice jacobienne :<br />
J =<br />
( ) I D<br />
J<br />
0 C g .<br />
( ) I D<br />
J<br />
0 C g ˙q,
Règles pratiques<br />
Pour les calculs analytiques, on utilise (sans le montrer) :<br />
J g =<br />
( ) ( ) ( ) ( )<br />
R0,1 0 R1,2 0 Rk−1,k 0 I −ˆpk+1,n |<br />
. . .<br />
Rk<br />
J<br />
0 R 0,1 0 R 1,2 0 R k−1,k 0 I<br />
k+1 | Rk<br />
avec :
Règles pratiques<br />
Pour les calculs analytiques, on utilise (sans le montrer) :<br />
J g =<br />
( ) ( ) ( ) ( )<br />
R0,1 0 R1,2 0 Rk−1,k 0 I −ˆpk+1,n |<br />
. . .<br />
Rk<br />
J<br />
0 R 0,1 0 R 1,2 0 R k−1,k 0 I<br />
k+1 | Rk<br />
avec :<br />
k = Ent( n 2<br />
) : indice préférentiel
Règles pratiques<br />
Pour les calculs analytiques, on utilise (sans le montrer) :<br />
J g =<br />
( ) ( ) ( ) ( )<br />
R0,1 0 R1,2 0 Rk−1,k 0 I −ˆpk+1,n |<br />
. . .<br />
Rk<br />
J<br />
0 R 0,1 0 R 1,2 0 R k−1,k 0 I<br />
k+1 | Rk<br />
avec :<br />
k = Ent( n 2<br />
) : indice préférentiel<br />
robot à poign<strong>et</strong> sphérique : ˆp 4,6 = 0
Règles pratiques<br />
Pour les calculs analytiques, on utilise (sans le montrer) :<br />
J g =<br />
( ) ( ) ( ) ( )<br />
R0,1 0 R1,2 0 Rk−1,k 0 I −ˆpk+1,n |<br />
. . .<br />
Rk<br />
J<br />
0 R 0,1 0 R 1,2 0 R k−1,k 0 I<br />
k+1 | Rk<br />
avec :<br />
k = Ent( n 2<br />
) : indice préférentiel<br />
robot à poign<strong>et</strong> sphérique : ˆp 4,6 = 0<br />
ˆp k+1,n | Rk : matrice anti-symétrique associée à la projection<br />
de p k+1,n dans R k
Règles pratiques<br />
Pour les calculs analytiques, on utilise (sans le montrer) :<br />
J g =<br />
( ) ( ) ( ) ( )<br />
R0,1 0 R1,2 0 Rk−1,k 0 I −ˆpk+1,n |<br />
. . .<br />
Rk<br />
J<br />
0 R 0,1 0 R 1,2 0 R k−1,k 0 I<br />
k+1 | Rk<br />
avec :<br />
k = Ent( n 2<br />
) : indice préférentiel<br />
robot à poign<strong>et</strong> sphérique : ˆp 4,6 = 0<br />
ˆp k+1,n | Rk : matrice anti-symétrique associée à la projection<br />
de p k+1,n dans R k<br />
J k+1 | Rk : projection dans R k de<br />
J k+1 =<br />
(<br />
σ1 z 1 + ¯σ 1 z 1 × p 1,k+1<br />
σ 2 z 2 + ¯σ 2 z 2 × p 2,k+1<br />
. . . σ nz n + ¯σ nz n × p n,k+1<br />
¯σ 1 z 1 ¯σ 2 z 2 . . . ¯σ nz n<br />
)
Exemple<br />
Fin <strong>des</strong> travaux dirigés.
Plan<br />
4 Génération de mouvements<br />
Les différents problèmes<br />
Système de <strong>commande</strong> d’un robot<br />
5 Technologie<br />
Motorisation<br />
Mesure de position<br />
Variateurs de vitesse<br />
6 Commande<br />
Commande point-à-point<br />
Commande à mouvement opérationnel imposé
Plan<br />
4 Génération de mouvements<br />
Les différents problèmes<br />
Système de <strong>commande</strong> d’un robot<br />
5 Technologie<br />
Motorisation<br />
Mesure de position<br />
Variateurs de vitesse<br />
6 Commande<br />
Commande point-à-point<br />
Commande à mouvement opérationnel imposé
Problèmes point-à-point<br />
Tâche<br />
Atteindre une position <strong>et</strong> une orientation désirées x f , à<br />
partir d’une configuration de départ q 0 .
Problèmes point-à-point<br />
Tâche<br />
Atteindre une position <strong>et</strong> une orientation désirées x f , à partir<br />
d’une configuration de départ q 0 = <br />
Génération de mouvements dans l’espace articulaire.<br />
x f<br />
MGI<br />
q f<br />
génération<br />
de mouvement<br />
q r (t)<br />
variateur<br />
robot<br />
q 0<br />
q(t)<br />
capteur
Problèmes point-à-point<br />
Avantages<br />
Moins de calculs en ligne car pas besoin <strong>des</strong> modèles<br />
Aucun problème au passage <strong>des</strong> configurations singulières<br />
Contraintes butées/vitesses/accélérations maximales<br />
prises en compte lors de la génération de la consigne<br />
x f<br />
MGI<br />
q f<br />
génération<br />
de mouvement<br />
q r (t)<br />
variateur<br />
robot<br />
q 0<br />
q(t)<br />
capteur
Problèmes point-à-point<br />
Inconvénients<br />
Prise en compte <strong>des</strong> contraintes géométriques impossible<br />
Gestion <strong>des</strong> collisions
Problèmes à mouvement opérationnel imposé<br />
Tâche<br />
Calcul <strong>des</strong> <strong>commande</strong>s articulaires du robot perm<strong>et</strong>tant de<br />
suivre une trajectoire opérationnelle au cours du temps.
Problèmes à mouvement opérationnel imposé<br />
Tâche à mouvement opérationnel imposé<br />
Calcul les <strong>commande</strong>s articulaires du robot perm<strong>et</strong>tant de<br />
suivre une trajectoire opérationnelle au cours du temps = <br />
x r (t) résulte d’une génération, ou bien est défini par la tâche,<br />
puis calcul de q r (t) par inversion de modèle.<br />
x f<br />
génération<br />
de mouvement<br />
x 0<br />
x r (t)<br />
+<br />
x(t)<br />
−<br />
cinématique<br />
inverse<br />
MGD<br />
q r (t)<br />
variateur robot<br />
q(t)<br />
capteur
Problèmes à mouvement opérationnel imposé<br />
Avantages<br />
Réaliser <strong>des</strong> tâches plus complexes<br />
Reformuler les problèmes de <strong>commande</strong> selon une<br />
approche référencée capteur
Problèmes à mouvement opérationnel imposé<br />
Inconvénients<br />
Difficile de prendre en compte <strong>des</strong> contraintes telles que<br />
butées, limites de vitesse, évitement <strong>des</strong> obstacles, . . .<br />
Requiert les modèles du robot<br />
Problème en cas configuration singulière<br />
x f<br />
génération<br />
de mouvement<br />
x 0<br />
x r (t)<br />
+<br />
x(t)<br />
−<br />
cinématique<br />
inverse<br />
MGD<br />
q r (t)<br />
variateur robot<br />
q(t)<br />
capteur
Système de <strong>commande</strong> d’un robot Adept Viper s650<br />
Système de <strong>commande</strong> d’un robot<br />
Synoptique<br />
Puissance : alimentation/asservissement <strong>des</strong> actionneurs<br />
Contrôle : consignes, supervision, communication
Contrôleur de robot<br />
Module Adept SmartController CX<br />
Génération <strong>et</strong> supervision du mouvement<br />
Système d’exploitation dédié, langage programmation<br />
Connectique importante<br />
Générique
Contrôleur de robot : programmation<br />
; Define a simple transformation<br />
SET loc_a = TRANS(300,50,350,0,180,0)<br />
; Move to the location<br />
MOVE loc_a<br />
BREAK<br />
; Move to a location offs<strong>et</strong> -50mm in X, 20mm in Y,<br />
; and 30mm in Z relative to "loc_a"<br />
MOVE loc_a:TRANS(-50, 20, 30)<br />
BREAK<br />
; Define "loc_b" to be the current location relative<br />
; to "loc_a"<br />
HERE loc_a:loc_b ;loc_b = -50, 20, 30, 0, 0, 0<br />
BREAK<br />
; Define "loc_c" as the vector sum of "loc_a" and "loc_b"<br />
SET loc_c = loc_a:loc_b ;loc_c = 350, 70, 320, 0, 180, 0<br />
; Once this code has run, loc_b exists as a<br />
; transformation that is compl<strong>et</strong>ely independent<br />
; of loc_a. The following instruction moves the<br />
; robot another -50mm in the x, 20mm in the y,<br />
; and 30mm in the z direction (relative to loc_c):<br />
MOVE loc_c:loc_b
Contrôleur de robot : communication<br />
Communications Adept SmartController CX<br />
IEEE 1394 (FireWire) privilégiée : transferts à hauts débits<br />
(800 Mb/s), cadencée à 8kHz, temps-réel<br />
Fast Ethern<strong>et</strong>, DeviceN<strong>et</strong>=bus terrain CAN, liaisons séries<br />
RS-232, XDIO=entrées/sorties tout ou rien, <strong>et</strong>c.<br />
Fonctionnalités dédiées : <strong>commande</strong> par vision, pilotage<br />
coordonné avec automate
Contrôleur de robot : communication<br />
Communications Adept SmartController CX<br />
Connecteur XMPC : boîtier de <strong>commande</strong> manuelle<br />
Apprentissage : enregistrement <strong>des</strong> variables utilisables<br />
dans les programmes<br />
Sécurité : arrêt d’urgence/interrupteur puissance
Variateur de vitesse<br />
Fonctionnalités principales du variateur MotionBlox-60R<br />
Alimentation <strong>des</strong> moteurs par une tension variable<br />
Asservissement courant/vitesse/position <strong>des</strong> axes<br />
Autres fonctionnalités :<br />
Communications avec le contrôleur pour la supervision du<br />
robot (à 1kHz : références, valeurs codeurs, statuts)<br />
Diagnostic du bon fonctionnement <strong>des</strong> moteurs : statuts,<br />
erreur d’asservissement, chauffe moteur<br />
Contrôle <strong>des</strong> freins <strong>des</strong> axes : électrique/manuel<br />
Arrêt d’urgence pour couper la puissance du robot<br />
Puissances mises en jeu<br />
Variables, fonctions <strong>des</strong> masses en mouvement <strong>et</strong> <strong>des</strong> vitesses.<br />
Viper s650 : 2kW max pour 5 kg utiles.
Plan<br />
4 Génération de mouvements<br />
Les différents problèmes<br />
Système de <strong>commande</strong> d’un robot<br />
5 Technologie<br />
Motorisation<br />
Mesure de position<br />
Variateurs de vitesse<br />
6 Commande<br />
Commande point-à-point<br />
Commande à mouvement opérationnel imposé
Motorisation<br />
Commande d’axe<br />
Mécanique : association moteur+réducteur de vitesse<br />
Capteur de position/vitesse<br />
Electronique de puissance : variateur de vitesse<br />
Moteurs électriques pour la robotique<br />
Moteurs dédiés à la robotique = moteurs à courant continu,<br />
avec ou sans balais.<br />
Quelques cas plus exotiques : asynchrones, pneumatiques,<br />
hydrauliques, piézoélectriques, pas à pas, . . .
Moteurs à courant continu (avec balais)
Moteurs à courant continu (avec balais)<br />
Avantages<br />
Simple <strong>et</strong> très répandu<br />
Commande très simple<br />
Electronique peu coûteuse<br />
Inconvénients<br />
Usure <strong>des</strong> balais<br />
Vitesse limitée<br />
Etincelles
Moteurs à courant continu sans balais<br />
Principe<br />
Moteurs synchrones auto-pilotés, <strong>commande</strong> basée sur<br />
l’analogie avec le moteur à courant continu.<br />
Avantages<br />
Meilleur rendement, meilleures propriétés mécaniques<br />
Meilleur couple massique<br />
Vitesse de rotation maximale plus grande<br />
Moins de bruit de commutation, pas d’étincelles<br />
Inconvénients<br />
Plus cher<br />
Electronique plus complexe (numérique)<br />
Eff<strong>et</strong>s d’ondulation de couple aux basses vitesses
Réducteurs<br />
Intérêt<br />
Moteur adapté à <strong>des</strong> vitesses de rotation élevées<br />
Augmentation du couple<br />
Inconvénients<br />
Augmentation de l’inertie de l’axe, <strong>et</strong> surtout <strong>des</strong> frottements. . .
Réducteurs conventionnels <strong>et</strong> planétaires<br />
Réducteurs à dentures droites ou hélicoïdales<br />
Réducteurs à étages ou train épicycloïdal
Réducteurs planétaires<br />
Principe<br />
Deux arbres coaxiaux : les planétaires (extérieur=couronne) +<br />
<strong>des</strong> satellites qui engrènent avec les planétaires, reliés entre<br />
eux par un porte-satellites.
Réducteurs Harmonic Drive<br />
Principe<br />
Utilisation d’une cloche déformable, entrainée par une partie<br />
mobile légèrement elliptique, qui engrène sur une couronne<br />
circulaire possédant deux dents de plus que la cloche.
Plan<br />
4 Génération de mouvements<br />
Les différents problèmes<br />
Système de <strong>commande</strong> d’un robot<br />
5 Technologie<br />
Motorisation<br />
Mesure de position<br />
Variateurs de vitesse<br />
6 Commande<br />
Commande point-à-point<br />
Commande à mouvement opérationnel imposé
Capteurs<br />
Intérêt<br />
Mesure de la position ou de la vitesse de l’arbre moteur<br />
Asservissement<br />
Inconvénients<br />
Pas mal de défauts potentiels. . .
Codeurs incrémentaux<br />
Principe<br />
Emission de lumière par une photodiode : signaux lumineux qui<br />
perçus sur les récepteurs donnent <strong>des</strong> signaux logiques<br />
déphasés A, B <strong>et</strong> le signal d’index I (ou Z).
Codeurs incrémentaux<br />
Avantages<br />
Bonne résolution, de loin la solution la plus classique<br />
Signaux Ā, ¯B pour la redondance<br />
Très bonne compacité du capteur<br />
Inertie négligeable, pas de frottement<br />
Inconvénients<br />
Quantification (basses vitesses, dérivation)<br />
Pas de position absolue de l’axe
Recepteur de ligne<br />
Circuits utilisables:<br />
- MC 3486<br />
- SN 75175<br />
-AM26LS32<br />
244 maxon tacho Edition Juill<strong>et</strong> 2005 / Modifications réservées<br />
Codeur<br />
Line Driver<br />
DS26LS31<br />
Canal<br />
Canal A<br />
Canal<br />
Canal B<br />
Canal<br />
Canal I<br />
R<br />
R<br />
Codeur HEDL 5540, 500 impulsions, 3 canaux, avec Line Driver RS 422<br />
maxon tacho<br />
R<br />
Programme Stock<br />
Numéros de <strong>commande</strong><br />
Programme Standard<br />
Programme Spécial (sur demande!)<br />
110512 110514 110516 110518<br />
Type<br />
Nombre d'impulsions par tour 500 500 500 500<br />
Nombre de canaux 3 3 3 3<br />
Fréquence impulsionnelle max. (kHz) 100 100 100 100<br />
Diamètre de l'arbre (mm) 3 4 6 8<br />
longueur totale<br />
longueur totale<br />
Combinaison<br />
+Moteur Page + Réducteur Page +Frein Page Longueur totale [mm] / voir: + Réducteur<br />
RE 25, 10 W* 77 75.3<br />
RE 25, 10 W* 77 GP 26, 0.5 - 2.0 216 ●<br />
RE 25, 10 W* 77 GP 32, 0.75 - 6.0 Nm 218/220 ●<br />
RE 25, 10 W* 77 GP 32, 0.4 - 2.0 Nm 222 ●<br />
RE 25, 20 W* 78 75.3<br />
RE 25, 20 W* 78 ●<br />
RE 25, 20 W* 78 GP 32, 0.75 - 6.0 Nm 218/220 ●<br />
RE 25, 20 W* 78 GP 32, 0.4 - 2.0 Nm 222 ●<br />
RE 26, 18 W* 79 77.2<br />
RE 26, 18 W* 79 ●<br />
RE 26, 18 W* 79 GP 32, 0.75 - 6.0 Nm 218/220 ●<br />
RE 26, 18 W* 79 GP 32, 0.4 - 2.0 Nm 222 ●<br />
RE 35, 90 W* 81 91.9<br />
RE 35, 90 W* 81 ●<br />
RE 35, 90 W* 81 GP 42, 3.0 - 15 Nm 224 ●<br />
RE 35, 90 W* 81 AB 40 279 124.1<br />
RE 35, 90 W* 81 AB 40 279 ●<br />
RE 35, 90 W* 81 GP 42, 3.0 - 15 Nm 224 AB 40 279 ●<br />
RE 36, 70 W* 82 92.2<br />
RE 36, 70 W* 82 ●<br />
RE 36, 70 W* 82 GP 32, 0.4 - 2.0 Nm 222 ●<br />
RE 36, 70 W* 82 GP 42, 3.0 - 15 Nm 224 ●<br />
RE 40, 150 W* 83 91.7<br />
RE 40, 150 W* 83 ●<br />
RE 40, 150 W* 83 GP 52, 4.0 - 30 Nm 227 ●<br />
RE 40, 150 W* 83 AB 40 279 124.2<br />
RE 40, 150 W* 83 AB 40 279 ●<br />
RE 40, 150 W* 83 GP 42, 4.0 - 30 Nm 227 AB 40 279 ●<br />
RE 75, 250 W 84 241.5<br />
RE 75, 250 W 84 ●<br />
RE 75, 250 W 84 AB 75 282 281.4<br />
RE 75, 250 W 84 AB 75 282 ●<br />
*Connectique voir page 245<br />
Données techniques Connectique pour moteur RE 75 Exemple de connexion<br />
Tension d'alimentation 5 V 10 %<br />
Connectique<br />
Signal de sortie EIA Standard RS 422<br />
Type SOURIAU 8GM-QL2-12P<br />
Drives utilisée:<br />
DS26LS31<br />
1 VCC<br />
Déphasage (nominal) 90°e<br />
2 N.C. (non utilisé)<br />
Distance entre flancs s min. 45°e<br />
3 GND<br />
4 N.C. (non utilisé)<br />
Tempsdemontéedusignal<br />
5 Canal I (Index)<br />
(typique avec CL =25pF,RL =2.7k, 25°C) 180 ns<br />
6 Canal I<br />
Tempsde<strong>des</strong>centedusignal<br />
7 Canal B<br />
(typique avec 8 Canal B<br />
CL =25pF,RL =2.7k, 25°C) 40 ns<br />
9 Canal A<br />
Largeur (nominale) d'impulsion d'index 90°e<br />
10 Canal A<br />
Plage de températures<br />
0 ... +70°C<br />
11 N.C. (non utilisé)<br />
Moment d'inertie du disque 0.6 gcm 2<br />
12 N.C. (non utilisé)<br />
Connecteurs connseillés<br />
Accélération angulaire max. 250 000 rad s -2<br />
Type SOURIAU 8GM-DM2-12S<br />
Courant par canal<br />
min. -20 mA, max. 20 mA<br />
(métal sortie droite:<br />
Option<br />
1000 impulsions, 2 canaux<br />
maxon Art. No. 2675.538) ou<br />
8G-V2-12S ((plastique, angle à 90°:<br />
maxon Art. No. 2675.539)<br />
Résistance terminale R = typique 100
Génératices tachymétriques <strong>et</strong> résolveurs<br />
Génératrice tachymétrique = machine à courant continu utilisée<br />
en génératrice :<br />
mesure continue <strong>et</strong> absolue de la vitesse de l’axe<br />
plus encombrant, beaucoup plus coûteux<br />
Résolveur = dispositif avec un bobinage primaire tournant, <strong>et</strong><br />
deux bobinages secondaires diphasés, dont le couplage<br />
dépend de la position du rotor :<br />
robustesse <strong>et</strong> longue durée de vie<br />
signaux mesurés transmis sans perturbations<br />
fournit potentiellement position <strong>et</strong> vitesse
252 maxon tacho Edition Juill<strong>et</strong> 2005 / Modifications réservées<br />
Génératrice DCT 22, 0.52 Volt<br />
maxon tacho<br />
Informations importantes<br />
● Génératrice équipée du rotor sans fer maxon.<br />
● Génératrice avec commutation en métaux précieux.<br />
● Inertie du système = inertie rotor moteur + inertie<br />
rotor génératrice.<br />
● Le rotor génératrice tourne dans le même sens<br />
que le rotor moteur (la rotation du moteur en sens<br />
horaire, vu en bout d’axe, fournit une tension positive<br />
sur la cosse marquée +).<br />
● Il est recommandé d’utiliser un amplificateur à haute<br />
impédance d’entrée.<br />
● La génératrice ne doit pas être trop chargée en<br />
courant.<br />
● La fréquence de résonance donnée provient <strong>des</strong><br />
systèmes rotor-moteur <strong>et</strong> rotor-TG.<br />
Programme Stock<br />
Numéros de <strong>commande</strong><br />
Programme Standard<br />
Programme Spécial (sur demande!)<br />
118908 118909 118910<br />
Type<br />
Diamètre de l'arbre (mm) 2 3 4<br />
longueur totale<br />
longueur totale<br />
Combinaison<br />
+Moteur Page + Réducteur Page Longueur totale [mm] / voir: + Réducteur<br />
RE 25, 10 W 77 76.8<br />
RE 25, 10 W 77 GP 26, 0.5 - 2.0 Nm 216 ●<br />
RE 25, 10 W 77 GP 32, 0.75 - 4.5 Nm 218 ●<br />
RE 25, 10 W 77 GP 32, 1.0 - 6.0 Nm 220 ●<br />
RE 25, 10 W 77 GP 32, 0.4 - 2.0 Nm 222 ●<br />
RE 25, 20 W 78 76.8<br />
RE 25, 20 W 78 GP 26, 0.5 - 2.0 Nm 216 ●<br />
RE 25, 20 W 78 GP 32, 0.75 - 4.5 Nm 218 ●<br />
RE 25, 20 W 78 GP 32, 1.0 - 6.0 Nm 220 ●<br />
RE 25, 20 W 78 GP 32, 0.4 - 2.0 Nm 222 ●<br />
RE 26, 18 W 79 79.8<br />
RE 26, 18 W 79 GP 26, 0.5 - 2.0 Nm 216 ●<br />
RE 26, 18 W 79 GP 32, 0.75 - 4.5 Nm 218 ●<br />
RE 26, 18 W 79 GP 32, 1.0 - 6.0 Nm 220 ●<br />
RE 26, 18 W 79 GP 32, 0.4 - 2.0 Nm 222 ●<br />
RE 35, 90 W 81 89.0<br />
RE 35, 90 W 81 GP 32, 0.75 - 4.5 Nm 219 ●<br />
RE 35, 90 W 81 GP 32, 1.0 - 6.0 Nm 220 ●<br />
RE 35, 90 W 81 GP 42, 3.0 - 15 Nm 224 ●<br />
RE 36, 70 W 82 89.3<br />
RE 36, 70 W 82 GP 32, 0.75 - 4.5 Nm 219 ●<br />
RE 36, 70 W 82 GP 32, 1.0 - 6.0 Nm 220 ●<br />
RE 36, 70 W 82 GP 32, 0.4 - 2.0 Nm 222 ●<br />
RE 36, 70 W 82 GP 42, 3.0 - 15 Nm 224 ●<br />
180 W<br />
Données techniques<br />
Exemple de connexion<br />
Tension de sortie par 1000 tr / min 0.52 V Courant max. conseillé 10 mA<br />
Résistance connectée tachymètrique 56.6 Tolérancedelatension<strong>des</strong>ortie 15 %<br />
Ondulation moyenne effective crête à crête 6 % Inertie du rotor génératrice < 3 gcm 2<br />
T<br />
1kW<br />
Nombre d'ondulations par tour 14 Fréq. de résonance avec le mot. <strong>des</strong> p. 77 - 79 > 2 kHz<br />
Linéarité entre 500 <strong>et</strong> 5000 tr / % avec le moteur <strong>des</strong> pages 86, 88 > 3 kHz<br />
min à vide 0.2<br />
Linéarité avec résistance de charge de 10 k 0.7 % avec le moteur <strong>des</strong> pages 81, 82 > 4.5 kHz<br />
Erreur d'inversion 0.1 % Plage de températures -20 ... +65°C<br />
Coefficient de température de la FEM (aimant) -0.02 % /°C<br />
Coefficient de temp. sur résistance d'induit +0.4 % /°C Option: également livrable avec <strong>des</strong> fils de connexion.<br />
Rippel = x 100 (%)
Edition Juill<strong>et</strong> 2005 / Modifications réservées maxon tacho 253<br />
SIN<br />
COS<br />
Résolveur Res 26, 10 Volt<br />
Primaire<br />
rouge / blanc<br />
d30<br />
b30<br />
jaune / blanc<br />
Resolverrotor<br />
b32<br />
jaune<br />
Secondaire<br />
noir<br />
bleu<br />
z32<br />
rouge<br />
d32<br />
U<br />
COS<br />
SIN<br />
z30 360°e<br />
Angle<br />
rotor<br />
<br />
maxon tacho<br />
Programme Stock<br />
Numéros de <strong>commande</strong><br />
Programme Standard<br />
Programme Spécial (sur demande!)<br />
166488 133405 268912 216287<br />
Type<br />
Diamètre de l'arbre (mm) 4 6 6 6<br />
longueur totale<br />
longueur totale<br />
Combinaison<br />
+Moteur Page + Réducteur Page Longueur totale [mm] / voir: + Réducteur<br />
EC 32, 80 W 159 80.1<br />
EC 32, 80 W 159 GP 32, 0.75 - 219<br />
4.5 Nm<br />
EC 32, 80 W 159 GP 32, 1.0 - 6.0 Nm 221<br />
EC 40, 120 W 160 96.6<br />
EC 40, 120 W 160 GP 42, 3.0 - 15 Nm 224<br />
EC 40, 120 W 160 GP 52, 4.0 - 30 Nm 227<br />
EC 45, 150 W 161 111.2<br />
EC 45, 150 W 161 ●<br />
EC 45, 150 W 161 GP 52, 4.0 - 30 Nm 227<br />
EC 45, 250 W 162 144.0<br />
EC 45, 250 W 162 ●<br />
EC 45, 250 W 162 GP 52, 4.0 - 30 Nm 227<br />
EC 45, 250 W 162 GP 62, 8.0 - 50 Nm 229<br />
EC 60, 400 W 165 177.3<br />
EC 60, 400 W 165 ●<br />
Données techniques<br />
Tension d'entrée 10 V peak, 10 kHz Moment d'inertie du rotor 6 gcm 2<br />
Transformation 0.5 Poids 40 g<br />
Erreur électrique 10 minutes Plage de températures -55 +155°C
Plan<br />
4 Génération de mouvements<br />
Les différents problèmes<br />
Système de <strong>commande</strong> d’un robot<br />
5 Technologie<br />
Motorisation<br />
Mesure de position<br />
Variateurs de vitesse<br />
6 Commande<br />
Commande point-à-point<br />
Commande à mouvement opérationnel imposé
Variateurs de vitesse<br />
Objectifs <strong>et</strong> hypothèses<br />
principe de fonctionnement <strong>des</strong> variateurs de vitesse
Variateurs de vitesse<br />
Objectifs <strong>et</strong> hypothèses<br />
principe de fonctionnement <strong>des</strong> variateurs de vitesse<br />
cas du moteur à courant continu (mcc)
Variateurs de vitesse<br />
Objectifs <strong>et</strong> hypothèses<br />
principe de fonctionnement <strong>des</strong> variateurs de vitesse<br />
cas du moteur à courant continu (mcc)<br />
bibliographie : Techniques de l’Ingénieur
Variateurs de vitesse<br />
Objectifs <strong>et</strong> hypothèses<br />
principe de fonctionnement <strong>des</strong> variateurs de vitesse<br />
cas du moteur à courant continu (mcc)<br />
bibliographie : Techniques de l’Ingénieur<br />
Définition<br />
Variateur de vitesse : dispositif perm<strong>et</strong>tant de réaliser<br />
l’alimentation <strong>et</strong> la <strong>commande</strong> d’un moteur.
Schéma de principe<br />
FIGURE: Schéma général d’un variateur de vitesse [Louis2002]
Principe <strong>et</strong> modélisation du convertisseur statique<br />
Convertisseurs statiques<br />
Alimentation du moteur à partir d’un réseau électrique<br />
alternatif :
Principe <strong>et</strong> modélisation du convertisseur statique<br />
Convertisseurs statiques<br />
Alimentation du moteur à partir d’un réseau électrique<br />
alternatif :<br />
redresseur (conversion alternatif/continu)
Principe <strong>et</strong> modélisation du convertisseur statique<br />
Convertisseurs statiques<br />
Alimentation du moteur à partir d’un réseau électrique<br />
alternatif :<br />
redresseur (conversion alternatif/continu)<br />
hacheur (conversion continu/continu).
Principe <strong>et</strong> modélisation du convertisseur statique<br />
Convertisseurs statiques<br />
Alimentation du moteur à partir d’un réseau électrique<br />
alternatif :<br />
redresseur (conversion alternatif/continu)<br />
hacheur (conversion continu/continu).<br />
différents cas
Principe <strong>et</strong> modélisation du convertisseur statique<br />
Convertisseurs statiques<br />
Alimentation du moteur à partir d’un réseau électrique<br />
alternatif :<br />
redresseur (conversion alternatif/continu)<br />
hacheur (conversion continu/continu).<br />
différents cas<br />
source d’énergie : monophasé, triphasé
Principe <strong>et</strong> modélisation du convertisseur statique<br />
Convertisseurs statiques<br />
Alimentation du moteur à partir d’un réseau électrique<br />
alternatif :<br />
redresseur (conversion alternatif/continu)<br />
hacheur (conversion continu/continu).<br />
différents cas<br />
source d’énergie : monophasé, triphasé<br />
technologie <strong>des</strong> convertisseurs statiques : pont redresseur<br />
commandé ou non ; hacheur 1, 2 ou 4 quadrants
Cas triphasé, redresseur non commandé, hacheur 4Q<br />
FIGURE: Schéma du convertisseur statique [Louis2002]
Choix pour la variation de vitesse<br />
Alimentation<br />
source d’alimentation : dépend <strong>des</strong> besoins en termes de<br />
puissance<br />
systèmes embarqués : (réseau+re<strong>des</strong>seur) remplacé par<br />
<strong>des</strong> batteries
Choix pour la variation de vitesse<br />
Alimentation<br />
source d’alimentation : dépend <strong>des</strong> besoins en termes de<br />
puissance<br />
systèmes embarqués : (réseau+re<strong>des</strong>seur) remplacé par<br />
<strong>des</strong> batteries<br />
Hacheur<br />
choix le plus important pour la variation de vitesse<br />
hacheur 4Q : fonctionnement possible dans les différents<br />
mo<strong>des</strong> moteur, freinage (attention à la réversibilité de la<br />
source)
FIGURE: Fonctionnement 4 quadrants du hacheur [Louis2002]
Modèle du hacheur<br />
Aspect échantillonné<br />
Le hacheur fournit une tension de valeur moyenne réglable par<br />
le biais de son rapport cyclique α ∈ [0 1] : système<br />
échantillonné.<br />
Fréquence de commutation élevée en faibles puissances<br />
(typiquement 50 kHz pour P < 1kW ).
Modèle du hacheur<br />
Aspect échantillonné<br />
Le hacheur fournit une tension de valeur moyenne réglable par<br />
le biais de son rapport cyclique α ∈ [0 1] : système<br />
échantillonné.<br />
Fréquence de commutation élevée en faibles puissances<br />
(typiquement 50 kHz pour P < 1kW ).<br />
Modèle en continu<br />
Première approximation : source de tension continue de valeur<br />
réglable :<br />
relation tension d’alimentation du moteur/tension de<br />
<strong>commande</strong> du rapport cyclique = simple gain.
Modélisation du mcc<br />
i<br />
v<br />
c<br />
B<br />
ω<br />
i<br />
R<br />
L<br />
v<br />
e<br />
Equations<br />
V = Ri + L di<br />
dt + e,<br />
e = K e Ω,<br />
J dΩ<br />
dt<br />
= c − c 0 − f Ω,<br />
c = K m i.
Mise en équation du mcc<br />
i<br />
v<br />
c<br />
B<br />
ω<br />
i<br />
R<br />
L<br />
e<br />
v<br />
Equations<br />
V (s) = (R + Ls)I(s) + E(s),<br />
E(s) = K e Ω(s),<br />
JsΩ(s) = C(s) − C 0 (s) − f Ω(s),<br />
C(s) = K m I(s).<br />
Remarque : K e ≃ K m . On pose K em = K e = K m .
Schéma-bloc<br />
Analyse<br />
mcc = système à contre-réaction<br />
V (s)<br />
+<br />
E(s)<br />
−<br />
1<br />
R + Ls<br />
I(s)<br />
K em<br />
C(s) +<br />
C 0 (s)<br />
−<br />
1<br />
B + Js<br />
Ω(s)<br />
K em<br />
FIGURE: Schéma de principe d’un moteur à courant continu
Modèle<br />
En combinant les équations :<br />
R<br />
(f Ω(s) + JsΩ(s))+ L (<br />
)<br />
fsΩ(s) + Js 2 Ω(s) +K em Ω(s) = V (s).<br />
K em K em<br />
Fonction de transfert en vitesse<br />
ordre 2, classe 0<br />
G(s) = Ω(s)<br />
V (s) =<br />
K em<br />
LJ<br />
s 2 + ( R L + f J )s + Rf +K 2 em<br />
LJ<br />
.
Modèle en vitesse d’ordre un<br />
Hypothèse<br />
On néglige l’influence de l’inductance d’induit.<br />
Fonction de transfert en vitesse<br />
G(s) = Ω(s)<br />
V (s) =<br />
K<br />
1 + τ em s ,<br />
avec la constante de temps électromécanique du système <strong>et</strong> le gain<br />
statique :<br />
RJ<br />
K em<br />
τ em =<br />
Rf + Kem<br />
2 <strong>et</strong>K =<br />
Rf + Kem<br />
2 .<br />
ordre 1, un pôle stable p = −1/τ em
Modèle en vitesse d’ordre deux<br />
Première expression<br />
G(s) =<br />
K em<br />
LJ<br />
s 2 + ( R L + f J )s + Rf +K 2 em<br />
LJ<br />
Identification de la forme canonique :<br />
.<br />
G(s) =<br />
K Ω 2 n<br />
s 2 + 2ξΩ n s + Ω 2 .<br />
n
Modèle en vitesse d’ordre deux<br />
Seconde expression<br />
G(s) =<br />
K<br />
1 + (τ em + µτ el )s + τ el τ em s 2 ,<br />
avec la constante de temps électrique du système : τ el = L R .
Modèle en vitesse d’ordre deux<br />
Seconde expression<br />
G(s) =<br />
K<br />
1 + (τ em + µτ el )s + τ el τ em s 2 ,<br />
avec la constante de temps électrique du système : τ el = L R .<br />
Comme µ =<br />
Rf<br />
Rf +K 2 em<br />
Modèles en position<br />
Bien évidemment. . .<br />
G(s) = Θ(s)<br />
V (s) =<br />
K<br />
s(1 + τ el s)(1 + τ em s) .<br />
Le système possède trois pôles p 1 = 0, p 2 = −1/τ el <strong>et</strong><br />
p 3 = −1/τ em .
●<br />
●<br />
●<br />
●<br />
Plages d'utilisation Légende Explications page 49<br />
RE 36 36 mm, Commutation Graphite, 70 Watt<br />
maxon DC motor<br />
M 1:2<br />
Programme Stock<br />
Programme Standard<br />
Programme Spécial (sur demande!)<br />
Numéros de <strong>commande</strong><br />
118797 118798 118799 118800 118801 118802 118803 118804 118805 118806 118807 118808 118809 118810<br />
Caractéristiques moteur<br />
1 Puissance conseillée W 70 70 70 70 70 70 70 70 70 70 70 70 70 70<br />
2 Tension nominale Volt 18.0 24.0 32.0 42.0 42.0 48.0 48.0 48.0 48.0 48.0 48.0 48.0 48.0 48.0<br />
3 Vitesse à vide tr / min 6610 6210 6790 7020 6340 6420 5220 4320 3450 2830 2280 1780 1420 1180<br />
4 Couple de démarrage mNm 730 783 832 865 786 785 627 504 403 326 258 198 158 127<br />
5 Pente vitesse / couple tr / min / mNm 9.23 8.05 8.27 8.19 8.14 8.25 8.41 8.65 8.67 8.80 8.96 9.17 9.21 9.51<br />
6 Courant à vide mA 153 105 89 70 61 55 42 33 25 20 15 12 9 7<br />
7 Courant de démarrage A 28.6 21.5 18.7 15.3 12.6 11.1 7.22 4.80 3.06 2.04 1.30 0.784 0.501 0.334<br />
8 Résistance aux bornes Ohm 0.628 1.11 1.71 2.75 3.35 4.32 6.65 10.00 15.7 23.5 36.8 61.3 95.8 144<br />
9 Vitesse limite tr / min 8200 8200 8200 8200 8200 8200 8200 8200 8200 8200 8200 8200 8200 8200<br />
10 Courant permanent max. A 3.18 2.44 1.99 1.59 1.44 1.27 1.03 0.847 0.679 0.556 0.445 0.346 0.277 0.226<br />
11 Couple permanent max. mNm 81 88.8 88.5 89.8 90.4 90.1 89.8 89.0 89.2 88.8 88.1 87.3 87.2 85.8<br />
12 Puissance max. fournie à la tension nom. W 123 125 146 157 129 131 84.9 56.4 36.0 23.9 15.2 9.09 5.78 3.82<br />
13 Rendement max. % 84 85 86 86 86 86 85 84 82 81 79 77 75 72<br />
14 Constante de couple mNm / A 25.5 36.4 44.5 56.6 62.6 70.7 86.9 105 131 160 198 253 315 380<br />
15 Constante de vitesse tr / min / V 375 263 215 169 152 135 110 90.9 72.7 59.8 48.2 37.8 30.3 25.1<br />
16 Constante de temps mécanique ms 6 6 6 6 6 6 6 6 6 6 6 6 6 6<br />
17 Inertie du rotor gcm2 60.2 67.7 65.2 65.4 65.6 64.6 63.3 61.5 61.3 60.3 59.2 57.8 57.5 55.7<br />
18 Inductivité mH 0.10 0.20 0.30 0.49 0.60 0.76 1.15 1.68 2.62 3.87 5.96 9.70 15.10 21.90<br />
19 Résistance therm. carcasse / air ambiant K / W 6.4 6.4 6.4 6.4 6.4 6.4 6.4 6.4 6.4 6.4 6.4 6.4 6.4 6.4<br />
20 Résistance therm. rotor / carcasse K / W 3.4 3.4 3.4 3.4 3.4 3.4 3.4 3.4 3.4 3.4 3.4 3.4 3.4 3.4<br />
21 Constante de temps thermique du bobinage s 38 43 41 41 41 41 40 39 39 38 37 36 36 35<br />
Spécifications<br />
● Jeu axial 0.05 - 0.15 mm n [tr / min]<br />
Plage de puissance conseillée<br />
Charge maximum <strong>des</strong> roulements<br />
9000<br />
axiale (dynamique)<br />
70 Watt<br />
Plage de fonctionnement permanent<br />
non pré-contraint<br />
5.6 N 7000<br />
Compte tenu <strong>des</strong> resistances thermiques (lignes 19<br />
pré-contraint<br />
2.4 N<br />
<strong>et</strong> 20) la température maximum du rotor peut être<br />
radiale (à 5 mm de la face)<br />
28 N<br />
atteinte au valeur nominal de couple <strong>et</strong> vitesse <strong>et</strong> à<br />
Force de chassage (statique)<br />
110 N 5000<br />
la température ambiante de 25°C.<br />
(statique, axe soutenu)<br />
1200 N<br />
= Limite thermique.<br />
● Jeu radial avec roulements 0.025 mm 3000<br />
Fonctionnement intermittent<br />
● Température ambiante -20 ... +100°C<br />
La surcharge doit être de courte durée.<br />
● Température rotor max. +125°C 1000<br />
● Nombre de lames au collecteur 13<br />
100 200 300 M [mNm]<br />
● Poids du moteur 350 g<br />
0.5 1.0 1.5 2.0 2.5 3.0 I [A]<br />
118804 Moteur avec bobinage à haute résistance<br />
Aimant permanent à 2 pôles<br />
118797<br />
Les caractéristiques moteur du tableau sont <strong>des</strong><br />
Moteur avec bobinage à basse résistance<br />
2 4 6 8 10 12 I [A]<br />
valeurs nominales.<br />
Voir en page 43 les plages de tolérances.<br />
Construction modulaire maxon Aperçu à la page 17 - 21<br />
Des informations détaillées se trouvent sur le<br />
maxon selection program du CD-ROM ci-joint. Réducteur planétaire<br />
Codeur MR<br />
Pour ce moteur, les tolérances diffèrent de celles 32 mm<br />
256 - 1024 imp.,<br />
qui figurent dans notre spécification standard. 0.75 - 4.5 Nm<br />
3 canaux<br />
Voir page 219<br />
Voir page 239<br />
Réducteur planétaire<br />
Codeur HEDS 5540<br />
32 mm<br />
500 imp.,<br />
1.0 - 6.0 Nm<br />
3 canaux<br />
Voir page 220<br />
Voir page 242<br />
Réducteur planétaire<br />
Codeur HEDL 5540<br />
32 mm<br />
500 imp.,<br />
0.4 - 2.0 Nm<br />
Electronique recommandée:<br />
3 canaux<br />
Voir page 222<br />
ADS 50/5 page 259<br />
Voir page 244<br />
Réducteur planétaire<br />
ADS 50/10 259<br />
Génératrice DCT<br />
42 mm<br />
ADS_E 50/5, 50/10 260<br />
22 mm<br />
3 - 15 Nm<br />
EPOS 24/5 271<br />
0.52 V<br />
Voir page 224<br />
MIP 50 273<br />
Voir page 252<br />
Informations 17<br />
82 maxon DC motor Edition Juill<strong>et</strong> 2005 / Modifications réservées
Vitesse [tr / min]<br />
12000<br />
10000<br />
8000<br />
6000<br />
4000<br />
2000<br />
Domaine de fonctionnement<br />
intermittent<br />
Fonctionnement continu<br />
Plage de puissance conseillée<br />
20 40 60 80 Couple [mNm]<br />
0.5 1.0 1.5 2.0<br />
1 2 3 4 5 6<br />
Courant permanent max.<br />
Courant [A]<br />
Courant [A]<br />
ON<br />
cont<br />
ON<br />
Explications sur les pages 50 - 146<br />
Dessin dimensionnel<br />
Sur le CD-ROM, les croquis de dimension sont Ligne 5 Pente vitesse/couple<br />
Ligne 13 Rendement max. max [%]<br />
disponibles en format DXF en vue de leur importation<br />
dans n’importe quel système CAD. La pente vitesse / couple indique la force du moteur. (voir page 35 «Caractéristique de rendement»).<br />
n /M [tr/min/mNm]<br />
Le rendement dépend du courant ou de la vitesse<br />
Présentation <strong>des</strong> vues conforme à la méthode E Plus c<strong>et</strong>te courbe est plate, moins la vitesse est Le rendement maximal est dérivé de la relation<br />
(ISO).<br />
sensible aux variations de la charge. La pente vitesse<br />
/ couple est calculée à une température de<br />
entre la marche à vide <strong>et</strong> le courant de démarrage.<br />
Toutes les dimensions sont exprimées en [mm].<br />
bobinage de 25°C.<br />
Ligne 14 Constante de couple k M [mNm / A]<br />
Taraudage de montage dans le plastique<br />
La constante de couple, ou couple spécifique, est le<br />
Ligne 6 Courant à vide I<br />
La réalisation de connexions vissées sur <strong>des</strong> flasques<br />
plastiques nécessite une attention spéciale.<br />
o [mA]<br />
quotient du couple fourni <strong>et</strong> du courant s’y rapportant.<br />
C’est le courant qui s’établit lorsque le moteur est à<br />
vide. Il dépend du frottement <strong>des</strong> balais <strong>et</strong> du frottement<br />
à l’intérieur <strong>des</strong> paliers, il se modifie légère-<br />
Ligne 15 Constante de vitesse k n [tr/min/V]<br />
Couple de serrage maximal [Ncm]<br />
Un tournevis automatique doit être ajusté à c<strong>et</strong>te<br />
ment avec la vitesse.<br />
Elle indique la vitesse spécifique par Volt de la tension<br />
appliquée, sans tenir compte <strong>des</strong> pertes par<br />
valeur d’étalonnage.<br />
Ligne 7 Courant de démarrage<br />
frottement. La valeur inverse de la constante de vitesse<br />
est la constante de tension, aussi appelée<br />
Profondeur active de vissage [mm]<br />
I A [mA], [A]<br />
La relation entre la profondeur de vissage <strong>et</strong> le diamètre<br />
du pas de vis doit être au moins de 2 : 1.La profon-<br />
C’est le rapport de la tension nominale (tension aux constante FEM.<br />
bornes) <strong>et</strong> de la résistance du moteur. Il est obtenu<br />
deur de vissage ne doit en aucun cas dépasser la longueur<br />
utile de taraudage!<br />
m [ms]<br />
au couple de blocage.<br />
Ligne 16 Constante de temps mécanique<br />
<br />
Ligne 8 Résistance aux bornes R[] C’est le temps nécessaire au rotor (sans charge extérieure),<br />
pour passer de la vitesse 0à63%<strong>des</strong>a<br />
C’est la résistance mesurée à 25°C aux bornes<br />
de connection. Elle détermine, sous une tension vitesseàvide.<br />
Caractéristiques<br />
U donnée, le courant de démarrage. Dans le cas<br />
de balais en graphite, la résistance de contact Ligne 17 Moment d’inertie du rotor J R [gcm 2 ]<br />
Ligne 1 ● Puissance conseillée P 2T [W] varie en fonction de la charge.<br />
C’est le moment d’inertie de masse du rotor, basée<br />
C’est la puissance max. fournie, dans la plage de<br />
sur l’axe de rotation.<br />
puissances conseillée. Elle dépend <strong>des</strong> types <strong>et</strong><br />
Ligne 9 Vitesse limite n max [tr / min]<br />
correspond à la représentation du Guide de Sélection<br />
(voir également pages 50-146 «Plages d’utilionnement<br />
normal, un dépassement intempestif C’est l’inductivité du bobinage lorsque le rotor est à<br />
La vitesse limite ne doit pas être dépassée en foncti-<br />
Ligne 18 Inductance terminale L[mH]<br />
sation»).<br />
endommagerait la commutation, m<strong>et</strong>tant ainsi le l’arrêt, mesurée à l’aide d’une tension sinusoïdale<br />
moteur en panne.<br />
à1kHz.<br />
Ligne 2 Tension nominale U[Volt]<br />
C’est la tension à laquelle se réfèrent toutes les valeurs<br />
nominales (lignes 3, 4, 6, 7, 12, 13).Elle est fixée<br />
Ligne 10 Courant permanent max.<br />
Ligne 19 Résistance thermique<br />
I cont [mA], [A]<br />
R th2 [K / W]<br />
pour que la vitesse à vide ne dépasse pas la vitesse C’est le courant qui, à une température ambiente de C’est la résistance thermique entre la carcasse <strong>et</strong><br />
maximale admissible. Mais l’utilisation du moteur 25°C, fait monter la température du rotor à sa limite l’air ambiant. Valeur théorique sans aucun refroidisseur<br />
additionnel. L’addition <strong>des</strong> lignes 19 <strong>et</strong> 20<br />
n’est pas limitée par c<strong>et</strong>te tension. Pour atteindre la max. admissible.<br />
puissance assignée (ligne 1), il est possible d’utiliser<br />
perm<strong>et</strong> de définir la puissance dissipée max.<br />
une tension de service plus haute. La puissance Ligne 11 Couple permanent max.<br />
Admissible. Sur les moteurs à flasque métallique,<br />
maximale de sortie est alors plus élevée (ligne 12).<br />
M cont [mNm]<br />
la résistance thermique R th2 peut être réduite jusqu'à<br />
50 %, à condition que le moteur soit couplé<br />
C’est le couple délivré en permanence ou en valeur<br />
Ligne 3 Vitesse à vide n o [tr / min]<br />
moyenne, qui élève la température du bobinage jusqu’à<br />
sa valeur max. admissible. On se base sur une tallique) au lieu d'une plaque en matière synthéti-<br />
directement à un bon conducteur thermique (mé-<br />
C’est la vitesse atteinte par le moteur sans charge<br />
additionnelle <strong>et</strong> alimenté à la tension nominale. Elle température ambiante de 25°C.<br />
que.<br />
est pratiquement proportionnelle à la tension appliquée.<br />
Ligne 12 Puissance max. fournie<br />
Ligne 20 Résistance thermique<br />
P max [mW], [W]<br />
R th1 [K / W]<br />
Ligne 4 Couple de démarrage M H [mNm] C’est la puissance max. disponible à la tension nominale<br />
<strong>et</strong> à une température rotor de 25°C. Les va-<br />
Idem entre rotor <strong>et</strong> carcasse.<br />
Ce couple est appliqué sur l’arbre pour obtenir<br />
l’arrêt à tension nominale. La croissance rapide de leurs d’utilisation se situent en-<strong>des</strong>sous de c<strong>et</strong>te<br />
Ligne 21 Constante de temps thermique du<br />
bobinage <br />
la température du moteur provoque la baisse du puissance (voir «courant max. permanent» <strong>et</strong> «vitesse<br />
limite»).<br />
C’est le temps nécessité par le bobinage pour modi-<br />
w [s]<br />
couple de démarrage (Voir page 38 «Comportement<br />
thermique»).<br />
fier sa température.<br />
maxon DC motor<br />
Plages d'utilisation Légende Exemple de la page 78<br />
Plage de puissance conseillée<br />
Plage de fonctionnement permanent<br />
Compte tenu <strong>des</strong> resistances thermiques<br />
(lignes 19 <strong>et</strong> 20) la température maximum du<br />
rotor peut être atteinte au valeur nominal de<br />
couple <strong>et</strong> vitesse <strong>et</strong> à la température ambiante<br />
de 25°C = Limite thermique.<br />
Fonctionnement intermittent<br />
La surcharge doit être de courte durée<br />
(voir page 36).<br />
118757 Moteur avec bobinage à haute résistance (Ligne 8)<br />
118749 Moteur avec bobinage à haute résistance (Ligne 8)<br />
Fonctionnement intermittent<br />
T<br />
5<br />
4<br />
Temps<br />
3<br />
2<br />
1<br />
0<br />
10 20 30 40 50 60 70 80 90 ON%<br />
Le diagramme du domaine de fonctionnement décrit<br />
la plage de puissance mécanique livrable par le bobinage.<br />
Il illustre les points de fonctionnement possibles<br />
en fonction de la vitesse <strong>et</strong> du couple.Pour deux<br />
bobinages sélectionnés, l’un à faible, l’autre à forte<br />
résistance, le couple figure en échelle de puissance<br />
(Ligne 8).<br />
ON Moteur en service<br />
OFF Moteur stationnaire<br />
ÎON Courant de pointe max.<br />
Icont Courant max. admissible en service continu (Ligne 10)<br />
tON Temps d’enclenchement, à ne pas dépasser w (Lg. 21)<br />
T Temps de cycle tON +tOFF [s]<br />
tON% Temps d’enclenchement en % du temps de cycle<br />
Pendant une durée d’enclenchement de X %, le moteur peut<br />
être surchargé dans le rapport ION /Icon<br />
Edition Juill<strong>et</strong> 2005 / Modifications réservées maxon DC motor 49<br />
I<br />
I<br />
t<br />
T
Nécessité d’un asservissement de courant<br />
Fonction de transfert en courant<br />
2 pôles, 1 zéro<br />
G I (s) = I(s)<br />
V (s) =<br />
Js + f<br />
LJs 2 + (RJ + Lf )s + Rf + Kem<br />
2 .<br />
FIGURE: Réponse en boucle ouverte du mcc (non chargé)
Nécessité d’un asservissement de courant<br />
Risque<br />
Dépassements de courant dans le hacheur, dans le circuit<br />
d’induit du mcc = eff<strong>et</strong>s <strong>des</strong>tructeur. Besoin :<br />
d’asservir le courant pour avoir la maîtrise <strong>des</strong><br />
dépassements ;<br />
de limiter le courant maximum pour protéger le moteur<br />
dans tous les cas.
Synthèse de l’asservissement de courant<br />
Approches<br />
utilisation de G I (s)
Synthèse de l’asservissement de courant<br />
Approches<br />
utilisation de G I (s)<br />
raisonnement approché : fém variant<br />
lentement=perturbation d’où :<br />
G I (s) =<br />
1<br />
R + Ls = 1 1<br />
R 1 + τ e s
Synthèse de l’asservissement de courant<br />
Ordre 1, classe 0, correction PI : CI(s) = K p (1 + 1<br />
τ i s ) :<br />
C I (s)G I (s) = K p 1 + τ i s<br />
Rτ i s(1 + τ e s) .<br />
Réglage<br />
Compensation du pôle électrique, d’où BF :<br />
G IBF (s) = 1 k i<br />
1<br />
1 + Rτ i<br />
K pk i<br />
s<br />
avec k i gain du capteur assurant la mesure de courant.<br />
Temps de réponse de la boucle de courant = fonction de K p .
Remarques sur l’asservissement de courant<br />
Remarque 1<br />
Hacheur=gain occulte le r<strong>et</strong>ard introduit par le hacheur<br />
Remarque 2<br />
Asservissement de courant analogique : coût <strong>et</strong> performances
Asservissements de vitesse <strong>et</strong> position<br />
Préalable<br />
Boucle de courant réglée, asservissement avec boucles<br />
imbriquées ou asservissement cascade<br />
V r (s)<br />
+<br />
C Ω (s)<br />
+<br />
C I (s)<br />
V (s)<br />
mcc<br />
Ω(s)<br />
−<br />
−<br />
K i<br />
I(s)<br />
V Ω (s) = K ωΩ(s)<br />
K ω<br />
FIGURE: Asservissement de vitesse d’un moteur à courant continu
Synthèses<br />
Synthèse de l’asservissement de vitesse<br />
Réécriture <strong>des</strong> équations dynamiques du mcc asservi en<br />
courant.<br />
Modèle d’ordre deux <strong>et</strong> de classe 0 : correction PI.<br />
Synthèse de l’asservissement de position<br />
Idem.<br />
Modèle d’ordre trois <strong>et</strong> de classe 1 : correction avance de<br />
phase.
Remarques<br />
Analogique ou numérique <br />
Choix dépend du type de moteur<br />
mcc=<strong>commande</strong> analogique suffisante (coût)<br />
moteurs à courants continus sans collecteur= <strong>commande</strong><br />
numérique : réalisation <strong>des</strong> asservissements nécessite<br />
<strong>des</strong> fonctions non linéaires (processeur)
Protection en courant<br />
FIGURE: Schéma général d’un variateur de vitesse [Louis2002]<br />
Limitation de courant<br />
Saturation de la <strong>commande</strong> de la boucle de courant par une<br />
tension égale à ±k i I M
Mise en garde<br />
Attention !<br />
Un certain nombre de protections ne sont pas présentes sur un<br />
variateur de vitesse :
Mise en garde<br />
Attention !<br />
Un certain nombre de protections ne sont pas présentes sur un<br />
variateur de vitesse :<br />
mise en court-circuit de la sortie du variateur : <strong>des</strong>truction<br />
du variateur
Mise en garde<br />
Attention !<br />
Un certain nombre de protections ne sont pas présentes sur un<br />
variateur de vitesse :<br />
mise en court-circuit de la sortie du variateur : <strong>des</strong>truction<br />
du variateur<br />
pas de protection en général contre une inversion <strong>des</strong><br />
tensions d’alimentation.
Le programme <strong>des</strong> asservissements de<br />
--<br />
--<br />
--<br />
maxon motor control<br />
Technique – sans détour<br />
moteurs maxon contient une gamme de servoamplificateurs<br />
pour <strong>commande</strong>r les moteurs<br />
DC <strong>et</strong> EC hautement dynamique.<br />
Grandeurs commandées<br />
Vitesse<br />
La tâche d’un servoamplificateur pour régulation<br />
de vitesse consiste à maintenir la vitesse<br />
de rotation aussi constante que possible quelles<br />
que soient les variations de couple demandées<br />
au moteur. Pour atteindre ce but,<br />
l’électronique de régulation du servoamplificateur<br />
compare en permanence la valeur de consigne<br />
(vitesse <strong>des</strong>irée) avec la valeur réelle<br />
instantanée (vitesse effective). La différence<br />
entre les deux valeurs sert à piloter l’étage de<br />
puissance du servoamplificateur de telle manière<br />
que le moteur amenuise la différence de<br />
vitesse. On dispose ainsi d’un circuit de régulation<br />
de vitesse en boucle fermée.<br />
Position<br />
Le régulateur de position s’efforce de faire<br />
coïncider la position actuelle mesurée avec la<br />
position désirée - de la même manière que le<br />
régulateur de vitesse - en donnant au moteur<br />
les valeurs de correction. L’information sur la<br />
position est généralement délivrée par un<br />
codeur digital.<br />
Courant<br />
Le régulateur de courant alimente le moteur<br />
avec une intensité proportionnelle à la valeur<br />
de consigne. Ainsi le couple du moteur est proportionnel<br />
à la consigne.<br />
Le régulateur de courant améliore aussi la dynamique<br />
d’un circuit de régulation de position<br />
ou de vitesse supérieur.<br />
Régulation par codeur digital<br />
Le moteur est équipé d’un codeur digital<br />
qui délivre un nombre donné d’impulsions à<br />
chaque tour du rotor. Les impulsions rectangulaires<br />
<strong>des</strong> canaux A <strong>et</strong> B sont décalées de<br />
90° pour perm<strong>et</strong>tre de déterminer le sens de<br />
rotation.<br />
Les codeurs digitaux sont surtout utilisés<br />
pour assurer le positionnement <strong>et</strong> pour<br />
détecter un déplacement angulaire.<br />
Les codeurs digitaux ne sont soumis à<br />
aucune usure.<br />
En liaison avec un régulateur digital, ils ne<br />
provoquent aucun eff<strong>et</strong> de dérive.<br />
Principe: Régulation par codeur<br />
Valeur de consigne<br />
maxon motor control<br />
-<br />
Valeur réelle<br />
M<br />
E<br />
n<br />
Compensation R x I<br />
Une tension proportionnelle à la valeur de consigne<br />
est appliquée au moteur. Si la charge<br />
augmente, la vitesse de rotation diminue. Le<br />
circuit de compensation augmente alors la tension<br />
de sortie, avec un accroissement du courant<br />
dans le moteur. C<strong>et</strong>te compensation doit<br />
être ajustée à la résistance interne du moteur.<br />
C<strong>et</strong>te résistance varie avec la température <strong>et</strong><br />
avec la charge appliquée.<br />
La précision du réglage de la vitesse que l’on<br />
peut obtenir dans de tels systèmes est de l’ordre<br />
de quelques pour cents<br />
Économie en prix <strong>et</strong> en place<br />
Pas de génératrice DC ou de<br />
codeur nécessaire<br />
Régulation peu précise en cas de forte variation<br />
de la charge<br />
Régulation de vitesse uniquement<br />
Idéal pour les applications «Low Cost» qui<br />
n’exigent pas une vitesse très précise<br />
Principe: Compensation R x I<br />
Valeur de consigne<br />
maxon motor control<br />
-<br />
I<br />
M<br />
U<br />
Valeur réelle<br />
Schéma d’un circuit de régulation<br />
Valeur de consigne<br />
maxon motor control<br />
Déviation du système<br />
Contrôleur<br />
-<br />
étage de puissance<br />
(actuateur)<br />
Moteur<br />
n<br />
Valeur réelle<br />
Capteur<br />
32
Edition Juill<strong>et</strong> 2005 / Modifications réservées maxon motor control 259<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
●<br />
4-Q-DC Servoamplificateur ADS en boîtier modulaire<br />
Données électriques<br />
● Tension de service VCC 12 - 50 VDC<br />
ondulation résiduelle < 5 %<br />
● Tension de sortie max. 0.9 x VCC<br />
Courant de sortie Imax:<br />
ADS 50/10 POWER<br />
20 A<br />
ADS 50/5 STANDARD<br />
10 A<br />
Courant de sortie continu Icont:<br />
ADS 50/10 POWER<br />
10 A<br />
Power<br />
ADS 50/5 STANDARD<br />
5 A<br />
Alimentation<br />
● Cadence de l’étage final 50 kHz<br />
● Connexions du moteur<br />
Rendement max. 95 %<br />
●<br />
LED<br />
Largeur de bande de réglage 2.5 kHz<br />
Indicateur de l'état<br />
Self interne du moteur:<br />
ADS 50/10 POWER 75 H /10A<br />
Signal<br />
ADS 50/5 STANDARD 150 H /5A<br />
Connexion pour les entrées<br />
Connexion pour les sorties<br />
Entrées<br />
Connexion génératrice tachymétrique<br />
● Valeur de consigne «S<strong>et</strong> value» -10 ... +10 V<br />
Encoder<br />
(Ri =20k)<br />
Connexion codeur digital<br />
● Circuit libre «Enable» +4 ... +50 V<br />
Commutateur DIP<br />
(Ri =15k)<br />
Choix du mode de réglage<br />
Génératrice DC<br />
min. 2 VDC, max. 50 VDC (Ri =14k)<br />
Potentiomètres<br />
Signaux codeurs<br />
Ajustement de l'équilibrage<br />
Canal A, A\, B, B\, max. 100 kHz, TTL<br />
maxon motor control<br />
Dimensions en [mm]<br />
Sorties<br />
Moniteur courant «Monitor I», protégé contre<br />
les courts-circuits<br />
-10 … +10 VDC<br />
(Ro = 100 )<br />
Moniteur vitesse «Monitor n», protégé contre<br />
les courts-circuits<br />
-10 … +10 VDC<br />
(Ro = 100 )<br />
Message de surveillance «READY»<br />
Open collector<br />
max. 30 VDC<br />
(IL
Plan<br />
4 Génération de mouvements<br />
Les différents problèmes<br />
Système de <strong>commande</strong> d’un robot<br />
5 Technologie<br />
Motorisation<br />
Mesure de position<br />
Variateurs de vitesse<br />
6 Commande<br />
Commande point-à-point<br />
Commande à mouvement opérationnel imposé
Plan<br />
4 Génération de mouvements<br />
Les différents problèmes<br />
Système de <strong>commande</strong> d’un robot<br />
5 Technologie<br />
Motorisation<br />
Mesure de position<br />
Variateurs de vitesse<br />
6 Commande<br />
Commande point-à-point<br />
Commande à mouvement opérationnel imposé
Principe de la génération de mouvement<br />
Tâche<br />
Atteindre une position <strong>et</strong> une orientation désirées x f , à partir<br />
d’une configuration de départ q 0 = <br />
Génération de mouvements dans l’espace articulaire.<br />
x f<br />
MGI<br />
q f<br />
génération<br />
de mouvement<br />
q r (t)<br />
variateur<br />
robot<br />
q 0<br />
q(t)<br />
capteur
Principe de la génération de mouvement<br />
Mouvement articulaire<br />
En toute généralité :<br />
q(t) = q 0 + (q f − q 0 )P(t), ∀0 t t f<br />
P(t)= fonction d’interpolation, t.q. P(0) = 0 <strong>et</strong> P(t f ) = 1<br />
1- Conditions aux limites :<br />
q(0) = q 0 , q(t f ) = q f , ˙q(0) = 0, ˙q(t f ) = 0, ¨q(0) = 0, ˙q(t f ) = 0<br />
2- Contraintes :<br />
| ˙q(t)| ω m , |¨q(t)| γ m , ∀0 t t f<br />
avec ω m / γ m : vitesses/accélérations articulaires maximales :<br />
ω m dépend de la vitesse admissible pour le moteur/la transmission<br />
γ m = (grossièrement) rapport du couple maximum sur l’inertie de l’axe
Interpolation polynomiale de degré cinq<br />
Polynôme interpolateur<br />
Autant de degrés de liberté qu’il y a de contraintes : ordre 5.<br />
Mouvement C 2 en position, vitesse <strong>et</strong> accélération, vérifiant :<br />
q(0) = q 0 , q(t f ) = q f , ˙q(0) = 0, ˙q(t f ) = 0, ¨q(0) = 0, ˙q(t f ) = 0<br />
Avec P(t) = p 0 + p 1 t + p 2 t 2 + p 3 t 3 + p 4 t 4 + p 5 t 5 :<br />
p 0 , p 1 , p 2 = 0<br />
P(t) = 10<br />
(<br />
t<br />
t f<br />
) 3<br />
− 15<br />
(<br />
t<br />
t f<br />
) 4<br />
+ 6<br />
(<br />
t<br />
t f<br />
) 5,<br />
d’où q(t)<br />
Vitesse / accélération maximale pour la i−ème<br />
articulation :<br />
ω mi = 15|q i(t f ) − q i (0)|<br />
8t f<br />
, γ mi = 10|q i(t f ) − q i (0)|<br />
√<br />
3t<br />
2<br />
f<br />
ω mi <strong>et</strong> γ mi imposés calcul de t f minimal<br />
A faire pour l’ensemble <strong>des</strong> articulations (2n contraintes)
Interpolation polynomiale de degré cinq<br />
Cas q 0 = 0, q f = π 2 , ω m = 4 rad.s −1 <strong>et</strong> γ m = 1, 5 rad.s −2 .<br />
t f résulte alors de la contrainte d’accélération : t f = 1, 74 s.
Loi Bang-bang<br />
Commande Bang Bang<br />
Mouvements à temps minimal : accélération = ±γ m .<br />
Mouvement C 2 en position <strong>et</strong> vitesse seulement :<br />
q(0) = q 0 , q(t f ) = q f , ˙q(0) = 0, ˙q(t f ) = 0<br />
Mouvement :<br />
( ) t 2<br />
q(t) = q 0 + 2 (q<br />
t f − q 0 ), pour 0 t t f<br />
f 2<br />
( ( ) ( ) )<br />
t t<br />
2<br />
q(t) = q 0 + −1 + 4 − 2 (q<br />
t f t f − q 0 ), pour t f<br />
f 2 t t f
Loi Bang-bang<br />
Commande Bang Bang<br />
Mouvements à temps minimal : accélération = ±γ m .<br />
Mouvement C 2 en position <strong>et</strong> vitesse seulement :<br />
q(0) = q 0 , q(t f ) = q f , ˙q(0) = 0, ˙q(t f ) = 0<br />
On peut montrer que, pour la i−ème articulation :<br />
ω mi = |q i(t f ) − q i (0)|<br />
, pour 0 t t f<br />
t f<br />
2<br />
γ mi = 4|q i(t f ) − q i (0)|<br />
tf<br />
2 , pour t f<br />
2 t t f<br />
ω mi <strong>et</strong> γ mi imposés calcul de t f minimal<br />
A faire pour l’ensemble <strong>des</strong> articulations (2n contraintes)
Loi Bang-Bang<br />
Cas q 0 = 0, q f = π 2 , ω m = 4 rad.s −1 <strong>et</strong> γ m = 1, 5 rad.s −2 .<br />
t f résulte alors de la contrainte d’accélération : t f = 1, 44 s.
Loi trapézoïdale en vitesse<br />
Principe<br />
Loi Bang-Bang : commutations instantanées fréquentes.<br />
Loi trapézoïdale en vitesse, avec paliers à vitesse constante.
Loi trapézoïdale en vitesse<br />
Principe<br />
Loi Bang-Bang : commutations instantanées fréquentes.<br />
Loi trapézoïdale en vitesse, avec paliers à vitesse constante.<br />
On peut montrer que, pour la i−ème articulation :<br />
q i (t) = q i (0) + 1 2 ε it 2 γ mi , pour 0 t τ i<br />
(<br />
q i (t) = q i (0) + ε i t − τ )<br />
i<br />
ω mi , pour τ i t t<br />
2<br />
f − τ i<br />
q i (t) = q i (t f ) − 1 2 ε i (t f − t) 2 γ mi , pour t f − τ i t t f<br />
avec ε i = signe(q i (t f ) − q i (0)) <strong>et</strong> τ i = ωm<br />
γ m<br />
.
Loi trapézoïdale en vitesse<br />
Principe<br />
Loi Bang-Bang : commutations instantanées fréquentes.<br />
Loi trapézoïdale en vitesse, avec paliers à vitesse constante.<br />
Temps minimal pour une articulation :<br />
t f = τ i + |q i(t f ) − q i (0)|<br />
ω mi<br />
(1)<br />
Besoin de synchroniser les articulations : même t f <strong>et</strong> τ i<br />
Pour en savoir plus [Khalil-2013].
Plan<br />
4 Génération de mouvements<br />
Les différents problèmes<br />
Système de <strong>commande</strong> d’un robot<br />
5 Technologie<br />
Motorisation<br />
Mesure de position<br />
Variateurs de vitesse<br />
6 Commande<br />
Commande point-à-point<br />
Commande à mouvement opérationnel imposé
Position du problème
Problèmes à mouvement opérationnel imposé<br />
Tâche à mouvement opérationnel imposé<br />
Calcul les <strong>commande</strong>s articulaires du robot perm<strong>et</strong>tant de<br />
suivre une trajectoire opérationnelle au cours du temps = <br />
x r (t) résulte d’une génération, ou bien est défini par la tâche,<br />
puis calcul de q r (t) par inversion de modèle.<br />
x f<br />
génération<br />
de mouvement<br />
x 0<br />
x r (t)<br />
+<br />
x(t)<br />
−<br />
cinématique<br />
inverse<br />
MGD<br />
q r (t)<br />
variateur robot<br />
q(t)<br />
capteur
Problème à mouvement opérationnel imposé<br />
Position du problème<br />
Calculer les consignes pour le variateur, afin que x(t)<br />
corresponde à x r (t) désirée, i.e. réguler à zéro :<br />
Données du problème :<br />
q 0 , qui est mesurée<br />
e(t) = x r (t) − x(t)<br />
mouvement de consigne x r (t)<br />
modèle cinématique : ẋ = J(q) ˙q<br />
Deux types de problèmes :<br />
1 quand e(0) = x r (0) − x 0 = 0 : suivi<br />
2 quand e(0) = x r (0) − x 0 ≠ 0 : poursuite
Solution (cinématique) en boucle fermée<br />
Loi de <strong>commande</strong> (robot non redondant)<br />
Loi cinématique :<br />
˙q(t) = J −1 (t) (ẋ r (t) + W (x r (t) − x(t)))<br />
avec W définie positive<br />
d<br />
dt<br />
ẋ r (t)<br />
génération<br />
de mouvement<br />
x r (t)<br />
+<br />
x(t)<br />
−<br />
W<br />
+<br />
+<br />
J −1<br />
variateur<br />
q(t)<br />
robot<br />
MGD<br />
capteur
Quelques remarques<br />
Modèle géométrique inverse numérique<br />
Situation désirée obtene itérativement : utilisable pour trouver<br />
une solution numérique au modèle géométrique inverse.<br />
Commande référencée capteur<br />
Asservissement sur <strong>des</strong> informations donnant une image de la<br />
situation de l’organe terminal.<br />
Typiquement : position dans l’image d’une caméra d’indices<br />
visuels (points, droites, <strong>et</strong>c.), que l’on cherche à placer de<br />
manière à positionner l’organe terminal indirectement.<br />
Modèle d’inversion à adapter....