JP7553899B2 - 位置・力制御装置、位置・力制御方法及びプログラム - Google Patents

Description

本発明は、制御対象における位置及び力を制御する位置・力制御装置、位置・力制御方法及びプログラムに関する。

従来、少子高齢化等を背景に、人手と手間のかかる作業をロボットにより代替することが強く求められている。
ところが、従来のロボットの動作は、環境適応性や柔軟性に欠けており、人間の身体的行為を適切に実現するには至っていない。
ここで、マスタ・スレーブシステムにより取得した時系列な位置情報及び力情報を用いてアクチュエータの運動を人工再現する取り組みも行われているが、再現時における機械的インピーダンスが常に一定であり、依然として環境の位置・大きさ・機械的インピーダンスといった環境変動への適応性に欠けている。
なお、マスタ・スレーブシステムによって遠隔制御を行うロボットに関する技術は、例えば特許文献１及び特許文献２に記載されている。

国際公開２００５／１０９１３９号公報 特開２００９－２７９６９９号公報

人手と手間のかかる作業をロボットにより代替実現するためには、高精度な力制御による高度な環境適応性と、多自由度システムによる人間座標系上の行為抽出が極めて重要であるところ、従来の技術においては、これを実現するに至っていない。
また、今後のロボットには、人間の身体的行為を単純に実現することに加え、人間の能力を拡張した機能や人間には備えられていない機能等を実現することも求められる。
即ち、従来の技術においては、ロボットに求められる機能を適切に実現する上で、改善の余地がある。
本発明の課題は、ロボットに求められる機能をより適切に実現するための技術を提供することである。

上記課題を解決するため、本発明の一態様に係る位置・力制御装置は、
アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に割り当てる第１の変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に基づいて、速度または位置の制御量と力の制御量との少なくとも一方を算出する制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とに第２の変換を行って、前記アクチュエータへの入力を決定する統合手段と、
を備え、
前記第１の変換による前記制御エネルギーの割り当て結果から前記アクチュエータへの入力を決定する処理において、前記制御エネルギーについて設定された条件を充足し、かつ、前記速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理を含むことを特徴とする。

本発明によれば、ロボットに求められる機能をより適切に実現するための技術を提供することができる。

本発明に係る基本的原理の概念を示す模式図である。 アクチュエータへの入力における速度（位置）と力との関係を示す模式図である。 機能別力・速度割当変換ブロックＦＴにおいて力・触覚伝達機能が定義された位置・力制御システム１の機能構成を示すブロック図である。 力・触覚伝達機能を実現するマスタ・スレーブシステムの概念を示す模式図である。 統合変換ブロックＩＦＴにおける第２の変換を第１の変換の逆変換とする場合及び第１の変換の逆変換以外とする場合の適用例の概念を示す模式図である。 理想力源ブロックＦＣにおける演算結果及び理想速度（位置）源ブロックＰＣにおける演算結果を基準値に追従させる目標値とする場合及び基準値に追従させる目標値と異ならせる場合の適用例の概念を示す模式図である。

以下、本発明の実施形態について、図面を参照して説明する。
初めに、本発明に係る位置・力制御装置、位置・力制御方法及びプログラムに適用される基本的原理について説明する。

なお、人間の身体的行為は、１つの関節等の個別の「機能」が単独で、あるいは組み合わされて構成されるものである。
したがって、以下、本実施形態において、「行為」とは、人間の身体における部位の個別の「機能」を構成要素として実現される統合的な機能を表すものとする。例えば、中指の曲げ伸ばしを伴う行為（ねじを回す行為等）は、中指の各関節の機能を構成要素とする統合的な機能である。

（基本的原理）
本発明における基本的原理は、どのような行為も力源と速度（位置）源及び行為を表す変換の三要素で数理的に表現できることから、変換及び逆変換により定義される変数群に対し、双対関係にある理想力源及び理想速度（位置）源より制御エネルギーを制御対象のシステムに供給することで、抽出した身体的行為を構造化し、再構築あるいは拡張増幅し身体的行為を可逆的に自動実現（再現）する、というものである。
また、行為を表す変換に対して、単純な逆変換を行った場合、行為を再現可能であるが、本発明においては、行為を表す変換の逆変換とは異なる変換を行うことにより、制御エネルギーを目的とする状態に柔軟に管理しつつ、制御対象のシステムに必要な電力を供給することを可能としている。

図１は、本発明に係る基本的原理の概念を示す模式図である。
図１に示す基本的原理は、人間の身体的行為を実現するために利用可能なアクチュエータの制御則を表しており、アクチュエータの現在位置を入力として、位置（または速度）あるいは力の少なくとも一方の領域における演算を行うことにより、アクチュエータの動作を決定するものである。
即ち、本発明の基本的原理は、制御対象システムＳと、機能別力・速度割当変換ブロックＦＴと、理想力源ブロックＦＣあるいは理想速度（位置）源ブロックＰＣの少なくとも一つと、統合変換ブロックＩＦＴと、電力供給部ＰＳとを含む制御則として表される。

