JPH09201782A

JPH09201782A - 脚式移動ロボットの歩行制御装置

Info

Publication number: JPH09201782A
Application number: JP8031365A
Authority: JP
Inventors: Nobuaki Ozawa; 信明小澤
Original assignee: Honda Motor Co Ltd
Current assignee: Honda Motor Co Ltd
Priority date: 1996-01-25
Filing date: 1996-01-25
Publication date: 1997-08-05
Anticipated expiration: 2016-01-25
Also published as: JP3662996B2; US5838130A

Abstract

(57)【要約】【課題】脚式移動ロボットが階段の奥行きより長い足
平を備える場合でも安定に降りることを可能とにする。【解決手段】降段するとき、脚式移動ロボットの足平
をかかと部から着地させると共に、次に遊脚となる脚部
の足平が離床するまで、支持脚の足平を階段面に少なく
とも３点以上で接触させ続ける。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】この発明は脚式移動ロボット
の歩行制御装置に関し、より詳しくは階段を安定した歩
容で昇降できるようにしたものに関する。

【０００２】

【従来の技術】近時、脚式移動ロボットが種々提案さ
れ、人と共通な環境で作業することを期待されている。
その作業環境には階段も予定されるが、階段は着地位置
が限定されるため、脚式移動ロボット、特に２足歩行の
脚式移動ロボットにとって安定した歩容で歩行すること
は困難である。

【０００３】脚式移動ロボットが階段を昇降する際の歩
行制御に関しては、本出願人も特開平５−３１８３４２
号、あるいは特開平６−６３８７６号で提案している。
例えば、特開平６−６３８７６号公報においては、階段
を昇降するときに着地位置の誤差の集積が許容範囲を超
えないように歩行制御する技術を提案している。

【０００４】

【発明が解決しようとする課題】人が階段を降りる場合
を考えると、つま先から着地すると共に、足のかかとを
着地直前の支持脚についても離床直前の次に遊脚となる
足についても上げている。このような歩容をとることに
よって、人は着地するときの衝撃を吸収し、関節負荷の
小さい、楽な姿勢で階段を降りることができる。試み
に、かかとから着地するように階段を降りてみれば、大
きな着地衝撃を受けて歩き難いことを容易に体験できよ
う。

【０００５】２足歩行ロボットは人と同じ環境で作業す
ることを期待されているが、実用的な２足歩行ロボット
の大きさを考えると、その足平は人の足平より長くなる
ことが予想される。２足歩行ロボットの足平が、人を基
準に設計されている階段の奥行き（階段面の前後方向長
さ）より長いか、同等であるとき、上に述べたような人
と同じ歩容をとると、着地位置が後ろにずれると上の段
と干渉し、前にずれると踏み外す恐れがある。

【０００６】即ち、このような場合には着地位置のずれ
に対する余裕が殆どないが、脚式移動ロボットの歩行制
御で階段を昇降するときなどは着地位置のずれは必然的
に生じる。

【０００７】従って、この発明の目的は、上記した課題
を解決し、脚式移動ロボット、特に２足歩行ロボットが
階段の奥行きよりも長い足平を持つような場合でも安定
した歩容で階段を降りることを可能とする脚式移動ロボ
ットの歩行制御装置を提供することにある。

【０００８】

【課題を解決するための手段】請求項１項においては、
少なくとも上体と、前記上体に関節を介して連結される
複数本の脚部リンクとを備え、前記複数本の脚部リンク
がそれぞれ関節を介して回転自在に連結される足平を先
端に有してなると共に、階段を昇降自在に構成されてな
る脚式移動ロボットの歩行制御装置において、階段を降
りる際に遊脚を着地させるとき、前記足平のかかと部か
ら着地させるか、あるいは少なくとも前記足平を階段面
に実質的に水平に着地させるように歩行制御する如く構
成した。

【０００９】

【作用】脚式移動ロボットが階段の奥行きよりも長い足
平を持つような場合でも安定した歩容で階段を降りるこ
とができる。

【００１０】

【発明の実施の形態】以下、この発明に係る脚式移動ロ
ボットの歩行制御装置の実施の形態を添付図面を参照し
て説明する。

