Plan du cours

UPJV, Département EEA M1 EEAII

Parcours ViRob

Fabio MORBIDI

Laboratoire MIS

Équipe Perception et Robotique E-mail: [email protected]

Année Universitaire 2015/2016

Mardi 9h00-12h00, Mercredi 13h30-16h30, Salle 8

Plan du cours

Chapitre 1 : Introduction

1.1 Définitions

1.2 Constituants d’un robot 1.3 Classification des robots 1.4 Caractéristiques d’un robot 1.5 Générations de robots

1.6 Programmation des robots 1.7 Utilisation des robots

Chapitre 2 : Fondements Théoriques 2.1 Positionnement

•  Rotation et représentations de la rotation

•  Attitude et matrices homogènes

Plan du cours

Chapitre 3 : Modélisation d’un Robot

2.2 Cinématique

•  Vitesse d’un solide

•  Vecteur vitesse de rotation

•  Mouvement rigide

•  Torseur cinématique

3.1 Modèle géométrique

•  Convention de Denavit-Hartenberg

•  Modèle géométrique direct

•  Modèle géométrique inverse 3.2 Modèle cinématique

•  Modèle cinématique direct

•  Modèle cinématique inverse 3.3 Modèle dynamique

•  Formulation de Lagrange

base

effecteur

θ

1

θ

2

θ

4

d

3

Modèle géométrique direct (MGD): étant données les positions articulaires (distance resp. angle pour une articulation prismatique resp. rotoïde) trouver la pose de l’effecteur par rapport à la base

Modèle géométrique inverse

Modèle géométrique inverse (MGI): étant donnée une pose de l’effecteur par rapport à la base, trouver, si elles existent, l’ensemble des positions articulaires qui permettent de générer cette pose

q = [q

1

, q

2

, . . . , q

n

]

^T

?

Problème direct

Si les variables des articulations sont connues, la pose de l’effectuer peut être calculée d’une manière unique en utilisant la matrice de transformation homogène:

Modèle géométrique inverse

Problème inverse

Il s'agit de déterminer les coordonnées articulaires permettant d'obtenir une situation désirée pour l’effecteur

Problème beaucoup plus difficile pour les raisons suivantes:

1.  Les équations à résoudre sont, en général, non linéaires.

En conséquence, il n’est pas toujours possible de trouver une solution de forme fermée (c’est-à-dire, une solution explicite)

2.  Le problème peut avoir des solutions multiples

3.  Le problème peut avoir un nombre infini de solutions (par ex. pour des robots cinématiquement redondants)

4.  Le problème peut n'avoir aucune solution admissible à cause de la structure cinématique du manipulateur

T

⁰_n

(q) = A

⁰₁

(q

₁

) A

¹₂

(q

₂

) · · · A

ⁿ⁻¹_n

(q

_n

)

Modèle géométrique inverse

Solutions multiples

•  Ça depend du nombre de DDL du robot mais aussi du nombre de paramètres de DH qui sont différents de zéro

•  En général, plus le nombre de paramètres de DH différents de zéro est grand, plus le nombre des solutions admissibles est grand

•  Pour un manipulateur à 6 DDL sans des butées mécaniques sur les articulations, il y a, en général, 16 solutions admissibles.

On a donc besoin de trouver des critères pour choisir parmi ces solutions admissibles

•  La presence de butées mécaniques sur les articulations des robots réels peut, éventuellement, reduire le nombre de solutions multiples admissibles

Modèle géométrique inverse

Solutions de forme fermée

Pour trouver des solutions de forme fermée est nécessaire de la:

•  Intuition algébrique pour trouver les équations significatives qui contiennent les inconnues

ou

•  Intuition géométrique pour trouver des points significatifs sur le robot que peuvent être utilisés pour exprimer la position et/ou orientation en fonction du nombre des inconnues

Solutions numériques

Lorsque il n’y a pas des solutions de forme fermée ou elles sont difficiles à déterminer, on peut calculer une solution particulière du problème inverse par des procédures numériques (méthodes itératives d'optimisation non linéaire ou l'algorithme de Levenberg-Marquardt)

•  Avantage: on peut appliquer les méthodes numeriques à tous les robots

•  Inconvénients: les méthodes numériques ne trouvent pas, en général, toutes les solutions admissibles. Ils trouvent une solution locale au sens où elle dépend des conditions initiales. Ces méthodes sont pénalisantes du point de vue du

temps de calcul

Exemple 1: robot planaire à 2 segments (RP)

On a le modèle géométrique direct suivant:

P

p

x