制御対象システムＳは、アクチュエータによって作動するロボットであり、加速度等に基づいてアクチュエータの制御を行う。ここで、制御対象システムＳは、人間の身体における１つまたは複数の部位の機能を実現可能なものであるが、その機能を実現するための制御則が適用されていれば、具体的な構成は必ずしも人間の身体を模した形態でなくてもよい。例えば、制御対象システムＳは、アクチュエータによってリンクに一次元のスライド動作を行わせるロボット等とすることができる。

機能別力・速度割当変換ブロックＦＴは、制御対象システムＳの機能に応じて設定される速度（位置）及び力の領域への制御エネルギーの変換（第１の変換）を定義するブロックである。具体的には、機能別力・速度割当変換ブロックＦＴでは、制御対象システムＳの機能の基準となる値（基準値）と、アクチュエータの現在位置とを入力とする座標変換が定義されている。この座標変換は、一般に、基準値及び現在速度（位置）を要素とする入力ベクトルを速度（位置）の制御目標値を算出するための速度（位置）からなる出力ベクトルに変換するとともに、基準値及び現在の力を要素とする入力ベクトルを力の制御目標値を算出するための力からなる出力ベクトルに変換するものである。具体的には、機能別力・速度割当変換ブロックＦＴにおける座標変換は、次式（１）及び（２）のように一般化して表される。

ただし、式（１）において、ｘ’₁～ｘ’_n（ｎは１以上の整数）は速度の状態値を導出するための速度ベクトルであり、ｘ’_a～ｘ’_m（ｍは１以上の整数）は、基準値及びアクチュエータの作用に基づく速度（アクチュエータの移動子の速度またはアクチュエータが移動させる対象物の速度）を要素とするベクトル、ｈ_1a～ｈ_nmは機能を表す変換行列（第１の変換行列）の要素である。また、式（２）において、ｆ’’₁～ｆ’’_n（ｎは１以上の整数）は力の状態値を導出するための力ベクトルであり、ｆ’’_a～ｆ’’_m（ｍは１以上の整数）は、基準値及びアクチュエータの作用に基づく力（アクチュエータの移動子の力またはアクチュエータが移動させる対象物の力）を要素とするベクトルである。
機能別力・速度割当変換ブロックＦＴにおける座標変換を、実現する機能に応じて設定することにより、各種行為を実現したり、スケーリングを伴う行為の再現を行ったりすることができる。
即ち、本発明の基本的原理では、機能別力・速度割当変換ブロックＦＴにおいて、アクチュエータ単体の変数（実空間上の変数）を、実現する機能を表現するシステム全体の変数群（仮想空間上の変数）に“変換”し、速度（位置）の制御エネルギーと力の制御エネルギーとに制御エネルギーを割り当てる。そのため、アクチュエータ単体の変数（実空間上の変数）のまま制御を行う場合と比較して、速度（位置）の制御エネルギーと力の制御エネルギーとを独立に与えることが可能となっている。

理想力源ブロックＦＣは、機能別力・速度割当変換ブロックＦＴによって定義された座標変換に従って、力の領域における演算を行うブロックである。理想力源ブロックＦＣにおいては、機能別力・速度割当変換ブロックＦＴによって定義された座標変換に基づく演算を行う際の力に関する目標値が設定されている。この目標値は、実現される機能に応じて固定値または可変値として設定される。例えば、基準値が示す機能と同様の機能を実現する場合には、目標値としてゼロを設定することができる。

理想速度（位置）源ブロックＰＣは、機能別力・速度割当変換ブロックＦＴによって定義された座標変換に従って、速度（位置）の領域における演算を行うブロックである。理想速度（位置）源ブロックＰＣにおいては、機能別力・速度割当変換ブロックＦＴによって定義された座標変換に基づく演算を行う際の速度（位置）に関する目標値が設定されている。この目標値は、実現される機能に応じて固定値または可変値として設定される。例えば、基準値が示す機能と同様の機能を実現する場合には、目標値としてゼロを設定することができる。

統合変換ブロックＩＦＴは、速度（位置）及び力の領域の値から制御対象システムＳへの入力の領域の値（例えば電圧値または電流値等）への変換（第２の変換）を定義するブロックである。本発明において、統合変換ブロックＩＦＴは、機能別力・速度割当変換ブロックＦＴにおける変換の単純な逆変換とは異なる変換内容に設定することが可能であり、制御エネルギーの寄与率の観点から、具体的な変換内容が設定される。例えば、理想力源ブロックＦＣによって演算された力の領域の値に基づく力の制御エネルギー及び理想速度（位置）源ブロックＰＣによって演算された速度（位置）の領域の値に基づく速度（位置）の制御エネルギーに対して、各制御エネルギーの寄与率を変更する変換を行うことにより、力制御の重みを増大させたり、速度（位置）制御の重みを増大させたりすることができる。また、全体の制御エネルギーを拡大または縮小することにより、機能別力・速度割当変換ブロックＦＴにおける変換の単純な逆変換を行った場合に対して、制御対象システムＳの出力を拡大または縮小することができる。具体的には、統合変換ブロックＩＦＴにおける座標変換は、次式（３）のように一般化して表される。

