特許 6598401 位置・力制御装置、位置・力制御方法及びプログラム

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

(12)【公報種別】特許公報(B2)

(11)【特許番号】6598401

(24)【登録日】2019年10月11日

(45)【発行日】2019年10月30日

(54)【発明の名称】位置・力制御装置、位置・力制御方法及びプログラム

(51)【国際特許分類】

   B25J 3/00 20060101AFI20191021BHJP

   A61B 34/37 20160101ALI20191021BHJP

【ＦＩ】

   B25J3/00 A

   A61B34/37

【請求項の数】30

【全頁数】37

(21)【出願番号】特願2018-144841(P2018-144841)

(22)【出願日】2018年8月1日

(62)【分割の表示】特願2015-537631(P2015-537631)の分割

【原出願日】2014年9月2日

(65)【公開番号】特開2019-30960(P2019-30960A)

(43)【公開日】2019年2月28日

【審査請求日】2018年8月30日

(31)【優先権主張番号】特願2013-194704(P2013-194704)

(32)【優先日】2013年9月19日

(33)【優先権主張国】JP

(73)【特許権者】

【識別番号】899000079

【氏名又は名称】学校法人慶應義塾

(74)【代理人】

【識別番号】100106002

【弁理士】

【氏名又は名称】正林 真之

(74)【代理人】

【識別番号】100120891

【弁理士】

【氏名又は名称】林 一好

(72)【発明者】

【氏名】大西 公平

(72)【発明者】

【氏名】境野 翔

(72)【発明者】

【氏名】野崎 貴裕

【審査官】 牧 初

(56)【参考文献】

【文献】 特開平１０−３０９６８４（ＪＰ，Ａ）

【文献】 特開平７−２９５６５０（ＪＰ，Ａ）

【文献】 特開平５−１５０８２６（ＪＰ，Ａ）

【文献】 特開２００８−２５９６０７（ＪＰ，Ａ）

【文献】 特開２００７−２２９８９７（ＪＰ，Ａ）

(58)【調査した分野】（Int.Cl.，ＤＢ名）

Ｂ２５Ｊ １／００−２１／０２

Ｇ０５Ｄ ２７／００−２７／０２

(57)【特許請求の範囲】

【請求項1】

アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出手段と、
前記機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合手段と、
を備え、
前記アクチュエータは、回転運動及び直線運動の少なくともいずれかを出力するデバイスに備えられていることを特徴とする位置・力制御装置。

【請求項2】

前記制御の基準となる情報は、前記アクチュエータが備えられた前記デバイスと異なる装置形態の装置において取得された速度（位置）及び力の情報であることを特徴とする請求項１に記載の位置・力制御装置。

【請求項3】

前記デバイスは、表示画面に表示された内容に対応する力触覚を出力することを特徴とする請求項１または２に記載の位置・力制御装置。

【請求項4】

前記デバイスは、回転軸の回りに回転するレバーを備え、
前記アクチュエータは、前記レバーの回転軸における回転運動を出力することを特徴とする請求項１から３のいずれか１項に記載の位置・力制御装置。

【請求項5】

前記デバイスは、車両の走行の制御に用いられる装置であることを特徴とする請求項１から４のいずれか１項に記載の位置・力制御装置。

【請求項6】

車両で走行する状況における速度（位置）及び力の情報を記憶していることを特徴とする請求項１から５のいずれか１項に記載の位置・力制御装置。

【請求項7】

アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出手段と、
前記機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合手段と、
前記アクチュエータを作用させる対象物の位置に基づいて、前記アクチュエータの出力におけるオフセットを生成するオフセット生成手段と、
を備えることを特徴とする位置・力制御装置。

【請求項8】

前記オフセットは、前記アクチュエータを作用させる対象物の位置を検出するセンサの検出結果に基づいて生成されることを特徴とする請求項７に記載の位置・力制御装置。

【請求項9】

アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出手段と、
前記機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合手段と、
前記アクチュエータの作用に基づく位置に関する情報に基づいて、前記アクチュエータを作用させる対象物における力の状態値を取得する力状態値取得手段と、
を備えることを特徴とする位置・力制御装置。

【請求項10】

アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に合わせて設定されている変換によって、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出手段と、
前記機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合手段と、
前記アクチュエータの出力に、位置、力及び時間の少なくともいずれかのスケーリングを生じさせるスケーリング手段と、
を備えることを特徴とする位置・力制御装置。

【請求項11】

前記スケーリング手段は、前記アクチュエータの出力が閾値を超えているか否かに応じて、位置及び力の少なくともいずれかの前記スケーリングを生じさせることを特徴とする請求項１０に記載の位置・力制御装置。

【請求項12】

アクチュエータの動作と対応付けて入力された行為に基づく位置に関する情報に対応する速度（位置）及び力の情報を、制御の基準となる情報として、実現される機能に合わせて設定されている変換によって、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出手段と、
前記機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記行為に対応する動作を出力するアクチュエータへの入力を決定する統合手段と、
前記機能別力・速度割当変換手段、前記位置制御量算出手段及び前記力制御量算出手段の演算内容を抽出する抽出手段と、
を備えることを特徴とする位置・力制御装置。

【請求項13】

前記抽出手段の抽出結果に基づいて、１または複数の対象者によって入力された前記行為における前記機能別力・速度割当変換手段、前記位置制御量算出手段及び前記力制御量算出手段の演算内容を蓄積したデータベースを生成することを特徴とする請求項１２に記載の位置・力制御装置。

【請求項14】

前記データベースには、前記アクチュエータによる作用の対象となった物体に関する情報が蓄積されていることを特徴とする請求項１３に記載の位置・力制御装置。

【請求項15】

前記データベースには、前記行為を行った操作者の動作に関する情報が蓄積されていることを特徴とする請求項１３または１４に記載の位置・力制御装置。

【請求項16】

アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出手段と、
前記機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合手段と、
を備え、
１または複数の前記アクチュエータによって、対象物に接触させる１または複数の接触子を制御することにより、前記対象物を把持することを特徴とする位置・力制御装置。

【請求項17】

前記対象物に応じた前記位置の制御量及び前記力の制御量が算出されることを特徴とする請求項１６に記載の位置・力制御装置。

【請求項18】

第１のアクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、第２のアクチュエータの作用に基づく位置に関する情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出手段と、
前記機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力を前記第１のアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記第１のアクチュエータへの入力を決定する統合手段と、
を備え、
前記第２のアクチュエータへの外部からの作用が、前記第１のアクチュエータの出力として伝達されることを特徴とする位置・力制御装置。

【請求項19】

前記第２のアクチュエータは、多関節機構を動作させることを特徴とする請求項１８に記載の位置・力制御装置。

【請求項20】

前記第１のアクチュエータ及び前記第２のアクチュエータの少なくともいずれかの出力に、位置及び力の少なくともいずれかのスケーリングを生じさせるスケーリング手段を備えることを特徴とする請求項１８または１９に記載の位置・力制御装置。

【請求項21】

前記第１のアクチュエータの動作及び前記第２のアクチュエータの動作において、リアルタイムに力触覚の伝達が行われることを特徴とする請求項１８から２０のいずれか１項に記載の位置・力制御装置。

【請求項22】

アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出手段と、
前記機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合手段と、
前記アクチュエータが作用する対象物に関する計測を実行する計測手段と、
を備えることを特徴とする位置・力制御装置。

【請求項23】

コンピュータに、
アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換機能と、
前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出機能と、
前記機能別力・速度割当変換機能によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出機能と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合機能と、
を実現させ、
前記アクチュエータは、回転運動及び直線運動の少なくともいずれかを出力するデバイスに備えられていることを特徴とするプログラム。

【請求項24】

コンピュータに、
アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換機能と、
前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出機能と、
前記機能別力・速度割当変換機能によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出機能と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合機能と、
前記アクチュエータを作用させる対象物の位置に基づいて、前記アクチュエータの出力におけるオフセットを生成するオフセット生成機能と、
を実現させることを特徴とするプログラム。

【請求項25】

コンピュータに、
アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換機能と、
前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出機能と、
前記機能別力・速度割当変換機能によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出機能と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合機能と、
前記アクチュエータの作用に基づく位置に関する情報に基づいて、前記アクチュエータを作用させる対象物における力の状態値を取得する力状態値取得機能と、
を実現させることを特徴とするプログラム。

【請求項26】

コンピュータに、
アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に合わせて設定されている変換によって、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換機能と、
前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出機能と、
前記機能別力・速度割当変換機能によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出機能と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合機能と、
前記アクチュエータの出力に、位置、力及び時間の少なくともいずれかのスケーリングを生じさせるスケーリング機能と、
を実現させることを特徴とするプログラム。

【請求項27】

コンピュータに、
アクチュエータの動作と対応付けて入力された行為に基づく位置に関する情報に対応する速度（位置）及び力の情報を、制御の基準となる情報として、実現される機能に合わせて設定されている変換によって、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換機能と、
前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出機能と、
前記機能別力・速度割当変換機能によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出機能と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記行為に対応する動作を出力するアクチュエータへの入力を決定する統合機能と、
前記機能別力・速度割当変換機能、前記位置制御量算出機能及び前記力制御量算出機能の演算内容を抽出する抽出機能と、
を実現させることを特徴とするプログラム。

【請求項28】

