23.12.2013 Views

THÈSE

THÈSE

THÈSE

SHOW MORE
SHOW LESS

Create successful ePaper yourself

Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.

96 Chapitre 6. Problème cinématique inverse du pagayage<br />

soit sous sa forme discrète :<br />

∆q = J + ∆x + α(1 − J + J)∇φ (27)<br />

où ∇φ = ∂φ/∂q est le gradient de la fonction φ et α une constante négative pour<br />

minimiser la fonction. La fonction φ permet d’appliquer des lois de recherche dans l’espace<br />

de solutions fourni par ∆q = J + ∆X. Le second terme de droite appartient à l’espace nul<br />

de J. Il correspond à des mouvements de la chaîne sans déplacement de l’effecteur ; il<br />

s’agit d’une tâche secondaire. Le système étant redondant, une variété de configurations<br />

sont possibles pour réaliser la tâche. Le terme α gére le compromis entre la minimisation<br />

de ‖ ˙q‖, due à la pseudo-inverse, et l’optimisation de φ(q).<br />

De nombreuses fonctions sont utilisées pour résoudre le problème de redondance du<br />

système (e.g. la minimisation de l’énergie, la minimisation de l’écart de posture par rapport<br />

à un mouvement d’origine, l’évitement de collision, ou encore la prise en compte des angles<br />

limites aux articulations (57; 59)). Dans notre cas, la minimisation de la fonction φ donne<br />

des mouvements loin des limites articulaires. Elle peut s’écrire sous la forme quadratique<br />

suivante (57) :<br />

φ(q) = ∑ i<br />

(<br />

qi − ¯q i<br />

∆q i<br />

) 2<br />

(28)<br />

− qi min est l’amplitude de l’articulation i et ¯q i = 1 (<br />

2 q<br />

max<br />

i<br />

où ∆q i = qi<br />

max<br />

moyenne. Après calcul du gradient de φ(q), l’Eq. [27] s’écrit sous la forme :<br />

+ qi<br />

min )<br />

sa valeur<br />

∆q = J + ∆x + (1 − J + J) 2α (q i − ¯q i )<br />

∆q 2 i<br />

(29)<br />

A partir de la décomposition en valeurs singulières de la jacobienne (J = UDV T ), deux<br />

méthodes principales permettent de calculer la pseudo-inverse et l’opérateur de projection<br />

dans l’espace nul de J (Annexe B.1). La première (163) demande une décomposition<br />

complète alors que la seconde (8) nécessite uniquement une décomposition réduite ; pour<br />

une matrice de dimensions m × n avec m > n, seules les n premières colonnes de U sont<br />

calculées et D est de dimensions n×n. La décomposition réduite est significativement plus<br />

rapide et économique, par contre le calcul est itératif. Cette seconde solution est préférée<br />

dans notre algorithme.<br />

La Figure 6.4 illustre les trajectoires articulaires moyennes obtenues pour 26 tâches<br />

de pagayage. Ces trajectoires sont cycliques car les positions finales sont équivalentes aux<br />

positions initiales. Dans l’ensemble le geste semble alterné. En d’autres termes, les trajectoires<br />

des segments gauches sont semblables à celles des segments droits avec un demi-cycle

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

Saved successfully!

Ooh no, something went wrong!