ただし、式（３）において、Ｘ’’₁～Ｘ’’_n（ｎは１以上の整数）は理想力源ブロックＦＣによって演算された力の領域における力の制御目標値及び理想速度（位置）源ブロックＰＣによって演算された速度（位置）の領域における速度（位置）の制御目標値が統合された加速度（即ち、各アクチュエータが出力すべき仮想空間における加速度）を要素とする入力ベクトルである。また、Ｘ’’_a～Ｘ’’_m（ｍは１以上の整数）は、各アクチュエータに対する加速度の指令値（即ち、各アクチュエータが出力すべき実空間における加速度）、α_1a～α_nmは第２の変換を表す座標変換（第２の変換行列）の要素である。
統合変換ブロックＩＦＴは、式（３）によって算出された加速度の値から、各アクチュエータに入力される値（電流値等）を算出する。

ここで、統合変換ブロックＩＦＴにおいて第２の変換行列による演算を経て算出されるアクチュエータへの入力値は、速度（位置）の制御エネルギー及び力の制御エネルギーを合計した制御エネルギーを有するものとなる。ただし、アクチュエータの動作は、そのアクチュエータが有する能力の限界（例えば、出力可能な力の限界である力限界あるいは出力可能な速度の限界である速度限界）等の条件に制約される。そこで、本実施形態においては、統合変換ブロックＩＦＴによって算出されるアクチュエータの入力値が、アクチュエータが有する能力の限界を超えないよう速度（位置）の制御エネルギー及び力の制御エネルギーに関する条件が設定されている。

図２は、アクチュエータへの入力における速度（位置）と力との関係を示す模式図である。
図２に示すように、本発明における基本原理では、第１の変換によって、接触物体との合成インピーダンスに基づく速度（位置）の制御エネルギー及び力の制御エネルギーの分配が行われ、さらに第２の変換が行われることにより、アクチュエータへの入力が決定される。
図２における曲線Ｃ１～Ｃ３は、特定の制御エネルギーを設定した場合に、第２の変換の前後において、制御エネルギーが維持される関数を示している。即ち、いずれかの曲線Ｃ１～Ｃ３上の点で表される制御エネルギーの分配が行われる場合、速度（位置）または力の一方が拡大されると、他方は縮小され、全体として制御エネルギーが維持される。

また、図２において、曲線Ｃ１～Ｃ３に代表される曲線が遷移することは、全体の制御エネルギーを拡大または縮小することを意味し、曲線Ｃ１から曲線Ｃ３に向かう順に、全体の制御エネルギーは増加するものとなっている。本発明においては、同一の曲線上に限られない点に制御エネルギーの分配点を設定することができる。即ち、本発明において、第２の変換によって速度（位置）または力の少なくとも一方を拡大または縮小する場合、制御エネルギーが維持される曲線上から制御エネルギーの拡大方向または縮小方向に存在する点に制御エネルギーの分配点を変更することが可能である。
この場合、制御対象システムＳに供給すべき電力にも変更が生じるところ、電力供給部ＰＳは、この変更に対応する電力を供給することが可能となっている。

さらに、本発明において、制御エネルギーの分配点の設定可能な範囲は、図２に示すように、力限界及び速度限界以下の範囲に制約される。即ち、第２の変換によって算出される制御エネルギーの分配点が力限界または速度限界を超える点となった場合、力限界または速度限界を上限とする点が制御エネルギーの分配点とされ、アクチュエータの入力が決定される。このように、本発明においては、制御エネルギーの観点において、速度（位置）の制御エネルギー及び力の制御エネルギーに関する条件（上限値）が設定されている。

電力供給部ＰＳは、バッテリ等の電源と、供給電力の制御機能とを備え、統合変換ブロックＩＦＴによって決定されたアクチュエータへの入力に対応する電力を制御対象システムＳに供給する。電力供給部ＰＳにおける供給電力の制御機能により、制御対象システムＳが出力すべき制御エネルギーの変化に応じて、制御対象システムＳに対する供給電力の維持／増加／減少が行われる。

このような基本的原理により、制御対象システムＳのアクチュエータにおける位置の情報が機能別力・速度割当変換ブロックＦＴに入力されると、位置の情報に基づいて得られる速度（位置）及び力の情報を用いて、機能別力・速度割当変換ブロックＦＴにおいて、機能に応じた位置及び力の領域それぞれの制御則が適用される。そして、理想力源ブロックＦＣにおいて、機能に応じた力の演算が行われ、理想速度（位置）源ブロックＰＣにおいて、機能に応じた速度（位置）の演算が行われ、力及び速度（位置）それぞれに制御エネルギーが分配される。