コンピュータに、
アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換機能と、
前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出機能と、
前記機能別力・速度割当変換機能によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出機能と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合機能と、
を実現させ、
１または複数の前記アクチュエータによって、対象物に接触させる１または複数の接触子を制御することにより、前記対象物を把持することを特徴とするプログラム。

【請求項29】

コンピュータに、
第１のアクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、第２のアクチュエータの作用に基づく位置に関する情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換機能と、
前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算機能と、
前記機能別力・速度割当変換機能によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出機能と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力を前記第１のアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記第１のアクチュエータへの入力を決定する統合機能と、
を実現させ、
前記第２のアクチュエータへの外部からの作用を、前記第１のアクチュエータの出力として伝達することを特徴とするプログラム。

【請求項30】

コンピュータに、
アクチュエータの作用に基づく位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換機能と、
前記機能別力・速度割当変換機能によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出機能と、
前記機能別力・速度割当変換機能によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出機能と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合機能と、
前記アクチュエータが作用する対象物に関する計測を実行する計測機能と、
を実現させることを特徴とするプログラム。

【発明の詳細な説明】

【技術分野】

【0001】

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

【背景技術】

【0002】

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

【先行技術文献】

【特許文献】

【0003】

【特許文献1】国際公開２００５／１０９１３９号公報

【特許文献2】特開２００９−２７９６９９号公報

【発明の概要】

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

【0004】

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

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

【0005】

上記課題を解決するため、本発明の一態様に係る位置・力制御装置は、
アクチュエータの作用に基づく位置に関する情報を検出する位置検出手段と、
前記位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う機能別力・速度割当変換手段と、
前記機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する位置制御量算出手段と、
前記機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する力制御量算出手段と、
前記速度または位置の制御量と前記力の制御量とを統合し、その出力をアクチュエータに戻すべく前記速度または位置の制御量と前記力の制御量とを逆変換して、前記アクチュエータへの入力を決定する統合手段と、
を備えることで、速度または位置のエネルギーと、力のエネルギーとをそれぞれ独立に制御可能としたことを特徴とする。

【発明の効果】

【0006】

本発明によれば、ロボットによって人間の身体的行為をより適切に実現するための技術を提供することができる。

【図面の簡単な説明】

【0007】

【図1】本発明に係る基本的原理の概念を示す模式図である。

【図2】機能別力・速度割当変換ブロックＦＴにおいて力・触覚伝達機能が定義された場合の制御の概念を示す模式図である。

【図3】力・触覚伝達機能が適用されるマスタ装置及びスレーブ装置を含むマスタ・スレーブシステムの概念を示す模式図である。

【図4】機能別力・速度割当変換ブロックＦＴにおいてピック＆プレイス機能が定義された場合の制御の概念を示す模式図である。

【図5】ピック＆プレイス機能が適用される第１のアーム及び第２のアームを含むロボットアームシステムの概念を示す模式図である。

【図6】機能別力・速度割当変換ブロックＦＴにおいてねじ回しの学習及び再現の機能が定義された場合の制御の概念を示す模式図である。

【図7】ねじ回しの学習及び再現機能が適用されるロボットを示す模式図である。

【図8】本発明に係る位置・力制御装置１の基本的構成を示す模式図である。

【図9】力・触覚伝達機能を実現する位置・力制御装置１の構成を示す模式図である。

【図10】ピック＆プレイス機能を実現する位置・力制御装置１の構成を示す模式図である。

【図11】ねじ回しの学習及び再現機能を実現する位置・力制御装置１の構成を示す模式図である。

【図12】行為の抽出結果として記憶される情報例を示す模式図である。

【図13】適応的機能実現の概念を示す説明図である。

【図14】機能を切り替えることが可能な位置・力制御装置１の構成を示す模式図である。

【図15】周波数領域におけるスケーリングを用いた力・触覚伝達機能の制御の概念を示す模式図である。

【図16】仮想空間における物体との間で力・触覚伝達機能を実現した状態を示す模式図である。

【図17】仮想空間における物体との間で力・触覚伝達機能を実現する場合の制御の概念を示す模式図である。

【図18】医療用の鉗子に本発明を応用した状態を示す模式図である。

【図19】無線によって接続されたマスタ装置とスレーブ装置とを示す模式図である。

【図20】マスタ装置と無線接続されたスレーブ装置４００の構成を示すブロック図である。

【図21】マスタ装置とスレーブ装置とで高速な通信を行うためのデータ構造を示す図である。

【図22】無線接続されたマスタ装置及びスレーブ装置の間における伝送手順を示すタイミングチャートである。

【図23】人間の動作をデータベース化する概念を示す模式図である。

【図24】機能別力・速度割当変換に対するオフセットの概念を示す模式図である。

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

【0008】

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

【0009】

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

【0010】

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

【0011】

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

【0012】

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

【0013】

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

【0014】

【数1】

【0015】

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

【0016】

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

【0017】

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

【0018】

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

【0019】

理想力源ブロックＦＣ及び理想速度（位置）源ブロックＰＣにおける演算結果は、制御対象システムＳの制御目標を示す情報となり、これらの演算結果が逆変換ブロックＩＦＴにおいてアクチュエータの入力値とされて、制御対象システムＳに入力される。
その結果、制御対象システムＳのアクチュエータは、機能別力・速度割当変換ブロックＦＴによって定義された機能に従う動作を実行し、目的とするロボットの動作が実現される。
即ち、本発明においては、ロボットによって人間の身体的行為をより適切に実現することが可能となる。

【0020】

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

【0021】

以下、各種機能の具体的な例を説明する。
（力・触覚伝達機能）
図２は、機能別力・速度割当変換ブロックＦＴにおいて力・触覚伝達機能が定義された場合の制御の概念を示す模式図である。また、図３は、力・触覚伝達機能が適用されるマスタ装置及びスレーブ装置を含むマスタ・スレーブシステムの概念を示す模式図である。
図２に示すように、機能別力・速度割当変換ブロックＦＴによって定義される機能として、マスタ装置の動作をスレーブ装置に伝達すると共に、スレーブ装置に対する物体からの反力の入力をマスタ装置にフィードバックする機能（バイラテラル制御機能）を実現することができる。
この場合、機能別力・速度割当変換ブロックＦＴにおける座標変換は、次式（３）及び（４）として表される。

【0022】

【数2】

【0023】

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

【0024】

（ピック＆プレイス機能）
図４は、機能別力・速度割当変換ブロックＦＴにおいてピック＆プレイス機能が定義された場合の制御の概念を示す模式図である。また、図５は、ピック＆プレイス機能が適用される第１のアーム及び第２のアームを含むロボットアームシステムの概念を示す模式図である。

【0025】

図４に示すように、機能別力・速度割当変換ブロックＦＴによって定義される機能として、ワーク等の物体を掴み（ピック）、目的位置まで搬送して離す（プレイス）機能（ピック＆プレイス機能）を実現することができる。
この場合、機能別力・速度割当変換ブロックＦＴにおける座標変換は、次式（５）及び（６）として表される。

【0026】

【数3】

【0027】

ただし、式（５）において、ｘ’_maniは速度（位置）の状態値を導出するための速度、ｘ’_graspは力の状態値に関する速度である。また、ｘ’₁は第１アームの速度（現在位置の微分）、ｘ’₂は第２アームの速度（現在位置の微分）である。また、式（６）において、ｆ_maniは速度（位置）の状態値に関する力、ｆ_graspは力の状態値を導出するための力である。また、ｆ₁は第１のアームが物体から受ける反力、ｆ₂は第２のアームが物体から受ける反力である。

【0028】

（ねじ回しの学習及び再現機能）
図６は、機能別力・速度割当変換ブロックＦＴにおいてねじ回しの学習及び再現機能が定義された場合の制御の概念を示す模式図である。また、図７は、ねじ回しの学習及び再現機能が適用されるロボットを示す模式図であり、図７（ａ）は、ねじ回しの学習及び再現機能が適用されるマスタの指型ロボットとスレーブの指型ロボットとを含むマスタ・スレーブシステムの概念を示す模式図、図７（ｂ）は、指型ロボットの指機構を示す模式図である。
図６に示すように、機能別力・速度割当変換ブロックＦＴによって定義される機能として、指の曲げ伸ばしによってねじの締緩を行うねじ回しの学習及び再現機能を実現することができる。
この場合、機能別力・速度割当変換ブロックＦＴにおける座標変換は、次式（７）及び（８）として表される。

【0029】

【数4】

【0030】

