トップに戻る

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

;プロセス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へジャンプ


TOPにもどる