Вычисление матрицы Якоби для обратной кинематики

При вычислении матрицы Якоби для аналитического решения обратной кинематики я читал из многих мест, что могу использовать эту формулу для создания каждого из столбцов соединения в матрице Якоби:

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

Так что - это ось вращения в мировом пространстве, - это точка поворота в мировом пространстве, а - это положение конечного эффектора в мировом пространстве.$a'$$r'$$e_{pos}$

Тем не менее, я не понимаю, как это может работать, когда суставы имеют более одного DOF. Возьмите следующее в качестве примера:

являются DOF вращения, то является концевой эффектор, то является целью концевого эффектора, в , и являются суставы.$\theta$$e$$g$$P_1$$P_2$$P_3$

Во-первых, если бы я вычислил матрицу Якоби на основе приведенной выше формулы для диаграммы, я получу что-то вроде этого:

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

Предполагается, что все оси вращения равны и все они имеют только одну DOF вращения. Итак, я считаю, что каждый столбец для одного DOF, в данном случае, .$(0,0,1)$$\theta_\#$

Теперь вот проблема: что если все суставы имеют полные 6 степеней свободы? Скажем, теперь для каждого соединения у меня есть вращательные DOF по всем осям, , и , а также поступательные DOF по всем осям, , и .$\theta_x$$\theta_y$$\theta_z$$t_x$$t_y$$t_z$

Чтобы прояснить мой вопрос, предположим, что если бы я «принудительно» применил приведенную выше формулу ко всем степеням свободы всех соединений, то я, вероятно, получу якобианскую матрицу, подобную этой:

(нажмите для увеличения)

Но это невероятно странно, потому что все 6 столбцов DOF для каждого сустава повторяют одно и то же.

Как я могу использовать одну и ту же формулу для построения матрицы Якоби со всеми степенями свободы? Как будет выглядеть матрица Якоби в этом случае?

Я должен признать, что я не видел эту конкретную формулу очень часто, но я предполагаю, что в случае более чем одного DOF, вы оцените ее для каждого соединения в каждом столбце, а затем (возможно?) Умножите эти результаты на каждый столбец.

Но позвольте мне предложить более простое подход к якобианам в контексте произвольного множества степеней свободы: по сути, якобиан говорит вам, как далеко перемещается каждое соединение, если вы перемещаете конечную эффекторную рамку в каком-то произвольно выбранном направлении. Пусть быть прямая кинематика, где θ = [ & thetas ; 1 , . , , , θ n ] - шарниры, f pos - позиционная часть прямой кинематики и f rot вращательной части. Тогда вы можете получить якобиан, дифференцируя прямую кинематику по объединенным переменным: $f(\theta)$$\theta = [\theta_1, ... , \theta_n]$$f_{\text{pos}}$$f_{\text{rot}}$ является якобиан вашего манипулятора. Инвертирование дало бы вам обратную кинематику с учетомскоростей. Онпрежнему может быть полезнымхотя, если вы хотите знатьнасколько каждое соединение должно двигатьсяесли вы хотитечтобы переместить конец эффектор некоторымнебольшимколичествомΔхв любом направлении (такна уровне позиции, это будет фактически линеаризацию): Δθ=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$$

Надеюсь, что это поможет.

Ваша формула для соединения с 6 степенями свободы предполагает, что все 6 соединений имеют ось в мировой системе координат и что все соединения являются вращательными. Поскольку 6 суставов, таким образом, идентичны, их столбцы в якобиане также идентичны.$(0, 0, 1)$

Начиная более, предположим, что соединение имеет ось проходит через точку г . Пусть е будет положением конечного эффектора. Все координаты a , r и e задаются в рамке мира и обновляются по мере перемещения робота. Ось имеет длину 1 .$a$$r$$e$$a$$r$$e$$a$$1$

Если сустав является вращающимся, столбец якобиана для сустава

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

Если соединение призматическое, столбец

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

Предположим, у нас есть шарнир 6 градусов, который не только сферический, но и может перемещаться в пространстве. Предположим, что оси соединения - , a y и a z, и что каждое вращающееся и призматическое соединение разделяет ось, так что якобиан для соединения становится$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$

Насколько я понимаю твой вопрос, что ты хочешь матрицу Якоби для соединения 6 степеней свободы.

Позвольте мне начать с самых основ робототехники. Вы находитесь на начальном этапе обучения робототехнике. Вы должны понимать, что каждый сустав представляет собой один DOF, будь то поворотный или призматический сустав.

Что касается сферического соединения, оно может быть преобразовано в 3 вращающихся соединения с тремя взаимно перпендикулярными осями. Итак, теперь вы упростили свой сферический сустав.

Двигаясь вперед к якобианской матрице. Он содержит 6 строк. Первые 3 строки представляют ориентацию, а последние 3 строки указывают положение со ссылкой на конкретную систему координат. Каждый столбец в матрице указывает на одно соединение. Таким образом, число соединений / DOF у вас есть тот же номер столбца, который у вас есть в матрице Якоби.

Вот более ясный взгляд на ваш вопрос: один сустав никогда не выполняет более одного DOF, потому что это усложняет сустав, и точный контроль никогда не будет достигнут. Даже если мы гипотетически рассмотрим соединение с более чем одним DOF, вам нужно преобразовать это соединение в несколько соединений с 1 DOF каждый, чтобы упростить математику и решение.

В идеале робот с 6 степенями свободы с 6 поворотными шарнирами работает для большинства на реальных проблемах. Но по вашему вопросу вы рассматривали 6 совместных роботов, каждый из которых имеет 3 степеней свободы, что составляет 18 степеней свободы. Это даст избыточный DOF (т.е. 18-6 = 12 резервных DOF). Таким образом, для достижения конечного эффектора робота в любом месте с любой ориентацией у вас будет бесконечно много разных решений (решение означает вращение каждого соединения). Так что для решения этой проблемы обратной кинематики вам потребуется итерационный метод обратной кинематики.

Надеюсь, я ответил на ваш вопрос более четко. Чтобы изучить основы робототехники, вы можете обратиться к Джону Крейгу - Введение в робототехнику и управление робототехникой -Pearson Education, Inc.

С уважением, Манан Каласария