式（７）において、ｘ’_a1はＭＰ関節の角度に関する速度応答値、ｘ’_a2はＰＩＰ関節の角度に関する速度応答値、ｘ’_a3はＤＩＰ関節の角度に関する速度応答値である。また、ｘ’_τ1はＭＰ関節のトルクに関する速度応答値、ｘ’_τ2はＰＩＰ関節のトルクに関する速度応答値、ｘ’_τ3はＤＩＰ関節のトルクに関する速度応答値、ｘ’_t1は、マスタの指型ロボットにおけるワイヤＷ１〜Ｗ４の張力に関する速度応答値、ｘ’_t2は、スレーブの指型ロボットにおけるワイヤＷ５〜Ｗ８の張力に関する速度応答値、ｘ’₁〜ｘ’₄はマスタの指型ロボットに連結されたワイヤＷ１〜Ｗ４それぞれの速度応答値、ｘ’₅〜ｘ’₈はスレーブの指型ロボットに連結されたワイヤＷ５〜Ｗ８それぞれの速度応答値である。なお、ＭＰ関節の角度、ＰＩＰ関節の角度及びＤＩＰ関節の角度は、図７（ｂ）におけるθ_１〜θ_３に示すように定義される。また、式（８）において、ｆ_a1はＭＰ関節の角度に関する力応答値、ｆ_a2はＰＩＰ関節の角度に関する力応答値、ｆ_a3はＤＩＰ関節の角度に関する力応答値である。また、ｆ_τ1はＭＰ関節のトルクに関する力応答値、ｆ_τ2はＰＩＰ関節のトルクに関する力応答値、ｆ_τ3はＤＩＰ関節のトルクに関する力応答値、ｆ_t1は、マスタの指型ロボットにおけるワイヤＷ１〜Ｗ４の張力に関する力応答値、ｆ_t2は、スレーブの指型ロボットにおけるワイヤＷ５〜Ｗ８の張力に関する力応答値、ｆ₁〜ｆ₄はマスタの指型ロボットに連結されたワイヤＷ１〜Ｗ４それぞれの力応答値、ｆ₅〜ｆ₈はスレーブの指型ロボットに連結されたワイヤＷ５〜Ｗ８それぞれの力応答値である。

【0031】

（位置・力制御装置の基本的構成）
次に、本発明の基本的原理を適用した位置・力制御装置１の基本的構成について説明する。
図８は、本発明に係る位置・力制御装置１の基本的構成を示す模式図である。
図８において、位置・力制御装置１は、基準値入力部１０と、制御部２０と、ドライバ３０と、アクチュエータ４０と、位置センサ５０とを含んで構成される。
位置・力制御装置１は、図示しないマスタ装置の動作と対応するスレーブ装置として動作するものであり、マスタ装置のアクチュエータに設置された位置センサの検出結果を入力として、機能に応じた動作を行う。
位置・力制御装置１に実装される機能は、後述するように、制御部２０における機能別力・速度割当変換ブロックＦＴによって定義される座標変換を切り替えることで、種々変更することができる。

【0032】

基準値入力部１０は、位置・力制御装置１に備えられる機能毎の基準となる値（基準値）を制御部２０に入力する。この基準値は、例えば、マスタ装置のアクチュエータに設置された位置センサから出力される時系列の検出値である。マスタ装置から時系列の検出値をリアルタイムで制御部２０に基準値として入力する場合、基準値入力部１０は、通信インターフェース（通信Ｉ／Ｆ）によって構成することができる。また、マスタ装置の時系列の検出値を記憶しておき、基準値として順次読み出して制御部２０に入力する場合、基準値入力部１０は、メモリあるいはハードディスク等の記憶装置によって構成することができる。

【0033】

制御部２０は、位置・力制御装置１全体を制御するものであり、ＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）等の情報処理装置によって構成される。
また、制御部２０は、図１における機能別力・速度割当変換ブロックＦＴと、理想力源ブロックＦＣと、理想速度（位置）源ブロックＰＣと、逆変換ブロックＩＦＴとの機能を備えている。
即ち、制御部２０には、基準値入力部１０を介して、マスタ装置の位置センサによって検出された時系列の検出値が入力される。この時系列の検出値は、マスタ装置の動作を表すものであり、制御部２０は、入力された検出値（位置）から導出された速度（位置）及び力の情報に対して、機能に応じて設定されている座標変換を適用する。

【0034】

そして、制御部２０は、座標変換によって得られた速度（位置）の状態値を導出するための速度（位置）に対し、速度（位置）の領域における演算を行う。同様に、制御部２０は、座標変換によって得られた力の状態値を導出するための力に対し、力の領域における演算を行う。さらに、制御部２０は、算出した速度（位置）の領域における演算結果及び力の領域における演算結果に対して、加速度等への次元統一の処理を施し、また、機能に応じて設定されている座標変換の逆変換を適用する。これにより、制御部２０は、算出した速度（位置）の領域における演算結果及び力の領域における演算結果がアクチュエータへの入力の領域の値に変換される。

【0035】

ドライバ３０は、制御部２０によって逆変換されたアクチュエータへの入力の領域の値をアクチュエータ４０に対する具体的な制御指令値（電圧値または電流値等）に変換し、その制御指令値をアクチュエータ４０に出力する。
アクチュエータ４０は、ドライバ３０から入力された制御指令値に従って駆動され、制御対象物の位置を制御する。
位置センサ５０は、アクチュエータ４０によって制御される制御対象物の位置を検出し、検出値を制御部２０に出力する。

【0036】

このような構成により、位置・力制御装置１は、位置センサ５０によって検出された制御対象物の位置から得られる速度（位置）及び力を、機能に応じた座標変換によって速度（位置）の領域及び力の領域の状態値に変換する。これにより、機能に応じて速度（位置）及び力それぞれに制御エネルギーが分配される。そして、それぞれの状態値が逆変換されて制御指令値とされ、この制御指令値に従って、ドライバ３０によりアクチュエータ４０が駆動される。
したがって、位置・力制御装置１は、制御対象物の位置を検出することで、目的とする機能を実現するために必要な速度（位置）及び力の状態値を算出することができ、これらの状態値に基づいてアクチュエータ４０を駆動することで、制御対象物の位置及び力を目的とする状態に制御することができる。

【0037】

また、位置・力制御装置１は、制御部２０における機能に応じた座標変換を切り替えることで、異なる機能を実現することが可能となる。例えば、位置・力制御装置１に備えられた記憶装置に、複数の機能に対応して、各機能に応じた座標変換を記憶しておき、目的に応じて、いずれかの機能に応じた座標変換を選択することで、位置・力制御装置１において種々の機能を実現させることが可能となる。
また、位置・力制御装置１は、制御部２０に対して入力される基準値を、マスタ装置からリアルタイムに入力される位置及び力の取得値とすることができる。この場合、マスタ装置の動作とリアルタイムに連動して、位置・力制御装置１を制御することができる。
また、位置・力制御装置１は、制御部２０に対して入力される基準値を、予め取得して記憶されたマスタ装置またはスレーブ装置の時系列の位置及び力の取得値とすることができる。この場合、予め用意されたマスタ装置の動作を基準として、位置・力制御装置１の機能を実現することができる。即ち、マスタ装置が存在しない状態で、位置・力制御装置１において、目的とする機能を再現することができる。

【0038】

（位置・力制御装置１の具体例）
次に、位置・力制御装置１の具体的な構成例について説明する。
上述のように、制御部２０において定義される機能に応じた座標変換を切り替えることで、位置・力制御装置１は、種々の機能を実現することができる。
以下、図２の力・触覚伝達機能、図４のピック＆プレイス機能及び図６のねじ回しの学習及び再現機能を実現する場合の位置・力制御装置１の構成例について説明する。
（力・触覚伝達機能を実現する位置・力制御装置１の構成例）

【0039】

図９は、力・触覚伝達機能を実現する位置・力制御装置１の構成を示す模式図である。
図９において、位置・力制御装置１は、マスタ装置１００Ａと、スレーブ装置１００Ｂと、ＰＣ（Ｐｅｒｓｏｎａｌ Ｃｏｍｐｕｔｅｒ）１００Ｃとを含んで構成される。
マスタ装置１００Ａは、ドライバ３０及び位置センサ５０を内蔵したアクチュエータ４０によって構成される。
マスタ装置１００Ａは、一方向にスライド可能な可動軸４１Ａを備えており、可動軸４１Ａは操作者によって移動される。可動軸４１Ａの位置は、位置センサ５０によって検出され、この検出値はＰＣ１００Ｃに出力される。

【0040】

また、マスタ装置１００Ａのアクチュエータ４０は、ＰＣ１００Ｃによって制御される。図９における位置・力制御装置１は、バイラテラル制御機能を備えており、アクチュエータ４０の動作はスレーブ装置１００Ｂが物体に接触する力に応じて、ＰＣ１００Ｃによって制御される。
スレーブ装置１００Ｂは、マスタ装置１００Ａと同様に、ドライバ３０及び位置センサ５０を内蔵したアクチュエータ４０によって構成される。
スレーブ装置１００Ｂは、一方向にスライド可能な可動軸４１Ｂを備えており、可動軸４１Ｂはアクチュエータ４０によって移動される。可動軸４１Ｂの位置は、位置センサ５０によって検出され、この検出値はＰＣ１００Ｃに出力される。
ＰＣ１００Ｃは、基準値入力部１０の機能を有する通信インターフェース１１０と、制御部２０とを備えている。

【0041】

通信インターフェース１１０は、マスタ装置１００Ａ及びスレーブ装置１００Ｂから入力される位置センサ５０の検出値を受け取り、制御部２０に出力する。また、通信インターフェース１１０は、制御部２０から入力されるマスタ装置１００Ａ及びスレーブ装置１００Ｂのアクチュエータ４０を制御するための加速度の値を、マスタ装置１００Ａ及びスレーブ装置１００Ｂに出力する。

【0042】

力・触覚伝達機能を実現する位置・力制御装置１の場合、制御部２０においては、式（２）として表される座標変換が定義されるため、マスタ装置１００Ａのアクチュエータ４０の位置とスレーブ装置１００Ｂのアクチュエータ４０の位置との差がゼロとなる状態に制御される。また、マスタ装置１００Ａのアクチュエータ４０に操作者が加える力とスレーブ装置１００Ｂのアクチュエータ４０に作用する物体からの反力とが、作用・反作用の関係（互いに等しく逆向き）となる状態に制御される。
これにより、マスタ装置１００Ａに対して行われた操作がスレーブ装置１００Ｂで正確に再現されると共に、スレーブ装置１００Ｂに入力された物体からの反力をマスタ装置１００Ａに正確に伝達することができる。

