JP6112947B2 - ロボット装置、ロボット制御方法、プログラム及び記録媒体 - Google Patents

Description

本発明は、リンクを旋回駆動する一対のアクチュエータを制御する制御部を備えたロボット装置、ロボット制御方法、プログラム及び記録媒体に関する。

マニピュレータの制御方法において、手先が対象物に柔軟に接触できることが重要になってきている。これを産業ロボットに応用すれば、人間とロボットとの共同作業が実現したり、手先の柔軟性の方向を制御することにより部品のはめ合い作業等が容易になったりする。

また、これを脚式移動ロボットに応用すれば、地面に柔らかく接地することで胴体に対する衝撃を和らげたり、段差を吸収することで不整地を安定に歩行したりすることを可能とする。

手先の柔軟性の制御を実現するために、手先に力センサを装着するインピーダンス制御や、人工筋肉アクチュエータを用いる制御等が行われている。人間の筋はアクチュエータであると同時に、粘弾性可変の制御機構であることが知られている。人工筋肉アクチュエータの中でも、特にＭｃＫｉｂｂｅｎ型の人工筋肉アクチュエータに代表される空気圧式のゴム人工筋肉アクチュエータは、粘弾性特性が筋に類似している。そこで、マニピュレータに配置されている人工筋肉アクチュエータの柔らかさを制御することで、任意の手先の柔軟性で対象物に接触することができる。

非特許文献１においては、第１リンク及び第２リンクをそれぞれ駆動する人工筋肉アクチュエータに加え、第１リンクと第２リンクとを同時に駆動する二関節同時駆動アクチュエータを有する、３対６筋マニピュレータが提示されている。非特許文献１では、人工筋肉アクチュエータの弾性を等しくすると、第１関節と手先を結ぶ線上から手先に外力が加わった場合では、手先の外力方向と移動方向が一致するという剛性特性に特徴があることを検証している。ＭｃＫｉｂｂｅｎ型のアクチュエータは粘弾性特性に非線形性を有している、拮抗配置して制御を行う必要がある、という理由でモーションコントロールに用いることには難がある。

これに対し、特許文献１では、制御入力の飽和を用いる簡便なフィードバック制御系を導出し、手先の剛性制御に加えて関節角度の同時制御を行っている。

マニピュレータシステムは手先の質量によってダイナミクスが変化する。この変化を考慮しない制御系では、手先のペイロード把持などにより関節角度の制御性能が劣化してしまう。マニピュレータシステムにダイナミクスの変化が生じた際に、制御性能及び安定性を保つ制御手法として、受動性に基づく制御が知られている。

特開２０１２−８６３５４号公報

一関節筋および二関節筋を含む筋座標系によるロボットアームの機能的特性、大島徹、藤川智彦、熊本水頼、精密工学会誌、Ｖｏｌ．６６，Ｎｏ．１，ｐｐ．１４１−１４６

しかしながら、上記特許文献１に示されているマニピュレータの制御では、アクチュエータの弾性要素による関節トルクを補償するため、フィードバック系に積分器を持たせている。そのため、ＰＤ制御等の受動性に基づく制御を導入することが難しく、ペイロード把持などにより手先質量が変動すると、関節角度の追従制御性能が劣化するという問題があった。

そこで、本発明は、リンクの負荷変動に対して関節角度の追従制御性能を維持することができるロボット装置、ロボット制御方法、プログラム及び記録媒体を提供することを目的とする。

本発明のロボット装置は、基部に対して第１関節で旋回可能に連結された第１リンクと、引張力を発生し、前記第１リンクを前記第１関節まわりに旋回駆動するよう前記第１リンクの両側に配置された一対の一関節駆動アクチュエータと、前記各一関節駆動アクチュエータに対する発生力指令値をそれぞれ求めて前記各一関節駆動アクチュエータを制御する制御部と、を備え、前記制御部は、前記第１関節の関節角度を目標関節角度にするのに必要な関節トルクを求める関節トルク演算処理と、前記第１関節の目標剛性に基づき、前記各一関節駆動アクチュエータに対する発生力指令値の和を示す和算値を求める和算処理と、前記第１関節に作用する前記各一関節駆動アクチュエータの弾性力による弾性トルクを求める弾性トルク演算処理と、前記関節トルクをＴ_１、前記和算値をＵ_１、前記弾性トルクをＴ_ＰＣ１、前記第１リンクのモーメントアーム径をｒとしたとき、｜Ｔ_１＋Ｔ_ＰＣ１｜＜Ｕ_１×ｒの制約条件を満たすように、前記関節トルクと前記弾性トルクとの合計値を制約する制約処理と、前記制約処理にて制約された前記合計値に基づき、前記各一関節駆動アクチュエータの発生力指令値を求める発生力演算処理と、を実行することを特徴とする。

本発明によれば、アクチュエータの弾性要素による関節剛性を補償する制御により、受動性に基づく制御が可能となる。そのため、リンクに接触が生じていなければ、リンクの負荷変動などに対してロバスト安定性の高い軌道制御が実現され、接触時はアクチュエータの弾性要素による所望の剛性が実現される。これにより、ロバスト性の高い関節角度の軌道追従制御と手先の柔軟性の制御の同時制御を実現することができる。

アクチュエータの粘弾性モデルを示す模式図である。 第１実施形態におけるロボット装置を示す模式図である。 第１実施形態における制御装置の構成を示すブロック図である。 第１実施形態におけるＣＰＵの制御動作を説明するための機能ブロック線図である。 第１実施形態におけるＣＰＵの制御動作を説明するための機能ブロック線図である。 第１実施形態における軌道設計を示す図である。 第１実施形態におけるシミュレーション結果を示す図である。 第１実施形態におけるシミュレーション結果を示す図である。 第２実施形態におけるロボット装置を示す模式図である。 第２実施形態におけるスティフネス楕円を説明する図である。 第２実施形態における制御装置の構成を示すブロック図である。 第２実施形態におけるＣＰＵの制御動作を説明するための機能ブロック線図である。 図１２のフィードバック演算部のブロック線図である。 第２実施形態におけるシミュレーション結果を示す図である。 第２実施形態におけるシミュレーション結果を示す図である。 第２実施形態におけるシミュレーション結果を示す図である。 第２実施形態におけるシミュレーション結果を示す図である。

以下、本発明を実施するための形態を、図面を参照しながら詳細に説明する。

［第１実施形態］
第１実施形態では、人工筋肉アクチュエータを用いたマニピュレータの関節角度と剛性の同時制御について説明する。

