HSWB−02を使いこなそう
とにかく歩かせよう編
2足歩行ロボットの基本、歩行のプロセスを紹介
今のROBO−ONEのレベルなら不知火の歩行プロセスも
トップシークレットにするほどではなくなったので説明します。
| 上から見た足 赤が接地してる足 黒が離れてる足 黄色が重心 上が正面 |
横から見た脚 黄色が間接 左が正面 |
正面から見た脚 黄色が間接 |
|
![]() |
![]() |
![]() |
プロセス1 横から見て付け根から足首まで 一直線になるようホームポジションを 設定、 重心は足と足の真ん中に来るよう 姿勢を調整。 |
![]() |
![]() |
![]() |
プロセス2 重心を左に移動。 |
![]() |
![]() |
![]() |
プロセス3 右脚のヒザを曲げ足をリフトアップ。 |
![]() |
![]() |
![]() |
プロセス4 右足を前へスライド。 |
![]() |
![]() |
![]() |
プロセス5 右足を下ろすと同時に左足を後ろへ スライド、同時に重心を中心へ。 |
![]() |
![]() |
![]() |
プロセス6 重心を右足に移動。 |
![]() |
![]() |
![]() |
プロセス7 左足を前へ引き上げる。 |
![]() |
![]() |
![]() |
プロセス8 左足を下ろすと同時に右足を後ろへ スライド、同時に重心を中心へ。 |
![]() |
![]() |
![]() |
プロセス9 重心を左足に移動。 |
![]() |
![]() |
![]() |
プロセス10 右足を前へ引き上げる プロセス5へジャンプ。 |
こうして出来たのが不知火の歩行プログラムです。↓
#ASはサーボを動かすためのコマンド
+は出力軸から見て時計回り、−は反時計回り、数字は動かす量
#AMコマンドでスピード調節(HSWB−02の取説参照)
サーボの番号は以下のとおり。
S12右足回転軸、S13左足回転軸、S14右足付根X軸、S15左足付根X軸
S16右足付根Y軸、S17左足付根Y軸、S18右足ヒザ、S19左足ヒザ
S20右足首Y軸、S21左足首Y軸、S22右足首X軸、S23左足首X軸
| ;歩行 ;プロセス1 P ;プロセス2 #AS S14 - 10 #AS S15 - 10 #AS S22 + 10 #AS S23 + 10 ;MAX=10 #AM 42 1 N ;プロセス3 #AS S15 + 3 #AS S16 + 10 #AS S18 + 20 #AS S20 - 10 ;MAX=20 #AM 15 1 N ;プロセス4 #AS S16 + 10 #AS S20 + 10 ;MAX=10 #AM 15 1 N :LOOP ;プロセス5 #AS S14 + 10 #AS S15 + 7 #AS S16 - 10 #AS S17 + 10 #AS S18 - 20 #AS S20 + 10 #AS S21 + 10 #AS S22 - 10 #AS S23 - 10 ;MAX=20 #AM 30 1 N ;プロセス6 #AS S14 + 10 #AS S15 + 10 #AS S16 - 10 #AS S17 + 10 #AS S20 - 10 #AS S21 + 10 #AS S22 - 10 #AS S23 - 10 ;MAX=10 #AM 28 1 N ;プロセス7 #AS S14 - 3 #AS S17 - 40 #AS S19 - 20 #AS S21 - 20 ;MAX=40 #AM 62 1 N ;プロセス8 #AS S14 - 7 #AS S15 - 10 #AS S16 - 10 #AS S17 + 10 #AS S19 + 20 #AS S20 - 10 #AS S21 - 10 #AS S22 + 10 #AS S23 + 10 ;MAX=20 #AM 30 1 N ;プロセス9 #AS S14 - 10 #AS S15 - 10 #AS S16 - 10 #AS S17 + 10 #AS S20 - 10 #AS S21 + 10 #AS S22 + 10 #AS S23 + 10 ;MAX=10 #AM 28 1 N ;プロセス10 #AS S15 + 3 #AS S16 + 40 #AS S18 + 20 #AS S20 + 20 ;MAX=40 #AM 62 1 N J LOOP |
・ホームポジション復帰 ・重心を左に移動。 ・右脚のヒザを曲げ足をリフトアップ。 S15の+3は片足の状態で傾いた股関節の補正 ・右足を前へスライド。 右足を下ろすと同時に左足を後ろへ スライド、同時に重心を中心へ。 重心を右足に移動。 左足を前へ引き上げる。 S14の−3は片足の状態で傾いた股関節の補正 左足を下ろすと同時に右足を後ろへ スライド、同時に重心を中心へ。 重心を左足に移動。 右足を前へ引き上げる S15の+3は片足の状態で傾いた股関節の補正 プロセス5へジャンプ |