【0043】

（ピック＆プレイス機能を実現する位置・力制御装置１の構成例）
図１０は、ピック＆プレイス機能を実現する位置・力制御装置１の構成を示す模式図である。
図１０において、位置・力制御装置１は、第１のアームを構成するアームユニット２００Ａと、第２のアームを構成するアームユニット２００Ｂと、ＰＣ２００Ｃとを含んで構成される。
アームユニット２００Ａは、アーム部２０１Ａと、ドライバ３０及び位置センサ５０を内蔵したアクチュエータ４０とによって構成される。

【0044】

アームユニット２００Ａは、一方向にスライド可能な可動軸（不図示）を備えており、可動軸の先端部にはアーム部２０１Ａが固定されている。アーム部２０１Ａの位置（即ち、可動軸の位置）は、位置センサ５０によって検出され、この検出値はＰＣ２００Ｃに出力される。
また、アームユニット２００Ａのアクチュエータ４０は、ＰＣ２００Ｃによって制御される。具体的には、アーム部２０１Ａは、設定された力で対象物に当接され、アーム部２０１Ｂと共に、その状態を保持して対象物を移動するようにＰＣ２００Ｃによって制御される。

【0045】

アームユニット２００Ｂは、アーム部２０１Ａと、アームユニット２００Ａと同様に、ドライバ３０及び位置センサ５０を内蔵したアクチュエータ４０とによって構成される。
ＰＣ２００Ｃは、基準値入力部１０の機能を有する通信インターフェース２１０と、制御部２０とを備えている。
通信インターフェース２１０は、アームユニット２００Ａ及びアームユニット２００Ｂから入力される位置センサ５０の検出値を受け取り、制御部２０に出力する。また、通信インターフェース２１０は、制御部２０から入力されるアームユニット２００Ａ及びアームユニット２００Ｂのアクチュエータ４０を制御するための加速度の値を、アームユニット２００Ａ及びアームユニット２００Ｂに出力する。

【0046】

ピック＆プレイス機能を実現する位置・力制御装置１の場合、制御部２０においては、式（３）として表される座標変換が定義されるため、アームユニット２００Ａのアクチュエータ４０に作用する物体からの反力ベクトルとアームユニット２００Ｂのアクチュエータ４０に作用する物体からの反力ベクトルの差、つまり、把持力が設定された目標値となる状態に制御される。また、アームユニット２００Ａのアーム部２０１Ａの位置（基準位置からの変位）とアームユニット２００Ｂのアーム部２０１Ｂの位置（基準位置からの変位）の和、つまり、二つのアームの中心が設定された目標値となる状態に制御される。

【0047】

これにより、アームユニット２００Ａのアーム部２０１Ａとアームユニット２００Ｂのアーム部２０１Ｂとは、互いに近づいたり離れたりする動作を行うと共に、対象物と同一の力で当接する状態に制御される。このような状態で、アーム部２０１Ａとアーム部２０１Ｂとを同方向に移動させることで、対象物を掴み、目的位置まで搬送することが可能となる。

【0048】

（ねじ回しの学習及び再現機能を実現する位置・力制御装置１の構成例）
図１１は、ねじ回しの学習及び再現機能を実現する位置・力制御装置１の構成を示す模式図である。
図１１において、位置・力制御装置１は、マスタ装置としての指型ロボット３００Ａと、スレーブ装置としての指型ロボット３００Ｂと、ＰＣ３００Ｃとを含んで構成される。
指型ロボット３００Ａは、指機構部３１０Ａと、指機構部３１０Ａの各部に連結されたワイヤＷ１〜Ｗ４と、ワイヤＷ１〜Ｗ４を引き込む制御を行うアクチュエータ４０ａ〜４０ｄとによって構成される。

【0049】

指機構部３１０Ａは、人間の中手骨に相当するベース部３１１Ａと、基節骨に相当する基節骨部３１２Ａと、中節骨に相当する中節骨部３１３Ａと、末節骨に相当する末節骨部３１４Ａと、ＭＰ関節に相当するＭＰ関節部３１５Ａと、ＰＩＰ関節に相当するＰＩＰ関節部３１６Ａと、ＤＩＰ関節に相当するＤＩＰ関節部３１７Ａとを備えている。
ワイヤＷ１は、末節骨部３１４Ａの手の甲側に一端が連結され、指機構部３１０Ａにおける手の甲側を通って、他端がアクチュエータ４０ａの出力軸に連結されている。そのため、ワイヤＷ１がアクチュエータ４０ａによって引き込まれると、指機構部３１０Ａにおいて指を伸ばす動作が実現される。

【0050】

ワイヤＷ２は、末節骨部３１４Ａの手の平側に一端が連結され、中節骨部３１３Ａにおいて手の甲側に引き出された後、他端がアクチュエータ４０ｂの出力軸に連結されている。そのため、ワイヤＷ２がアクチュエータ４０ｂによって引き込まれるとＤＩＰ関節部では指を曲げる方向、ＰＩＰ関節およびＭＰ関節では指を伸ばす方向に力が加わる。
ワイヤＷ３は、中節骨部３１３Ａの手の平側に一端が連結され、基節骨部３１２Ａにおいて手の甲側に引き出された後、他端がアクチュエータ４０ｃの出力軸に連結されている。そのため、ワイヤＷ３がアクチュエータ４０ｃによって引き込まれるとＰＩＰ関節では指を曲げる方向、ＭＰ関節では指を伸ばす方向に力が加わる。

【0051】

ワイヤＷ４は、基節骨部３１２Ａの手の平側に一端が連結され、指機構部３１０Ａにおける手の平側を通って、他端がアクチュエータ４０ｄの出力軸に連結されている。そのため、ワイヤＷ４がアクチュエータ４０ｄによって引き込まれると、基節骨部３１２ＡにおいてＭＰ関節部３１５Ａを支点として、指を曲げる動作が実現される。

【0052】

アクチュエータ４０ａ〜４０ｄは、ＰＣ３００Ｃによって制御される。具体的には、アクチュエータ４０ａ〜４０ｄには、ＰＣ３００Ｃから、指型ロボット３００Ａの各部の位置・角度及び姿勢、回転トルク、ワイヤＷ１〜Ｗ４の張力を実現するための値が入力され、これらの入力値に従って、ワイヤＷ１〜Ｗ４を引き込む制御を行う。
また、各アクチュエータ４０ａ〜４０ｄは、ドライバ３０及び位置センサ５０を内蔵している。ワイヤＷ１〜Ｗ４の位置は、各アクチュエータ４０ａ〜４０ｄの位置センサ５０によって検出され、この検出値はＰＣ３００Ｃに出力される。

【0053】

ここで、指型ロボット３００Ａは、人間の指の動作（行為）に追従して動かされ、アクチュエータ４０ａ〜４０ｄにおける位置センサ５０の時系列の検出値として、その動作（行為）を抽出する。
具体的には、指型ロボット３００Ａの指機構部３１０Ａの各部は、人間の指と対応する箇所において（即ち、末節骨と末節骨部３１４Ａ、中節骨と中節骨部３１３Ａ、基節骨と基節骨部３１２Ａにおいて）固定され、人間の指の動作に追従する状態とされる。
なお、末節骨と末節骨部３１４Ａ、中節骨と中節骨部３１３Ａ、基節骨と基節骨部３１２Ａのうち、末節骨と末節骨部３１４Ａの固定に加えて、他の１箇所を固定すれば、その他の１箇所の固定は省略することができる。

【0054】

指型ロボット３００Ｂは、指機構部３１０Ｂと、指機構部３１０Ｂの各部に連結されたワイヤＷ５〜Ｗ８と、ワイヤＷ５〜Ｗ８を引き込む制御を行うアクチュエータ４０ｅ〜４０ｈとによって構成される。
指機構部３１０Ｂは、人間の中手骨に相当するベース部３１１Ｂと、基節骨に相当する基節骨部３１２Ｂと、中節骨に相当する中節骨部３１３Ｂと、末節骨に相当する末節骨部３１４Ｂと、ＭＰ関節に相当するＭＰ関節部３１５Ｂと、ＰＩＰ関節に相当するＰＩＰ関節部３１６Ｂと、ＤＩＰ関節に相当するＤＩＰ関節部３１７Ｂとを備えている。

【0055】

ワイヤＷ５は、基節骨部３１２Ｂの手の甲側に一端が連結され、指機構部３１０Ａにおける手の甲側を通って、他端がアクチュエータ４０ｅの出力軸に連結されている。そのため、ワイヤＷ５がアクチュエータ４０ｅによって引き込まれると、基節骨部３１２ＢにおいてＭＰ関節部３１５Ｂを支点として、指を伸ばす動作が実現される。
ワイヤＷ６は、中節骨部３１３Ｂの手の甲側に一端が連結され、基節骨部３１２Ｂにおいて手の平側に引き出された後、他端がアクチュエータ４０ｆの出力軸に連結されている。そのため、ワイヤＷ６がアクチュエータ４０ｆによって引き込まれると、中節骨部３１３ＢにおいてＰＩＰ関節部３１６Ｂを支点として、指を伸ばす動作が実現される。

【0056】

