JP4291602B2 - Robot walking using passive change of joint angle and its control method - Google Patents
Robot walking using passive change of joint angle and its control method Download PDFInfo
- Publication number
- JP4291602B2 JP4291602B2 JP2003070758A JP2003070758A JP4291602B2 JP 4291602 B2 JP4291602 B2 JP 4291602B2 JP 2003070758 A JP2003070758 A JP 2003070758A JP 2003070758 A JP2003070758 A JP 2003070758A JP 4291602 B2 JP4291602 B2 JP 4291602B2
- Authority
- JP
- Japan
- Prior art keywords
- joint
- leg link
- joint angle
- free
- robot
- 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.)
- Expired - Fee Related
Links
Images
Description
【０００１】
【発明の属する技術分野】
本発明は、２以上の脚リンクが股関節によって胴部に揺動可能に連結されており、その脚リンクを揺動させることによって歩行するロボットに関する。
【０００２】
【従来の技術】
左脚リンクと腰と右脚リンクの相対的姿勢を変化させることによって歩行するロボットが開発されている。左脚リンクと腰と右脚リンクの相対的姿勢を変化させる場合、結果として歩行した結果が得られるように、左脚リンクと腰と右脚リンクの相対的姿勢を変化させなければならない。このために、左足先と腰と右足先の位置と姿勢を指示する歩容データが利用される。
図１１に示すように、歩容データは、ロボットが活動する空間の座標を定めるグローバル座標系において、左足先と腰と右足先の位置と姿勢を指示する。左足先と腰と右足先の位置を指示するために、左足先には基準点Ｌ０が定められており、右足先には基準点Ｒ０が定められており、腰には基準点Ｗ０が定められている。左足先と腰と右足先の姿勢を指示するために、左足先に垂直なベクトルＬが想定されており、右足先に垂直なベクトルＲが想定されており、腰柱に沿って伸びるベクトルＷが想定されている。歩容データは、グローバル座標系において、左足先の基準点Ｌ０のｘ、ｙ、ｚ座標、右足先の基準点Ｒ０のｘ、ｙ、ｚ座標、腰の基準点Ｗ０のｘ、ｙ、ｚ座標を指示する。また、左足先に垂直なベクトルＬのピッチ角Ｌαと、ロール角Ｌβと、ヨー角Ｌγを指示し、右足先に垂直なベクトルＲのピッチ角Ｒαと、ロール角Ｒβと、ヨー角Ｒγを指示し、腰柱に沿って伸びるベクトルＷのピッチ角Ｗαと、ロール角Ｗβと、ヨー角Ｗγを指示する。歩容データは、左足先と腰と右足先の位置と姿勢を指示するデータを経時的に記憶している。
【０００３】
左足先と腰と右足先の位置と姿勢を指示する歩容データが与えられると、ロボットは、与えられた位置と姿勢をとるために必要な関節の関節角を計算し、計算された関節角に調整する。歩容データが経時的に変化することから、関節角も経時的に変えられる。歩容データに従って、左脚リンクと腰と右脚リンクの相対的姿勢を経時的に変化させることによってロボットは歩行する。
腰の位置（Ｗｘ、Ｗｙ，Ｗｚ）と姿勢（Ｗα、Ｗβ、Ｗγ）は、ロボットのＺＭＰ（zero moment point）を接地脚の足平内に維持する関係に設定されているために、ロボットは転倒しないで歩行を続ける。
上記の方式は、ロボットの全ての関節を能動的に動かして歩行する方式であるということができ、特許文献１等に記載されている。
【０００４】
【特許文献１】
特開平０５−２５３８６７号公報
【０００５】
【発明が解決しようとする課題】
歩行に関与する全ての関節を能動的に動かして歩行するロボットの歩容動作には不自然さが感じられる。また歩行するロボットを静止させるには、プラグラムによって静止させる必要があり、人がロボットに手を差し伸べて停止させることが難しい。
【０００６】
【課題を解決するための手段と作用】
本発明者らは、足首の関節を自由にすることによって、受動的に揺動する現象を活用することを想到した。能動的に揺動させるのではなく、力を抜いたために自然に揺動する現象を利用するのである。意図的に能動的に揺動させる現象に比して、自然に受動的に揺動する現象には不自然さがなく、ロボットのダイナミクスに適応した自然な歩容動作が得られる。また自然に受動的に揺動する現象であるがゆえに、人がロボットに手を差し伸べることによって揺動することを止めることができ、ロボットの歩行を停止させることができる。さらには、自然に受動的に揺動する現象を利用して歩行すると、歩行に要するエネルギも節約できることが判明した。
【０００７】
本発明のロボットは、足首関節を持つ脚リンクが股関節によって胴部に揺動可能に連結されており、その脚リンクが２以上存在する。機械構成自体は既知であるが、そのコントローラが新規で斬新である。本発明のコントローラは、
(1) 接地脚リンクの足首関節を揺動自由とし、
(2) 揺動自由とした関節の関節角を計測し、
(3) 計測された関節角に基づいて残余の関節角を計算し、
(4) 残余の関節角を調整するアクチュエータを制御して、残余の関節角を計算された関節角に調整し、
(5) 脚リンクの先端が接地して浮遊して再度接地する繰返し現象の進行に合わせて揺動自由とする足首関節を切替えることによって、揺動自由とする足首関節を接地脚リンクの側に維持することを特徴とする。
【０００８】
このロボットは、接地脚リンクの足首関節を揺動自由とするために、接地脚リンク自体は自然に受動的に倒れようとする。このときに他の関節角を能動的に調整し、ロボットが転倒する以前に他方の脚リンクが接地して転倒を防止するように制御する。接地脚が入れ代わるために、ロボットは歩を進める。これを繰り返すことによって、ロボットは接地脚を入れ代えながら歩行を続ける。
自然界で受動的に生じる動きを利用して歩行することから自然な歩行動作が得られる。ロボットのダイナミクスに適応した動作を利用して歩行することから、歩行に要するエネルギも節約できる。人がロボットに手を差し伸べて受動的な動きを停止させるとロボットは停止する。人とロボットの共存にも有利であり、高い安全性を確保することができる。
【０００９】
左脚リンクと右脚リンクが股関節によって胴部に揺動可能に連結されているロボットの場合、コントローラが、前記(3)の処理で残余の関節角を計算する際に、下記の関係を利用して計算することが好ましい。即ち、計算された関節角に残余の関節角を調整したときのロボットの重心位置が、
(6) 右脚リンクが遊脚リンクになっている間は、左右の脚リンクの体側方向での接地位置の間において右脚リンクの接地位置に向けて移動し、
(7) 左脚リンクが遊脚リンクになっている間は、左右の脚リンクの体側方向での接地位置の間において左脚リンクの接地位置に向けて移動する関係を満たす関節角を計算する。
【００１０】
この場合、左脚リンクが接地して右脚リンクが遊脚リンクになっている間は、ロボットの重心位置が右脚リンクの接地位置に向けて移動するように残余の関節角が調整されることから、接地脚が受動的に揺動する動きと、遊脚を接地方向に能動的に揺動する動きが複合し、ロボットは自然な感じで歩行する。同様に、右脚リンクが接地して左脚リンクが遊脚リンクになっている間は、ロボットの重心位置が左脚リンクの接地位置に向けて移動するように残余の関節角が調整されることから、接地脚が受動的に揺動する動きと、遊脚を接地方向に能動的に揺動する動きが複合して得られる。
【００１１】
コントローラが、
(8) 接地脚リンクの接地位置よりも股関節が進行方向に前方に位置するように接地脚リンクの足首関節と股関節の進行方向の関節角を調整し、
(9) 股関節よりも遊脚リンクの先端が進行方向に前方に位置するように遊脚リンクの足首関節と股関節の進行方向の関節角を調整するようにすると、
ロボットは左右方向に交互に揺動しながら、接地脚に対して胴を前方に送り、胴に対して遊脚を前方に送る。これによって、ロボットは前方に歩行する。
【００１２】
本発明は、ロボットの新規で斬新な制御方法を創作した。この方法は、
(1) 接地脚リンクの足首関節を揺動自由とする工程と、
(2) 揺動自由とした関節の関節角を計測する工程と、
(3) 計測された関節角に基づいて残余の関節角を計算する工程と、
(4) 残余の関節角を計算された関節角に調整する工程と、
(5) 脚リンクの先端が接地して浮遊して再度接地する繰返し現象の進行に合わせて揺動自由とする足首関節を切替えることによって、揺動自由とする足首関節を接地脚リンクの側に維持する工程とを有する。
【００１３】
この制御方法によると、接地脚リンクが受動的に倒れる動きを利用してロボットが歩行するようになり、自然な歩行動作が得られ、歩行に要するエネルギも節約できる。人がロボットに手を差し伸べて受動的な動きを停止させるとロボットは停止するために、人とロボットの共存にも有利である。
【００１４】
左脚リンクと右脚リンクが股関節によって胴部に揺動可能に連結されているロボットの場合、前記(3)の処理で残余の関節角を計算する際に、下記の関係を利用して計算することが好ましい。即ち、計測された関節角に基づいて残余の関節角を計算する際に、計算された関節角に調整したときのロボットの重心位置が、(6) 右脚リンクが遊脚リンクになっている間は、左右の脚リンクの体側方向での接地位置の間において右脚リンクの接地位置に向けて移動し、
(7) 左脚リンクが遊脚リンクになっている間は、左右の脚リンクの体側方向での接地位置の間において左脚リンクの接地位置に向けて移動する関係を満たす関節角を計算する。
【００１５】
この制御方法によると、左脚リンクが接地して右脚リンクが遊脚リンクになっている間は、ロボットの重心位置が右脚リンクの接地位置に向けて移動するように残余の関節角が調整されることから、接地脚が受動的に揺動する動きと、遊脚を接地方向に能動的に揺動する動きが複合して得られる。同様に、右脚リンクが接地して左脚リンクが遊脚リンクになっている間は、ロボットの重心位置が左脚リンクの接地位置に向けて移動するように残余の関節角が調整されることから、接地脚が受動的に揺動する動きと、遊脚を接地方向に能動的に揺動する動きが複合して得られる。ロボットは自然な感じで歩行する。
【００１６】
前記(3)の処理で残余の関節角を計算する際に、下記の関係を利用して計算することが好ましい。即ち、計測された関節角に基づいて残余の関節角を計算する際に、計算された関節角に調整したときのロボットの重心位置が、
(8) 右脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において右脚リンクの接地位置に向けて移動すると同時に進行方向でも右脚リンクの接地位置に向けて移動し、
(9) 左脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において左脚リンクの接地位置に向けて移動すると同時に進行方向でも左脚リンクの接地位置に向けて移動する関係を満たす関節角を計算する。
【００１７】
この制御方法によると、体側方向においても進行方向においても、左脚リンクが接地して右脚リンクが遊脚リンクになっている間は、ロボットの重心位置が右脚リンクの接地位置に向けて移動するように残余の関節角が調整され、右脚リンクが接地して左脚リンクが遊脚リンクになっている間は、ロボットの重心位置が左脚リンクの接地位置に向けて移動するように残余の関節角が調整されることから、ロボットは左右方向に交互に揺動しながら、接地脚に対して胴を前方に送り、胴に対して遊脚を前方に送る。これによって、ロボットは前方に歩行する。歩行姿勢は自然であり、歩行に要するエネルギは小さくてすむ。また、外部から人が手を差し伸べることによってロボットを停止させることができる。
【００１８】
【実施例】
図1は、ロボット２１の機械構成のスケルトン図を示す。股関節に2軸、膝関節に1軸、足首関節に2軸、肩関節に2軸、肘関節に1軸を備えている。各関節にエンコーダ付のモータを備えており、関節角を調整でき、関節角を計測することができる。θ１〜θ１０は関節角を示す。参照番号１７，１８は力センサを示し、１９，２０はホトセンサを示す。ホトセンサ１９，２０は、足平が接地しているのか浮遊しているのかを検出する。
図２は、ロボットのコントローラ２２の構成を示し、エンコーダ１〜１０の出力と、力センサ１７，１８の出力と、ホトセンサ１９，２０の出力を入力する。コントローラ２２は、モータ１〜１０に回転角を指示する。
【００１９】
図３は、歩行するロボットを正面から見た図を示し、（１）は右足で踏ん張っている状態を示し、（ａ）は（１）の状態から左傾して左足が接地する直前の状態を示し、（２）は左足が接地した状態を示し、（３）は（２）の状態からさらに左傾して左足で踏ん張っている状態を示し、（４）は（３）の状態から右傾して右足が接地した状態を示し、（５）は（４）の状態からさらに右傾して右足で踏ん張っている状態を示している。（１）と（５）は同一状態であり、（３）の状態と左右対称であり、（２）と（４）は左右対称である。
このロボット２１は、コントローラ２２によって、図３の（１）、（２）、（３）、（４）、（１）の状態を繰り返して左右に足踏みする動作を実現する。
【００２０】
図２に示すように、コントローラ２２は相判定手段２４をもち、判定された相によって、制御内容を切替える。相は、図３に示すように、状態（１）から（２）までの右脚支持Ａ相と、状態（２）から（３）までの左脚支持Ｂ相と、状態（３）から（４）までの左脚支持Ａ相と、状態（４）から（５）までの右脚支持Ｂ相に分けられている。
【００２１】
図７は、左右に足踏みするロボット２１の、右足首の体側方向の関節の関節角θ９の時間的変化を示し、（１）の状態では−α（これがこの関節の最大関節角）であり、ｋα（ｋは１以下の定数）まで回転すると（２）の状態となって左足が接地し、（３）の状態では＋α（これがこの関節の最大関節角）であり、−ｋαまで回転すると（４）の状態となって右足が接地し、（５）の状態では−αとなって（１）の状態に戻る。
図８は、相判定手段２４による判定処理手順の一例を示し、右足首の体側方向の関節の関節角θ９によって相を判別する。ステップＳ２でθ９＝αであれば、左脚支持Ａ相であると判別する（ステップＳ４）。ステップＳ６でθ９＝−αであれば、右脚支持Ａ相であると判別する（ステップＳ８）。θ９が増大中で−α以上でｋα未満であれば、右脚支持Ａ相であると判別する（ステップＳ１４）。θ９が増大中でｋα以上であれば、左脚支持Ｂ相であると判別する（ステップＳ１６）。θ９が減少中でα以下で−ｋαよりも大きければ、左脚支持Ａ相であると判別する（ステップＳ２０）。θ９が減少中で−ｋα以下であれば、右脚支持Ｂ相であると判別する（ステップＳ２２）。
この相判定処理手順は一例に過ぎず、他に様々な手順が可能である。力センサ１７，１８やホトセンサ１９，２０の情報を活用して判定することもできる。
【００２２】
図２に示すコントローラ２２は、相判定手段２４の判定結果によって制御内容を切替える。
図２の（１）は、右脚支持状態での制御内容を示す。右脚支持状態では、次にように制御する。
(1) 接地脚の足首の体側方向の関節（この場合θ９）のモータを回転自由とし、勝手に回転するのに任せる。関節θ９を受動関節（フリー関節）とし、受動的に回転するのに任せる。ただし、−αがこの関節の最大関節角であり、それ以上には回転しない。
(2) 受動的に回転する関節角θ９を計測する。
(3) 計測された関節角θ９によって、接地脚の股関節の体側方向の関節の関節角（この場合θ７）を計算する。この計算内容については後記する。
(4) 遊脚の股関節の体側方向の関節の関節角（この場合θ２）を−θ７に等しくする。この結果、接地脚リンクと遊脚リンクが平行に維持される。
(5) 遊脚の足首関節の体側方向の関節の関節角（この場合θ４）をθ９に等しくする。この結果、接地脚の足平と遊脚の足平が平行に維持される。
(6) 膝関節（θ3とθ８）については、膝をまっすぐに伸びした角度（ここではそれをゼロとする）に維持する。
(7) 計測された関節角θ９によって、接地脚の足首関節の進行方向の関節の関節角（この場合θ１０）を計算する。この計算内容については後記する。これによって、接地脚の接地位置に対して股関節の位置が進行方向前方に送られる。
(8) 接地脚の股関節の進行方向の関節の関節角（この場合θ６）を−θ１０に等しくする。胴部が倒れることが防止される。
(9) 遊脚の股関節の進行方向の関節の関節角（この場合θ１）をθ１０に等しくする。これによって、遊脚が進行方向前方に踏み出される。
(10) 遊脚の足首関節の進行方向の関節の関節角（この場合θ５）を−θ１０に等しくする。これによって、遊脚の足平と接地脚の足平が平行に維持される。
【００２３】
図２の（２）は、左脚支持状態での制御内容を示す。左脚支持状態では、次にように制御する。
(1) 接地脚の足首の体側方向の関節（この場合θ４）のモータを回転自由とし、勝手に回転するのに任せる。関節θ４を受動関節（フリー関節）とし、受動的に回転するのに任せる。ただし、αがこの関節の最大関節角であり、それ以上には回転しない。
(2) 受動的に回転する関節角θ４を計測する。
(3) 計測された関節角θ４によって、接地脚の股関節の体側方向の関節の関節角（この場合θ２）を計算する。この計算内容については後記する。
(4) 遊脚の股関節の体側方向の関節の関節角（この場合θ７）を−θ２に等しくする。この結果、接地脚リンクと遊脚リンクが平行に維持される。
(5) 遊脚の足首関節の体側方向の関節の関節角（この場合θ９）をθ４に等しくする。この結果、接地脚の足平と遊脚の足平が平行に維持される。
(6) 膝関節（θ3とθ８）については、膝をまっすぐに伸びした角度（ここではそれをゼロとする）に維持する。
(7) 計測された関節角θ４によって、接地脚の足首関節の進行方向の関節の関節角（この場合θ５）を計算する。この計算内容については後記する。これによって、接地脚の接地位置に対して股関節の位置が進行方向前方に送られる。
(8) 接地脚の股関節の進行方向の関節の関節角（この場合θ１）を−θ５に等しくする。胴部が倒れることが防止される。
(9) 遊脚の股関節の進行方向の関節の関節角（この場合θ６）をθ５に等しくする。これによって、遊脚が進行方向前方に踏み出される。
(10) 遊脚の足首関節の進行方向の関節の関節角（この場合θ１０）を−θ５に等しくする。これによって、遊脚の足平と接地脚の足平が平行に維持される。
図２に示すように、ロボットコントローラ２２は、相判定手段２４を備え、判定された相によって、モータ４とモータ９のいずれか一方をフリーとし（２６）、フリ−とした関節の回転角（θ４またはθ９）を計測し（２８）、計測された関節角によってその他のモータの関節角を計算し（３０）、その他のモータの関節角を計算された角に調整する（３４）。その他のモータの関節角を計算するときに、次に説明する重心推移モデル３２を利用する。
【００２４】
図４に示すように、状態（１）で右足が踏ん張ってθ９＝−αに維持されている場合、ロボットの重心位置はＷ１の位置にある。ここでは、重心位置Ｗが左右の股関節の中央にあるとしているが、胴部にあってもかまわない。状態（１）から左傾して左足が接地したときのθ９がｋαであれば、θ９＝ｋαのときのロボットの重心位置はＷ２の位置にある。
状態（１）以降、即ち、右脚支持Ａ相では、フリーにする関節角θ９に応じて重心位置が変化し、θ９＝−αでは重心位置がＷ１にあり、ロボットが左傾するにつれて重心位置がＷ１からＷ２に向けて移動し、θ９＝ｋαのときの重心位置がＷ２にあるようにすれば、状態（１）から状態２に変化する。
ロボットのラテラル面の重心位置は、θ２、θ４、θ７、θ９で決定される。右脚支持状態では、θ９がフリーであり（計測はできるがアクティブに制御することはしない）、θ４はθ９に等しく、θ２は−θ７に等しくされ、θ７がθ９によって計算される。θ９からθ7を計算するにあたって、計算されたθ7を利用してロボットの姿勢を調節したときのロボットの重心位置が、θ９＝−αのときの重心位置がＷ１にあり、ロボットが左傾するにつれて重心位置がＷ１からＷ２に向けて移動し、θ９＝ｋαのときの重心位置がＷ２にあるようにすれば、ロボットは、状態（１）から状態（２）に変化する。
θ９＝−αのときの重心位置Ｗ１は、右脚の接地位置よりも左方向にあり、それ以上には右傾することがない。ロボットは右側に転倒することがない。重心位置Ｗ１は、右脚の接地位置よりも左方向にあり、関節θ９を自由にすれば左傾する。
【００２５】
図5の（Ａ）式は、θ９からθ7を計算する式を示し、その式を利用してθ7を計算し、計算された関節角θ７に調整すると、ロボットの重心位置は、θ９＝−αのときにＷ１にあり、ロボットが左傾するにつれてＷ１からＷ２に向けて移動し、θ９＝ｋαのときにＷ２に移動する関係が得られる。
【００２６】
図4には、状態（２）から状態（３）における重心位置の推移も示しており、左足が踏ん張ってθ４＝αに維持されているときの重心位置がＷ３で示されている。θ４の変化に追従してθ２、θ７、θ９を制御することによって状態（３）では重心位置がＷ３に来るようにすれば、ロボットは状態（２）から状態（３）に変化する。
左脚支持Ｂ層では、θ４からθ２を計算し、θ７＝−θ２、θ９＝θ４に制御するところ、ロボットの重心位置が、θ４＝−ｋαのときにＷ２にあり、ロボットが左傾するにつれてＷ２からＷ３に向けて移動し、θ４＝αのときにＷ３に移動する関係が得られれば、ロボットは状態（２）から状態（３）に変化する。この場合も、図5の（Ａ）式と類似する式によって、θ４からθ２を計算することができる。
θ４＝αのときの重心位置Ｗ３は、左脚の接地位置よりも右方向にあり、それ以上には左傾することがない。ロボットは左側に転倒することがない。重心位置Ｗ３は、左脚の接地位置よりも右方向にあり、関節θ４を自由にすれば右傾する。
【００２７】
図4には、状態（３）から状態（４）における重心位置の推移も示しており、ロボットが右傾してθ４が−ｋαで右足が接地したときの重心位置がＷ４の位置にあれば、ロボットは状態（３）から状態（４）に変化する。
同様に、状態（４）から状態（１）における重心位置の推移も示しており、ロボットがさらに右傾してθ９が−αで踏ん張っているときの重心位置がＷ１の位置にあれば、ロボットは状態（４）から状態（１）に変化する。
【００２８】
重心位置は、Ｗ１からＷ３の間にあるが、それは、左右の脚リンクの体側方向での接地位置の間Ｌにおいて存在している。左脚リンクが遊脚リンクになっている間の重心位置は、左脚リンクの接地位置に向けて移動し、右脚リンクが遊脚リンクになっている間の重心位置は右脚リンクの接地位置に向けて移動する。
状態（１）から（２）の右脚支持Ａ相では、重心位置が下降するために現象が自然に進行する。状態（２）から（３）の左脚支持Ｂ相では、重心位置が上昇するが、ロボットは状態（１）から（２）で左傾運動をしており、その慣性が存在することから重心位置が上昇する現象が自然に進行する。同様に、状態（３）から（４）の左脚支持Ａ相では、重心位置が下がるために現象が自然に進行する。状態（４）から（１）の右脚支持Ｂ相では、重心位置が上がるが、ロボットは状態（３）から（４）で右傾運動をしており、その慣性が存在することから重心位置が上がる現象が自然に進行する。
【００２９】
状態（１）から（４）の繰返し運動は、三角柱が反発係数１の床の上で振り子運動を繰り返すのに似ており、小さなエネルギで運動を持続することができる。揺動ないし回転自在とした関節の摩擦がなければ、状態（１）から（４）の繰返し運動が減衰することなく繰り返される。実際には、摩擦が存在する。回転自在とした関節のモータに、摩擦を相殺するだけのトルクを与えることによって、摩擦が存在しない状態を作り出すことができる。本発明で関節をフリーにするというのは、モータに電流を加えないで受動回転を許容するようにすることのみならず、摩擦を相殺するだけのトルクを与えることによって実質的には摩擦が存在しない状態とすることの両者を言う。
【００３０】
状態（１）から（４）の繰返し運動は、左右の脚の足踏み運動を実現する。この左右の脚の足踏み運動に同期して足を踏み出す動作を加えると、ロボットは進行する。このとき、左右の傾動を利用することから遊脚の膝を曲げないでも遊脚は空中を移動する。
図５のＢ式は、右脚接地中における接地脚の足首の進行方向の関節の関節角（この場合θ１０）を示す。この場合、接地脚の股関節の進行方向の関節の関節角θ６を−θ１０とし、遊脚の股関節の進行方向の関節の関節角θ１をθ１０とし、遊脚の足首の進行方向の関節の関節角θ５を−θ１０とすれば、θ１０によって接地脚の接地位置よりも股関節が進行方向前方に位置し、θ６によって胴の傾きが禁止され、θ１によって股関節よりも前方向に遊脚リンクが踏み出され、θ5によって接地脚の足平と遊脚の足平が平行に維持される。図６の下段がそれを示し、ロボットは左右の脚を交互に踏み出して歩行する。左右の足踏み運動と前方への踏み出し運動が複合され、ロボットは自然な感じで歩行する。
【００３１】
以上では、接地脚の足首の体側方向の関節角θ４またはθ９をフリーにし、その変化に追従して残余の関節の関節角を制御する。これによって左右の足踏み運動と前方への踏み出し運動が複合した動作を得ている。
これに代えて、接地脚の足首の進行方向の関節角θ５またはθ１０をフリーにし、その変化に追従して残余の関節の関節角を制御することもできる。このようにしても左右の足踏み運動と前方への踏み出し運動が複合した動作を得ることができる。この場合、進行方向については、ロボットの重心が前方にシフトするように、フリーにした関節角θ５またはθ１０に基づいて残余の関節角をアクティブに制御する。また、体側方向については、右脚接地中はロボットの重心が左方にシフトし、左脚接地中はロボットの重心が右方にシフトするように、フリーにした関節角θ５またはθ１０に基づいて残余の関節角をアクティブに制御する。接地脚の足首の体側方向の関節角と進行方向の関節角の両者をフリーにしてもよい。接地脚の交替に同期して、関節角θ４とθ５とフリーにする状態と、θ９とθ１０をフリーにする状態を切替える。この場合には、右脚支持相では、θ９とθ１０をフリーにする（ただしθ９の絶対値をαで規制し、θ１０の絶対値をβで規制する）。体側方向の残余の関節θ７、θ２、θ４については、計測された関節角θ９に基づいてアクティブに制御し、進行方向の残余の関節θ６、θ１、θ５については、計測された関節角θ１０に基づいてアクティブに制御する。左脚支持相では、θ４とθ５をフリーにする（ただしθ４の絶対値をαで規制し、θ５の絶対値をβで規制する）。体側方向の残余の関節θ２、θ７、θ９については、計測された関節角θ４に基づいてアクティブに制御し、進行方向の残余の関節θ１、θ６、θ１０については、計測された関節角θ５に基づいてアクティブに制御する。いずれの場合にも、θ９＝θ４、θ７＝−θ２、θ６＝−θ１、θ１０＝−θ５の関係を維持するようにアクティブに制御する。進行方向については、ロボットの重心が前方にシフトするように、フリーにした関節角θ５またはθ１０に基づいて残余の関節角をアクティブに制御する。また、体側方向については、右脚接地中はロボットの重心が左方にシフトし、左脚接地中はロボットの重心が右方にシフトするように、フリーにした関節角θ４またはθ９に基づいて残余の関節角をアクティブに制御する。計測された関節角に基づいて残余の関節角を計算する際に、計算された関節角に調整したときのロボットの重心位置が、右脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において右脚リンクの接地位置に向けて移動すると同時に進行方向でも右脚リンクの接地位置に向けて移動し、左脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において左脚リンクの接地位置に向けて移動すると同時に進行方向でも左脚リンクの接地位置に向けて移動する関係を満たす関節角を計算することによって、ロボットは歩行を続けることが確認されている。
【００３２】
重心の変化軌跡は様々に設定することが可能であり、図９に示すように、滑らかなカーブ状の軌跡を採用するともできる。接地時の傾斜角、即ち、上記した定数ｋの大小は、実験によってチューニングするべきであり、図１０の（１）の重心軌跡に示すように小さく設定することが好ましいロボットも存在すれば、（２）のように大きく設定することが好ましいロボットも存在する。
【００３３】
以上、本発明の具体例を詳細に説明したが、これらは例示であり、特許請求の範囲を限定するものではない。また、本発明はいくつかの目的を解決するものであり、全部の目的を同時に解決するときに限って有意義なものではなく、一または二の目的を解決するだけで十分に有意義なものである。
【００３４】
【発明の効果】
本発明のロボット制御技術によると、受動的で自然に変化する事象を利用して歩行することができる。これは人間の歩行パターンによく一致しており、自然な歩容動作が得られる。またロボットのダイナミクスに無理なく適応しており、小さな消費エネルギで歩行することを可能とする。さらに受動的で自然に変化する現象を利用して歩行することから、人間がその変化を止めてやるとロボットは歩行動作を停止する。人が手を差し伸べることでロボットが停止するために、人とロボットが共存しやすく、高い安全性を確保することができる。
【図面の簡単な説明】
【図１】 ロボットの機械構成を示すスケルトン図。
【図２】 ロボットのコントローラの構成を示す図。
【図３】 ロボットの左右の足踏み運動と、相と、制御内容を対照して示す。
【図４】 重心位置の移動軌跡を示す。
【図５】 重心位置の移動軌跡を実現する関節角の計算方法を示す。
【図６】 ロボットの左右の足踏み運動と、踏み出し運動を対照して示す。
【図７】 関節角θ９の時間的変化を示す。
【図８】 相判別処理手順の一例を示す。
【図９】 重心移動軌跡の別例を示す。
【図１０】 重心移動軌跡の他の別例を示す。
【図１１】 従来のロボットの教示技術を示す。
【符号の説明】
θ１：左股関節の進行方向の関節
θ２：左股関節の体側方向の関節
θ３：膝関節
θ４：左足首の体側方向の関節
θ５：左足首の進行方向の関節
θ６：右股関節の進行方向の関節
θ７：右股関節の体側方向の関節
θ８：膝関節
θ９：右足首の体側方向の関節
θ１０：右足首の進行方向の関節[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a robot in which two or more leg links are connected to a trunk by a hip joint so as to be swingable, and the robot walks by swinging the leg links.
[0002]
[Prior art]
Robots that walk by changing the relative postures of the left leg link, the waist, and the right leg link have been developed. When the relative postures of the left leg link, the waist, and the right leg link are changed, the relative postures of the left leg link, the waist, and the right leg link must be changed so that a result of walking is obtained as a result. For this purpose, gait data that indicates the positions and postures of the left toe, waist, and right toe is used.
As shown in FIG. 11, the gait data indicates the positions and postures of the left foot, waist and right foot in a global coordinate system that defines the coordinates of the space in which the robot is active. In order to indicate the positions of the left toe, waist and right toe, a reference point L0 is defined for the left foot, a reference point R0 is defined for the right foot, and a reference point W0 is defined for the waist. ing. In order to indicate the posture of the left toe, waist and right foot, a vector L perpendicular to the left foot is assumed, a vector R perpendicular to the right foot is assumed, and a vector W extending along the waist pillar is Assumed. Gait data is the x, y, z coordinates of the reference point L0 of the left foot tip, the x, y, z coordinates of the reference point R0 of the right foot tip, and the x, y, z coordinates of the waist reference point W0 in the global coordinate system. Instruct. Also, the pitch angle Lα, roll angle Lβ, and yaw angle Lγ of the vector L perpendicular to the left foot tip are designated, and the pitch angle Rα, roll angle Rβ, and yaw angle Rγ of the vector R perpendicular to the right foot tip are designated. Then, the pitch angle Wα, roll angle Wβ, and yaw angle Wγ of the vector W extending along the waist column are indicated. The gait data stores data indicating the position and posture of the left foottip, waist, and right foottip over time.
[0003]
Given gait data that indicates the position and posture of the left toe, waist, and right foot, the robot calculates the joint angles required to take the given position and posture, and the calculated joint angles Adjust to. Since the gait data changes over time, the joint angle can also change over time. The robot walks by changing the relative postures of the left leg link, the waist and the right leg link over time according to the gait data.
Since the waist position (Wx, Wy, Wz) and posture (Wα, Wβ, Wγ) are set to maintain the ZMP (zero moment point) of the robot within the foot of the grounded leg, the robot falls Do not continue walking.
The above system can be said to be a system in which all joints of the robot are actively moved to walk, and is described in
[0004]
[Patent Document 1]
Japanese Patent Laid-Open No. 05-253867
[0005]
[Problems to be solved by the invention]
Unnaturalness is felt in the gait motion of a robot that walks by actively moving all the joints involved in walking. In order to stop a walking robot, it is necessary to stop it by a program, and it is difficult for a person to reach out and stop the robot.
[0006]
[Means and Actions for Solving the Problems]
The present inventors have conceived of utilizing the phenomenon of passive rocking by making the ankle joint free. Instead of actively swinging, the phenomenon of swinging naturally due to the removal of force is used. Compared to the intentionally actively swinging phenomenon, the naturally passively swinging phenomenon has no unnaturalness, and a natural gait motion adapted to the dynamics of the robot can be obtained. In addition, since it is a phenomenon that naturally swings passively, it can stop swinging when a person reaches out to the robot, and the robot can stop walking. Furthermore, it has been found that the energy required for walking can be saved by walking using the phenomenon of naturally passively swinging.
[0007]
In the robot of the present invention, a leg link having an ankle joint is slidably connected to the trunk by a hip joint, and there are two or more leg links. The machine configuration itself is known, but its controller is new and innovative. The controller of the present invention
(1) Freely swing the ankle joint of the grounding leg link,
(2) Measure the joint angle of the joint that is free to swing,
(3) Calculate the remaining joint angle based on the measured joint angle,
(4) Control the actuator that adjusts the remaining joint angle, adjust the remaining joint angle to the calculated joint angle,
(5) By switching the ankle joint that can swing freely according to the progress of the repetitive phenomenon that the tip of the leg link touches, floats and touches again, the swinging ankle joint is moved to the grounded leg link side. It is characterized by maintaining.
[0008]
In this robot, the grounding leg link itself tends to fall down passively in order to make the ankle joint of the grounding leg link freely swingable. At this time, other joint angles are actively adjusted, and control is performed so that the other leg link contacts the ground before the robot falls to prevent the fall. As the grounding legs are replaced, the robot advances. By repeating this, the robot continues walking while changing the grounding leg.
A natural walking motion can be obtained by walking by using movements that occur passively in nature. Since walking is performed using an action adapted to the dynamics of the robot, energy required for walking can be saved. When a person reaches out to the robot to stop passive movement, the robot stops. It is advantageous for coexistence of humans and robots, and can ensure high safety.
[0009]
In the case of a robot in which the left leg link and the right leg link are swingably connected to the torso by a hip joint, the controller uses the following relationship when calculating the remaining joint angle in the process of (3) above. It is preferable to calculate as follows. That is, the position of the center of gravity of the robot when the remaining joint angle is adjusted to the calculated joint angle,
(6) While the right leg link is a free leg link, it moves toward the grounding position of the right leg link between the grounding positions of the left and right leg links in the body side direction,
(7) While the left leg link is a free leg link, calculate the joint angle that satisfies the relationship of moving toward the grounding position of the left leg link between the grounding positions of the left and right leg links in the body side direction. .
[0010]
In this case, while the left leg link is grounded and the right leg link is a free leg link, the remaining joint angle is adjusted so that the center of gravity of the robot moves toward the grounded position of the right leg link. Therefore, the movement in which the ground leg passively swings and the movement in which the swing leg actively swings in the grounding direction are combined, and the robot walks with a natural feeling. Similarly, while the right leg link is grounded and the left leg link is a free leg link, the remaining joint angle is adjusted so that the center of gravity of the robot moves toward the grounded position of the left leg link. For this reason, the movement in which the ground leg passively swings and the movement in which the swing leg actively swings in the ground contact direction are obtained in combination.
[0011]
The controller
(8) Adjust the joint angle of the ankle joint and the hip joint in the traveling direction so that the hip joint is positioned forward in the traveling direction from the grounding position of the grounded leg link,
(9) If the ankle joint of the swing leg link and the joint angle in the travel direction of the hip joint are adjusted so that the tip of the free leg link is positioned forward in the travel direction relative to the hip joint,
The robot, while swinging alternately in the left and right directions, sends the trunk forward with respect to the grounding leg and sends the free leg forward with respect to the trunk. As a result, the robot walks forward.
[0012]
The present invention has created a novel and novel control method for a robot. This method
(1) a step of making the ankle joint of the grounding leg link freely swingable;
(2) a step of measuring the joint angle of the joint that is free to swing;
(3) calculating a residual joint angle based on the measured joint angle;
(4) adjusting the remaining joint angle to the calculated joint angle;
(5) By switching the ankle joint that can swing freely according to the progress of the repetitive phenomenon that the tip of the leg link touches, floats and touches again, the swinging ankle joint is moved to the grounded leg link side. Maintaining.
[0013]
According to this control method, the robot walks using the movement in which the ground leg link is passively tilted, a natural walking motion is obtained, and the energy required for walking can be saved. When a person reaches out to the robot and stops passive movement, the robot stops, which is advantageous for coexistence of the person and the robot.
[0014]
In the case of a robot in which the left leg link and the right leg link are swingably connected to the torso by a hip joint, the remaining joint angle is calculated using the following relationship when calculating the remaining joint angle in step (3) above. It is preferable to do. That is, when calculating the remaining joint angle based on the measured joint angle, the position of the center of gravity of the robot when adjusted to the calculated joint angle is (6) The right leg link is a free leg link Between, it moves toward the grounding position of the right leg link between the grounding positions in the body side direction of the left and right leg links,
(7) While the left leg link is a free leg link, calculate the joint angle that satisfies the relationship of moving toward the grounding position of the left leg link between the grounding positions of the left and right leg links in the body side direction. .
[0015]
According to this control method, while the left leg link is grounded and the right leg link is a free leg link, the remaining joint angle is set so that the center of gravity of the robot moves toward the grounded position of the right leg link. Since the adjustment is made, the movement in which the ground leg passively swings and the movement in which the swing leg actively swings in the ground contact direction are obtained in combination. Similarly, while the right leg link is grounded and the left leg link is a free leg link, the remaining joint angle is adjusted so that the center of gravity of the robot moves toward the grounded position of the left leg link. For this reason, the movement in which the ground leg passively swings and the movement in which the swing leg actively swings in the ground contact direction are obtained in combination. The robot walks with a natural feeling.
[0016]
When calculating the remaining joint angle in the process (3), it is preferable to calculate using the following relationship. That is, when calculating the remaining joint angle based on the measured joint angle, the position of the center of gravity of the robot when adjusted to the calculated joint angle is
(8) While the right leg link is a free leg link, the right leg link is grounded in the traveling direction at the same time as it moves toward the grounding position of the right leg link between the grounding positions of the left and right leg links in the body side direction. Move towards the position,
(9) While the left leg link is a free leg link, it moves toward the ground contact position of the left leg link between the ground contact positions of the left and right leg links in the body side direction, and at the same time the ground contact of the left leg link also in the traveling direction Calculate the joint angle that satisfies the relationship of moving toward the position.
[0017]
According to this control method, while the left leg link is grounded and the right leg link is a free leg link in both the body side direction and the traveling direction, the position of the center of gravity of the robot is directed toward the grounded position of the right leg link. The remaining joint angle is adjusted to move, and while the right leg link is grounded and the left leg link is a free leg link, the center of gravity position of the robot moves toward the grounded position of the left leg link. Since the remaining joint angle is adjusted, the robot sends the trunk forward with respect to the grounding leg while swinging alternately in the left-right direction, and sends the free leg forward with respect to the trunk. As a result, the robot walks forward. The walking posture is natural and the energy required for walking is small. Further, the robot can be stopped when a person reaches out from the outside.
[0018]
【Example】
FIG. 1 shows a skeleton diagram of the mechanical configuration of the
FIG. 2 shows the configuration of the
[0019]
FIG. 3 is a front view of a walking robot. (1) shows a state where the robot is strung with a right foot, and (a) shows a state immediately before the left foot is grounded by tilting left from the state of (1). (2) shows a state where the left foot is grounded, (3) shows a state where the left foot is further tilted from the state of (2), and a state where the left foot is strung, and (4) is a state where the left foot is inclined from the state of (3). The right foot is in a grounded state, and (5) is a state in which the right foot is further tilted from the state of (4) and is strung on the right foot. (1) and (5) are in the same state, and are symmetrical with the state of (3), and (2) and (4) are symmetrical.
The
[0020]
As shown in FIG. 2, the
[0021]
FIG. 7 shows the temporal change of the joint angle θ9 of the joint in the body side direction of the right ankle of the
FIG. 8 shows an example of the determination processing procedure by the phase determination means 24, and the phase is determined by the joint angle θ9 of the joint in the body side direction of the right ankle. If θ9 = α in step S2, it is determined that the left leg support phase A (step S4). If θ9 = −α in step S6, it is determined that it is the right leg support A phase (step S8). If θ9 is increasing and is greater than or equal to −α and less than kα, it is determined that the phase is the right leg support A phase (step S14). If θ9 is increasing and is greater than or equal to kα, it is determined that it is the left leg support B phase (step S16). If θ9 is decreasing and less than α and greater than −kα, it is determined that the left leg support phase A (step S20). If θ9 is decreasing and −kα or less, it is determined that it is the right leg support B phase (step S22).
This phase determination processing procedure is merely an example, and various other procedures are possible. The determination can also be made by utilizing the information of the
[0022]
The
(1) of FIG. 2 shows the control content in a right leg support state. In the right leg support state, control is performed as follows.
(1) The motor of the joint (θ9 in this case) of the ankle of the grounding leg is free to rotate and left to rotate freely. Let the joint θ9 be a passive joint (free joint), and leave it to passively rotate. However, -α is the maximum joint angle of this joint and does not rotate any further.
(2) Measure passively rotating joint angle θ9.
(3) The joint angle (θ7 in this case) of the joint in the body side direction of the hip joint of the ground leg is calculated from the measured joint angle θ9. This calculation will be described later.
(4) The joint angle (θ2 in this case) of the hip-joint of the free leg is set equal to −θ7. As a result, the ground leg link and the free leg link are maintained in parallel.
(5) The joint angle of the ankle joint of the free leg in the body side direction (θ4 in this case) is made equal to θ9. As a result, the foot of the ground leg and the foot of the free leg are maintained in parallel.
(6) For the knee joints (θ3 and θ8), keep the knee at an angle that extends straight (here it is zero).
(7) The joint angle (θ10 in this case) of the joint in the direction of travel of the ankle joint of the ground leg is calculated from the measured joint angle θ9. This calculation will be described later. Thereby, the position of the hip joint is sent forward in the traveling direction with respect to the ground contact position of the ground leg.
(8) The joint angle (θ6 in this case) in the advancing direction of the hip joint of the ground leg is made equal to −θ10. The body part is prevented from falling down.
(9) The joint angle (θ1 in this case) in the advancing direction of the hip joint of the free leg is made equal to θ10. Thereby, the free leg is stepped forward in the traveling direction.
(10) The joint angle (θ5 in this case) of the ankle joint of the free leg in the traveling direction is made equal to −θ10. Thereby, the foot of the free leg and the foot of the grounding leg are maintained in parallel.
[0023]
(2) of FIG. 2 shows the control content in the left leg support state. In the left leg support state, control is performed as follows.
(1) The motor of the body side joint (in this case θ4) of the ankle of the grounding leg is free to rotate and left to rotate freely. Let the joint θ4 be a passive joint (free joint), and leave it to passively rotate. However, α is the maximum joint angle of this joint and does not rotate beyond that.
(2) Measure passively rotating joint angle θ4.
(3) The joint angle (θ2 in this case) of the joint in the body side direction of the hip joint of the ground leg is calculated from the measured joint angle θ4. This calculation will be described later.
(4) The joint angle (in this case, θ7) of the hip-joint of the free leg is set equal to −θ2. As a result, the ground leg link and the free leg link are maintained in parallel.
(5) The joint angle of the ankle joint of the free leg in the body side direction (θ9 in this case) is made equal to θ4. As a result, the foot of the ground leg and the foot of the free leg are maintained in parallel.
(6) For the knee joints (θ3 and θ8), keep the knee at an angle that extends straight (here it is zero).
(7) Based on the measured joint angle θ4, the joint angle of the joint in the advancing direction of the ankle joint of the ground leg (in this case, θ5) is calculated. This calculation will be described later. Thereby, the position of the hip joint is sent forward in the traveling direction with respect to the ground contact position of the ground leg.
(8) The joint angle (θ1 in this case) of the grounded leg in the advancing direction of the hip joint is made equal to −θ5. The body part is prevented from falling down.
(9) The joint angle (θ6 in this case) of the free leg's hip joint is set equal to θ5. Thereby, the free leg is stepped forward in the traveling direction.
(10) The joint angle (θ10 in this case) in the advancing direction of the ankle joint of the free leg is made equal to −θ5. Thereby, the foot of the free leg and the foot of the grounding leg are maintained in parallel.
As shown in FIG. 2, the
[0024]
As shown in FIG. 4, when the right foot is stretched and maintained at θ9 = −α in the state (1), the center of gravity of the robot is at the position W1. Here, the center of gravity position W is assumed to be at the center of the left and right hip joints, but it may be located on the trunk. If θ9 is kα when tilted left from state (1) and the left foot touches the ground, the center of gravity of the robot when θ9 = kα is at the position W2.
In state (1) and thereafter, that is, in the right leg support phase A, the center of gravity position changes in accordance with the joint angle θ9 to be freed, the center of gravity position is W1 at θ9 = −α, and the center of gravity position changes as the robot tilts to the left. If the center of gravity moves from W1 to W2 and the center of gravity position is θ2 when θ9 = kα, the state (1) changes to the
The position of the center of gravity of the lateral surface of the robot is determined by θ2, θ4, θ7, and θ9. In the right leg support state, θ9 is free (measurable but not actively controlled), θ4 is equal to θ9, θ2 is equal to −θ7, and θ7 is calculated by θ9. In calculating θ9 to θ7, the center of gravity position of the robot when the posture of the robot is adjusted using the calculated θ7 is the center of gravity position when θ9 = −α is W1, and the center of gravity is as the robot tilts to the left If the position moves from W1 to W2 and the position of the center of gravity when θ9 = kα is at W2, the robot changes from state (1) to state (2).
The center-of-gravity position W1 when θ9 = −α is to the left of the ground contact position of the right leg, and does not tilt to the right beyond that. The robot never falls to the right. The center of gravity position W1 is on the left side of the ground contact position of the right leg, and tilts to the left if the joint θ9 is free.
[0025]
The equation (A) in FIG. 5 shows an equation for calculating θ9 to θ7. If θ7 is calculated using the equation and adjusted to the calculated joint angle θ7, the center of gravity position of the robot is θ9 = −α. At W1, the robot moves from W1 to W2 as the robot tilts to the left, and a relationship of moving to W2 when θ9 = kα is obtained.
[0026]
FIG. 4 also shows the transition of the center of gravity position from the state (2) to the state (3), and the center of gravity position when the left foot is stretched and maintained at θ4 = α is indicated by W3. The robot changes from state (2) to state (3) by controlling θ2, θ7, and θ9 following the change of θ4 so that the center of gravity is positioned at W3 in state (3).
In the left leg support B layer, θ2 is calculated from θ4 and controlled to θ7 = −θ2 and θ9 = θ4. The center of gravity of the robot is at W2 when θ4 = −kα, and W2 as the robot tilts to the left. If the relation of moving to W3 when θ4 = α is obtained, the robot changes from state (2) to state (3). Also in this case, θ2 can be calculated from θ4 by an expression similar to the expression (A) in FIG.
The center-of-gravity position W3 when θ4 = α is in the right direction from the ground contact position of the left leg, and does not tilt to the left beyond that. The robot never falls to the left. The center of gravity position W3 is on the right side of the ground contact position of the left leg, and tilts to the right if the joint θ4 is free.
[0027]
FIG. 4 also shows the transition of the center of gravity position from state (3) to state (4). If the center of gravity position is W4 when the robot tilts to the right, θ4 is −kα and the right foot is grounded, The robot changes from state (3) to state (4).
Similarly, the transition of the center of gravity position from state (4) to state (1) is also shown. If the center of gravity position when the robot is further tilted to the right and θ9 is straddled by −α is at the position W1, the robot The state (4) changes to the state (1).
[0028]
The center-of-gravity position is between W1 and W3, but it exists at L during the ground contact position in the body side direction of the left and right leg links. The center of gravity position while the left leg link is a free leg link moves toward the ground contact position of the left leg link, and the center of gravity position while the right leg link is a free leg link is the ground contact position of the right leg link. Move towards position.
In the right leg support A phase from the state (1) to the state (2), the phenomenon progresses naturally because the position of the center of gravity is lowered. In the left leg support phase B from state (2) to (3), the center of gravity increases, but the robot is tilting leftward from state (1) to (2), and its inertia exists, so the center of gravity position exists. The phenomenon of rising naturally proceeds. Similarly, in the left leg support A phase from the state (3) to the state (4), the phenomenon progresses naturally because the center of gravity is lowered. In the right leg support B phase from state (4) to (1), the center of gravity increases, but the robot is tilting rightward from state (3) to (4) and its inertia exists, so the center of gravity position is Ascending phenomenon proceeds naturally.
[0029]
The repetitive motions of states (1) to (4) are similar to the fact that the triangular prism repeats the pendulum motion on the floor having a coefficient of restitution coefficient of 1, and can continue the motion with a small amount of energy. If there is no friction of the swingable or rotatable joint, the repeated motions of the states (1) to (4) are repeated without being attenuated. In fact, there is friction. By applying a torque sufficient to cancel the friction to the rotatable joint motor, a state in which no friction exists can be created. In the present invention, making the joint free means not only to allow passive rotation without applying current to the motor, but also by substantially applying friction to cancel the friction. Say both not to state.
[0030]
The repetitive motions of the states (1) to (4) realize the stepping motion of the left and right legs. The robot advances when a stepping step is added in synchronization with the stepping motion of the left and right legs. At this time, since the left and right tilt is used, the free leg moves in the air without bending the knee of the free leg.
Formula B in FIG. 5 shows the joint angle (in this case, θ10) of the joint in the advancing direction of the ankle of the grounding leg during the right leg grounding. In this case, the joint angle θ6 of the hip joint of the ground leg is set to −θ10, the joint angle θ1 of the hip joint of the swing leg is set to θ10, and the joint angle of the joint of the free leg ankle is set to θ10. If θ5 is −θ10, the hip joint is positioned forward in the traveling direction with respect to the grounding position of the grounding leg by θ10, the trunk tilt is prohibited by θ6, and the free leg link is stepped forward by θ1 with respect to the hip joint, The foot of the grounding leg and the foot of the free leg are maintained in parallel by θ5. The lower part of FIG. 6 shows this, and the robot walks by alternately stepping on the left and right legs. The left and right stepping motion and the forward stepping motion are combined, and the robot walks with a natural feeling.
[0031]
In the above, the joint angle θ4 or θ9 in the body side direction of the ankle of the grounding leg is made free, and the joint angles of the remaining joints are controlled following the change. As a result, the left and right stepping motion and the forward stepping motion are combined.
Alternatively, the joint angle θ5 or θ10 in the advancing direction of the ankle of the ground leg can be made free, and the joint angles of the remaining joints can be controlled following the change. Even in this way, it is possible to obtain an operation in which the left and right stepping motions and the forward stepping motion are combined. In this case, for the advancing direction, the remaining joint angle is actively controlled based on the free joint angle θ5 or θ10 so that the center of gravity of the robot shifts forward. As for the body side direction, the center of gravity of the robot shifts to the left while the right leg is grounded, and the center of gravity of the robot shifts to the right while the left leg is grounded, based on the free joint angle θ5 or θ10. Actively control the remaining joint angles. Both the joint angle in the body side direction and the joint angle in the traveling direction of the ankle of the ground leg may be free. In synchronism with the replacement of the grounding leg, the state where the joint angles θ4 and θ5 are made free and the state where the angles θ9 and θ10 are made free are switched. In this case, in the right leg support phase, θ9 and θ10 are made free (however, the absolute value of θ9 is regulated by α, and the absolute value of θ10 is regulated by β). The remaining joints θ7, θ2, and θ4 in the body side direction are actively controlled based on the measured joint angle θ9, and the remaining joints θ6, θ1, and θ5 in the traveling direction are based on the measured joint angle θ10. Active control. In the left leg support phase, θ4 and θ5 are set free (however, the absolute value of θ4 is regulated by α and the absolute value of θ5 is regulated by β). The remaining joints θ2, θ7, and θ9 in the body side direction are actively controlled based on the measured joint angle θ4, and the remaining joints θ1, θ6, and θ10 in the traveling direction are based on the measured joint angle θ5. Active control. In any case, active control is performed so as to maintain the relationships of θ9 = θ4, θ7 = −θ2, θ6 = −θ1, and θ10 = −θ5. Regarding the advancing direction, the remaining joint angle is actively controlled based on the free joint angle θ5 or θ10 so that the center of gravity of the robot shifts forward. As for the body side direction, the center of gravity of the robot is shifted to the left while the right leg is grounded, and the center of gravity of the robot is shifted to the right while the left leg is grounded, based on the free joint angle θ4 or θ9. Actively control the remaining joint angles. When calculating the remaining joint angle based on the measured joint angle, the position of the center of gravity of the robot when adjusted to the calculated joint angle is the right and left leg while the right leg link is a free leg link. While moving toward the ground contact position of the right leg link between the ground contact positions in the body side direction of the link, it also moves toward the ground contact position of the right leg link in the traveling direction and the left leg link is a free leg link. Calculate the joint angle that satisfies the relationship of moving toward the grounding position of the left leg link in the traveling direction at the same time as moving to the grounding position of the left leg link between the grounding positions of the left and right leg links in the body side direction. The robot is confirmed to continue walking.
[0032]
The change locus of the center of gravity can be set in various ways, and as shown in FIG. 9, a smooth curved locus can be adopted. The inclination angle at the time of contact, that is, the magnitude of the constant k described above should be tuned by experiment, and if there is a robot that is preferably set small as shown in the center of gravity locus of (1) in FIG. There are also robots that are preferably set large as in 2).
[0033]
Although specific examples of the present invention have been described in detail above, these are examples and do not limit the scope of the claims. In addition, the present invention solves several objects, and is not meaningful only when all the objects are solved at the same time, and is sufficiently meaningful only by solving one or two objects. .
[0034]
【The invention's effect】
According to the robot control technology of the present invention, it is possible to walk using an event that changes passively and naturally. This closely matches the human walking pattern, and a natural gait movement can be obtained. In addition, it is adaptable to the robot dynamics, and can walk with small energy consumption. Furthermore, since it walks using the phenomenon which changes passively and naturally, if a human stops the change, the robot stops the walking motion. Since the robot stops when the person reaches out, it is easy for the person and the robot to coexist and high safety can be ensured.
[Brief description of the drawings]
FIG. 1 is a skeleton diagram showing a mechanical configuration of a robot.
FIG. 2 is a diagram showing a configuration of a robot controller.
FIG. 3 shows the left and right stepping motions, phases, and control contents of the robot in contrast.
FIG. 4 shows the movement locus of the center of gravity position.
FIG. 5 shows a method of calculating a joint angle that realizes the movement locus of the center of gravity.
FIG. 6 shows the left and right stepping motion of the robot in contrast to the stepping motion.
FIG. 7 shows a temporal change in the joint angle θ9.
FIG. 8 shows an example of a phase discrimination processing procedure.
FIG. 9 shows another example of the center of gravity movement locus.
FIG. 10 shows another example of the center of gravity movement locus.
FIG. 11 shows a conventional robot teaching technique.
[Explanation of symbols]
θ1: Joint in the direction of travel of the left hip joint
θ2: Joint in the body direction of the left hip joint
θ3: Knee joint
θ4: joints in the body side direction of the left ankle
θ5: Left ankle joint in the direction of travel
θ6: Joint in the direction of travel of the right hip joint
θ7: Body side direction of the right hip joint
θ8: Knee joint
θ9: Body side direction joint of right ankle
θ10: joint in the direction of travel of the right ankle
Claims (6)
接地脚リンクの足首関節を揺動自由とし、
揺動自由とした関節の関節角を計測し、
計測された関節角に基づいて残余の関節角を計算し、
残余の関節角を調整するアクチュエータを制御して、残余の関節角を計算された関節角に調整し、
脚リンクの先端が接地して浮遊して再度接地する繰返し現象の進行に合わせて揺動自由とする足首関節を切替えることによって、揺動自由とする足首関節を接地脚リンクの側に維持する、
コントローラを有する、関節角の受動変化を利用して歩行するロボット。A leg link having an ankle joint is slidably connected to the trunk by a hip joint, and there are two or more leg links, and the following controller,
The ankle joint of the grounding leg link can swing freely,
Measure the joint angle of the joint that is free to swing,
Calculate the remaining joint angle based on the measured joint angle,
Control the actuator to adjust the remaining joint angle, adjust the remaining joint angle to the calculated joint angle,
Maintaining the ankle joint to be free to swing on the side of the grounded leg link by switching the ankle joint to be free to swing in accordance with the progress of a repetitive phenomenon where the tip of the leg link is grounded, floated and grounded again.
A robot having a controller and walking using passive changes in joint angles.
接地脚リンクの足首関節を揺動自由とし、
揺動自由とした関節の関節角を計測し、
計測された関節角に基づいて残余の関節角を計算し、
残余の関節角を調整するアクチュエータを制御して、残余の関節角を計算された関節角に調整し、
脚リンクの先端が接地して浮遊して再度接地する繰返し現象の進行に合わせて揺動自由とする足首関節を切替えることによって、揺動自由とする足首関節を接地脚リンクの側に維持する、
コントローラを有し、
計測された関節角に基づいて残余の関節角を計算する際に、計算された関節角に調整したときのロボットの重心位置が、右脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において右脚リンクの接地位置に向けて移動し、左脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において左脚リンクの接地位置に向けて移動する関係を満たす関節角を計算することを特徴とする、関節角の受動変化を利用して歩行するロボット。It is a robot in which a left leg link having an ankle joint and a right leg link are swingably connected to a trunk by a hip joint, and the following controller,
The ankle joint of the grounding leg link can swing freely,
Measure the joint angle of the joint that is free to swing,
Calculate the remaining joint angle based on the measured joint angle,
Control the actuator to adjust the remaining joint angle, adjust the remaining joint angle to the calculated joint angle,
Maintaining the ankle joint to be free to swing on the side of the grounded leg link by switching the ankle joint to be free to swing in accordance with the progress of a repetitive phenomenon where the tip of the leg link is grounded, floated and grounded again.
Have a controller,
When calculating the remaining joint angle based on the measured joint angle, the position of the center of gravity of the robot when adjusted to the calculated joint angle is the right and left leg while the right leg link is a free leg link. It moves toward the contact position of the right leg link between the contact positions in the body side direction of the link, and while the left leg link is a free leg link, between the contact positions of the left and right leg links in the body side direction. A robot that uses a passive change in joint angle to calculate a joint angle that satisfies the relationship of moving toward the ground contact position of the left leg link.
接地脚リンクの足首関節を揺動自由とする工程と、
揺動自由とした関節の関節角を計測する工程と、
計測された関節角に基づいて残余の関節角を計算する工程と、
残余の関節角を計算された関節角に調整する工程と、
脚リンクの先端が接地して浮遊して再度接地する繰返し現象の進行に合わせて揺動自由とする足首関節を切替えることによって、揺動自由とする足首関節を接地脚リンクの側に維持する工程と、
を有するロボットの制御方法。A leg link having an ankle joint is slidably connected to a trunk by a hip joint, and there are two or more leg links.
Making the ankle joint of the ground leg link free to swing;
Measuring the joint angle of the joint that is free to swing;
Calculating a residual joint angle based on the measured joint angle;
Adjusting the remaining joint angle to the calculated joint angle;
The step of maintaining the ankle joint to be free to swing on the side of the grounded leg link by switching the ankle joint to be freely swingable in accordance with the progress of a repetitive phenomenon in which the tip of the leg link is grounded, floated and grounded again. When,
A method of controlling a robot having
接地脚リンクの足首関節を揺動自由とする工程と、
揺動自由とした関節の関節角を計測する工程と、
計測された関節角に基づいて残余の関節角を計算する工程と、
残余の関節角を計算された関節角に調整する工程と、
脚リンクの先端が接地して浮遊して再度接地する繰返し現象の進行に合わせて揺動自由とする足首関節を切替えることによって、揺動自由とする足首関節を接地脚リンクの側に維持する工程とを有し、
計測された関節角に基づいて残余の関節角を計算する際に、計算された関節角に調整したときのロボットの重心位置が、右脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において右脚リンクの接地位置に向けて移動し、左脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において左脚リンクの接地位置に向けて移動する関係を満たす関節角を計算することを特徴とするロボット制御方法。It is a control method for a robot in which a left leg link and an right leg link having an ankle joint are swingably connected to a trunk by a hip joint,
Making the ankle joint of the ground leg link free to swing;
Measuring the joint angle of the joint that is free to swing;
Calculating a residual joint angle based on the measured joint angle;
Adjusting the remaining joint angle to the calculated joint angle;
The step of maintaining the ankle joint to be free to swing on the side of the grounded leg link by switching the ankle joint to be freely swingable in accordance with the progress of a repetitive phenomenon in which the tip of the leg link is grounded, floated and grounded again. And
When calculating the remaining joint angle based on the measured joint angle, the position of the center of gravity of the robot when adjusted to the calculated joint angle is the right and left leg while the right leg link is a free leg link. It moves toward the contact position of the right leg link between the contact positions in the body side direction of the link, and while the left leg link is a free leg link, between the contact positions of the left and right leg links in the body side direction. A robot control method characterized by calculating a joint angle satisfying a relationship of moving toward a ground contact position of a left leg link.
接地脚リンクの足首関節を進行方向に揺動自由とする工程と、
揺動自由とした関節の関節角を計測する工程と、
計測された関節角に基づいて残余の関節角を計算する工程と、
残余の関節角を計算された関節角に調整する工程と、
脚リンクの先端が接地して浮遊して再度接地する繰返し現象の進行に合わせて揺動自由とする足首関節を切替えることによって、揺動自由とする足首関節を接地脚リンクの側に維持する工程とを有し、
計測された関節角に基づいて残余の関節角を計算する際に、計算された関節角に調整したときのロボットの重心位置が、右脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において右脚リンクの接地位置に向けて移動すると同時に進行方向でも右脚リンクの接地位置に向けて移動し、左脚リンクが遊脚リンクになっている間は左右の脚リンクの体側方向での接地位置の間において左脚リンクの接地位置に向けて移動すると同時に進行方向でも左脚リンクの接地位置に向けて移動する関係を満たす関節角を計算することを特徴とするロボット制御方法。It is a control method for a robot in which a left leg link and an right leg link having an ankle joint are swingably connected to a trunk by a hip joint,
Making the ankle joint of the grounding leg link freely swingable in the direction of travel;
Measuring the joint angle of the joint that is free to swing;
Calculating a residual joint angle based on the measured joint angle;
Adjusting the remaining joint angle to the calculated joint angle;
The step of maintaining the ankle joint to be free to swing on the side of the grounded leg link by switching the ankle joint to be freely swingable in accordance with the progress of a repetitive phenomenon in which the tip of the leg link is grounded, floated and grounded again. And
When calculating the remaining joint angle based on the measured joint angle, the position of the center of gravity of the robot when adjusted to the calculated joint angle is the right and left leg while the right leg link is a free leg link. While moving toward the ground contact position of the right leg link between the ground contact positions in the body side direction of the link, it also moves toward the ground contact position of the right leg link in the traveling direction and the left leg link is a free leg link. Calculate the joint angle that satisfies the relationship of moving toward the grounding position of the left leg link in the traveling direction at the same time between the grounding positions of the left and right leg links in the body side direction. A robot control method characterized by the above.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003070758A JP4291602B2 (en) | 2003-03-14 | 2003-03-14 | Robot walking using passive change of joint angle and its control method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003070758A JP4291602B2 (en) | 2003-03-14 | 2003-03-14 | Robot walking using passive change of joint angle and its control method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004276167A JP2004276167A (en) | 2004-10-07 |
| JP4291602B2 true JP4291602B2 (en) | 2009-07-08 |
Family
ID=33287426
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003070758A Expired - Fee Related JP4291602B2 (en) | 2003-03-14 | 2003-03-14 | Robot walking using passive change of joint angle and its control method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4291602B2 (en) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4559803B2 (en) * | 2004-09-14 | 2010-10-13 | 敏男 福田 | Robot walking using passive change of joint angle and its control method |
| JP4766381B2 (en) * | 2005-11-10 | 2011-09-07 | 株式会社Ｉｈｉ | Leg wheel type mobile robot, its operation method and program |
| JP4840239B2 (en) * | 2007-04-20 | 2011-12-21 | トヨタ自動車株式会社 | Control method for legged mobile robot and legged mobile robot |
| JP5467291B2 (en) * | 2009-09-16 | 2014-04-09 | 学校法人 工学院大学 | Energy-saving robot joint drive control system |
-
2003
- 2003-03-14 JP JP2003070758A patent/JP4291602B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2004276167A (en) | 2004-10-07 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US7663332B2 (en) | Walking robot by using passive changes in joint angles and control method thereof | |
| JP4513320B2 (en) | Robot apparatus and motion control method of robot apparatus | |
| KR100476644B1 (en) | Apparatus walking with two legs, walking control apparatus, and walking control method thereof | |
| KR101985790B1 (en) | Walking robot and control method thereof | |
| JP4998506B2 (en) | Robot control device, robot control method, and legged robot | |
| JP3629133B2 (en) | Control device for legged mobile robot | |
| JP4951732B2 (en) | Drive method, drive control device, and robot | |
| JP4912891B2 (en) | Legged mobile robot and its control program | |
| US9079624B2 (en) | Walking robot and method of controlling balance thereof | |
| WO2003090978A1 (en) | Control device of legged mobile robot | |
| JP6682341B2 (en) | Walking control method, walking control program, and bipedal walking robot | |
| KR20160135348A (en) | Exoskeleton comprising a foot structure | |
| WO1998026905A1 (en) | Attitude controller of legged moving robot | |
| JPH05337849A (en) | Attitude stabilization control device for leg type mobile robot | |
| KR20040068438A (en) | Walking type robot and a moving method thereof | |
| WO2011117999A1 (en) | Ambulation assistance device | |
| US6353773B1 (en) | Remote control system for biped locomotion robot | |
| JP4291602B2 (en) | Robot walking using passive change of joint angle and its control method | |
| JPH11300661A (en) | Controller for leg-type mobile robot | |
| JP5040693B2 (en) | Legged robot and control method thereof | |
| WO2016159346A1 (en) | Legged mechanism, walking robot, orientation control method, and program | |
| JP2009255231A (en) | Walking control device and walking control method | |
| JP4833121B2 (en) | System comprising a legged robot, a gait generator and a gait modifier | |
| JP2009125838A (en) | Biped walking robot and walking control method | |
| JP2008142861A (en) | Gait data production device and gait data production method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20051031 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080826 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20090331 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090403 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120410 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120410 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130410 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130410 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140410 Year of fee payment: 5 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |