特開 2022-47779 ロボット装置

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公開特許公報(A)

(11)【公開番号】P2022047779

(43)【公開日】2022-03-25

(54)【発明の名称】ロボット装置

(51)【国際特許分類】

   B25J 13/00 20060101AFI20220317BHJP

【ＦＩ】

B25J13/00 Z

【審査請求】未請求

【請求項の数】5

【出願形態】ＯＬ

(21)【出願番号】P 2020153747

(22)【出願日】2020-09-14

(71)【出願人】

【識別番号】000000011

【氏名又は名称】株式会社アイシン

(74)【代理人】

【識別番号】110000017

【氏名又は名称】特許業務法人アイテック国際特許事務所

(72)【発明者】

【氏名】辰野 仁嗣

(72)【発明者】

【氏名】浅井 雅広

(72)【発明者】

【氏名】梅村 哲央

(72)【発明者】

【氏名】▲高▼田 亮

【テーマコード（参考）】

3C707

【Ｆターム（参考）】

3C707BS10

3C707DS01

3C707HS21

3C707KS21

3C707KS35

3C707KX05

3C707LU07

3C707LV22

3C707MT01

(57)【要約】

【課題】適合処理や実際の制御を煩雑化させることなく、ヒステリシス特性を有する人工筋肉を含むロボット装置を適正に作動させる。
【解決手段】本開示のロボット装置は、関節を介して連結された２つのリンクと、液体の供給を受けて２つのリンクを相対的に回動させる少なくとも１つの人工筋肉と、人工筋肉に液体を供給する液体供給装置と、予め定められた人工筋肉の静特性に基づいて当該人工筋肉に供給される液圧の目標圧力を設定すると共に、当該目標圧力に基づいて液体供給装置を制御する制御装置とを含み、当該制御装置は、関節の現在角度の目標角度に対する追従性が許容範囲外にあるときに、目標角度と現在角度との差に基づいて目標圧力を設定すると共に、当該目標圧力に基づいて液体供給装置を制御する。
【選択図】図１０

【特許請求の範囲】

【請求項1】

関節を介して連結された２つのリンクと、液体の供給を受けて前記２つのリンクを相対的に回動させる少なくとも１つの人工筋肉と、前記人工筋肉に前記液体を供給する液体供給装置とを含むロボット装置であって、
予め定められた前記人工筋肉の静特性に基づいて前記人工筋肉に供給される液圧の目標圧力を設定すると共に、前記目標圧力に基づいて前記液体供給装置を制御する制御装置であって、前記関節の現在角度の目標角度に対する追従性が許容範囲外にあるときに、前記目標角度と前記現在角度との差に基づいて前記目標圧力を設定すると共に、前記目標圧力に基づいて前記液体供給装置を制御する制御装置を備えるロボット装置。

【請求項2】

請求項１に記載のロボット装置において、
前記制御装置は、前記追従性が前記許容範囲外にあるときに、前記目標角度と前記現在角度との前記差が大きくなるにつれて高くなるように前記目標圧力を設定するロボット装置。

【請求項3】

請求項１または２に記載のロボット装置において、
前記人工筋肉は、前記液体が供給された際に径方向に膨張しながら軸方向に収縮するチューブを含み、
前記静特性は、前記チューブに供給される前記液圧ごとに、前記チューブの収縮率と前記チューブの収縮により発生する収縮力との関係を規定するロボット装置。

【請求項4】

請求項３に記載のロボット装置において、
前記静特性は、前記チューブに供給される前記液圧ごとに、軸方向に収縮する前記チューブの収縮率と軸方向に伸長する前記チューブの収縮率とが同一になったときに両者が発生する収縮力の平均をとることにより作成されるロボット装置。

【請求項5】

請求項３または４に記載のロボット装置において、
前記制御装置は、
前記２つの前記リンクを相対的に回動させるための目標トルクを設定する目標トルク設定部と、
前記関節の前記現在角度に基づいて前記人工筋肉の収縮率を設定する収縮率設定部と、
前記目標トルク設定部により設定された前記目標トルクに基づいて前記人工筋肉の収縮力を算出する収縮力算出部と、
前記静特性を用いて前記収縮率設定部により設定された前記収縮率と前記収縮力算出部により算出された前記収縮力とに対応した第１圧力を設定する第１圧力設定部と、
前記追従性が前記許容範囲内にあるときに、第２圧力にゼロを設定すると共に、前記追従性が許容範囲外にあるときに、前記目標角度と前記現在角度との差に基づいて前記第２圧力を設定する第２圧力設定部と、
前記第１圧力設定部により設定された前記第１圧力と前記第２圧力設定部により設定された前記第２圧力との大きい方を前記目標圧力に設定する目標圧力設定部とを含むロボット装置。

【発明の詳細な説明】

【技術分野】

【0001】

本開示は、液体の供給を受けて作動する人工筋肉と、当該人工筋肉に液体を供給する液体供給装置とを含むロボット装置に関する。

【背景技術】

【0002】

従来、複数の弾性膨張収縮構造体（人工筋肉）と、それぞれ対応する一対の弾性膨張収縮構造体により回転駆動される複数の関節軸と、物体把持用のハンドと、複数の３ポート流量制御電磁弁（駆動装置）とを含む２自由度のロボットアームである弾性体アクチュエータ駆動機構が知られている（例えば、特許文献１参照）。この弾性体アクチュエータ駆動機構の各弾性膨張収縮構造体は、ゴム材料で構成された中空の管状弾性体と、当該管状弾性体の外表面を覆う網目状の変形方向規制部材とを含む。管状弾性体の両端部は封止部材により気密封止され、管状弾性体の内部には、一端側の封止部材に設けられた管状の流体通過部材を介して空気等の圧縮性流体が供給される。管状弾性体は、内部に圧縮性流体が供給された際に主に半径方向に膨張しようとするが、変形方向規制部材の作用により管状弾性体の変形方向の運動が軸方向の運動に変換される。これにより、圧縮性流体の供給により管状弾性体を収縮させることで、弾性膨張収縮構造体を直動アクチュエータとして利用することができる。更に、第１および第２関節軸をそれぞれ対応した一対の弾性膨張収縮構造体の拮抗駆動により正逆に回転させることで、物体把持用のハンドを移動させることが可能となる。

【0003】

上記従来の弾性体アクチュエータ駆動機構では、予め作成された動作プログラムに従って設定される目標関節角度ベクトルと、エンコーダにより計測される関節角の現在値（関節角度ベクトル）との差である角度誤差ベクトルから角度誤差修正指令値が算出される。また、目標関節角度ベクトルから目標角加速度が計算により求められ、当該目標角加速度と角度誤差ベクトルとから修正目標角加速度が計算により求められる。また、修正目標角加速度と、弾性体アクチュエータ駆動機構の各リンクまたは搬送物体の質量、重心位置、若しくは慣性行列といったダイナミクスパラメータとから、搬送物体および弾性体アクチュエータ駆動機構の質量にかかる重力項を含む目標関節トルクが算出される。更に、目標関節トルクと上記関節角度ベクトルとから、関節軸ごとに弾性膨張収縮構造体の目標圧力値が算出されると共に、当該目標圧力値と圧力センサにより計測される弾性膨張収縮構造体（管状弾性体）の内圧（空気の圧縮率）との差である圧力誤差が算出される。そして、圧力誤差から圧力差誤差修正出力が算出され、当該圧力差誤差修正出力は、各３ポート流量制御電磁弁に電圧指令値として与えられる。これにより、各関節軸が対応する一対の弾性膨張収縮構造体によって独立して回転駆動されることになる。

【先行技術文献】

【特許文献】

【0004】

【特許文献1】国際公開第２０１２／０８１１９７号

【発明の概要】

【発明が解決しようとする課題】

【0005】

ここで、中空の管状弾性体を含む弾性膨張収縮構造体は、いわゆるヒステリシス特性、すなわち、管状弾性体内の圧力および収縮率が同一であっても、管状弾性体が軸方向に収縮するときと管状弾性体が軸方向に伸長するときとで発生する収縮力が異なる特性を有する。しかしながら、上記特許文献１では、弾性膨張収縮構造体のヒステリシス特性が考慮されておらず、圧力センサにより検出される管状弾性体の内圧に基づいて流量制御電磁弁が精度よく制御されたとしても、弾性膨張収縮構造体の出力不足により弾性体アクチュエータ駆動機構を適正に作動させ得なくなることがある。一方、ヒステリシス特性に起因した弾性膨張収縮構造体の出力不足が解消されるように流量制御電磁弁への電圧指令値を補正することも考えられるが、かかる補正処理は、補正値の適合等に多大な労力を要するものであって実質的に実施し得ないものである。

【0006】

そこで、本開示は，適合処理や実際の制御を煩雑化させることなく、ヒステリシス特性を有する人工筋肉を含むロボット装置を適正に作動させることを主目的とする。

【課題を解決するための手段】

【0007】

本開示のロボット装置は、関節を介して連結された２つのリンクと、液体の供給を受けて前記２つのリンクを相対的に回動させる少なくとも１つの人工筋肉と、前記人工筋肉に前記液体を供給する液体供給装置とを含むロボット装置であって、予め定められた前記人工筋肉の静特性に基づいて前記人工筋肉に供給される液圧の目標圧力を設定すると共に、前記目標圧力に基づいて前記液体供給装置を制御する制御装置であって、前記関節の現在角度の目標角度に対する追従性が許容範囲外にあるときに、前記目標角度と前記現在角度との差に基づいて前記目標圧力を設定すると共に、前記目標圧力に基づいて前記液体供給装置を制御する制御装置を含むものである。

【0008】

