特許第6357672号(P6357672)IP Force 特許公報掲載プロジェクト 2022.1.31 β版

知財求人 - 知財ポータルサイト「IP Force」

▶ 株式会社国際電気通信基礎技術研究所の特許一覧

<>
  • 特許6357672-駆動機構 図000011
  • 特許6357672-駆動機構 図000012
  • 特許6357672-駆動機構 図000013
  • 特許6357672-駆動機構 図000014
  • 特許6357672-駆動機構 図000015
  • 特許6357672-駆動機構 図000016
  • 特許6357672-駆動機構 図000017
  • 特許6357672-駆動機構 図000018
  • 特許6357672-駆動機構 図000019
  • 特許6357672-駆動機構 図000020
  • 特許6357672-駆動機構 図000021
< >
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】6357672
(24)【登録日】2018年6月29日
(45)【発行日】2018年7月18日
(54)【発明の名称】駆動機構
(51)【国際特許分類】
   B25J 19/00 20060101AFI20180709BHJP
   B25J 17/00 20060101ALI20180709BHJP
   B25J 11/00 20060101ALN20180709BHJP
   A61H 1/02 20060101ALN20180709BHJP
   A61H 3/00 20060101ALN20180709BHJP
【FI】
   B25J19/00 A
   B25J17/00 G
   !B25J11/00 Z
   !A61H1/02 R
   !A61H3/00 B
