Computando a matriz jacobiana para cinemática inversa

Ao calcular a matriz jacobiana para resolver analiticamente um cinemático inverso, li em muitos lugares que eu poderia usar essa fórmula para criar cada uma das colunas de uma junta na matriz jacobiana:

$$\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]$$

De tal modo que $a'$ é o eixo de rotação no espaço do mundo, $r'$ é o ponto de articulação no espaço do mundo, e $e_{pos}$ é a posição do instrumento terminal no espaço do mundo.

No entanto, não entendo como isso pode funcionar quando as articulações têm mais de um DOF. Tome o seguinte como exemplo:

Os $\theta$ são o DOF rotacional, o $e$ é a extremidade actuante, o $g$ é o objectivo do efector final, a $P_1$ , $P_2$ e $P_3$ são as articulações.

Primeiro, se eu fosse calcular a matriz jacobiana com base na fórmula acima para o diagrama, obteria algo assim:

$$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}$$

Supõe-se que todos os eixos de rotação sejam $(0,0,1)$ e todos tenham apenas um DOF rotacional. Então, acredito que cada coluna é para um DOF, neste caso, o $\theta_\#$ .

Agora, aqui está o problema: e se todas as juntas tiverem 6 DOFs cheias? Digamos agora, para cada junta, eu tenho DOFs rotacionais em todos os eixos, $\theta_x$ , $\theta_y$ e $\theta_z$ , e também DOFs translacionais em todos os eixos, $t_x$ , $t_y$ e $t_z$ .

Para tornar minha pergunta mais clara, suponha que se eu aplicasse "forçosamente" a fórmula acima a todos os DOFs de todas as juntas, provavelmente terei uma matriz jacobiana como esta:

(clique para ampliar)

Mas isso é incrivelmente estranho, porque todas as 6 colunas do DOF para cada junta estão repetindo a mesma coisa.

Como posso usar a mesma fórmula para construir a matriz jacobiana com todos os DOFs? Como seria a matriz jacobiana neste caso?

Devo admitir que não tenho visto essa fórmula específica com muita frequência, mas meu palpite seria que, no caso de mais de um DOF, você o avaliaria para todas as articulações de cada coluna e depois (talvez?) Multiplicaria esses resultados em cada coluna.

Mas deixe-me sugerir uma abordagem mais simples aos jacobianos no contexto de muitos DOFs arbitrários: Basicamente, o jacobiano diz a você quão longe cada junta se move, se você mover o quadro efetor final em uma direção escolhida arbitrariamente. Deixe- ser a cinemática para a frente, onde θ = [ q 1 , . . . , θ n ] são as juntas, f pos é a parte posicional da cinemática direta e f rot a parte rotacional. Então você pode obter o jacobiano diferenciando a cinemática direta em relação às variáveis ​​conjuntas: $f(\theta)$$\theta = [\theta_1, ... , \theta_n]$$f_{\text{pos}}$$f_{\text{rot}}$ é Jacobian do seu manipulador. A inversão daria a cinemática inversa em relação àsvelocidades. No entanto, ainda pode ser útil, se você quiser saber até que ponto cada junta deve se mover, se quiser mover seu efetor final em umapequenaquantidadeΔxem qualquer direção (porque no nível da posição, isso seria efetivamente uma linearização): Δθ=J-1Δ

$$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}$$ $\Delta x$ $$\Delta \theta = J^{-1}\Delta x$$

Espero que isso ajude.

Sua fórmula para uma junta de 6 dof pressupõe que todas as 6 juntas tenham o eixo no quadro mundial e que todas as juntas sejam rotativas. Como as 6 articulações são assim idênticas, suas colunas no jacobiano também são idênticas.$(0, 0, 1)$

Começar de novo, suponha que uma joint tem um eixo passar por um ponto r . Seja e a posição do efetor final. As coordenadas de um , r , e e são dadas no quadro mundial e estão sendo atualizados conforme o robô está sendo movido. O eixo a tem comprimento 1 .$a$$r$$e$$a$$r$$e$$a$$1$

Se a articulação é revoluta, a coluna jacobiana da articulação é

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

Se a junta é prismática, a coluna é

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

Suponha que tenhamos uma junta de 6 dof, que não é apenas esférica, mas também pode se traduzir no espaço. Suponhamos que os eixos da articulação são , um Y , e um de Z e que cada revolutas e prismáticos partes conjuntas de um eixo, de modo que o Jacobiana para o conjunto torna-se$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$

Tanto quanto eu entendo sua pergunta, você quer a matriz jacobiana para a junta dos 6 DOF.

Deixe-me começar com o básico da robótica. Você está na fase inicial variada do aprendizado de robótica. Você precisa entender que cada articulação representa um único DOF, seja uma articulação revoluta ou prismática.

No que diz respeito à articulação esférica, ela pode ser convertida em articulação de 3 rotações com três eixos mutuamente perpendiculares. Então, agora você simplificou sua articulação esférica.

Avançando para a matriz jacobiana. Ele contém 6 linhas. As primeiras 3 linhas representam a orientação e as 3 últimas linhas indicam a posição com referência a um sistema de coordenadas específico. Cada coluna na matriz indica uma única junta. Portanto, o número de junta / DOF tem a mesma coluna de número que você tem na matriz jacobiana.

Aqui está a visão mais clara da sua pergunta: Uma única junta nunca preenche mais de um DOF, porque complica a junta e o controle preciso nunca será alcançado. Mesmo se considerarmos hipoteticamente uma articulação com mais de um DOF, você precisará converter essa articulação em várias articulações com 1 DOF cada para simplificar a matemática e a solução.

Idealmente, o robô 6 DOF com 6 juntas de revolução funciona para a maioria dos problemas reais. Mas, de acordo com a sua pergunta, você considerou 6 robôs articulados, cada um com 3 DOF, o que faz 18 robôs do DOF. Isso fornecerá DOF redundante (ou seja, 18-6 = 12 DOF redundante). Portanto, para alcançar o efeito final do robô em qualquer local com qualquer orientação, você terá infinitas soluções diferentes (solução significa rotação de cada junta). Portanto, resolva esse tipo de problema de cinemática inversa e você precisará de um método iterativo de cinemática inversa.

Espero ter respondido sua pergunta mais claramente. Para aprender robótica básica, você pode consultar John J. Craig - Introdução à Mecânica e Controle de Robótica - Pearson Education, Inc.

Atenciosamente, Manan Kalasariya