ワイヤＷ７は、末節骨部３１４Ｂの手の甲側に一端が連結され、中節骨部３１３Ｂにおいて手の平側に引き出された後、他端がアクチュエータ４０ｇの出力軸に連結されている。そのため、ワイヤＷ７がアクチュエータ４０ｇによって引き込まれると、末節骨部３１４ＢにおいてＤＩＰ関節部３１７Ｂを支点として、指を伸ばす動作が実現される。
ワイヤＷ８は、末節骨部３１４Ｂの手の平側に一端が連結され、指機構部３１０Ｂにおける手の平側を通って、他端がアクチュエータ４０ｈの出力軸に連結されている。そのため、ワイヤＷ８がアクチュエータ４０ｈによって引き込まれると、指機構部３１０Ｂにおいて指を曲げる動作が実現される。

【0057】

アクチュエータ４０ｅ〜４０ｈは、ＰＣ３００Ｃによって制御される。具体的には、アクチュエータ４０ｅ〜４０ｈには、ＰＣ３００Ｃから、指型ロボット３００Ａの動作として抽出された各部の位置・角度及び姿勢、回転トルク、ワイヤＷ５〜Ｗ８の張力を実現するための値が入力され、これらの入力値に従って、ワイヤＷ５〜Ｗ８を引き込む制御を行う。
また、各アクチュエータ４０ｅ〜４０ｈは、ドライバ３０及び位置センサ５０を内蔵している。ワイヤＷ５〜Ｗ８の位置は、各アクチュエータ４０ｅ〜４０ｈの位置センサ５０によって検出され、この検出値はＰＣ３００Ｃに出力される。

【0058】

ＰＣ３００Ｃは、基準値入力部１０の機能を有する通信インターフェース３１０と、制御部２０とを備えている。
通信インターフェース３１０は、指型ロボット３００Ａ及び指型ロボット３００Ｂから入力される各位置センサ５０の検出値を受け取り、制御部２０に出力する。また、通信インターフェース３１０は、制御部２０から入力される指型ロボット３００Ａ及び指型ロボット３００Ｂのアクチュエータ４０ａ〜４０ｈを制御するための加速度の値を、指型ロボット３００Ａ及び指型ロボット３００Ｂに出力する。

【0059】

ねじ回しの学習及び再現機能を実現する位置・力制御装置１の場合、制御部２０においては、式（４）として表される座標変換が定義される。そのため、指型ロボット３００Ａにおいて抽出された指の各部の動作に応じた制御が指型ロボット３００Ｂにおいて実行される。
これにより、人間がマスタ装置としての指型ロボット３００Ａにおいて、ねじを回す動作を行うと、スレーブ装置としての指型ロボット３００Ｂでは、その動作が実現され、ねじを回すことができる。このとき、指型ロボット３００Ｂにねじから作用する力は、バイラテラル制御機能によって、指型ロボット３００Ａにおいて再現される。即ち、ねじを回す動作を行っている人間の指に対して、アクチュエータ４０ａ〜４０ｄにより、実際にねじを回している場合と同様の反力が再現される。

【0060】

（行為の抽出機能）
次に、本発明によって実現される人間の行為の抽出機能について詳細に説明する。
図１１の「ねじ回しの学習及び再現機能を実現する位置・力制御装置１の構成例」において説明したように、人間の身体の機能に対応する機構のロボットを構成し、人間の身体の機能をこのロボットに追従させて、その際の時系列の動作を検出することで、人間の行為を抽出することが可能となる。

【0061】

例えば、図１１に示す指型ロボット３００Ａの場合、人間が指を動かしてねじを回す動作に追従して、指機構部３１０Ａが動いた際のワイヤＷ１〜Ｗ４またはワイヤＷ５〜Ｗ８の位置を時系列に各位置センサ５０で検出し、これらの位置を記憶装置に記憶しておく。
また、ワイヤＷ１〜Ｗ４またはワイヤＷ５〜Ｗ８の位置の検出結果に代えて、制御部２０において座標変換結果として得られる状態値を導出するための各値（即ち、時系列で算出された式（４）の左辺の各値）を記憶装置に記憶しておくこととしてもよい。

【0062】

図１２は、行為の抽出結果として記憶される情報例を示す模式図であり、図１２（ａ）はワイヤＷ１〜Ｗ４の時系列の位置が記憶された場合、図１２（ｂ）は式（４）の座標変換結果が記憶された場合を示している。
図１２（ａ）を参照すると、例えば、ワイヤＷ１について、時刻ｔ１では位置ｐ１、時刻ｔ２では位置ｐ２、時刻ｔ３では位置ｐ３・・・と時系列の位置が記憶されている。
また、図１２（ｂ）を参照すると、例えば、座標変換結果ｘ’’_a1について、時刻ｔ１では座標変換結果ｑ１、時刻ｔ２では座標変換結果ｑ２、時刻ｔ３では座標変換結果ｑ３・・・と時系列の値が記憶されている。
これにより、人間が一度だけ実際に指の動作（行為）を行えば、それ以降、指の動作（行為）を行わなくても、ねじ回しの学習及び再現機能等の動作（行為）をロボットによって再現することができる。

【0063】

（適応的機能実現）
次に、本発明によって可能となる適応的機能実現について説明する。
適応的機能実現とは、上述のように行為の抽出機能によって人間の行為が抽出された場合に、行為の抽出時とは異なる対象物であっても、抽出された機能が適応的に実現されることをいう。
本実施形態における適応的機能実現においては、式（７）及び式（８）に示す座標変換のうち、力の領域における状態値を導出するための力のベクトルを得る演算を適用する。即ち、適応的機能実現においては、式（７）及び式（８）に示す座標変換において、適応的機能実現の目的に応じた入力を用いる一方、他の部分の入力を実質的にゼロとし、座標変換における一部の要素によって、状態値を導出する。このような手法により、速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に制御エネルギーが割り当てられ、行為の抽出時と完全に同一ではない適応的な機能が実現される。
具体的には、本実施形態における適応的機能実現のための座標変換は、次式（９）として表される。

【0064】

【数5】

【0065】

以下、図１１の「ねじ回しの学習及び再現機能を実現する位置・力制御装置１の構成例」で説明した装置を例に挙げて、適応的機能実現について説明する。
図１３は、適応的機能実現の概念を示す説明図である。
図１３（ａ）〜（ｃ）に示すように、まず、図１１に示す位置・力制御装置１において、人間がねじを回す動作（行為）を抽出し、例えば図１２（ａ）に示すワイヤＷ１〜Ｗ４またはワイヤＷ５〜Ｗ８の時系列の位置または力の少なくとも一方を記憶しておく。
次に、位置・力制御装置１は、記憶装置からワイヤＷ１〜Ｗ４またはワイヤＷ５〜Ｗ８の時系列の位置または力の少なくとも一方を順次読み出す。そして、これを基準値として、スレーブ装置となる指型ロボット３００Ｂにおいて、式（８）の座標変換を順次適用しながら、アクチュエータ４０ｅ〜４０ｆを制御する。このとき、指型ロボット３００Ｂには、人間がねじを回す動作（行為）が抽出されたときと同一のねじＸがセットされているものとする。

【0066】

すると、図１３（ｄ）〜（ｆ）に示すように、記憶されているワイヤＷ１〜Ｗ４またはワイヤＷ５〜Ｗ８が示すマスタ装置での動作が再現され、人間がねじを回す動作（行為）を抽出したときと同様に、ねじＸを回して外すことができる。
ここで、指型ロボット３００Ｂに、人間がねじを回す動作（行為）が抽出されたときとは直径または形状等の異なるねじＹがセットされたとする。

【0067】

このとき、位置・力制御装置１は、記憶装置に記憶されたワイヤＷ１〜Ｗ４またはワイヤＷ５〜Ｗ８の時系列の位置を用いることなく、指型ロボット３００Ｂの各位置センサ５０が検出したワイヤＷ５〜Ｗ８の位置のみを用いて、式（９）の座標変換を順次実行する。
そして、式（９）の座標変換によって得られるｆ_τ1、ｆ_τ2、ｆ_τ3、ｆ_t2を用いて、状態値を導出し、算出した状態値に対応するアクチュエータ４０ｅ〜４０ｈの制御を行う。

【0068】

すると、図１３（ｇ）〜図１３（ｉ）に示すように、ねじＸとは直径または形状等が異なるねじＹであっても、力の領域における状態値が順次導出されることで、適応的に機能を実現することが可能となる。
このように、本発明の基本的原理を応用することで、対象物が異なる等、環境変動に対しても適応性の高い機能の実現を図ることができる。

【0069】

（機能の切り替えの具体例）
図８に示す位置・力制御装置１の基本的構成において、機能別力・速度割当変換ブロックＦＴによって定義される座標変換を複数記憶しておき、これらを切り替えて機能別力・速度割当変換ブロックＦＴに設定することで、位置・力制御装置１で実現される機能を切り替えることができる。

【0070】

図１４は、機能を切り替えることが可能な位置・力制御装置１の構成を示す模式図である。
図１４に示す位置・力制御装置１は、図８に示す位置・力制御装置１に対して、機能を表す座標変換を複数記憶する記憶部６０が備えられている点で異なっている。
即ち、制御部２０は、実現すべき機能に応じて、記憶部６０に記憶されている座標変換Ｔ１〜Ｔｋ（ｋは１以上の整数）のいずれかを読み出して、機能別力・速度割当変換ブロックＦＴに設定する。

