Transcript ロボティクスーその来し方行く末

知能システム学１（５）
逆運動学(Inverse Kinematics)
２００８．５．２０
講義内容
１．はじめに
２．ベクトルの基礎
３．運動学(Kinematics)：逆運動学
４．動力学（Dynamics)
５．行列の演算と応用(Matrix)
６．軌道計算(Trajectory)
７．ロボットの制御(Control)
８．応用(Application)
ロボットマニピュレータの運動学(Kinematics)
ロボットの自由度（関節）の動きを表す変数と、ロボットを
構成する位置姿勢、またはそれらの変化速度、
加速度間の関係式を求める。
自由度変数ー＞リンクの位置姿勢
順運動学 （Forward Kinematics)
リンクの位置姿勢ー＞自由度変数
逆運動学 (Inverse Kinematics)
講義では基準座標系からみた３次元ベクトルによる
表現を基本とする。
姿勢の算出
x1  cos1  x0  sin 1  y0
y1   sin 1  x0  cos  yo
A1
x1
y1
z1   x0
y0
z1  z0
x2  c2 x1  s2 z1
y2  y1
z2  s2 x1  c2 z1
x2
z2   x1
y2
y1
x3  c3 x2  s3 z2
y3  y2
z3  s3 x2  c3 z2
x3
y3
z3   A1 A2 A3
x3
xi
z3   x2
y3
yi
y2
c1
z0  s1

 0
 s1 0
c1 0

0 1
A2
 c2
z1  0

 s2
0 s2 
1 0

0 c2 
A3  c3
0 s3 
1 0

0 c3 
z2  0

 s3
zi   A1    Ai
逆運動学(Inverse Kinematics)
Ｐが与えられθ1,θ2,θ3を求める。
P  F (1,2 ,3 ) を解く。
θ3
P3
P  l1z1  l2 z2  l3 z3
リンク３
リンク2
l3
l2
P
1 : P  x0  (l1z1  l2 z2  l3z3 )  x0
 l2 s2c1  l3 ( s2c3  s3c2 )c1
 (l2 s2  l3s2c3  l3s3c2 )c1
P  y0  (l2 s2  l3s2c3  l3s3c2 )s1
θ2
Z2
P2
l1
Y2
Z0,Z1 リンク1
Y1
P1
X2
L
X０
θ1
X1
Y0
s1 P  y0
1 P  y0
tan1  
 1  tan (
)
c1 P  x0
P  x0
3 : P  l1z1  l2 z2  l3z3
(l2 s2  l3s2c3  l3s3c2 )  0 のとき
P  l1 z1  (l2 z2  l3 z3 )  (l2 z2  l3 z3 )  l22  l32  2l2l3 ( z2  z3 )
1
2
1
3  cos (
{ P  l1z1  l22  l32 })
c3
2l3l2
2
2 : P  z0  (l1z1  l2 z2  l3 z3 )  z0  l1  (l2 z2  l3 ( s3 x2  c3 z2 ))  z0
 l1  {l3s3 (c2 x1  s2 z1 )  (l2  l3c3 )(s2 x1  c2 z1 )} z0
P  z0  l1  {(l3s3c2  (l2  l3c3 )s2 ) x1  (l3s3s2  (l2  l3c3 )c2 ) z1}  z0
 l3s3s2  (l3c3  l2 )c2  Asin(  2 )
但し
A  (l3s3 )2  (l3c3  l2 )2 , tan   (l3c3  l2 ) (l3s3 )
2   sin1((P  z0  l1 ) A)  tan1 (l3c3  l2 ) (l3s3 )
 180  2  180 の範囲で妥当な解を求める。
練習問題
1
l1  0, l2  1, l3  1, P  1 のときの  , , を求めよ。 １
 
1 2
3
0
1  tan1 (
P  y0
)  tan1 ( 1 )  45
1
P  x0
1
2
 3  cos (
{ P  l1 z1  l22  l32 })
2l3l2
1
１
１
1
 cos1 ( (2  1  1))  90
2
 2   sin 1 ((P  z0  l1 ) A)  tan1 (l3c3  l2 ) (l3s3 )
  sin(0)  tan1 ( 1 )  45 or  135
1
１
練習問題(続き）
3  90 の場合の解を考える。
１
 2  45 のとき、
L  (l2 s2  l3s2c3  l3s3c2 )  1
1  45
１
2
0 1
2
 2 0
2  135 のとき、
L  (l2 s2  l3s2c3  l3s3c2 )   1
１
2
0 1
L( P  y0 )
1  tan (
)  tan1 (  1 )  135
1
L( P  x0 )
1
2
 2 0
１
逆運動学の式が２次の代数方程式になるケース１
Θ１
θ２、θ３の回転軸が平行な場合
Θ２
Ｐ２
Θ３
Ｐ
θ２、θ３の回転軸方向に垂直で
先端の点Ｐが乗る平面がＰの与えら
れた座標を含むための拘束条件は
θ１の余弦（正弦）の２次の代数
方程式となる。
Ｐ－Ｐ２の長さがθ３のみの関数
になりθ３も２次の代数方程式で
求められる。
Ｐの座標はθ２のみの関数になり
Θ２も２次の代数方程式で求め
られる。
逆運動学の式が２次の代数方程式になるケース２
Θ１
θ１、θ２の回転軸が平行な場合
Ｐ１
Θ２
Ｐ２
Θ３
Ｐ
先端の点Ｐの与えられた座標の
θ１、θ２の回転軸方向成分はθ３
のみの関数となり、θ３は２次の
代数方程式で求められる。
Ｐ－Ｐ１の長さがθ２のみの関数
になりθ２も２次の代数方程式で
求められる。
Ｐの座標はθ１のみの関数になり
θ１も２次の代数方程式で求め
られる。
逆運動学の式が２次の代数方程式になるケース３
θ１、θ２の回転軸が交差する場合
Ｐ１
Θ１
Ｐ２
Θ２
Θ３
Ｐ
Ｐ－Ｐ１の長さがθ３のみの関数
になりθ３は２次の代数方程式で
求められる。
Ｐの座標のθ１軸方向成分は
θ２のみの関数になりθ２も２次の
代数方程式で求め
られる。
先端の点Ｐの座標はθ１のみの
関数となり、θ１は２次の代数方程
式で求められる。
逆運動学の式が２次の代数方程式になるケース４
Θ１
Ｐ１
θ１とθ２の回転軸が直交、かつ、
θ２とθ３の回転軸が直交な場合
Θ２
Ｐ２
Ｐの座標のθ１の回転軸方向成分
は、θ２、θ３の関数になる。 Ｐ－Ｐ１
の長さもθ２、θ３の関数になる。
これを整理すると、θ２の余弦（正弦）
に関する２次の代数方程式が得られる。
以下同様。
Θ３
Ｐ