本開示のロボット装置は、液体の供給を受けて作動すると共に、関節を介して連結された２つのリンクを相対的に回動させる少なくとも１つの人工筋肉と、当該人工筋肉に液体を供給する液体供給装置と、当該液体供給装置を制御する制御装置とを含む。また、制御装置は、予め定められた人工筋肉の静特性に基づいて当該人工筋肉に供給される液圧の目標圧力を設定すると共に、目標圧力に基づいて液体供給装置を制御する。そして、当該制御装置は、関節の現在角度の目標角度に対する追従性が許容範囲外にあるときに、目標角度と現在角度との差に基づいて目標圧力を設定し、当該目標圧力に基づいて液体供給装置を制御する。これにより、ヒステリシス特性に起因して、人工筋肉から実際に出力される力が当該人工筋肉の静特性に基づいて設定された目標圧力に対応する力よりも小さくなるときに、目標角度と現在角度との差を無くすように目標圧力を設定してロボット装置の動作不良を抑制することが可能となる。更に、目標圧力の設定に用いられる静特性に人工筋肉のヒステリシス特性を完全に反映させる必要が無くなると共に、補正値の適合や煩雑な目標圧力の補正処理等が不要となる。この結果、適合処理や実際の制御を煩雑化させることなく、ヒステリシス特性を有する人工筋肉を含むロボット装置を適正に作動させることが可能となる。

【図面の簡単な説明】

【0009】

【図1】本開示のロボット装置を示す概略構成図である。

【図2】本開示のロボット装置を示す拡大図である。

【図3】本開示のロボット装置の液体供給装置を示す概略構成図である。

【図4】本開示のロボット装置の制御装置の要部を示すブロック図である。

【図5】本開示のロボット装置の制御手順を例示するフローチャートである。

【図6】本開示のロボット装置の制御手順を例示するフローチャートである。

【図7】本開示のロボット装置の制御手順を例示するフローチャートである。

【図8】本開示のロボット装置の制御手順を例示するフローチャートである。

【図9】目標圧力設定マップを例示する説明図である。

【図10】本開示のロボット装置の制御手順を例示するフローチャートである。

【発明を実施するための形態】

【0010】

次に、図面を参照しながら、本開示の発明を実施するための形態について説明する。

【0011】

図１は、本開示のロボット装置１を示す概略構成図であり、図２は、ロボット装置１を示す拡大図である。これらの図面に示すロボット装置１は、ロボットアーム（ロボット本体）２と、液体供給装置１０と、装置全体を制御する制御装置１００とを含む。ロボットアーム２は、複数（本実施形態では、３つ）の関節（ピン結合部）Ｊ１，Ｊ２，Ｊ３と、複数（本実施形態では、３つ）のアーム（リンク）３と、関節Ｊ１，Ｊ２，Ｊ３ごとに例えば偶数個（本実施形態では、４つ）ずつ設けられる人工筋肉としての複数の液圧アクチュエータＭと、先端側のアーム３の手先に取り付けられる把持部としてのハンド部（ロボットハンド）４とを含む多関節アームである。ハンド部４は、対象となる物体（以下、「把持対象」という。）を把持するように制御装置１００により制御される。また、液体供給装置１０は、制御装置１００により制御されて各液圧アクチュエータＭに液体としての作動油（作動流体）を給排する。これにより、ロボットアーム２を油圧（液圧）により駆動してハンド部４を所望の位置に移動させることができる。

【0012】

ロボットアーム２の各液圧アクチュエータＭは、図２に示すように、作動油の圧力によって膨張および収縮するチューブＴと、当該チューブＴを覆う編組スリーブＳとを含む、いわゆるマッキベン型の人工筋肉である。チューブＴは、高い耐油性をもった例えばゴム材等の弾性材により円筒状に形成されており、当該チューブＴの両端部は、封止部材Ｃにより封止されている。チューブＴの基端側（液体供給装置１０側、図２中下端側）の封止部材Ｃには、作動油の出入口ＩＯが形成されている。編組スリーブＳは、所定方向に配向された複数のコードを互いに交差するように編み込むことにより円筒状に形成されており、軸方向および径方向に収縮可能である。編組スリーブＳを形成するコードとしては、繊維コード、高強度繊維、極細のフィラメントによって構成される金属製コード等を採用することができる。かかる液圧アクチュエータＭのチューブＴ内に上記出入口ＩＯから作動油を供給してチューブＴ内の作動油の圧力を高めることで、チューブＴは、編組スリーブＳの作用により径方向に膨張すると共に軸方向に収縮し、内部の作動油の圧力に応じた収縮力を発生する。

【0013】

図１および図２に示すように、複数のアーム３のうち、最基端側（最も液体供給装置１０側）のアーム３は、関節Ｊ１を介してリンクとしての支持部材５により回動自在に支持される。また、２つのアーム３同士が、関節Ｊ２またはＪ３を介して互いに回動自在に連結される。更に、各アーム３の先端部（手先側の端部）には、連結部材６が固定されている。図示するように、支持部材５は、最基端側の関節Ｊ１に対応した複数（４つ）の液圧アクチュエータＭの基端側の封止部材Ｃを回動自在に支持する。また、各アーム３の連結部材６は、基端側に位置する関節Ｊ１またはＪ２に対応した複数（４つ）液圧アクチュエータＭの先端側（手先側）の封止部材Ｃを回動自在に支持する。更に、各連結部材６は、先端側に位置する関節Ｊ２またはＪ３に対応した複数（４つ）液圧アクチュエータＭの基端側の封止部材Ｃを回動自在に支持する。

【0014】

より詳細には、支持部材５は、関節Ｊ１に対応した２つの液圧アクチュエータＭの基端側の封止部材Ｃを第１の連結軸を介して回動自在に支持する。また、最基端側のアーム３の連結部材６は、関節Ｊ１に対応した当該２つの液圧アクチュエータＭの先端側の封止部材Ｃを第２の連結軸を介して回動自在に支持する。更に、支持部材５は、関節Ｊ１に対応した残り２つの液圧アクチュエータＭの基端側の封止部材Ｃを上記第１の連結軸と平行に延びる第３の連結軸を介して回動自在に支持する。また、最基端側のアーム３の連結部材６は、関節Ｊ１に対応した当該残り２つの液圧アクチュエータＭの先端側の封止部材Ｃを上記第２の連結軸と平行に延びる第４の連結軸を介して回動自在に支持する。同様に、関節Ｊ２またはＪ３を介して互いに連結される２つのアーム３の連結部材６も、上述のような複数の連結軸を介して、当該関節Ｊ２またはＪ３に対応した複数（４つ）の液圧アクチュエータＭの対応する封止部材Ｃを回動自在に支持する。

【0015】

これにより、関節Ｊ１－Ｊ３の関節軸から手先側（ハンド部４側）に延びる各アーム３の両側には、液圧アクチュエータＭが本実施形態では２つずつ対応するアーム３と平行に配列される。そして、各アーム３の一側に配置される２つの液圧アクチュエータＭは、１つの関節Ｊ１，Ｊ２またはＪ３に対応した第１の人工筋肉（一方の拮抗筋）ＡＭ１（図３参照）を構成し、各アーム３の他側に配置される２つの液圧アクチュエータＭは、当該第１の人工筋肉ＡＭ１と対をなす１つの関節Ｊ１，Ｊ２またはＪ３に対応した第２の人工筋肉（他方の拮抗筋）ＡＭ２（図３参照）を構成する。ただし、第１の人工筋肉ＡＭ１を構成する液圧アクチュエータＭの数と、第２の人工筋肉ＡＭ２を構成する液圧アクチュエータＭの数とが異なっていてもよい。また、本実施形態において、１つの関節Ｊ１，Ｊ２またはＪ３に対して設けられる複数（４つ）の液圧アクチュエータＭは、互いに同一の諸元を有する。ただし、１つの関節Ｊ１，Ｊ２またはＪ３に対応した複数の液圧アクチュエータＭの諸元は、必ずしも同一である必要はなく、例えば、第１の人工筋肉ＡＭ１を構成する液圧アクチュエータＭの諸元と、第２の人工筋肉ＡＭ２を構成する液圧アクチュエータＭの諸元とが異なっていてもよい。更に、各アーム３は、中空に形成されており、各アーム３の内部には、液体供給管としての複数のホースＨ（図２における破線参照）が配置される。各ホースＨは、対応する液圧アクチュエータＭの基端側の封止部材Ｃに形成された出入口ＩＯに接続され、各液圧アクチュエータＭのチューブＴ内には、ホースＨを介して液体供給装置１０からの作動油（油圧）が供給される。

【0016】

従って、制御装置１００により液体供給装置１０を制御することで、第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭのチューブＴ内の油圧と、第１の人工筋肉ＡＭ１と対をなす第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭのチューブＴ内の油圧とを互いに異ならせることができる。これにより、４つの液圧アクチュエータＭすなわち対をなす（一組の）第１および第２の人工筋肉ＡＭ１，ＡＭ２から連結部材６を介して各アーム３に力（回転トルク）を伝達し、支持部材５または基端側のアーム３に対して各アーム３を回動させて関節Ｊ１－Ｊ３の関節角度を変化させることが可能となる。本実施形態において、第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭと、第１の人工筋肉ＡＭ１と対をなす第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭとは、チューブＴが所定量（例えば、自然長の１０％程度）だけ軸方向に収縮した状態を初期状態として液体供給装置１０からの油圧により拮抗駆動される。

【0017】

ロボット装置１の液体供給装置１０は、図１に示すように、作動油貯留部（液体貯留部）を画成するタンク１１と、当該タンク１１を上下方向に延びる回動軸（図１における一点鎖線参照）の周りに回動自在に支持するベース部１２とを含む。タンク１１は、例えば上端および下端が閉鎖された筒体であり、内部に作動油を貯留可能なものである。本実施形態において、ロボットアーム２の支持部材５は、図２に示すように、タンク１１の上壁部１１ｕに図示しないボルト等を介して固定される。すなわち、ロボットアーム２は、液体供給装置１０のタンク１１（上壁部１１ｕ）により支持される。

【0018】