【0071】

これにより、複数用意された機能のうち、目的とする機能を適宜実現可能な位置・力制御装置１とすることができる。
このような位置・力制御装置１は、例えば、１つの制御部２０によって、複数の機能を実現する場合や複数のロボットを制御する場合等に、特に有用なものとなる。

【0072】

（スケーリング機能）
上述の位置・力制御装置１において、位置、力及び時間のスケーリング機能を実現することができる。
スケーリング機能とは、基準となる制御に対して、出力される位置、力あるいは時間のスケールを拡大あるいは縮小する機能である。スケーリング機能によって、例えば、マスタ装置の動きの大きさを縮小してスレーブ装置で再現したり、マスタ装置の動きの強さ（力）を強めてスレーブ装置で再現したり、あるいは、マスタ装置の動きの速度を低下させてスレーブ装置で再現したりすることができる。また、記憶装置に記憶された位置または力の少なくとも一方の情報にスケーリング機能を用いることで、例えば、記憶された動きの大きさを縮小してスレーブ装置で再現したり、記憶された動きの強さ（力）を強めてスレーブ装置で再現したりすることができる。
以下、スケーリング機能を実現するための構成例について説明する。

【0073】

（スケーリングを伴う力・触覚伝達機能）
スケーリングを伴う力・触覚伝達機能が実現される場合、図２における機能別力・速度割当変換ブロックＦＴにおける座標変換は、次式（１０）及び（１１）として表される。

【0074】

【数6】

【0075】

式（１０）及び式（１１）に示す座標変換とした場合、スレーブ装置の位置がα倍（αは正数）、スレーブ装置の力がβ倍（βは正数）されて、マスタ装置に伝達される。
このようなスケーリング機能によって、例えば、手術やマイクロアセンブリ等の繊細な作業や、土木作業や船外活動等の大規模な作業を行う場合に有効となる。

【0076】

（スケーリングによる位置の制限を伴う力・触覚伝達機能）
スケーリングによる位置の制限を伴う力・触覚伝達機能が実現される場合、図２における機能別力・速度割当変換ブロックＦＴにおける座標変換は、例えば、次式（１２）〜（１５）として表される。
なお、このような機能を実現する場合、以下のような条件を考慮することが適当である。
・速度次元まで連続であること（ヤコビ行列の存在条件）
・制限後の位置が元の位置の単調増加関数であること（安定性の条件）
・ｘ_s＜ａの時にはｘ_s＝ｘ_shatもしくはｘ_s≒ｘ_shat（ｘ_shatは式（１４）および式（１５）において機能別力・速度割当変換ブロックＦＴに含まれるパラメータ）
（安全領域での制御性能を保証する条件）
・飽和関数であること（ポジションリミットを実現する条件）
これらの条件を満たす他の関数として、atan関数を採用することも可能である。

【0077】

【数7】

【0078】

式（１２）〜式（１５）に示す座標変換とした場合、スレーブ装置の位置がａ未満の場合、式（１２）、 （１３）の座標変換を適用することで、スレーブ装置とマスタ装置とは同様の位置に制御される。一方、スレーブ装置の位置がａ以上の場合、式（１４）、 （１５）の座標変換を適用することで、スケーリング機能が作用し、スレーブ装置は（１／ｂ＋ａ）の位置を超えないように制御される。
このようなスケーリング機能によって、例えば、手術において臓器を保護したり、物体の破断を回避したりする場合に有効となる。

【0079】

（周波数領域におけるスケーリングを用いた力・触覚伝達機能）
図１５は、周波数領域におけるスケーリングを用いた力・触覚伝達機能の制御の概念を示す模式図である。
図１５において、マスタ装置及びスレーブ装置の出力は、ハイパスフィルタ（ＨＰＦ）及びローパスフィルタ（ＬＰＦ）をそれぞれ通過した後に、機能別力・速度割当変換ブロックＦＴに入力される。
機能別力・速度割当変換ブロックＦＴでは、ハイパスフィルタを通過したマスタ装置及びスレーブ装置の出力に対して、高周波域用の座標変換を適用し、ローパスフィルタを通過したマスタ装置及びスレーブ装置の出力に対して、低周波域用の座標変換を適用する。
即ち、機能別力・速度割当変換ブロックＦＴは、マスタ装置及びスレーブ装置からの入力を高周波域及び低周波域の信号に分離し、それぞれの周波数域に対応する座標変換を適用する。
図１５に示すように、周波数領域におけるスケーリングを用いた力・触覚伝達機能が実現される場合、機能別力・速度割当変換ブロックＦＴにおける座標変換は、次式（１６）〜（１９）として表される。

【0080】

【数8】

【0081】

式（１６）〜式（１９）に示す座標変換とした場合、低周波域では、式（１６）、 （１７）の座標変換を適用することで、スレーブ装置とマスタ装置とは同様の位置となるように制御され、高周波域では、式（１８）、 （１９）の座標変換を適用することで、スレーブ装置の位置がα倍（αは正数）、スレーブ装置の力がβ倍（βは正数）されて、マスタ装置に伝達される。
このようなスケーリング機能によって、例えば、スレーブ装置が、物体を貫通したり、破断したりする際の感覚を強調してマスタ装置に伝達することが可能となる。

【0082】

（時間のスケーリングを用いた機能の再現）
位置・力制御装置１による機能の再現において、学習して記憶されている機能を示す情報（例えば、図１２に示す行為の抽出結果を表す時系列のデータ）を間引く、あるいは、補間する等して目標値とすることにより、時間のスケーリングを実現することができる。
具体的には、学習して記憶されている機能を示す情報を間引いた上で、理想力源ブロックＦＣあるいは理想速度（位置）源ブロックＰＣにおける演算の目標値として用いることにより、記憶されている機能（動作）を高速で再現することができる。同様に、学習して記憶されている機能を示す情報を補間した上で、目標値として用いることにより、記憶されている機能（動作）を低速で再現することができる。
このように、記憶されている機能（動作）を高速で再現する場合、行為の抽出時には、低速かつ正確な動作を行えばよく、再現時には、高速かつ正確な動作とすることができる。
また、記憶されている機能（動作）を低速で再現する場合、通常の速度で行われている動作を緩やかに再現できるため、例えば、後遺症を抱える患者のリハビリテーション等において、その患者に応じた訓練動作を再現することができる。

【0083】

（具体的応用例）
上記実施形態で説明した機能を単独でまたは組み合わせて用いることで、種々の応用例を実現することができる。

【0084】

（ゲームへの応用）
図１６は、仮想空間における物体との間で力・触覚伝達機能を実現した状態を示す模式図である。
図１６においては、操作者が仮想空間内の対象物との間で力及び触覚を伝達するゲーム（例えば、腕相撲等）に本発明を適用した例を示している。
また、図１７は、仮想空間における物体との間で力・触覚伝達機能を実現する場合の制御の概念を示す模式図である。
図１６に示すように、操作者Ｒｍは、マスタ装置としてのコントローラ（アクチュエータ）Ｃｔを操作する。
すると、コントローラＣｔの移動に合わせて、仮想物体Ｘａ（ここでは、仮想人物Ｖａの腕）が移動する。

【0085】

仮想物体Ｘａが仮想物体Ｘｂ（ここでは、仮想人物Ｖｂの腕）に接触すると、図１７に示すように、仮想物体Ｘａと仮想物体Ｘｂとの接触をスレーブ装置における作用として、仮想空間における変数と実空間における変数に対し、位置及び力のエネルギーの割り当て変換が行われる。
このとき、コントローラＣｔにおいては、仮想物体Ｘａとの間で力・触覚伝達が行われ、仮想人物Ｖｂと腕相撲をしている仮想人物Ｖａが受ける力・触覚が伝達される。
このように、本発明は、仮想空間における対象物と力を作用させ合うようなゲームに応用することができる。
なお、仮想空間における対象物は、仮想的に生成されたものや、実体的な対象物が仮想空間に抽出されたものとして構成することが可能である。
このような応用例によって、仮想空間内の敵キャラクターと戦う状況や、仮想空間内の種々の路面からなるレースコースを仮想的な車両で走行する状況や、仮想空間内の物体を動かす状況等を高いリアリティで実現することが可能となる。
また、コントローラＣｔは、アクチュエータへの制御信号を受信することで、マスタ装置として機能することが可能であるため、コントローラＣｔにプログラムや多数のセンサを実装する必要がなく、簡単な構成で安価にコントローラＣｔを実現することができる。

【0086】

なお、図１６において、マスタ装置としてのコントローラＣｔをレバー型の装置として示したが、コントローラＣｔの具体的形態は、ゲームの種類等に応じて、種々変更することができる。例えば、同軸に配置された内筒及び外筒を備え、アクチュエータによって内筒の周りに外筒を回転させることが可能なコントローラとすることもできる。この場合、操作者Ｒｍは、ゲームの内容に応じて、外筒を回転させる動作を行い、アクチュエータが力・触覚伝達機能によって外筒の回転力及び回転量を制御する。

【0087】