【００１１】図１はそのロボット１を全体的に示す説明
スケルトン図であり、左右それぞれの脚部リンク２に６
個の関節を備える（理解の便宜のために各関節をそれを
駆動する電動モータで示す）。

【００１２】６個の関節は上から順に、股の脚部回旋用
の関節１０Ｒ，１０Ｌ（右側をＲ、左側をＬとする。以
下同じ）、股のロール方向（ｙ軸まわり。矢状面sagitt
al plane内の運動）の関節１２Ｒ，１２Ｌ、同ピッチ方
向（ｘ軸まわり。左右面frontal plane 内の運動）の関
節１４Ｒ，１４Ｌ、膝部のロール方向の関節１６Ｒ，１
６Ｌ、足部のロール方向の関節１８Ｒ，１８Ｌ、同ピッ
チ方向の関節２０Ｒ，２０Ｌから構成される。

【００１３】足部には足平２２Ｒ，２２Ｌが取着される
と共に、最上位には上体（基体）２４が設けられ、その
内部に後述するマイクロコンピュータからなる制御ユニ
ット２６などが格納される。

【００１４】上記において股関節は関節１０Ｒ（Ｌ），
１２Ｒ（Ｌ），１４Ｒ（Ｌ）から、足関節は関節１８Ｒ
（Ｌ），２０Ｒ（Ｌ）から構成される。また股関節と膝
関節とは大腿リンク２８Ｒ，２８Ｌ、膝関節と足関節と
は下腿リンク３０Ｒ，３０Ｌで連結される。

【００１５】上記の構成により、脚部リンク２は左右の
足についてそれぞれ６つの自由度を与えられ、歩行中に
これらの６×２＝１２個の関節を適宜な角度で駆動する
ことで、足全体に所望の動きを与えることができ、任意
に３次元空間を歩行する。

【００１６】図２は足部の断面図（矢状面で切断）であ
る。前記した足関節１８を駆動する電動モータ（図２で
図示省略）の出力はハーモニック減速機（商品名。図２
で図示省略）の入力端に入力され、周知の如く適宜な倍
率で減速して増力され、下腿リンク３０に取着される固
定部材３２とその下部の回転部材３４とを軸線３６（足
関節１８Ｒ（Ｌ）の軸線に同じ）を中心として歩行進行
方向（sagittal plane内）に相対回転（回動）させ、足
平２２Ｒ（Ｌ）をその方向に傾動させる。

【００１７】その軸線３６と直交する位置には、前記し
た足関節２０を駆動する電動モータ２０Ｍが配置され、
その出力は第２のハーモニック減速機４０に入力され、
前記固定部材３２と回転部材３４とを第２の軸線４２
（足関節２０Ｒ（Ｌ）の軸線に同じ）を中心として進行
方向に直交する左右方向（frontal plane 内）に相対回
転させ、足平２２Ｒ（Ｌ）をその方向に傾動させる。

【００１８】尚、足関節を含む上記したロボットの構成
の詳細は本出願人が先に提案した出願（特開平３−１８
４，７８２号）などに述べられているので、これ以上の
説明は省略する。

【００１９】回転部材３４の下方には公知の６軸力セン
サ４４が取着され、力の３方向成分Ｆｘ，Ｆｙ，Ｆｚと
モーメントの３方向成分Ｍｘ，Ｍｙ，Ｍｚとを測定し、
足部の着地の有無ないしは接地荷重などを検出する。６
軸力センサ４４の下部には、前記した足平２２Ｒ（Ｌ）
を構成する、平板状のフレーム４６が固定される。フレ
ーム４６の下面（足底）は大略平坦に形成され、つま先
部４６ａとかかと部４６ｂには、着地時の衝撃を吸収す
る弾性体５０，５２が張りつけられる。

【００２０】また、図１に示すロボットにおいて、上体
２４には傾斜センサ６０が設置され、左右面内のｚ軸
（重力方向）に対する傾きとその角速度、同様に矢状面
内のｚ軸に対する傾きとその角速度を検出する。また各
関節の電動モータには、その回転量を検出するロータリ
エンコーダが設けられる。

