SHISEIGYO-1 Walkerを実現させたい俺3 ーバランス動作検討ー
お父ちゃん
2022.1.25
0
0
前回はSHISEIGYO-1 Walkerの足構造と逆運動学を再検討し、ヨチヨチではありますが歩行動作を確認いたしました。
ここではバランス動作について検討します。
目次
バランス動作検討
使用している姿勢制御装置にはホイール回転数から動的に目標姿勢角を調整するIDRS機能がついており、床の傾きやゆるやかな外乱に耐性を持たせております。
だいぶ他方の足を動かせるようになってきた
弊姿勢制御装置にはホイール回転数から動的に目標姿勢角を調整するIDRS機能があるのだけど更に足の座標からバランスする姿勢角を算出してオフセットとして付与しようとしたけど止めた.
発散しそうだし天板は平行に保つという制約があったほうがいいかなと pic.twitter.com/8PEwkv3Al4
— HomeMadeGarbage (@H0meMadeGarbage) January 23, 2022
倒立角動的再調整システム Inverted angle Dynamic Readjustment System (IDRS)については以下の通りです。
前回検討したように天板を水平に保ってIDRS機能のみでの制御では、足をホイール回転軸の極力直下に配置するように移動させる花魁道中のような歩行になります。
まだまだヨチヨチのヨチヨチ#ロボット #robotics #ReactionWheel#2足歩行ロボット #二足歩行ロボット pic.twitter.com/ZmWA55rGai
— HomeMadeGarbage (@H0meMadeGarbage) January 24, 2022
この手法を最適化してスムーズな歩行を目指してもいいのですが、せっかくなので足の配置の自由度を高める検証をしてみました。
足座標からバランス姿勢角導出
IDRSに加えて接地する足の座標からバランスする角度を算出して制御目標角としてみます。
具体的には接地する足先の座標とホイール回転軸が地面に対して垂直になるように制御します。
SHISEIGYO-1 Walkerは足の位置を 股関節のロール角$θ_0$と足の前後(X軸)位置と上下(Z軸)位置で指定します。
バランスオフセット角$θ_{offset}$は以下の図より
$\tan θ_{offset}= \frac{z \tan{θ_0}+29}{34.6+28+z}$ から
$$θ_{offset} = \tan^{-1} \left(\frac{z \tan{θ_0}+29}{34.6+28+z}\right) で導出されます。$$
このオフセット角$θ_{offset}$を制御目標角に付与して制御します。
動作
片足バランス後に 股関節のロール角を変えてみました。
目標姿勢角も変更されいい感じにバランス追従できました。
おわりに
ここでは足の座標からバランスする姿勢角を算出してオフセットとして付与しリアクションホイールを制御いたしました。
これにより足の接地位置の自由度は増しました。
しかし この機構をどのように歩行に利用するかはよく検討しないといけません。
なんだか発散しそうになってるけど、ここからがエンジニアリングの醍醐味でありましょうから楽しんでやっていきたいです。