p

y

θ

1

d

2

p

x

= d

2

cos θ

1

p

y

= d

2

sin θ

1

Une démarche analytique simple permet de déterminer le modèle géométrique inverse. En effet, nous avons que :

d

2

=

p

²_x

+ p

²_y

θ

1

= arctan(p

y

/p

x

),

q = [θ

₁

, d

2

]

^T

? [p

x

, p

y

]

^T donné.

Problème

Problème: étant données la position et l’orientation de l’effecteur, déterminer les variables θ , θ , θ des trois articulations rotoïdes

θ

1

θ

2

θ

₃

Exemple 2: manipulateur planaire à 3 segments

φ

W

q = [θ

1

, θ

2

, θ

3

]

^T

?

•  On a déjà vu que la matrice de transformation totale pour ce manipulateur est (cf. la première partie du Ch. 3.1):

T⁰₃(q) = A⁰₁A¹₂A²₃ =

⎡

⎢⎢

⎢⎣

c123 −s123 0 a1c1 +a2c12 + a3c123

s123 c123 0 a1s1 +a2s12 +a3s123

0 0 1 0

0 0 0 1

⎤

⎥⎥

⎥⎦

où et

q = [θ

1

, θ

2

, θ

3

]

^T

•  Il convient de spécifier la position et orientation de l’effecteur en utilisant un nombre minimal de paramètres

•  On peut utiliser les coordonnées

p

_x ,

p

_y et l’angle entre l’effecteur et l’axe

φ x

₀:

⎡

⎢ ⎣ p

_x

p

y

φ

⎤

⎥ ⎦ = f (q) =

⎡

⎢ ⎣

a

₁

c

₁

+ a

₂

c

₁₂

+ a

₃

c

₁₂₃

a

1

s

1

+ a

2

s

12

+ a

3

s

123

θ

₁

+ θ

₂

+ θ

₃

⎤

⎥ ⎦

T

⁰₃

Élément (1,4) de

T

⁰₃

Élément (2,4) de Somme des variables articulaires

c

12

= cos(θ

1

+ θ

2

), s

123

= sin(θ

1

+ θ

2

+ θ

3

) c

1

= cos θ

1

,

Exemple 2: manipulateur planaire à 3 segments

1 - Solution algébrique

Si est spécifié, la 1ère équation du système à resoudre est:

•  À partir du modèle direct, on trouve que:

Position du point W

(origine du repère 2)

φ

En revanche si n’est pas spécifié, le manipulateur est redondant et il y a un nombre infini de solutions au problème inverse

φ

φ = θ

1

+ θ

2

+ θ

3

p

Wx

= p

x

− a

3

c

φ

= a

1

c

1

+ a

2

c

12

p

Wy

= p

y

− a

3

s

φ

= a

1

s

1

+ a

2

s

12

•  On calcule le carré des deux expressions précédentes et on les additionne:

Donc

p

²_Wx

+ p

²_Wy

= a

²₁

+ a

²₂

+ 2a

₁

a

2

c

2

c

2

= p

²_Wx

+ p

²_Wy

− a

²₁

− a

²₂

2a

1

a

2

Exemple 2: manipulateur planaire à 3 segments

1 - Solution algébrique

•  Pour avoir une solution admissible, il faut que:

•  Maintenant, il faut déterminer . Si on substitue l’expression de trouvée, dans les equations de , on obtient un système de deux équations à deux inconnues, , avec solution:

où le signe est “+” correspond à la posture “coude en bas” et le signe “^_” à la posture “coude en haut” du robot

•  Donc, on impose

•  En conséquence:

−1 ≤ c

2

≤ 1 s

2

= ±

1 − c

²₂

θ

2

= Atan2(s

2

, c

2

)

θ

1

θ

2

p

Wx

, p

Wy

s

₁

, s

₂

s

1

=

^(a1+a2c_p^{22)pWy−a2s2pWx}

Wx+p²_Wy

c

1

=

^(a1+a2c_p^22)pWx_+p^{+a2 2s2pWy}

= ⇒ θ

1

= Atan2(s

1

, c

1

)

Par conséquent:

Exemple 2: manipulateur planaire à 3 segments

Remarque:

•  Enfin, pour trouver l’angle on peut utiliser l’équation:

Si on a que : dans cette posture le manipulateur est dans une singularité cinématique. On peut déterminer encore d’une manière unique sauf si et on requiert que

s

2

= 0

θ2 ∈ {0, π}

θ

1

p

_Wx

= p

_Wy

= 0 θ

3

θ

3

= φ − θ

