(57)【要約】【課題】ロボットが物体を床から持ち上げる際に、初期状態から静的不安定領域を通過して終端状態へ物体を持ち上げる場合においてもロボットが転倒しないための擬似自由関節を提供する。【解決手段】関節を動かすための力を与えるアクチュエータ１００と、当該関節の動きを当該アクチュエータ１００から当該関節以外の部位に伝達し、当該関節以外の部位を動かすための複数の歯車２６〜２９と、当該関節の角度または負荷を検出するために、前記複数の歯車２６〜２９のうち所定の噛み合う歯車同士２６，２７のそれぞれが装着されているシャフトの各々２３，２４に取り付けられた一対のエンコーダ２１、２２とを備え、エンコーダ２１，２２は、前記一対の歯車の互いの歯が触れないように制御することにより擬似的な自由運動を生成可能とする。【選択図】      図１
2007210065.tif 000002
【特許請求の範囲】
【請求項１】
関節を動かすための力を与えるアクチュエータと、当該関節の動きを当該アクチュエー
タから当該関節以外の部位に伝達し、当該関節以外の部位を動かすために複数のシャフト
に取り付けられた複数の歯車と、当該関節の角度または負荷を検出するために取り付けら
れたエンコーダを備え、前記エンコーダは、前記複数の歯車のうち噛み合う一対の歯車を
装着しているシャフトの各々に取り付けられ、前記一対の歯車の互いの歯が触れないよう
に制御することにより擬似的な自由運動を生成可能とし、物体を持ち上げる際、当該物体
を持ち上げるために蓄積された運動量と前記自由運動により転倒を回避しながら物体を持
ち上げることを特徴とする擬似自由関節を有する非固定式ロボット。
【請求項２】
前記擬似自由関節は、前記一対の歯車の互いの歯の幅または高さを変更することによっ
て、噛み合う部分のバックラッシュを変動することを特徴とする請求項１に記載の擬似自
由関節を有する非固定式ロボット。
【請求項３】
前記擬似自由関節は、前記一対の歯車のうち一方の歯車の歯にテーパをかけて連続的に
動作可能にしたことを特徴とする請求項１に記載の擬似自由関節を有する非固定式ロボッ
ト。
【請求項４】
前記擬似自由関節は、前記一対の歯車のうち一方の歯車を、当該一方の歯車が装着され
ているシャフトの軸方向に滑走可能に取り付けられていることを特徴とする請求項１に記
載の擬似自由関節を有する非固定式ロボット。
【請求項５】
前記一対の歯車は、前記アクチュエータからの力の伝達経路が最も長い位置に配置され
た一対の歯車であることを特徴とする請求項１に記載の擬似自由関節を有する非固定式ロ
ボット。
【請求項６】
関節を動かすための力を与えるアクチュエータと、当該関節の動きを当該アクチュエー
タから当該関節以外の部位に伝達し、当該関節以外の部位を動かすために複数のシャフト
に取り付けられた複数の歯車と、当該関節の角度または負荷を検出するために取り付けら
れたエンコーダを備え、前記エンコーダは、前記複数の歯車のうち噛み合う一対の歯車を
装着しているシャフトの各々に取り付けられ、前記一対の歯車の互いの歯が触れないよう
に制御することにより擬似的な自由運動を生成可能とし、物体を持ち上げる際、当該物体
を持ち上げるために蓄積された運動量と前記自由運動により転倒を回避しながら物体を持
ち上げることを特徴とする擬似自由関節。
【請求項７】
アクチュエータによって関節を動かすための力を与えるステップと、当該関節以外の部
位を動かすために複数のシャフトに取り付けられた複数の歯車によって当該関節の動きを
当該アクチュエータから当該関節以外の部位に伝達するステップと、エンコーダによって
当該関節の角度または負荷を検出するステップを含み、前記エンコーダは、前記複数の歯
車のうち噛み合う一対の歯車を装着しているシャフトの各々に取り付けられ、前記一対の
歯車の互いの歯が触れないように制御することにより擬似的な自由運動を生成可能とし、
物体を持ち上げる際、当該物体を持ち上げるために蓄積された運動量と前記自由運動によ
り転倒を回避しながら物体を持ち上げることを特徴とする擬似自由関節を有する非固定式
ロボット制御方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、非固定式ロボットおよびそのロボット制御方法に係り、特に、動的制御理論
に基づく擬似自由関節を有する非固定式ロボットおよびその制御方法ならびに擬似自由関
節に関する。
【背景技術】
【０００２】
従来、２足歩行ロボットやヒューマノイドロボットなどの非固定型ロボットに対して、
全身の運動量を利用して、物体を操作する方法について十分に検討されていないのが実情
である。また、非固定型ロボットの安定性は、主に、ＺＭＰを規範として議論されてきた
ため、歩行やマニピュレーションにおいてロボットの運動量を利用して転倒を回避する方
法については十分検討されていない。
【０００３】
図１０は、従来のロボット関節の構成の一例を示す斜視図である。同図に示すように、
従来のロボット関節２０は、アクチュエータ１００と、エンコーダ２００と、複数のギア
３００と、アーム５００とから構成されている。ここで、アーム（リンク）５００を同図
矢印で示す方向に自由落下させて、そのダイナミクスを妨げないように関節を駆動させる
方法を考えると、従来では、まずアーム５００の目標軌道を設定し、それに追従するよう
にアクチュエータ１００を制御する方法が採られてきた。したがって、従来法では、アー
ム５００などの完全なモデルを構築して、自由落下させたときの軌道を正確に計算し、そ
の軌道に追従するように関節が制御されてきた。
【０００４】
しかし、この従来法では、関節角を測定するセンサに相当するエンコーダ２００は、ア
クチュエータ１００側のみに装着されていて、かつ、アクチュエータ１００からアーム５
００まで複数のギア３００で力が伝達されるため、特にアーム５００が高速に運動する場
合などでは完全に目標軌道を追従させることはできない。
上述した従来のロボット関節の代表的な動作について以下に説明する。
【０００５】
図１１〜図１３は、従来のヒューマノイドロボットの物体持ち上げ動作を示す図である
。
まず、重力下におけるヒューマノイドロボットによる物体持ち上げ動作について説明す
る。
図１１に示すように、ヒューマノイドロボットは、環境に固定されていないので、ロボ
ットが静的な状態にあるときロボットが転倒しないためには、全身の重心（ＣＯＭ；Ｃｅ
ｎｔｅｒ  ｏｆ  Ｍａｓｓ）の床面への射影点が両足底の外側の縁で構成された支持多角
形Ｓの内部にある必要がある。
【０００６】
また、図１２（ａ）に示すように、ロボットの足部接地位置を変えずに静的安定状態の
ときのロボットの手先が取りうる領域（静的安定な手先可動領域と呼ぶ）を灰色領域Ｃと
し、そのときの全体の系のＣＯＭを点Ｐ１とする。また、図１２（ｂ）に示すように、灰
色領域Ｃ内にある重い物体Ｗを把持する場合、ロボットと物体の全体の系のＣＯＭを点Ｐ
２とする。ＣＯＭ（点Ｐ１）とＣＯＭ（点Ｐ２）とを比較すると、ロボットと物体の全体
の系のＣＯＭ（点Ｐ２）と、ロボットのみのＣＯＭ（点Ｐ１）とは異なる位置に存在する
ことが分かる。
【０００７】
例えば、図１２（ｂ）に示すように、物体Ｗがロボットの正面にある場合、全体の系の
ＣＯＭ（点Ｐ２）は，ロボットのＣＯＭ（点Ｐ１）より遠くに存在する。したがって、物
体Ｗの重量や位置によっては系全体のＣＯＭ（点Ｐ１）の床面への射影点が支持多角形Ｓ
の外側に位置する場合が生じ、このとき、ロボットは、どんなに大きな出力を持っていて
も物体を静的には保持することはできず、前方へ転倒してしまう。
【０００８】
ここで、改めて物体を考慮した系の静的安定な手先可動領域を求めると、その領域は、
物体を考慮しない系の静的安定な手先可動領域Ｃ（図１２の灰色領域）より小さくなり、
物体が重いほどロボットの足首を通る鉛直線付近に分布する。ロボットが物体を把持した
状態における静的安定な手先可動領域は、図１３（ａ）に示す水平線ならびに図３（ｂ）
に示す斜線部領域のようになる。図１３（ａ）には、物体Ｗが床に接している状態でロボ
ットが物体を把持している様子が描かれているが、このときの静的安定な手先可動領域は
、物体の把持点を通る水平線Ａａとなる。また、図１３（ｂ）には、物体Ｗが床に接して
いない状態でロボットが物体Ｗを把持している様子が描かれているが、このときの静的安
定な手先可動領域は、灰色領域内にある斜線部領域Ａｂとなる。
【０００９】
また、特許文献１には、体幹部において、自由度を有し、任意の転倒姿勢においてこれ
ら体幹部の自由度を活用することにより、円滑に起き上がることができ、体幹部以外の可
動部への負担や要求トルクを軽減すると共に、過重負担を各可動部間で分散・平均化する
ことで、特定部位への集中荷重を回避するロボットが提案されている。
【特許文献１】特開２００１−１５０３７０号公報
【発明の開示】
【発明が解決しようとする課題】
【００１０】
しかしながら、上述した従来例においては、以下のような問題を有する。
図１４，図１５は、従来のヒューマノイドロボットの物体持ち上げ時における問題点を
示す図である。
まず、図１４に示すように、図１３（ａ）に示すロボットの静的安定状態を初期状態、
図１３（ｂ）に示すロボットの静的安定状態を終端状態とし、各静止状態のときの手先位
置をそれぞれ点ＰｓとＰｅで表す。ただし、点Ｐｓは、静的安定な手先可動領域である斜
線領域Ａｂ以外の点とする。図１４に示す経路に沿って初期状態（点Ｐｓ）から終端状態
（点Ｐｅ）まで物体Ｗをゆっくりと静的に持ち上げる場合、経路Ｄと斜線領域Ａｂの境界
との接点を点Ｐｃとすると、点Ｐｃと点Ｐｅとの間の経路，ならびに点Ｐｓでは静的安定
状態で物体Ｗを保持することが可能であるが、点Ｐｓと点Ｐｃとの間の経路では、静的不
安定状態となり、ロボットは転倒してしまう。直接、初期状態から静的不安定領域を通過
して終端状態へ物体を持ち上げる場合、ロボットが転倒しないためには、転倒しないため
の力を外部から受ける必要がある。
【００１１】
そのためには、図１５に示すように、水平前方をＸ方向、上方向をＺ方向とし、Ｘ方向
の力をｆｘ、Ｚ負方向の力をｆｚとすると、Ｘ方向の力ｆｘやＺ負方向の力ｆｚで物体を
押したときの反力ｆｒｅａｃｔｘ，ｆｒｅａｃｔｚを利用し、ＺＭＰが、図１１に示す支
持多角形Ｓの内部でかつ境界でない範囲に存在するようにする必要がある。しかし、Ｘ方
向やＺ負方向の力ｆｘ、ｆｚは、終端方向から物体を遠ざける力であり、終端方向へ物体
を持ち上げることは極めて困難となる。
【００１２】
また、図１４に示す経路では、物体をロボット側に引き寄せながら上げていく力が必要
となる。言い換えると、反作用によりロボットは、図１６に示すような物体側に引っ張ら
れる力Ｆｘと重力方向の力Ｆｚを受けることになるが、これらの力は、ロボットの重心や
脚の位置を考慮すると、明らかにロボットを転倒するように働く。したがって、経路に沿
って物体が移動するようにロボットが物体に力を加えると、静的に物体を保持するより、
さらにロボットは倒れやすくなると考えられる。
【００１３】
以上のことから、物体Ｗが床から離れた瞬間から静的不安定状態となる経路では、ロボ
ットがどんなに大きな出力を持っていても、初期状態から直接物体を持ち上げることがで
きず、また、仮に持ち上がったとしても転倒しないための力を発生させることは困難であ
る。
また、一般に、ヒューマノイドロボットのような実在する多自由度移動ロボットは、全
関節が駆動されており、系のダイナミクスが有効に利用することが難しい。一方、歩行ロ
ボットの研究において、非駆動関節を利用したパッシブウォーキングの研究が進められて
いてダイナミクスの利用の有効性が指摘されているが、駆動できない自由関節が用いられ
ているため、物体持ち上げなどの力が必要な作業を行う場合に問題となる。
【００１４】
また、特許文献１記載の発明についても、このロボットは、転倒したか否かを判断する
転倒判断手段と、転倒時の姿勢を判定する判定手段と、起き上がり動作を実行する手段と
を有するのみで、ロボット自身が転倒したときに何をするかについては対処できるが、物
体を持ち上げる際に運動量等を考慮して制御されるようなロボットではなく、物体を持ち
上げる際には転倒しないよう制御できないという問題を有している。
【００１５】
本発明は、上述した事情を鑑みてなされたものであって、物体を床から持ち上げる際に
、転倒せずに物体を終端状態へ移動させ、初期状態から静的不安定領域を通過して終端状
態へ物体を持ち上げる場合においても転倒しない擬似自由関節を有する非固定式ロボット
およびその制御方法ならびに擬似自由関節を提供することを目的としている。
また、本発明は、関節又はリンクを、駆動した状態ならびに自由にした状態に切り替え
ることができ、ＺＭＰの概念に縛られずに非固定型ロボットの転倒を回避し、かつ、系の
ダイナミクスを有効に利用して物体の運動を制御できる擬似自由関節を有する非固定式ロ
ボットおよびその制御方法ならびに擬似自由関節を提供することを目的としている。
【課題を解決するための手段】
【００１６】
上記課題を解決するために、本発明の請求項１に記載の擬似自由関節を有する非固定式
ロボットは、関節を動かすための力を与えるアクチュエータと、当該関節の動きを当該ア
クチュエータから当該関節以外の部位に伝達し、当該関節以外の部位を動かすために複数
のシャフトに取り付けられた複数の歯車と、当該関節の角度または負荷を検出するために
取り付けられたエンコーダを備え、前記エンコーダは、前記複数の歯車のうち噛み合う一
対の歯車を装着しているシャフトの各々に取り付けられ、前記一対の歯車の互いの歯が触
れないように制御することにより擬似的な自由運動を生成可能とし、物体を持ち上げる際
、当該物体を持ち上げるために蓄積された運動量と前記自由運動により転倒を回避しなが
ら物体を持ち上げることを特徴としている。
【００１７】
また、請求項２に記載の擬似自由関節を有する非固定式ロボットは、請求項１に記載の
擬似自由関節を有する非固定式ロボットに係り、前記擬似自由関節は、前記一対の歯車の
互いの歯の幅または高さを変更することによって、噛み合う部分のバックラッシュを変動
することを特徴としている。
また、請求項３に記載の擬似自由関節を有する非固定式ロボットは、請求項１に記載の
擬似自由関節を有する非固定式ロボットに係り、前記擬似自由関節は、前記一対の歯車の
うち一方の歯車の歯にテーパをかけて連続的に動作可能にしたことを特徴としている。
【００１８】
また、請求項４に記載の擬似自由関節を有する非固定式ロボットは、請求項１に記載の
擬似自由関節を有する非固定式ロボットに係り、前記擬似自由関節は、前記一対の歯車の
うち一方の歯車を、当該一方の歯車が装着されているシャフトの軸方向に滑走可能に取り
付けられていることを特徴としている。
また、請求項５記載の擬似自由関節を有する非固定式ロボットは、請求項１に記載の擬
似自由関節を有する非固定式ロボットに係り、前記一対の歯車は、前記アクチュエータか
らの力の伝達経路が最も長い位置に配置された一対の歯車であることを特徴としている。
【００１９】
また、請求項６記載の擬似自由関節を有する非固定式ロボットは、関節を動かすための
力を与えるアクチュエータと、当該関節の動きを当該アクチュエータから当該関節以外の
部位に伝達し、当該関節以外の部位を動かすために複数のシャフトに取り付けられた複数
の歯車と、当該関節の角度または負荷を検出するために取り付けられたエンコーダを備え
、前記エンコーダは、前記複数の歯車のうち噛み合う一対の歯車を装着しているシャフト
の各々に取り付けられ、前記一対の歯車の互いの歯が触れないように制御することにより
擬似的な自由運動を生成可能とし、物体を持ち上げる際、当該物体を持ち上げるために蓄
積された運動量と前記自由運動により転倒を回避しながら物体を持ち上げることを特徴と
している。
【００２０】
また、請求項７に記載の擬似自由関節を有する非固定式ロボット制御方法は、アクチュ
エータによって関節を動かすための力を与えるステップと、当該関節以外の部位を動かす
ために複数のシャフトに取り付けられた複数の歯車によって当該関節の動きを当該アクチ
ュエータから当該関節以外の部位に伝達するステップと、エンコーダによって当該関節の
角度または負荷を検出するステップを含み、前記エンコーダは、前記複数の歯車のうち噛
み合う一対の歯車を装着しているシャフトの各々に取り付けられ、前記一対の歯車の互い
の歯が触れないように制御することにより擬似的な自由運動を生成可能とし、物体を持ち
上げる際、当該物体を持ち上げるために蓄積された運動量と前記自由運動により転倒を回
避しながら物体を持ち上げることを特徴としている。
【００２１】
本発明は、ロボットの足部接地位置を変えずに静的に転倒しない状態（静的安定状態）
から静的には転倒する状態（静的不安定状態）を通過して他の静的安定状態へ物体を操作
しながら、全身を動かす方法とそれを表現する機構を開示する。なお、本発明では、物体
が床に接したまま物体をロボット側に引きずって手先位置を斜線領域に移動させる方法は
考慮していない。
【発明の効果】
【００２２】
以上説明したように、本発明の擬似自由関節を有する非固定式ロボットによれば、物体
を床から持ち上げる際、転倒せずに物体を終端状態へ移動させ、初期状態から静的不安定
領域を通過して終端状態へ物体を持ち上げる場合においても転倒しない擬似自由関節を有
する非固定型ロボットを提供することができる。
また、本発明による擬似自由関節は、関節又はリンクを、駆動した状態ならびに自由に
した状態に切り替えることができ、ＺＭＰの概念に縛られずに非固定型ロボットの転倒を
回避することができる。
また、本発明の擬似自由関節を有する非固定式ロボット制御方法は、系のダイナミクス
を有効に利用して物体の運動を制御できる非固定型ロボット制御方法を提供することがで
きる。
【発明を実施するための最良の形態】
【００２３】
以下、図面を参照して、本発明の実施形態に係る非固定型ロボットについて説明する。
まず、図１〜図５を参照して、本発明の実施形態に係る非固定型ロボットの構成につい
て説明する。図１は、本発明の実施形態に係る擬似自由関節の構成を示す斜視図、図２は
、他の実施形態に係る擬似自由関節の構成、図３は、擬似自由関節における隣り合う歯車
同士の一方の歯車の歯の形状を変更した場合の状態を示す概略図、図４は、擬似自由関節
における隣り合う歯車同士の一方の歯車の歯にテーパをかけた時の歯の状態を示す概略図
、図５は、擬似自由関節における隣り合う歯車同士の一方の歯車をスライド式に形成した
ときの状態を示す斜視図である。
【００２４】
一般に、ロボットによる物体持ち上げなどのような動的な作業の場合、物体を操作する
ために物体に力を加えたり、物体の運動を妨げないように物体に繋がるリンクの運動を自
由にさせたりすることが必要となる。これを実現する一手法として、駆動源からの力がリ
ンクに伝達されたり、伝達されずに自由な状態になったりするように関節を制御する方法
がある。この擬似的な自由運動状態を生成するために、本発明は、以下の構成を採用して
いる。
【００２５】
図１は、本発明の実施形態にかかる非固定式ロボットの関節を示す斜視図である。
この関節１０は、アクチュエータ１００と、シャフト２３〜２５と、歯車２６〜２９と
、エンコーダ２１，２２と、アーム５００とで構成されている。
アクチュエータ１００は、関節を動かすための力を与える作動部としての機能を有する
。
【００２６】
歯車２６〜２９は、当該関節の動きを当該アクチュエータ１００から当該関節以外の部
位に伝達し、当該関節以外の部位を動かす第１の歯車２６，第２の歯車２７，第３の歯車
２８，第４の歯車２９と、計４つの歯車から構成されている。
エンコーダ２１，２２は、当該関節の角度または負荷を検出するための第１のエンコー
ダ２１，第２のエンコーダ２２と、計２つのエンコーダから構成されている。
【００２７】
シャフト２３〜２５は、各部位を連結するための部位で、第１シャフト２３，第２シャ
フト２４，第３シャフト２５と、計３つのシャフトから構成されている。第１シャフト２
３は、第１歯車２６，第１エンコーダ２１と、アーム５００とを連結し、第２シャフト２
４は、第２の歯車２７，第２エンコーダ２２と、第３歯車２８とを連結し、第３シャフト
２５は、第４歯車２９とアクチュエータ１００とを連結している。
そして、本発明の擬似自由関節は、特に、第１歯車２６、第２歯車２７を取り付けてい
る第１シャフト２３、第２シャフト２４の各々に第１エンコーダ２１、第２エンコーダ２
２を取り付けていることを特徴としている。
【００２８】
図１に示すように、歯車の噛み合う歯と歯との間には、隙間（バックラッシュ）が存在
するのが一般的であるが、第１歯車２６と第２歯車２７とが噛み合う際に、歯と歯とが触
れないように、第２歯車２７を制御できれば、第１歯車２６には力が加わらず、アーム５
００の自由な運動が実現できる。そこで、第１歯車２６と第２歯車２７とが噛み合う際に
、歯と歯とが触れないように第２歯車２７を制御するための方法について以下に説明する
。
【００２９】
まず、図１に示すように、第１歯車２６と第２歯車２７のそれぞれに関節角を測定する
センサを装着する方法がある。本実施形態では、このセンサとして第１エンコーダ２１，
第２エンコーダ２２を用いている。そして、第１エンコーダ２１および第２エンコーダ２
２の計測値を用いれば、より高精度に第２歯車２７が第１歯車２６の歯に触れないように
アクチュエータ１００を制御することが可能となる。
【００３０】
また、図２に示すように、もしエンコーダの分解能が小さく高精度な制御が十分にでき
ない場合は、アーム５００に直結する第１歯車３０に噛み合い、第１歯車３０より歯数の
多い第２歯車３６を用いることによって、第１歯車３０の回転運動を減速させれば良い。
なお、第３歯車３７は、図１の第２歯車２７に相当する。
次に、図１に戻り、第１歯車２６と第２歯車２７とが噛み合う部分のバックラッシュを
大きくする方法として、第１，第２歯車２６，２７の軸間距離を変える方法は、歯車全体
の配置に影響を与えるので良い方法とはいえない。そこで、本実施形態では、歯車の歯の
形状・大きさを自在に変える方法を採用している。
【００３１】
そこで、図３に示すように、歯の幅と高さのそれぞれを変更することにより、同図右側
の四角形内に示すようにバックラッシュを大きくすることが可能になる。また、前述した
ように、ロボットの物体操作ではアーム（リンク）を自由運動させたり、駆動させたりす
ることが自在にできることが要求されているので、バックラッシュの大きさを連続的に変
動させることが望ましい。
【００３２】
そこで、図４に示す片側にテーパをつけたテーパード歯を用いることを考える。図４（
ａ）では、歯の高さは変わらないが、Ｒ側の歯の幅はＬ側に比べて細くなっている。また
、同図４（ｂ）では、Ｒ側の歯の高さがＬ側に比べて低くなっている。同図上側に３方向
からのそれぞれの見取り図を示す。
図５は、図４（ａ）に示すテーパード歯を持つ第２歯車４７を装着した機構を示す斜視
図である。同図に示すように、第２歯車４７がシャフト軸方向にスライド駆動できるよう
にすれば、同図の右側の四角内の図のように、第１歯車４６と第２歯車４７の噛み合い部
のバックラッシュを小さくしたり大きくしたりすることが可能となる。なお、図４（ｂ）
のテーパード歯を用いても同様の効果が得られる。したがって、アーム５００を自由に運
動させるには、Ｒ側の歯が第１歯車４６の歯と歯との間に配置するように第２歯車４７を
スライドし、アーム５００を駆動するには、Ｌ側の歯が第１歯車４６と噛み合うように第
２歯車４７をスライドすればよい。
【００３３】
この方法を用いれば、アーム５００などの完全なモデルを構築したり、アーム５００が
自由運動するための目標軌道を生成したりすることなく、ただ、第２歯車４７を第１歯車
４６の歯に触れないようにアクチュエータ１００を制御するだけで簡便に擬似的な自由関
節を生成することが可能となる。
なお、擬似的な自由関節を生成するために、従来のようなクラッチやＥＲアクチュエー
タなどを用いると、関節重量が大きくなったり、大きな電力が必要となったり、現存のも
のを改造するのにコストがかかったりするなどの問題があるが、本発明では、このような
問題に対処することができる。
【００３４】
次に、図６〜図９を参照して、本発明の非固定式ロボットの自由関節の動作について説
明する。図６は、物体を持ち上げる際の非固定式ロボットの動作を段階的に示す図、（ａ
）は持ち上げる前、（ｂ）は持ち上げる準備段階、（ｃ）は持ち上げる直前、（ｄ）は持
ち上げる途中、（ｅ）は持ち上げ後の終端状態を示す概略図である。図７は、ＺＭＰの概
念による転倒回避方法を示す概略図、図８は、重心速度による転倒回避方法を示す概略図
、図９は、自由関節運動を利用した重心の放物線運動を示す概略図、（ａ）はロボット重
心の軌道、（ｂ）は物体重心の軌道を示す図である。
【００３５】
以下、（１）力積（慣性力）を利用した物体操作方法と、（２）運動量を利用した転倒
回避方法とに分けて説明する。
（１）まず、図６を参照して、力積（慣性力）を利用した物体操作方法について説明する
。
背景技術で説明したように、物体をロボット側に引き寄せながら上げていく力が必要と
なり、反作用によりロボットは、物体側に引っ張られる力と重力方向の力を受けることに
なり、これらの力は、ロボットの重心や脚の位置を考慮すると、明らかにロボットを転倒
するように働き、経路に沿って物体が移動するようにロボットが物体に力を加えると、静
的に物体を保持するより、さらにロボットは倒れやすくなる。
【００３６】
そこで、物体が床から離れた状態では、物体を引き寄せる力や物体を上げる力を発生さ
せず、物体が床から離れる前に物体に力積を加えることによって生じる物体の運動を利用
する方法を考える。すなわち、静的に安定な初期状態から直接物体を持ち上げるのではな
く、物体ならびにロボットの足底の位置を固定した状態でロボットが運動し、物体を持ち
上げる前に持ち上げ動作に必要な運動量をロボット自身に蓄積し、その後、この運動量の
一部を物体に瞬間的に与えて生じる物体速度によって物体を持ち上げる方法を考える。そ
の詳細を以下に示す。
【００３７】
まず、物体が床から持ち上がる前に、物体を静止させたままでヒューマノイドが全身運
動を行い持ち上げに必要な運動エネルギー（運動量）を生成する。
具体的には、まず、図６（ａ）に示す初期状態から図６（ｂ）に示すように、物体に掴
まりながら持ち上げ前に行う運動の開始姿勢へ移動する。このとき、ロボット１の重心の
床への射影点が足底から外れる姿勢であっても、物体と床との摩擦が十分に大きく物体が
傾かない場合、射影点が両足底と箱の底面との外側の縁で構成された支持多角形の内部に
ある限り、物体を支えようとすることによって転倒を防ぐことができる。
【００３８】
次に、物体を押しながらロボット１の上体を勢いよく起こすことによって大きな重心移
動が生成され、図６（ｃ）に示すように、ロボットが起き上がっていく途中で腕が伸びた
とき、瞬間的な力により物体に大きな初速度が生じる。このとき、ロボットのいくつかの
関節を自由な動きができるようにすることによって物体の運動を妨げることなく、物体を
床から持ち上げることが可能になる。このようにして、物体を持ち上げた後は、図６（ｄ
）に示すように持ち上げ途中の段階を経て、図６（ｅ）に示すように、終端状態に移行す
る。
【００３９】
（２）次に、図７〜図９を参照して、運動量（力積）を利用した転倒回避方法について説
明する。
ロボットが床から離れた物体を把持しているときの状態を図７（ａ）のような第１〜第
３リンクからなる３リンクアームのロボットで簡略化する。同図では、第１リンク，第２
リンクがロボット１の脚に相当し、第３リンクがロボット１の脚以外の全リンクと物体で
構成される系に相当する。同図に示すように、系全体の重心の床面への射影点が支持多角
形内（足底）にない場合、ロボットは静的に物体を把持することはできない。
【００４０】
このような場合、ＺＭＰの概念から考えると、図７（ｂ）に示すように第３リンクの重
心（点Ａ）に少なくともＸ軸方向に（矢印Ｘ）加速度を発生させることによって生じる慣
性力−Ｍｘが必要となる。この慣性力−Ｍｘと重力−Ｍｇとの合力が支持多角形の境界以
外の内部を通るならば、ロボットの転倒を回避できるが、その慣性力−Ｍｘを継続して発
生させる必要がある。したがって、重心をＸ方向に加速し続けるために、同図の点線付近
に系の重心が位置する安定な状態へ到達できる保証がない。
【００４１】
そこで、ＺＭＰを規範とした転倒回避法では考慮されていない系の速度に着目する。こ
れまで、図７（ａ）の状態では、ロボットが転倒すると述べたが、第３リンクの重心に図
８に示すような十分に大きい速度ｖがあり、かつこの速度ｖによって生じる運動を妨げな
ければ、系は図７（ｂ）の点線で示す安定な状態へ到達することが可能となる。例えば、
同図中の３関節を自由関節のような状態にすれば、重心Ａ点は図７（ａ）の点線で示すよ
うに自由放物線運動をすることができる。なお、足部の重さを考慮すれば、第１リンクが
足部を強く引っ張らない限り足底が床から離れない。また、実際には第１，第２リンクに
も重さがあり、その重量によって重心Ａ点の自由放物線運動が妨げられるので、厳密には
その影響を考慮して重心速度ｖを決める必要がある。しかしながら、多くの場合、第３リ
ンクの重量に比べると、第１，第２リンクの重量は小さく、その影響も小さい。
【００４２】
このように、図８に示すように十分な速度ｖがあれば、前述した図６においても、持ち
上げ前に生成したロボットの運動量により、持ち上げ後も物体のみならず、ロボット自身
にも足首鉛直線上（図６（ｃ）の破線）の安定な位置へ移動する方向の速度が生成される
。
この速度を利用すれば、ロボットの重心運動を妨げないようにロボットの関節、例えば
脚の関節を自由関節の動きになるように制御することによって、図９（ａ）に示すように
転倒を回避しながらロボット１自身の自然な起き上がる運動を保つことができ、安定な状
態へ移動することが可能となる。同時に、物体Ｗの自由な運動を妨げないように腕の関節
を自由関節の動きになるように制御することによって、図９（ｂ）に示すように物体の放
物運動を実現することが可能となる。
【００４３】
そして、最後に、前述した図６（ｅ）に示すように、物体やロボットの運動を減速させ
て、全重心の床への射影点が足底の支持多角形内にあるような終端状態にする。
以上、本発明の実施形態について説明してきたが、本発明は、この実施形態に限定され
ず、本発明の趣旨を逸脱しない範囲で種々の変更が可能である。
例えば、上述した実施形態では、非固定式ロボットの場合について説明したが、これに
限定されず、固定式ロボットの場合にも擬似自由関節を用いることができる。
【図面の簡単な説明】
【００４４】
【図１】本発明の実施形態に係る擬似自由関節の構成を示す斜視図である。
【図２】本発明の他の実施形態に係る擬似自由関節の構成を示す斜視図である。
【図３】本発明の実施形態に係る擬似自由関節における隣り合う歯車同士の一方の歯車の歯の形状を変更した場合の状態を示す概略図である。
【図４】本発明の実施形態に係る擬似自由関節における隣り合う歯車同士の一方の歯車の歯にテーパをかけた時の歯の状態を示す概略図である。
【図５】本発明の実施形態に係る擬似自由関節における隣り合う歯車同士の一方の歯車をスライド式に形成したときの状態を示す斜視図である。
【図６】物体を持ち上げる際の非固定式ロボットの動作を段階的に示す図である。（ａ）は持ち上げる前、（ｂ）は持ち上げる準備段階、（ｃ）は持ち上げる直前、（ｄ）は持ち上げる途中、（ｅ）は持ち上げ後の終端状態を示す概略図である。
【図７】ＺＭＰの概念による転倒回避方法を示す概略図である。
【図８】重心速度による転倒回避方法を示す概略図である。
【図９】自由関節運動を利用した重心の放物線運動を示す概略図である。（ａ）はロボット重心の軌道、（ｂ）は物体重心の軌道を示す図である。
【図１０】従来のロボットの関節駆動機構を示す斜視図である。
【図１１】ロボットの静的安定状態における重心位置を示す概略図である。
【図１２】ロボットが物体を持ち上げる際の重心移動を示す概略図である。（ａ）は持ち上げる前、（ｂ）は持ち上げた後の重心位置を示す。
【図１３】ロボットの静的安定な手先可動領域を示す概略図である。（ａ）は物体が床に接している場合、（ｂ）は物体が床に接していない場合を示す。
【図１４】ロボットが物体を持ち上げる際の経路を示す概略図である。
【図１５】ロボットが物体を持ち上げる際の転倒回避のための手先の力を示す概略図である。
【図１６】ロボットが物体を持ち上げるのに必要な手先の力の反力を示す概略図である。
【符号の説明】
【００４５】
１…非固定式ロボット、１０…擬似自由関節、２１…第１エンコーダ、２２…第２エンコ
ーダ、２３…第１シャフト、２４…第２シャフト、２５…第３シャフト、２６，３０…第
１歯車、２７，３６…第２歯車、２８，３７…第３歯車、２９，３８…第４歯車、１００
…アクチュエータ、２００…エンコーダ（従来）、３００…歯車（従来）、４１０，４２
０，４３０…シャフト、５００…アーム
【図１】
2007210065.tif 000003
【図２】
2007210065.tif 000004
【図３】
2007210065.tif 000005
【図４】
2007210065.tif 000006
【図５】
2007210065.tif 000007
【図６】
2007210065.tif 000008
【図７】
2007210065.tif 000009
【図８】
2007210065.tif 000010
【図９】
2007210065.tif 000011
【図１０】
2007210065.tif 000012
【図１１】
2007210065.tif 000013
【図１２】
2007210065.tif 000014
【図１３】
2007210065.tif 000015
【図１４】
2007210065.tif 000016
【図１５】
2007210065.tif 000017
【図１６】
2007210065.tif 000018