（１）モデリング
本第１実施形態では、人工筋肉アクチュエータを用いたマニピュレータの制御を行う。人工筋肉アクチュエータとは、筋の粘弾性と呼ばれる特性と類似する特性を有するアクチュエータである。筋は図１に示すように、力発生要素と弾性要素と粘性要素とを用いてモデル化される。ここで、ｕを力発生要素の収縮力（引張力）、ｘを収縮方向（引張方向）を正とする筋の収縮量（引張量）とする。収縮速度は、以下の式となる。

また、ｋを弾性定数、ｂを粘性定数、Ｆを筋発生力とする。このとき、筋の粘弾性特性は、

とモデル化され、筋発生力の弾性力、粘性力は、力発生要素の発生力ｕと比例するという非線形要素を有する点が特徴的である。

次に、本第１実施形態に係るロボット装置を図２に示す。図２に示すロボット装置１００は、いわゆる１リンクマニピュレータ（以下、単に「マニピュレータ」という）１２０を有している。マニピュレータ１２０は、第１リンクであるリンク１０１、一対の一関節駆動アクチュエータであるアクチュエータｅ_１，ｆ_１を備えている。

リンク１０１は、基端が基部１０３に対して第１関節である関節Ｊ１で旋回可能に連結されている。

アクチュエータｅ_１，ｆ_１は、力発生要素、弾性要素及び粘性要素の並列接続でモデル化された、ＭｃＫｉｂｂｅｎ型の人工筋肉アクチュエータに代表される空気圧式のゴム人工筋肉アクチュエータである。

アクチュエータｅ_１，ｆ_１は、発生力として、引張力（収縮力）のみ発生する。関節Ｊ１を任意の関節角度に位置決めするためには、アクチュエータｅ_１，ｆ_１は、拮抗して配置される必要がある。そのため、アクチュエータｅ_１，ｆ_１は、リンク１０１を関節Ｊ１まわりに旋回駆動するようリンク１０１の両側に配置されている。アクチュエータｅ_１，ｆ_１の一端が、基部１０３に固定され、他端がリンク１０１に固定されている。

拮抗配置された各アクチュエータｅ_１，ｆ_１の力発生要素の発生力（収縮力）、即ち発生力指令値をそれぞれｕ_ｅ１，ｕ_ｆ１とする。また、リンク１０１の旋回角度、即ち関節Ｊ１の関節角度（第１関節角度）をθとする。また、リンク１０１の慣性モーメントをＩ、モーメントアーム径をｒとすると、運動方程式は、

となる。式（２）の右辺第一項における発生力（発生力指令値）ｕ_ｅ１，ｕ_ｆ１の差が関節に回転トルク（関節トルク）を与え、右辺第二、第三項における発生力ｕ_ｅ１，ｕ_ｆ１の和が関節Ｊ１に対する剛性及び粘性を変動させることがわかる。

（２）制御系設計
ロボット装置１００は、制御装置２００と、制御装置２００からの発生力指令値ｕ_ｅ１，ｕ_ｆ１に基づき、アクチュエータｅ_１，ｆ_１をそれぞれ駆動させる２つのドライバ３０１，３０２とを備えている。これらドライバ３０１，３０２は、アクチュエータｅ_１，ｆ_１に空気を送り込み、発生力指令値に応じた力をアクチュエータｅ_１，ｆ_１に発生させるものである。

制御装置２００は、各アクチュエータｅ_１，ｆ_１に対応する発生力指令値ｕ_ｅ１，ｕ_ｆ１を生成する。そして、制御装置２００は、各ドライバ３０１，３０２に各発生力指令値ｕ_ｅ１，ｕ_ｆ１を出力することで、各アクチュエータｅ_１，ｆ_１の発生力を制御する。

以下、制御装置２００の動作を説明する前に、制御装置２００の装置構成について説明する。図３は、制御装置２００の構成を示すブロック図である。

制御装置２００は、コンピュータで構成されており、制御部（演算部）としてのＣＰＵ（Central Processing Unit）２０１を有している。また制御装置２００は、ＲＯＭ（Read Only Memory）２０２及びＲＡＭ（Random Access Memory）２０３を有している。また、制御装置２００は、ＨＤＤ（Hard Disk Drive）２０４、記録ディスクドライブ２０５及び各種のインタフェース２０７，２０９，２１０を備えている。

ＣＰＵ２０１には、ＲＯＭ２０２、ＲＡＭ２０３、ＨＤＤ２０４、記録ディスクドライブ２０５及び各種のインタフェース２０７，２０９，２１０が、バス２０６を介して接続されている。ＲＯＭ２０２には、ＢＩＯＳ等の基本プログラムが格納されている。ＲＡＭ２０３は、ＣＰＵ２０１の演算処理結果を一時的に記憶する記憶装置である。

ＨＤＤ２０４は、ＣＰＵ２０１の演算処理結果である各種のデータ等を記憶する記憶部であると共に、ＣＰＵ２０１に、後述する各種演算処理を実行させるためのプログラム２２１を記録する記録媒体でもある。ＣＰＵ２０１は、ＨＤＤ２０４に記録されたプログラム２２１に基づいて各種演算処理を実行する。

記録ディスクドライブ２０５は、記録ディスク２２２に記録された各種データやプログラム等を読み出すことができる。

インタフェース２１０には、上述したドライバ３０１，３０２が接続されている。ＣＰＵ２０１は、バス２０６及びインタフェース２１０を介して各ドライバ３０１，３０２に発生力指令値ｕ_ｅ１，ｕ_ｆ１を出力する。これにより、各ドライバ３０１，３０２は、各発生力指令値ｕ_ｅ１，ｕ_ｆ１に対応する発生力を各アクチュエータｅ_１，ｆ_１に発生させる。

本第１実施形態では、ロボット装置１００は、図１では不図示の第１検出部である検出部４０１、及び接触センサ４０３を備えている。検出部４０１は、図１で関節Ｊ１に配置され、関節Ｊ１の関節角度θを検出する。接触センサ４０３は、リンク１０１に設けられ、リンク１０１に物体が接触したか否かを検知する。

インタフェース２０７には、検出部４０１が接続され、検出された関節角度θを示す信号が、インタフェース２０７及びバス２０６を介してＣＰＵ２０１に伝送される。インタフェース２０９には、接触センサ４０３が接続され、接触したか否かを示す信号が、インタフェース２０９及びバス２０６を介してＣＰＵ２０１に伝送される。

図４は、ＣＰＵ２０１の制御動作を説明するための機能ブロック線図である。以下、図４を用いてロボット制御方法について説明する。なお、図４では、マニピュレータ１２０は、符号Ｐで表している。ここで、制御装置２００のＣＰＵ（制御部）２０１は、ＨＤＤ２０４から読み出したプログラム２２１を実行することにより、図４に示す各部として機能する。

