27.01.2015 Views

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

SHOW MORE
SHOW LESS

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....

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!