理想力源ブロックＦＣ及び理想速度（位置）源ブロックＰＣにおける演算結果は、制御対象システムＳの制御目標を示す情報となり、これらの演算結果が統合変換ブロックＩＦＴにおいて、設定された速度（位置）の制御エネルギー及び力の制御エネルギーの寄与率に応じて重みが変更された上で、アクチュエータの入力値とされて、制御対象システムＳに入力される。
その結果、制御対象システムＳのアクチュエータは、機能別力・速度割当変換ブロックＦＴによって定義された機能に従うことを基本としつつ、設定された速度（位置）の制御量及び力の制御量の拡大または縮小が反映された動作を実行し、目的とするロボットの動作が実現される。
即ち、本発明においては、ロボットに求められる機能をより適切に実現することが可能となる。
また、電力供給部ＰＳにおける供給電力の制御機能によっても、アクチュエータが出力する全体の制御エネルギーを拡大または縮小し、速度（位置）及び力の拡大または縮小を実現することができる。

（具体的構成例）
次に、本発明の基本的原理を適用した具体的なシステム構成例について説明する。
機能別力・速度割当変換ブロックＦＴでは、入力されたアクチュエータの現在位置に基づいて得られる速度（位置）及び力を対象とした座標変換（実現する機能に対応した実空間から仮想空間への変換（第１の変換））が定義されている。

機能別力・速度割当変換ブロックＦＴでは、このような現在位置から速度（位置）及び力と、機能の基準値としての速度（位置）及び力とを入力として、速度（位置）及び力それぞれについての制御則が加速度次元において適用される。
即ち、アクチュエータにおける力は質量と加速度との積で表され、アクチュエータにおける速度（位置）は加速度の積分によって表される。そのため、加速度の領域を介して、速度（位置）及び力を制御することで、アクチュエータの現在位置を取得して、目的とする機能を実現することができる。

また、以下のシステム構成例では、上述したように、統合変換ブロックＩＦＴにおいて、理想力源ブロックＦＣによって演算された力の領域の値に基づく力の制御エネルギー及び理想速度（位置）源ブロックＰＣによって演算された速度（位置）の領域の値に基づく速度（位置）の制御エネルギーに対して、各制御エネルギーの寄与率を変更する変換を行う。これにより、力制御の重みを増大させたり、速度（位置）制御の重みを増大させたりすることができる。

機能別力・速度割当変換ブロックＦＴでは、入力されたアクチュエータの現在位置に基づいて得られる速度（位置）及び力を対象とした座標変換（実現する機能に対応した実空間から仮想空間への変換）が定義されている。
機能別力・速度割当変換ブロックＦＴでは、このような現在位置から速度（位置）及び力と、機能の基準値としての速度（位置）及び力とを入力として、速度（位置）及び力それぞれについての制御則が加速度次元において適用される。
即ち、アクチュエータにおける力は質量と加速度との積で表され、アクチュエータにおける速度（位置）は加速度の積分によって表される。そのため、加速度の領域を介して、速度（位置）及び力を制御することで、アクチュエータの現在位置を取得して、目的とする機能を実現することができる。

図３は、機能別力・速度割当変換ブロックＦＴにおいて力・触覚伝達機能が定義された位置・力制御システム１の機能構成を示すブロック図である。また、図４は、力・触覚伝達機能を実現するマスタ・スレーブシステムの概念を示す模式図である。なお、図３に示す位置・力制御システム１は、図１に示す制御則で制御される制御対象システムＳとしてのマスタ装置及びスレーブ装置をそれぞれ含むマスタ側の位置・力制御装置及びスレーブ側の位置・力制御装置によって構成される。位置・力制御システム１は、例えば、ＰＣ（Ｐｅｒｓｏｎａｌ Ｃｏｍｐｕｔｅｒ）等、メモリ、ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）、プロセッサ及びストレージデバイス（ハードディスク等）を備える情報処理装置によって、アクチュエータを有するマスタ装置及びスレーブ装置を制御するシステムとして実現することができる。

図３に示すように、機能別力・速度割当変換ブロックＦＴによって定義される機能として、マスタ装置の動作をスレーブ装置に伝達すると共に、スレーブ装置に対する物体からの反力の入力をマスタ装置にフィードバックする機能（バイラテラル制御機能）を実現することができる。
この場合、機能別力・速度割当変換ブロックＦＴにおける座標変換は、次式（４）及び（５）として表される。

ただし、式（４）において、ｘ’_pは速度（位置）の状態値を導出するための速度、ｘ’_fは力の状態値に関する速度である。また、ｘ’_mは基準値（マスタ装置からの入力）の速度（マスタ装置の現在位置の微分値）、ｘ’_sはスレーブ装置の現在の速度（現在位置の微分値）である。また、式（５）において、ｆ_pは速度（位置）の状態値に関する力、ｆ_fは力の状態値を導出するための力である。また、ｆ_mは基準値（マスタ装置からの入力）の力、ｆ_sはスレーブ装置の現在の力である。

本実施形態においては、上述したように、統合変換ブロックＩＦＴは、機能別力・速度割当変換ブロックＦＴにおける変換の単純な逆変換とは異なる変換内容に設定することが可能であり、制御エネルギーの寄与率の観点から、具体的な変換内容が設定される。
図５は、統合変換ブロックＩＦＴにおける第２の変換を第１の変換の逆変換とする場合及び第１の変換の逆変換以外とする場合の適用例の概念を示す模式図である。
図５では、図３及び図４に示す構成例において、力の制御エネルギー及び速度（位置）の制御エネルギーの寄与率を維持する場合及び変更する場合の例が示されている。
なお、以下の説明において、式（１）及び（２）に対応する座標変換を式（６）及び（７）で表し、式（３）に対応する座標変換を式（８）で表すものとする。

