13: 2013-08-05 (月) 13:23:30 yoshida | 14: 2013-08-07 (水) 18:39:00 yoshida | ||
---|---|---|---|
Line 3: | Line 3: | ||
**幾何学的に角度を求める [#zdb959c7] | **幾何学的に角度を求める [#zdb959c7] | ||
逆運動(IK)とは指示された座標を元に関節の角度を求めるものです。~ | 逆運動(IK)とは指示された座標を元に関節の角度を求めるものです。~ | ||
- | 色々な計算手法がありますが、今回のロボットハンドでは余弦定理をメインに角度を計算してみたいと思います。~ | + | 色々な計算手法がありますが、本章では余弦定理をメインに角度を計算してみたいと思います。~ |
- | 尚、ハンド部分は角度計算に不要なので取り外します。~ | + | 以下のようにX、Y、Z軸の方向を決め、ハンド部分は角度計算に不要なので取り外して下さい。~ |
#ref(RobotHand3D.png) | #ref(RobotHand3D.png) | ||
指定座標をposと称し、各アクチュエータと軸間の長さを次のように呼称することにします。 | 指定座標をposと称し、各アクチュエータと軸間の長さを次のように呼称することにします。 | ||
Line 29: | Line 29: | ||
最後にD1の角度をアークタンジェントで求めれば角度計算は終了です。 | 最後にD1の角度をアークタンジェントで求めれば角度計算は終了です。 | ||
- | |||
- | **回転方向について [#b1298fca] | ||
- | 回転方向は軸を正から見て左回りになる方向をプラスとします。 | ||
- | #ref(roll_pitch_yaw.png) | ||
**プログラミング [#bdefef6a] | **プログラミング [#bdefef6a] |