FC2ブログ

爪車

ヒト型ロボット 58 ZMPを規範とするオフライン歩行パターン生成を試してみました

単質点モデルにより得られた重心軌道をもとに、多リンクモデルのZMPを求めてみました。

ZMPは慣性テンソルの効果を無視した、多質点のモデルによる近似です。
質点は間接軸の位置に配置してみました。
実際のロボットで、サーボに質量が集中しているという感じです。
ZMPの近似計算に必要な各質点の速度、加速度は前の状態からの差分を元に算出。

多リンクモデルは下半身だけのモデルです。

重心とZMPの軌跡 x方向
Screenshot-Gnuplot-20100331-x.png
赤:重心, 青:目標ZMP, 緑:多リンクモデルのZMP

重心とZMPの軌跡 y方向
Screenshot-Gnuplot-20100331-y.png
赤:重心, 青:目標ZMP, 緑:多リンクモデルのZMP

かなりずれています。
下半身だけのなので、脚の質点の影響が大きいみたいです。
x方向で、目標ZMPと多リンクモデルのZMPの差は、おそらく、膝が曲がり、膝の質点が前に出たことによる影響。
y方向は、遊脚の質点が及ぼす影響がかなり大きいみたいです。

これらの誤差を補正するために繰り返し計算すれば、多リンクモデルでもうまく歩行できる重心軌道が得られるはず・・・

・・・なのですが、うまくいきませんでした。
多リンクモデルのZMPの計算結果が収束せずにガッタガタになってしまいました。

原因調査中。

それにしても、コンパイラの最適化のオプションで計算結果が変わるのはなぜ?

泥沼にはまりそうです。

« ヒト型ロボット 59 小休止|Top|ヒト型ロボット 57 C++に移植 »

コメント

コメントの投稿

管理者にだけ表示を許可する

トラックバック

http://tsumeguruma.blog46.fc2.com/tb.php/128-f8929a50

Top

HOME

tsumehashi

Author:tsumehashi
FC2ブログへようこそ!

03 | 2020/04 | 05
- - - 1 2 3 4
5 6 7 8 9 10 11
12 13 14 15 16 17 18
19 20 21 22 23 24 25
26 27 28 29 30 - -