【請求項の数】6
【全頁数】21
(21)【出願番号】特願2016-185498(P2016-185498)
(22)【出願日】2016年9月23日
(62)【分割の表示】特願2012-202854(P2012-202854)の分割
【原出願日】2012年9月14日
(65)【公開番号】特開2016-221680(P2016-221680A)
(43)【公開日】2016年12月28日
【審査請求日】2016年10月21日
【国等の委託研究の成果に係る記載事項】(出願人による申告)文部科学省、科学技術試験研究委託事業「日本の特長を活かしたBMIの総合的研究開発」に係る委託研究、産業技術力強化法第19条の適用を受ける特許出願
(73)【特許権者】
【識別番号】393031586
【氏名又は名称】株式会社国際電気通信基礎技術研究所
(74)【代理人】
【識別番号】100109162
【弁理士】
【氏名又は名称】酒井 將行
(72)【発明者】
【氏名】野田 智之
(72)【発明者】
【氏名】森本 淳
【審査官】 貞光 大樹
(56)【参考文献】
【文献】 特開2012−45194(JP,A)
【文献】 特開2011−152620(JP,A)
【文献】 特開2004−322283(JP,A)
【文献】 特開2012−125847(JP,A)
【文献】 特表2012−516780(JP,A)
【文献】 特開2009−257573(JP,A)
【文献】 特開2008−87143(JP,A)
【文献】 米国特許第4819547(US,A)
(58)【調査した分野】(Int.Cl.,DB名)
B25J 1/00 − 21/02
A61H 1/00 − 5/00
(57)【特許請求の範囲】
【請求項1】
ロボットのフレーム構造の能動関節を駆動するための駆動機構であって、
前記能動関節の関節角を検出するための第1のセンサと、
前記能動関節に対するトルク制御により前記能動関節を動作させる制御部とを備え、
前記能動関節は、
エアマッスルと、
電動モータと、
前記エアマッスルからの第1の駆動力と前記電動モータからの第2の駆動力とを合成し
て前記能動関節の屈伸を駆動するための駆動力合成手段と、
前記エアマッスルからの前記第1の駆動力を前記駆動力合成手段に伝達するためのワイヤとを含み、
前記制御部は、前記能動関節をトルク制御するにあたり、
前記ワイヤを所定のバネ定数で表されるバネとした力学モデルで表現し、前記第1の駆動力を、前記エアマッスルに供給するべき圧力および前記エアマッスルの収縮割合との関係を表す所定の関数による駆動力モデルで表現する場合に、
前記能動関節に目標トルクを生じさせるための第1の駆動力を目標駆動力とするとき、
前記第1のセンサにより検出される前記関節角から算出される見かけの収縮割合から前記力学モデルを用いて得られる推定収縮割合と前記目標駆動力とに基づき、前記駆動力モデルの逆モデルにより、前記エアマッスルに供給するべき圧力を算出して、前記エアマッスルに加える圧力を制御する、駆動機構。
【請求項2】
前記駆動力モデルの前記所定の関数は、前記エアマッスルによる第1の駆動力を、前記エアマッスルに供給される圧力と前記エアマッスルの収縮割合との所定の多項式で表現したものである、請求項1記載の駆動機構。
【請求項3】
前記エアマッスルにおいて、前記エアマッスルと前記ワイヤとの接合部に設けられ、前記エアマッスルからの前記第1の駆動力の大きさを検出するための第2のセンサをさらに備え、
前記制御部は、
前記第2のセンサの検出結果に応じて、前記エアマッスルの前記第1の駆動力および前記電動モータからの前記第2の駆動力とを制御する、請求項1または2記載の駆動機構。
【請求項4】
前記制御部は、前記第2のセンサにより検出された前記第1の駆動力に基づいて、前記力学モデルにより、前記見かけの収縮割合から前記推定収縮割合を算出する、請求項3記載の駆動機構。
【請求項5】
前記エアマッスルは、
流体袋と、
前記流体袋が埋め込まれたらせん状のファイバーとを含み、
圧縮空気が送り込まれて前記流体袋が膨張すると、長手方向に収縮し、
前記駆動力モデルは、前記エアマッスルに供給される圧力と、前記エアマッスルの収縮割合と、常圧における前記エアマッスルの径と、前記らせん状のファイバーの収縮方向に直交する方向に対する巻方向の傾きの角度との関数である、請求項4記載の駆動機構。
【請求項6】
ロボットのフレーム構造の関節にトルクを与えるための駆動機構であって、
前記トルクに対応する駆動力を生成するためのエアマッスルと、
前記関節の関節角を検出するための角度センサと、
前記エアマッスルからの前記駆動力を前記関節に伝達するためのワイヤと、
トルク制御により前記関節を動作させる制御部とを備え、
前記制御部は、前記関節をトルク制御するにあたり、
前記ワイヤを所定のバネ定数で表されるバネとした力学モデルで表現し、前記駆動力を、前記エアマッスルに供給するべき圧力および前記エアマッスルの収縮割合との関係を表す所定の関数による駆動力モデルで表現する場合に、
前記関節に目標トルクを生じさせるための駆動力を目標駆動力とするとき、前記角度センサにより検出される前記関節角から算出される見かけの収縮割合から前記力学モデルを用いて得られる推定収縮割合と前記目標駆動力とに基づき、前記駆動力モデルの逆モデルにより、前記エアマッスルに供給するべき圧力を算出して、前記エアマッスルに加える圧力を制御する、駆動機構。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、ユーザの行う運動を支援するパワーアシストロボットに関するものである。
【背景技術】
【0002】
近年、運動再建などを目的とし、脳情報によって外部のロボットデバイスの制御を行うブレインマシンインタフェース(BMI)に関する研究が注目を集めている(非特許文献1)。一方、バランスや歩行が可能なロボットが開発されてきている。例えば、運動に必要な作用力を空間上の任意の複数接触点に最適に配分し,ヒトと同じように各関節のトルクを発生できるロボットが存在する(特許文献1参照)。
【0003】
また、下肢・体幹運動の支援をめざした外骨格型ロボットがいくつか開発されている。
【0004】
少子化によって引き起こされた少子高齢化社会は、外骨格型ロボットのようなリハビリテーションを支援するロボットの開発をますます要求することとなってきている。たとえば、外骨格型ロボットは、患者の自立生活を促進するリハビリテーションにおいて、脊髄損傷患者のために使用される(たとえば、非特許文献2、3、4、5、6を参照)。
【0005】
これらの外骨格型ロボットのうち、体重を支えるタイプでは、大型の電動モータまたは油圧シリンダが用いられており、ロボット本体の自重も相当大きい。一方、体重を支えないリハビリ用途としては、空圧式の人工筋肉(以下、「エアマッスル」という。)を用いるものがあった。
【0006】
エアマッスルは、その他のアクチュエータと比べて軽量で安価に製造可能で、空圧独特の柔らかさを持つ。その反面、遅れ、非線形性、個体のばらつきなどから、正確な制御には向いていないとされてきた。
【0007】
このようなエアマッスルの問題に対処するために、空圧式のエアマッスルと電動モータとを組み合わせた空電ハイブリッド式アクチュエータも提案されている(特許文献2を参照)。
【0008】
また、より一般には、「パワーアシストロボット」と呼ばれるロボットは、操作者が物体を移動しようとする際、操作する力に基づいてアクチュエータが駆動力を発生させ、操作者の負担を軽減するためのロボットである。主として、上述した介護やリハビリなどの福祉分野の他、工場における組み立てなどの産業分野で多く用いられている。
【0009】
パワーアシストロボットは、装着型と非装着型に分けることができる。上述したような外骨格型ロボットは装着型に分類され、一方で、非装着型としては、ロボットアームなどにおいて、フレーム構造を駆動するアクチュエータとして、モータ、バネ、空気圧シリンダ、油圧シリンダ、エアマッスルなどを使用するものが知られている。
【先行技術文献】
【特許文献】
【0010】
【特許文献1】WO2007/139135号公報
【特許文献2】特開2012−045194号公報
【非特許文献】
【0011】
【非特許文献1】Lebedev, M.A. and Nicolelis, M.A.:”Brain-machine interfaces past,present and future”,Trends in Neuroscience,vol.29,no.9,pp. 536-546,2006.
【非特許文献2】K. Suzuki, M. G. Kawamoto, H. Hasegarwa, and Y. Sankai. Intension-based walking support for paraplegia patients with Robot Suit HAL. Advanced Robotics, Vol. 21, No. 12, pp. 1441-1469, 2007.
【非特許文献3】S. K. Au, P. Dilworth, and H. Herr. An ankle-foot emulation system for the study of human walking biomechanics. In IEEE International Conference on Robotics and Automation, pp. 2939-2945, 2006.
【非特許文献4】H. Kobayashi, A. Takamitsu, and T. Hashimoto. Muscle Suit Development and Factory Application. International Journal of Automation Technology, Vol. 3, No. 6, pp. 709-715, 2009.
【非特許文献5】G. Yamamoto and S. Toyama. Development of Wearable Agri-Robot- Mechanism for Agricultural Work. In IEEE/RSJ International Conference on Intelligent Robots and System, pp. 5801-5806, 2009.
【非特許文献6】T. Kagawa and Y. Uno. Gait pattern generation for a power-assist device of paraplegic gait. In The 18th IEEE International Symposium on Robot and Human Interactive Communication, pp. 633-638, 2009.
【発明の概要】
【発明が解決しようとする課題】
【0012】
空電ハイブリッド式アクチュエータは、相補的なアクチュエータとして、2つの異なるエネルギー源で駆動される駆動機構を利用し、弾性を有する柔軟なトルク制御が可能である。1つの駆動機構は、空圧式エアマッスルを用いた空圧式アクチュエータであって、軽量化に向いている。しかしながら、上述のとおり、空圧式アクチュエータの圧縮性は、コントロールする際には、レスポンスが遅く、非線形力学を引き起こすために制御が難しい。
【0013】
一方で、他の1つの駆動機構である電動式アクチュエータは、速く制御しやすい特性を有している。しかしながら、電動モータを用いた電動式アクチュエータは、大きなトルクを制御しようとすると、アクチュエータのヒートアップや、あるいは、重量の増加を招いてしまう。このため、空電ハイブリッド式アクチュエータにおいても、電動式アクチュエータを大型化することは軽量化に反する結果となる。
【0014】
ここで、非装着型のパワーアシストロボットにおいても、また、上述したようなリハビリテーションを目的とした外骨格型ロボットの場合は特に、軽量化は重要な課題であるので、駆動力源である空圧式エアマッスルや電動モータの軽量化は、もちろんで必要であるが、これらの駆動力源からの力を外骨格型ロボットの関節部に伝達するための伝達機構の軽量化も重要な課題である。
【0015】
しかしながら、伝達機構の軽量化は、制御対象の力学をより複雑化して、制御の困難性を増大させてしまう恐れがある。
【0016】
本発明は、上記のような問題点を解決するためになされたものであって、軽量化を実現しつつ、正確なトルク御を達成することが可能な駆動機構を提供することである。
【課題を解決するための手段】
【0017】
この発明の1つの局面に従うと、ロボットのフレーム構造の能動関節を駆動するための駆動機構であって、能動関節の関節角を検出するための第1のセンサと、能動関節に対するトルク制御により能動関節を動作させる制御部とを備え、能動関節は、エアマッスルと、電動モータと、エアマッスルからの第1の駆動力と電動モータからの第2の駆動力とを合成して能動関節の屈伸を駆動するための駆動力合成手段と、エアマッスルからの第1の駆動力を駆動力合成手段に伝達するためのワイヤとを含み、制御部は、能動関節をトルク制御するにあたり、ワイヤを所定のバネ定数で表されるバネとした力学モデルで表現し、第1の駆動力を、エアマッスルに供給するべき圧力およびエアマッスルの収縮割合との関係を表す所定の関数による駆動力モデルで表現する場合に、能動関節に目標トルクを生じさせるための第1の駆動力を目標駆動力とするとき、第1のセンサにより検出される関節角から算出される見かけの収縮割合から力学モデルを用いて得られる推定収縮割合と目標駆動力とに基づき、駆動力モデルの逆モデルにより、エアマッスルに供給するべき圧力を算出して、エアマッスルに加える圧力を制御する。
【0018】
好ましくは、駆動力モデルの所定の関数は、エアマッスルによる第1の駆動力を、エアマッスルに供給される圧力とエアマッスルの収縮割合との所定の多項式で表現したものである。
【0019】
好ましくは、各エアマッスルにおいて、エアマッスルとワイヤとの接合部に設けられ、エアマッスルからの第1の駆動力の大きさを検出するための第2のセンサをさらに備え、制御部は、第2のセンサの検出結果に応じて、エアマッスルの第1の駆動力および電動モータからの第2の駆動力とを制御する。
【0020】
好ましくは、制御部は、第2のセンサにより検出された第1の駆動力に基づいて、力学モデルにより、見かけの収縮割合から推定収縮割合を算出する。
【0021】
好ましくは、エアマッスルは、流体袋と、流体袋が埋め込まれたらせん状のファイバーとを含み、圧縮空気が送り込まれて流体袋が膨張すると、長手方向に収縮し、駆動力モデルは、エアマッスルに供給される圧力と、エアマッスルの収縮割合と、常圧におけるエアマッスルの径と、らせん状のファイバーの収縮方向に直交する方向に対する巻方向の傾きの角度との関数である
【0022】
この発明の他の局面にしたがうと、ロボットのフレーム構造の関節にトルクを与えるための駆動機構であって、トルクに対応する駆動力を生成するためのエアマッスルと、 関節の関節角を検出するための角度センサと、エアマッスルからの駆動力を関節に伝達するためのワイヤと、トルク制御により関節を動作させる制御部とを備え、制御部は、関節をトルク制御するにあたり、ワイヤを所定のバネ定数で表されるバネとした力学モデルで表現し、駆動力を、エアマッスルに供給するべき圧力およびエアマッスルの収縮割合との関係を表す所定の関数による駆動力モデルで表現する場合に、関節に目標トルクを生じさせるための駆動力を目標駆動力とするとき、角度センサにより検出される関節角から算出される見かけの収縮割合から力学モデルを用いて得られる推定収縮割合と目標駆動力とに基づき、駆動力モデルの逆モデルにより、エアマッスルに供給するべき圧力を算出して、エアマッスルに加える圧力を制御する。
【発明の効果】
【0023】
本発明によれば、アクチュエータによる駆動力の伝達機構を軽量化して、高負荷トルクを正確に制御できる駆動機構を提供できる。
【図面の簡単な説明】
【0024】
図1】本実施の形態における外骨格型ロボット1の構成事例を示す図である。
図2】外骨格型ロボット1の自由度の構成を示す図である。
図3】外骨格型ロボット1のブロック図の例である。
図4】外骨格型ロボットの構成において、1自由度分の動作を行う空電ハイブリッドアクチュエータの部分を抜き出した外観を示す図である。
図5】1自由度分の動作を行う空電ハイブリッドアクチュエータのシステムを制御する構成を説明するための機能ブロック図である。
図6】各アクチュエーターが、関節を動かす態様を説明するための概念図である。
図7】うずくまっている姿勢および直立姿勢における外骨格型ロボットの各関節と、空圧式エアマッスルの状態を示す図である。
図8】空圧式エアマッスルの収縮割合と駆動力との作動範囲を比較して示す図である。
図9】1自由度システムを使用して観察されるトルク制御器の応答特性を示す図である。
図10】空電ハイブリッド式アクチュエータの1自由度の腕のエンドエフェクタの端部に錘がつりさげられた状態での重力補正タスクを示す図である。
図11】外骨格型ロボットが、2つの異なる運動模型を切り替える重力補正によって達成された、起立タスクを支援する動作を示す図である。
【発明を実施するための形態】
【0025】
以下、本発明の実施の形態の外骨格型ロボットの構成について、図に従って説明する。なお、以下の実施の形態において、同じ符号を付した構成要素および処理工程は、同一または相当するものであり、必要でない場合は、その説明は繰り返さない。
【0026】
以下、本実施の形態において、歩行・姿勢リハビリテーションのための空電ハイブリッド式の外骨格型ロボットについて説明する。
【0027】
ただし、本発明の空電ハイブリッド式外骨格型ロボットは、下肢の運動をアシストするための外骨格型ロボットに対してだけでなく、上肢の運動をアシストする外骨格型ロボットとしても使用することが可能である。
【0028】
また、以下の説明では、下肢の対としての運動をアシストする外骨格型ロボットについて説明するが、下肢のうちのいずれか一方、または、上肢のうちのいずれか一方の運動をアシストする外骨格型ロボットとして使用することも可能である。
【0029】
さらに、本発明の空電ハイブリッド式外骨格型ロボットは、対象となる人間の筋骨格系の運動をアシストするのであれば、上述したような「下肢のうちの少なくともいずれか一方、または、上肢のうちの少なくともいずれか一方の運動」に限定されるものではなく、たとえば、対象となる人間の腰の運動のみをアシストするものであってもよいし、歩行または走行時において下肢の運動と連動して腰の運動をアシストするものであってもよい。本明細書では、このような対象となる人間の運動のアシストを総称して、「対象となる人間の筋骨格系運動の支援」と呼ぶことにする。
【0030】
また、本発明の空電ハイブリッド式の駆動機構は、外骨格型ロボットに対してだけでなく、より一般的なパワーアシスト技術に適用し、重量物を扱う作業者の作業をアシストするパワーアシストロボットを実現することも可能である。ただし、以下では、本発明の実施の形態として、「外骨格型ロボット」を例にとって説明する。
【0031】
本実施の形態の外骨格型ロボットは、外骨格を有する。「外骨格」とは、人間の骨格構造に対応してロボットが有する骨格構造のことである。より特定的には、「外骨格」とは、外骨格型ロボットを装着する人間の体の一部を、外部から支えるフレーム(枠組み)構造のことをいう。
【0032】
このフレーム構造には、さらに、フレーム構造の各部を人間の骨格構造に基づく運動に応じて動かすための関節が設けられる。
【0033】
特に、下肢の運動をアシストする外骨格型ロボットは、ベースと下半身とを有し、足首、膝、腰の左右の位置に、能動6自由度の関節を有するロボットである。また、当該6つの関節は、空電ハイブリッド駆動の関節である。以下、このように、外骨格型ロボットにおいて、アクチュエータにより駆動される関節のことを「能動関節」と呼ぶ。
【0034】
図1は、本実施の形態における外骨格型ロボット1の構成事例を示す図である。本外骨格型ロボット1は、10自由度である。
【0035】
図1において、図1(a)は、外骨格型ロボットの外観を示す図であり、図1(b)は、図1(a)の外観において、外骨格型ロボット1の主要部を抽出して示す斜視図である。
【0036】
図1(b)において、外骨格型ロボット1は、両脚に対応したフレーム構造、バックパック101、柔軟シート102、HAA拮抗筋103、HFE伸筋104、HFEモータ111、KFE伸筋105、 KFEモータ106、AFE伸筋107、AFE屈筋108、ジョイント109、フレーム構造に設けられたプーリー付回転関節110を備える。
【0037】
なお、図1(b)では、バックパック101が運動を支援する構造に直接とりつけられているが、図1(a)に示すように、バックパック101は、この構造から取り外されていてもよい。
【0038】
また、プーリー付回転関節110には、たとえば、光学式エンコーダを回転軸に取り付け、関節角度を計測する。光学式エンコーダは、軸に取り付けるのではなく、軸に巻かれたベルトの移動方向と移動量を読み取る構成としてもよい。なお、ハイブリッド関節であるHFEおよびKFE関節においては、モータ付属のエンコーダを用いて関節角度を計測してもよい。ジョイント109は、AAA関節に相当し、この構成では、駆動機構は取り付けられず、受動的な関節となっている。
【0039】
図2は、外骨格型ロボット1の自由度の構成を示す図である。
【0040】
図2において、各関節において、「R_」との表示は、右側の関節であることを示し、「L_」との表示は、左側の関節であることを示す。
【0041】
図1および図2を参照して、全10自由度のうち、HFE関節とKFE関節はハイブリッド駆動としている。また、図2において、全10自由度のうち、左右のAFE関節は伸筋と屈筋による拮抗駆動を採用している。ハイブリッド駆動および拮抗駆動以外の関節は、パッシブな駆動である。ただし、より多くの関節、たとえば、全ての関節をハイブリッド駆動としてもよい。
【0042】
図1において、両脚が接続する胴体部には姿勢センサを搭載してベース部の姿勢を検出している。また、全ての関節にワイヤ式エンコーダ(またはモータ付属のエンコーダ)を取り付け、関節角度を計測できるようにしている。ベースの姿勢と関節角度を検出することで、重心から接触部への正確なヤコビ行列が算出でき、各関節に発生させる目標トルクが算出できる。
【0043】
また、足底部には、床反力センサを搭載し、接触を想定する足底部が実際に接触しているかどうかを判定したり、ヤコビ行列に含まれるモデル誤差を修正するために補助的に使用する構成としてもよい。
【0044】
このようなヤコビ行列を用いた順運動学モデルに基づいて、目標作用力から夫々のアクチュエータに配分するトルク値を算出する方法については、たとえば、上述した特許文献1に開示がある。
【0045】
また、バックパック101内には制御器の他、エアマッスルのバルブおよび電動モータのドライバを内蔵している。
【0046】
また、バックパック101内に、バッテリーと圧搾したCOガスボンベ、レギュレータを搭載し、電源ラインとエア供給が断絶した場合に備え、短時間の自律駆動を可能にする構成であってもよい。
【0047】
また、図3は、外骨格型ロボット1のブロック図の例である。
【0048】
外骨格型ロボット1を制御するためのコマンドが、外部制御装置20から、通信経路を介して外骨格型ロボットに与えられる。特に限定されないが、外部制御装置20は、汎用のパーソナルコンピュータを用いることが可能であり、通信経路としては、イーサネット(登録商標)ケーブルを用いることができる。もちろん、通信経路としては、その他の規格の有線通信の経路の他、無線による通信経路、たとえば、無線LAN(Local Area Network)や他の通信規格の無線などを使用してもよい。
【0049】
外部制御装置20は、ユーザからの指示入力を受ける入力部210と、コマンドを生成するためのプログラムや、様々な制御パラメータなど制御のために必要とされるデータが記録された不揮発性の記憶装置206と、外部制御装置20を起動するためのファームウェアが記憶されたROM(Read Only Memory)や、ワーキングメモリとして動作するRAM(Random Access Memory)などを含むメモリ204と、プログラムに応じて、コマンドを生成する処理を実行する演算装置208と、コマンドを通信経路を介して、外骨格型ロボットに送信するためのインタフェース(I/F)部202と、演算装置208の制御の下で、外骨格型ロボット1への制御の状態に関する情報などを表示するための表示装置212とを備える。
【0050】
上述のとおり、外部制御装置20が、汎用のパーソナルコンピュータである場合は、演算装置208は、CPU(Central Processing Unit)で構成され、不揮発性の記憶装置206としては、ハードディスクドライブやソリッドステートドライブなどを用いることができる。ただし、外部制御装置20の機能ブロックの一部または全部は、専用のハードウェアにより構成されてもよい。
【0051】
また、外部制御装置20は、外骨格型ロボットが装着されるユーザの脳情報を検出し、外骨格型ロボットを制御するコマンドを生成する装置であってもよい。この場合は、いわゆるブレイン・マシン・インタフェースにより、外骨格型ロボットが制御されることになる。
【0052】
外骨格型ロボット1は、外骨格部12、内部制御装置10を備える。
【0053】
外骨格部12は、ベース121、下半身122、能動関節123、検出機構124を備える。さらに、能動関節123は、エアマッスル1231(図示せず)、電動モータ1232(図示せず)を備える。
【0054】
また、内部制御装置10は、I/F部11、記録装置131、記憶装置 132、計測装置133、制御部134、出力装置135を備える。
【0055】
I/F部11は、外部制御蔵置20から指令された、あるいは、脳情報から復号化されたトルクまたは位置指令等を受け付けることができる。ここで、脳情報とは、例えば、右足を上げることを示す情報や、歩くことおよび歩く速度を示す情報、さらには、特定の関節のトルク値を含む、体幹・下肢部の運動を規程する情報である。
【0056】
なお、ベース121は、腰の位置の骨格、腰の位置の能動関節123を含むと考えても良いし、腰の位置の骨格のみであると考えても良い。
【0057】
下半身122は、腿や足の位置の骨格、腿や足の位置の能動関節123を含むと考えても良いし、腿や足の位置の骨格のみであると考えても良い。
【0058】
能動関節123は、左右の足首、左右の膝、および腰の左右の各位置に配置されている能動の関節である。ここで、能動関節123とは、アクチュエータで能動的に動作することのできる関節である。つまり、能動関節123は、アクチュエータを備える。
【0059】
また、ここでの1以上の能動関節123は、ハイブリッド型である。つまり、能動関節123の少なくとも一部のものは、エアマッスル1231、電動モータ1232を備えるハイブリッド型である。なお、アクチュエータは、制御目標値となるトルク値を駆動信号として受け付け、受け付けたトルク値に基づいて制御する機能を有している。
【0060】
アクチュエータとして、サーボモータを使用する場合、アクチュエータは、例えば、電流制御が可能な駆動回路を有し、電流に比例したトルクを発生させるサーボモータは、制御目標値として入力されたトルク値に、ギヤ比により決定されるトルク定数を乗じて駆動回路に指令することで入力されたトルクを発生させるトルク制御を実現する。特に、能動関節123にトルクセンサを配設し、当該トルクセンサにより検出した値を駆動回路にフィードバックすることにより、高精度のトルク制御が可能となる。
【0061】
検出機構124は、ロボットの状態を検出する。検出機構124は、例えば、各関節に配置されたエンコーダ、足平に配置された床反力センサ、骨盤部に配置された姿勢検出のためのジャイロセンサ、各エアマッスルの駆動力を検知するロードセルなどである。検出機構124は、関節の角度を検出する角度センサや、ロボットの姿勢を取得する姿勢センサ、外力センサなどでも良い。
【0062】
内部制御装置10は、能動関節123を動作させる。内部制御装置10は、I/F部11が受け付けたトルクまたは位置指令等に対応して、能動関節123を動作させる。内部制御装置10は、例えば、目標とする床作用力を、ヤコビ行列にて規定される順運動学モデル等に基づいて、各能動関節123を駆動する夫々のアクチュエータの夫々のトルク値に変換し、変換した夫々のトルク値を各アクチュエータに制御目標値として出力する。
【0063】
計測装置133は、センサ等の検出機構124から検出結果を示す様々な信号(データ)を受け付ける。
【0064】
制御部134は、制御目標値の算出等の様々な演算を行う。制御部134が行う演算は後に説明する。
【0065】
出力装置135は、能動関節123に制御信号を出力する。出力装置135は、例えば、目標とするトルク値を能動関節123に出力する。
【0066】
(空電ハイブリッド式アクチュエータ用のトルク制御器)
以下では、空電ハイブリッド式アクチュエータ用のトルク制御器の構成について説明する。
【0067】
以下に説明するように、このような制御器は、制御部134に対して、機械学習を実行させることにより、実行させる構成とすることが可能である。
【0068】
空圧式エアマッスルは軽量であるもの、圧縮空気(または圧縮気体)のエネルギーをゴムチューブにより収縮力に変換することにより大きな力を生み出すことができる。
【0069】
エアマッスルが、力を発生させる原理は、空圧式の空気袋が埋め込まれたらせん状のファイバーが、圧縮空気が送り込まれて空気袋が膨張すると、長手方向(縦方向)に収縮するというものである。
【0070】
より詳しく説明すると、両端部に栓をしたゴムチューブに対して、動径方向を拘束するよう、表面にらせん状にまかれたファイバーを被せた構造になっている。このゴムチューブの中に空気を送り込むと、空気の圧力でゴムチューブが膨張する。しかし、動径方向はファイバーによって拘束されているため膨張できず、径方向の膨張に引っ張られて縦方向に収縮する。膨らみながら収縮する様が動物の筋肉に似ているところが人工筋肉と呼ばれる。
【0071】
アクチュエーター自体が軽く、柔らかい。さらに、ゴムチューブの内面全体がアクチュエーターの収縮に寄与するため、断面積のみで圧力を受ける構造になっている一般的なエアシリンダー等よりも、パワー・ウェイト・レシオを大きく取りやすい。反面、上述したように、一般に空気圧による機器制御は空気の収縮・膨張などによる、制御遅れが大きく、素早い動作は苦手である。
【0072】
なお、「空気袋」は、流体により膨張ないし収縮運動をするものであれば、袋中に流入するものは、空気に限られないので、より一般には、「流体袋」と表現する。
【0073】
図4は、外骨格型ロボットの構成において、1自由度分の動作を行う空電ハイブリッドアクチュエータの部分を抜き出した外観を示す図である。
【0074】
図4において、空圧式エアマッスルのうち上側のエアマッスル302は、屈筋(PAM1)に相当し、下側のエアマッスル304ものは伸筋(PAM2)に相当する。
【0075】
伸筋PAM2は、屈筋PAM1とは相反し反対向きの力を生成する。
【0076】
プーリー付回転関節310には、電動モータからの駆動力も印加され、空圧式エアマッスルからの駆動力と電動モータからの駆動力とが合成される。
【0077】
エアマッスル302からの駆動力は、ワイヤ306によりプーリー付回転関節310に伝達され、エアマッスル304からの駆動力は、ワイヤ308によりプーリー付回転関節310に伝達される。このような構成により、駆動力の伝達機構自体を軽量化することが可能となる。
【0078】
プーリー付回転関節310へ加えられた駆動トルクにより、脚(または腕)350が駆動される。
【0079】
図5は、図4に示した1自由度分の動作を行う空電ハイブリッドアクチュエータのシステムを制御する構成を説明するための機能ブロック図である。
【0080】
図5においては、内部制御装置10は、マルチファンクションボード(Multi Function board)として構成される。
【0081】
外部制御装置20に接続されたマルチファンクションボード10は、外部制御装置20からのコマンドに応じて、アクチュエーターを制御する。具体的には、マルチファンクションボード10は、空圧式エアマッスル302および304の収縮を制御するためのバルブ301とバルブ302、ならびに、電動モータ312を制御するためのモータドライバ311を制御する。さらに、マルチファンクションボード10は、関節角度θを検知する角度エンコーダ324およびエアマッスルからの駆動力を検知するロードセル、能動関節に加わるトルクを検知するトルクセンサからの計測データを読み取ることで、これらに基づき、以下に説明するような制御を実行する。
【0082】
角度エンコーダ324は、たとえば、直交エンコーダを使用することが可能である。
【0083】
エアマッスル302および304ならびに電動モータ312からの駆動力は、プーリー付回転関節310において合成され、脚350にトルクτを与える。
【0084】
図6は、各アクチュエーターが、関節を動かす態様を説明するための概念図である。
【0085】
以下では、まず、図6(a)に示されるように、腱ワイヤの伸長を無視できる場合を考える。
【0086】
空圧式エアマッスルフォースからの駆動力fPAMi(i=1,2,…)は、ワイヤとプーリにより、腕(または脚)にトルクとして転送され/変換される。このプーリーを介して、電動モータの駆動力も伝達される。空圧式エアマッスルフォースからの駆動力fPAMiは、空圧式エアーマッスルと駆動力をプーリーに伝達するワイヤーとの接合部に設けられたロードセルにより検知される。
【0087】
以下のモデルの説明は、拮抗筋と電動モータの組合せの場合に限らず、たとえば、伸筋と電動モータの組合せにも広く適用することが可能である。ただし、以下では、説明の簡単のために、単純な2つの拮抗筋のモデルを考える。
【0088】
トルクτPAMは、駆動力fPAMiにより、以下の式ように表される。
【0089】
【数1】