即ち、ＣＰＵ２０１は、プログラム２２１に基づき、関節トルク演算処理を実行する関節トルク演算部２３０、和算処理を実行する和算部２３１、弾性トルク演算処理を実行する弾性トルク演算部２３２として機能する。更に、ＣＰＵ２０１は、プログラム２２１に基づき、加算部２３３、制約処理を実行する制約部２３４、及び発生力演算処理を実行する発生力演算部２３５として機能する。

本第１実施形態では、関節Ｊ１を目標関節角度ｒ_ａに位置決めし、同時に関節Ｊ１の剛性を制御する。受動性に基づくロバスト制御を行う場合、その制御は積分器を考慮して設計することは難しい。

そこで、本第１実施形態では、弾性力を補償するループを設け、手先に接触などが発生せず剛性制御を必要としない際は弾性力をキャンセルし、受動性に基づく制御系を設計することにより位置決め制御に対するロバスト性を向上させる。

（２．１）粘弾性力補償
関節Ｊ１の目標関節角度をｒ_ａ、関節Ｊ１の目標剛性をｒ_ｓとする。関節トルク演算部２３０は、関節トルク演算処理として、関節Ｊ１の関節角度θを目標関節角度ｒ_ａにするのに必要な関節トルクＴ_１を演算する（関節トルク演算ステップ）。

具体的には、関節トルク演算部２３０は、フィードフォワード演算処理を実行するフィードフォワード演算部２４１と、フィードバック演算処理を実行するフィードバック演算部２４２と、加算処理を実行する加算部２４３とを有する。

フィードフォワード演算部２４１は、目標関節角度ｒ_ａに基づくフィードフォワード演算により、関節Ｊ１に対するフィードフォワード制御トルクＴ_ＦＦＷ１を求める。フィードバック演算部２４２は、関節角度θと目標関節角度ｒ_ａとの差分（θ−ｒ_ａ）に基づくフィードバック演算により、フィードバック制御トルクＴ_ＦＢ１を求める。より具体的には、フィードバック演算部２４２は、フィードバック演算処理として、差分（θ−ｒ_ａ）を補償するＰＤ制御を行う。そして、加算部２４３は、フィードバック制御トルクＴ_ＦＢ１にフィードフォワード制御トルクＴ_ＦＦＷ１を加算して、関節トルクＴ_１を求める。つまり、関節トルクをＴ_１＝Ｔ_ＦＢ１＋Ｔ_ＦＦＷ１と定義する。フィードバック制御系であるフィードバック演算部２４２により用いられる伝達関数をＫ_Ｐａｓとする。

また、アクチュエータｅ_１，ｆ_１の弾性力を補償する制御入力（弾性トルク）をＴ_ＰＣ１とすると、

となる。即ち、弾性トルク演算部２３２は、弾性トルク演算処理として、式（３）に基づき、関節Ｊ１に作用する弾性力による弾性トルクＴ_ＰＣ１を演算する（弾性トルク演算ステップ）。

ここで、式（２）より、

を満たすように発生力指令値ｕ_ｅ１，ｕ_ｆ１を決定すれば、関節トルクＴ_１と弾性トルクＴ_ＰＣ１を与えることができる。

しかし、同時に関節Ｊ１の剛性に関する条件

を満たさなければならない。Ｕ_１を発生力指令値ｕ_ｅ１，ｕ_ｆ１の和を示す和算値

と定義すると、

を満たすように、発生力指令値ｕ_ｅ１，ｕ_ｆ１を決定する必要がある。即ち、和算部２３１は、和算処理として、関節Ｊ１の目標剛性ｒ_ｓに基づき、つまり式（７）の関係式に基づき、和算値Ｕ１を求める（和算ステップ）。

トルクの合計値（Ｔ_１＋Ｔ_ＰＣ１）と収縮力の和算値Ｕ_１を同時に満たすには、式（４）と式（６）をｕ_ｅ１，ｕ_ｆ１について解き、

と決定すればよい。しかし、人工筋肉アクチュエータは収縮方向（引張方向）にのみ力を発生するため、

という条件を同時に満たさなければならない。式（８）と式（９）より

という条件が得られる。つまりトルクの合計値Ｔ_１＋Ｔ_ＰＣ１が、

という条件を満たしていれば、マニピュレータ１２０は、関節Ｊ１の剛性が目標値ｒ_ｓとなると同時に、トルクＴ_１により目標角度ｒ_ａに位置決めされる。

式（１１）を実現するには、

と制御入力を制約すればよい。

即ち、加算部２３３は、関節トルクＴ_１と弾性トルクＴ_ＰＣ１とを合計した合計値（Ｔ_１＋Ｔ_ＰＣ１）を生成する。次に、制約部２３４は、制約処理として、｜Ｔ_１＋Ｔ_ＰＣ１｜＜Ｕ_１×ｒの制約条件を満たすように、合計値（Ｔ_１＋Ｔ_ＰＣ１）を制約する（制約ステップ）。次に、発生力演算部２３５は、制約部２３４にて制約されたトルクの合計値（Ｔ_１＋Ｔ_ＰＣ１）に基づき、各アクチュエータｅ_１，ｆ_１の発生力指令値ｕ_ｅ１，ｕ_ｆ１を、式（８）を用いて演算する（発生力演算ステップ）。

ここで、図４に示すように、接触ゲインＧｔを導入し、接触が発生した場合は、Ｇｔ＝０とすることでフィードバック系および筋の弾性力の補償ループを遮断する。これにより、リンク１０１が人や物に接触したことを検知するなどの任意の時刻で、速やかにリンク１０１の剛性を目標剛性ｒ_ｓへと切り替えることができる。

本第１実施形態では、筋の弾性力を補償しているためフィードバック演算部２４２に積分器が不要となるため、ＰＤ制御系を用いる。伝達関数Ｋ_Ｐａｓは、

としている。

ここで、図４に示す制御ブロックを図５に示す制御ブロックに等価変換することが可能である。式（１４）を発生力の和算値Ｕ_１を用いて書き直すと、

となる。即ち、制御部であるＣＰＵ２０１は、弾性トルク演算処理として、Ｕ_１×ｋ×ｒ^２×θを演算することにより、弾性トルクＴ_ＰＣ１を求める。これを、式（８）に代入すると、

となる。このとき、アクチュエータｅ_１，ｆ_１が収縮方向にのみ力を発生する条件は、

となる。

制御入力（関節トルク）Ｔ_１を、関節角度θをパラメータとして式（１６）に示したように上限値、下限値を制約し、さらに式（１５）に示したように分配する。これにより、マニピュレータ１２０はＰＤ制御系のような積分器を含まない制御系を用いて関節Ｊ１の剛性が目標値ｒ_ｓとなると同時に、トルクＴ_１により目標角度ｒ_ａに位置決めされる。