ベース部１２は、ロボットアーム２およびタンク１１の下方に位置するようにロボット装置１の設置箇所に固定されるか、あるいは図示しない無人搬送車（ＡＧＶ）に搭載（固定）される。また、ベース部１２は、タンク１１を上記回動軸の周りに回動させる図示しない回動ユニットを支持している。これにより、回動ユニットを作動させることで、ロボットアーム２およびタンク１１を当該回動軸の周りに一体に回動させることが可能となる。回動ユニットは、液体供給装置１０から供給される油圧により駆動される揺動モータであってもよく、電動モータ等を含むものであってもよい。

【0019】

更に、液体供給装置１０は、図３に示すように、タンク１１およびベース部１２に加えて、液体供給源としてのポンプ１３と、タンク１１内に配置される図示しないバルブボディと、元圧生成バルブ１４と、それぞれ複数の調圧弁（調圧装置）としての第１および第２リニアソレノイドバルブ１５１，１５２と、それぞれ複数の供給遮断部としての第１および第２供給遮断弁１６１，１６２とを含む。ポンプ１３、第１および第２リニアソレノイドバルブ１５１，１５２並びに第１および第２供給遮断弁１６１，１６２は、何れも制御装置１００により制御される。第１および第２リニアソレノイドバルブ１５１，１５２と、第１および第２供給遮断弁１６１，１６２とは、関節Ｊ１，Ｊ２，Ｊ３ごとにそれぞれ１つずつ設けられる。

【0020】

ポンプ１３は、例えば電動ポンプであり、タンク１１内に貯留された作動油を吸引して吐出口から吐出する。ポンプ１３は、タンク１１内に配置されるポンプ部と、電動モータおよび減速ギヤ機構とを有すると共にタンク１１内またはタンク１１外に配置される駆動部とを含む。元圧生成バルブ１４は、図示しない信号圧生成バルブからの信号圧に応じてポンプ１３から吐出される作動油の一部をドレン（調圧）して元圧を生成し、元圧をバルブボディに形成された油路（液体通路）Ｌ０に供給する。元圧生成バルブ１４の信号圧生成バルブとしては、例えば、制御装置１００による通電制御されるリニアソレノイドバルブが用いられる。

【0021】

第１および第２リニアソレノイドバルブ１５１，１５２は、制御装置１００により通電制御される電磁部１５ｅやスプール１５ｓ、スプール１５ｓを電磁部１５ｅ側（図３中上側）に付勢するスプリングＳＰ等を含み、バルブボディ内に配置される。また、第１および第２リニアソレノイドバルブ１５１，１５２は、バルブボディの油路Ｌ０に連通する入力ポート１５ｉと、入力ポート１５ｉと連通可能な出力ポート１５ｏと、出力ポート１５ｏに連通するフィードバックポート１５ｆと、出力ポート１５ｏと連通可能なドレンポート１５ｄとを含む。

【0022】

本実施形態において、第１および第２リニアソレノイドバルブ１５１，１５２は、電磁部１５ｅに電流が供給される際に開弁する常閉弁であり、各電磁部１５ｅは、印加される電流に応じてスプール１５ｓを軸方向に移動させる。これにより、電磁部１５ｅ（コイル）への給電により当該電磁部１５ｅからスプール１５ｓに付与される推力と、スプリングＳＰの付勢力と、出力ポート５ｏからフィードバックポート５ｆに供給された油圧によりスプール５ｓに作用する電磁部５ｅ側への推力とをバランスさせることで、元圧生成バルブ１４（ポンプ１３）側から入力ポート１５ｉに供給されて出力ポート１５ｏから流出する作動油を所望の圧力に調圧することができる。また、第１および第２リニアソレノイドバルブ１５１，１５２のドレンポート１５ｄは、図３に示すように、それぞれ油路Ｌ３を介してタンク１１内の作動油貯留部に連通する。

【0023】

第１および第２供給遮断弁１６１，１６２は、互いに同一の構造を有する電磁式スプール弁（電磁弁）であり、図３に示すように、入力ポート１６ｉ、第１および第２出力ポート１６ｏａ，１６ｏｂを有するスリーブと、当該スリーブの内部に軸方向に摺動自在（移動自在）に配置される図示しないスプールと、制御装置１００により通電制御されてスプールを移動させる電磁部１６ｅと、スプールを電磁部１６ｅ側に付勢する図示しないスプリングとをそれぞれ含む。第１供給遮断弁１６１の入力ポート１６ｉは、バルブボディに形成された油路を介して第１リニアソレノイドバルブ１５１の出力ポート１５ｏに接続され、第２供給遮断弁１６２の入力ポート１６ｉは、バルブボディに形成された油路を介して第２リニアソレノイドバルブ１５２の出力ポート１５ｏに接続される。

【0024】

また、第１供給遮断弁１６１の第１出力ポート１６ｏａは、油路Ｌ１１を介して対応する上記第１の人工筋肉ＡＭ１を構成する一方の液圧アクチュエータＭ（チューブＴ）の作動油の出入口ＩＯに接続される。更に、第１供給遮断弁１６１の第２出力ポート１６ｏｂは、油路Ｌ１２を介して当該第１の人工筋肉ＡＭ１を構成する他方の液圧アクチュエータＭ（チューブＴ）の作動油の出入口ＩＯに接続される。また、第２供給遮断弁１６２の第１出力ポート１６ｏａは、油路Ｌ２１を介して対応する上記第２の人工筋肉ＡＭ２を構成する一方の液圧アクチュエータＭ（チューブＴ）の作動油の出入口ＩＯに接続される。更に、第２供給遮断弁１６２の第２出力ポート１６ｏｂは、油路Ｌ２２を介して当該第２の人工筋肉ＡＭ２を構成する他方の液圧アクチュエータＭ（チューブＴ）の作動油の出入口ＩＯに接続される。

【0025】

本実施形態において、第１および第２供給遮断弁１６１，１６２は、電磁部１６ｅに供給される電流に応じて、完全連通状態、第１部分連通状態、第２部分連通状態および完全遮断状態を選択的に形成する。第１および第２供給遮断弁１６１，１６２が完全連通状態を形成した際には、入力ポート１６ｉと第１および第２出力ポート１６ｏａ，１６ｏｂの双方とが連通する。第１および第２供給遮断弁１６１，１６２が第１部分連通状態を形成した際には、入力ポート１６ｉと第２出力ポート１６ｏｂとが連通すると共に入力ポート１６ｉと第１出力ポート１６ｏａとの連通が遮断される。第１および第２供給遮断弁１６１，１６２が第２部分連通状態を形成した際には、入力ポート１６ｉと第１出力ポート１６ｏａとが連通すると共に入力ポート１６ｉと第２出力ポート１６ｏｂとの連通が遮断される。第１および第２供給遮断弁１６１，１６２が完全遮断状態を形成した際には、入力ポート１６ｉと第１および第２出力ポート１６ｏａ，１６ｏｂとの連通が遮断される。

【0026】

ロボット装置１の制御装置１００は、ＣＰＵ、ＲＯＭ、ＲＡＭ、入出力インターフェース等を含むマイクロコンピュータや各種ロジックＩＣ等（何れも図示省略）を含む。制御装置１００は、第１および第２リニアソレノイドバルブ１５１，１５２の下流側で油路Ｌ０における作動油の圧力を検出する図示しない元圧センサ、第１、第２リニアソレノイドバルブ１５１，１５２並びに第１、第２供給遮断弁１６１，１６２の電源の電圧を検出する図示しない電圧センサの検出値等を入力する。制御装置１００は、元圧センサにより検出される油路Ｌ０における油圧が目標値になるように、ポンプ１３をデューティ制御すると共に、元圧生成バルブ１４の信号圧生成バルブの電磁部に供給される電流を制御する。

【0027】

また、制御装置１００は、第１および第２リニアソレノイドバルブ１５１，１５２から各液圧アクチュエータＭに要求に応じた油圧が供給されるように第１および第２リニアソレノイドバルブ１５１，１５２への電流指令値を設定し、当該電流指令値に基づいて各電磁部１５ｅに供給される電流を制御する。更に、制御装置１００は、ロボット装置１を作動させる間、基本的に、第１および第２供給遮断弁１６１，１６２が上述の完全連通状態を形成するように各電磁部１６ｅに供給される電流を制御する。また、制御装置１００は、第１リニアソレノイドバルブ１５１の電磁部１５ｅを流れる電流を検出する電流検出部と、第２リニアソレノイドバルブ１５２の電磁部１５ｅを流れる電流を検出する電流検出部とを含み（何れも図示省略）、各電流検出部により検出される電流を監視する。

【0028】

更に、制御装置１００は、各液圧アクチュエータＭにおける油圧を検出する図示しない圧力センサからの検出値に応じて、第１部分連通状態または第２部分連通状態を形成するように第１および第２供給遮断弁１６１，１６２の該当するものを制御する。これにより、破損等により第１および第２リニアソレノイドバルブ１５１，１５２の何れかに対応した２つの液圧アクチュエータＭの一方から作動油が流出した場合に、当該２つの液圧アクチュエータＭの他方に継続して作動油を供給してロボットアーム２の挙動の乱れを抑えつつ、破損した液圧アクチュエータＭからの作動油の更なる流出を良好に抑制することが可能となる。また、制御装置１００により完全遮断状態を形成するように第１および第２供給遮断弁１６１，１６２の該当するものを制御することで、第１または第２リニアソレノイドバルブ１５１，１５２からそれに対応した２つの液圧アクチュエータＭへの作動油の供給を遮断したり、当該２つの液圧アクチュエータＭからの作動油の流出を規制してロボットアーム２の意図しない動作の発生を抑制したりすることができる。

【0029】

図４は、上述の制御装置１００における第１および第２リニアソレノイドバルブ１５１，１５２の制御部を示すブロック図である。同図に示すように、制御装置１００は、それぞれコンピュータのＣＰＵやＲＯＭ，ＲＡＭといったハードウェアと、当該コンピュータにインストールされた制御プログラムといったソフトウェアとの少なくとも何れか一方により構築される、目標位置設定部１０１と、現在位置導出部１０２と、トルク演算部１０３および重力補償部１０４を含む目標トルク設定部１０５と、目標剛性設定部１０６と、収縮率設定部１０７と、収縮力算出部１０８と、目標角度算出部１０９と、関節状態判定部１１０と、第１圧力設定部１１１と、第２圧力設定部１１２と、目標圧力設定部１１５と、電流指令値設定部１１６と、バルブ駆動部１１７とを含む。