【００２１】また、足平２２Ｒ（Ｌ）の裏面には非接触
型の反射式光センサが装着され、着地位置を検出するが
（図１および図２で図示省略）、それについて後述す
る。

【００２２】更に、図１で図示を省略するが、ロボット
１の適宜な位置には傾斜センサ６０の出力を補正するた
めの原点スイッチ６２と、フェール対策用のリミットス
イッチ６４が設けられる。これらの出力は前記した上体
２４内の制御ユニット２６に送られる。

【００２３】図３は制御ユニット２６の詳細を示すブロ
ック図であり、制御ユニット２６はマイクロ・コンピュ
ータから構成される。そこにおいて傾斜センサ６０など
の出力はＡ／Ｄ変換器７０でデジタル値に変換され、そ
の出力はバス７２を介してＲＡＭ７４に送られる。また
各電動モータに隣接して配置されるエンコーダの出力は
カウンタ７６を介してＲＡＭ７４内に入力されると共
に、原点スイッチなどの出力は波形整形回路７８を経て
同様にＲＡＭ７４内に格納される。

【００２４】制御ユニット２６内にはＣＰＵからなる第
１、第２の演算装置８０，８２が設けられており、第１
の演算装置８０は後述の如く生成されＲＯＭ８４に格納
されている歩容パラメータを読み出して目標関節角度を
算出し、ＲＡＭ７４に送出する。また第２の演算装置８
２は後述の如くＲＡＭ７４からその目標値と検出された
実測値とを読み出し、各関節の駆動に必要な制御値を算
出してＤ／Ａ変換器８６とサーボアンプを介して各関節
を駆動する電動モータに出力する。

【００２５】ここで、図４および図５を参照して先に触
れた光センサについて説明すると、光センサ９０は検出
部９０ａとセンサ本体９０ｂとから構成されると共に、
検出部９０ａは足平２２Ｒ（Ｌ）の両側にそれぞれ５個
づつ１列にアレイ状に配置し、発光部から床面に発せら
れた光の反射光量を検出する。

【００２６】検出部９０ａは光ファイバケーブル９２で
センサ本体９０ｂと接続され、光ファイバ９２を介して
光信号（反射光）が伝達される。センサ本体９０ｂは、
下腿リンク３０Ｒ（Ｌ）の内部に収納され、光信号を電
気信号（デジタル）に変換する。

【００２７】更に、左右の下腿リンク３０Ｒ（Ｌ）の内
部にはそれぞれ、センサ本体群の付近にＤ／Ａ変換器９
４を１個配置し、計１０個の検出部出力を５個分づつ１
つのアナログ信号に変換し、多芯ケーブル９６を介して
制御ユニット２６内のＡ／Ｄ変換器７０に送出し、そこ
でアナログ信号を数値処理可能なデジタル信号に変換す
る。

【００２８】前記した第１の演算装置８０はバス７２を
介してＡ／Ｄ変換器７０から必要なデータを読み出し、
適当な処理を行って足平２２Ｒ（Ｌ）の外側、内側それ
ぞれ５個、左右の脚部を合わせて合計２０個の検出部９
０ａの出力状態（オン／オフ）を検知する。

【００２９】ここで、各列５個の検出部９０ａの中心間
の間隔は、５ｍｍとする。尚、足平２２Ｒ（Ｌ）の幅
は、図６に示すように、２００ｍｍとする。片側の５個
のセンサアレイで検出できる範囲を考えると、全部のセ
ンサがオンまたはオフの状態では相対位置が分からない
ので、例えば階段１００などエッジを検出する場合には
同図に示す如く、全ての出力がオンまたはオフであると
検出できないため、オンの数が１〜４個に対応する１５
ｍｍの範囲となる。

【００３０】検出範囲が１５ｍｍとすると、ロボット１
の階段１００に対する相対位置誤差はそれ以下にしなけ
ればならないが、実際問題として検出範囲が１５ｍｍで
は小さすぎることから、ランドマーカ８０を利用して検
出範囲を拡大する。即ち、図７に示すように、ランドマ
ーカ８０の幅をセンサアレイの幅とほぼ等しい値とし
（図面では理解の便宜のため誇張して示す）、検出範囲
の幅を±２０ｍｍ（４０ｍｍ）と２倍以上に拡大する。