なお、本第１実施形態では筋の弾性力を補償する制御系を示したが、関節角速度を制御ループに加えることで筋の粘性力を補償することも可能である。

（２．２）軌道設計
次に、関節Ｊ１の目標軌道ｒ_ａ、目標剛性ｒ_ｓの設計方法を示す。本第１実施形態では、目標軌道ｒ_ａは図６（ａ）に示すような、加速区間−等速区間−減速区間を有する軌道を用いる。ここで、ｒ_ａＳ，ｒ_ａＦはそれぞれ、軌道の初期角度、目標角度である。また、ｔ_ａ，ｔ_ｂ，ｔ_ｆｉｎはそれぞれ、等速区間の開始時間、等速区間の終了時間、位置決め終了時間である。さらに、目標剛性ｒ_ｓは図６（ｂ）に示すように、加減速区間で高剛性ｒ_ｓｍａｘとなり、等速間で低剛性ｒ_ｓｍｉｎとなるように設定する。剛性を可変させることにより、マニピュレータ１２０は、駆動開始時では筋の弾性力により加速され、等速区間では低剛性となることによりほぼ慣性力で駆動される。これにより、少ない筋の発生力で駆動することが可能となる。

本第１実施形態では、加速区間−等速区間−減速区間を有する軌道を用いたが、例えばミニマムジャーク軌道のような等速区間を伴わない軌道であっても構わない。また、駆動の効率を考慮しない場合は、目標剛性を一定としても構わない。

（３）シミュレーション
前節の制御系を用いるシミュレーションを行う。リンク１０１の慣性モーメントをＩ＝８．３×１０^−２［ｋｇｍ^２］、モーメントアーム径をｒ＝０．１［ｍ］、弾性定数，粘性定数をｋ＝２５，ｂ＝３とする。目標軌道ｒ_ａは、初期角度ｒ_ａＳ＝０［ｄｅｇ］、目標角度ｒ_ａＦ＝２０［ｄｅｇ］、等速区間の開始時間ｔ_ａ＝０．３５［秒］、等速区間の終了時間ｔ_ｂ＝０．４５［秒］、位置決め終了時間ｔ_ｆｉｎ＝０．８［秒］とする。関節Ｊ１の目標剛性はｒ_ｓｍａｘ＝２．３×ｋ×ｒ^２［Ｎｍ／ｒａｄ］とし、ｒ_ｓｍｉｎ＝０．８×ｋ×ｒ^２［Ｎｍ／ｒａｄ］とする。ここで、ｋ，ｒは定数であるので、発生力の和Ｕ_１を、加減速区間でＵ_１＝２．３、等速区間で、Ｕ_１＝０．８となるように制御すればよい。

図７（ａ）に関節角度θと目標角度ｒ_ａをそれぞれ実線，破線で、図７（ｂ）に発生力指令値ｕ_ｅ１，ｕ_ｆ１の応答をそれぞれ実線，破線で示す。図７（ｃ）に発生力指令値ｕ_ｅ１，ｕ_ｆ１の差を実線で、和を破線で、Ｔ_１／ｒ＋Ｕ_１×ｋ×ｒ×θの応答を一点鎖線で示す。さらに、図７（ｄ）に関節トルクＴ_１を実線で、そのうちフィードフォワード制御トルクＴ_ＦＦＷ１を破線で、式（１６）に示した制御トルクの上限値、下限値を点線で示す。

図７（ａ）より、目標軌道ｒ_ａと関節角度θは精度良く一致しており、関節Ｊ１は目標角度に位置決めされていることがわかる。図７（ｂ）より、発生力指令値ｕ_ｅ１，ｕ_ｆ１はフィードバック制御系の関節トルクＴ_１を、式（１５）と式（１６）に示した条件で配分されているが、人工筋肉アクチュエータの収縮力（引張力）は正の値のみを取るという特性を満たしていることがわかる。図７（ｃ）において、実線で示すｕ_ｆ１−ｕ_ｅ１は、一点鎖線で示すＴ_１／ｒ＋Ｕ_１×ｋ×ｒ×θと重なっており、式（４）の条件を満たしている。また、破線で示すｕ_ｆ１＋ｕ_ｅ１＝Ｕ_１は、０．３６［秒］以降は加減速区間で２．３、等速区間で０．８となっており、関節Ｊ１の剛性は目標値に制御されていることがわかる。図７（ｄ）より、慣性モーメントがノミナル値では関節トルクＴ_１とフィードフォワード制御トルクＴ_ＦＦＷ１は一致していることがわかる。

次に、制御系のロバスト性を検証するため、リンク１０１の慣性モーメントを１．２倍とするシミュレーションを行う。応答を図８（ａ）〜図８（ｄ）に示す。図８（ａ）より、慣性モーメントが変動しても受動性により関節角度θは目標軌道ｒ_ａに精度良く追従していることがわかる。また、図８（ｄ）より、慣性モーメントの変動をフィードバック制御系が補償していることがわかる。フィードバック制御系の制御入力により、関節トルクＴ_１は破線で示すトルク制限に達し、０．３［秒］前後でトルクが制約されている。これにより、アクチュエータｅ_１，ｆ_１は引張方向（収縮方向）のみに力を発生するという特性が保証され、図８（ｂ）より、発生力指令値ｕ_ｅ１，ｕ_ｆ１は正の値のみを取るという特性を満たしていることがわかる。このように、制御対象のパラメータが変動しても、図８（ｃ）において、破線で示すｕ_ｆ１＋ｕ_ｅ１＝Ｕ_１は、０．３６［秒］以降は加減速区間で２．３、等速区間で０．８となっており、関節Ｊ１の剛性は目標値に制御されていることがわかる。

以上、本第１実施形態により、フィードバック制御系に積分器を含めることなく、高精度な軌道追従制御と、筋の粘弾性力による剛性制御の同時制御が実現できることがわかる。

［第２実施形態］
次に、本発明の第２実施形態に係るロボット装置について説明する。

（１）モデリング
図９は、第２実施形態におけるロボット装置を示す模式図であり、ロボット装置１００Ｂは、マニピュレータ１２０Ｂと、制御装置２００Ｂと、６つのドライバ３０１〜３０６を備えている。

マニピュレータ１２０Ｂは、３対６筋の２リンクマニピュレータである。マニピュレータ１２０Ｂは、基部１０３に対して関節（第１関節）Ｊ１で旋回可能に連結されたリンク（第１リンク）１０１と、リンク１０１に対して関節（第２関節）Ｊ２で旋回可能に連結されたリンク（第２リンク）１０２とを有する。