ただし、式（６）において、Ｈは第１の変換行列、ｘ_{ｍｏｔｏｒ}は基準値及びアクチュエータの作用に基づく速度（位置）を要素とするベクトル、ｘ_{ｆｕｎｃｔｉｏｎ}は第１の変換行列によってベクトルｘ_{ｍｏｔｏｒ}が変換された仮想空間上の速度（位置）を要素とするベクトルである。また、式（７）において、ｆ_{ｍｏｔｏｒ}は基準値及びアクチュエータの作用に基づく速度（位置）を要素とするベクトル、ｆ_{ｆｕｎｃｔｉｏｎ}は第１の変換行列によってベクトルｆ_{ｍｏｔｏｒ}が変換された仮想空間上の力を要素とするベクトルである。さらに、式（８）において、Ｈ^－１は第１の変換行列の逆変換、x’’_{ｍｏｔｏｒ}は各アクチュエータへの入力を定義する加速度（実空間上の変数）を要素とするベクトル、x’’_{ｆｕｎｃｔｉｏｎ}は仮想空間上で算出された速度（位置）の制御エネルギーと力の制御エネルギーとによって定義される加速度（仮想空間上の変数）を要素とするベクトルである。

図５において、このような変換が行われた場合、マスタとスレーブとの間でリアルタイムに力触覚の伝達（バイラテラル制御）を行うマスタ・スレーブシステムを実現することができる。マスタ・スレーブシステムでは、例えば、マスタ側アクチュエータに入力された動作が、第１の変換及び第２の変換を経て、リアルタイムにスレーブ側アクチュエータの実作業として出力（リアルタイムに動作が伝達）される。
このとき、第１の変換の前後及び第２の変換の前後において、制御エネルギーはエネルギーＥ１に維持される。
これに対し、図５において、式（９）のような第２の変換を行った場合、第２の変換の前後において、制御エネルギーはエネルギーＥ１からエネルギーＥ２に拡大または縮小される。

ただし、式（９）において、αは第１の変換行列Ｈの逆変換行列とは異なる変換行列である。
このような変換が行われた場合、式（６）～（８）の座標変換によるバイラテラル制御で取得された制御パラメータを記録しておき、記録時のスレーブの動作とは異なる動作（例えば、機械インピーダンスを異ならせて柔らかい制御を行う等）を実現することができる。
なお、式（９）の変換を行う場合、第２の変換の前後において、制御エネルギーが式（６）～（８）の座標変換によるバイラテラル制御の場合とは異なることから、動作に必要な電力が、バイラテラル制御におけるスレーブに供給された電力とは異なるものとなる。

以上のように、本実施形態における位置・力制御システム１では、第１の変換による制御エネルギーの割り当て結果に第２の変換を適用することにより、制御エネルギーについて設定された条件を充足し、かつ、速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理が行われる。
そのため、制御エネルギーを目的とする状態に柔軟に管理しつつ、制御対象のシステムに必要な電力を供給することができる。
したがって、ロボットに求められる機能をより適切に実現するための技術を提供することができる。

［変形例１］
上述の実施形態において、機能を表す第１の変換行列によって実空間上の変数を仮想空間上の変数に変換し、仮想空間において速度（位置）の制御エネルギーと力の制御エネルギーとに制御エネルギーを割り当てた後、第２の変換行列によって、仮想空間が表す速度（位置）及び力の領域の値から制御対象システムＳへの入力の領域の値に変換するものとした。そして、第２の変換において、速度（位置）の制御エネルギー及び力の制御エネルギーに関する条件を充足しつつ、速度（位置）または力の少なくとも一方の拡大または縮小を可能とした。

これに対し、理想力源ブロックＦＣにおける力に関する目標値及び理想速度（位置）源ブロックＰＣにおける速度（位置）に関する目標値を、力の制御エネルギー及び速度（位置）の制御エネルギーの少なくとも一方を拡大・縮小する値に設定することにより、速度（位置）または力の一方の拡大または縮小を実現することも可能である。なお、この場合、第２の変換行列は、第１の変換行列の逆変換行列とすることができる。
具体的には、理想力源ブロックＦＣにおいて、基準値が示す機能と同様の機能を実現する場合には、目標値としてゼロが設定されるところ、スケーリングを行う場合には、再現する機能を示す情報を拡大・縮小した値を設定することができる。即ち、基準値が示す機能に対し、力の制御エネルギーをＧｆ倍する場合には、理想力源ブロックＦＣによる演算結果を基準値に追従する場合のＧｆ倍とするように目標値を設定することができる。

