実際に2リンクモデルの可操作性楕円体を求める方法を紹介する

可操作性楕円体を用いることで、ロボットの動かしやすさを表すことが出来ます。

ロボットの可操作性楕円体とはロボットの姿勢（関節状態）によって、動作しやすい姿勢（方向）や動作しづらい姿勢（方向）が存在します。これらのどれ...

これまでの記事では、2リンクモデルの可操作性楕円体を求めるために必要な知識を紹介しました。

2リンクモデルの可操作性楕円体を求めてみよう可操作性楕円体を用いることで、ロボットの手先がどの方向にどれくらい動かしやすいかが分かります。 https://tajim...

今回の記事では、実際に具体的な値を用いて2リンクモデルの可操作性楕円体を求める流れを紹介します。

Contents

2リンクモデルの条件
可操作性楕円体の算出方法
2リンクモデルの可操作性楕円体
まとめ

2リンクモデルの条件

可操作性楕円体の形や向き、大きさは、ロボットの関節状態によって変化します。

今回の記事では、下記のような条件における2リンクモデルの可操作性楕円体を求めます。

$$ \begin{eqnarray} \left\{ \begin{array}{l} L_1 &=& 1 \ [m] \\ L_2 &=& 1 \ [m] \\ \theta_1 &=& 30 \ [^{ \circ }] \\ \theta_2 &=& 60 \ [^{ \circ }] \end{array} \right. \end{eqnarray} $$

このように今回の記事では、具体的な値を用いて2リンクモデルの可操作性楕円体を描いていきます。

可操作性楕円体の算出方法

可操作性楕円体を書くためには、可操作性楕円体の各軸の方向と大きさを求める必要があります。

楕円体の軸方向と大きさを求めるためには、2リンクモデルのヤコビ行列を用います。

ヤコビ行列Jの導出

今回の記事で取り扱っている2リンクモデルのヤコビ行列Jは、

$$ \begin{eqnarray} \boldsymbol{ J } = \begin{bmatrix} – L_1 \sin \left( \theta_1 \right) – L_2 \sin \left( \theta_1 + \theta_2 \right) & – L_2 \sin \left( \theta_1 + \theta_2 \right) \\ L_1 \cos \left( \theta_1 \right) + L_2 \cos \left( \theta_1 + \theta_2 \right) & L_2 \cos \left( \theta_1 + \theta_2 \right) \end{bmatrix} \end{eqnarray}$$

と表されます。

このヤコビ行列Jの式に今回の条件（L₁、L₂、θ₁、θ₂）を代入すると、

$$ \begin{eqnarray} \boldsymbol{ J } &=& \begin{bmatrix} – 1 \sin \left( 30 \right) – 1 \sin \left( 30 + 60 \right) & – 1 \sin \left( 30 + 60 \right) \\ 1 \cos \left( 30 \right) + 1 \cos \left( 30 + 60 \right) & 1 \cos \left( 30 + 60 \right) \end{bmatrix} \\ &=& \begin{bmatrix} -1.5 & -1 \\ 0.866 & 0 \end{bmatrix} \end{eqnarray}$$

とヤコビ行列Jを求めることが出来ました。

行列A=JJ^Tの算出

このヤコビ行列Jとヤコビ行列Jの転置行列より得られる行列を

$$ \boldsymbol{ A } = \boldsymbol{ J } \boldsymbol{ J }^T $$

のように行列Aと定義し、求めていきます。

先ほど得られたヤコビ行列Jを行列Aの式に代入すると、

$$ \begin{eqnarray} \boldsymbol{ A } &=& \begin{bmatrix} -1.5 & -1 \\ 0.866 & 0 \end{bmatrix} \begin{bmatrix} -1.5 & -1 \\ 0.866 & 0 \end{bmatrix}^T \\ &=& \begin{bmatrix} -1.5 & -1 \\ 0.866 & 0 \end{bmatrix} \begin{bmatrix} -1.5 & 0.866 \\ -1 & 0 \end{bmatrix} \\ &=& \begin{bmatrix} 3.25 & -1.299 \\ -1.299 & 0.75 \end{bmatrix} \end{eqnarray} $$

のように、2リンクモデルの行列Aを算出することが出来ました。

行列Aの固有値と固有ベクトルの算出

可操作性楕円体の成分を求めるために、このヤコビ行列Jより得られた行列Aの固有値λと固有ベクトルvを算出します。

前の項で算出した行列A

$$ \boldsymbol{ A } = \begin{bmatrix} 3.25 & -1.299 \\ -1.299 & 0.75 \end{bmatrix} $$

の固有値λは

$$ \begin{eqnarray} \lambda_1 &=& 3.8028 \\ \lambda_2 &=& 0.1972 \end{eqnarray} $$

と求められます。

そして、それぞれの固有値λに対する固有ベクトルvは、

$$ \begin{eqnarray} \boldsymbol{ v_1 } &=& \begin{bmatrix} -0.9202 & 0.3916 \end{bmatrix}^T \\ \boldsymbol{ v_2 } &=& \begin{bmatrix} -0.3916 & -0.9202 \end{bmatrix}^T \end{eqnarray} $$

と算出することが出来ました。

可操作性楕円体の軸方向と大きさ

算出した固有値λと固有ベクトルvを用いて、可操作性楕円体を描くために必要な楕円体の成分を求めていきます。

軸の方向

ヤコビ行列Jより得られた行列Aの固有ベクトルvが、可操作性楕円体の軸の方向を表します。

行列Aの固有ベクトルv₁とv₂より、可操作性楕円体の各軸は

$$ \begin{eqnarray} \left\{ \begin{array}{l} \begin{bmatrix} -0.9202 & 0.3916 \end{bmatrix}^T \\ \begin{bmatrix} -0.3916 & -0.9202 \end{bmatrix}^T \end{array} \right. \end{eqnarray} $$

となります。