また、マニピュレータ１２０Ｂは、リンク１０１を関節Ｊ１まわりに旋回駆動するようリンク１０１の両側に配置された一対のアクチュエータｅ_１，ｆ_１を有する。また、マニピュレータ１２０Ｂは、リンク１０２を関節Ｊ２まわりに旋回駆動するようリンク１０２の両側に配置された一対のアクチュエータｅ_２，ｆ_２を有する。更に、マニピュレータ１２０Ｂは、リンク１０１，１０２を同時に関節Ｊ１，Ｊ２まわりに旋回駆動するようリンク１０１，１０２の両側に配置された一対のアクチュエータｅ_３，ｆ_３を有する。

一対のアクチュエータｅ_３，ｆ_３は、二関節同時駆動アクチュエータである。二関節同時駆動アクチュエータは、リンク１０１とリンク１０２を同時に駆動するように配置されているアクチュエータであり、人の上腕部や下肢大腿部には、二関節筋とよばれる二関節同時駆動アクチュエータが存在することが知られている。人の四肢の筋配列は複雑であるが、実効筋概念が導入され、図９に示すような３対６筋を有する２リンクモデルが提示されている。なお、アクチュエータｅ_１，ｆ_１の拮抗対とアクチュエータｅ_２，ｆ_２の拮抗対のように単一のリンクを駆動するアクチュエータを一関節駆動アクチュエータとよぶ。

アクチュエータｅ_１，ｆ_１，ｅ_２，ｆ_２，ｅ_３，ｆ_３は、上記第１実施形態で説明した図１に示した筋の粘弾性特性を有するアクチュエータである。即ち、アクチュエータｅ_１，ｆ_１，ｅ_２，ｆ_２，ｅ_３，ｆ_３は、力発生要素、弾性要素及び粘性要素の並列接続でモデル化され、引張力（収縮力）のみを発生する。本第２実施形態では、２リンクマニピュレータ１２０Ｂに対して関節角度と剛性の同時制御を行う。

制御装置２００Ｂは、各アクチュエータｅ_１，ｆ_１，ｅ_２，ｆ_２，ｅ_３，ｆ_３に対応する発生力指令値ｕ_ｅ１，ｕ_ｆ１，ｕ_ｅ２，ｕ_ｆ２，ｕ_ｅ３，ｕ_ｆ３を生成する。そして、制御装置２００Ｂは、各ドライバ３０１〜３０６に各発生力指令値ｕ_ｅ１，ｕ_ｆ１，ｕ_ｅ２，ｕ_ｆ２，ｕ_ｅ３，ｕ_ｆ３を出力することで、各アクチュエータｅ_１，ｆ_１，ｅ_２，ｆ_２，ｅ_３，ｆ_３の発生力を制御する。各ドライバ３０１〜３０６は、発生力指令値ｕ_ｅ１，ｕ_ｆ１，ｕ_ｅ２，ｕ_ｆ２，ｕ_ｅ３，ｕ_ｆ３に対応する発生力をアクチュエータｅ_１，ｆ_１，ｅ_２，ｆ_２，ｅ_３，ｆ_３に発生させる。

ｕ_ｅｎ，ｕ_ｆｎ（ｎ＝１，２，３）を力発生要素の発生力（発生力指令値）、ｋ_ｅｎ，ｋ_ｆｎ，ｂ_ｅｎ，ｂ_ｆｎ（ｎ＝１，２，３）をアクチュエータの弾性定数、粘性定数とする。リンク１０１，１０２の旋回角度（即ち、関節Ｊ１，Ｊ２の関節角度）をθ_１，θ_２とする。また、リンク１０１，１０２の慣性モーメントをＩ_１，Ｉ_２、リンク１０１，１０２の長さをｌ_１，ｌ_２、リンク１０１，１０２の質量をｍ_１，ｍ_２とする。モーメントアーム径をリンク１０１，１０２共にｒとする。また、エンドエフェクタの質量をｍ_ｅとする。エンドエフェクタは、図９では省略されているが、リンク１０２の先端Ｅに設けられている。本第２実施形態では、各筋の弾性定数、粘性定数をいずれもｋ，ｂとすると、運動方程式は、

となる。

（２）制御系設計
上記第１実施形態では関節Ｊ１の角度と剛性の同時制御を行ったが、本第２実施形態においても、関節Ｊ１，Ｊ２の角度と剛性の同時制御を行う。しかし、２リンクマニピュレータ１２０Ｂでは、手先（リンク１０２の先端）Ｅが外界と直に接触するので、手先Ｅの剛性を制御することが重要である。手先Ｅの剛性は、図１０に示すようなスティフネス楕円によって表される。この楕円は、各方向に対しての剛性の分布を示し、手先Ｅと楕円の距離が離れるほど剛性が高いことを表している。

図１１は、制御装置２００Ｂの構成を示すブロック図である。制御装置２００Ｂは、コンピュータで構成されており、上記第１実施形態と同様、制御部（演算部）としてのＣＰＵ２０１、ＲＯＭ２０２、ＲＡＭ２０３、ＨＤＤ２０４、記録ディスクドライブ２０５及び各種のインタフェース２０７〜２１０を備えている。

ＣＰＵ２０１には、ＲＯＭ２０２、ＲＡＭ２０３、ＨＤＤ２０４、記録ディスクドライブ２０５及び各種のインタフェース２０７〜２１０が、バス２０６を介して接続されている。ＣＰＵ２０１は、ＨＤＤ２０４に記録されたプログラム２２１Ｂに基づいて各種演算処理を実行する。

インタフェース２１０には、上述したドライバ３０１〜３０６が接続されている。ＣＰＵ２０１は、バス２０６及びインタフェース２１０を介して各ドライバ３０１〜３０６に発生力指令値ｕ_ｅ１，ｕ_ｆ１，ｕ_ｅ２，ｕ_ｆ２，ｕ_ｅ３，ｕ_ｆ３を出力する。各ドライバ３０１〜３０６は、入力した各発生力指令値に対応する発生力を各アクチュエータｅ_１，ｆ_１，ｅ_２，ｆ_２，ｅ_３，ｆ_３に発生させる。

本第２実施形態では、ロボット装置１００Ｂは、図９では不図示の第１検出部である検出部４０１、第２検出部である検出部４０２及び接触センサ４０３を備えている。検出部４０１は、図９で関節Ｊ１に配置され、関節Ｊ１の関節角度（第１関節角度）θ_１を検出する。検出部４０２は、図９で関節Ｊ２に配置され、関節Ｊ２の関節角度（第２関節角度）θ_２を検出する。接触センサ４０３は、リンク１０１又はリンク１０２に設けられ、リンク１０１又はリンク１０２に物体が接触したか否かを検知する。