【0090】
モーターの駆動力によるトルクは、空圧式エアマッスルの駆動力と並行して伝達される。例えば、小さなトルクが機械的なベルトによりプーリー経由で伝達される。
【0091】
空圧式エアマッスルは、直流的または低周波のトルクの生成において優れている。また、電動モータによる駆動力は、迅速で周波数の高いトルクとして、空圧式エアマッスルの駆動力によるトルクτPAMの誤差をカバーするので、電動式のトルクτmotorの値は、空圧式エアマッスルによるトルクよりも小さな値でよい。
【0092】
トータルのトルクは、以下の式で表される。
【0093】
τ=τPAM+τmotor
したがって、特に限定されないが、たとえば、内部制御装置10が、第一の閾値よりも(「より」は「以上」も含む、とする)高周波であるトルクに対して電動モータ312を追加動作させることは好適である。 なお、追加動作とは、エアマッスル302および304に加えて電動モータ312を動作させることである。ここで、第一の閾値は、例えば、3Hzである。
【0094】
空圧式エアマッスルから、ワイヤがプーリーへ駆動力を伝達し、指定された一方向へ関節を駆動する。
【0095】
ワイヤとしては、金属線、チェーンあるいは機械的なベルトなどの方式と比較して、軽量で強く、柔軟であるので、液晶ポリマー繊維を採用することができる。液晶ポリマー繊維としては、たとえば、クラレ社製ベクトラン(登録商標)を用いることができ、これは、高分子繊維であるにも関わらず、高強力高弾性率を有する素材として知られている。
【0096】
(空圧式エアマッスルの力学モデル)
空圧式エアマッスル、ワイヤおよびプーリを含む空圧式アクチュエーターは、人間の筋肉と多くの共通点を持っている。
【0097】
外骨格型ロボットが人間の重さを支持する際に、ワイヤは、その特性において、人間の腱に類似している。
【0098】
そこで、以下に説明するように、平衡の仮定を置いて、空圧式エアマッスルのためのトルク制御器を導出する。
【0099】
空圧式エアマッスルの圧力の制御には、たとえば、比例的に圧力を調整するバルブを使用し、圧力pはクローズドフィードバックループにより制御され、十分に安定であるものとする。
【0100】
過渡状態においては、バルブ圧力と空圧式エアマッスルの圧力との間には、空気力学的な運動が存在するものの、一定の時定数の後には、ロボットと人間の重量のような外部の運動上の制約条件に駆動力が釣り合うまで、空圧式エアマッスルは収縮する。
【0101】
したがって、空気回路の動力学の影響は小さく、準静的な動作では無視することができる。
【0102】
この均衡点で、駆動力の生成は、内圧および収縮割合に依存し、空圧式エアマッスルの駆動力モデルは、以下のように与えられる:
【0103】
【数2】
ここで、εは、収縮割合であり、Dとψとは、常圧における空圧式エアマッスルの径と、空圧式エアマッスルにおいて、空圧式の空気袋が埋め込まれたらせん状のファイバーの収縮方向に直交する方向に対する巻方向の傾きの角度である。
【0104】
このような「空圧式エアマッスルの駆動力モデル」は、たとえば、以下の文献に開示されている。
【0105】
文献1:K. Inoue. Rubbertuators and applications for robots. In Proceedings of the 4th international symposium on Robotics Research, pp. 57-63. MIT Press, 1988.
文献2:D.G. Caldwell, A. Razak, and MJ Goodwin. Braided pneumatic muscle actuators. In Proceedings of the IFAC Conference on Intelligent Autonomous Vehicles, pp. 507-512, 1993.
空気シリンダーと異なり、関節角が変化することによってトルクは非線形に変化する。
運動上の制約条件が常に不変であるという仮定の下では、空圧式エアマッスルの圧力は常に同じ均衡点での収縮割合ε(p)を与えることになる。すなわち、収縮割合ε(p)は、圧力pの関数となる。
【0106】
このとき、このような「空圧式エアマッスルの駆動力モデル」の逆モデルは、機械学習により学習することができる。すなわち、所望の駆動力fを得るための圧力pを求めることに相当する。内部制御装置10は、このような圧力pをエアマッスルに与えるように、バルブを制御することで、所望の駆動力を出力させることになる。
【0107】
例えば、ハートマン等は、動力学的な学習について、以下の文献で提案している。
【0108】
文献3:Christoph Hartmann, Joschka Boedecker, Oliver Obst, Shuhei Ikemoto, and Minoru Asada. Real-time inverse dynamics learning for musculoskeletal robots based on echo state gaussian process regression. In Accepted at RSS 2012, 2012.
しかしながら、一般的には、運動上の制約条件をダイナミックに変更し、異なる外力Fと釣り合うので、この仮定は、上述したような外骨格型ロボットにおいては、厳密には成り立たない。
【0109】
したがって、この場合の均衡点での収縮割合εは、圧力と外力の関数として、ε(p,F)と表現される。
【0110】
(腱スプリング均衡モデル)
上述したような液晶ポリマー繊維製のワイヤは、高強力高弾性率を有するので、通常は、張力に対して長さが変化しないとの近似がよく成り立つ。高強度・高弾性率繊維としては、ベクトラン(登録商標)のようなポリアリレート繊維の他に、たとえば、超高分子量ポリエチレン繊維、PBO繊維などがある。
【0111】
しかし、人間(たとえば、体重は60kgある)を保持するためには、空圧式エアマッスルは、張力として、典型的には、3000Nを生成する(最大値としては、たとえば、5000Nが必要になる)。
【0112】
このような大きな力が加わると、たとえ、液晶ポリマー繊維製のワイヤ(腱ワイヤ)であっても、その伸長量が無視できず、均衡点を変化させてしまう。
【0113】
以下では、図6(b)に示すように、腱ワイヤの伸長の影響を考慮したモデルを検討する。
【0114】
そこで、液晶ポリマー繊維製の腱の力学モデルとして、以下に説明するような、線形の腱スプリング・モデルを導入する。
【0115】
f=kΔε (2)
すなわち、このモデルでは、腱ワイヤ(ポリアリレート繊維などの液晶ポリマー繊維製のワイヤ)は、バネに近似され、Δεは、力によって引き起こされた余分なエアマッスルの収縮であり、kはばね定数である。つまり、腱が力によって伸びる分、空圧式エアマッスルは、余分に収縮することが必要になる。このようにバネに近似される腱ワイヤのことを「腱スプリング」と呼ぶことにする。
【0116】
このような腱に相当するワイヤを、腱スプリングとして近似しない場合、空圧式エアマッスルの駆動力モデルg()は3つのパラメーター(そのうちの2つは依存関係にある)を備えた以下の二次式(3)で表される:
【0117】
【数3】
ここで、
2次式の係数には、以下の関係が成り立つ。
【0118】
【数4】
均衡点で、駆動力fは、腱の伸長によって、以下のように減少する。
【0119】
【数5】
ここで、g´()が腱スプリングの仮定の下での駆動力モデルであり、εは、見かけの収縮割合であり、εは、空圧式エアマッスルの実際の収縮割合であり、Δεは、空圧式エアマッスルの実際の収縮割合への付加項である。
【0120】
式(2)から、Δε=f/k となる。
【0121】
実際の収縮割合εは、上述したような外骨格型ロボットの検出機構124では、直接測定するのが困難である。したがって、その代りに、推定収縮割合εest(=ε+Δε)を使用する。収縮割合εは、以下の式のように、関節角から計算される。
【0122】
【数6】
ここで、Lは、関節角θ=0のときの空圧式エアマッスルの初期長さである。つまり、「見かけの収縮割合」とは、アクチュエータにより駆動される関節の角度変化から導かれる収縮割合であって、角度センサから検知できる量に基づく収縮割合であるのに対して、「実際の収縮割合」とは、駆動力fを生成するために、エアマッスルが現実に収縮している割合のことである。
【0123】
収縮割合εにおいて、駆動力fが必要とされる場合、逆モデルg−1()から、必要な圧力pが、以下のようにして導出される。
【0124】
【数7】
最小二乗アルゴリズムを使用して、既知の空圧式エアマッスルのデータから、空圧式エアマッスルパラメーターa、bおよびcを評価できる。
【0125】
さらに、たとえば、キャリブレーション実験で、1自由度システムによって均衡点駆動力を測定する際に、バネ定数kについては、手動で調整することで最適値を実験的に求めることができる。
【0126】
運動をアシストする主要なトルク(所定の周波数以下の成分のトルク、たとえば、直流成分のトルク)は、空圧式エアマッスルによって供給され、実際のトルクτPAMsは、ロードセルにより測定することができる。上述したように、高周波トルク(所定の周波数を超える成分のトルク:交流成分のトルク)は電動モータによって生成される。
【0127】
したがって、モータのトルクは以下の式(7)のように表現される。
【0128】
【数8】
以上のようにして、腱スプリングモデルを腱ワイヤに適用することにより、関節角と腱ワイヤに印加される駆動力を検知する構成において、空圧式エアマッスルの駆動力を正しく反映した逆モデルを、たとえば、機械学習により、構築することが可能となる。その結果、空電アクチュエータを制御する際に、以下に説明するように、その周波数応答性を向上させることが可能となる。
(起立動作を支援する鉛直力の生成)
以下では、外骨格型ロボットにより、鉛直方向の運動、たとえば、起立動作を支援する構成について説明する。
【0129】
鉛直方向の運動を支援する外骨格型ロボットの力(アシスト力)は、次のように生成される。
【0130】
【数9】
ここでJは、ロボットによるアシスト力と外骨格型ロボットの各関節へのトルクとを関連付けるヤコビ行列であり、Fは、起立動作を支援する仮想力Fである。
【0131】
ここでは、鉛直方向の力のみを考慮し、水平方向の力は、ユーザーの上体の動作によって生成されると考える。
【0132】
図7は、うずくまっている姿勢(図7(a))および直立姿勢(図7(b))における外骨格型ロボットの各関節と、空圧式エアマッスルの状態を示す図である。
【0133】
図7(a)に示すように、より低くうずくまっている姿勢では、空圧式アクチュエータは大きな張力を生成する。
【0134】
図7(b)に示すように、直立姿勢では、バランスをとり姿勢を保持するために必要とされるトルクは、小さい。
【0135】
図8は、空圧式エアマッスルの収縮割合と駆動力との作動範囲を比較して示す図である。
【0136】
図8では、腱スプリング・モデル有りのモデルおよび腱スプリング・モデルなしの空圧式アクチュエータモデル(PAMオリジナルモデル)を比較して示し、各収縮割合で発生する力の測定結果も示す。図中、vは、圧力制御バルブの制御電圧を表し、エアマッスル内の圧力と比例関係を有する。
【0137】
腱スプリングモデルを考慮することにより、トルク制御器は、特に、駆動力の大きな範囲で、測定された駆動力をよく再現しているのがわかる。
【0138】
図9は、1自由度システムを使用して観察されるトルク制御器の応答特性を示す図である。
【0139】
図9においては、制御目標としての入力である所望のトルクはサイン波であり、空圧式エアマッスルのみの特性を考慮した場合と、腱スプリングモデルとを比較して示す。
【0140】
反力を発生するエアマッスル(伸筋)の圧力を最大値(0.6Mpa)に維持した状態で、屈筋のエアマッスルにサイン波のトルクを発生させるように、制御器に信号を入力している。このような信号入力により、関節が駆動される。
【0141】
図9では、腱スプリングモデルにおいて、周波数応答における時間遅れをほぼ変化させることなく、より所望のトルクに近いトルクを発生できていることがわかる。
【0142】
なお、図9では、腱スプリングを考慮しない従来のエアマッスルのみのモデル(PAMオリジナルモデル)との対比のために、空圧式エアマッスルを駆動させることによる腱スプリングモデルの時間応答を比較している。ただし、空電ハイブリッド駆動の場合、上述のとおり、所望のトルクとエアマッスルの駆動力によるトルクと誤差は、電動モータによるトルクによりカバーされるので、空電ハイブリッド駆動では、トータルのトルクとしては、所望のトルクを得ることができる。
【0143】
図10は、空電ハイブリッド式アクチュエータの1自由度の腕のエンドエフェクタの端部に錘がつりさげられた状態での重力補正タスクを示す図である。
【0144】
空電ハイブリッド式アクチュエータとしては、図4に示した構成のものを使用する。
【0145】
各図は、動画から、残像のある静止画として抽出したものである。
【0146】
図10(a)に示すように、10kgの錘を吊り下げている状態で、腱スプリングモデルを利用した制御器で、重力を補償して、腕を下方に向く角度としておく。
【0147】
次に、図10(b)に示すように、指1本でも、腕を上方向に動かすことが可能である。
【0148】
さらに、図10(c)に示すように、重力が補償されているため、腕は、上方を向く角度のまま、静止する。
【0149】
ここで、このような制御器は、位置/アングル制御器ではなく、あくまで、トルク制御器であるにも関わらず、図10(a)〜(c)のような動きをすることが可能である。
【0150】
図11は、外骨格型ロボットが、2つの異なる運動模型を切り替える重力補正によって達成された、起立タスクを支援する動作を示す図である。
【0151】
図11(a)〜(b)に示すように、腰かけた状態を初期状態とすると、初めは、外骨格型ロボットは、ロボットの運動のみを考慮して、ロボット重量に対するトルクを生成する。
【0152】
次に、図11(c)に示すように、運動モデルを、ロボットと人間の脚との双方を考慮したものに切り替えることで、人間は、上方向へのアシスト力を受け取ることになり、ユーザは、起立動作をアシストされる。
【0153】
以上説明したように、以上、本実施の形態によれば、空圧の人工筋(エアマッスル)と電動モータとを組み合わせ、駆動力の伝達機構を軽量化して、歩行や姿勢の機能回復やアシストに必要な高負荷トルクを正確に制御できる外骨格型ロボットを提供できる。
【0154】
より特定的には、本実施の形態の外骨格型ロボットを、下肢の運動のアシストに使用することで、体幹・下肢部の運動支援を適切に行えるという効果を有し、歩行や姿勢のリハビリテーションのための外骨 格型ロボット等として有用である。
【0155】
また、以上の説明では、外骨格ロボットを例にとって説明してきたが、本発明はこのような場合に限定されず、フレーム構造(たとえば、ロボットアームの骨格構造)とこのフレーム構造の各能動関節を空電ハイブリッド駆動するロボットであれば、適用可能なものである。たとえば、重量物を搬送することの多い作業現場などにおいて、作業者とは独立してその重量物を懸下することで重量物の重さを軽減し、作業者による重量物の所望の方向への移動と正確な組み付けを可能とするパワーアシストロボットなどにも適用することが可能である。
【0156】
今回開示された実施の形態は、本発明を具体的に実施するための構成の例示であって、本発明の技術的範囲を制限するものではない。本発明の技術的範囲は、実施の形態の説明ではなく、特許請求の範囲によって示されるものであり、特許請求の範囲の文言上の範囲および均等の意味の範囲内での変更が含まれることが意図される。
【符号の説明】
【0157】
1 外骨格型ロボット、10 内部制御装置、11 I/F部、12 外骨格、20 外部制御装置、121 ベース、122 下半身、123 能動関節、124 検出機構、131 記録処理部、132 記憶装置、133 計測装置、134 制御部、135 出力装置、302,304 エアマッスル、310 プーリー付回転関節、312 電動モータ。
図1
図2
図3
図4
図5
図6
図7
図8
図9
図10
図11