同様に、理想速度（位置）源ブロックＰＣにおいて、基準値が示す機能と同様の機能を実現する場合には、目標値としてゼロが設定されるところ、スケーリングを行う場合には、再現する機能を示す情報を拡大・縮小した値を設定することができる。即ち、基準値が示す機能に対し、速度（位置）の制御エネルギーをＧｐ倍する場合には、理想速度（位置）源ブロックＰＣによる演算結果を基準値に追従する場合のＧｐ倍とするように目標値を設定することができる。
ただし、この場合にも、制御エネルギーの分配点の設定可能範囲は、図２に示す力限界及び速度限界以下の範囲に制約される。そのため、理想力源ブロックＦＣの演算結果に対して、力限界に対応する上限値が設定されると共に、理想速度（位置）源ブロックＰＣの演算結果に対して、速度限界に対応する上限値が設定される。

図６は、理想力源ブロックＦＣにおける演算結果及び理想速度（位置）源ブロックＰＣにおける演算結果を基準値に追従させる目標値とする場合及び基準値に追従させる目標値と異ならせる場合の適用例の概念を示す模式図である。
図６では、図３及び図４に示す構成例において、力の制御エネルギー及び速度（位置）の制御エネルギーの寄与率を維持する場合及び変更する場合の例が示されている。

式（６）～（８）の座標変換によるバイラテラル制御が行われた場合、マスタとスレーブとの間でリアルタイムに力触覚の伝達（バイラテラル制御）を行うマスタ・スレーブシステムを実現することができる。マスタ・スレーブシステムでは、例えば、マスタ側アクチュエータに入力された動作が、第１の変換及び第２の変換を経て、リアルタイムにスレーブ側アクチュエータの実作業として出力（リアルタイムに動作が伝達）される。
このとき、第１の変換の前後及び第２の変換の前後において、制御エネルギーはエネルギーＥ１に維持される。

これに対し、図６において、理想力源ブロックＦＣにおける力に関する目標値及び理想速度（位置）源ブロックＰＣにおける速度（位置）に関する目標値を、力の制御エネルギー及び速度（位置）の制御エネルギーの少なくとも一方を拡大・縮小する値に設定した場合、理想力源ブロックＦＣの演算結果及び理想速度（位置）源ブロックＰＣの演算結果において、制御エネルギーはエネルギーＥ１からエネルギーＥ２に拡大または縮小される。

このような制御が行われた場合、式（９）の座標変換による制御と同様に、式（６）～（８）の座標変換によるバイラテラル制御で取得された制御パラメータを記録しておき、記録時のスレーブの動作とは異なる動作（例えば、機械インピーダンスを異ならせて柔らかい制御を行う等）を実現することができる。
なお、図６の記録時の例として示す制御を行う場合、第１の変換から第２の変換に至る過程（即ち、仮想空間における処理過程）において、制御エネルギーが拡大または縮小されることから、動作に必要な電力が、バイラテラル制御におけるスレーブに供給された電力とは異なるものとなる。

このように本変形例においては、第１の変換による制御エネルギーの割り当て結果に対する目標値を設定する際に、制御エネルギーについて設定された条件を充足し、かつ、速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理が行われる。
本変形例の制御則によっても、制御エネルギーを目的とする状態に柔軟に管理しつつ、制御対象のシステムに必要な電力を供給することができる。

［変形例２］
上述の実施形態において、制御対象システムＳへの入力（即ち、アクチュエータへの入力）の段階で、全体の制御エネルギーを拡大または縮小することができる。
即ち、上述の実施形態に示すように、統合変換ブロックＩＦＴにおける第２の変換によって速度（位置）または力の少なくとも一方を拡大または縮小することが可能である他、電力供給部ＰＳにおける供給電力の制御機能によって、アクチュエータの動作の規模を拡大または縮小することが可能である。この場合、第２の変換によって算出された速度（位置）の制御エネルギー及び力の制御エネルギーの寄与率は維持されたまま、全体の制御エネルギーが拡大または縮小される。

ただし、この場合にも、制御エネルギーの分配点の設定可能範囲は、図２に示す力限界及び速度限界以下の範囲に制約される。そのため、アクチュエータへの入力において、アクチュエータの振る舞いが力限界及び速度限界以下となるように上限値が設定される。
本変形例の制御則によって全体の制御エネルギーを拡大または縮小した場合、アクチュエータの出力が第１の座標変換及び第２の座標変換以外の処理において変更される。そのため、第１の座標変換における入力として用いられるアクチュエータの現在位置を、拡大または縮小した度合いに応じて補正（即ち、制御エネルギーが拡大または縮小されない状態に復元）することとしてもよい。

このように本変形例においては、第１の変換による制御エネルギーの割り当て結果を第２の変換により実空間上の変数に変換した後に、アクチュエータへの入力を決定する段階で、制御エネルギーについて設定された条件を充足し、かつ、速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理が行われる。
本変形例の制御則によっても、制御エネルギーを目的とする状態に柔軟に管理しつつ、制御対象のシステムに必要な電力を供給することができる。