インタフェース２０７には、検出部４０１が接続され、検出された関節角度θ_１を示す信号が、インタフェース２０７及びバス２０６を介してＣＰＵ２０１に伝送される。インタフェース２０８には、検出部４０２が接続され、検出された関節角度θ_２を示す信号が、インタフェース２０８及びバス２０６を介してＣＰＵ２０１に伝送される。インタフェース２０９には、接触センサ４０３が接続され、接触したか否かを示す信号が、インタフェース２０９及びバス２０６を介してＣＰＵ２０１に伝送される。

図１２は、ＣＰＵ２０１の制御動作を説明するための機能ブロック線図である。以下、図１２を用いてロボット制御方法について説明する。なお、図１２では、マニピュレータ１２０Ｂは、符号Ｐで表している。ここで、制御装置２００ＢのＣＰＵ（制御部）２０１は、ＨＤＤ２０４から読み出したプログラム２２１Ｂを実行することにより、図１２に示す各部として機能する。

即ち、ＣＰＵ２０１は、プログラム２２１Ｂに基づき、目標関節角度生成部５２０として機能する。また、ＣＰＵ２０１は、プログラム２２１Ｂに基づき、関節トルク演算処理を実行する関節トルク演算部５３０、及び和算処理を実行する和算部５３１として機能する。また、ＣＰＵ２０１は、プログラム２２１Ｂに基づき、弾性トルク演算処理、制約処理及び発生力演算処理を実行する発生力演算部５３２，５３３，５３４として機能する。

目標関節角度生成部５２０は、リンク１０２の先端Ｅの目標軌道に基づき、関節Ｊ１の目標関節角度（第１目標関節角度）ｒ_ａ１及び関節Ｊ２の目標関節角度（第２目標関節角度）ｒ_ａ２を生成する目標関節角度生成処理を実行する。

ここで、関節トルク演算部５３０は、上記第１実施形態の関節トルク演算部２３０と略同様の演算処理を実行する。また、和算部５３１は、上記第１実施形態の和算部２３１と略同様の演算処理を実行する。また、発生力演算部５３２，５３３は、上記第１実施形態の各部２３３，２３４，２３５と略同様の演算処理を実行する。関節トルク演算部５３０は、上記第１実施形態と同様、フィードフォワード演算部５４１と、フィードバック演算部５４２と、加算部５４３，５４４とを有している。

（２．１）粘弾性力補償
一関節駆動アクチュエータであるアクチュエータｅ_１，ｆ_１及びアクチュエータｅ_２，ｆ_２の制御方法は第１実施形態と略同様である。リンク１０１，１０２に対して、フィードバック制御系Ｋ_Ｐａｓ及びフィードフォワード制御系Ｋ_ＦＦＷは、関節角度θ_ｎ（ｎ＝１，２）と目標角度ｒ_ａｎ（ｎ＝１，２）との誤差を補償するための関節トルク（制御入力トルク）Ｔ_ｎとして、

を算出する。上記第１実施形態と同様に、発生力指令値の和算値をＵ_ｎとおくと、

と表せる。上記第１実施形態と同様にこれを解くと、

となる。そして、関節トルク（制御入力トルク）Ｔ_ｎ（ｎ＝１，２）に対して、

と制約する。

本第２実施形態では、一関節駆動アクチュエータに加えて、二関節同時駆動アクチュエータであるアクチュエータｅ_３，ｆ_３を用いて関節Ｊ１，Ｊ２に剛性を与える。アクチュエータｅ_３，ｆ_３の発生力指令値ｕ_ｅ３，ｕ_ｆ３の和算値をＵ_３とする。さらに、アクチュエータｅ_３，ｆ_３の発生力指令値ｕ_ｅ３，ｕ_ｆ３に差を与えることによって、一関節駆動アクチュエータと同様に関節Ｊ１，Ｊ２にトルクを与えることが可能である。つまり、制御部であるＣＰＵ２０１（発生力演算部５３４）は、各アクチュエータｅ_３，ｆ_３に対する発生力指令値ｕ_ｅ３，ｕ_ｆ３の差分（ｕ_ｆ３−ｕ_ｅ３）に基づくトルクを各関節Ｊ１，Ｊ２に付与するように発生力指令値ｕ_ｅ３，ｕ_ｆ３を算出する。その際、接触などが発生せず手先Ｅに剛性を必要としない時間帯では、アクチュエータｅ_３，ｆ_３の関節トルクにより、弾性要素の発生力をキャンセルするように発生力指令値ｕ_ｅ３，ｕ_ｆ３を算出する。ここで、

とする。これを解くと発生力指令値ｕ_ｅ３，ｕ_ｆ３は、

となる。そして、

と制約する。

（２．２）ロバスト制御
上記第１実施形態では受動性に基づく制御系としてＰＤ制御系を適用した。しかし、２リンクマニピュレータに対しては受動性に基づくロバスト制御手法が数多く提案されており、制御系に受動性に基づくロバスト安定性に加え、ロバスト性能を付与することができる。これらのロバスト制御を、前節の粘弾性補償を用いることにより二関節筋マニピュレータに対して適用することができる。本第２実施形態では、フィードバック演算部５４２は、図１３に示すフィードバック制御系として構成されている。ここで、ｖ，ａは補助的なベクトルであり、

である。ただし、

である。また、

とする。Ｙはリグレッサと呼ばれる行列であり、

とおく。これを用いて、

と定義する。このときｕ_ｐを、

とすると、フィードバック制御トルクＴ_ＦＢｎは、

と求まる。ここで、

の変動幅から求めることができる。ここで、

はリンク１０２とエンドエフェクタを一体の剛体とみなすときの重心までの距離と慣性モーメントである。また、Λ，Ｋ，εは設計パラメータである。

（２．３）手先剛性制御
上記第１実施形態の１リンクマニュピレータ１２０では、関節Ｊ１の剛性と手先の剛性は同一であった。３対６筋を有する２リンクマニュピレータ１２０Ｂでは、発生力の和Ｕ_１，Ｕ_２，Ｕ_３を制御することにより手先Ｅの剛性が求まる。例えば、発生力の和Ｕ_１，Ｕ_２，Ｕ_３を、

と制御すると、スティフネス楕円の長軸は関節Ｊ１と手先Ｅを結ぶ方向を向くことが知られている。また、手先Ｅのスティフネス楕円の長短軸がｘ−ｙ軸と平行になる発生力の和Ｕ_１，Ｕ_２，Ｕ_３を求めてもよい。