（医療用の鉗子への応用）
図１８は、医療用の鉗子に本発明を応用した状態を示す模式図である。
図１８（ａ）に示すように、操作者Ｒｍがマスタ装置を操作し、スレーブ装置となる鉗子のアクチュエータとの間で力・触覚伝達機能を実現することができる。
このとき、単純に力・触覚伝達を行う場合には、マスタ装置を支点に対して上方に操作すると、図１８（ｂ）に示すように、スレーブ装置の鉗子も上方に変位することから、人間の直感とは逆の動きとなる可能性がある。
即ち、実物の鉗子を取り扱う際には、鉗子は剛体であることから、操作者が鉗子の先端を下方に向ける場合、鉗子の操作部を上方に操作する。そのため、図１８（ｂ）の動きは、剛体である実物の鉗子を取り扱う場合とは逆の動きとなる。
そこで、図１８（ｃ）に示すように、機能別力・速度割当変換ブロックＦＴにおける座標変換に鏡像変換を施すことで、図１８（ｄ）に示すように、マスタ装置を支点に対して上方に操作した場合に、スレーブ装置の鉗子が下方に変位する状態に制御することができる。即ち、剛体である実物の鉗子を取り扱う場合と同様の動きとなる。
これにより、操作者にとって直感的な操作を行うことが可能となる。

【0088】

また、このような鏡像変換を施すことにより、操作者が対象物に対する視点を柔軟に設定し、操作者が操作し易い状態に調整することが可能となる。
さらに、鏡像変換を施した機能別力・速度割当変換ブロックＦＴにおける座標変換に、スケーリングを施すことが可能である。
例えば、マスタ装置の操作を縮小するスケーリングを施した場合、鉗子における繊細な動きに変換することができ、心臓や脳等の高度な注意を要する困難な手術を支援することが可能となる。
このとき、スケーリングの比率は、固定的な比率とすることの他、状況に応じて比率を変化させること等が可能である。
例えば、心臓の手術であれば、開胸する段階ではマスタ装置とスレーブ装置との動作の比率を１：１等としておき、心臓に対する切開を行う段階では、マスタ装置の動作に対してスレーブ装置の動作が縮小されるようスケーリングの比率を小さくすることができる。

【0089】

（無線接続されたマスタ装置及びスレーブ装置としての応用）
図１９は、無線によって接続されたマスタ装置とスレーブ装置とを示す模式図である。
マスタ装置とスレーブ装置とを無線によって接続し、高速な通信を行うことで、高い実時間性を持ち、携帯性に優れたマスタ・スレーブシステムを実現することができる。
即ち、マスタ装置と無線接続されたスレーブ装置において、力・触覚伝達機能等の各種機能を実現することができる。
図２０は、マスタ装置と無線接続されたスレーブ装置４００の構成を示すブロック図である。
図２０に示すように、スレーブ装置４００は、スイッチ群４０１と、ＬＥＤ群４０２と、ホストマイコンユニット４０３と、無線ユニット４０４と、モータユニット４０５と、減速機構４０６と、手先効果器４０７と、計測ユニット４０８と、記録・表示ユニット４０９と、電源ユニット４１０とを備えている。

【0090】

スイッチ群４０１は、複数の回転型スイッチ及びＯＮ／ＯＦＦスイッチを備え、スレーブ装置４００の各種設定を受け付ける。具体的には、回転型スイッチは、スレーブ装置４００におけるスケーリング比の調整に用いられる。本実施形態においては、回転型スイッチによって、位置のスケーリング及び力のスケーリングをそれぞれ独立に設定することができる。また、ＯＮ／ＯＦＦスイッチは、スレーブ装置４００の状態設定に用いられる。例えば、第１のＯＮ／ＯＦＦスイッチは、電源用スイッチとして機能し、第１のＯＮ／ＯＦＦスイッチがＯＮとされることで、電源回路４１０ｂが導通状態となり、信号用バッテリ４１０ａの電力がスレーブ装置４００の制御系統に供給される。また、第２のＯＮ／ＯＦＦスイッチは、サーボモータ用スイッチとして機能し、第２のＯＮ／ＯＦＦスイッチがＯＮとされることで、モータドライバ４０５ｂの電源がＯＮし、サーボモータ４０５ｄへの電力供給のスタンバイ状態となる。また、第３のＯＮ／ＯＦＦスイッチは、制御用スイッチとして機能し、第３のＯＮ／ＯＦＦスイッチがＯＮとされることで、制御用プログラムが実行され、スレーブ装置４００の制御及びサーボモータ４０５ｄへの電力供給（駆動）が開始される。第１のＯＮ／ＯＦＦスイッチから第３のＯＮ／ＯＦＦスイッチを順にＯＮとすることで、マスタ・スレーブシステムにおけるスレーブ装置４００の制御が開始される。

【0091】

ＬＥＤ群４０２は、スレーブ装置４００の各種状態（電源のＯＮ／ＯＦＦ状態等）を点灯状態によって表す。
ホストマイコンユニット４０３は、プログラム書き込み回路４０３ａと、マイクロコントローラ４０３ｂとを備えている。
プログラム書き込み回路４０３ａは、マイクロコントローラ４０３ｂにプログラムを書き込む。
マイクロコントローラ４０３ｂは、プログラム書き込み回路４０３ａによって書き込まれたプログラムに従って、スレーブ装置４００を制御する。具体的には、マイクロコントローラ４０３ｂは、マスタ装置との無線通信を行いながら、対象物への位置及び力の制御あるいは対象物からの作用の計測を実行する。
無線ユニット４０４は、アンテナ４０４ａと、無線回路４０４ｂとを備えている。
アンテナ４０４ａは、マスタ装置からの無線信号を受信すると共に、スレーブ装置４００からマスタ装置への無線信号を送信する。
無線回路４０４ｂは、アンテナ４０４ａから入力される無線信号を復調し、復調後の制御信号をホストマイコンユニット４０３に出力する。また、無線回路４０４ｂは、ホストマイコンユニット４０３から入力される制御信号を変調し、アンテナ４０４ａに出力する。

【0092】

モータユニット４０５は、Ｄ／Ａコンバータ４０５ａと、モータドライバ４０５ｂと、駆動用バッテリ４０５ｃと、サーボモータ４０５ｄとを備えている。
Ｄ／Ａコンバータ４０５ａは、ホストマイコンユニット４０３から入力されるデジタル信号（制御信号）をアナログ信号に変換する。
モータドライバ４０５ｂは、Ｄ／Ａコンバータ４０５ａから入力されたアナログ信号に従って、サーボモータ４０５ｄを駆動する。
駆動用バッテリ４０５ｃは、サーボモータ４０５ｄを駆動するための電力を供給する。
サーボモータ４０５ｄは、モータドライバ４０５ｂの駆動信号に従って、減速機構４０６を介して手先効果器４０７の位置及び力を制御する。
減速機構４０６は、サーボモータ４０５ｄの動作を減速し、トルクを変換して手先効果器４０７に伝達する。
手先効果器４０７は、対象物に直接作用するインターフェースを構成する。本実施形態では、手先効果器４０７として、フォーク状の器具が備えられている。

【0093】

計測ユニット４０８は、エンコーダ４０８ａと、ラインレシーバ４０８ｂとを備えている。
エンコーダ４０８ａは、サーボモータ４０５ｄの動作（回転角度）を計測し、電気信号に変換する。
ラインレシーバ４０８ｂは、エンコーダ４０８ａから出力される計測結果の電気信号を差動信号としてホストマイコンユニット４０３に出力する。なお、スレーブ装置４００の応答を得るにあたっては、速度センサや加速度センサ、または、その他の推定法により代替することも可能である。
記録・表示ユニット４０９は、記録・表示用回路４０９ａと、記憶媒体４０９ｂと、ディスプレイ４０９ｃとを備えている。
記録・表示用回路４０９ａは、ホストマイコンユニット４０３の指示に従って、サーボモータ４０５ｄの位置及び力の制御情報やスケーリング比、無線接続における電波状況、時間等の装置および接触している物体に関する情報を記憶媒体４０９ｂに記憶したり、ディスプレイ４０９ｃに表示したりする。また、記録・表示用回路４０９ａは、記憶媒体４０９ｂに記憶された情報を読み出し、ホストマイコンユニット４０３に出力する。
記憶媒体４０９ｂは、記録・表示用回路４０９ａの制御に従って、スレーブ装置４００の動作におけるサーボモータ４０５ｄの位置及び力の制御情報やスケーリング比、無線接続における電波状況、時間等の装置および接触している物体に関する情報を記憶する。記憶媒体４０９ｂに記憶された情報は、データ処理のために読み出すことができる。また、記憶媒体４０９ｂには、スレーブ装置４００において動作を再現するための情報が記憶され、マイクロコントローラ４０３ｂが、この情報を読み出して実行することにより動作を再現することができる。

【0094】

電源ユニット４１０は、信号用バッテリ４１０ａと、電源回路４１０ｂとを備えている。
信号用バッテリ４１０ａは、スレーブ装置４００の制御系統に電力を供給する。
電源回路４１０ｂは、信号用バッテリ４１０ａからスレーブ装置４００の制御系統に供給される電力を制御する。
なお、マスタ装置とスレーブ装置とは、無線通信によって接続可能である他、有線通信用ポート（図１９参照）を介して、有線通信によって接続することも可能である。
このような構成により、マスタ装置の動きに応じて、手先効果器４０７が対象物（ボール等）に接触すると、サーボモータ４０５ｄの位置及び反力が位置及び力の情報として、スレーブ装置４００からマスタ装置に送信される。すると、マスタ装置では、スレーブ装置４００における力・触覚を伝達する機能等を実現することができる。

【0095】