【００３１】ランドマーカ８０は黒色ペイントなど光を
良く吸収する塗料で描いた直線からなる所定幅の面領域
で構成する。また、階段１００の面は白色など光を反射
するように彩色される。光センサ９０の出力状態は、検
出部９０ａに反射光があるときをオンとなるように構成
するので、ランドマーカ８０上にあるとき、および離床
しているときオフとなり、階段１００の面に接触すると
きオンとなる。

【００３２】次いで、図８を参照してこの発明に係る脚
式移動ロボットの歩行制御装置の動作を階段を昇降する
場合を例にとって説明する。

【００３３】まず、Ｓ１０で装置各部をイニシャライズ
してＳ１２に進み、そこで歩容パラメータを前記したＲ
ＯＭ８４からロードする。ここで、ロボットの歩容は力
学的（動的な）安定条件を考慮して予め設計され、歩容
パラメータとしてＲＯＭ８４に記憶されているものとす
る。

【００３４】この歩容パラメータは、上体の位置と姿
勢、および着地位置を含む両足平の軌跡などで表現され
るが、以下これについて先に述べた階段昇降に関して詳
述する。

【００３５】初めに、図９を参照して着地位置について
説明する。同図に示す如く、足平２２Ｒ（Ｌ）の水平面
の長さｌｆは、階段１００の奥行き（前後方向長さ）ｌ
ｓよりもわずかに短いものとする。

【００３６】ここで、つま先部から着地させるとする
と、Ｘの位置に着地させれば幾何学的な関係から見て問
題はなく、力学的にも安定に歩行することができる。し
かし、誤差ｄ（ロボット１の階段１００に対する相対位
置の）が発生し、着地位置がＹ（後方）にずれると、か
かと部４６ｂは一段上の段に接触してしまい、Ｚ（前
方）にずれるときには階段を踏み外してしまう。更に、
足平Ｒ（Ｌ）の水平面の長さｌｆが階段の奥行きｌｓよ
りも長くなると、幾何学的な関係から見て着地できな
い。

【００３７】そこで、この発明に係る装置においては、
歩行パラメータの中の足平の軌跡は、以下のように設定
する。１．遊脚の足平２２Ｒ（Ｌ）は、階段１００の面にかか
と部４６ｂから着地する。あるいは少なくとも実質的に
水平に着地する。換言すれば、つま先部４６ａから着地
しない。２．片足支持期間中、支持脚足平は階段面に面接触し続
けるか、少なくとも３点以上で点接触し続ける。換言す
れば、その間は支持脚足平をｙ軸回り（軸線３６回
り。）に回転させない、即ち、かかと部４６を上げない
ようにする。３．両足支持期間中も同様とする。即ち、次に遊脚とな
る脚部の足平が離床するまで、支持脚足平は階段面に面
接触させたままとするか、少なくとも３点以上で点接触
させ続け、支持脚足平をｙ軸回り（軸線３６回り）に回
転させない。

【００３８】尚、上記で『面接触』ないし『３点以上で
点接触』とは、ロボット１の姿勢が不安定になったとき
に、姿勢を回復するに十分な床反力を起こすに足りるよ
うに、足平が階段に支持されることを意味する。また
『実質的に水平に着地』とは少なくともつま先部からで
はない着地を意味する。

【００３９】図１０ないし図１２に上記を示す（図１０
は片足支持期を、図１１は着地の瞬間を、図１２は離床
の瞬間を示す）。また、図１３に次に遊脚となる脚部の
足平の軌跡を示す。

【００４０】図示の如く、遊脚となる側の足平は階段１
００の面アを垂直に（上の段と干渉しないように）上昇
させられた後、上記１に述べるように、かかと部４６ｂ
から、支持脚足平が着地されている階段面イの次の段ロ
に着地させられる。このとき、想像線で示す如く、足裏
の平坦面が実質的に水平に（階段面と平行するように）
着地させても良い。