（２．４）軌道設計
本第２実施形態では、目標軌道を手先Ｅがｙ軸に平行に駆動するものとする。さらに上記第１実施形態と同様に加速区間−等速区間−減速区間を有するものとする。そして、関節角度θ_１，θ_２に対する目標軌道ｒ_ａ１，ｒ_ａ２は、手先軌道から逆運動学により求める。

つぎに、目標剛性は式（３５）を満たし、手先Ｅの目標位置においてスティフネス楕円の長軸が関節Ｊ１と手先Ｅを結ぶ方向を向くように設定する。また、上記第１実施形態と同様に、加減速区間で高剛性となり、等速間で低剛性となるように設定する。加減速区間での一関節アクチュエータの発生力の和をＵ_ｎｍａｘ（ｎ＝１，２，３）、等速区間での一関節アクチュエータの発生力の和をＵ_ｎｍｉｎ（ｎ＝１，２，３）とする。

本第２実施形態では、加速区間−等速区間−減速区間を有する軌道を用いたが、例えばミニマムジャーク軌道のような等速区間を伴わない軌道であっても構わない。また、駆動の効率を考慮しない場合は、目標剛性を一定としても構わない。

（３）シミュレーション
前節の制御系を用いたシミュレーションを行う。リンク１０１とリンク１０２の物理パラメータは同一とする。リンク１０１，１０２の長さを０．２［ｍ］、リンク１０１，１０２の慣性モーメントをＩ_１＝Ｉ_２＝１．３×１０^−３［ｋｇｍ^２］、モーメントアーム径を０．０５［ｍ］、弾性、粘性定数をｋ＝１２，ｂ＝０．００３とする。目標軌道は、等速区間の開始時間ｔ_ａ＝０．２７４７［秒］、等速区間の終了時間ｔ_ｂ＝０．４７４６［秒］、位置決め終了時間ｔ_ｆｉｎ＝０．７５［秒］とする。また、手先Ｅのスティフネス楕円が関節Ｊ１と手先Ｅを結ぶ方向になるように、各アクチュエータの発生力の和Ｕ_１，Ｕ_２，Ｕ_３を制御する。そこで、Ｕ_ｎｍａｘ＝４，Ｕ_ｎｍｉｎ＝２（ｎ＝１，２，３）とする。

図１４（ａ）及び図１４（ｂ）にリンク１０１，１０２の関節角度θ_１，θ_２を実線で、目標軌道ｒ_ａ１，ｒ_ａ２を破線で示す。図１５（ａ）〜図１５（ｃ）に発生力指令値ｕ_ｆ１，ｕ_ｆ２，ｕ_ｆ３の応答を実線で、発生力指令値ｕ_ｅ１，ｕ_ｅ２，ｕ_ｅ３の応答を破線で示す。さらに、図１６に発生力指令値ｕ_ｅｎ，ｕ_ｆｎ（ｎ＝１，２，３）の和をそれぞれ実線、破線、一点鎖線で示す。

図１４（ａ）及び図１４（ｂ）より実線で示す関節角度θ_１，θ_２は破線で示す軌道と重なっており、リンク１０１，１０２は目標軌道に追従していることがわかる。図１５（ａ）及び図１５（ｂ）に示すリンク１０１，１０２の応答より、発生力指令値ｕ_ｅ１，ｕ_ｆ１及び発生力指令値ｕ_ｅ２，ｕ_ｆ２は、それぞれ関節トルクＴ_１，Ｔ_２を、式（２１）に示した条件で配分されている。図１５（ｃ）より、発生力指令値ｕ_ｅ３，ｕ_ｆ３は弾性力を補償するためのトルクを式（２５）に示した条件で配分されている。

図１６において、実線、破線、一点鎖線で示すｕ_ｆｎ＋ｕ_ｅｎ（ｎ＝１，２，３）は、いずれも加減速区間で４、等速区間で２となっていることがわかる。各拮抗対の剛性が目標剛性に制御されていることから、手先Ｅのスティフネス楕円は関節Ｊ１と手先Ｅを結ぶ方向に制御されていることがわかる。

さらに、エンドエフェクタ質量を変動させるシミュレーションを行う。図１７（ａ）にエンドエフェクタ質量を１倍、２倍、４倍とする際のリンク１０２の位置決め誤差の応答をそれぞれ実線、破線、一点鎖線で示す。また、比較として図１７（ｂ）にフィードバック制御系にＰＤ制御系を用いるエンドエフェクタ変動シミュレーションの位置決め誤差応答を示す。フィードバック制御系にロバスト制御を用いると、エンドエフェクタ質量が変動しても軌道追従誤差に大きな劣化はない。しかし、ＰＤ制御系ではエンドエフェクタ質量が変動するにつれて軌道位置決め誤差が大きくなってゆくことがわかる。

本第２実施形態の制御系により、目標軌道への追従を実現しながら、３対６筋の弾性により手先の剛性を制御することが可能であることがわかる。さらに、エンドエフェクタ質量などにパラメータ変動が発生する際も受動性に基づくロバスト性を有し、軌道追従制御性能の劣化を防ぐことができる。

なお、本発明は、以上説明した実施形態に限定されるものではなく、多くの変形が本発明の技術的思想内で当分野において通常の知識を有する者により可能である。

上記実施形態の各処理動作は具体的には制御装置２００，２００Ｂの制御部としてのＣＰＵ２０１により実行されるものである。従って上述した機能を実現するプログラムを記録した記録媒体を制御装置に供給し、制御装置のコンピュータ（ＣＰＵやＭＰＵ）が記録媒体に格納されたプログラムを読み出し実行することによって達成されるようにしてもよい。この場合、記録媒体から読み出されたプログラム自体が上述した実施形態の機能を実現することになり、プログラム自体及びそのプログラムを記録した記録媒体は本発明を構成することになる。

また、上記実施形態では、コンピュータ読み取り可能な記録媒体がＨＤＤ２０４であり、ＨＤＤ２０４にプログラム２２１，２２１Ｂが格納される場合について説明したが、これに限定するものではない。プログラムは、コンピュータ読み取り可能な記録媒体であれば、いかなる記録媒体に記録されていてもよい。例えば、プログラムを供給するための記録媒体としては、図３，図１１に示すＲＯＭ２０２、記録ディスク２２２、不図示の外部記憶装置等を用いてもよい。具体例を挙げて説明すると、記録媒体として、フレキシブルディスク、ハードディスク、光ディスク、光磁気ディスク、ＣＤ−ＲＯＭ、ＣＤ−Ｒ、磁気テープ、書き換え可能な不揮発性のメモリ（例えばＵＳＢメモリ）、ＲＯＭ等を用いることができる。