【0030】

目標位置設定部１０１は、ハンド部４の把持対象の位置や、ユーザにより与えられるハンド部４の移動中の目標速度および目標加速度に基づいて、当該ハンド部４の最終的な目標位置である目標到達位置（３次元座標）と、ハンド部４の初期位置から目標到達位置までの軌道であって複数の目標位置すなわち経由位置（３次元座標）を含む目標軌道とを設定する。現在位置導出部１０２は、ロボットアーム２の関節Ｊ１－Ｊ３の関節角度θ１，θ２，θ３とロボットアーム２（ロボット装置１）の諸元（アーム３の寸法等）とに基づいて、ハンド部４（予め定められた基準点）の現在位置（３次元座標）を導出する。関節Ｊ１－Ｊ３の関節角度θ１－θ３は、ロボットアーム２に設けられた複数の関節角度センサ７の対応する何れかにより検出される。以下、“ｉ”を関節の番号として（ただし、本実施形態において、ｉ＝１，２，３である。）、ｉ番目の関節を“関節Ｊｉ”といい、関節Ｊｉの関節角度を“θｉ”という。

【0031】

目標トルク設定部１０５のトルク演算部１０３は、関節Ｊ１－Ｊ３ごとに、ハンド部４が現在位置から目標位置まで移動するように関節Ｊｉを介して連結された２つのアーム３（アーム３および支持部材５）を相対的に回動させる関節トルクＴｊ（ｉ）を算出する。目標トルク設定部１０５の重力補償部１０４は、関節Ｊ１－Ｊ３ごとに、関節角度θ１－θ３とロボットアーム２（ロボット装置１）の諸元（アーム３の寸法等）とに基づいてロボットアーム２の姿勢を維持するのに必要な重力補償トルクＴｃ（ｉ）を算出する。そして、目標トルク設定部１０５は、関節トルクＴｊ（ｉ）と重力補償トルクＴｃ（ｉ）との和を、関節Ｊｉを介して連結される２つのアーム３等を相対的に回動させるための関節トルクの目標値（目標駆動力）である目標トルクＴｔａｇ（ｉ）に設定する。

【0032】

目標剛性設定部１０６は、少なくともロボット装置１すなわちハンド部４の目標位置に基づいて、関節Ｊ１－Ｊ３ごとに、関節Ｊｉがもつべき剛性、すなわち関節Ｊｉを介して連結される２つのアーム３等（リンク）を単位角度だけ相対的に回動させるのに必要な力（トルク）であって、当該２つのアーム３等を相対的に回動させようとする外力に対する関節Ｊｉの動きにくさを示す目標剛性Ｒ（ｉ）を設定する。より詳細には、目標剛性設定部１０６は、ハンド部４等を把持対象等まで移動させる際に、当該ハンド部４等と把持対象等との位置関係に応じて目標剛性Ｒ（ｉ）を変化させ、ハンド部４等を把持対象等に接触する前に目標剛性Ｒ（ｉ）を低下させる。更に、目標剛性設定部１０６は、ハンド部４の移動速度および加速度の少なくとも何れか一方に応じて目標剛性Ｒ（ｉ）を変化させると共に、ロボット装置１の周囲（例えばロボット装置１が配置される室内あるいは柵の内側といったロボットアーム２の動作範囲を含む領域）に人がいる場合、目標剛性Ｒ（ｉ）を低下させる。なお、各関節Ｊｉの目標剛性Ｒ（ｉ）は、少なくともロボット装置１すなわちハンド部４の現在位置に基づいて設定されてもよい。

【0033】

収縮率設定部１０７は、関節Ｊ１－Ｊ３ごとに、ハンド部４の現在位置に応じた各関節Ｊｉの関節角度θｉに基づいて、当該関節Ｊｉに対応した上記第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭの収縮率Ｃｒ１（ｉ）と、関節Ｊｉに対応した上記第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭの収縮率Ｃｒ２（ｉ）とを設定する。収縮率Ｃｒ１（ｉ），Ｃｒ２（ｉ）は、それぞれ該当する液圧アクチュエータＭのチューブＴの軸方向における自然長に対する収縮したチューブＴの軸長の割合を示す。なお、収縮率Ｃｒ１（ｉ），Ｃｒ２（ｉ）は、ロボット装置１の目標位置に応じた各関節Ｊｉの目標角度に基づいて設定されてもよい。

【0034】

収縮力算出部１０８は、関節Ｊ１－Ｊ３ごとに、目標トルク設定部１０５により設定された目標トルクＴｔａｇ（ｉ）と、目標剛性設定部１０６により設定された目標剛性Ｒ（ｉ）とに基づいて、関節Ｊｉを介して連結された２つのアーム３等を目標トルクＴｔａｇ（ｉ）で相対的に回動させる際に当該関節Ｊｉに対応した複数（一対）の液圧アクチュエータＭに要求される収縮力Ｆｃ１（ｉ），Ｆｃ２（ｉ）を算出する。収縮力Ｆｃ１（ｉ）は、各関節Ｊｉに対応した第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭのチューブＴの収縮により発生させるべき力であり、収縮力Ｆｃ２（ｉ）は、各関節Ｊｉに対応した第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭのチューブＴの収縮により発生させるべき力である。

【0035】

目標角度算出部１０９は、目標位置設定部１０１により設定された目標軌道におけるハンド部４の複数の目標位置ごとに、当該目標位置とロボットアーム２（ロボット装置１）の諸元等とから定まる各関節Ｊｉの目標角度θｔａｇ（ｉ）を算出する。関節状態判定部１１０は、関節角度センサ７により検出された関節Ｊｉの関節角度θｉと、目標角度算出部１０９により算出された当該関節Ｊｉの目標角度θｔａｇ（ｉ）とから、関節Ｊｉの現在の関節角度θｉの目標角度θｔａｇ（ｉ）に対する追従性が許容範囲内にあるか否かを判定する。

【0036】

第１圧力設定部１１１は、関節Ｊ１－Ｊ３ごとに、人工筋肉としての液圧アクチュエータＭの静特性から収縮率設定部１０７により設定された収縮率Ｃｒ１（ｉ）と収縮力算出部１０８により算出された収縮力Ｆｃ１（ｉ）とに対応した圧力を導出して第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭの第１の仮目標圧力（第１圧力）である圧力Ｐａ１（ｉ）に設定する。また、第１圧力設定部１１１は、関節Ｊ１－Ｊ３ごとに、当該静特性から収縮率設定部１０７により設定された収縮率Ｃｒ２（ｉ）と収縮力算出部１０８により算出された収縮力Ｆｃ２（ｉ）とに対応した圧力を導出して第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭの第１の仮目標圧力（第１圧力）である圧力Ｐａ２（ｉ）に設定する。

【0037】

第２圧力設定部１１２は、第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭの第２の仮目標圧力（第２圧力）である圧力Ｐｂ１（ｉ）と、第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭの第２の仮目標圧力（第２圧力）である圧力Ｐｂ２（ｉ）とを設定する。第２圧力設定部１１２は、関節Ｊｉの現在の関節角度θｉの目標角度θｔａｇ（ｉ）に対する追従性に応じて、圧力Ｐｂ１（ｉ），Ｐｂ２（ｉ）を変化させる。

【0038】

目標圧力設定部１１５は、第１圧力設定部１１１により設定された圧力Ｐａ１（ｉ）と、第２圧力設定部１１２により設定された圧力Ｐｂ１（ｉ）とのうちの大きい方を第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭの目標圧力Ｐｔａｇ１（ｉ）に設定する。また、目標圧力設定部１１５は、第１圧力設定部１１１により設定された圧力Ｐａ２（ｉ）と、第２圧力設定部１１２により設定された圧力Ｐｂ２とのうちの大きい方を第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭの目標圧力Ｐｔａｇ２（ｉ）に設定する。

【0039】

電流指令値設定部１１６は、目標圧力設定部１１５により設定された目標圧力Ｐｔａｇ１（ｉ）およびＰｔａｇ２（ｉ）を第１および第２リニアソレノイドバルブ１５１，１５２の電磁部１５ｅへの電流指令値（目標電流）に直接変換する。バルブ駆動部１１７は、図示しない上述の電流検出部により検出される電流が電流指令値に一致するようにフィードフォワード制御（あるいはフィードフォワード制御およびフィードバック制御）により目標電圧を設定すると共に、目標電圧をＰＷＭ信号に変換する。更に、バルブ駆動部１１７は、ＰＷＭ信号に基づいて図示しないスイッチング素子（トランジスタ）をスイッチング制御して第１、第２リニアソレノイドバルブ１５１，１５２の電磁部１５ｅに電流を印加する。これにより、第１および第２リニアソレノイドバルブ１５１，１５２は、目標圧力Ｐｔａｇ１（ｉ）またはＰｔａｇ２（ｉ）に応じた油圧を生成するように制御される。

【0040】

続いて、図５から図９を参照しながら、上述のロボット装置１の制御手順について説明する。以下、ロボット装置１のハンド部４を把持対象まで移動させ、ハンド部４に把持対象を把持させて移送させるケースを例にとってロボット装置１の制御手順について説明する。

【0041】

本実施形態において、ロボット装置１の制御装置１００は、ロボットアーム２の手先すなわちハンド部４と把持対象とが仮想的なバネおよびダンパを介して連結され、当該仮想的なバネおよびダンパが発生する引張力Ｆｔによりハンド部４が現在位置から把持対象あるいは当該把持対象の移送先まで引っ張られるとの仮定のもとで設計されている。かかる仮定のもとでは、仮想的なバネおよびダンパによる引張力Ｆｔ＝（ｆ_x，ｆ_y，ｆ_z）が、ハンド部４（予め定められた基準点）の目標位置（ｘｄ（ｔ），ｙｄ（ｔ），ｚｄ（ｔ））と当該ハンド部４の現在位置（ｘ（ｔ），ｙ（ｔ），ｚ（ｔ））とから、いわゆるＰＤ制御（フィードバック制御）の関係式である次式（１）のように、目標位置と現在位置との差にゲインＫ_px，Ｋ_pyまたはＫ_pzを乗じた比例項と、ゲインＫ_vx，Ｋ_vyまたはＫ_vzを含む速度項との和として表すことができる。