1

− θ

2

2 - Solution géométrique

•  On utilise encore les trois équations:

φ = θ

1

+ θ

2

+ θ

3

p

Wx

= p

x

− a

3

c

φ

= a

1

c

1

+ a

2

c

12

p

Wy

= p

y

− a

3

s

φ

= a

1

s

1

+ a

2

s

12

a

₁

= a

₂

Exemple 2: manipulateur planaire à 3 segments

2 - Solution géométrique

•  Si on applique le théorème d’Al-Kashi (ou loi des cosinus) au triangle rouge en figure, on obtient:

φ

p

²_Wx

+ p

²_Wy

= a

²₁

+ a

²₂

− 2 a

1

a

2

cos(π − θ

2

)

•  En effet, on a deux configurations possibles du triangle (voir le trait pointillé noir en figure)

•  Car , nous avons:

cos(π − θ

₂

) = − cos θ

₂

c

2

= p

²_Wx

+ p

²_Wy

− a

²₁

− a

²₂

2a

1

a

2

•  Pour l’existence d’un triangle, il faut que:

p

²_Wx

+ p

²_Wy

≤ a

1

+ a

2

•  Sous cette condition:

θ

2

= ± arccos(c

2

)

“coude en bas”

“coude en haut”

W θ

2

Exemple 2: manipulateur planaire à 3 segments

2 - Solution géométrique

•  La posture “coude en haut”

est obtenue avec

φ

•  Pour déterminer , il faut considérer les angles

α

^et

β

en figure

•  La valeur de

α

depend du signe de . Il faut donc

calculer

α

^comme:

“coude en bas”

“coude en haut”

θ₂ ∈ (−π, 0)

θ

₂

∈ (0, π)

•  La posture “coude en bas”

est obtenue avec

θ

1

p

W_x

, p

W_y

α = Atan2(p

Wy

, p

Wx

)

θ

2

θ

₁

•  Pour trouver

β

, nous appliquons encore la loi des cosinus au triangle vert, ce qui nous donne l’équation:

c

_β

p

²_Wx

+ p

²_Wy

= a

₁

+ a

₂

c

₂

W

a²₂ = p²_Wx + p²_Wy +a²₁ − 2a1

p²_Wx + p²_Wy cosβ =⇒

Exemple 2: manipulateur planaire à 3 segments

2 - Solution géométrique

•  Si on utilise l’expression de trouvée auparavant, on trouve

c

₂

β = arccos

⎛

⎝ p

²_Wx

+ p

²_Wy

+ a

²₁

− a

²₂

2a

1

p

²_Wx

+ p

²_Wy

⎞

⎠

avec pour garantir encore l’existence du triangle

β ∈ (0, π )

•  Donc, où le signe est

“+” pour et “

θ

₁

= α ± β

^_” pour

θ

2

< 0 θ

2

> 0

•  Enfin pour trouver , on utilise à nouveau l’équation:

θ

₃

φ = θ

1

+ θ

2

+ θ

3

φ

θ

2

θ

₁

W

Exemple 2: manipulateur planaire à 3 segments

Solutions de forme fermée: considerations générales

•  La plupart des manipulateurs existant sont cinématiquement simples

•  En effet ils sont typiquement composés d’un porteur et d’un poignet de type rotule (avec un poignet de type rotule, le point

W

est choisi à

l’intersection des trois axes des articulations rotoïdes)

•  Ce choix est motivé par la difficulté à déterminer des solutions du problème inverse dans le cas général

•  En particulier, un manipulateur à 6 DDL a des solutions de forme fermée du problème inverse si une des conditions suivantes est satisfaite:

  Les axes de trois articulations rotoïdes consecutives se croisent en un seul point (trois axes concourants), comme dans le cas du poignet de type rotule

  Les axes de trois articulations rotoïdes consecutives sont parallèles

Méthode de Paul

•  Le MGI est obtenu en résolvant l'équation matricielle suivante :

où décrit la situation du repère

n

par rapport au repère de la base

•  La méthode de Paul permet la détermination de

q

₁^{, puis}

q

₂ et ainsi de suite jusqu'à

q

_n

•  Il s'agit de déplacer l'une après l'autre chacune des variables articulaires (

q

₁,…,

q

_n) dans le membre de gauche de l'équation

•  Pour cela, on multiplie par (en prenant successivement ) de part et d'autre dans l'équation

U

₀

= A

⁰₁

(q

₁

) A

¹₂

(q

₂

) · · · A

ⁿ⁻¹_n

(q

_n

)

U

0

A