また、上記実施形態におけるプログラムを、ネットワークを介してダウンロードしてコンピュータにより実行するようにしてもよい。

また、コンピュータが読み出したプログラムコードを実行することにより、上記実施形態の機能が実現されるだけに限定するものではない。そのプログラムコードの指示に基づき、コンピュータ上で稼働しているＯＳ（オペレーティングシステム）等が実際の処理の一部または全部を行い、その処理によって前述した実施形態の機能が実現される場合も含まれる。

さらに、記録媒体から読み出されたプログラムコードが、コンピュータに挿入された機能拡張ボードやコンピュータに接続された機能拡張ユニットに備わるメモリに書き込まれてもよい。そのプログラムコードの指示に基づき、その機能拡張ボードや機能拡張ユニットに備わるＣＰＵ等が実際の処理の一部または全部を行い、その処理によって上記実施形態の機能が実現される場合も含まれる。

また、上記実施形態では、コンピュータがＨＤＤ等の記録媒体に記録されたプログラムを実行することにより、図４、図５又は図１２に示す機能を果たす場合について説明したが、これに限定するものではない。図４、図５又は図１２に示す制御部の一部又は全部の機能をＡＳＩＣやＦＰＧＡ等の専用ＬＳＩで構成してもよい。なお、ＡＳＩＣはApplication Specific Integrated Circuit、ＦＰＧＡはField-Programmable Gate Arrayの頭字語である。

１００…ロボット装置、１０１…リンク（第１リンク）、１２０…マニピュレータ、２０１…ＣＰＵ（制御部）、ｅ_１，ｆ_１…アクチュエータ（一関節駆動アクチュエータ）

Claims (9)

1. 基部に対して第１関節で旋回可能に連結された第１リンクと、
   引張力を発生し、前記第１リンクを前記第１関節まわりに旋回駆動するよう前記第１リンクの両側に配置された一対の一関節駆動アクチュエータと、
   前記各一関節駆動アクチュエータに対する発生力指令値をそれぞれ求めて前記各一関節駆動アクチュエータを制御する制御部と、を備え、
   前記制御部は、
   前記第１関節の関節角度を目標関節角度にするのに必要な関節トルクを求める関節トルク演算処理と、
   前記第１関節の目標剛性に基づき、前記各一関節駆動アクチュエータに対する発生力指令値の和を示す和算値を求める和算処理と、
   前記第１関節に作用する前記各一関節駆動アクチュエータの弾性力による弾性トルクを求める弾性トルク演算処理と、
   前記関節トルクをＴ_１、前記和算値をＵ_１、前記弾性トルクをＴ_ＰＣ１、前記第１リンクのモーメントアーム径をｒとしたとき、｜Ｔ_１＋Ｔ_ＰＣ１｜＜Ｕ_１×ｒの制約条件を満たすように、前記関節トルクと前記弾性トルクとの合計値を制約する制約処理と、
   前記制約処理にて制約された前記合計値に基づき、前記各一関節駆動アクチュエータの発生力指令値を求める発生力演算処理と、を実行することを特徴とするロボット装置。
2. 前記制御部は、
   前記関節トルク演算処理として、前記関節角度と前記目標関節角度との差分に基づくフィードバック演算により、前記関節トルクを求めるフィードバック演算処理を実行することを特徴とする請求項１に記載のロボット装置。
3. 前記制御部は、
   前記関節トルク演算処理として、
   前記目標関節角度に基づくフィードフォワード演算により、前記第１関節に対するフィードフォワード制御トルクを求めるフィードフォワード演算処理と、
   前記関節角度と前記目標関節角度との差分に基づくフィードバック演算により、フィードバック制御トルクを求めるフィードバック演算処理と、
   前記フィードバック制御トルクに前記フィードフォワード制御トルクを加算して、前記関節トルクを求める加算処理と、を実行することを特徴とする請求項１に記載のロボット装置。
4. 前記制御部は、
   前記フィードバック演算処理として、前記差分を補償するＰＤ制御を行うことを特徴とする請求項２又は３に記載のロボット装置。
5. 前記制御部は、
   前記弾性トルク演算処理として、前記各一関節駆動アクチュエータの弾性定数をｋ、前記関節角度をθとしたとき、Ｕ_１×ｋ×ｒ^２×θを演算することにより、前記弾性トルクを求めることを特徴とする請求項１乃至４のいずれか１項に記載のロボット装置。
6. 前記第１リンクに対して第２関節で旋回可能に連結された第２リンクと、
   引張力を発生し、前記第１リンク及び前記第２リンクを同時に前記第１関節及び前記第２関節まわりに旋回駆動するよう前記第１リンク及び前記第２リンクの両側に配置された一対の二関節同時駆動アクチュエータと、を備え、
   前記制御部は、
   前記各二関節同時駆動アクチュエータの弾性力により前記第１関節及び前記第２関節に付与されるトルクをキャンセルするように、前記各二関節同時駆動アクチュエータに対する、正の値となる制約を満たす発生力指令値を演算することを特徴とする請求項１乃至５のいずれか１項に記載のロボット装置。
7. 基部に対して第１関節で旋回可能に連結された第１リンクと、
   引張力を発生し、前記第１リンクを前記第１関節まわりに旋回駆動するよう前記第１リンクの両側に配置された一対の一関節駆動アクチュエータと、
   前記各一関節駆動アクチュエータに対する発生力指令値をそれぞれ求めて前記各一関節駆動アクチュエータを制御する制御部と、を有するロボット装置を制御するロボット制御方法において、
   前記制御部が、前記第１関節の関節角度を目標関節角度にするのに必要な関節トルクを求める関節トルク演算ステップと、
   前記第１関節の目標剛性に基づき、前記各一関節駆動アクチュエータに対する発生力指令値の和を示す和算値を求める和算ステップと、
   前記第１関節に作用する前記各一関節駆動アクチュエータの弾性力による弾性トルクを求める弾性トルク演算ステップと、
   前記関節トルクをＴ_１、前記和算値をＵ_１、前記弾性トルクをＴ_ＰＣ１、前記第１リンクのモーメントアーム径をｒとしたとき、｜Ｔ_１＋Ｔ_ＰＣ１｜＜Ｕ_１×ｒの制約条件を満たすように、前記関節トルクと前記弾性トルクとの合計値を制約する制約ステップと、
   前記制約ステップにて制約された前記合計値に基づき、前記各一関節駆動アクチュエータの発生力指令値を求める発生力演算ステップと、を備えたことを特徴とするロボット制御方法。
8. コンピュータに、請求項１乃至６のいずれか１項に記載の各処理を実行させるためのプログラム。
9. 請求項８に記載のプログラムを記録したコンピュータ読み取り可能な記録媒体。

Images