next up previous contents
Next: 全方向移動ロボットの逆運動学 Up: 車輪に注目した Jacobian 行列 Previous: Roller Whell 方式 3輪の場合   Contents

Roller Whell 方式 4輪の場合

車輪i(i=1,2,3)に対して式2.42を適用し,座標変換行列を車輪 $C_i$ に対して表すと, ${}^A\varphi _B\equiv {}^R\varphi _{C_1}=0^\circ $ :
\begin{displaymath}
{}^R\Pi _{C_1}=\left( {\matrix{1&0&0&0\cr
0&1&0&L\cr
0&0&1&0\cr
0&0&0&1\cr
}} \right)
\end{displaymath} (64)

${}^A\varphi _B\equiv {}^R\varphi _{C_2}=90^\circ $ :
\begin{displaymath}
{}^R\Pi _{C_2}=\left( {\matrix{0&-1&0&L\cr
1&0&0&0\cr
0&0&1&0\cr
0&0&0&1\cr
}} \right)
\end{displaymath} (65)

${}^A\varphi _B\equiv {}^R\varphi _{C_3}=180^\circ $ :
\begin{displaymath}
{}^R\Pi _{C_3}=\left( {\matrix{1&0&0&0\cr
0&-1&0&-L\cr
0&0&1&0\cr
0&0&0&1\cr
}} \right)
\end{displaymath} (66)

${}^A\varphi _B\equiv {}^R\varphi _{C_4}=270^\circ $ :
\begin{displaymath}
{}^R\Pi _{C_4}=\left( {\matrix{0&1&0&-L\cr
1&0&0&0\cr
0&0&1&0\cr
0&0&0&1\cr
}} \right)
\end{displaymath} (67)

2.48 $\alpha =90^\circ $ を代入すると, 車輪1の場合:
\begin{displaymath}
\left( {\matrix{{v_1}\cr
{v_2}\cr
{\dot \psi }\cr
}} \ri...
...\dot \theta _{1_r}}\cr
{\dot \theta _{1_Z}}\cr
}} \right)
\end{displaymath} (68)

車輪2の場合:
\begin{displaymath}
\left( {\matrix{{v_1}\cr
{v_2}\cr
{\dot \psi }\cr
}} \ri...
...\dot \theta _{2_r}}\cr
{\dot \theta _{2_Z}}\cr
}} \right)
\end{displaymath} (69)

車輪3の場合:
\begin{displaymath}
\left( {\matrix{{v_1}\cr
{v_2}\cr
{\dot \psi }\cr
}} \ri...
...\dot \theta _{3_r}}\cr
{\dot \theta _{3_Z}}\cr
}} \right)
\end{displaymath} (70)

車輪4の場合:
\begin{displaymath}
\left( {\matrix{{v_1}\cr
{v_2}\cr
{\dot \psi }\cr
}} \ri...
...\dot \theta _{4_r}}\cr
{\dot \theta _{4_Z}}\cr
}} \right)
\end{displaymath} (71)

となる.

Shoichiro FUJISAWA