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