【0042】

【数1】

【0043】

また、ハンド部４が把持対象に接触した状態では、把持対象に対する手先の速度はゼロになるから、上記式（１）より、ハンド部４が仮想的なバネおよびダンパによる引っ張られることで把持対象との接触後に当該把持対象に加える押圧力Ｆｐは、接触後の目標位置と把持対象の位置（ハンド部４と把持対象との接触位置）とから求めることができる。従って、ハンド部４の最終的な目標到達位置（ｘ_r，ｙ_r，ｚ_r）は、接触後にハンド部４から把持対象に加えられる押圧力Ｆｐ＝（ｆ_px，ｆ_py，ｆ_pz）と、把持対象の位置（接触位置）（ｘ_o，ｙ_o，ｚ_o）と、ゲインＫ_px，Ｋ_py，Ｋ_pzとから、次式（２）のように表すことができる。

【0044】

【数2】

【0045】

そして、ロボット装置１では、ロボットアーム２の作動開始に先立って（ハンド部４の移動開始前に）、図５のルーチンが制御装置１００の目標位置設定部１０１により実行され、ハンド部４の最終的な目標到達位置（ｘ_r，ｙ_r，ｚ_r）と、初期位置から目標到達位置（ｘ_r，ｙ_r，ｚ_r）までのハンド部４の目標軌道が設定される。図５のルーチンの開始に際して、制御装置１００の目標位置設定部１０１は、把持対象の位置（ｘ_o，ｙ_o，ｚ_o）と、ユーザにより与えられているハンド部４の移動中の目標速度および目標加速度とを取得する（ステップＳ１）。把持対象の位置（ｘ_o，ｙ_o，ｚ_o）は、それが予め判明している場合、ロボット装置１のユーザにより制御装置１００に入力されてもよく、ロボットアーム２の作動開始前にカメラ等により取得されたデータから導出されたものであってよい。

【0046】

次いで、目標位置設定部１０１は、上記式（２）に従って、ハンド部４と把持対象との接触後に当該ハンド部４から把持対象に予め定められた押圧力Ｆｐが加えられるハンド部４の目標到達位置（ｘ_r，ｙ_r，ｚ_r）を設定する（ステップＳ２）。ロボット装置１において、式（２）における押圧力Ｆｐ＝（ｆ_px，ｆ_py，ｆ_pz）は、把持対象の材質や強度、サイズといった諸元から、当該把持対象を破壊することなくハンド部４を把持対象に接触させるように把持対象の位置（ｘ_o，ｙ_o，ｚ_o）のばらつき等を考慮して予め定められる。更に、目標位置設定部１０１は、ステップＳ１にて取得したハンド部４の目標速度および目標加速度と、ステップＳ２にて設定した目標到達位置（ｘ_r，ｙ_r，ｚ_r）とに基づいて、予め定められた数（複数）の目標位置すなわち経由位置（３次元座標）を含むハンド部４の目標軌道を設定し（ステップＳ３）、図５のルーチンを終了させる。

【0047】

また、ロボット装置１では、把持対象の位置に応じた目標到達位置および目標軌道が設定された後、把持対象の移送先（把持対象の載置面）に応じた目標到達位置および目標軌道を設定するために再度図５のルーチンが目標位置設定部１０１により実行される。この際、目標位置設定部１０１は、ハンド部４により把持された把持対象（手先）と載置面（対象）との接触後に当該ハンド部４から把持対象を介して載置面（対象）に予め定められた押圧力Ｆｐが加えられるハンド部４の目標到達位置（ｘ_r，ｙ_r，ｚ_r）を設定する。

【0048】

図６は、目標到達位置および目標軌道が設定された後、制御装置１００により実行されるロボットアーム制御ルーチンを例示するフローチャートである。図６のルーチンは、図５のルーチンの完了後、ユーザによる実行指示に応じて、制御装置１００により所定時間（例えば１０ｍｓ程度）おきに繰り返し実行される。

【0049】

図６のルーチンの開始に際して、制御装置１００のトルク演算部１０３（目標トルク設定部１０５）と目標剛性設定部１０６とは、それぞれ目標位置設定部１０１により設定された目標位置を取得する（ステップＳ１０）。ステップＳ１０にて取得される目標位置は、目標軌道における１番目の目標位置または図６のルーチンの前回実行時に取得された目標位置である。また、制御装置１００の現在位置導出部１０２および重力補償部１０４は、複数の関節角度センサ７により取得された関節Ｊ１－Ｊ３の関節角度θ１－θ３を取得する（ステップＳ２０）。現在位置導出部１０２は、取得した関節角度θ１－θ３とロボットアーム２（ロボット装置１）の諸元とに基づいて、ハンド部４の現在位置（３次元座標）を導出し（ステップＳ３０）、導出した現在位置をトルク演算部１０３に与える。

【0050】

制御装置１００のトルク演算部１０３（目標トルク設定部１０５）は、ハンド部４の現在位置が前回位置から変化しているか否か（ハンド部４が移動しているか否か）を判定する（ステップＳ４０）。トルク演算部１０３は、ハンド部４の現在位置が前回位置から変化していると判定した場合（ステップＳ４０：ＹＥＳ）、更に、当該現在位置が目標位置に実質的に一致しているか否かを判定する（ステップＳ５０）。現在位置が目標位置に実質的に一致していると判定した場合（ステップＳ５０：ＹＥＳ）、トルク演算部１０３は、ステップＳ１０にて取得した目標位置の次の目標位置を取得する（ステップＳ６０）。当該次の目標位置は、目標剛性設定部１０６にも与えられ、目標剛性設定部１０６は、取得した目標位置等に基づいて、各関節Ｊｉの目標剛性Ｒ（ｉ）を設定する。また、ハンド部４の現在位置が目標回位置に実質的に一致していない場合、ステップＳ６０の処理は、スキップされる。

【0051】

ステップＳ５０またはＳ６０の処理の後、制御装置１００の目標トルク設定部１０５は、各関節Ｊｉについての目標トルクＴｔａｇ（ｉ）を設定する（ステップＳ７０）。図７は、ステップＳ７０における目標トルク設定部１０５による目標トルクＴｔａｇ（ｉ）の設定手順を例示するフローチャートである。同図に示すように、目標トルク設定部１０５のトルク演算部１０３は、まず、ステップＳ１０にて取得したハンド部４の目標位置に基づいて上述のゲインＫ_px，Ｋ_pyおよびＫ_pzを設定する（ステップＳ７００）。ステップＳ７００において、トルク演算部１０３は、ステップＳ１０にて取得した目標位置が予め定められた目標位置（例えば、ハンド部４が減速し始める位置）になるまでゲインＫ_px，Ｋ_pyおよびＫ_pzの各々を予め定められた通常値に設定し、ステップＳ１０にて取得した目標位置が予め定められた目標位置になった以降、ゲインＫ_px，Ｋ_pyおよびＫ_pzの各々を上記通常値よりも小さい値に設定する。

【0052】

次いで、トルク演算部１０３は、ステップＳ１０にて取得したハンド部４の目標位置と、ステップＳ３０にて取得したハンド部４の現在位置とに基づいて、上記式（１）から上述の仮想的なバネおよびダンパによる引張力Ｆｔ＝（ｆ_x，ｆ_y，ｆ_z）を算出する（ステップＳ７１０）。なお、ステップＳ７１０では、次式（３）から引張力Ｆｔ＝（ｆ_x，ｆ_y，ｆ_z）が算出されてもよく、式（１）および式（３）が併用されてもよい。式（３）を用いることで、ロボットアーム２（各関節Ｊｉ）の動き出しをよりスムースにすることができる。

【0053】

【数3】

【0054】

また、トルク演算部１０３は、別途設定される人感フラグを取得し（ステップＳ７２０）、人感フラグがオフされているか否かを判定する（ステップＳ７３０）。人感フラグは、ロボット装置１の設置箇所あるいは無人搬送車等に配置された少なくとも１つの人感センサからの信号に基づいて制御装置１００によりオンまたはオフされるものである。すなわち、制御装置１００は、当該少なくとも１つの人感センサにより人の存在が検知されていない場合、人感センサをオフし、少なくとも１つの人感センサにより人の存在が検知された場合、人感センサをオンする。

【0055】

トルク演算部１０３は、人感フラグがオフされていると判定した場合（ステップＳ７３０：ＹＥＳ）、第１の力（ベクトル）Ｆｕ１を上記引張力Ｆｔの上限値Ｆｕに設定する（ステップＳ７４０）。また、トルク演算部１０３は、人感フラグがオンされていると判定した場合（ステップＳ７３０：ＮＯ）、上記第１の力Ｆｕ１よりも小さい第２の力（ベクトル）Ｆｕ２を引張力Ｆｔの上限値Ｆｕに設定する（ステップＳ７４５）。ステップＳ７４０またはＳ７４５の処理の後、トルク演算部１０３は、ステップＳ７１０にて設定した引張力Ｆｔと上限値Ｆｕとの小さい方を引張力Ｆｔに設定（再設定）する（ステップＳ７５０）。

【0056】

更に、トルク演算部１０３は、次式（４）に示すように、ステップＳ７５０にて設定した引張力Ｆｔと次式（５）に示すヤコビ行列とから、関節Ｊ１－Ｊ３ごとに、ハンド部４が現在位置から目標位置まで移動するように関節Ｊｉを介して連結された２つのアーム３（アーム３および支持部材５）を相対的に回動させる関節トルクＴｊ（ｉ）を算出する（ステップＳ７６０）。そして、目標トルク設定部１０５は、上述のようにしてトルク演算部１０３により算出された関節トルクＴｊ（ｉ）と、重力補償部１０４により別途算出された重力補償トルクＴｃ（ｉ）との和を２つのアーム３等を相対的に回動させるための目標トルクＴｔａｇ（１）－Ｔｔａｇ（３）に設定する（ステップＳ７７０）。