【００４１】このような足平の軌跡を上体の位置、姿勢
も含めて歩容パラメータとして予め設定し、制御ユニッ
ト２６のＲＯＭ８４中に格納しておく。また、かかる歩
容パラメータはＺＭＰの軌跡を満足するように設定す
る。尚、ＺＭＰ（Zero MomentPoint ）は、「その点回
りのピッチ軸（左右面frontal plane 内の軸）回り、お
よびロール軸（矢状面sagittal plane内の軸）回りのモ
ーメントが零となる任意の点で、歩行のあらゆる瞬間に
おいて足底接地点と路面とが形成する支持多角形の辺上
あるいはその内側にある点」を意味する。

【００４２】上記を図１４を参照して敷衍すると、前記
した第１の特徴より、ロボットの遊脚はかかと部４６ｂ
側から着地するので、幾何学的に考えると、Ａの位置に
もＢの位置に着地することができる（足平の水平面の長
さｌｆは階段の奥行きｌｓよりもわずかに短いものとす
る）。

【００４３】従って、かかと部４６ｂが着地できる範囲
は、ａ（＝奥行きｌｓ）となる。しかし、Ｂの位置のよ
うに、足平が前方に大きくはみ出すと、次の片足支持期
に安定に歩行することができなくなるので、必要な接地
面積ｂを確保しつつ、Ｃより後方、即ち、ｃの範囲内に
着地すれば、安定に歩行することができる。

【００４４】更に、歩行中に発生する相対位置誤差のた
めに、安定に歩行するのに必要な接地面積ｂを確保する
ことができなければならず、尚且つ、上の段に干渉しな
いようしなければならない。

【００４５】そこで、相対位置誤差の最大許容量ｄの分
だけ余裕を見て、着地位置をＤ〜Ｅの間、即ち、ｅの範
囲内に着地するようにすれば、相対位置誤差が発生して
も接地面積ｂを確保することができ、上の段に干渉する
こともない。換言すれば、着地可能な範囲に余裕をもっ
て安定に歩行させることができ、ｅが零になるまで安定
に歩行し続けることができる。

【００４６】次に前記した第２および第３の特徴の意味
について述べる。

【００４７】図１０ないし図１２に示したように、片足
支持期間中の支持脚と、両足支持期間中の、次に遊脚と
なる脚部の足平が回転（ｙ軸回りに）しない歩容とすれ
ば、図１５および図１６に示すように着地位置が前後方
向に多少ずれたとしても、足平が階段から離れたり、干
渉するという問題を生じないので、相対位置誤差を許容
することができる（図１５は着地の瞬間を、図１６は離
床の瞬間を示す）。

【００４８】即ち、上記した第２の特徴によらない歩容
で歩行したと仮定すると、着地直前では支持脚足平が回
転して図１７ないし図１９に示す姿勢となる。このとき
の問題点の一つは支持脚が線接触（２点で接触）状態と
なるため、転倒しそうになったときに足平で踏み止める
ことができない。そのため、歩行安定性を高めようとす
ると、動的な安定問題を解かなかればならず、高性能の
演算装置（コンピュータ）が必要となる。

【００４９】更に、階段歩行では着地位置に強い制約が
あるので、着地位置を修正することで歩行安定化を図る
ような歩行制御も制約されてしまう。図１７などでは足
平先端が階段からはみ出しているために、階段のエッジ
が回転中心（力の作用点）となっている。これは足平全
体が階段面の上に乗っており、つま先が回転中心になる
ときも同様である。

【００５０】問題点の二つ目は、ロボットの足平が階段
のエッジからはみ出した状態で階段を降りるときの問題
であり、上記した第２、第３の特徴に共に関係する。

【００５１】上記した第３の特徴によらない歩容で階段
を降りるときの離床タイミング（即ち、両足支持期の末
期）を考える。図２０ないし図２２にそれを示す。

【００５２】着地位置がずれて回転中心が、図２０に示
す如く、階段面のエッジになったとする。このとき、図
２１に示す如く、階段に対するロボットの相対位置が前
方にずれたとすると、後ろ側の足で前に蹴る力を発生で
きないので、ロボットは後ろに倒れる。逆に、図２２に
示す如く、相対位置が後ろにずれたときは、前に蹴る力
が強くなりすぎてロボットは前に倒れる。

