Calcul de la matrice jacobienne pour la cinématique inverse

Lors du calcul analytique de la matrice jacobienne pour résoudre une cinématique inverse, j'ai lu à de nombreux endroits que je pouvais utiliser cette formule pour créer chacune des colonnes d'un joint dans la matrice jacobienne:

J_{i} = \frac{\partial e}{\partial ϕ_{i}} = [\begin{matrix} {[a_{i}^{'} \times (e_{p o s} - r_{i}^{'})]}^{T} \\ {[a_{i}^{'}]}^{T} \end{matrix}]

$\mathbf{J}_{i}=\frac{\partial \mathbf{e}}{\partial \phi_{i}}=\left[\begin{array}{c}{\left[\mathbf{a}_{i}^{\prime} \times\left(\mathbf{e}_{p o s}-\mathbf{r}_{i}^{\prime}\right)\right]^{T}} \\ {\left[\mathbf{a}_{i}^{\prime}\right]^{T}}\end{array}\right]$

Tels que $a'$ est l'axe de rotation dans l'espace mondial, $r'$ est le point de pivot dans l'espace mondial et $e_{pos}$ est la position de l'effecteur terminal dans l'espace mondial.

Cependant, je ne comprends pas comment cela peut fonctionner lorsque les articulations ont plus d'un DOF. Prenons l'exemple suivant:

entrez la description de l'image ici

Les $\theta$ sont le DOF rotatif, le $e$ est l'effecteur terminal, le $g$ est le but de l'effecteur terminal, les $P_1$ , $P_2$ et $P_3$ sont les articulations.

Premièrement, si je calculais la matrice jacobienne sur la base de la formule ci-dessus pour le diagramme, j'obtiendrais quelque chose comme ceci:

J = [\begin{matrix} ((0, 0, 1) \times \vec{e})_{x} & ((0, 0, 1) \times (\vec{e} - \vec{P_{1}}))_{x} & ((0, 0, 1) \times (\vec{e} - \vec{P_{2}}))_{x} \\ ((0, 0, 1) \times \vec{e})_{y} & ((0, 0, 1) \times (\vec{e} - \vec{P_{1}}))_{y} & ((0, 0, 1) \times (\vec{e} - \vec{P_{2}}))_{y} \\ ((0, 0, 1) \times \vec{e})_{z} & ((0, 0, 1) \times (\vec{e} - \vec{P_{1}}))_{z} & ((0, 0, 1) \times (\vec{e} - \vec{P_{2}}))_{z} \\ 0 & 0 & 0 \\ 0 & 0 & 0 \\ 1 & 1 & 1 \end{matrix}]

$J=\begin{bmatrix} ((0,0,1)\times \vec { e } )_{ x } & ((0,0,1)\times (\vec { e } -\vec { P_{ 1 } } ))_{ x } & ((0,0,1)\times (\vec { e } -\vec { P_{ 2 } } ))_{ x } \\ ((0,0,1)\times \vec { e } )_{ y } & ((0,0,1)\times (\vec { e } -\vec { P_{ 1 } } ))_{ y } & ((0,0,1)\times (\vec { e } -\vec { P_{ 2 } } ))_{ y } \\ ((0,0,1)\times \vec { e } )_{ z } & ((0,0,1)\times (\vec { e } -\vec { P_{ 1 } } ))_{ z } & ((0,0,1)\times (\vec { e } -\vec { P_{ 2 } } ))_{ z } \\ 0 & 0 & 0 \\ 0 & 0 & 0 \\ 1 & 1 & 1 \end{bmatrix}$

Ceci est supposé que tous les axes de rotation sont $(0,0,1)$ et tous n'ont qu'un seul DOF rotatif. Donc, je crois que chaque colonne est pour un DOF, dans ce cas, le $\theta_\#$ .

Maintenant, voici le problème: que faire si toutes les articulations ont 6 DOF complets? Disons maintenant que pour chaque joint, j'ai des DOF rotatifs dans tous les axes, $\theta_x$ , $\theta_y$ et $\theta_z$ , ainsi que des DOF translationnels dans tous les axes, $t_x$ , $t_y$ et $t_z$ .

Pour rendre ma question plus claire, supposons que si j'appliquais "avec force" la formule ci-dessus à tous les DOF de toutes les articulations, alors j'obtiendrai probablement une matrice jacobienne comme ceci:

(cliquez pour agrandir)

Mais c'est incroyablement bizarre car les 6 colonnes du DOF pour chaque joint répètent la même chose.

Comment puis-je utiliser la même formule pour construire la matrice jacobienne avec tous les DOF? À quoi ressemblerait la matrice jacobienne dans ce cas?

inverse-kinematics kinematics xénon
la source

En fait, je ne sais pas si j'aurais dû poster cette question ici, en mathématiques, dans GamesDev ou en physique. J'ai le sentiment d'avoir posté cette question au mauvais endroit.

xenon

Je pense que votre erreur est que vous n'avez pas changé le a 'pour chaque DOF, c'est pourquoi ils se ressemblent tous.

Réponses:

Je dois admettre que je n'ai pas vu cette formule spécifique très souvent, mais je suppose que dans le cas de plusieurs DOF, vous l'évalueriez pour chaque joint dans chaque colonne, puis (peut-être?) Multiplieriez ces résultats dans chaque colonne.

Mais permettez-moi de suggérer une approche plus simple pour les Jacobiens dans le contexte de nombreux DOF arbitraires: Fondamentalement, le Jacobien vous indique jusqu'où chaque joint se déplace, si vous déplacez le cadre effecteur final dans une direction choisie arbitrairement. Soit soit la cinématique avant, où sont les articulations, est la partie positionnelle de la cinématique avant et la partie rotationnelle. Ensuite, vous pouvez obtenir le jacobien en différenciant la cinématique avant par rapport aux variables communes: $f(\theta)$ $\theta = [\theta_1, ... , \theta_n]$ $f_{\text{pos}}$ $f_{\text{rot}}$ est le jacobien de votre manipulateur. L'inverser vous donnerait la cinématique inverse en respectant lesvitesses. Cela peut néanmoins être utile si vous voulez savoir jusqu'où chaque articulation doit se déplacer si vous voulez déplacer votre effecteur terminal d'unepetitequantitédans n'importe quelle direction (car au niveau de la position, ce serait effectivement une linéarisation):

J = \frac{\partial f}{\partial θ} = [\begin{matrix} \frac{\partial f_{pos}}{\partial θ_{1}}, & \frac{\partial f_{pos}}{\partial θ_{2}} & . . ., \frac{\partial f_{pos}}{\partial θ_{n}} \\ \frac{\partial f_{rot}}{\partial θ_{1}}, & \frac{\partial f_{rot}}{\partial θ_{2}} & . . ., \frac{\partial f_{rot}}{\partial θ_{n}} \end{matrix}]

$J = \frac{\partial f}{\partial \theta} = \begin{bmatrix} \frac{\partial f_{\text{pos}}}{\partial \theta_1}, & \frac{\partial f_{\text{pos}}}{\partial \theta_2} & ..., \frac{\partial f_{\text{pos}}}{\partial \theta_n} \\ \frac{\partial f_{\text{rot}}}{\partial \theta_1}, & \frac{\partial f_{\text{rot}}}{\partial \theta_2} & ..., \frac{\partial f_{\text{rot}}}{\partial \theta_n} \end{bmatrix}$

Δ x

$\Delta x$

Δ θ = J^{- 1} Δ x

$\Delta \theta = J^{-1}\Delta x$

J'espère que cela vous aidera.

Daniel Eberts
la source

Merci d'avoir répondu! Mais cela signifierait que je devrai calculer les valeurs numériquement? En fait, j'ai vu cet exemple analytique de graphics.cs.cmu.edu/nsp/course/15-464/Fall09/handouts/IK.pdf de la diapositive 19 et graphics.ucsd.edu/courses/cse169_w05/CSE169_13.ppt sur la diapositive 78. D'après les diapositives, il me semble que je n'aurai peut-être pas à passer par les méthodes numériques. Dans les situations où je n'ai pas les fonctions réelles pour différencier, je peux utiliser cette formule. Mais le problème est ce qui se passe lorsque j'ai plus de DOF pour chaque articulation.

xenon

Si je comprends bien les diapositives, vous géreriez le cas de nombreux DOF arbitraires en déterminant les vecteurs

pour chacune de ces articulations, où

est la position de l'articulation. Donc, si vous avez, disons 46 articulations, vous obtiendrez en effet un jacobien avec 46 colonnes et 6 lignes (ou 3, si vous négligez l'orientation de l'effecteur terminal). Pour faire court: vous pouvez appliquer cette formule à n'importe quel nombre d'articulations et ne pas avoir à la "combiner" avec d'autres articulations.

(e_{i} - P_{i})

$(e_i - P_i)$

P_{i}

$P_i$

Daniel Eberts

Mais que se passe-t-il si un joint a de nombreux DOF comme

et des DOF de traduction comme

? Maintenant, chaque joint a 6 DOF. D'après ma compréhension du fonctionnement de la matrice jacobienne pour IK, les 6 premières colonnes seront les dérivées de l'effecteur terminal par rapport aux 6 DOF différents, et ces 6 premières colonnes doivent décrire la première articulation. Les 6 colonnes suivantes décrivent le second joint par rapport aux 6 DOF et ainsi de suite. Utilisation de l'équation

θ_{x}

$\theta_x$

θ_{y}

$\theta_y$

θ_{z}

$\theta_z$

t_{x}

$t_x$

t_{y}

$t_y$

t_{z}

$t_z$

(e_{i} - P_{i})

$(e_i - P_i)$ , cela signifie-t-il que les 6 colonnes de chaque joint sont automatiquement regroupées dans une seule colonne?

xenon

Ah, je vois. Non, dans ce cas, la formule ne fonctionnerait pas car elle a été conçue pour les joints de rotation avec un axe de rotation. Si vous voulez traiter par exemple des articulations sphériques, vous aurez besoin d'une formule différente qui traite ce type d'articulation spécifique ou vous avez besoin d'une forme fermée de la cinématique avant du robot. Si vous avez cela, vous pouvez le différencier des articulations

et obtenir le jacobien.

θ

$\theta$

Daniel Eberts

Merci! :) Juste curieux cependant, la diapositive 58 dans graphics.ucsd.edu/courses/cse169_w05/CSE169_13.ppt laisse-t-elle entendre qu'il est possible d'utiliser la formule pour les rotations avec 3 DOF? Ce qui signifie que si un joint n'a pas de DOF de translation et a seulement 3 DOF de rotation, c'est toujours possible? Bien que je ne sais pas pourquoi il faut

pour se multiplier avec différentes rotations pour obtenir les différents DOF.

(1, 0, 0, 0)

$(1,0,0,0)$

xénon

Votre formule pour un joint 6 dof suppose que tous les 6 joints ont l'axe dans le cadre mondial et que tous les joints sont révolutionnaires. Puisque les 6 articulations sont donc identiques, leurs colonnes en jacobien sont également identiques. $(0, 0, 1)$

En recommençant, supposons qu'une articulation a un axe passant par un point . Soit la position de l'effecteur terminal. Les coordonnées de , et sont toutes données dans le cadre du monde et sont mises à jour au fur et à mesure du déplacement du robot. L'axe a longueur de . $a$ $r$ $e$ $a$ $r$ $e$ $a$ $1$

Si l'articulation est révolutionnaire, la colonne du jacobien pour l'articulation est

$J_{\theta}(a, r) = \left[\begin{matrix} a \times (e - r) \\ a \end{matrix}\right]$

Si le joint est prismatique, la colonne est

$J_{p}(a) = \left[\begin{matrix} a \\ 0 \end{matrix}\right]$

Supposons que nous ayons un joint à 6 ddl qui est non seulement sphérique, mais qui peut également se traduire dans l'espace. Supposons que les axes du joint soient , et et que chaque joint tournant et prismatique partage un axe, de sorte que le jacobien du joint devienne $a_x$ $a_y$ $a_z$

$J = \left[\begin{matrix} J_p(a_x) & J_p(a_y) & J_p(a_z) & J_{\theta}(a_x, r) & J_{\theta}(a_y, r) & J_{\theta}(a_z, r) \end{matrix}\right]$

$a_x$ $a_y$ $a_z$ $k$

$F_k = \prod_{i=1}^{k} L_i T_i$

$L_i$ $T_i$ $R_c(q)$ $P_c(q)$ $q$ $c$ $x$ $y$ $z$

$\Delta q = (\Delta p_x, \Delta p_y, \Delta p_z, \Delta \theta_x, \Delta \theta_y, \Delta \theta_z)$ $i$ $\Delta T = P_x(\Delta p_x) P_y(\Delta p_y) P_z(\Delta p_z) R_x(\Delta \theta_x) R_y(\Delta \theta_y) R_z(\Delta \theta_z)$

$T_i \leftarrow T_i \, \Delta T$

$a_x$ $a_y$ $a_z$ $i$ $F_i$ $r$ $F_i$

antonakos
la source

Pour autant que je comprends votre question que vous voulez la matrice jacobienne pour le joint 6 DOF.

Permettez-moi de commencer par les bases de la robotique. Vous êtes dans la phase initiale variable de l'apprentissage de la robotique. Vous devez comprendre que chaque joint représente un seul DOF, qu'il s'agisse d'un joint révolutionnaire ou prismatique.

En ce qui concerne l'articulation sphérique, elle peut être convertie en 3 articulations tournantes avec trois axes mutuellement perpendiculaires. Alors maintenant, vous avez simplifié votre articulation sphérique.

Passons à la matrice jacobienne. Il contient 6 lignes. Les 3 premières lignes représentent l'orientation et les 3 dernières lignes indiquent la position en référence à un système de coordonnées particulier. Chaque colonne de la matrice indique un seul joint. Donc, le nombre de joint / DOF que vous avez la même colonne de nombre que vous avez dans la matrice jacobienne.

Voici la vue la plus claire de votre question: un seul joint ne remplit jamais plus d'un DOF, car cela complique le joint et un contrôle précis ne sera jamais réalisé. Même si nous considérons hypothétiquement un joint avec plus d'un DOF, vous devez convertir ce joint en plusieurs joints avec 1 DOF chacun pour simplifier les mathématiques et la solution.

Idéalement, le robot 6 DOF avec 6 articulations tournantes fonctionne pour la majorité sur les vrais problèmes. Mais selon votre question, vous avez envisagé un robot à 6 articulations, chaque articulation ayant 3 DOF, ce qui fait 18 robots DOF. Cela donnera une DOF redondante (c'est-à-dire 18-6 = 12 DOF redondants). Ainsi, pour atteindre l'effecteur terminal du robot à n'importe quel endroit avec n'importe quelle orientation, vous aurez des solutions infinies différentes (la solution signifie la rotation de chaque articulation). Donc, pour résoudre ce type de problème de cinématique inverse, vous aurez besoin d'une méthode itérative de cinématique inverse.

J'espère que j'ai répondu plus clairement à votre question. Pour apprendre la robotique de base, vous pouvez consulter John J. Craig - Introduction to Robotics Mechanics and Control -Pearson Education, Inc.

Cordialement, Manan Kalasariya

manan kalsariya
la source