【0057】

【数4】

【0058】

ステップＳ７０（ステップＳ７７０）にて各関節Ｊｉについての目標トルクＴｔａｇ（ｉ）が設定されると、制御装置１００は、関節Ｊｉすなわちアーム３ごとに複数の液圧アクチュエータＭの目標圧力Ｐｔａｇ１（ｉ）およびＰｔａｇ２（ｉ）を設定する（ステップＳ８０）。図８は、ステップＳ８０における目標圧力Ｐｔａｇ１（ｉ）およびＰｔａｇ２（ｉ）の設定手順を例示するフローチャートである。同図に示すように、制御装置１００は、まず、変数ｉすなわち関節の番号を値１に設定する（ステップＳ８００）。次いで、制御装置１００の収縮力算出部１０８は、目標トルク設定部１０５により設定された関節Ｊｉについての目標トルクＴｔａｇ（ｉ）と、目標剛性設定部１０６により設定された関節Ｊｉの目標剛性Ｒ（ｉ）とを取得する（ステップＳ８１０）。また、ステップＳ８１０において、制御装置１００の収縮率設定部１０７は、対応する関節角度センサ７により検出された関節Ｊｉの現在の関節角度θｉを取得する。

【0059】

関節角度θｉを取得した収縮率設定部１０７は、関節Ｊｉに対応した上記第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭの収縮率Ｃｒ１（ｉ）と、関節Ｊｉに対応した上記第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭの収縮率Ｃｒ２（ｉ）とを設定する（ステップＳ８２０）。ステップＳ８２０において、収縮率設定部１０７は、関節Ｊｉの関節角度θｉや、ロボットアーム２（ロボット装置１）の諸元（アーム３の寸法等）等に基づいて、第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭの収縮率Ｃｒ１（ｉ）と、第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭの収縮率Ｃｒ２（ｉ）とを導出・設定する。

【0060】

また、収縮力算出部１０８は、ステップＳ８１０にて取得した目標トルクＴｔａｇ（ｉ）および関節Ｊｉの目標剛性Ｒ（ｉ）に基づいて、関節Ｊｉに対応した第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭに要求される収縮力（引張力）Ｆｃ１（ｉ）と、当該関節Ｊｉに対応した第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭに要求される収縮力（引張力）Ｆｃ２（ｉ）とを算出する（ステップＳ８３０）。ここで、目標トルクＴｔａｇ（ｉ）と収縮力Ｆｃ１（ｉ），Ｆｃ２（ｉ）との間には、｜Ｔｔａｇ（ｉ）｜＝｜ｒ（Ｆｃ１（ｉ）－Ｆｃ２（ｉ））｜という関係が成立する（ただし、“ｒ”は、換算係数である。）。また、関節Ｊｉの目標剛性Ｒ（ｉ）と収縮力Ｆｃ１（ｉ），Ｆｃ２（ｉ）との間には、Ｒ（ｉ）＝Ｆｃ１（ｉ）＋Ｆｃ２（ｉ）という関係が成立するとみなすことができる。従って、ステップＳ８３０において、収縮力算出部１０８は、これら２つの関係式から得られる連立方程式を解くことにより、目標トルクＴｔａｇ（ｉ）および関節Ｊｉの目標剛性Ｒ（ｉ）に対応した収縮力Ｆｃ１（ｉ），Ｆｃ２（ｉ）を算出する。

【0061】

ステップＳ８２０およびＳ８３０の処理の後、第１圧力設定部１１１は、図９に例示する目標圧力設定マップから収縮率Ｃｒ１（ｉ）と収縮力Ｆｃ１（ｉ）とに対応した圧力を適宜線形補間を行いながら導出して関節Ｊｉに対応した第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭの第１の仮目標圧力（第１圧力）である圧力Ｐａ１（ｉ）に設定する。（ステップＳ８４０）。また、ステップＳ８４０において、第１圧力設定部１１１は、当該目標圧力設定マップから収縮率Ｃｒ２（ｉ）と収縮力Ｆｃ２（ｉ）とに対応した圧力を導出して関節Ｊｉに対応した第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭの第１の仮目標圧力（第１圧力）である圧力Ｐａ２（ｉ）に設定する。

【0062】

図９の目標圧力設定マップは、人工筋肉としての液圧アクチュエータＭの静特性を示すものであり、液圧アクチュエータＭ（チューブＴ）に供給される油圧ごとに、チューブＴの収縮率と当該チューブＴが発生する収縮力との関係を規定するように予め実験・解析を経て作成されたものである。また、ロボット装置１の各液圧アクチュエータＭは、作動油の圧力によって膨張および収縮するチューブＴを含むものであり、チューブＴ内の油圧および収縮率が同一であっても、当該チューブＴが軸方向に収縮するときと軸方向に伸長するときとで発生する収縮力が異なるという、いわゆるヒステリシス特性を有する。これを踏まえて、ロボット装置１の目標圧力設定マップは、チューブＴに供給される油圧ごとに、軸方向に収縮するチューブＴの収縮率（図９における一点鎖線参照）と軸方向に伸長するチューブＴの収縮率（図９における二点鎖線参照）とが同一になったときに両者が発生する収縮力の平均をとることにより作成されている。これにより、目標圧力の設定に用いられる目標圧力設定マップをより実用性の高いものとすることが可能となる。

【0063】

第１圧力設定部１１１により設定された圧力Ｐａ１（ｉ），Ｐａ２（ｉ）は、目標圧力設定部１１５に与えられ、目標圧力設定部１１５は、更に、第２圧力設定部１１２により別途設定された第２の仮目標圧力（第２圧力）である圧力Ｐｂ１（ｉ），Ｐｂ２（ｉ）を取得する（ステップＳ８５０）。目標圧力設定部１１５は、第１圧力設定部１１１により設定された圧力Ｐａ１（ｉ）と、第２圧力設定部１１２により設定された圧力Ｐｂ１（ｉ）とのうちの大きい方を関節Ｊｉに対応した第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭの目標圧力Ｐｔａｇ１（ｉ）に設定する（ステップＳ８６０）。また、ステップＳ８６０において、目標圧力設定部１１５は、第１圧力設定部１１１により設定された圧力Ｐａ２（ｉ）と、第２圧力設定部１１２により設定された圧力Ｐｂ２とのうちの大きい方を関節Ｊｉに対応した第２の人工筋肉ＡＭ２を構成する２つの液圧アクチュエータＭの目標圧力Ｐｔａｇ２（ｉ）に設定する。

【0064】

ステップＳ８６０にて目標圧力Ｐｔａｇ１（ｉ）およびＰｔａｇ２（ｉ）を設定すると、制御装置１００は、変数ｉをインクリメントし（ステップＳ８７０）、変数ｉが値Ｎ＋１以上であるか否かを判定する（ステップＳ８８０）。値Ｎは、ロボットアーム２における関節の数を示し、本実施形態では、Ｎ＝３である。制御装置１００は、変数ｉが値Ｎ＋１未満であると判定した場合（ステップＳ８８０：ＮＯ）、上記ステップＳ８１０－Ｓ８８０の処理を再度実行する。制御装置１００により変数ｉが値Ｎ＋１以上であると判定されると（ステップＳ８８０；ＹＥＳ）、図６に示すように、電流指令値設定部１１６は、図示しないマップ等を用いて、各関節Ｊｉの目標圧力Ｐｔａｇ１（ｉ）およびＰｔａｇ２（ｉ）の各々を電流指令値に直接変換する（ステップＳ９０）。電流指令値設定部１１６により導出された電流指令値は、バルブ駆動部１１７に与えられ、バルブ駆動部１１７は、当該電流指令に基づいて、それぞれ複数の第１および第２リニアソレノイドバルブ１５１，１５２を制御（ＰＷＭ制御）する（ステップＳ１００）。

【0065】

これにより、目標トルクＴｔａｇ（ｉ）に応じた液体供給装置１０への電流指令値が容易かつ速やかに設定され、当該電流指令値に基づいて制御される液体供給装置１０の第１および第２リニアソレノイドバルブ１５１，１５２の各々は、対応する目標圧力Ｐｔａｇ１（ｉ）またはＰｔａｇ２（ｉ）に応じた油圧を生成する。更に、第１および第２リニアソレノイドバルブ１５１，１５２により調圧された作動油は、第１および第２供給遮断弁１６１，１６２を介して対応する液圧アクチュエータＭのチューブＴに供給される。この結果、流量制御弁により作動油の流量を調整してチューブＴ内に供給したり、チューブＴに供給される油圧を圧力センサにより検出して実油圧が目標圧力に一致するように流量制御弁をフィードバック制御したりする場合に比べて、目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）の設定から短時間のうちに、各チューブＴに供給される油圧を当該目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）に実質的に一致させ、各チューブＴの実際の収縮率を要求値に応答性よく高精度に追従させることが可能となる。制御装置１００は、ステップＳ１００の処理の後、図６のルーチンを一旦終了させ、次の実行タイミングの到来に応じて再度ステップＳ１０以降の処理を実行する。

【0066】

一方、図６のステップＳ４０にて、トルク演算部１０３によりハンド部４の現在位置が前回位置から実質的に変化していないと判定されると、制御装置１００は、ハンド部４が把持対象に接触したとみなして図６のルーチンを終了させ、ハンド部４に把持対象を把持させるためのハンド制御ルーチンを実行する。また、制御装置１００の目標位置設定部１０１は、ハンド部４により把持対象が把持されるまでに、図５のルーチンを実行して把持対象の載置位置に応じた目標到達位置および目標軌道を設定する。そして、ハンド部４により把持対象が把持されてハンド制御ルーチンが完了すると、制御装置１００は、ロボットアーム２により把持対象を載置位置まで搬送すべく、図６のルーチンを再度実行する。