【００５３】同様に、２番目の特徴によらない歩容で、
着地の直前のタイミング（即ち、片足支持期の末期）を
考えると、図１７に示したように支持脚足平が階段面の
エッジを中心に回転すると仮定するとき、図１８に示す
如く、相対位置が前方にずれると床反力作用点が後ろに
ずれるので、そのモーメントによってロボットは前に倒
れる。

【００５４】逆に、相対位置が図１９に示すように後ろ
にずれたときは床反力作用点が前にずれるので、そのモ
ーメントによりロボットは後ろに倒れる、という問題が
生じる。

【００５５】このように、上記した第１ないし第３の特
徴を持たない歩容では、ロボットの足平の水平面の長さ
が階段の奥行きより大きいときは、ロボットが階段を降
りることが困難になると共に、階段に対するロボットの
相対位置の誤差の大きさによっては、階段を降りること
が不可能となる。

【００５６】ロボットの足平の水平面の長さが階段の奥
行きより大きいために階段を降りることが困難な場合を
除くと、相対位置誤差については、足平と階段のエッジ
との接触位置が前記した光センサ９０でリアルタイムに
検出されることから、そこを回転中心とする歩容を歩行
中にリアルタイムに生成する手法も考えられる。更に
は、足平と階段面とが線接触状態でも、ロボットの動的
安定性を保つ安定化制御を行う手法も考えられる。

【００５７】しかし、これらの手法では動的な安定問題
を解き、歩容をリアルタイムに生成するための複雑なア
ルゴリズムや、演算装置（コンピュータ）の演算処理能
力などを別に解決しなければならない。このような複雑
なアルゴリズムや高性能の演算装置を必要としないこと
もこの発明の利点の一つである。

【００５８】以上のように、上記した特徴を備えた足平
の軌跡を歩容パラメータとして予め設定しておくことに
より、階段の奥行きよりも長い足平を有するロボットに
おいても階段を降りることができ、同時に階段に対する
ロボットの相対位置誤差を許容することができる。

【００５９】また、階段の寸法に影響を受けることな
く、足平の大きさを決定することができるため、階段以
外の場所を歩行するのに有利なときは、足平の大きさを
任意に大きくすることも可能となる。

【００６０】図８の説明に戻ると、続いてＳ１４に進ん
でスタート信号を待機し、スタート信号が生じるとＳ１
６に進んでカウンタをインクリメントし、Ｓ１８に進ん
で歩容修正タイミングか否か判断する。これについては
後述する。

【００６１】続いてＳ２０に進んで姿勢パラメータを計
算する。これは前記した歩容パラメータの中に補間演算
を必要とするものがあるため、ここでそれを求め、Ｓ１
６のカウンタで指定される時刻の姿勢パラメータを計算
する。

【００６２】続いてＳ２２に進んでそれから１２個の関
節の角度を計算し、Ｓ２４に進んで同期信号を待機し、
同期が取れたところでＳ２６に進んで算出した関節角度
を出力し、Ｓ２８に進んで歩行終了と判断されない限
り、Ｓ１６に戻って同様の作業を繰り返すと共に、終了
と判断されるときはＳ３０に進んでカウンタをリセット
して終わる。

【００６３】即ち、Ｓ１６のカウンタの単位時間（例え
ば２０ｍｓ）ごとにＳ１６からＳ２８をループする。ま
たＳ２６で出力された関節角度に基づき、その関節角度
となるように前記した第２の演算装置６２においては図
２３に示すフロー・チャートのＳ１００からＳ１１０に
示すステップに従ってサーボ制御が並行的に行われる
が、この作業は公知であるので、説明は省略する。

【００６４】ここで、Ｓ１８について説明すると、そこ
では歩容修正タイミングであるか否か判断されるが、こ
の制御においては離床時点を歩容修正タイミングとし
た。相対位置誤差を検知するタイミングを離床のときと
したのは、離床以前に相対位置誤差を検知し、目標着地
位置にフィードバックすれば遊脚軌道を遊脚期間全体を
使って修正できるので、急激ではなく、滑らかな変更が
可能となり、歩容の安定性の低下を最小限に抑えること
ができると共に、時間的に最新の相対位置誤差を制御に
使用できるからである。