（効果）
以上のように、本発明の第１の態様に係る位置・力制御装置によれば、機能別力・速度割当変換手段は、アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に割り当てる第１の変換を行う。そして、制御量算出手段は、機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に基づいて、速度または位置の制御量と力の制御量との少なくとも一方を算出する。さらに、統合手段は、速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とに第２の変換を行って、前記アクチュエータへの入力を決定する。そして、第１の変換による制御エネルギーの割り当て結果からアクチュエータへの入力を決定する処理において、制御エネルギーについて設定された条件を充足し、かつ、速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理が行われる。
第１の変換による制御エネルギーの割り当て結果に第２の変換を適用することにより、制御エネルギーについて設定された条件を充足し、かつ、速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理が行われる。
そのため、制御エネルギーを目的とする状態に柔軟に管理しつつ、制御対象のシステムに必要な電力を供給することができる。
したがって、ロボットに求められる機能をより適切に実現するための技術を提供することができる。

なお、本発明は、上述の実施形態に限定されるものではなく、本発明の目的を達成できる範囲での変形、改良等は本発明に含まれるものである。
例えば、上述の実施形態及び変形例を適宜組み合わせることが可能であり、この場合、上述の実施形態及び変形例１，２のうち、２つ以上の構成を組み合わせた位置・力制御装置とすることができる。
また、上述の実施形態及び変形例１，２において、速度または位置の制御エネルギーあるいは力のエネルギーを縮小する場合、エネルギーをゼロとする（即ち、速度または位置の制御量あるいは力の制御量を無効とする）こととしてもよい。この場合、本発明の制御則のうち、位置または速度の制御と力の制御とのうち、一方を利用することができる。

上述の実施形態等における処理は、ハードウェア及びソフトウェアのいずれにより実行させることも可能である。
即ち、上述の処理を実行できる機能が位置・力制御システム１に備えられていればよく、この機能を実現するためにどのような機能構成及びハードウェア構成とするかは上述の例に限定されない。
上述の処理をソフトウェアにより実行させる場合には、そのソフトウェアを構成するプログラムが、コンピュータにネットワークや記憶媒体からインストールされる。

プログラムを記憶する記憶媒体は、装置本体とは別に配布されるリムーバブルメディア、あるいは、装置本体に予め組み込まれた記憶媒体等で構成される。リムーバブルメディアは、例えば、半導体メモリ（フラッシュメモリ等）、磁気ディスク、光ディスク、または光磁気ディスク等により構成される。光ディスクは、例えば、ＣＤ－ＲＯＭ（Ｃｏｍｐａｃｔ Ｄｉｓｃ－Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ），ＤＶＤ（Ｄｉｇｉｔａｌ Ｖｅｒｓａｔｉｌｅ Ｄｉｓｃ），Ｂｌｕ－ｒａｙ Ｄｉｓｃ（登録商標）等により構成される。光磁気ディスクは、ＭＤ（Ｍｉｎｉ－Ｄｉｓｃ）等により構成される。また、装置本体に予め組み込まれた記憶媒体は、例えば、プログラムが記憶されているＲＯＭやハードディスク等で構成される。

なお、上記実施形態は、本発明を適用した一例を示しており、本発明の技術的範囲を限定するものではない。即ち、本発明は、本発明の要旨を逸脱しない範囲で、省略や置換等種々の変更を行うことができ、上記実施形態以外の各種実施形態を取ることが可能である。本発明が取ることができる各種実施形態及びその変形は、特許請求の範囲に記載された発明とその均等の範囲に含まれる。

Ｓ 制御対象システム、ＦＴ 機能別力・速度割当変換ブロック（機能別力・速度割当変換手段）、ＦＣ 理想力源ブロック（力制御量算出手段）、ＰＣ 理想速度（位置）源ブロック（位置制御量算出手段）、ＩＦＴ 統合変換ブロック（統合手段）、ＰＳ 電力供給部

Claims (11)

1. アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に割り当てる第１の変換を行う機能別力・速度割当変換手段と、
   前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に基づいて、速度または位置の制御量と力の制御量との少なくとも一方を算出する制御量算出手段と、
   前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とに第２の変換を行って、前記アクチュエータへの入力を決定する統合手段と、
   を備え、
   前記第１の変換による前記制御エネルギーの割り当て結果から前記アクチュエータへの入力を決定する処理において、前記制御エネルギーについて設定された条件を充足し、かつ、前記速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理を含み、
   前記第１の変換では、速度または位置と、力とを独立に取り扱うことが可能な空間への座標変換を行い、
   前記制御エネルギーについて設定された条件として、前記速度または位置と前記力との対応関係に基づいて定められた前記制御エネルギーの合計に関する設定可能範囲内で、前記速度または位置のエネルギーと前記力のエネルギーとが設定されることを特徴とする位置・力制御装置。
2. 前記速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理は、制御対象に対して予め設定された速度限界及び力限界の範囲で、前記速度または位置のエネルギーと力のエネルギーとの少なくとも一方を変化させることを特徴とする請求項１に記載の位置・力制御装置。
3. 前記第２の変換は、前記第１の変換の逆変換とは異なる変換であり、前記速度または位置の制御量と前記力の制御量との少なくとも一方を拡大または縮小することを特徴とする請求項１または２に記載の位置・力制御装置。
4. 前記第２の変換は、前記第１の変換の逆変換であり、前記統合手段の出力において全体のエネルギーを拡大または縮小することを特徴とする請求項１から３のいずれか１項に記載の位置・力制御装置。
5. 前記アクチュエータとは異なる他のアクチュエータをさらに備え、
   前記アクチュエータはマスタ装置及びスレーブ装置の一方として動作し、前記他のアクチュエータは前記マスタ装置及び前記スレーブ装置の他方として動作することを特徴とする請求項１から４のいずれか１項に記載の位置・力制御装置。
6. マスタ装置として動作するアクチュエータ及びスレーブ装置として動作するアクチュエータの間で実行されるバイラテラル制御で取得されたパラメータに基づいて、前記速度または位置のエネルギーと力のエネルギーとを前記マスタ装置または前記スレーブ装置とは異ならせて前記アクチュエータを制御することを特徴とする請求項１から５のいずれか１項に記載の位置・力制御装置。
7. アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に割り当てる第１の変換を行う機能別力・速度割当変換手段と、
   前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に基づいて、速度または位置の制御量と力の制御量との少なくとも一方を算出する制御量算出手段と、
   前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とに第２の変換を行って、前記アクチュエータへの入力を決定する統合手段と、
   を備え、
   前記第１の変換による前記制御エネルギーの割り当て結果から前記アクチュエータへの入力を決定する処理において、前記制御エネルギーについて設定された条件を充足し、かつ、前記速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理を含み、
   前記第２の変換は、前記第１の変換の逆変換であり、前記統合手段の出力において全体のエネルギーを拡大または縮小することを特徴とする位置・力制御装置。
8. アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に割り当てる第１の変換を行う機能別力・速度割当変換ステップと、
   前記機能別力・速度割当変換ステップにおいて割り当てられた速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に基づいて、速度または位置の制御量と力の制御量との少なくとも一方を算出する制御量算出ステップと、
   前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とに第２の変換を行って、前記アクチュエータへの入力を決定する統合ステップと、
   を含み、
   前記第１の変換による前記制御エネルギーの割り当て結果から前記アクチュエータへの入力を決定する処理において、前記制御エネルギーについて設定された条件を充足し、かつ、前記速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理を含み、
   前記第１の変換では、速度または位置と、力とを独立に取り扱うことが可能な空間への座標変換を行い、
   前記制御エネルギーについて設定された条件として、前記速度または位置と前記力との対応関係に基づいて定められた前記制御エネルギーの合計に関する設定可能範囲内で、前記速度または位置のエネルギーと前記力のエネルギーとが設定されることを特徴とする位置・力制御方法。
9. アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に割り当てる第１の変換を行う機能別力・速度割当変換ステップと、
   前記機能別力・速度割当変換ステップにおいて割り当てられた速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に基づいて、速度または位置の制御量と力の制御量との少なくとも一方を算出する制御量算出ステップと、
   前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とに第２の変換を行って、前記アクチュエータへの入力を決定する統合ステップと、
   を含み、
   前記第１の変換による前記制御エネルギーの割り当て結果から前記アクチュエータへの入力を決定する処理において、前記制御エネルギーについて設定された条件を充足し、かつ、前記速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理を含み、
   前記第２の変換は、前記第１の変換の逆変換であり、前記統合ステップの出力において全体のエネルギーを拡大または縮小することを特徴とする位置・力制御方法。
10. コンピュータに、
    アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に割り当てる第１の変換を行う機能別力・速度割当変換機能と、
    前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に基づいて、速度または位置の制御量と力の制御量との少なくとも一方を算出する制御量算出機能と、
    前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とに第２の変換を行って、前記アクチュエータへの入力を決定する統合機能と、
    を実現させ、
    前記第１の変換による前記制御エネルギーの割り当て結果から前記アクチュエータへの入力を決定する処理において、前記制御エネルギーについて設定された条件を充足し、かつ、前記速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理を含み、
    前記第１の変換では、速度または位置と、力とを独立に取り扱うことが可能な空間への座標変換を行い、
    前記制御エネルギーについて設定された条件として、前記速度または位置と前記力との対応関係に基づいて定められた前記制御エネルギーの合計に関する設定可能範囲内で、前記速度または位置のエネルギーと前記力のエネルギーとが設定されることを特徴とするプログラム。
11. コンピュータに、
    アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に割り当てる第１の変換を行う機能別力・速度割当変換機能と、
    前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に基づいて、速度または位置の制御量と力の制御量との少なくとも一方を算出する制御量算出機能と、
    前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とに第２の変換を行って、前記アクチュエータへの入力を決定する統合機能と、
    を実現させ、
    前記第１の変換による前記制御エネルギーの割り当て結果から前記アクチュエータへの入力を決定する処理において、前記制御エネルギーについて設定された条件を充足し、かつ、前記速度または位置のエネルギーと力のエネルギーとの少なくとも一方の拡大または縮小に相当する処理を含み、
    前記第２の変換は、前記第１の変換の逆変換であり、前記統合機能の出力において全体のエネルギーを拡大または縮小することを特徴とするプログラム。
    

Images