^j_j−1 ^j ∈ {1, . . . , n}

•  Dans le cas de robots cinématiquement simples (pour lesquels la plupart des distances

a

_i et

d

_i sont nulles et θ_i ^et α_i sont égaux à 0, ±π/2), le MGI peut être obtenu analytiquement via la méthode de Paul

Méthode de Paul

Considérons un robot à 6 DDL (

n

= 6). Appliquons la méthode : 1) Pré-multiplier l'équation précédente par , soit :

Les éléments situés dans le membre de gauche sont soient indépendants, soient fonctions de

q

₁. Les éléments situés dans le membre de droite sont soient

constants, soient fonctions de

q

₂^,…,

q

₆

2) Déduire

q

₁ de l'équation précédente

3) Pré-multiplier l'équation précédente par , soit :

4) En déduire

q

₂

5) Continuer cette procédure pour en déduire

q

₃,…,

q

₆

A¹₀(q1)

A

¹₀

(q

1

) U

0

= A

¹₂

(q

2

) · · · A

⁵₆

(q

6

)

A

²₁

(q

2

) A

¹₀

(q

1

) U

0

= A

²₃

(q

2

) · · · A

⁵₆

(q

6

)

A²₁(q₂)

A

²₃

(q

3

)

Méthode de Paul

En résumé, on utilise les équations suivantes pour calculer les variables articulaires q₁,…, q₆:

La résolution de ces équations est intuitive, mais fait intervenir (en principe) quelques types d'équations dont la solution analytique est connue

U

0

= A

⁰₁

(q

1

) A

¹₂

(q

2

) A

²₃

(q

3

) A

³₄

(q

4

) A

⁴₅

(q

5

) A

⁵₆

(q

6

) A

¹₀

(q

1

)U

0

= A

¹₂

(q

2

) A

²₃

(q

3

) A

³₄

(q

4

) A

⁴₅

(q

5

) A

⁵₆

(q

6

)

A

²₁

(q

2

)U

1

= A

²₃

(q

3

) A

³₄

(q

4

) A

⁴₅

(q

5

) A

⁵₆

(q

6

) A

³₂

(q

3

)U

2

= A

³₄

(q

4

) A

⁴₅

(q

5

) A

⁵₆

(q

6

)

A

⁴₃

(q

4

)U

3

= A

⁴₅

(q

5

) A

⁵₆

(q

6

) A

⁵₄

(q

5

)U

4

= A

⁵₆

(q

6

)

avec U_j = A^j₆ = A^j_j−1U_j−1, j ∈ {1, 2, 3, 4}.

Méthode de Paul

•  Si on applique la méthode de Paul au robot Stäubli TX60 (un robot

anthropomorphe avec poignet de type rotule à 6 DDL), on trouve qu’il existe 8 solutions, dans le cas général

•  Certaines positions dites singulières du robot occasionnent un nombre infini de solutions. C'est par exemple le cas de la configuration initiale

“sans offset” du robot (

θ

1 = … =

θ

6 = 0) où les arguments de la fonction arc tangente utilisés pour déterminer le paramètre

θ

4 sont nuls, ce qui rend ce paramètre indéterminé

•  Le choix de la valeur de ce paramètre étant libre, on assigne fréquemment la valeur

courante

θ

4 du robot. Ce choix fixe alors la valeur du paramètre θ6

Robot Stäubli TX60

Les quatre postures compatibles avec une pose donnée du poignet d’un manipulateur anthropomorphe

Bras à gauche et en haut

Bras à droite et en haut

Bras à gauche et en bas

Bras à droite et en bas Poignet

•  On a vu précédemment que le modèle géométrique direct d'un robot peut se représenter à l'aide de l'application:

Cette application est définie de l'espace articulaire (EA) vers l'espace opérationnel (EO), tous deux de dimension

n

≤ 6, en général

•  Cette application n'est pas biunivoque, c’est-à-dire, à un élément de l’EO correspond une seule image dans l’EA, par contre un élément de EA pourra être l'image de plusieurs éléments de l’EO

•  Dans le cas du robot Staübli TX60, il existe (au maximum) 8 solutions possibles pour attendre un point de l’EO

•  Dans la pratique, cette “non propriété” peut poser des problèmes, par exemple, dans le cas où des obstacles sont à proximité du robot

•  En effet, la réalisation d'une trajectoire rectiligne peut s'avérer irréalisable physiquement, ou le bras du robot peut être amené à se reconfigurer, ce qui peut induire des comportements “intempestifs” du manipulateur

x

_e

= f (q)