【0067】

引き続き、図１０を参照しながら、第２圧力設定部１１２による第２の仮目標圧力（第２圧力）としての圧力Ｐｂ１（ｉ），Ｐｂ２（ｉ）の算出手順について説明する。

【0068】

図１０の一連の処理は、第２圧力設定部１１２により、図８のステップＳ８００－Ｓ８４０の処理と並行して実行されるものである。図示するように、第２圧力設定部１１２は、まず変数ｉすなわち関節の番号を値１に設定する（ステップＳ９００）。次いで、第２圧力設定部１１２は、目標角度算出部１０９により算出された関節Ｊｉの目標角度θｔａｇ（ｉ）および関節角度センサ７により検出された関節Ｊｉの現在の関節角度θｉを取得する（ステップＳ９１０）。更に、第２圧力設定部１１２は、取得した目標角度θｔａｇ（ｉ）に基づいて目標角度変化量Δθｔａｇ（ｉ）を算出すると共に、取得した関節角度θに基づいて関節角度変化量Δθｉを算出する（ステップＳ９２０）。目標角度変化量Δθｔａｇ（ｉ）は、ステップＳ９１０にて取得される目標角度θｔａｇ（ｉ）と図１０のルーチンの前回実行時に取得された目標角度θｔａｇ（ｉ）との差をとることにより算出され、関節角度変化量Δθｉは、ステップＳ９１０にて取得される関節角度θｉと図１０のルーチンの前回実行時に取得された関節角度θｉとの差をとることにより算出される。

【0069】

ステップＳ９２０の処理の後、第２圧力設定部１１２は、算出した目標角度変化量Δθｔａｇ（ｉ）が予め定められた閾値α以上であるか否かを判定する（ステップＳ９３０）。目標角度変化量Δθｔａｇ（ｉ）が閾値α以上であると判定した場合（ステップＳ９３０：ＹＥＳ）、第２圧力設定部１１２は、ステップＳ９２０にて算出した関節角度変化量Δθｉが予め定められた閾値β以上であるか否かを判定する（ステップＳ９４０）。目標角度変化量Δθｔａｇ（ｉ）が閾値α以上であり、かつ関節角度変化量Δθｉが閾値β以上であると判定した場合（ステップＳ９４０：ＹＥＳ）、第２圧力設定部１１２は、関節角度θｉの目標角度θｔａｇ（ｉ）に対する追従性が許容範囲内にあるとみなし、第２の仮目標圧力（第２圧力）としての圧力Ｐｂ１（ｉ）およびＰｂ２（ｉ）にゼロを設定する（ステップＳ９５０）。また、目標角度変化量Δθｔａｇ（ｉ）が閾値α未満であると判定した場合も（ステップＳ９３０：ＮＯ）、圧力Ｐｂ１（ｉ）およびＰｂ２（ｉ）にゼロを設定する（ステップＳ９５０）。

【0070】

これに対して、関節角度変化量Δθｉが閾値β未満であると判定した場合（ステップＳ９４０：ＮＯ）、第２圧力設定部１１２は、関節角度θｉの目標角度θｔａｇ（ｉ）に対する追従性が許容範囲外にあるとみなし、ステップＳ９１０にて取得した目標角度θｔａｇ（ｉ）と関節角度θｉとの角度差（＝θｔａｇ（ｉ）－θｉ）に基づいて第２の仮目標圧力（第２圧力）としての圧力Ｐｂ１（ｉ）およびＰｂ２（ｉ）を設定する（ステップＳ９５５）。本実施形態では、目標角度θｔａｇ（ｉ）と関節角度θｉとの角度差と、当該角度差を無くすのに要求される第１および第２の人工筋肉ＡＭ１，ＡＭ２への供給油圧との関係を規定する図示しない圧力設定マップが予め作成されている。当該圧力設定マップは、角度差が大きいほど第１および第２の人工筋肉ＡＭ１，ＡＭ２への供給油圧を高くするものである。ステップＳ９５５において、第２圧力設定部１１２は、当該圧力設定マップから目標角度θｔａｇ（ｉ）と関節角度θｉとの角度差に応じた第１の人工筋肉ＡＭ１への供給油圧を導出して圧力Ｐｂ１（ｉ）に設定すると共に、当該圧力設定マップから当該角度差に応じた第２の人工筋肉ＡＭ２への供給油圧を導出して圧力Ｐｂ２（ｉ）に設定する。これにより、ステップＳ９５５にて第２の仮目標圧力（第２圧力）としての圧力Ｐｂ１（ｉ）およびＰｂ２（ｉ）が設定された際には、圧力Ｐｂ１（ｉ）およびＰｂ２（ｉ）が第１の仮目標圧力（第１圧力）としての圧力Ｐａ１（ｉ）またはＰａ２（ｉ）よりも大きくなり、当該圧力Ｐｂ１（ｉ）およびＰｂ２（ｉ）が図８のステップＳ８６０にて目標圧力Ｐｔａｇ１（ｉ）またはＰｔａｇ２（ｉ）に設定されることになる。

【0071】

ステップＳ９５０またはＳ９５５にて圧力Ｐｂ１（ｉ）およびＰｂ２（ｉ）を設定すると、第２圧力設定部１１２は、変数ｉをインクリメントし（ステップＳ９６０）、変数ｉが値Ｎ＋１以上であるか否かを判定する（ステップＳ９７０）。第２圧力設定部１１２は、変数ｉが値Ｎ＋１未満であると判定した場合（ステップＳ９７０：ＮＯ）、上記ステップＳ９１０－Ｓ９７０の処理を再度実行する。また、第２圧力設定部１１２は、変数ｉが値Ｎ＋１以上であると判定した場合（ステップＳ９７０：ＹＥＳ）、図１０の一連の処理を一旦終了させ、次の実行タイミングの到来に応じて再度ステップＳ９００以降の処理を実行する。

【0072】

以上説明したように、本開示のロボット装置１は、それぞれ作動油（液体）の供給を受けて作動すると共に、関節Ｊｉを介して連結された２つのアーム３等を相対的に回動させる複数の液圧アクチュエータ（人工筋肉）Ｍと、当該複数の液圧アクチュエータＭに液体を供給する液体供給装置１０と、当該液体供給装置１０を制御する制御装置１００とを含む。また、制御装置１００は、予め定められた液圧アクチュエータＭの静特性を示す目標圧力設定マップを用いて各液圧アクチュエータＭに供給される油圧の第１の仮目標圧力（第１圧力）である圧力Ｐａ１（ｉ）、Ｐａ２（ｉ）を設定する（図８のステップＳ８４０）。更に、制御装置１００は、関節Ｊｉの現在の関節角度θｉの目標角度θｔａｇ（ｉ）に対する追従性に応じて、ゼロまたは目標角度θｔａｇ（ｉ）と関節角度θｉとの差に応じた圧力を各液圧アクチュエータＭに供給される油圧の第２の仮目標圧力（第２圧力）である圧力Ｐｂ１（ｉ），Ｐｂ２（ｉ）に設定する（図１０のステップＳ９５０，Ｓ９５５）。そして、制御装置１００は、圧力Ｐａ１（ｉ）と圧力Ｐｂ１（ｉ）とのうちの大きい方と、圧力Ｐａ２（ｉ）と圧力Ｐｂ２（ｉ）とのうちの大きい方とを各液圧アクチュエータＭの目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）に設定し、当該目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）に基づいて液体供給装置１０を制御する（図８のステップＳ８６０、図６のステップＳ９０－Ｓ１００）。

【0073】

すなわち、制御装置１００は、基本的に、液圧アクチュエータＭの静特性を示す目標圧力設定マップから導出された圧力を目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）に設定し、当該目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）に基づいて液体供給装置１０を制御する。一方、関節Ｊｉの現在の関節角度θｉの目標角度θｔａｇ（ｉ）に対する追従性が許容範囲外にあるときには、制御装置１００は、目標角度θｔａｇ（ｉ）と現在角度θｉとの差に基づいて導出された圧力を目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）に設定し、当該目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）に基づいて液体供給装置１０を制御する。これにより、ヒステリシス特性に起因して、人工筋肉としての液圧アクチュエータＭから実際に出力される力が上記静特性を示す目標圧力設定マップを用いて設定された目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）に対応する力よりも小さくなるときに、目標角度θｔａｇ（ｉ）と現在角度θｉとの差を無くすように目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）を設定してロボット装置１の動作不良を抑制することが可能となる。更に、ロボット装置１では、図９に関連して説明したように、目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）の設定に用いられる目標圧力設定マップに液圧アクチュエータＭのヒステリシス特性を完全に反映させる必要が無くなり、補正値の適合や煩雑な目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）の補正処理等が不要となる。この結果、適合処理や実際の制御を煩雑化させることなく、ヒステリシス特性を有する複数の液圧アクチュエータＭを含むロボット装置１を適正に作動させることが可能となる。

【0074】

また、ロボット装置１では、関節Ｊｉの現在の関節角度θｉの目標角度θｔａｇ（ｉ）に対する追従性が許容範囲外にあるときに、制御装置１００により、目標角度θｔａｇ（ｉ）と現在角度θｉとの差が大きくなるにつれて高くなるように目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）が設定されることになる（図１０のステップＳ９５５、図８のステップＳ８６０）。これにより、目標角度θｔａｇ（ｉ）と現在角度θｉとの差を無くすように各液圧アクチュエータＭに収縮力を発生させて、当該液圧アクチュエータＭのヒステリシス特性に起因するロボット装置１の動作不良の良好に抑制することが可能となる。

【0075】

更に、液圧アクチュエータＭの静特性を示す目標圧力設定マップは、当該液圧アクチュエータＭのチューブＴに供給される油圧ごとにチューブＴの収縮率とチューブＴの収縮により発生する収縮力との関係を規定するように、チューブＴに供給される液圧ごとに、軸方向に収縮するチューブＴの収縮率と軸方向に伸長するチューブＴの収縮率とが同一になったときに両者が発生する収縮力の平均をとることにより作成される。

