JP2004090112A - Walking/running control method of leg type moving device and walking/running control device of leg type moving device - Google Patents
Walking/running control method of leg type moving device and walking/running control device of leg type moving device Download PDFInfo
- Publication number
- JP2004090112A JP2004090112A JP2002252088A JP2002252088A JP2004090112A JP 2004090112 A JP2004090112 A JP 2004090112A JP 2002252088 A JP2002252088 A JP 2002252088A JP 2002252088 A JP2002252088 A JP 2002252088A JP 2004090112 A JP2004090112 A JP 2004090112A
- Authority
- JP
- Japan
- Prior art keywords
- moving device
- control
- legged
- walking
- state
- 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.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
【０００１】
【発明の属する技術分野】
この発明は、脚式移動装置の歩行運動および走行運動の制御を行う脚式移動装置の歩行・走行制御方法および脚式移動装置の歩行・走行制御装置に関し、より詳細には、脚式移動装置の歩行運動と走行運動をシームレスに制御して運動の連続性を実現する脚式移動装置の歩行・走行制御方法および脚式移動装置の歩行・走行制御装置に関する。
【０００２】
【従来の技術】
近時、脚を用いて移動する装置（以降、脚式移動装置と記載する）の研究が長足の進歩を遂げている。一般的に、脚式移動装置は、装置本体を支持すると共に装置本体に推進力を与えて移動させるための複数の脚が装置本体の下部に設けられている。なお、脚式移動装置の具体例としては、例えば、２本の脚を有する人間型のロボットや、装置本体の下部に４本の足を設けた装置などを挙げることができる。
【０００３】
また、従来の脚式移動装置として、例えば、特開２００１−１２９７７５号公報「ロボット、及び、ロボットの重心位置制御方法」に開示されるように、人やサルなどの直立歩行型の身体メカニズムや動作を模した構造を有する脚式移動型ロボットにおいて、歩行運動や、その他体幹や上肢などを含んだ全身協調運動時において好適な重心位置を設定可能な直立歩行・脚式移動型ロボットが提供されている。
【０００４】
なお、このような従来の脚式移動装置では、ＺＭＰ（Ｚｅｒｏ ＭｏｍｅｎｔＰｏｉｎｔ：総慣性力のモーメントがゼロとなる点）規範に基づいて、歩行制御を行っている。すなわち、脚式移動装置が歩行するときの床反力によるモーメントがゼロとなる床面上の点を目標値に一致させるように制御することにより、脚式移動装置の歩行運動を実現している。
【０００５】
一方、歩行運動が可能な脚式移動装置とは別に、走行運動を実現した脚式移動装置も提供されている。ここで、走行運動とは、脚式移動装置の移動において両脚が同時に床から離れている（浮いている）期間がある移動運動のことである。歩行運動では脚式移動装置の何れか一方の脚が常に床に接地しているので前述したＺＭＰ規範を適用することが可能であるが、走行運動では両脚が浮いている期間があることでＺＭＰ規範を適用することができないため、歩行運動とは完全に異なる運動として扱われている。
【０００６】
したがって、歩行運動と走行運動では、それぞれの制御における制御モデルおよび各種式が異なることになるため、１つの脚式移動装置で連続して歩行運動と走行運動を行わせる場合には、歩行運動時と走行運動時とで制御モデルや各種式を切り替える必要があった。
【０００７】
【発明が解決しようとする課題】
しかしながら、上記従来の技術によれば、脚式移動装置の歩行運動と走行運動とを異なる運動と捕らえて、歩行制御と走行制御とを別々の制御方法で行う構成であるため、１つの脚式移動装置で歩行運動と走行運動を行わせる場合には運動の切り分けにより、複雑な制御が要求されるという問題点や、切り分けることによって運動の連続性が損なわれ、歩いている状態から走り出すことや、走っている状態から歩く状態へ移ることができないという問題点が発生する。
【０００８】
この発明は上記に鑑みてなされたものであって、歩行運動制御と走行運動制御を切り替えるための複雑な制御を行うことなく、歩行運動と走行運動とを連続的に実現して、立ち止まっている状態から歩き出して徐々に速度アップ走行にいたり、また止まるという動作を可能とすることを目的とする。
【０００９】
【課題を解決するための手段】
上記目的を達成するため、請求項１に係る脚式移動装置の歩行・走行制御方法は、脚式移動装置の歩行運動および走行運動の制御を行う脚式移動装置の歩行・走行制御方法において、前記脚式移動装置の歩行運動と走行運動とを同一の制御モデルを用いてモデル化し、前記制御モデルで使用する制御パラメータを切り替えることによって歩行運動制御と走行運動制御を制御することを特徴とする。
【００１０】
この発明によれば、歩行運動と走行運動とを同一の制御モデルを用いてモデル化し、該制御モデルで使用する制御パラメータを切り替えることによって、歩行運動制御と走行運動制御を制御するので、制御パラメータの切り替えのみで、歩行運動と走行運動とを制御する。換言すれば、複雑な制御を行うことなく、歩行運動と走行運動とを連続的に実現する。
【００１１】
また、請求項２に係る脚式移動装置の歩行・走行制御方法は、請求項１に記載の脚式移動装置の歩行・走行制御方法において、前記制御モデルは、前記脚式移動装置の脚の運動によって発生するモーメントおよび力を質点本体に対する外乱として処理し、前記脚式移動装置を三次元の一質点系飛行体として見做してモデル化したことを特徴とする。
【００１２】
また、請求項３に係る脚式移動装置の歩行・走行制御方法は、請求項１または２に記載の脚式移動装置の歩行・走行制御方法において、前記制御モデルは、前記脚式移動装置の運動を、前記脚式移動装置に推進力を与える第１の運動期間と、前記脚式移動装置の空中姿勢および脚を用いた支持姿勢を目標状態に保つ第２の運動期間と、前記脚式移動装置が着地する際の衝撃を和らげる第３の運動期間との３つの運動期間に分けて、前記３つの運動期間毎に使用する制御パラメータを変更する構成であることを特徴とする。
【００１３】
また、請求項４に係る脚式移動装置の歩行・走行制御方法は、請求項３に記載の脚式移動装置の歩行・走行制御方法において、前記制御モデルが、前記第１の運動期間において、前記脚式移動装置の接地点から重心までの重心位置ベクトルと、その時の重心速度ベクトルと、その時の重心加速度ベクトルとの３つを制御パラメータとして用いることを特徴とする。
【００１４】
また、請求項５に係る脚式移動装置の歩行・走行制御方法は、請求項３または４に記載の脚式移動装置の歩行・走行制御方法において、前記制御モデルが、前記第２の運動期間において、前記第１の運動期間における前記脚式移動装置の最終姿勢状態を初期姿勢状態として用いると共に、前記脚式移動装置の角運動量および運動量の２つを制御パラメータとして用いることを特徴とする。
【００１５】
また、請求項６に係る脚式移動装置の歩行・走行制御方法は、請求項５に記載の脚式移動装置の歩行・走行制御方法において、前記制御モデルが、前記第２の運動期間において、さらに、前記脚式移動装置の姿勢角度が目標姿勢角度となるように制御することを特徴とする。
【００１６】
また、請求項７に係る脚式移動装置の歩行・走行制御方法は、請求項３〜６のいずれか一つに記載の脚式移動装置の歩行・走行制御方法において、前記制御モデルが、前記第３の運動期間において、前記第２の運動期間における前記脚式移動装置の最終姿勢状態を初期姿勢状態として用いると共に、前記脚式移動装置の接地点から重心までの重心位置ベクトルと、その時の重心速度ベクトルと、その時の重心加速度ベクトルとの３つを制御パラメータとして用いることを特徴とする。
【００１７】
また、請求項８に係る脚式移動装置の歩行・走行制御装置は、脚式移動装置の歩行運動および走行運動の制御を行う脚式移動装置の歩行・走行制御装置において、前記脚式移動装置の並進移動速度を入力して、その時の運動に最適な前記脚式移動装置の接地点から重心までの重心位置ベクトル、その時の重心速度ベクトルおよびその時の重心加速度ベクトルを生成して出力するベクトル生成手段と、前記脚式移動装置が脚を用いて推進力を生成する第１の運動期間において、前記ベクトル生成手段で生成された前記重心位置ベクトル、重心速度ベクトルおよび重心加速度ベクトルの３つを制御パラメータとして入力し、前記第１の運動期間における前記脚式移動装置の初期姿勢状態から前記第１の運動期間の最終目標姿勢状態を生成して、前記最終目標姿勢状態へ遷移させる制御を行う第１の制御手段と、前記脚式移動装置の空中姿勢または脚を用いた支持姿勢を目標状態に保つ第２の運動期間において、前記第１の運動期間における前記脚式移動装置の最終目標姿勢状態を初期姿勢状態として、前記脚式移動装置の角運動量および運動量の２つを制御パラメータとして入力し、前記角運動量および運動量から前記第２の運動期間の制御目標となる角運動量および運動量を生成し、生成した角運動量および運動量へ遷移させる制御を行う第２の制御手段と、前記脚式移動装置の脚が接地する際の衝撃を和らげる第３の運動期間において、前記第２の運動期間における前記脚式移動装置の最終姿勢状態を初期姿勢状態として、その時の重心位置ベクトル、その時の重心速度ベクトルおよびその時の重心加速度ベクトルの３つを制御パラメータとして用い、前記初期姿勢状態から前記第３の運動期間の最終目標姿勢状態を生成し、前記最終目標姿勢状態へ遷移させる制御を行う第３の制御手段と、前記脚式移動装置の運動状態に基づいて、前記第１の制御手段、第２の制御手段または第３の制御手段に切り替える切替制御手段と、を備えたことを特徴とする。
【００１８】
また、請求項９に係る脚式移動装置の歩行・走行制御装置は、脚式移動装置の歩行運動および走行運動の制御を行う脚式移動装置の歩行・走行制御装置において、前記脚式移動装置の並進移動速度を検出する速度検出手段と、前記速度検出手段から並進移動速度を入力して、その時の運動に最適な前記脚式移動装置の接地点から重心までの重心位置ベクトル、その時の重心速度ベクトルおよびその時の重心加速度ベクトルを生成して出力するベクトル生成手段と、前記脚式移動装置の２つの脚の接地状態を検出する接地検出手段と、前記脚式移動装置の角運動量を検出する角運動量検出手段と、前記脚式移動装置の運動量を検出する運動量検出手段と、前記速度検出手段および接地検出手段の検出結果に基づいて、前記脚式移動装置の脚の接地状態が２脚の接地状態から１脚の接地状態へ移行する期間または１脚の接地状態から接地なしの状態へ移行する期間で、かつ、前記脚式移動装置の並進移動速度が増加する期間を第１の運動期間として、前記ベクトル生成手段で生成された前記重心位置ベクトル、重心速度ベクトルおよび重心加速度ベクトルの３つを制御パラメータとして入力し、前記第１の運動期間における前記脚式移動装置の初期姿勢状態から前記第１の運動期間の最終目標姿勢状態を生成して、前記最終目標姿勢状態へ遷移させる制御を行う第１の制御手段と、前記接地検出手段の検出結果に基づいて、前記脚式移動装置の脚の接地状態が１脚の接地状態から２脚の接地状態へ移行する期間または接地なしの状態から１脚の接地状態へ移行する期間を第２の運動期間として、前記第１の運動期間における前記脚式移動装置の最終目標姿勢状態を初期姿勢状態として、前記角運動量検出手段および運動量検出手段から前記脚式移動装置の角運動量および運動量の２つを制御パラメータとして入力し、前記角運動量および運動量から前記第２の運動期間の制御目標となる角運動量および運動量を生成し、生成した角運動量および運動量へ遷移させる制御を行う第２の制御手段と、前記速度検出手段および接地検出手段の検出結果に基づいて、前記脚式移動装置の脚の接地状態が２脚の接地状態または１脚の接地状態である期間で、かつ、前記脚式移動装置の並進移動速度を低下させる期間を第３の運動期間として、前記第２の運動期間における前記脚式移動装置の最終姿勢状態を初期姿勢状態として、その時の重心位置ベクトル、その時の重心速度ベクトルおよびその時の重心加速度ベクトルの３つを制御パラメータとして用い、前記初期姿勢状態から前記第３の運動期間の最終目標姿勢状態を生成し、前記最終目標姿勢状態へ遷移させる制御を行う第３の制御手段と、前記脚式移動装置の運動状態に基づいて、前記脚式移動装置の運動が前記第１の運動期間、第２の運動期間または第３の運動期間のいずれであるかを判定して、前記第１の制御手段、第２の制御手段および第３の制御手段の切り替え制御を行う切替制御手段と、を備えたことを特徴とする。
【００１９】
【発明の実施の形態】
以下、本発明の脚式移動装置の歩行・走行制御方法および脚式移動装置の歩行・走行制御装置の一実施の形態について、添付の図面を参照して詳細に説明する。なお、以下の説明において脚式移動装置として二足歩行・走行のロボットを例として説明するが、本発明は特にこれに限定されるものではなく、脚を用いて移動する装置であれば本発明の範疇であることは勿論である。
【００２０】
〔本実施の形態の概要〕
本実施の形態の脚式移動装置の歩行・走行制御方法は、同一の制御モデルを用いて脚式移動装置の歩行運動と走行運動とをモデル化することにより、制御モデル（制御手法）を切り替えることなくシームレスに脚式移動装置に運動を行わせるものである。すなわち、歩行運動でも走行運動でも同一の制御モデルを使用することにより、複雑な切り替え制御を行わないで済むようにしたものである。
【００２１】
ところで、歩行運動と走行運動を比較した場合、歩行運動は常に何れかの脚が床に接地している状態の移動運動であるが、走行運動は全ての脚が同時に床から離れている（浮いている）期間がある移動運動である。このため、従来の歩行運動の制御に使用しているＺＭＰ規範のみを適用して、歩行運動と走行運動との両方を制御可能な制御モデルを作成することは困難である。
【００２２】
このため、本実施の形態では、歩行運動制御と走行運動制御を同一の制御モデルで実現するために、歩行運動および走行運動中に制御パラメータを切り替えるようにしたものである。すなわち、走行運動におけるＺＭＰ規範が適用できない期間（全ての脚が床から離れている期間）に着目して、この期間をＺＭＰ規範に制約されない制御パラメータを使用して制御し、同時に歩行運動における前記ＺＭＰ規範が適用できない期間に対応する期間（後述する歩行運動での単脚支持期間に相当する）でも前記ＺＭＰ規範に制約されない制御パラメータを用いて制御する。
【００２３】
なお、本実施の形態では、脚式移動装置の運動状態を、脚式移動装置に推進力を与える蹴力発生期（本発明の第１の運動期間）と、脚式移動装置の空中姿勢および脚を用いた支持姿勢を目標状態に保つ姿勢制御期（本発明の第２の運動期間：上記ＺＭＰ規範が適用できない期間に相当）と、脚式移動装置が着地する際の衝撃を和らげる衝撃吸収期（本発明の第３の運動期間）との３つの運動期間に分けて定義し、脚式移動装置の運動状態がこの３つの運動期間の何れの期間に相当するかに基づいて、使用する制御パラメータを変えている。
【００２４】
さらに、本実施の形態では、歩行運動および走行運動中に制御パラメータを切り替えることによって歩行運動と走行運動とで同一の制御モデルを実現する一例として、脚式移動装置を三次元の一質点系飛行体として見做してモデル化するものである。
【００２５】
ここで、本実施の形態における脚式移動装置のモデル化の方法とその運動方程式について具体的に説明する。本実施の形態では、前述したように歩行運動と走行運動とで同一の制御モデルを用いるために、脚式移動装置を三次元の一質点系飛行体として見做してモデル化している。この際に、脚式移動装置の脚の運動によって発生するモーメントおよび力を質点本体に対する外乱として処理する。
【００２６】
図１は、脚式移動装置を一質点系飛行体モデル化する際の座標系の関係を示す説明図である。図において、１０１は脚式移動装置を示し、Ｏ−ＸＹＺは慣性空間における固定座標系を示し、Ｇ−ｘｙｚは脚式移動装置の重心Ｇに原点を持ち機体に固定された回転座標系を示している。
【００２７】
この回転座標系Ｇ−ｘｙｚに対して脚式移動装置１０１の重心Ｇの絶対速度ＶＧは、（１）式で表すことができ、脚式移動装置１０１に働く外力ＦＧは、（２）式で表すことができ、重心Ｇに働く外力モーメントＭＧは、（３）式で表すことができる。
【数１】
ここで、脚式移動装置１０１の質量をＭとした場合、機体の重心の運動方程式は回転座標系に対する換算式を用いて、（４）式に示すように表すことができる。さらに、（５）式および（６）式を用いて書き改めると（７）式〜（９）式を得ることができる。
【数２】
また、重心まわりの回転運動の運動方程式は、ｘｙｚの軸を慣性主軸と一致するように選べば、（１０）式〜（１２）式となる。なお、図１のＦは駆動点に掛かる力を示している。
【数３】
次に、脚式移動装置の位置と姿勢を求めるために、固定座標系Ｏ−ＸＹＺに対して回転座標系Ｇ−ｘｙｚの位置と角度を表すと（１３）式のようになる。なお、図２（ａ）〜（ｃ）は、機体の姿勢角度（θ、φ、ψ）を定義する説明図である。
【数４】
これによって固定座標系Ｏ−ＸＹＺと回転座標系Ｇ−ｘｙｚの間のオイラー角を定めることができる。また、脚式移動装置の位置とオイラー角の関係は（１４）式で求めることができる。さらに、ωとオイラー角との関係は（１５）式に示すようになり、これを積分することで、（１６）式の現在ｔの姿勢角度θ、φ、ψを得ることができる。
【数５】
ここで、外力について追記すると、外力は、脚式移動装置の駆動点にかかる力（脚からの力など）Ｆ（Ｆｘ、Ｆｙ、Ｆｚ）の他にも、Ｍｇがかかるので、（１７）式のように表すことができる。
【数６】
次に、図３（ａ）、（ｂ）および表１を参照して、本実施の形態において歩行運動および走行運動をどのように３つの運動期間に分けて制御するかについて具体的に説明する。本実施の形態では、図３に示すように、運動の機能に基づいて、歩行運動および走行運動を飛行体（脚式移動装置）に推進力を与える蹴力発生期、飛行姿勢を目標姿勢に保つ姿勢制御期および着地衝撃を和らげる衝撃吸収期の３つの運動期間に統一的に切り分けて制御する。
【００３４】
蹴力発生期の場合、歩行運動では、脚式移動装置の両脚が床面に接地しており、脚式移動装置は両脚で支持された状態で脚を用いて移動のための推進力を生成している。この期間は、走行運動のための初速度を準備する期間と定義することもできる。一方、走行運動では、すでに所定の並進移動速度（歩行から走行に切り替わる閾値となる速度）以上を脚式移動装置が有している状態であり、この所定の並進移動速度以上を維持して、かつ、飛距離を与えるように飛行体（脚式移動装置）を移動方向の上方へ射出している。この期間において、両方の運動とも脚式移動装置のエネルギーは増加する。
【００３５】
また、姿勢制御期の場合、歩行運動では、単脚で床面に接地しており、脚式移動装置は単脚で支持した状態で装置本体を移動方向へ移動させる。一方、走行運動では、蹴力発生期で射出されて、両脚が空中に浮いている状態であり、この空中での姿勢を目標状態（着地時の理想の状態）に保っている。この期間において、両方の運動とも脚式移動装置のエネルギーは保存されている。
【００３６】
衝撃吸収期の場合、運動によって前段の姿勢制御期の状態は異なるものの、両方の運動とも、蹴力発生期で生成した推進力によって移動方向へ投げ出された脚式移動装置の着地の衝撃を和らげる機能を果たしている。この期間において、両方の運動とも脚式移動装置のエネルギーは減少（損失）する。
【００３７】
次に、３つの運動期間で使用する制御パラメータについて説明する。本実施の形態では、運動を３つに切り分けているが、そのうちの蹴力発生期と衝撃吸収期では、制御パラメータとして、脚式移動装置の接地点から重心までのベクトルＰと、その時の重心速度ベクトルＶと、その時の重心加速度ベクトルＶ’（以下、式および図面中のＶポイントを明細書中で必要に応じてＶ’と記載する）とを用いる。
【００３８】
蹴力発生期において、上記３つの制御パラメータを用いることにより、歩行運動と走行運動をシームレスに切り分けることが可能である。具体的には、（１８）式、（１９）式に示すように制御パラメータを用いれば歩行／走行状態を判別／明示することができる。なお、本実施の形態において、各ベクトル（Ｐ、Ｖ、Ｖ’）の下添字ｋは蹴力発生期を示し、上添字ｏは目標値を示す。また、各ベクトル（Ｐ、Ｖ、Ｖ’）の下添字ｌは衝撃吸収期を示し、上添字ｉは初期値を示す。
【００３９】
【数７】
一方、姿勢制御期では、姿勢を制御するために、脚式移動装置の角運動量ＨＧ および運動量ＭｖＧの２つを制御パラメータとして用いる。
【００４１】
次に、蹴力発生期において目標となるＰ，Ｖベクトルで射出された後の脚式移動装置１０１の飛距離と浮遊時間の関係を導出する。浮遊時間ＴＡＰは、（２０）式に示すように、射出ベクトル垂直成分との関係によって一意に決定される。同様に飛距離は、（２１）式に示すように、浮遊時間ＴＡＰと射出ベクトル水平成分によって決定される。この飛距離が歩行／走行系でいう一歩の歩幅となる。
【００４２】
【数８】
ここで、本実施の形態の脚式移動装置の歩行・走行制御方法による３つの運動期間と歩行／走行運動の切り分けおよび機能を纏めて表１に示す。
【表１】
〔本実施の形態の歩行・走行制御装置〕
図４は、本実施の形態の歩行・走行制御装置２００を適用した脚式移動装置１０１の全体構成図を示す。なお、ここでは、説明を分かりやすくするために歩行・走行制御装置２００と制御対象となる脚式移動装置１０１とを分けて図示するが、特に限定するものではなく、必要に応じて脚式移動装置１０１内に搭載することも別装置として構成することも可能である。
【００４５】
歩行・走行制御装置２００は、脚式移動装置１０１の並進移動速度を検出する速度検出センサー２０１と、速度検出センサー２０１から並進移動速度を入力して、その時の運動に最適な脚式移動装置１０１の接地点から重心までの重心位置ベクトルＰ、その時の重心速度ベクトルＶおよびその時の重心加速度ベクトルＶ’を生成して出力するベクトル生成手段としてのオプティマイザー２０３と、脚式移動装置１０１の２つの脚の接地状態を検出する接地検出センサー２０２と、脚式移動装置１０１の角運動量ＨＧを検出する角運動量検出手段および脚式移動装置１０１の運動量ＭｖＧを検出する運動量検出手段として機能するセンサー群２０４と、速度検出センサー２０１および接地検出センサー２０２の検出結果に基づいて、脚式移動装置１０１の脚の接地状態が２脚の接地状態から１脚の接地状態へ移行する期間または１脚の接地状態から接地なしの状態へ移行する期間で、かつ、脚式移動装置１０１の並進移動速度が増加する期間を蹴力発生期として、オプティマイザー２０３で生成された重心位置ベクトルＰ、重心速度ベクトルＶおよび重心加速度ベクトルＶ’の３つを制御パラメータとして入力し、蹴力発生期における脚式移動装置１０１の初期姿勢状態から蹴力発生期の最終目標姿勢状態を生成して、最終目標姿勢状態へ遷移させる制御を行う第１の制御手段としてのＰＶＶ’コントローラ２０５と、接地検出センサー２０２の検出結果に基づいて、脚式移動装置１０１の脚の接地状態が１脚の接地状態から２脚の接地状態へ移行する期間または接地なしの状態から１脚の接地状態へ移行する期間を姿勢制御期として、蹴力発生期における脚式移動装置１０１の最終目標姿勢状態を初期姿勢状態として、センサー群２０４から脚式移動装置１０１の角運動量ＨＧおよび運動量ＭｖＧの２つを制御パラメータとして入力し、角運動量ＨＧおよび運動量ＭｖＧから姿勢制御期の制御目標となる角運動量および運動量を生成し、生成した角運動量および運動量へ遷移させる制御を行う第２の制御手段としての角運動量コントローラ２０６と、速度検出センサー２０１および接地検出センサー２０２の検出結果に基づいて、脚式移動装置１０１の脚の接地状態が２脚の接地状態または１脚の接地状態である期間で、かつ、脚式移動装置１０１の並進移動速度を低下させる期間を衝撃吸収期として、姿勢制御期における脚式移動装置１０１の最終姿勢状態を初期姿勢状態として、その時の重心位置ベクトルＰ、その時の重心速度ベクトルＶおよびその時の重心加速度ベクトルＶ’の３つを制御パラメータとして用い、初期姿勢状態から衝撃吸収期の最終目標姿勢状態を生成し、最終目標姿勢状態へ遷移させる制御を行う第３の制御手段としてのコンプライアンスコントローラ２０７と、脚式移動装置１０１の運動状態に基づいて、脚式移動装置１０１の運動が蹴力発生期、姿勢制御期または衝撃吸収期のいずれであるかを判定して、ＰＶＶ’コントローラ２０５、角運動量コントローラ２０６およびコンプライアンスコントローラ２０７の切り替え制御を行う切替制御手段としての状態監視部２０８と、を備えている。
【００４６】
すなわち、オプティマイザー２０３は、脚式移動装置１０１の並進移動速度υＧＨを与えられ、その運動に適切な重心位置ベクトルＰ、重心速度ベクトルＶおよび重心加速度ベクトルＶ’を出力する。
【００４７】
また、モーションジェネレータは、ＰＶＶ’コントローラ２０５、角運動量コントローラ２０６およびコンプライアンスコントローラ２０７の３つの制御則から構成され、状況に応じて状態監視部２０８により切り替えられる。
【００４８】
また、脚式移動装置１０１は、歩行、走行両方を行うことができるロボットハードウェアおよび様々なセンサーを搭載している。
【００４９】
さらに、状態監視部２０８は、脚式移動装置１０１の状態を絶えず監視して、条件により、モーションジェネレータ内のＰＶＶ’コントローラ２０５、角運動量コントローラ２０６およびコンプライアンスコントローラ２０７を切り替える信号（Ｅｎａｂｌｅ／Ｄｉｓａｂｌｅ Ｉｎｆｏｒｍａｔｉｏｎ）を出力する。
【００５０】
次に、図５〜図９を参照して、ＰＶＶ’コントローラ２０５、角運動量コントローラ２０６およびコンプライアンスコントローラ２０７のそれぞれの制御則について詳細に説明する。
【００５１】
図５は、ＰＶＶ’コントローラ２０５の制御則の概略ブロック図を示す。ＰＶＶ’コントローラ２０５は、蹴力発生期の運動制御を担っており、その機能は、オプティマイザー２０３からベクトルＰ、Ｖ、Ｖ’を入力して、（２２）式で示す初期姿勢状態から（２３）式で示す目標となる射出状態へ遷移させるものである。
また、図５の制御則における誤差拡散方程式は、（２４）式のようになり、この式に基づいて、安定になるようにＫｖ、Ｋｐを選べば良いことになる。
【００５２】
【数９】
角運動量コントローラ２０６は、蹴力発生期での射出時の姿勢を初期状態とし、巻き込み関数および最終目標姿勢に従って軌道を生成し、姿勢制御を行う。
ここで、ポイントを列挙すると、まず、着地するべき脚を目標着地体制になるように位置制御する。このとき巻き込み関数ε（υＧＨ，τ）に従う。
巻き込み関数ε（υＧＨ，τ）の運動によって発生した並進力（（２５）式参照）およびモーメント（（２６）式参照）のカウンターバランシングを行い、その差などにより姿勢を目標姿勢に制御する。
【数１０】
ここで、図６のロボットモデルを参照して、カウンターバランシングの方法の一例を示す。上記発生したモーメントに対しては、左右の腕を鉛直軸鏡関係で駆動して疑似リアクションホールとして利用し、腰の回転コリオリ力を利用してカウンター用モーメント（（２７）式参照）を発生させる。また、着地しない側の脚では巻き込み関数ε（υＧＨ，τ）により発生した並進力に対するカウンターバランシングのための力（（２８）式参照）を発生させる。
【数１１】
この時の角運動量ＨＧおよび運動量ＭｖＧは、（２９）式〜（３１）式で表される。
【数１２】
角運動量コントローラ２０６の制御則としては、（２９）式に従って以下のものを実現する。
脚式移動装置の角運動量ＨＧ→制御目標角運動量ＨＧ Ｏ
脚式移動装置の運動量ＭｖＧ→制御目標運動量ＭｖＧ Ｏ
【００５７】
また、角運動量コントローラ２０６は、同時に姿勢制御期間（浮遊時間ＴＡＰと同じ）で（３２）式を達成するように制御する。なお、（θＯ，φＯ，ψＯ）は目標姿勢角度を示す。従って、これらの制御則をブロック図で表すと図７に示すようになる。
【数１３】
次に、コンプライアンスコントローラ２０７による衝撃吸収期の制御則について説明する。衝撃吸収期では、着地によって角運動量が不連続にならないように図８に示すような仮想のコンプライアンス系を用いてエネルギーの吸収を行う。すなわち、コンプライアンスコントローラ２０７は、着地姿勢状態（（３３）式参照）から与えられた目標の状態（（３４）式参照）へ遷移させる制御を行う。具体的には、例えば、インピーダンス制御を用いて、（３５）式に従って系を制御する。
【００５９】
【数１４】
コンプライアンスコントローラ２０７の制御則をブロック図で示すと図９のようになる。ただし、（３５）式中のＤ，Ｋ（（３６）式参照）は以下の方法によって求められる。まず、吸収すべきエネルギーＥδは（３７）式で求めることができる。
【数１５】
この任意のエネルギーを失わせるには、（３８）式に従って仮想のインピーダンスを求めればよいことになる。
【数１６】
以上の構成において、図１０および図１１を参照して、その動作を説明する。図１０は本実施の形態の歩行・走行制御装置２００の歩行・走行制御フローチャートを示し、図１１は、脚式移動装置１０１が停止状態（立ち止まっている状態）から歩行運動を開始して、徐々に速度を上げて、並進移動速度が所定の閾値を超えて、走行運動へ移行し、さらに走行運動から並進移動速度を落として歩行運動へ移行する状態を示す説明図である。
【００６３】
まず、脚式移動装置１０１が停止状態から脚を踏み出して移動を開始すると、速度検出センサー２０１によって並進移動速度υＧＨが検出され、オプティマイザー２０３に並進移動速度が与えられる（Ｓ３０１）。
【００６４】
オプティマイザー２０３は並進移動速度υＧＨから最適な重心位置ベクトルＰ、重心速度ベクトルＶおよびその時の重心加速度ベクトルＶ’を算出する（Ｓ３０２）。このとき、状態監視部２０８は脚式移動装置１０１の動作状態を監視しており、そのときの条件からモードセレクターを切り替える。ここでは、停止状態から歩行を開始したので、蹴力発生期に移行すべく、ＰＶＶ’コントローラ２０５へＥｎａｂｌｅ信号を出力する（他のコントローラはＤｉｓａｂｌｅとなる）。なお、次回からは前段の処理（運動期間）に基づいて、蹴力発生期→姿勢制御期→衝撃吸収期→蹴力発生期→姿勢制御期，，，と運動期間が移行するように切り替える。これによって、制御パラメータが切り替えられたことになる。
【００６５】
ＰＶＶ’コントローラ２０５は、オプティマイザー２０３で生成された重心位置ベクトルＰ、重心速度ベクトルＶおよび重心加速度ベクトルＶ’の３つを制御パラメータとして入力し、蹴力発生期における脚式移動装置１０１の初期姿勢状態（衝撃吸収期の着地終了状態と一致）から蹴力発生期の最終目標姿勢状態を生成して、最終目標姿勢状態へ遷移させる（Ｓ３０３）。
【００６６】
次に、センサー群２０４からの検出信号によって重心回りの角運動量ＨＧ（ここでは、蹴力発生期の終了時の角運動量ＨＧｋ）が検出されると（Ｓ３０４）、状態監視部２０８は姿勢制御期に移行すべく、角運動量コントローラ２０６へ制御を切り替える。
【００６７】
角運動量コントローラ２０６は、重心回りの運動量ＭｖＧおよび角運動量ＨＧが目標値に収束するように脚式移動装置１０１の関節の力制御を行い、各関節の軌道を生成する。また遊脚の軌道は巻き込み関数ε（υＧＨ，τ）に従う（Ｓ３０５）。このとき、オプティマイザー２０３は、次段の衝撃吸収期で使用するために重心位置ベクトルＰ、重心速度ベクトルＶを最新の状態に更新する（Ｓ３０６）。その後、着地衝撃を検知するまで（Ｓ３０７）、Ｓ３０５、Ｓ３０６を繰り返す。
【００６８】
Ｓ３０７で着地衝撃を検知すると、オプティマイザー２０３の最新のデータ（着地直前の重心位置ベクトルＰ、重心速度ベクトルＶ）から吸収すべきエネルギーを算出し（Ｓ３０８）、続いて、コンプライアンスコントローラ２０７が、衝撃吸収後に残る速度ベクトルＶを算出し（Ｓ３０９）、算出した速度ベクトルＶから蹴力発生期に遷移するために必要な重心位置ベクトルＰを算出し（Ｓ３１０）、インピーダンス制御（コンプライアンス制御）により着地直前の重心位置ベクトルＰ、重心速度ベクトルＶから目標着地終了状態を実現する（Ｓ３１１）。
【００６９】
衝撃吸収期におけるエネルギーの吸収（損失）によって並進移動速度が「０」になったか否か判定し（Ｓ３１２）、「０」でなければ、すなわち、脚式移動装置１０１が歩行または走行運動の状態であれば、Ｓ３０１へ戻って同様の処理を繰り返す。
【００７０】
以上の処理から、図１１（ａ）に示すように、停止状態から歩行運動を開始し、図１１（ｂ）に示すように、並進移動速度が徐々に大きくなって予め設定されている閾値を超えると、運動の状態は歩行運動から走行運動へ移行する。このとき、図１１（ｄ）に示すように、制御モデルは歩行運動と走行運動で同一の制御モデルが使用される。一方、運動期間は、図１１（ｃ）に示すように、蹴力発生期→姿勢制御期→衝撃吸収期→蹴力発生期→姿勢制御期，，，，と順番に切り替えられる。これによって運動期間に応じて制御パラメータが切り替えられることになる。
【００７１】
同様に走行運動から歩行運動へ移行する場合にも、運動期間に応じて制御パラメータを切り替えることで、同一の制御モデルを使用して制御を行うことができる。換言すれば、歩行運動制御と走行運動制御を切り替えるための複雑な制御を行うことなく、歩行運動と走行運動とを連続的に実現して、立ち止まっている状態から歩き出して徐々に速度アップ走行にいたり、また止まるという動作を実現することができる。
【００７２】
【発明の効果】
以上説明したように、本発明の脚式移動装置の歩行・走行制御方法および脚式移動装置の歩行・走行制御装置によれば、歩行運動と走行運動とを同一の制御モデルを用いてモデル化し、該制御モデルで使用する制御パラメータを切り替えることによって、歩行運動制御と走行運動制御を制御するので、制御パラメータの切り替えのみで、歩行運動と走行運動とを制御することができる。換言すれば、歩行運動制御と走行運動制御を切り替えるための複雑な制御を行うことなく、歩行運動と走行運動とを連続的に実現して、立ち止まっている状態から歩き出して徐々に速度アップ走行にいたり、また止まるという動作が可能である。
【図面の簡単な説明】
【図１】本実施の形態において脚式移動装置を一質点系飛行体モデル化する際の座標系の関係を示す説明図である。
【図２】機体（脚式移動装置）の姿勢角度を定義する説明図である。
【図３】本実施の形態において歩行運動および走行運動をどのように３つの運動期間に分けて制御するかを示す説明図である。
【図４】本実施の形態の歩行・走行制御装置を適用した脚式移動装置の全体構成図である。
【図５】本実施の形態のＰＶＶ’コントローラの制御則の概略ブロック図である。
【図６】カウンターバランシングの方法の一例を示す説明図である。
【図７】本実施の形態の角運動量コントローラの制御則の概略ブロック図である。
【図８】衝撃吸収期の仮想のコンプライアンス系を示す説明図である。
【図９】本実施の形態のコンプライアンスコントローラの制御則の概略ブロック図である。
【図１０】本実施の形態の歩行・走行制御フローチャートである。
【図１１】本実施の形態において、歩行運動から走行運動への移行および走行運動から歩行運動への移行時における制御モデルとその時の運動期間の状態を示す説明図である。
【符号の説明】
１０１ 脚式移動装置
２００ 歩行・走行制御装置
２０１ 速度検出センサー
２０２ 接地検出センサー
２０３ オプティマイザー
２０４ センサー群
２０５ ＰＶＶ’コントローラ
２０６ 角運動量コントローラ
２０７ コンプライアンスコントローラ
２０８ 状態監視部[0001]
TECHNICAL FIELD OF THE INVENTION
BACKGROUND OF THE
[0002]
[Prior art]
2. Description of the Related Art In recent years, research on devices that move using legs (hereinafter, referred to as leg-type moving devices) has made great strides. Generally, a leg-type moving device has a plurality of legs provided at a lower portion of the device main body for supporting the device main body and applying a propulsive force to the device main body to move the device main body. Specific examples of the legged moving device include, for example, a humanoid robot having two legs, a device having four legs provided at the lower part of the device main body, and the like.
[0003]
Further, as a conventional leg-type moving device, for example, as disclosed in Japanese Patent Application Laid-Open No. 2001-129775 “Robot and a method of controlling the center of gravity of the robot”, an upright walking type body mechanism such as a human or a monkey can be used. Provided is an upright walking / legged mobile robot that can set a suitable center of gravity position in a walking motion, or a whole body cooperative motion including the trunk and upper limbs, etc., in a legged mobile robot having a structure imitating movement. Have been.
[0004]
In such a conventional legged moving device, walking control is performed based on the ZMP (Zero MomentPoint: point at which the moment of the total inertial force becomes zero). That is, the walking motion of the legged mobile device is realized by controlling the point on the floor where the moment due to the floor reaction force when the legged mobile device walks to zero becomes equal to the target value. .
[0005]
On the other hand, in addition to a legged moving device capable of walking movement, a legged moving device that realizes running movement has also been provided. Here, the running motion refers to a moving motion in which there is a period in which both legs are simultaneously separated (floating) from the floor in the movement of the legged moving device. In a walking exercise, one of the legs of the leg-type moving device is always in contact with the floor, so the above-described ZMP standard can be applied. Because the norms cannot be applied, they are treated as completely different from walking.
[0006]
Therefore, the control model and various formulas in the respective controls are different between the walking motion and the running motion. Therefore, when the walking motion and the running motion are continuously performed by one legged moving device, the walking motion and the running motion are different. It was necessary to switch the control model and various formulas between and during running exercise.
[0007]
[Problems to be solved by the invention]
However, according to the above-described conventional technique, the walking motion and the running motion of the legged moving device are regarded as different motions, and the walking control and the running control are performed by different control methods. When a walking device and a running motion are performed by a moving device, the problem is that complicated control is required due to the separation of the movement, and the separation causes the continuity of the movement to be impaired. However, there is a problem that it is not possible to shift from a running state to a walking state.
[0008]
The present invention has been made in view of the above, and realizes a walking motion and a running motion continuously without performing complicated control for switching between the walking motion control and the running motion control, and stops. It is an object of the present invention to enable an operation of walking out of a state to gradually increase speed and stop again.
[0009]
[Means for Solving the Problems]
In order to achieve the above object, a method for controlling walking and running of a legged moving device according to
[0010]
According to the present invention, the walking motion and the running motion are modeled using the same control model, and the walking motion control and the running motion control are controlled by switching the control parameters used in the control model. The walking motion and the running motion are controlled only by switching. In other words, the walking motion and the running motion are continuously realized without performing complicated control.
[0011]
Further, a walking / running control method for a legged moving device according to claim 2 is the walking / running control method for a legged moving device according to
[0012]
Further, a method of controlling walking and running of a legged moving device according to claim 3 is the method of controlling walking and running of a legged moving device according to
[0013]
Further, the walking / running control method of the legged moving device according to claim 4 is the walking / running control method of the legged moving device according to claim 3, wherein the control model is in the first exercise period, The present invention is characterized in that three parameters of a center-of-gravity position vector from the ground contact point to the center of gravity of the legged moving device, a center-of-gravity velocity vector at that time, and a center-of-gravity acceleration vector at that time are used as control parameters.
[0014]
Further, the walking / running control method for a legged mobile device according to
[0015]
Further, the walking / running control method of the legged moving device according to
[0016]
Further, a walking / running control method for a legged moving device according to claim 7 is the walking / running control method for a legged moving device according to any one of claims 3 to 6, wherein the control model is In the third exercise period, the final posture state of the legged moving device during the second exercise period is used as an initial posture state, and a center-of-gravity position vector from the ground point to the center of gravity of the legged moving device, It is characterized in that three of a center-of-gravity velocity vector and a center-of-gravity acceleration vector at that time are used as control parameters.
[0017]
The walking / running control device for a legged moving device according to claim 8 is a walking / running control device for a legged moving device that controls a walking motion and a running motion of the legged moving device. Is generated by inputting the translational movement speed of the above, and generating and outputting the center of gravity position vector from the contact point to the center of gravity, the center of gravity velocity vector and the center of gravity acceleration vector at that time, which are optimal for the movement at that time. Means for controlling three of the center-of-gravity position vector, the center-of-gravity velocity vector, and the center-of-gravity acceleration vector generated by the vector generating means during a first exercise period in which the leg type moving device generates a propulsive force using a leg. Inputting the parameter as a parameter, generating a final target posture state in the first exercise period from the initial posture state of the legged moving device in the first exercise period, A first control unit for performing a control for transitioning to a final target posture state, and a second exercise period for maintaining an aerial posture of the legged moving device or a supporting posture using a leg in the target state, the first exercise period The final target posture state of the legged moving device in the above is set as an initial posture state, and two of the angular momentum and the momentum of the legged moving device are input as control parameters, and the angular momentum and the momentum are used for the second exercise period. Second control means for generating an angular momentum and a momentum to be control targets and performing control for transition to the generated angular momentum and the momentum; and a third motion for relieving an impact when the legs of the legged moving device touch the ground. In the period, the final posture state of the legged moving device in the second exercise period is set as an initial posture state, and the center of gravity position vector at that time, the center of gravity velocity vector at that time, and the like. And a third control for generating a final target posture state in the third exercise period from the initial posture state and transitioning to the final target posture state by using three of the center-of-gravity acceleration vectors at that time as control parameters. Means, and switching control means for switching to the first control means, the second control means, or the third control means based on the motion state of the legged moving device.
[0018]
The walking / running control device for a legged moving device according to claim 9 is a walking / running control device for a legged moving device that controls a walking motion and a running motion of the legged moving device. Speed detecting means for detecting the translational movement speed of the robot, and a translational speed input from the speed detection means, and a center-of-gravity position vector from the contact point to the center of gravity of the legged moving device optimal for the movement at that time, the center of gravity at that time Vector generating means for generating and outputting a velocity vector and a centroid acceleration vector at that time, ground detecting means for detecting a ground state of two legs of the legged moving device, and detecting angular momentum of the legged moving device Angular momentum detecting means, momentum detecting means for detecting the momentum of the legged moving device, and contacting of the legs of the legged moving device based on the detection results of the speed detecting means and the contact detecting means. A period in which the state transitions from the two-leg contact state to the one-leg contact state or a period in which the one-leg contact state transitions to the no-contact state, and a period in which the translational movement speed of the legged moving device increases. As the first exercise period, three of the center-of-gravity position vector, the center-of-gravity velocity vector, and the center-of-gravity acceleration vector generated by the vector generation means are input as control parameters, and the legged moving device during the first exercise period A first control unit configured to generate a final target posture state in the first exercise period from the initial posture state and perform control for transitioning to the final target posture state; and A second exercise period is a period during which the ground contact state of the leg of the leg-type moving device shifts from a ground contact state of one leg to a ground contact state of two legs, or a period of transition from a state without ground contact to a ground contact state of one leg. Then, the final target posture state of the legged moving device during the first exercise period is set as an initial posture state, and the angular momentum detecting means and the momentum detecting means determine two of the angular momentum and the momentum of the legged moving device. Second control means for inputting as a control parameter, generating an angular momentum and a momentum to be a control target of the second exercise period from the angular momentum and the momentum, and performing a control to make a transition to the generated angular momentum and the momentum; Based on the detection results of the speed detecting means and the contact detecting means, during a period in which the contact state of the legs of the leg-type moving device is a contact state of two legs or a contact state of one leg, and The period during which the translational movement speed is reduced is defined as a third exercise period, and the final posture state of the legged moving device during the second exercise period is defined as an initial posture state. Using a center position vector, a center-of-gravity velocity vector at that time, and a center-of-gravity acceleration vector at that time as control parameters, a final target posture state of the third exercise period is generated from the initial posture state, and the state is changed to the final target posture state. A third control unit for performing transition control, and wherein the motion of the legged moving device is performed in the first motion period, the second motion period, or the third motion period based on a motion state of the legged motion device. And switching control means for performing switching control of the first control means, the second control means, and the third control means.
[0019]
BEST MODE FOR CARRYING OUT THE INVENTION
Hereinafter, an embodiment of a walking / running control method for a legged mobile device and a walking / running control device for a legged mobile device according to the present invention will be described in detail with reference to the accompanying drawings. In the following description, a bipedal walking / running robot will be described as an example of a legged moving device. However, the present invention is not particularly limited to this. Of course.
[0020]
[Outline of the present embodiment]
The walking / running control method of the legged mobile device according to the present embodiment switches the control model (control method) by modeling the walking motion and the running motion of the legged mobile device using the same control model. This allows the legged mobile device to exercise seamlessly without any exercise. That is, by using the same control model for both the walking motion and the running motion, complicated switching control is not required.
[0021]
By the way, when the walking movement and the running movement are compared, the walking movement is a moving movement in which one of the legs is always in contact with the floor, but in the running movement, all the legs are simultaneously separated from the floor (the floating movement). Is a locomotion with a period. For this reason, it is difficult to create a control model that can control both the walking motion and the running motion by applying only the ZMP standard used for controlling the conventional walking motion.
[0022]
Therefore, in the present embodiment, the control parameters are switched during the walking motion and the running motion in order to realize the walking motion control and the running motion control with the same control model. That is, paying attention to a period in which the ZMP norm in the running motion cannot be applied (a period in which all the legs are separated from the floor), this period is controlled using control parameters not restricted by the ZMP norm, and Even during a period corresponding to a period during which the ZMP standard cannot be applied (corresponding to a single leg support period in a walking motion described later), control is performed using control parameters that are not restricted by the ZMP standard.
[0023]
In the present embodiment, the motion state of the legged moving device is defined as a kicking force generation period (first exercise period of the present invention) for applying a propulsive force to the legged moving device, an aerial posture of the legged moving device, and A posture control period (second exercise period of the present invention: corresponding to a period during which the ZMP standard cannot be applied) in which the supporting posture using the legs is maintained in the target state, and shock absorption for reducing the impact when the legged moving device lands. Period (third exercise period of the present invention) and is defined based on three exercise periods, and is used based on which of the three exercise periods the exercise state of the legged mobile device corresponds to. Changing control parameters.
[0024]
Further, in the present embodiment, as an example of realizing the same control model for the walking motion and the running motion by switching the control parameters during the walking motion and the running motion, a three-dimensional one-mass system flight It is modeled as a body.
[0025]
Here, a method of modeling the legged moving device and an equation of motion thereof in the present embodiment will be specifically described. In the present embodiment, as described above, in order to use the same control model for the walking motion and the running motion, the legged moving device is modeled as a three-dimensional one-mass-point flying object. At this time, the moment and the force generated by the movement of the leg of the leg type moving device are processed as disturbance to the mass body.
[0026]
FIG. 1 is an explanatory diagram showing a coordinate system relationship when a legged mobile device is modeled as a one-mass-point vehicle. In the figure, 101 indicates a leg-type moving device, O-XYZ indicates a fixed coordinate system in inertial space, and G-xyz indicates a rotating coordinate system having an origin at the center of gravity G of the leg-type moving device and fixed to the body. ing.
[0027]
The absolute velocity V of the center of gravity G of the legged moving
(Equation 1)
Here, assuming that the mass of the legged moving
(Equation 2)
Further, the equations of motion of the rotational motion around the center of gravity are expressed by equations (10) to (12) if the xyz axis is selected so as to coincide with the principal axis of inertia. In addition, F of FIG. 1 has shown the force applied to a drive point.
(Equation 3)
Next, in order to obtain the position and orientation of the legged moving device, the position and angle of the rotating coordinate system G-xyz with respect to the fixed coordinate system O-XYZ are expressed by Expression (13). 2A to 2C are explanatory diagrams that define the attitude angles (θ, φ, ψ) of the body.
(Equation 4)
Thus, an Euler angle between the fixed coordinate system O-XYZ and the rotating coordinate system G-xyz can be determined. Further, the relationship between the position of the legged moving device and the Euler angle can be obtained by equation (14). Further, the relationship between ω and the Euler angle is as shown in Expression (15), and by integrating this, the posture angles θ, φ, and の at the current t in Expression (16) can be obtained.
(Equation 5)
Here, when the external force is additionally described, the external force is a force (eg, a force from a leg) applied to a driving point of the leg type moving device F (Fx, Fy, Fz) Other than Mg, it can be expressed as in equation (17).
(Equation 6)
Next, with reference to FIGS. 3A and 3B and Table 1, how the walking exercise and the running exercise are controlled in three exercise periods in the present embodiment will be specifically described. . In the present embodiment, as shown in FIG. 3, based on the function of the movement, the walking movement and the running movement are performed in a kicking force generation period in which a propulsive force is applied to the flying object (leg type moving device), and the flying posture is set to the target posture. Control is performed by uniformly dividing into three exercise periods of a posture control period to be maintained and a shock absorption period to reduce landing impact.
[0034]
In the period of kicking force, in the walking motion, both legs of the legged moving device are in contact with the floor, and the legged moving device generates the propulsion force for movement using the legs while supported by both legs are doing. This period can also be defined as the period of preparing the initial speed for the running movement. On the other hand, in the running motion, the legged moving device has a predetermined translational movement speed (a speed that is a threshold value for switching from walking to running) or more, and maintains the predetermined translational movement speed or more. In addition, the flying object (leg type moving device) is ejected upward in the moving direction so as to give a flight distance. During this period, both exercises increase the energy of the legged mobile device.
[0035]
Further, in the posture control period, in the walking motion, in a walking motion, a single leg is in contact with the floor surface, and the leg type moving device moves the device main body in the moving direction while being supported by the single leg. On the other hand, in the running motion, the foot is ejected during the kicking force generation period and both legs are floating in the air, and the posture in the air is maintained in the target state (the ideal state at the time of landing). During this period, the energy of the legged mobile device is preserved for both exercises.
[0036]
In the case of the shock absorption period, although the state of the preceding posture control period differs depending on the movement, both movements reduce the impact of the landing of the leg type mobile device thrown in the direction of movement by the propulsion generated in the kicking force generation period Plays a function. During this period, the energy of the legged mobile device is reduced (lost) for both exercises.
[0037]
Next, control parameters used in the three exercise periods will be described. In the present embodiment, the motion is divided into three. In the kicking period and the shock absorbing period, the vector P from the contact point of the leg type moving device to the center of gravity and the center of gravity at that time are used as control parameters. The velocity vector V and the centroid acceleration vector V 'at that time (hereinafter, the V point in the expression and the drawing is described as V' in the specification as needed) are used.
[0038]
In the kicking force generation period, it is possible to seamlessly separate the walking motion and the running motion by using the above three control parameters. Specifically, as shown in the equations (18) and (19), it is possible to determine / specify the walking / running state by using the control parameters. In the present embodiment, the lower suffix k of each vector (P, V, V ') indicates a kicking force generation period, and the upper suffix o indicates a target value. Further, the lower suffix l of each vector (P, V, V ') indicates the shock absorption period, and the upper suffix i indicates the initial value.
[0039]
(Equation 7)
On the other hand, in the posture control period, the angular momentum H of the leg-type moving device is used to control the posture.GAnd momentum MvGAre used as control parameters.
[0041]
Next, the relationship between the flight distance and the floating time of the legged moving
[0042]
(Equation 8)
Table 1 summarizes three exercise periods, walking / running exercise separation, and functions according to the walking / running control method of the legged mobile device of the present embodiment.
[Table 1]
[Walking / running control device of the present embodiment]
FIG. 4 is an overall configuration diagram of a legged moving
[0045]
The walking / running
[0046]
That is, the
[0047]
The motion generator includes three control rules of a PVV '
[0048]
The legged moving
[0049]
Further, the
[0050]
Next, the control rules of the PVV '
[0051]
FIG. 5 is a schematic block diagram of a control law of the PVV '
The error diffusion equation in the control law of FIG. 5 is as shown in equation (24).v, KpWould be a good choice.
[0052]
(Equation 9)
The
Here, when the points are enumerated, first, the positions of the legs to be landed are controlled so as to achieve the target landing system. At this time, the convolution function ε (υGH, Τ).
Convolution function ε (υGH, Τ), the translational force (see equation (25)) and the moment (see equation (26)) generated by the motion are counterbalanced, and the attitude is controlled to the target attitude based on the difference or the like.
(Equation 10)
Here, an example of a counter balancing method will be described with reference to the robot model of FIG. With respect to the generated moment, the left and right arms are driven in relation to a vertical axis mirror and used as a pseudo reaction hole, and a counter moment (see equation (27)) is generated using the rotational Coriolis force of the waist. . In addition, on the leg on the non-landing side, the winding function ε (υGH, Τ) to generate a force (see equation (28)) for counterbalancing the translation force generated.
[Equation 11]
Angular momentum H at this timeGAnd momentum MvGIs represented by equations (29) to (31).
(Equation 12)
The following is realized as a control rule of the
Angular momentum H of a leg type moving deviceG→ Control target angular momentum HG O
Momentum Mv of the leg type moving deviceG→ Control target momentum MvG O
[0057]
Further, the
(Equation 13)
Next, the control law of the shock absorption period by the
[0059]
[Equation 14]
FIG. 9 is a block diagram showing the control rules of the
[Equation 15]
In order to lose this arbitrary energy, a virtual impedance may be obtained according to the equation (38).
(Equation 16)
The operation of the above configuration will be described with reference to FIGS. FIG. 10 shows a walking / running control flowchart of the walking / running
[0063]
First, when the leg-
[0064]
The
[0065]
The PVV ′
[0066]
Next, based on a detection signal from the
[0067]
The
[0068]
When the landing impact is detected in S307, the energy to be absorbed is calculated from the latest data of the optimizer 203 (the center-of-gravity position vector P and the center-of-gravity velocity vector V immediately before landing) (S308). A velocity vector V remaining after the absorption is calculated (S309), and a center-of-gravity position vector P required for transition to the kicking force generation period is calculated from the calculated velocity vector V (S310), and immediately before landing by impedance control (compliance control). The target landing end state is realized from the center-of-gravity position vector P and the center-of-gravity velocity vector V (S311).
[0069]
It is determined whether or not the translational movement speed has become “0” due to energy absorption (loss) during the shock absorption period (S312). If not, that is, if the legged moving
[0070]
From the above processing, as shown in FIG. 11A, the walking motion is started from the stop state, and as shown in FIG. Beyond that, the state of exercise shifts from walking to running. At this time, as shown in FIG. 11D, the same control model is used for the walking motion and the running motion. On the other hand, as shown in FIG. 11C, the exercise period is switched in the order of kicking force period → posture control period → shock absorption period → kicking force generation period → posture control period,. As a result, the control parameters are switched according to the exercise period.
[0071]
Similarly, also in the case of shifting from running exercise to walking exercise, control can be performed using the same control model by switching control parameters according to the exercise period. In other words, without performing complicated control for switching between the walking motion control and the running motion control, the walking motion and the running motion are continuously realized, and the vehicle starts walking from a stopped state and gradually increases in speed. It is possible to realize an operation of entering and stopping again.
[0072]
【The invention's effect】
As described above, according to the walking / running control method of the legged mobile device and the walking / running control device of the legged mobile device of the present invention, the walking motion and the running motion are modeled using the same control model. Since the walking motion control and the running motion control are controlled by switching the control parameters used in the control model, the walking motion and the running motion can be controlled only by switching the control parameters. In other words, without performing complicated control for switching between the walking motion control and the running motion control, the walking motion and the running motion are continuously realized, and the vehicle starts walking from a stopped state and gradually increases in speed. It is possible to go on and off again.
[Brief description of the drawings]
FIG. 1 is an explanatory diagram showing a relationship of a coordinate system when a legged mobile device is modeled into a one-mass-point vehicle in this embodiment.
FIG. 2 is an explanatory diagram that defines an attitude angle of a body (leg type moving device).
FIG. 3 is an explanatory diagram showing how to control a walking exercise and a running exercise in three exercise periods in the present embodiment.
FIG. 4 is an overall configuration diagram of a legged moving device to which the walking / running control device of the present embodiment is applied.
FIG. 5 is a schematic block diagram of a control law of a PVV 'controller according to the present embodiment.
FIG. 6 is an explanatory diagram showing an example of a counter balancing method.
FIG. 7 is a schematic block diagram of a control law of the angular momentum controller of the present embodiment.
FIG. 8 is an explanatory diagram showing a virtual compliance system in a shock absorption period.
FIG. 9 is a schematic block diagram of a control law of a compliance controller according to the present embodiment.
FIG. 10 is a flowchart of walking / running control according to the present embodiment.
FIG. 11 is an explanatory diagram showing a control model and a state of an exercise period at the time of a transition from a walking exercise to a running exercise and a transition from a traveling exercise to a walking exercise in the present embodiment.
[Explanation of symbols]
101 leg type moving device
200mm walking / running control device
201 speed detection sensor
202 ground detection sensor
203 Optimizer
204 sensor group
205 "PVV" controller
206 ° angular momentum controller
207 compliance controller
208 Condition monitoring unit
Claims (9)
前記脚式移動装置の歩行運動と走行運動とを同一の制御モデルを用いてモデル化し、前記制御モデルで使用する制御パラメータを切り替えることによって歩行運動制御と走行運動制御を制御することを特徴とする脚式移動装置の歩行・走行制御方法。In a walking / running control method of a legged moving device that controls a walking motion and a running motion of a legged moving device,
The walking motion and the running motion of the legged mobile device are modeled using the same control model, and the walking motion control and the running motion control are controlled by switching control parameters used in the control model. A walking / running control method for a legged moving device.
前記脚式移動装置の接地点から重心までの重心位置ベクトルと、その時の重心速度ベクトルと、その時の重心加速度ベクトルとの３つを制御パラメータとして用いることを特徴とする請求項３に記載の脚式移動装置の歩行・走行制御方法。The control model may include, during the first exercise period,
The leg according to claim 3, wherein three of a center-of-gravity position vector from the ground contact point to the center of gravity of the legged moving device, a center-of-gravity velocity vector at that time, and a center-of-gravity acceleration vector at that time are used as control parameters. Walking / running control method for mobile devices.
前記第１の運動期間における前記脚式移動装置の最終姿勢状態を初期姿勢状態として用いると共に、前記脚式移動装置の角運動量および運動量の２つを制御パラメータとして用いることを特徴とする請求項３または４に記載の脚式移動装置の歩行・走行制御方法。The control model, during the second exercise period,
4. The method according to claim 3, wherein a final posture state of the legged moving device during the first exercise period is used as an initial posture state, and two of angular momentum and momentum of the legged moving device are used as control parameters. Or the walking / running control method for the legged mobile device according to item 4.
前記第２の運動期間における前記脚式移動装置の最終姿勢状態を初期姿勢状態として用いると共に、前記脚式移動装置の接地点から重心までの重心位置ベクトルと、その時の重心速度ベクトルと、その時の重心加速度ベクトルとの３つを制御パラメータとして用いることを特徴とする請求項３〜６のいずれか一つに記載の脚式移動装置の歩行・走行制御方法。In the third exercise period, the control model includes:
The final posture state of the legged moving device during the second exercise period is used as an initial posture state, and the center of gravity position vector from the ground point to the center of gravity of the legged moving device, the centroid velocity vector at that time, The walking / running control method for a legged mobile device according to any one of claims 3 to 6, wherein three of the center of gravity acceleration vector and the center of gravity acceleration vector are used as control parameters.
前記脚式移動装置の並進移動速度を入力して、その時の運動に最適な前記脚式移動装置の接地点から重心までの重心位置ベクトル、その時の重心速度ベクトルおよびその時の重心加速度ベクトルを生成して出力するベクトル生成手段と、
前記脚式移動装置が脚を用いて推進力を生成する第１の運動期間において、前記ベクトル生成手段で生成された前記重心位置ベクトル、重心速度ベクトルおよび重心加速度ベクトルの３つを制御パラメータとして入力し、前記第１の運動期間における前記脚式移動装置の初期姿勢状態から前記第１の運動期間の最終目標姿勢状態を生成して、前記最終目標姿勢状態へ遷移させる制御を行う第１の制御手段と、
前記脚式移動装置の空中姿勢または脚を用いた支持姿勢を目標状態に保つ第２の運動期間において、前記第１の運動期間における前記脚式移動装置の最終目標姿勢状態を初期姿勢状態として、前記脚式移動装置の角運動量および運動量の２つを制御パラメータとして入力し、前記角運動量および運動量から前記第２の運動期間の制御目標となる角運動量および運動量を生成し、生成した角運動量および運動量へ遷移させる制御を行う第２の制御手段と、
前記脚式移動装置の脚が接地する際の衝撃を和らげる第３の運動期間において、前記第２の運動期間における前記脚式移動装置の最終姿勢状態を初期姿勢状態として、その時の重心位置ベクトル、その時の重心速度ベクトルおよびその時の重心加速度ベクトルの３つを制御パラメータとして用い、前記初期姿勢状態から前記第３の運動期間の最終目標姿勢状態を生成し、前記最終目標姿勢状態へ遷移させる制御を行う第３の制御手段と、
前記脚式移動装置の運動状態に基づいて、前記第１の制御手段、第２の制御手段または第３の制御手段に切り替える切替制御手段と、
を備えたことを特徴とする脚式移動装置の歩行・走行制御装置。In the walking / running control device of the legged moving device that controls the walking motion and the running motion of the legged moving device,
By inputting the translational movement speed of the legged moving device, a center of gravity position vector from the ground contact point to the center of gravity of the legged moving device, a centroid speed vector at that time, and a centroid acceleration vector at that time are generated which are optimal for the movement at that time. Vector generating means for outputting
In a first exercise period in which the leg type moving device generates a propulsive force using a leg, three of the center of gravity position vector, the center of gravity speed vector, and the center of gravity acceleration vector generated by the vector generating means are input as control parameters. And a first control for generating a final target posture state in the first exercise period from the initial posture state of the legged moving device in the first exercise period, and performing control for transitioning to the final target posture state. Means,
In the second exercise period in which the aerial posture of the legged moving device or the supporting posture using the legs is in the target state, the final target posture state of the legged moving device in the first exercise period is set as an initial posture state, Two of the angular momentum and the momentum of the leg type moving device are input as control parameters, and the angular momentum and the momentum to be the control targets of the second exercise period are generated from the angular momentum and the momentum, and the generated angular momentum and Second control means for performing control for transition to momentum;
In a third exercise period in which the impact of the legs of the legged moving device touching the ground is eased, a final posture state of the legged moving device in the second exercise period is set as an initial posture state, and a center-of-gravity position vector at that time; Using the three gravity parameters of the gravity center velocity vector at that time and the gravity center acceleration vector at that time as control parameters, a final target posture state of the third exercise period is generated from the initial posture state, and control is performed to transition to the final target posture state. Third control means for performing;
Switching control means for switching to the first control means, the second control means, or the third control means based on a motion state of the legged moving device;
A walking / running control device for a legged moving device, comprising:
前記脚式移動装置の並進移動速度を検出する速度検出手段と、
前記速度検出手段から並進移動速度を入力して、その時の運動に最適な前記脚式移動装置の接地点から重心までの重心位置ベクトル、その時の重心速度ベクトルおよびその時の重心加速度ベクトルを生成して出力するベクトル生成手段と、
前記脚式移動装置の２つの脚の接地状態を検出する接地検出手段と、
前記脚式移動装置の角運動量を検出する角運動量検出手段と、
前記脚式移動装置の運動量を検出する運動量検出手段と、
前記速度検出手段および接地検出手段の検出結果に基づいて、前記脚式移動装置の脚の接地状態が２脚の接地状態から１脚の接地状態へ移行する期間または１脚の接地状態から接地なしの状態へ移行する期間で、かつ、前記脚式移動装置の並進移動速度が増加する期間を第１の運動期間として、前記ベクトル生成手段で生成された前記重心位置ベクトル、重心速度ベクトルおよび重心加速度ベクトルの３つを制御パラメータとして入力し、前記第１の運動期間における前記脚式移動装置の初期姿勢状態から前記第１の運動期間の最終目標姿勢状態を生成して、前記最終目標姿勢状態へ遷移させる制御を行う第１の制御手段と、
前記接地検出手段の検出結果に基づいて、前記脚式移動装置の脚の接地状態が１脚の接地状態から２脚の接地状態へ移行する期間または接地なしの状態から１脚の接地状態へ移行する期間を第２の運動期間として、前記第１の運動期間における前記脚式移動装置の最終目標姿勢状態を初期姿勢状態として、前記角運動量検出手段および運動量検出手段から前記脚式移動装置の角運動量および運動量の２つを制御パラメータとして入力し、前記角運動量および運動量から前記第２の運動期間の制御目標となる角運動量および運動量を生成し、生成した角運動量および運動量へ遷移させる制御を行う第２の制御手段と、
前記速度検出手段および接地検出手段の検出結果に基づいて、前記脚式移動装置の脚の接地状態が２脚の接地状態または１脚の接地状態である期間で、かつ、前記脚式移動装置の並進移動速度を低下させる期間を第３の運動期間として、前記第２の運動期間における前記脚式移動装置の最終姿勢状態を初期姿勢状態として、その時の重心位置ベクトル、その時の重心速度ベクトルおよびその時の重心加速度ベクトルの３つを制御パラメータとして用い、前記初期姿勢状態から前記第３の運動期間の最終目標姿勢状態を生成し、前記最終目標姿勢状態へ遷移させる制御を行う第３の制御手段と、
前記脚式移動装置の運動状態に基づいて、前記脚式移動装置の運動が前記第１の運動期間、第２の運動期間または第３の運動期間のいずれであるかを判定して、前記第１の制御手段、第２の制御手段および第３の制御手段の切り替え制御を行う切替制御手段と、
を備えたことを特徴とする脚式移動装置の歩行・走行制御装置。In the walking / running control device of the legged moving device that controls the walking motion and the running motion of the legged moving device,
Speed detection means for detecting the translation speed of the legged moving device,
The translational movement speed is input from the speed detection means, and the center of gravity position vector from the contact point to the center of gravity of the legged moving device, the center of gravity speed vector at that time, and the center of gravity acceleration vector at that time are generated which are optimal for the movement at that time. Output vector generating means,
Ground detection means for detecting the ground state of the two legs of the legged moving device;
Angular momentum detection means for detecting the angular momentum of the legged moving device,
Momentum detection means for detecting the amount of motion of the legged moving device,
On the basis of the detection results of the speed detecting means and the grounding detecting means, a period in which the grounding state of the legs of the legged mobile device shifts from a grounded state of two legs to a grounded state of one leg, or no grounding from a grounded state of one leg. And the period during which the translational speed of the legged moving device increases as the first motion period, the center-of-gravity position vector, the center-of-gravity speed vector, and the center-of-gravity acceleration generated by the vector generation means. Three of the vectors are input as control parameters, and a final target posture state in the first exercise period is generated from an initial posture state of the legged moving device in the first exercise period, and the final target posture state is changed to the final target posture state. First control means for performing control to cause transition,
On the basis of the detection result of the grounding detection means, a period in which the grounding state of the leg of the leg type moving device shifts from a grounding state of one leg to a grounding state of two legs, or a state where no grounding is made, changes to a grounding state of one leg. A second exercise period, a final target posture state of the legged moving device during the first exercise period as an initial posture state, and the angular momentum detecting means and the momentum detecting means determine the angle of the legged moving device. Two of the momentum and the momentum are input as control parameters, the angular momentum and the momentum are used to generate the angular momentum and the momentum to be the control targets in the second exercise period, and control is performed to transition to the generated angular momentum and the momentum. Second control means;
Based on the detection results of the speed detecting means and the contact detecting means, during a period in which the contact state of the legs of the leg-type moving device is a contact state of two legs or a contact state of one leg, and A period during which the translational movement speed is reduced is defined as a third exercise period, and a final posture state of the legged moving device during the second exercise period is defined as an initial posture state. A third control unit that generates a final target posture state in the third exercise period from the initial posture state by using three of the center-of-gravity acceleration vectors as control parameters, and performs control to transition to the final target posture state. ,
Based on the exercise state of the legged moving device, it is determined whether the exercise of the legged moving device is the first exercise period, the second exercise period, or the third exercise period. Switching control means for performing switching control of the first control means, the second control means, and the third control means;
A walking / running control device for a legged moving device, comprising:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002252088A JP3660332B2 (en) | 2002-08-29 | 2002-08-29 | Walking / running control method for legged mobile device and walking / running control device for legged mobile device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002252088A JP3660332B2 (en) | 2002-08-29 | 2002-08-29 | Walking / running control method for legged mobile device and walking / running control device for legged mobile device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004090112A true JP2004090112A (en) | 2004-03-25 |
| JP3660332B2 JP3660332B2 (en) | 2005-06-15 |
Family
ID=32058451
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2002252088A Expired - Fee Related JP3660332B2 (en) | 2002-08-29 | 2002-08-29 | Walking / running control method for legged mobile device and walking / running control device for legged mobile device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3660332B2 (en) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2004085121A1 (en) * | 2003-03-27 | 2004-10-07 | Sony Corporation | Robot device and method of controlling the same |
| JP2009142903A (en) * | 2007-12-11 | 2009-07-02 | Denso Wave Inc | Robot control device |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109703645B (en) * | 2018-12-29 | 2020-05-22 | 深圳市优必选科技有限公司 | Robot centroid position adjusting method and device, robot and data storage medium |
-
2002
- 2002-08-29 JP JP2002252088A patent/JP3660332B2/en not_active Expired - Fee Related
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2004085121A1 (en) * | 2003-03-27 | 2004-10-07 | Sony Corporation | Robot device and method of controlling the same |
| US7437214B2 (en) | 2003-03-27 | 2008-10-14 | Sony Corporation | Robot device and method of controlling the same |
| JP2009142903A (en) * | 2007-12-11 | 2009-07-02 | Denso Wave Inc | Robot control device |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3660332B2 (en) | 2005-06-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3435666B2 (en) | robot | |
| US9073209B2 (en) | Walking robot and control method thereof | |
| US6898485B2 (en) | Device and method for controlling operation of legged robot, and robot device | |
| JP4912891B2 (en) | Legged mobile robot and its control program | |
| KR101549817B1 (en) | robot walking control apparatus and method thereof | |
| JP2003326483A (en) | Attitude control device of mobile robot | |
| JP6228097B2 (en) | Mobile robot | |
| JP2011143536A (en) | Humanoid robot and walking control method therefor | |
| WO2002040223A1 (en) | Legged mobile robot and control method thereof, leg structure of legged mobile robot, and mobile leg unit for legged mobile robot | |
| JP6356033B2 (en) | Control device for moving body | |
| WO2006064597A1 (en) | Legged mobile robot and control program | |
| US7801643B2 (en) | Legged mobile robot and control program for the robot | |
| US8483876B2 (en) | Controller of mobile robot | |
| JP2004009205A (en) | Two-foot walking robots | |
| JP3660332B2 (en) | Walking / running control method for legged mobile device and walking / running control device for legged mobile device | |
| JP2002210681A (en) | Motion control device and method for leg-type moving robot, and robot device | |
| Kryczka et al. | Implementation of a human model for head stabilization on a humanoid platform | |
| Nagakubo et al. | Development of a high-performance upper-body humanoid system | |
| JP2003266339A (en) | Leg type moving robot | |
| JP4352774B2 (en) | Motion control device and motion control method for legged walking robot | |
| JP2008126382A (en) | Biped mobile robot and its control method | |
| Jun et al. | From concept to realization: designing miniature humanoids for running | |
| JP5306959B2 (en) | Control device for legged mobile robot | |
| JP2009125838A (en) | Biped walking robot and walking control method | |
| JP2006068884A (en) | Robot device and its control method, and passive wheel device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20020829 |
|
| RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7426 Effective date: 20021009 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20021009 |
|
| A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A712 Effective date: 20031031 |
|
| RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20031215 |
|
| RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20040210 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20041214 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050209 |
|
| 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: 20050308 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050316 |
|
| 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: 20080325 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090325 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100325 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100325 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110325 Year of fee payment: 6 |
|
| LAPS | Cancellation because of no payment of annual fees |