JP2018034239A - 移動ロボット及びそのほふく移動方法 - Google Patents
移動ロボット及びそのほふく移動方法 Download PDFInfo
- Publication number
- JP2018034239A JP2018034239A JP2016168790A JP2016168790A JP2018034239A JP 2018034239 A JP2018034239 A JP 2018034239A JP 2016168790 A JP2016168790 A JP 2016168790A JP 2016168790 A JP2016168790 A JP 2016168790A JP 2018034239 A JP2018034239 A JP 2018034239A
- Authority
- JP
- Japan
- Prior art keywords
- limb
- limbs
- mobile robot
- road surface
- grounding
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
【課題】不整地路面の進行を安定して行える移動ロボットを提供すること。【解決手段】移動ロボット10は、所定の範囲内で動作可能な複数の肢体11と、各肢体11を支持するとともに、各肢体11の動作に伴って移動可能な胴体12と、各肢体11の動作制御を行う制御装置13とを備えており、路面Rに対して各肢体11の接地と胴体12の接地とを繰り返し行いながら前進するほふく移動を行えるようになっている。制御装置13は、各肢体11及び胴体12の動作状態が異なる複数のフェーズを所定順に行う基準歩容パターンが記憶され、基準歩容パターンに従って各肢体11の動作制御を行う基準歩容制御手段21を備えている。この基準歩容パターンは、胴体12が路面Rに接地する各フェーズで、胴体12が面接地するように、若しくは、胴体12の外周部分における接地位置を変えながら線接地若しくは点接地するように設定される。【選択図】 図1
Description
本発明は、移動ロボット及びそのほふく移動方法に係り、更に詳しくは、路面に対して各肢体の接地と胴体の接地とを繰り返し行いながら前進するほふく移動を行う移動ロボット及びそのほふく移動方法に関する。
大規模災害により建築物等が倒壊して瓦礫が散在しているような脆弱な環境での状況調査と復旧活動には、危険と困難を伴う。そこで、そのような極限環境下での作業を行うには、災害対応ロボットが必要となる。この災害対応ロボットとしては、クローラの回転によって移動するクローラ式ロボット(特許文献1等参照)や、2つの脚部の動作によって移動する2足歩行型の脚式ロボット(特許文献2等参照)等が提案されている。
しかしながら、前記特許文献1に開示されているクローラ式の災害対応ロボットでは、障害物の跨ぎ越え等の不連続な足場における踏破が困難で、移動途中での転倒を伴い易い。また、瓦礫等による不整地は、路面崩壊の可能性があり、前記特許文献2に開示されている2足歩行型の脚式災害対応ロボットは、重心位置が高いことから、不整地の移動が不安定で転倒し易くなり、転倒時の衝撃による破損が生し易い。
ところで、特許文献3には、前後左右4つの各脚を支持するロボット本体の中央部分の左右2箇所に動輪を設け、当該動輪と2つの脚が接地した状態で、残り2つの脚が移動する遊脚動作と、当該各脚でロボット本体を持ち上げて移動する立脚動作とを繰り返すほふく移動ロボットが開示されている。前記遊脚動作は、左右何れか一方側の前脚と、左右何れか他方側の後脚とをペアで同時に2脚ずつ動かす歩容となっている。
前記特許文献3のほふく移動ロボットにあっては、前記遊脚動作の際に、動作していない2つの脚の他に、ロボット本体の中央部分の左右2箇所が、動輪を通じて路面に固定的に接地し、左右何れか一方側の前脚と、左右何れか他方側の後脚とをペアで同時に2脚ずつ動かす歩容パターンとなっている。ところが、例えば、災害現場等の状況により、遊脚動作において、左右両側の各前脚を同時に動かし、左右両側の各後脚を異なるタイミングで動かす他の歩容パターンの要請がある場合に、前記特許文献3の構造では、ロボットの安定性に欠けることになる。すなわち、この構造では、動輪を通じたロボット本体の接地部位が常時一定となる左右中央位置で点接地しており、形成される支持多角形の領域が、ロボット本体の半分程度しか重ならない。このため、前後両側の2脚のうち何れか一方側の2脚が遊脚動作している際に、支持多角形の辺上となるロボット本体の中央に存在するロボットの重心位置が、当該一方側に少しでもずれると、支持多角形の領域から直ぐに外れてしまい、ロボットの転倒の虞が生じる。
また、前記ほふく移動ロボットにあっては、予定していた進行方向に何らかの障害が存在する等の理由で急な方向転換や旋回等を行いたい場合に、路面に接地しているロボット本体の部分が、一方向のみの動作を許容する動輪となっているため、当該動輪を横滑りさせない限り、その場においての旋回や左右方向や斜め方向の移動が出来ず、小回りが利かない構造となっている。
本発明は、このような課題に着目して案出されたものであり、その主目的は、種々の歩容パターンに適用しても、瓦礫等が散在している不整地路面の移動や障害物の跨ぎ越えを安定して行うことができる移動ロボット及びそのほふく移動方法を提供することにある。
また、本発明の他の目的は、何らかの障害により、予定していた進行を阻害する要因が生じた場合でも、当該障害に対応した動作により目標位置への進行を可能にする移動ロボットを提供することにある。
前記主目的を達成するため、本発明は、主として、所定の範囲内で動作可能な複数の肢体と、当該各肢体を支持するとともに、前記各肢体の動作に伴って移動可能な胴体と、前記各肢体の動作制御を行う制御装置とを備え、路面に対して前記各肢体の接地と前記胴体の接地とを繰り返し行いながら前進するほふく移動を行う移動ロボットにおいて、前記制御装置は、前記各肢体及び前記胴体の動作状態が異なる複数のフェーズを所定順に行う基準歩容パターンが記憶され、当該基準歩容パターンに従って前記各肢体の動作制御を行う基準歩容制御手段を備え、前記基準歩容パターンは、前記胴体が前記路面に接地する各フェーズで、前記胴体が面接地するように、若しくは、前記胴体の外周部分における接地位置を変えながら線接地若しくは点接地するように設定される、という構成を採っている。
また、主として、所定の範囲内で動作可能な複数の肢体と、当該各肢体を支持するとともに、前記各肢体の動作に伴って移動可能な胴体と、前記各肢体の動作制御を行う制御装置とを備え、路面に対して前記各肢体の接地と前記胴体の接地とを繰り返し行いながら前進するほふく移動を行う移動ロボットにおいて、
前記制御装置は、前記各肢体及び前記胴体の動作状態が異なる複数のフェーズを所定順に行う基準歩容パターンが記憶され、当該基準歩容パターンに従って前記各肢体の動作制御を行う基準歩容制御手段を備え、
前記基準歩容パターンは、前記胴体が接地しているタイミングで全ての前記肢体を同時に動かし、全ての前記肢体が接地しているタイミングで、前記各肢体の動作により前記胴体を前記路面から持ち上げて進行方向に移動させる全肢同時移動パターンである、という構成を採っている。
前記制御装置は、前記各肢体及び前記胴体の動作状態が異なる複数のフェーズを所定順に行う基準歩容パターンが記憶され、当該基準歩容パターンに従って前記各肢体の動作制御を行う基準歩容制御手段を備え、
前記基準歩容パターンは、前記胴体が接地しているタイミングで全ての前記肢体を同時に動かし、全ての前記肢体が接地しているタイミングで、前記各肢体の動作により前記胴体を前記路面から持ち上げて進行方向に移動させる全肢同時移動パターンである、という構成を採っている。
なお、本特許請求の範囲及び本明細書において、特に明示しない限り、「前」、「後」は、移動ロボットの進行方向における「前」、「後」を意味し、「左」、「右」は、当該前後方向に対する「左」、「右」を意味し、「上」、「下」は、鉛直方向における「上」、「下」を意味する。
また、本明細書にて用いられる直交3軸については、図1等に示されるように、前後方向(進行方向)に延びる軸線をx軸とし、左右方向(横方向)に延びる軸線をy軸とし、上下方向(鉛直方向)に延びる軸線をz軸とする。
本発明によれば、路面に対して各肢体の接地と胴体の接地とを繰り返し行いながら前進するほふく移動により、胴体を路面に接地させながら移動ロボットを移動することが可能になるため、当該移動を低重心の状態で安定的に行うことができ、仮に、不整地路面等の進行によって転倒した場合でも、当該転倒時の衝撃を小さくしてロボットを破損し難くすることができる。
また、前記胴体を接地させる際に、面接地し、若しくは、その外周部分における接地位置を各フェーズで変えながら線接地若しくは点接地するため、ほふく移動を行う種々の基準歩容パターンに対し、より広範囲となる支持多角形をフェーズ毎に設定することができる。これにより、種々の基準歩容パターンにおいて、移動ロボットが不整地路面等を進行することでロボットの重心位置が多少移動しても、当該重心位置を確実に支持多角形の内側の領域に含めることができ、ロボットの安定性を高めることができる。
更に、基準歩容パターンとして、同じタイミングで全ての前記肢体を動かす全肢同時移動パターンを採用することにより、動作数が、肢体の移動と胴体の移動の2つとなり、よりスピーディーなほふく移動が可能になる。
また、方向転換制御手段を採用することで、移動ロボットが予め入力された目標位置に向かって基準歩容パターンで移動する際に、路面の崩壊等により、目標位置への移動ロボットの進行方向を修正する必要が生じたときでも、肢体の繰り出し量の左右差による小回りの利いた方向転換が可能になる。
更に、接触回避制御手段を採用することで、基準歩容パターンで肢体を前方に移動する際に、肢体の先端部分の路面からの上げ高さが、前方に位置する路面の凹凸や障害物に対して低い場合でも、当該路面等に移動ロボットが干渉して進行を阻害しないように対応することができる。
また、路面の凹凸や崩壊等によって胴体が傾いたときに、予め設定された基準動作軌道で肢体の先端部分が動作すると、胴体の傾きの無い状態では発生しないタイミングで、先端部分が路面に接触してしまう問題が生じるが、先端軌道修正制御手段を採用することにより、胴体の傾きに応じた基準動作軌道の補正により、前記問題を解決することができる。
以下、本発明の実施形態について図面を参照しながら説明する。
図1(A)には、本実施形態に係る移動ロボットを概念的に表した平面図が示され、同図(B)には、同(A)の側面図が示されている。また、図2には、前記移動ロボットの構成を示すブロック図が示されている。これらの図において、前記移動ロボット10は、所定の範囲内で動作可能な複数の肢体11と、当該各肢体11を支持するとともに、各肢体11の動作に伴って移動可能な胴体12と、肢体11の動作制御を行う制御装置13とを備えている。なお、以下説明においては、図1(A)、(B)中の右方を前方としている。
この移動ロボット10は、胴体12が路面Rに接地した状態で、肢体11の先端部分を前方に移動させるフェーズと、全ての肢体11が路面Rに接地した状態で、肢体11の動作によって胴体12を路面Rから持ち上げて移動させるフェーズとを繰り返し行いながら前進するほふく移動が可能となっている。
前記肢体11は、前後左右にそれぞれ1箇所ずつ合計4つ設けられており、それぞれ実質的に同一の構成となっている。すなわち、各肢体11は、複数の部材が関節部分を介して相対回転可能に接続された多関節型の構造となっており、各関節部分に設けられたモータ15(図2参照)の駆動により、回転運動、屈曲運動、伸展運動を可能に設けられ、路面Rに接地する肢体11の先端部分となるエンドエフェクタ11Aが所定範囲内で移動可能になっている。
前記エンドエフェクタ11Aは、その底部が路面Rに面接地可能な形状をなしており、当該エンドエフェクタ11Aには、外部の物体との接触状態を検知するための接触状態検知センサとして、6軸の力覚センサ17(図2参照)が設けられている。なお、前記接触状態検知センサとしては、力覚センサ17の他に、外部の物体との接触状態を検知できる限り、接触センサ等の他のセンサを適用することもできる。
前記胴体11は、特に限定されるものではないが、路面Rへの接地部分となる底部がほぼ平面状となる箱型となっている。この胴体11には、前記制御装置13と、胴体11の直交3軸方向の傾き角度をそれぞれ検出可能な姿勢センサ18と、移動ロボット10の現在の位置情報を取得する環境認識センサ19とが搭載されている。この環境認識センサ19としては、移動ロボット10の現在の3次元位置情報を取得できる限りにおいて、カメラの撮像に基づいて位置情報を検出可能なものやGPSを使用したもの等、種々のセンサを適用することができる。
前記制御装置13は、CPU等の演算処理装置及びメモリやハードディスク等の記憶装置等からなるコンピュータによって構成され、当該コンピュータを以下の各手段として機能させるためのプログラムがインストールされている。
この制御装置13は、図2に示されるように、前記ほふく移動に際する各肢体11及び胴体12の動作状態が異なる複数のフェーズを所定順に行う基準歩容パターンに従って移動ロボット10が移動するように、モータ15の駆動を制御する基準歩容制御手段21と、基準歩容パターンでの進行方向が予め入力された目標位置の方向からずれた場合に、移動ロボット10の進行方向を変えるように、モータ15の駆動を制御する方向転換制御手段22と、前方に位置する路面Rや物体への接触を回避するように、モータ15の駆動を制御する接触回避制御手段23と、胴体12の路面Rに対する傾きに応じ、基準歩容パターンでのエンドエフェクタ11Aの動作を修正するように、モータ15の駆動を制御する先端軌道修正制御手段24とを備えている。
前記基準歩容制御手段21では、基準歩容パターンとして、各肢体11及び胴体12の動作状態が異なる複数のフェーズからなるパターンが予め記憶され、当該フェーズ毎に各肢体11の動作状態を変えながら、各肢体11の動作制御がなされる。
この基準歩容パターンにおいて、エンドエフェクタ11Aは、一定の基準動作軌道に沿って移動するようになっている。この基準動作軌道は、図1(B)に示されるように、中間点A、B、C、Dを頂点とし、路面Rに対して垂直に起立する方形状として表される。すなわち、この基準動作軌道では、路面R側の初期位置である中間点Aから、その真上に所定量持ち上げて、中間点Bにエンドエフェクタ11Aを移動させる第1の軌道aと、中間点Bから水平方向前方の中間点Cにエンドエフェクタ11Aを移動させる第2の軌道bと、エンドエフェクタ11Aを中間点Cからその真下に前記所定量下ろして、中間点Aよりも前方に位置する中間点Dにエンドエフェクタ11Aを移動させる第3の軌道cと、エンドエフェクタ11Aを中間点Dから胴体12側に移動して中間点Aに戻す第4の軌道dとが順に繰り返し行われる。
本実施形態における前記基準歩容パターンは、胴体12が路面Rに接地しているタイミングで全ての肢体11を同時に動かし、全ての肢体11が路面Rに接地しているタイミングで、各肢体11の動作により胴体12を路面Rから持ち上げて進行方向に移動させる全肢同時移動パターンとなっている。
すなわち、この全肢同時移動パターンでは、図3(A)、(B)における(1)から(7)の各フェーズの順で、移動ロボット10を進行方向に移動させるようになっている。なお、これら各図において、同図中右方が進行方向となっている。
先ず、各肢体11の先端側に位置するエンドエフェクタ11Aが全て路面Rに接地している4肢全体の接地状態(図3(A)、(B)中(1)参照)のまま、各肢体11の屈曲運動を主とした動作により、同図中(2)に示されるように、胴体12の底部を路面Rに面接地させる。次に、胴体12を面接地した状態のまま、同図中(3)、(4)に示されるように、各肢体11の回転運動を主とした動作により、全ての肢体11のエンドエフェクタ11Aを路面Rから離して前方に移動させ、同図中(5)に示されるように、路面Rの更に前方の地点に接地させる。そこから、同図中(6)に示されるように、各エンドエフェクタ11Aを路面Rに接地した状態で、各肢体11の伸展運動を主とした動作により、胴体12を路面Rから持ち上げる。そして、各肢体11の回転運動を主とした動作により、胴体12を前方に移動させ、同図中(1)と同じ状態で全体が前方に移動した同図中(7)に示される状態とし、以降、前述の動作が繰り返し行われ、移動ロボット10が進行方向に移動することになる。
この全肢同時移動パターンでは、胴体12の接地時に路面Rに面接触しているため、全てのフェーズにおいて、路面Rに対する接地点を直線で結んで得られる支持多角形(図3(B)中1点鎖線参照)が、胴体12の全領域を含む4角形となり、安定したほふく移動が可能になる。
なお、前記基準歩容パターンとしては、前記全肢同時移動パターンに限らず、他のパターンを採用可能である。当該他の基準歩容パターンとしては、前後両側の2つの肢体11をそれぞれセットにして、肢体11を前後異なるタイミングで動かす前後同時移動パターンと、左右両側の2つの肢体11をそれぞれセットにして、当該肢体11を左右異なるタイミングで動かす左右同時移動パターンと、各肢体11を1肢ずつ異なるタイミングで動かす1肢移動パターンとを例示できる。また、ロボット操作に際し、これら各種の基準歩容パターンを任意で選択し、当該選択された基準歩容パターンに応じて歩容制御を行うこともできる。
前後同時移動パターンでは、図4(A)、(B)における(1)から(7)の各フェーズの順で、移動ロボット10を進行方向に移動させるようになっている。なお、これら各図においても、同図中右方が進行方向となっている。
このパターンでは、前側若しくは後側の何れか一方側の左右2つの肢体11を路面Rに接地させるとともに、その前後反対側となる胴体12の底部における外周部分を路面Rに線接地させた状態で、他方側の左右2つの肢体11を進行方向に移動する動作が行われ、当該動作を前後両側それぞれの2つの肢体11で交互に繰り返し行うことで、移動ロボット10を進行方向に移動させるようになっている。
すなわち、先ず、各肢体11のエンドエフェクタ11Aが全て路面Rに接地している図4各図中(1)の状態から、同図中(2)に示されるように、後側の2つの肢体11を接地状態としたまま、前側の2つの肢体11を路面Rから離し、胴体12の底部における前端側部分を路面Rに対して線接地させる。その状態で、前側の2つの肢体11を前方に移動し、同図中(3)に示されるように、当該肢体11を路面Rの更に前方の地点に接地させる。そして、同図中(4)に示されるように、全肢体11が路面Rに接地した状態で、胴体12を路面Rから持ち上げる。その後、同図中(5)に示されるように、前側の2つの肢体11を接地状態としたまま、後側の2つの肢体11を路面Rから離し、胴体12の底部における後端側部分を路面Rに対して線接地させる。その状態で、後側の2つの肢体11を前方に移動し、当該肢体11を路面Rの更に前方の地点に接地させた上で、同図中(6)に示されるように、全肢体11が路面Rに接地した状態のまま胴体12を路面Rから持ち上げる。更に、各肢体11が全て路面Rに接地している状態で、当該各肢体11の動作により胴体12を前方に移動させると、同図中(1)と同じ状態で全体が前方に移動した同図中(7)に示される状態とし、以降、前述の動作が繰り返し行われる。
以上の前後同時移動パターンでは、図4(B)中1点鎖線で示される前記支持多角形が、全肢同時移動パターンと同様に、全てのフェーズにおいて、胴体12の全領域を含む4角形となり、安定したほふく移動が可能になる。つまり、この前後同時移動パターンでは、胴体12の路面Rへの接地時に、遊脚側となる肢体11の部位に対応して、支持多角形が最大になるように、胴体12の外周部分における接地位置を前後で変えるようになっている。
前記左右同時移動パターンは、前述した前後同時移動パターンに対し、前後の肢体11の動作パターンを左右の肢体11の動作パターンに置き換えたパターンである。
詳述すると、この左右同時移動パターンは、図5中(1)から(3)の各フェーズの順で、移動ロボット10を進行方向に移動させるようになっている。なお、これら各図においては、同図中上方が進行方向となっており、前記支持多角形が一点鎖線で示されている。
この左右同時移動パターンでは、左側若しくは右側の何れか一方側の前後2つの肢体11を路面Rに接地させるとともに、その左右反対側となる胴体12の底部における外周部分を路面Rに線接地させた状態で、他方側の前後2つの肢体11を進行方向に移動する動作が行われ、当該動作を左右両側それぞれの2つの肢体11で交互に繰り返し行うことで、移動ロボット10を進行方向に移動させるようになっている。
すなわち、先ず、各肢体11のエンドエフェクタ11Aが全て路面Rに接地している状態から、右側の2つの肢体11を接地状態としたまま、左側の2つの肢体11を路面Rから離して、胴体12における底部の左端側部分を路面Rに対して線接地させる(図5中(1)参照)。その状態で、同(1)中矢印で示すように、左側の2つの肢体11を前方に移動し、当該肢体11を路面Rの更に前方の地点に接地させてから、胴体12を路面Rから持ち上げる。その後、先ほど動かした左側の2つの肢体11を接地状態としたまま、反対側となる右側の2つの肢体11を路面Rから離して、胴体12における底部の右端側部分を路面Rに対して線接地させる(同図中(2)参照)。その状態で、同(2)中矢印で示すように、右側の2つの肢体11を前方に移動して、当該肢体11を路面Rの更に前方の地点に接地させてから、胴体12を路面Rから持ち上げる。その後、路面Rに接地している全肢体11の動作により、胴体12を前方に移動させ(同図中(3)参照)、以降、前述の動作が繰り返し行われる。
以上の左右同時移動パターンでは、図5中1点鎖線で示される前記支持多角形が、前述した前後同時移動パターンと同様に、全てのフェーズにおいて、胴体12の全領域を含む4角形となり、安定したほふく移動が可能になる。つまり、この左右同時移動パターンでは、胴体12の路面Rへの接地時に、遊脚側となる肢体11の部位に対応して、支持多角形が最大になるように、胴体12の外周部分における接地位置を左右で変えるようになっている。
前記1肢移動パターンでは、胴体12の底部における外周部分の一部を路面Rに点接地させた状態で、各肢体11を1肢ずつ路面Rから離して進行方向に移動させる。ここで、胴体12の外周部分のうち路面Rに接地する部位は、路面Rから離す肢体11の部位に対応して変わることになる。
1肢移動パターンの一例として、図6に示される態様がある。なお、これら各図においても、同図中上方が進行方向となっており、前記支持多角形が一点鎖線で示されている。
この態様では、各肢体11のエンドエフェクタ11Aが全て路面Rに接地している状態から、左前側の肢体11のみを路面Rから離して、胴体12の底部における左前端側のコーナ部分を路面Rに対して点接地させる(同図中(1)参照)。そして、路面Rから胴体12を持ち上げ、右前側の肢体11のみを路面Rから離して、胴体12の底部における右前端側のコーナ部分を路面Rに対して点接地させる(同図中(2)参照)。更に、路面Rから胴体12を持ち上げ、左後側の肢体11のみを路面Rから離して、胴体12の底部における左後端側のコーナ部分を路面Rに対して点接地させる(同図中(3)参照)。次に、路面Rから胴体12を持ち上げ、右後側の肢体11のみを路面Rから離して、胴体12の底部における右後端側のコーナ部分を路面Rに対して点接地させる(同図中(4)参照)。最後に、全て路面Rに接地している状態の各肢体11の動作により、胴体12を前方に移動させ(同図中(5)参照)、以降、前述の動作が繰り返し行われる。
この1肢移動パターンでは、図6中1点鎖線で示される前記支持多角形が、前記各パターンと同様に、全てのフェーズにおいて、胴体12の全領域を含む4角形となり、安定したほふく移動が可能になる。つまり、この1肢移動パターンでも、胴体12の路面Rへの接地時に、遊脚側となる肢体11の部位に対応して、支持多角形が最大になるように、胴体12の外周部分における接地位置を各コーナ部分で変えるようになっている。
前記方向転換制御手段22では、移動ロボット10が予め入力された目標位置に向かって前述の基準歩容パターンで移動する際に、路面の崩壊等により、移動ロボット10の目標位置への進行方向を修正する必要が生じたときに、エンドエフェクタ11Aの繰り出し量(距離)を左右の肢体11間で差を設けることにより、移動ロボット10の方向転換制御を行うようになっている。ここでの方向転換制御は、環境認識センサ19で検出された移動ロボット10の位置情報に基づいて行われる。
すなわち、ここでは、図7に示されるように、移動ロボット10の進行方向(同図中矢印参照)と目標位置Qまでの直線方向とのなす角度である目標位置Qに対するずれ角度φに応じて、エンドエフェクタ11Aの繰り出し量が左右で差が設けられ、基準歩容パターンに対して方向転換される。ここでのエンドエフェクタ11Aの繰り出し量は、次式(1)〜(3)により決定される。
上式(1)において、vは、予め入力された移動ロボット10の速度ベクトルであり、Qは、予め入力された目標位置の位置ベクトルであり、Pは、前記環境認識センサ19で検出された移動ロボット10の位置ベクトルである。これら各ベクトルv,Q,Pは、xy平面における2次元ベクトルである。また、ここでのずれ角度φは、移動ロボット10の進行方向左側に目標位置が存在する場合に正の値とし、同右側に目標位置が存在する場合に負の値とする。
上式(2)、(3)において、lL1は、基準歩容パターンにおける左側の前後双方の肢体11の繰り出し量であり、lR1は、基準歩容パターンにおける右側の前後双方の肢体11の繰り出し量である。更に、lL2は、方向転換のために修正量を加えた左側の前後双方の肢体11の繰り出し量であり、lR2は、方向転換のために修正量を加えた右側の前後双方の肢体11の繰り出し量である。なお、kは、予め設定されたゲインであり、基準歩容パターンでは、各肢体11の繰り出し量が左右同一となっている。
以上の各式により、ずれ角度φが正の値の場合には、目標位置が移動ロボット10の進行方向に対して左側にあるため、上式(2)により、右側における前後両側の肢体11の繰り出し量が、左側に比べて大きくなるような修正が加えられ、移動ロボット10が左方に方向転換しながら前進することになる。
逆に、ずれ角度φが負の値の場合には、目標位置が移動ロボット10の進行方向に対して右側にあるため、上式(3)により、左側における前後両側の肢体11の繰り出し量が、右側に比べて大きくなるような修正が加えられ、移動ロボット10が右方に方向転換しながら前進することになる。
前記接触回避制御手段23では、前記基準歩容パターンでの肢体11の持ち上げ量では、前方に位置する路面Rや物体に接触する場合に、これら路面や物体を乗り越えて前進できるように、各肢体11の動作を制御する接触回避制御が行われる。具体的には、基準歩容パターンでエンドエフェクタ11Aを前方に移動する際に、図8に示されるように、路面Rからのエンドエフェクタ11Aの持ち上げ高さが路面Rの凹凸や障害物に対して低い場合に、当該路面R等に移動ロボット11が干渉して進行が阻害されないように、エンドエフェクタ11Aの持ち上げ高さが調整される。
すなわち、ここでは、エンドエフェクタ11Aの動作中に、エンドエフェクタ11Aの先端側に設けられた力覚センサ17によりエンドエフェクタ11Aと路面R等との接触が検知されると、図8(A)の点線矢印で示されるように、当該エンドエフェクタ11Aを一旦後方に移動してから、同図(B)に示されるように、エンドエフェクタ11Aの持ち上げ高さを上げるように上方に移動した後で、再び前方にエンドエフェクタ11Aが繰り出される。
前記後方移動の際のx軸方向の移動量と、前記上方移動の際のz軸方向の移動量は、予め所定の値が記憶されており、予め設定された閾値よりも大きな衝突力が力覚センサ17により検出された場合に、エンドエフェクタ11Aが路面Rや障害物等の物体に接触したと判定され、前記各移動量により前述の接触回避制御が行われる。
前記先端軌道修正制御手段24では、路面の凹凸や崩壊等によって胴体12が傾いたときに、エンドエフェクタ11Aが前述した基準動作軌道(図1(B)参照)で動作すると、路面Rにエンドエフェクタ11Aが接触する虞があるため(図9(A)参照)、姿勢センサ18により検出された胴体12の傾き角度に応じて基準動作軌道が修正され、当該修正後の補正軌道(図9(B)中の矢印参照)に基づいて肢体11の動作を制御する先端軌道修正制御がなされる。
具体的には、次式(4)、(5)に基づき、胴体12の傾きに応じて前記各中間点A〜D(図1(B)参照)の位置が修正されるともに、当該各中間点A〜Dでのエンドエフェクタ11Aの姿勢が修正され、当該修正後の各中間点A〜Dを順に直線移動する補正軌道が生成される。
これら各式において、S´nは、n番目の中間点での修正後におけるエンドエフェクタ11Aの3次元位置ベクトルであり、Snは、n番目の中間点での修正前におけるエンドエフェクタ11Aの既知の3次元位置ベクトルである。また、M´nは、n番目の中間点での修正後におけるエンドエフェクタ11Aの3次元姿勢ベクトルであり、Mnは、n番目の中間点での修正前におけるエンドエフェクタ11Aの既知の3次元姿勢ベクトルである。また、胴体12の傾き角度である胴体12と水平面とのなす角度θbodyは、姿勢センサ18によって検出される姿勢ベクトルであって、x軸回りとなるロール方向の成分であるθrと、y軸回りとなるピッチ方向の成分であるθpと、z軸回りとなるヨー方向の成分であるθyとからなる。更に、P(θp)は、検出値θpが用いられるピッチ方向の回転行列であり、R(θr)は、検出値θrが用いられるロール方向の回転行列であり、これら回転行列P(θp)、R(θr)は、予め記憶されている。
以上の先端軌道修正制御では、検出された胴体12の傾き角度に応じて、各中間点A〜Dに回転行列をかけて基本動作軌道が変更される。また、エンドエフェクタ11Aの姿勢に関しては、その関節部分の当初の角度に胴体12の傾き角度を加えることで、路面Rへの着地動作等に支障が無いように、胴体12の傾きに関わらずエンドエフェクタ11Aの姿勢が一定に保持される。
以上の構成の制御装置13では、基準歩容制御手段21での肢体11の動作制御により、基本歩容パターンで移動ロボットを目標位置に向かって移動させるが、その際に、路面の崩壊、或いは、意図しない凹凸の路面や物体が移動ロボットの前方に存在する等の進行障害が発生したような場合には、方向転換制御手段22、接触回避制御手段23及び先端軌道修正制御手段24によるフィードバック制御が行われる。
なお、前記基準歩容パターンとしては、前述した各種態様に限定されず、胴体12が路面Rに接地する各フェーズで、胴体12が面接地するように、若しくは、胴体12の外周部分における接地位置を変えながら線接地若しくは点接地することができる限りにおいて、他のパターンを採用することもできる。
また、前記胴体12としては、前述した作用を奏する限りにおいて、種々の形状にすることができる。例えば、図10に示されるように、底部の中央を凹ませてそのコーナ部分のみをそれぞれ路面Rに点接地可能な形状のものを採用することができる。
更に、前記実施形態では、前後左右4つの肢体11からなる4肢の移動ロボット10の場合を図示説明したが、本発明はこれに限らず、前述した作用を奏する限りにおいて、肢体11の数を更に増やした移動ロボット10への適用も可能である。
その他、本発明における装置各部の構成は図示構成例に限定されるものではなく、実質的に同様の作用を奏する限りにおいて、種々の変更が可能である。
10 移動ロボット
11 肢体
12 胴体
13 制御装置
17 力覚センサ(接触状態検知センサ)
18 姿勢センサ
19 環境認識センサ
21 基準歩容制御手段
22 方向転換制御手段
23 接触回避制御手段
24 先端軌道修正制御手段
R 路面
11 肢体
12 胴体
13 制御装置
17 力覚センサ(接触状態検知センサ)
18 姿勢センサ
19 環境認識センサ
21 基準歩容制御手段
22 方向転換制御手段
23 接触回避制御手段
24 先端軌道修正制御手段
R 路面
Claims (9)
- 所定の範囲内で動作可能な複数の肢体と、当該各肢体を支持するとともに、前記各肢体の動作に伴って移動可能な胴体と、前記各肢体の動作制御を行う制御装置とを備え、路面に対して前記各肢体の接地と前記胴体の接地とを繰り返し行いながら前進するほふく移動を行う移動ロボットにおいて、
前記制御装置は、前記各肢体及び前記胴体の動作状態が異なる複数のフェーズを所定順に行う基準歩容パターンが記憶され、当該基準歩容パターンに従って前記各肢体の動作制御を行う基準歩容制御手段を備え、
前記基準歩容パターンは、前記胴体が前記路面に接地する各フェーズで、前記胴体が面接地するように、若しくは、前記胴体の外周部分における接地位置を変えながら線接地若しくは点接地するように設定されることを特徴とする移動ロボット。 - 所定の範囲内で動作可能な複数の肢体と、当該各肢体を支持するとともに、前記各肢体の動作に伴って移動可能な胴体と、前記各肢体の動作制御を行う制御装置とを備え、路面に対して前記各肢体の接地と前記胴体の接地とを繰り返し行いながら前進するほふく移動を行う移動ロボットにおいて、
前記制御装置は、前記各肢体及び前記胴体の動作状態が異なる複数のフェーズを所定順に行う基準歩容パターンが記憶され、当該基準歩容パターンに従って前記各肢体の動作制御を行う基準歩容制御手段を備え、
前記基準歩容パターンは、前記胴体が接地しているタイミングで全ての前記肢体を同時に動かし、全ての前記肢体が接地しているタイミングで、前記各肢体の動作により前記胴体を前記路面から持ち上げて進行方向に移動させる全肢同時移動パターンであることを特徴とする移動ロボット。 - 前記基準歩容パターンは、同じタイミングで全ての前記肢体を動かす全肢同時移動パターンと、前後両側にそれぞれ複数配置された前記肢体を前後それぞれセットにして、当該肢体を前後異なるタイミングで動かす前後同時移動パターン、左右両側にそれぞれ複数配置された前記肢体を左右それぞれセットにして、当該肢体を左右異なるタイミングで動かす左右同時移動パターン、若しくは、前記各肢体を1肢ずつ異なるタイミングで動かす1肢移動パターンであることを特徴とする請求項1記載の移動ロボット。
- 前記制御装置は、前記各パターンの何れかの前記基準歩容パターンを選択可能に設けられ、当該選択された前記基準歩容パターンに従って前記各肢体の動作制御を行うことを特徴とする請求項3記載の移動ロボット。
- 移動ロボットの現在の位置情報を取得する環境認識センサを更に備え、
前記制御装置は、前記基準歩容パターンでの進行方向が予め入力された目標位置への方向からずれた場合に、当該目標位置の方向に前記進行方向を変えるように、前記肢体の動作を制御する方向転換制御手段を更に備え、
前記方向転換制御手段では、前記環境認識センサの検出結果により、現在の移動ロボットの前記目標位置に対するずれ角度を算出し、当該ずれ角度に基づいて、左右両側に配置された前記肢体の先端部分の繰り出し量を左右間で差が生じるようにし、当該繰り出し量の左右間の差によって移動ロボットを方向転換させることを特徴とする請求項1又は2記載の移動ロボット。 - 前記肢体が何等かの物体と接触した場合に、当該接触状態を検知する接触状態検知センサを更に備え、
前記制御装置は、前方に位置する路面や物体への接触を回避するように、前記肢体の動作を制御する接触回避制御手段を更に備え、
前記接触回避制御手段では、前記接触状態検知センサにより前記接触状態が検出されると、前記肢体の先端部分を一旦後方に移動してから、当該先端部分の持ち上げ高さを上げるように上方に移動した後で、再び前方に前記先端部分を繰り出すように、前記肢体を動作させることを特徴とする請求項1又は2記載の移動ロボット。 - 前記胴体の姿勢を検出する姿勢センサを更に備え、
前記制御装置は、前記胴体の路面に対する傾きに応じ、前記基準歩容パターンでの前記肢体の先端部分の基準動作軌道を修正するように、前記肢体の動作を制御する先端軌道修正制御手段を更に備え、
前記先端軌道修正制御手段では、前記姿勢センサで検出された前記胴体の姿勢が予め記憶された数式に代入されることにより、前記基準動軌道中に複数設定された各中間点の位置が修正されるともに、当該各中間点での前記先端部分の姿勢が修正され、当該修正後の前記各中間点を順に直線移動する補正軌道に沿って前記先端部分を動作させることを特徴とする請求項1又は2記載の移動ロボット。 - 所定の範囲内で動作可能な複数の肢体と、当該各肢体を支持するとともに、前記各肢体の動作に伴って移動可能な胴体とを備えた移動ロボットに対し、前記各肢体の路面への接地と前記胴体の路面への接地とを繰り返し行いながら前進させる移動ロボットのほふく移動方法において、
前記各肢体及び前記胴体の動作状態が異なる複数のフェーズを所定順に行う基準歩容パターンに従って前記各肢体を動作させ、
前記基準歩容パターンでは、前記胴体が前記路面に接地する各フェーズで、前記胴体を面接地させ、若しくは、前記胴体の外周部分における接地位置を変えながら、線接地若しくは点接地させることを特徴とする移動ロボットのほふく移動方法。 - 所定の範囲内で動作可能な複数の肢体と、当該各肢体を支持するとともに、前記各肢体の動作に伴って移動可能な胴体とを備えた移動ロボットに対し、前記各肢体の路面への接地と前記胴体の路面への接地とを繰り返し行いながら前進させる移動ロボットのほふく移動方法において、
前記各肢体及び前記胴体の動作状態が異なる複数のフェーズを所定順に行う基準歩容パターンに従って前記各肢体を動作させ、
前記基準歩容パターンでは、前記胴体が接地しているタイミングで全ての前記肢体を同時に動かし、全ての前記肢体が接地しているタイミングで、前記各肢体の動作により前記胴体を前記路面から持ち上げて進行方向に移動させることを特徴とする移動ロボットのほふく移動方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016168790A JP2018034239A (ja) | 2016-08-31 | 2016-08-31 | 移動ロボット及びそのほふく移動方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016168790A JP2018034239A (ja) | 2016-08-31 | 2016-08-31 | 移動ロボット及びそのほふく移動方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2018034239A true JP2018034239A (ja) | 2018-03-08 |
Family
ID=61565152
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016168790A Pending JP2018034239A (ja) | 2016-08-31 | 2016-08-31 | 移動ロボット及びそのほふく移動方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2018034239A (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018144149A (ja) * | 2017-03-03 | 2018-09-20 | 本田技研工業株式会社 | 移動ロボットの異常接触検知方法及び接触部位特定方法 |
CN111150873A (zh) * | 2020-02-19 | 2020-05-15 | 郑州团噢智能科技有限公司 | 一种隧道内防止气溶胶方式传播病菌的消毒装置 |
JP2020163551A (ja) * | 2019-03-29 | 2020-10-08 | セイコーエプソン株式会社 | 制御方法およびロボットシステム |
-
2016
- 2016-08-31 JP JP2016168790A patent/JP2018034239A/ja active Pending
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018144149A (ja) * | 2017-03-03 | 2018-09-20 | 本田技研工業株式会社 | 移動ロボットの異常接触検知方法及び接触部位特定方法 |
JP2020163551A (ja) * | 2019-03-29 | 2020-10-08 | セイコーエプソン株式会社 | 制御方法およびロボットシステム |
JP7259487B2 (ja) | 2019-03-29 | 2023-04-18 | セイコーエプソン株式会社 | 制御方法およびロボットシステム |
CN111150873A (zh) * | 2020-02-19 | 2020-05-15 | 郑州团噢智能科技有限公司 | 一种隧道内防止气溶胶方式传播病菌的消毒装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11548151B2 (en) | Robotically negotiating stairs | |
JP6071815B2 (ja) | 脚式移動ロボットの制御装置 | |
JP4466715B2 (ja) | 脚式ロボット、及びその制御方法 | |
JP5053644B2 (ja) | 脚式移動ロボットおよびその制御プログラム | |
JP5282852B2 (ja) | 二足歩行ロボット及び二足歩行ロボットの着地タイミング決定方法 | |
KR101985790B1 (ko) | 보행 로봇 및 그 제어 방법 | |
JP4912891B2 (ja) | 脚式移動ロボットおよびその制御プログラム | |
CN109642409B (zh) | 工程机械 | |
JP2014161991A (ja) | ロボットの移動機構及びそれを備えるロボット | |
JP2008126349A (ja) | 移動ロボット | |
JP6228097B2 (ja) | 移動ロボット | |
US11485029B2 (en) | Working robot | |
JP2018034239A (ja) | 移動ロボット及びそのほふく移動方法 | |
JP6068302B2 (ja) | 脚式移動ロボットの制御装置 | |
US9964956B2 (en) | Operating environment information generating device for mobile robot | |
JP2009184022A (ja) | ロボット制御装置、ロボット制御方法およびロボット制御プログラム | |
CN111576511B (zh) | 步行式挖掘机自行上下运输车控制方法 | |
JP4905041B2 (ja) | ロボット制御装置 | |
JP4985776B2 (ja) | ロボット制御装置、ロボット制御方法およびロボット制御プログラム | |
JP4840649B2 (ja) | 脚式ロボットの歩行制御方法 | |
JP4706357B2 (ja) | 歩行型ロボット及びその絶対方位推定方法 | |
JP2017030093A (ja) | 複数ロボットの協調移動システム及び方法 | |
JP4696728B2 (ja) | 脚式ロボットとその制御方法 | |
JP4311159B2 (ja) | ロボットの歩容データ作成装置及びシステム | |
JP4237130B2 (ja) | 脚式移動ロボットの制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A80 | Written request to apply exceptions to lack of novelty of invention |
Free format text: JAPANESE INTERMEDIATE CODE: A80 Effective date: 20160908 |