【0076】

これにより、目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）の設定に用いられる目標圧力設定マップをより実用性の高いものとすることが可能となる。ただし、目標圧力設定マップは、このようなもの限られず、油圧ごとのチューブＴの収縮率を示す曲線は、軸方向に収縮するチューブＴの収縮率を示す曲線（図９における一点鎖線参照）よりも上側かつ軸方向に伸長するチューブＴの収縮率を示す曲線（図９における二点鎖線参照、線上を含む）までの範囲に含まれていればよい。

【0077】

また、制御装置１００は、関節Ｊｉを介して連結された２つのアーム３等を相対的に回動させるための目標トルクＴｒａｇ（ｉ）を設定する目標トルク設定部１０５と、関節Ｊｉの現在の関節角度θｉに基づいて各液圧アクチュエータＭの収縮率Ｃｒ１（ｉ），Ｃｒ２（ｉ）を設定する収縮率設定部１０７と、目標トルク設定部１０５により設定された目標トルクＴｒａｇ（ｉ）に基づいて各液圧アクチュエータＭの収縮率Ｆｃ１（ｉ），Ｆｃ２（ｉ）を算出する収縮力算出部１０８と、目標圧力設定マップ（静特性）を用いて収縮率設定部１０７により設定された収縮率Ｃｒ１（ｉ），Ｃｒ２（ｉ）と収縮力算出部１０８により算出された収縮力Ｆｃ１（ｉ），Ｆｃ２（ｉ）とに対応した圧力（第１圧力）Ｐａ１（ｉ），Ｐａ２（ｉ）を設定する第１圧力設定部１１１と、関節角度θｉの目標角度θｔａｇ（ｉ）に対する追従性が許容範囲内にあるときに圧力（第２圧力）Ｐｂ１（ｉ），Ｐｂ２（ｉ）にゼロを設定すると共に、当該追従性が許容範囲外にあるときに目標角度θｔａｇ（ｉ）と関節角度θｉとの角度差に基づいて圧力Ｐｂ１（ｉ），Ｐｂ２（ｉ）を設定する第２圧力設定部１１２と、圧力Ｐａ１（ｉ）と圧力Ｐｂ１（ｉ）とのうちの大きい方と、圧力Ｐａ２（ｉ）と圧力Ｐｂ２（ｉ）とのうちの大きい方とを目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）に設定に設定する目標圧力設定部１１５とを含む。これにより、目標トルクＴｔａｇ（ｉ）から各液圧アクチュエータＭに供給される油圧の目標圧力Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ）を適正に設定することが可能となる。

【0078】

なお、ロボット装置１において、２つのアーム３等は、第１の人工筋肉ＡＭ１を構成する２つの液圧アクチュエータＭと、当該２つの液圧アクチュエータＭと互いに拮抗するように配置された第２の人工筋肉ＡＭ２を構成する他の２つの液圧アクチュエータＭとにより相対的に回動させられるが、これに限られるものではない。すなわち、関節Ｊｉを介して連結された２つのアーム３等に必ずしも対をなす複数の液圧アクチュエータ（人工筋肉）Ｍが設けられる必要はなく、当該２つのアーム３等には、１つまたは複数の液圧アクチュエータＭと、当該液圧アクチュエータＭと拮抗するように配置されるスプリングやゴム材等の弾性体とが連結されてもよい。

【0079】

また、ロボット装置１において、制御装置１００の収縮力算出部１０８は、目標トルク設定部１０５により設定された目標トルクＴｔａｇ（ｉ）と、目標剛性設定部１０６により設定された目標剛性Ｒ（ｉ）とに基づいて液圧アクチュエータＭの収縮力Ｆｃ１（ｉ），Ｆｃ２（ｉ）を算出するが、これに限られるものではない。すなわち、少なくともロボット装置１のハンド部４の目標位置に基づいて関節Ｊｉに対応した上記第１および第２の人工筋肉ＡＭ１，ＡＭ２の一方を構成する２つの液圧アクチュエータＭに発生させる収縮力Ｆｃ１（ｉ）が設定されてもよく、目標トルクＴｔａｇ（ｉ）と収縮力Ｆｃ１（ｉ）とに基づいて当該第１および第２の人工筋肉ＡＭ１，ＡＭ２の他方を構成する２つの液圧アクチュエータＭに発生させる収縮力Ｆｃ２（ｉ）が設定されてもよい。また、ロボット装置１において、目標トルクＴｔａｇ（ｉ）等に応じて、予め定められた一定の圧力が関節Ｊｉに対応した第１および第２の人工筋肉ＡＭ１，ＡＭ２の一方を構成する２つの液圧アクチュエータＭの目標圧力Ｐｔａｇ１（ｉ）に設定されてもよく、目標トルクＴｔａｇ（ｉ）と目標圧力Ｐｔａｇ１（ｉ）とに基づいて当該第１および第２の人工筋肉ＡＭ１，ＡＭ２の他方を構成する２つの液圧アクチュエータＭの目標圧力Ｐｔａｇ２（ｉ）が設定されてもよい。

【0080】

更に、液体供給装置１０において、第１および第２リニアソレノイドバルブ１５１，１５２が、電磁部に供給される電流に応じた信号圧を出力するリニアソレノイドバルブ（あるいはオンオフソレノイドバルブ）と、当該信号圧に応じて作動油を調圧するコントロールバルブとで置き換えられてもよい。また、第１および第２リニアソレノイドバルブ１５１，１５２は、対応する液圧アクチュエータＭに供給される液圧（油圧）が目標圧力になるように制御される流量制御弁で置き換えられてもよい。更に、液体供給装置１０から元圧生成バルブ１４が省略されてもよい。また、ポンプ１３により発生させられた油圧を蓄えるアキュムレータ（蓄圧器）が液体供給装置１０に設けられてもよい。更に、液体供給装置１０は、水等の作動油以外の液体を液圧アクチュエータＭに供給するように構成されてもよい。

【0081】

また、上記実施形態において、人工筋肉としての液圧アクチュエータＭは、内部に作動油が供給されると共に当該内部の油圧の上昇に応じて径方向に膨張しながら軸方向に収縮するチューブＴと、当該チューブＴを覆う編組スリーブＳとを含むマッキベン型の人工筋肉であるが、ロボット装置１における液圧アクチュエータＭの構成は、これに限られるものではない。すなわち、液圧アクチュエータＭは、液体が供給された際に径方向に膨張しながら軸方向に収縮するチューブを含むものであればよく、例えば弾性体により形成された内側筒状部材と、弾性体により形成されると共に内側筒状部材の外側に同軸に配置され外側筒状部材と、内側筒状部材と外側筒状部材との間に配置された繊維層とを含む軸方向繊維強化型の液圧アクチュエータ（例えば、特開２０１１－１３７５１６号参照）であってもよい。更に、液圧アクチュエータＭは、シリンダおよびピストンを含む液体シリンダであってもよい。

【0082】

そして、ロボット装置１は、少なくとも１つの液圧アクチュエータＭとハンド部４とを有するロボットアーム２を含むものに限られず、少なくとも１つの液圧アクチュエータＭと、例えばドリルビット等の工具や例えばスイッチ等を押圧する押圧部材といったハンド部４以外の要素が手先に取り付けられたロボットアームとを含むものであってもよい。また、ロボット装置１は、歩行ロボットや、ウェアラブルロボット等であってもよい。更に、ロボット装置１は、関節を１つだけ含むものであってもよく、人工筋肉としての液圧アクチュエータＭを１つだけ含むものであってもよい。

【0083】

また、本開示の発明は上記実施形態に何ら限定されるものではなく、本開示の外延の範囲内において様々な変更をなし得ることはいうまでもない。更に、上記実施形態は、あくまで発明の概要の欄に記載された発明の具体的な一形態に過ぎず、発明の概要の欄に記載された発明の要素を限定するものではない。

【産業上の利用可能性】

【0084】

本開示の発明は、人工筋肉を含むロボット装置の製造産業等において利用可能である。

【符号の説明】

【0085】

１ ロボット装置、２ ロボットアーム（ロボット本体）、３ アーム（リンク）、４ ハンド部、５ 支持部材（リンク）、６ 連結部材、７ 関節角度センサ、１０ 液体供給装置、１５１ 第１リニアソレノイドバルブ（調圧装置）、１５２ 第２リニアソレノイドバルブ（調圧装置）、１５ｄ ドレンポート、１５ｅ 電磁部、１５ｆ フィードバックポート、１５ｉ 入力ポート、１５ｏ 出力ポート、１５ｓ スプール、ＳＰ スプリング、１００ 制御装置、１０１ 目標位置設定部（目標到達位置設定部、目標軌道設定部）、１０３ トルク演算部、１０４ 重力補償部、１０５ 目標トルク設定部、１０６ 目標剛性設定部、１０７ 収縮率設定部、１０８ 収縮力算出部、１１１ 第１圧力設定部、 １１２ 第２圧力設定部、１１５ 目標圧力設定部、１１６ 電流指令値設定部（指令値設定部）、ＡＭ１ 第１の人工筋肉、ＡＭ２ 第２の人工筋肉、Ｃｒ１（ｉ），Ｃｒ２（ｉ） 収縮率、Ｆｃ１（ｉ），Ｆｃ２（ｉ） 収縮力、Ｆｐ 押圧力、Ｆｔ 引張力、Ｆｕ 上限値、Ｊ１，Ｊ２，Ｊ３，Ｊｉ 関節、Ｋ_px，Ｋ_py，Ｋ_pz，Ｋ_vx，Ｋ_vy，Ｋ_vz ゲイン、Ｍ 液圧アクチュエータ（人工筋肉）、Ｐｔａｇ１（ｉ），Ｐｔａｇ２（ｉ） 目標圧力、Ｒ（ｉ） 目標剛性、Ｓ 編組スリーブ、Ｔｊ（ｉ） 関節トルク、Ｔ チューブ、Ｔｔａｇ（ｉ） 目標トルク、θｉ 関節角度。

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】

【図10】