【００６５】そしてＳ１８で離床時と判断されるときは
Ｓ３２に進み、足平２２Ｒ（Ｌ）に配置された光センサ
９０で階段のエッジを検出し、歩容パラメータで設定さ
れている目標着地位置と比較して階段との相対位置誤差
を検知する。

【００６６】続いてＳ３４に進み、検出した相対位置お
よび角度のずれに応じてそれが累積しないように適当な
目標歩幅修正量を決定し、続いてＳ３６に進んで歩容パ
ラメータ中に記載されている目標着地位置を書き換え
る。

【００６７】目標着地位置が更新されると、歩容は予め
設計された値から、具体的には歩幅が変更される。足平
２２Ｒ（Ｌ）の着地位置はｘ，ｙ，ｚ方向とそれらの軸
まわりの回転で決定されるので、変更した歩幅となるよ
うに、それらの全てまたは一部が修正される。以上の手
順を階段昇降中に１歩ごとに繰り返せば、相対位置誤差
の累積を防止することができ、連続して何段でも昇降す
ることができる。

【００６８】この実施の形態は上記のように構成したの
で、脚式移動ロボット、特に２足歩行ロボットが階段の
奥行きよりも長い足平を持つような場合でも安定した歩
容で階段を降りることができる。

【００６９】また、階段に対するロボットの相対位置誤
差を許容することができ、前述したように誤差が許容範
囲を超えて集積しないように歩行制御することで、連続
して何段でも降りることができる。

【００７０】また、階段の寸法に影響を受けることな
く、足平の大きさを決定することができるため、足平の
大きさを任意に大きくすることができる。

【００７１】上記の如く、この実施の形態では、少なく
とも上体２４と、前記上体に関節１０，１２，１４Ｒ
（Ｌ）を介して連結される複数本の脚部リンク２とを備
え、前記複数本の脚部リンク２がそれぞれ関節１８Ｒ
（Ｌ）を介して回転自在に連結される足平２２Ｒ（Ｌ）
を先端に有してなると共に、階段１００を昇降自在に構
成されてなる脚式移動ロボット１の歩行制御装置におい
て、階段を降りる際に遊脚を着地させるとき、前記足平
２２Ｒ（Ｌ）のかかと部４６ｂから着地させるか、ある
いは少なくとも前記足平を階段面に実質的に水平に着地
させるように歩行制御する（図８のＳ１２以下）如く構
成した。

【００７２】尚、ここで『実質的に水平に着地』とは足
平２２Ｒ（Ｌ）を、つま先部４６ａから着地しないこと
を意味する。

【００７３】更には、前記脚式移動ロボット１が片足支
持期の間は、支持脚足平が少なくとも３点以上で階段面
と点接触し続けるように歩行制御する（図８のＳ１２以
下）如く構成した。

【００７４】更には、前記脚式移動ロボット１が両足支
持期の間は、次に遊脚となる脚部の足平が離床するま
で、その足平が少なくとも３点以上で階段面と接触し続
けるように歩行制御する（図８のＳ１２以下）如く構成
した。

【００７５】尚、実施の形態では脚式移動ロボットが階
段を降りるときを例にとったが、上記は脚式移動ロボッ
トが後ろ向きのまま階段を昇るときにも同様に妥当す
る。

【００７６】更に、上記において歩容パラメータを予め
設定しておくようにしたが、歩行中にリアルタイムに決
定するようにしても良い。

【００７７】更に、上記において２足歩行脚式移動ロボ
ットの例のみ示したが、上記した構成は３足以上の脚式
移動ロボットにおいても原理的には妥当する。

【００７８】

【発明の効果】脚式移動ロボットが階段の奥行きよりも
長い足平を持つような場合でも安定した歩容で階段を降
りることができる。

【図面の簡単な説明】

【図１】この発明に係る脚式移動ロボットの歩行制御装
置を全体的に示すスケルトン図である。

【図２】図１に示す２足歩行ロボットの足部の構造を詳
細に示す説明断面図である。

【図３】図１に示す２足歩行ロボットの制御ユニットの
詳細を示すブロック図である。

【図４】図１に示す２足歩行ロボットに配置した光セン
サの構成を全体的に示す説明図である。

【図５】図４の光センサのロボットの足平での配置位置
を示す足平の説明平面図である。

【図６】図４に示す光センサの階段を昇降するときの検
出動作を示す説明図である。

【図７】図４に示す光センサの検出範囲と階段に設置し
たランドマーカとの関係を示す説明図である。

【図８】図１に示す脚式移動ロボットの歩行制御装置の
動作を示すフロー・チャートである。

【図９】図１に示すロボットが階段を降りるときに、つ
ま先部から着地した状態を示す説明図である。

【図１０】図１に示すロボットがこの発明に係る装置で
設定された歩容で階段を降りるときの片足支持期の状態
を示す説明図である。

【図１１】図１に示すロボットがこの発明に係る装置で
設定された歩容で階段を降りるときの着地の瞬間を示す
説明図である。

【図１２】図１に示すロボットがこの発明に係る装置で
設定された歩容で階段を降りるときの離床の瞬間を示す
説明図である。

【図１３】図１に示すロボットがこの発明に係る装置で
設定された歩容で階段を降りるときの遊脚の軌跡を示す
説明図である。

【図１４】図１に示すロボットがこの発明に係る装置で
設定された歩容で階段を降りるときの着地範囲を示す説
明図である。

【図１５】図１に示すロボットがこの発明に係る装置で
設定された歩容で階段を降りるときの着地の瞬間を示す
説明図である。

【図１６】図１に示すロボットがこの発明に係る装置で
設定された歩容で階段を降りるときの離床の瞬間を示す
説明図である。

【図１７】片足支持期間中に、図１に示すロボットの支
持脚足平がかかと部を上げる歩容で階段を降りるときの
着地の直前を示す説明図である。

【図１８】片足支持期間中に、図１に示すロボットの支
持脚足平がかかと部を上げる歩容で階段を降りるときの
着地の直前を示す、図１７と同様の説明図である。

【図１９】片足支持期間中に、図１に示すロボットの支
持脚足平がかかと部を上げる歩容で階段を降りるときの
着地の直前を示す、図１７と同様の説明図である。

【図２０】両足支持期間中に、図１に示すロボットが足
平をｙ軸回りに回転させる歩容で階段を降りるときの離
床の直前を示す説明図である。

【図２１】両足支持期間中に、図１に示すロボットが足
平をｙ軸回りに回転させる歩容で階段を降りるときの離
床の直前を示す、図２０と同様の説明図である。

【図２２】両足支持期間中に、図１に示すロボットが足
平をｙ軸回りに回転させる歩容で階段を降りるときの離
床の直前を示す、図２０と同様の説明図である。

【図２３】図８のフロー・チャートと並行的に行われ
る、関節角サーボ制御を示すフロー・チャートである。

【符号の説明】

１ロボット２脚部リンク１０，１２，１４Ｒ，Ｌ股関節１６Ｒ，Ｌ膝関節１８，２０Ｒ，Ｌ足関節２２Ｒ，Ｌ足平２４上体２６制御ユニット４６ａつま先部４６ｂかかと部９０光センサ１００階段

Claims

【特許請求の範囲】

【請求項１】少なくとも上体と、前記上体に関節を介
して連結される複数本の脚部リンクとを備え、前記複数
本の脚部リンクがそれぞれ関節を介して回転自在に連結
される足平を先端に有してなると共に、階段を昇降自在
に構成されてなる脚式移動ロボットの歩行制御装置にお
いて、階段を降りる際に遊脚を着地させるとき、前記足
平のかかと部から着地させるか、あるいは少なくとも前
記足平を階段面に実質的に水平に着地させるように歩行
制御することを特徴とする脚式移動ロボットの歩行制御
装置。
【請求項２】前記脚式移動ロボットが片足支持期の間
は、支持脚足平が少なくとも３点以上で階段面と点接触
し続けるように歩行制御されることを特徴とする請求項
１項記載の脚式移動ロボットの歩行制御装置。
【請求項３】前記脚式移動ロボットが両足支持期の間
は、次に遊脚となる脚部の足平が離床するまで、その足
平が少なくとも３点以上で階段面と接触し続けるように
歩行制御されることを特徴とする請求項１項または２項
記載の脚式移動ロボットの歩行制御装置。