次に、マスタ装置とスレーブ装置とのデータ伝送方法について説明する。
図２１は、マスタ装置とスレーブ装置とで高速な通信を行うためのデータ構造を示す図である。
図２１に示すように、本応用例では、位置と力の情報を合計６４ビットのデータ（３２ビットずつのｆｌｏａｔ型変数）として表し、これを高速に伝送する。
そのために、まず位置及び力のデータを１６個のデータブロックに分割する。すると、各データブロックは、それぞれ４ビットの情報量となる。これら４ビット×１６個の順番を識別するために、各データブロックの先頭に４ビットのデータ番号を付加する。これにより、４ビットのデータ番号及び４ビットの実データからなる１バイトのデータブロックが１６個生成され、合計１６バイトのデータとなる。
これを以下の手順によって、マスタ装置とスレーブ装置との間で伝送する。

【0096】

図２２は、無線接続されたマスタ装置及びスレーブ装置の間における伝送手順を示すタイミングチャートである。
なお、本応用例におけるマスタ・スレーブシステムにおいては、処理の高速化を図るため、マスタ装置及びスレーブ装置の内蔵ＭＣＵ（Ｍｅｍｏｒｙ Ｃｏｎｔｒｏｌ Ｕｎｉｔ）に制御プログラムが直接実装される。
図２２において、送信側ホスト（送信側のプロセッサ等）は、図２１に示す１６個のデータブロックを１ブロックずつ送信側モジュール（送信側の通信インターフェース等）に伝送する。このとき、１ブロックを伝送するためには１００［μｓ］で足り、送信側ホストと送信側モジュールとの間の伝送速度として約１［Ｍｂｐｓ］を確保可能である。
次に、送信側モジュールと受信側モジュール（受信側の通信インターフェース等）との間で無線通信が行われる。このとき、無線通信路の伝送速度として約１［Ｍｂｐｓ］を確保可能であり、１６個のデータブロックを伝送するためには、約１．２［ｍｓ］で足りる。

【0097】

そして、受信側モジュールと受信側ホスト（受信側のプロセッサ等）との間では、伝送速度として約１［Ｍｂｐｓ］を確保可能であり、１バイトのデータブロック１つを伝送するためには１００［μｓ］で足りる。
すると、送信側ホストがデータの送出を開始してから、１６バイトのデータが受信側ホストに伝送されるまで、約４．５［ｍｓ］となる。
このように、本応用例では、内蔵ＭＣＵに制御プログラムを直接実装し、位置と力の情報を４ビット×８個にそれぞれ分割して通信モジュールに伝送し、無線通信路におけるパケットサイズを１６バイトに縮小することとした。
なお、従来のプロトコル、例えば、ＵＣＰ／ＩＰ等では、種々のヘッダ情報等のために、パケットサイズが２４バイトとなっているのに対し、本応用例の場合、必要なパケットサイズは１６バイトとなっている。
これにより、無線接続されたマスタ・スレーブシステムを高い実時間性を有し、携帯性に優れたシステムとして実現することができる。

【0098】

（動作のデータベース化への応用）
図２３は、人間の動作をデータベース化する概念を示す模式図である。
上述のように、アクチュエータにおける速度（位置）は加速度の積分によって表され、アクチュエータにおける力は質量と加速度との積で表される。
そのため、本発明においては、アクチュエータの位置の情報またはアクチュエータの位置の情報に基づいて得られる力の情報の少なくとも一方から、人間の動作を数値化して抽出することができる。
そこで、図２３に示すように、本発明の力・触覚伝達機能によって操作者が行った動作を測定する。
即ち、操作者がマスタ装置を操作した場合、操作者が行った動作を機能別力・速度割当変換ブロックＦＴ、理想力源ブロックＦＣ、理想速度（位置）源ブロックＰＣにおける演算に分解して、動作を表現することができる。

【0099】

そして、複数の人間の動作を機能別力・速度割当変換ブロックＦＴ、理想力源ブロックＦＣ、理想速度（位置）源ブロックＰＣにおける演算に分解して取得することで、これらの各ブロックにおいて処理される情報をデータベースＤＢに蓄積することができる。
このようにデータベース化された複数の人間の動作情報に対して統計処理を施すことで、各個人の動作の特徴（個人のやり方、他の人と比べた個性等）を抽出して数値化することが可能となる。
これにより、熟練者や素人等の動作情報に対して統計処理を施すことで、暗黙知、スキル、ノウハウ等を抽出して客観的な数値データとすることができる。

【0100】

（機能別力・速度割当変換に対するオフセットを用いた応用）
図２４は、機能別力・速度割当変換に対するオフセットの概念を示す模式図である。
機能別力・速度割当変換に対するオフセットでは、機能別力・速度割当変換ブロックＦＴにおいて変換された結果の位置及び力のエネルギーに対して、所定の定数を加減することにより、対象物の変化に追従することが可能となる。
即ち、図２４に示すように、機能別力・速度割当変換において、外部センサＤによって測定した対象物の位置等をオフセットとして加えることができる。
例えば、心臓の手術の場合、対象物である心臓は常時鼓動することから、外部センサＤによって心臓表面の位置を測定し、機能別力・速度割当変換におけるオフセットとして測定された位置の変化を加えることで、スレーブ装置（例えば、鉗子等）の心臓表面への自動追従を実現することができる。
このとき、力・触覚伝達機能にオフセットを加えることにより、力・触覚伝達と心臓表面への位置の自動追従とを両立させることが可能である。
これにより、手術を行う医師においては、心臓の鼓動による変位の影響を軽減して、より正確な作業を行うことが可能となる。

【0101】

（効果）
以上のように、本発明の第１の態様に係る位置・力制御装置によれば、機能別力・速度割当変換手段は、位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う。そして、位置制御量算出手段は、機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する。また、力制御量算出手段は、機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する。さらに、統合手段は、速度または位置の制御量と力の制御量とを統合し、その出力をアクチュエータに戻すべく速度または位置の制御量と力の制御量とを逆変換して、アクチュエータへの入力を決定する。これにより、速度または位置のエネルギーと、力のエネルギーとをそれぞれ独立に制御可能とした。
そのため、機能別力・速度割当変換手段において、制御エネルギーの速度または位置のエネルギーと力のエネルギーとへの割り当てを機能に応じて種々変更することができる。
したがって、目的とする機能に応じて、機能別力・速度割当変換手段の設定を変更することにより、ロボットによって人間の身体的行為をより適切に実現するための技術を提供することができる。

【0102】

また、本発明の第２の態様に係る位置・力制御装置によれば、機能別力・速度割当変換手段は、位置に関する情報に対応する速度（位置）及び力の情報と、予め取得されている制御の基準となる情報とに基づいて、実現される機能に応じて、制御エネルギーを速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に割り当てる変換を行う。そして、位置制御量算出手段は、機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーと力のエネルギーとのうち、少なくとも一方に基づいて、速度または位置の制御量と力のエネルギーとの少なくとも一方を算出する。さらに、統合手段は、速度または位置の制御量と力の制御量とを統合し、その出力をアクチュエータに戻すべく速度または位置の制御量と力の制御量とを逆変換して、アクチュエータへの入力を決定する。
したがって、予め取得された制御の基準となる情報に基づいて、速度（位置）あるいは力の制御量が算出されるため、予め取得された機能を再現することが可能となる。

【0103】

また、本発明の第３の態様に係る位置・力制御装置によれば、機能別力・速度割当変換手段は、位置に関する情報に対応する速度（位置）及び力の情報と、制御の基準となる情報とに基づいて、実現される機能に合わせて設定されている変換によって、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行う。そして、位置制御量算出手段は、機能別力・速度割当変換手段によって割り当てられた速度または位置のエネルギーに基づいて、速度または位置の制御量を算出する。また、力制御量算出手段は、機能別力・速度割当変換手段によって割り当てられた力のエネルギーに基づいて、力の制御量を算出する。さらに、統合手段は、速度または位置の制御量と力の制御量とを統合し、その出力をアクチュエータに戻すべく速度または位置の制御量と力の制御量とを逆変換して、アクチュエータへの入力を決定する。そして、スケーリング手段は、アクチュエータの出力に、位置、力及び時間の少なくともいずれかのスケーリングを生じさせる。
したがって、実現される機能に合わせて設定されている変換によって、制御エネルギーが速度または位置のエネルギーと力のエネルギーとに割り当てられるため、特定の目的に応じた機能を実現することができる。また、制御経路のいずれかの箇所にスケーリング手段が介装されることによって、アクチュエータの出力に、位置、力及び時間のスケーリングを生じさせることができるため、アクチュエータの動きの大きさを縮小したり、動きの強さ（力）を強めたり、あるいは、動きの速度を低下させたりすることができる。

【符号の説明】

【0104】

Ｓ 制御対象システム、ＦＴ 機能別力・速度割当変換ブロック（機能別力・速度割当変換手段）、ＦＣ 理想力源ブロック（力制御量算出手段）、ＰＣ 理想速度（位置）源ブロック（位置制御量算出手段）、ＩＦＴ 逆変換ブロック（統合手段）、１ 位置・力制御装置、１０ 基準値入力部、２０ 制御部、３０ ドライバ、４０ アクチュエータ、５０ 位置センサ（位置検出手段）、６０ 記憶部

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】

【図10】

【図11】

【図12】

【図13】

【図14】

【図15】

【図16】

【図17】

【図18】

【図19】

【図20】

【図21】

【図22】

【図23】

【図24】