JP2006212741A - タスクスキル生成装置 - Google Patents
タスクスキル生成装置 Download PDFInfo
- Publication number
- JP2006212741A JP2006212741A JP2005028658A JP2005028658A JP2006212741A JP 2006212741 A JP2006212741 A JP 2006212741A JP 2005028658 A JP2005028658 A JP 2005028658A JP 2005028658 A JP2005028658 A JP 2005028658A JP 2006212741 A JP2006212741 A JP 2006212741A
- Authority
- JP
- Japan
- Prior art keywords
- task skill
- information
- control
- force sensor
- impedance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Landscapes
- Manipulator (AREA)
Abstract
【課題】
ロボットに人の器用さを実装するためのタスクスキルをモデル化し、タスクスキルを生成するための制御方式を定義し、タスクスキルに必要な制御パラメータを抽出し、タスクスキル動作手順を抽出し、対象作業に適したタスクスキルの生成を実現する。
【解決手段】インピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置１およびインピーダンス制御を利用したタスクスキル生成装置１を利用して、操作者が対象作業を動作入力・提示装置１２と力センサ１３を使ってスレーブ装置１１のロボット２を遠隔操作し、その遠隔操作結果からタスクスキル生成に必要なタスクスキル動作手順、タスクスキルのモデルに基づいた初期条件、タスクスキル動作（インピーダンスと力のハイブリッド制御のパラメータ、インピーダンス制御のパラメータ）、終了条件を抽出する。
【選択図】図１
ロボットに人の器用さを実装するためのタスクスキルをモデル化し、タスクスキルを生成するための制御方式を定義し、タスクスキルに必要な制御パラメータを抽出し、タスクスキル動作手順を抽出し、対象作業に適したタスクスキルの生成を実現する。
【解決手段】インピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置１およびインピーダンス制御を利用したタスクスキル生成装置１を利用して、操作者が対象作業を動作入力・提示装置１２と力センサ１３を使ってスレーブ装置１１のロボット２を遠隔操作し、その遠隔操作結果からタスクスキル生成に必要なタスクスキル動作手順、タスクスキルのモデルに基づいた初期条件、タスクスキル動作（インピーダンスと力のハイブリッド制御のパラメータ、インピーダンス制御のパラメータ）、終了条件を抽出する。
【選択図】図１
Description
本発明は器用な作業を実現するタスクスキルを生成するためのインピーダンスと力のハイブリッド制御、またはインピーダンス制御を利用したタスクスキル生成装置に関するものである。
ロボットが人の代わりに複雑な作業を実行するには、ロボットに人の器用さを実装する必要がある。ロボットに実装する人の器用さをタスクスキルと呼ぶ。タスクスキル動作は、位置制御や力制御や位置と力のハイブリッド制御により実装され、動作手順を上手く設定することにより、対象作業が実現される。したがって、位置制御や力制御や位置と力のハイブリッド制御に必要なパラメータと動作手順の決め方が重要となる。
しかし、タスクスキル動作が位置制御で実装される場合、予め予想していた作業対象や環境と実際の位置との間に位置誤差が必ず生じるため、過大な力が発生してしまう。タスクスキル動作が力制御で実装される場合、自由空間でロボットを動作させ、目標軌道に追従させることが非常に困難である。タスクスキル動作が実装される位置と力のハイブリッド制御でも、上記位置制御と力制御と同じ問題がある。また、タスクスキル動作が実装される位置と力のハイブリッド制御では、必要なパラメータを対象作業にあわせて試行錯誤的に求めるしかなかった。さらに、対象作業を実現する動作手順についても試行錯誤的に求めるしかなかった（特許文献１〜３参照）。
タスクスキル動作を実装する位置制御と力制御と位置と力のハイブリッド制御では、前記の欠点があるため対象物や環境を破壊したり、常に対象物や環境と接触する必要があるなどの問題があった。また、タスクスキルを生成する場合に、タスクスキルの動作制御に必要なパラメータを試行錯誤的に求め、動作手順も試行錯誤的に求める方法は、非常に手間がかかるだけでなく、対象作業を実現するパラメータと動作手順を見つけることができないなどの問題があった。さらに、タスクスキルがモデル化されていないため、モデルに基づくタスクスキルの生成方法を確立することができないなどの問題があった。
この改善策として、タスクスキル動作を実装する制御方式には、前記制御方式以外を採用する必要がある。
また、人が直接対象作業を実施し、そのデータから必要とするパラメータと動作手順を抽出する方法がある。しかしながらこの方法でも、必要とするパラメータを作業中の人から直接抽出することはできず、人が対象作業を実現できる動作手順を、そのままロボットの動作手順として採用しても、人とロボットは構造、材質などが全く違うためロボットが対象作業を実現することはできないため、結局試行錯誤的に動作手順を修正する必要がある。
特開平２００１−５１７１２号公報
特開平２００３−１２７０７８号公報
特開平２００４−３２２２２４号公報
また、人が直接対象作業を実施し、そのデータから必要とするパラメータと動作手順を抽出する方法がある。しかしながらこの方法でも、必要とするパラメータを作業中の人から直接抽出することはできず、人が対象作業を実現できる動作手順を、そのままロボットの動作手順として採用しても、人とロボットは構造、材質などが全く違うためロボットが対象作業を実現することはできないため、結局試行錯誤的に動作手順を修正する必要がある。
解決しようとする問題点は、これまで確立されていないタスクスキルのモデル化と、タスクスキル動作を実装する前記制御方式と、作成者が頭の中で試行錯誤的に求めていた制御パラメータの抽出方法とタスクスキル動作手順の抽出方法の簡単化である。
本発明は前記課題を解決するために、以下の手段を採用する。
インピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置は、
ロボットと、力センサと、ハンドと、カメラと、ロボットを制御する制御装置と、力センサの情報を取得する装置と、ハンドを制御する制御装置と、カメラを制御する制御装置と、
を有するスレーブ装置の動作を生成する基となる操作者動作情報を操作者が入力しかつ前記スレーブ装置の動作情報を操作者に提示する動作入力・提示装置と、
前記スレーブ装置の動作を生成する基となる操作者力情報を操作者が入力する力センサと、
前記スレーブ装置の力センサ情報を操作者に提示する力センサ情報提示装置と、
前記スレーブ装置のカメラ映像を操作者に提示するカメラ映像提示装置と、
前記動作入力・提示装置を制御する制御装置と、
前記力センサの情報を取得する装置と、
操作者が入力する前記力センサ情報と前記スレーブ装置からの動作情報と力センサ情報を受信・処理し、前記動作入力・提示装置への動作指令情報と前記スレーブ装置への動作指令情報を生成する遠隔操作システム制御装置を有するマスタ装置と、
を有する。
インピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置は、
ロボットと、力センサと、ハンドと、カメラと、ロボットを制御する制御装置と、力センサの情報を取得する装置と、ハンドを制御する制御装置と、カメラを制御する制御装置と、
を有するスレーブ装置の動作を生成する基となる操作者動作情報を操作者が入力しかつ前記スレーブ装置の動作情報を操作者に提示する動作入力・提示装置と、
前記スレーブ装置の動作を生成する基となる操作者力情報を操作者が入力する力センサと、
前記スレーブ装置の力センサ情報を操作者に提示する力センサ情報提示装置と、
前記スレーブ装置のカメラ映像を操作者に提示するカメラ映像提示装置と、
前記動作入力・提示装置を制御する制御装置と、
前記力センサの情報を取得する装置と、
操作者が入力する前記力センサ情報と前記スレーブ装置からの動作情報と力センサ情報を受信・処理し、前記動作入力・提示装置への動作指令情報と前記スレーブ装置への動作指令情報を生成する遠隔操作システム制御装置を有するマスタ装置と、
を有する。
前記スレーブ装置のロボットは多関節構造であり、ロボットを駆動するモータの電流を利用して力センサの代わりに利用することができることを特徴とする。
前記マスタ装置の動作入力・提示装置は多関節構造ロボットであり、操作者に動作情報と力情報を提示でき、本装置を駆動するモータの電流を利用して力センサの代わりに利用することができることを特徴とする。
前記タスクスキルは、ロボットがある基本動作を実行できるだけでなく、上位言語のレベルから再利用可能なモジュールであり、該タスクスキルのモデルは、初期条件、タスクスキル動作、終了条件からなる一連の状態遷移を実現するものであることを特徴とする。
前記タスクスキル動作は、インピーダンスと力のハイブリッド制御を利用することを特徴とする。
さらに、本発明は前記課題を解決するために、以下の手段を採用する。
インピーダンス制御を利用したタスクスキル生成装置は、ロボットと、力センサと、ハンドと、カメラと、ロボットを制御する制御装置と、力センサの情報を取得する装置と、ハンドを制御する制御装置と、カメラを制御する制御装置と、
を有するスレーブ装置の動作を生成する基となる操作者動作情報を操作者が入力しかつ前記スレーブ装置の動作情報を操作者に提示する動作入力・提示装置と、
前記スレーブ装置の動作を生成する基となる操作者力情報を操作者が入力する力センサと、
前記スレーブ装置の力センサ情報を操作者に提示する力センサ情報提示装置と、
前記スレーブ装置のカメラ映像を操作者に提示するカメラ映像提示装置と、
前記動作入力・提示装置を制御する制御装置と、
前記力センサの情報を取得する装置と、
操作者が入力する前記力センサ情報と前記スレーブ装置からの動作情報と力センサ情報を受信・処理し、前記動作入力・提示装置への動作指令情報と前記スレーブ装置への動作指令情報を生成する遠隔操作システム制御装置を有するマスタ装置と、
を有する。
インピーダンス制御を利用したタスクスキル生成装置は、ロボットと、力センサと、ハンドと、カメラと、ロボットを制御する制御装置と、力センサの情報を取得する装置と、ハンドを制御する制御装置と、カメラを制御する制御装置と、
を有するスレーブ装置の動作を生成する基となる操作者動作情報を操作者が入力しかつ前記スレーブ装置の動作情報を操作者に提示する動作入力・提示装置と、
前記スレーブ装置の動作を生成する基となる操作者力情報を操作者が入力する力センサと、
前記スレーブ装置の力センサ情報を操作者に提示する力センサ情報提示装置と、
前記スレーブ装置のカメラ映像を操作者に提示するカメラ映像提示装置と、
前記動作入力・提示装置を制御する制御装置と、
前記力センサの情報を取得する装置と、
操作者が入力する前記力センサ情報と前記スレーブ装置からの動作情報と力センサ情報を受信・処理し、前記動作入力・提示装置への動作指令情報と前記スレーブ装置への動作指令情報を生成する遠隔操作システム制御装置を有するマスタ装置と、
を有する。
前記インピーダンス制御を利用したタスクスキル生成装置のスレーブ装置のロボットは多関節構造であり、ロボットを駆動するモータの電流を利用して力センサの代わりに利用することができることを特徴とする。
前記インピーダンス制御を利用したタスクスキル生成装置のマスタ装置の動作入力・提示装置は多関節構造ロボットであり、操作者に動作情報と力情報を提示でき、本装置を駆動するモータの電流を利用して力センサの代わりに利用することができることを特徴とする。
前記インピーダンス制御を利用したタスクスキル生成装置のタスクスキルは、ロボットがある基本動作を実行できるだけでなく、上位言語のレベルから再利用可能なモジュールであり、該タスクスキルのモデルは、初期条件、タスクスキル動作、終了条件からなる一連の状態遷移を実現するものであることを特徴とする。
前記インピーダンス制御を利用したタスクスキル生成装置のタスクスキル動作は、インピーダンス制御を利用することを特徴とする。
本発明に係るタスクスキル生成装置によれば、タスクスキルの生成において、操作者が本装置を利用して対象作業を実行することにより、実行結果からタスクスキルのモデルに基つく初期条件、タスクスキル動作、終了条件と、タスクスキル動作に実装されるインピーダンスと力のハイブリッド制御又はインピーダンス制御に必要なパラメータと、タスクスキル動作手順を簡単に抽出できるという利点がある。
本発明は、前記課題を解決するために、初期条件、タスクスキル動作、終了条件からなる一連の状態遷移とするタスクスキルのモデルを基にタスクスキルを生成するものである。
本発明は、タスクスキル動作にインピーダンスと力のハイブリッド制御を実装することにより、自由空間での軌道追従性を確保し、対象物や環境との位置誤差に対しても過大な力が発生することを防ぎ、位置と姿勢のそれぞれ軸に対して操作者の意図に合わせてインピーダンス制御と力制御を適用できることを最も主な特徴とする。
本発明は、タスクスキル動作にインピーダンス制御を実装することにより、自由空間での軌道追従性を確保し、対象物や環境との位置誤差に対しても過大な力が発生することを防ぐことを最も主な特徴とする。
さらに、タスクスキル動作にインピーダンスと力のハイブリッド制御を実装する場合、ひとつの軸においてインピーダンス制御から力制御あるいは力制御からインピーダンス制御に切り替えるときの制御の安定化問題が生じるが、タスクスキル動作にインピーダンス制御を実装すると制御の切り替え問題がなくなることを最も主な特徴とする。
さらに、タスクスキル動作にインピーダンスと力のハイブリッド制御を実装する場合、ひとつの軸においてインピーダンス制御から力制御あるいは力制御からインピーダンス制御に切り替えるときの制御の安定化問題が生じるが、タスクスキル動作にインピーダンス制御を実装すると制御の切り替え問題がなくなることを最も主な特徴とする。
本発明は、操作者がロボットを遠隔操作により動作させ、対象作業を実施することにより得られるデータから、インピーダンスと力のハイブリッド制御とインピーダンス制御に必要な制御パラメータとタスクスキルのモデルの一部である初期条件、終了条件を遠隔操作実験結果から抽出することを最も主な特徴とする。タスクスキルの動作手順は操作者の遠隔操作手順から抽出することを最も主な特徴とする。
本発明に係るタスクスキル動作にインピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置を実施するための最良の形態を実施例１に基づいて図面を参照して、以下説明する。
本発明に係るタスクスキル動作にインピーダンス制御を利用したタスクスキル生成装置を実施するための最良の形態を実施例２に基づいて図面を参照して、以下説明する。なお、図面及び符号は、実施例１と実施例２について共通であり、実施例１及び実施例２は、同じ図面及び符号で説明する。
図１は、本発明に関わるタスクスキル動作にインピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置１の全体構成図である。スレーブ装置１１は、ロボット２（本実施例ではロボットアーム）、力センサ３、ハンド４、カメラ５、ロボット制御装置６、ハンド制御装置７、力センサ情報取得装置８、カメラ制御装置９、コマンド・データ送受信装置１０を有する。
ロボット２は、多関節構造であり、ロボット制御装置６により位置制御で動作する。さらに、ロボット２を駆動するモータの電流を利用して力センサ３の代わりに利用することもできる。ハンド４の手先位置は、ロボット２の関節に設置されている関節角度計測装置（例、ポテンショメータ）により計算できることは周知技術である。
ハンド４は、多指ハンドであり、ハンド制御装置７により指先が位置制御で動作する。
コマンド・データ送受信装置１０は、ロボット制御装置６に送信するロボット２の目標手先位置指令値とハンド制御装置７に送信するハンド４の目標指位置指令値をマスタ装置２０のコマンド・データ送受信装置１９から受信し、ロボット制御装置６で計算されるロボット２の現在手先位置情報と力センサ情報取得装置８で取得する力センサ３の情報とハンド制御装置７で計算されるハンド４の現在指位置情報とカメラ制御装置９で取得するカメラ５の映像をマスタ装置２０のコマンド・データ送受信装置１９に送信する。
マスタ装置２０は、動作入力・提示装置１２、力センサ１３、動作入力・提示装置用制御装置１４、力センサ情報取得装置１５、遠隔操作システム制御装置１６、力センサ情報提示装置１７、カメラ映像提示装置１８、コマンド・データ送受信装置１９を有する。
動作入力・提示装置１２は、多関節構造であり、動作入力・提示装置用制御装置１４により位置制御で動作する。さらに、動作入力・提示装置１２を駆動するモータの電流を利用して力センサ１３の代わりに利用することもできる。操作者が把持する動作入力・提示装置１２の把持部の位置は、動作入力・提示装置の関節に設置されている関節角度計測装置（例、ポテンショメータ）により把持部の位置が計測できることは周知技術である。
力センサ情報提示装置１７は、スレーブ装置１１の力センサ３の情報とマスタ装置２０の力センサ１３の情報を提示する装置である。
カメラ映像提示装置１８は、スレーブ装置１１のカメラ５の映像を提示する装置である。
図２は、遠隔操作システム制御装置１６に実装される並列型バイラテラル遠隔操作方式のブロック図である。遠隔操作システム制御装置１６は、スレーブ装置１１の力センサ３の情報とマスタ装置２０の力センサの１３情報を基にしてスレーブ装置１１のロボット２の目標手先位置とマスタ装置２０の動作入力・提示装置１２の目標把持部位置を計算する。計算式は、スレーブ装置１１の力センサ３の情報をFs、マスタ装置２０の力センサ１３の情報をFm、スレーブ装置１１のロボット２の目標手先位置とマスタ装置２０の動作入力・提示装置１２の目標把持部位置をPbref、ゲインをKbとすると、
Pbref = Kb (Fm + Fs)
となる。
Pbref = Kb (Fm + Fs)
となる。
コマンド・データ送受信装置１９は、ロボット制御装置６に送信するロボット２の目標手先位置指令値とハンド制御装置７に送信するハンド４の目標指位置指令値をスレーブ装置１１のコマンド・データ送受信装置１０に送信し、ロボット制御装置６で計算されるロボット２の現在手先位置情報と力センサ情報取得装置８で取得する力センサ３の情報とハンド制御装置７で計算されるハンド４の現在指位置情報とカメラ制御装置９で取得するカメラ５の映像をスレーブ装置１１のコマンド・データ送受信装置１０から受信する。
図３は、ボルト２２にナット２１を組付ける作業の概要図である。ボルト２２は環境に固定されており、ナット２１はスレーブ装置１１のハンド４に把持される。Σnはナット２１に固定されたナット座標系であり、点０が原点である。Σbはボルト２２に固定されたボルト座標系であり、点Bが原点である。ロボット２の手先座標系は、ナット２１のナット座標系Σnと一致する。ナット２１を動かすタスクスキル動作は、タスクスキル動作座標系Σsで記述されるとする。Σsは、Σnを基準として決定されるが、ナット２１が移動すると同時にΣnも移動するため、ある時点でのΣnをΣsと設定し、Σnが引き続き移動したとしてもΣsは設定された時点の位置に固定される。また、一度ΣsがΣnにより設定され、Σsを基準にしてΣnが移動したとしても、移動後のΣnを利用してΣsを新規に再設定できる。
操作者は、遠隔操作によりナット組付け作業が実行可能な遠隔操作手順を考え、その手順に沿ってナット組付け作業を実施する。したがって、この遠隔操作手順は、ロボット２にとってナット組付け作業を実際に実施した手順と考えることができるため、この遠隔操作手順をナット組付けタスクスキルの動作手順とする。図４は、ナット組付けタスクスキルの動作手順である。遠隔操作時、動作入力・提示装置１２の手先位置（制御点）は、ハンド４に把持されたナット２１の点Oと対応している。したがって、操作者は、動作入力・提示装置１２を介して、ナット２１の点Oを操作することとなる。
タスクスキル動作に実装されるインピーダンスと力のハイブリッド制御では、個々の制御軸（x、y、z軸、roll、pitch、yaw軸）に対してインピーダンス制御と力制御のどちらかの制御を設定する必要がある。操作者には、予め力制御したい制御軸のみ意識して遠隔操作を実施してもらうことにより、その軸のみ力制御軸と設定し、その他の軸をインピーダンス制御軸と設定する。
図５は、操作者が本発明装置を使ってボルト２２にナット２１を組付け作業を実施した実験結果である。
図５（a）がナット２１の点Oに作用する力、図５（b）がナット２１の点Oに作用するトルク、図５（c）がナット２１の点Oの位置、図５（d）がナット２１の点Oの姿勢である。図５で使用する座標系（x、y、z軸、roll、pitch、yaw軸）は、空間の一点に固定される必要があるため、ナット組付け作業開始時のΣnを図５で使用する座標系とし、点Oを原点とした。スレーブ装置１１のハンド４に把持されたナット２１の点Oに作用する力は、力センサ４と力センサ情報取得装置８で取得し、ナット２１の点Oの位置は、ロボット２とロボット制御装置６から取得できる。ナット２１の点Oに作用する力をFs、ナット２１の点Oの位置をPs、剛性ゲインをKiとすると、ナット２１のインピーダンス中心Picは、
Pic = Ps + Ki Fs
となる。
図５（a）がナット２１の点Oに作用する力、図５（b）がナット２１の点Oに作用するトルク、図５（c）がナット２１の点Oの位置、図５（d）がナット２１の点Oの姿勢である。図５で使用する座標系（x、y、z軸、roll、pitch、yaw軸）は、空間の一点に固定される必要があるため、ナット組付け作業開始時のΣnを図５で使用する座標系とし、点Oを原点とした。スレーブ装置１１のハンド４に把持されたナット２１の点Oに作用する力は、力センサ４と力センサ情報取得装置８で取得し、ナット２１の点Oの位置は、ロボット２とロボット制御装置６から取得できる。ナット２１の点Oに作用する力をFs、ナット２１の点Oの位置をPs、剛性ゲインをKiとすると、ナット２１のインピーダンス中心Picは、
Pic = Ps + Ki Fs
となる。
この式から計算したナット２１のインピーダンス中心の位置を図５（e）、姿勢を図５（f）に示す。ここで剛性ゲインKiはx、y、z軸、roll、pitch、 yaw軸周りについてそれぞれ500.0 [N/m]、500.0 [N/m]、 500.0 [N/m]、5.0 [Nm/rad]、 5.0 [Nm/rad]、5.0 [Nm/rad]とした。
ここで、ナット２１に力、モーメントが作用しない場合には、ナット２１の点Oがナットのインピーダンス中心となる。
ここで、ナット２１に力、モーメントが作用しない場合には、ナット２１の点Oがナットのインピーダンス中心となる。
操作者による遠隔操作手順とハイブリッド制御における制御軸の決定を基に、ナット組付け作業のタスクスキル動作手順を決定し、このタスクスキル手順を図５に対応させると、
（１） ボルト２２への接近、接触動作（図５のAB間、IJ間）（全軸インピーダンス制御）
（２） ボルト２２への押付け動作（図５のBC間、JK間）（z軸力制御、その他の軸インピーダンス制御）
（３） ボルト２２への軸合せ動作（図５のCG間、KO間）（z軸力制御、その他の軸インピーダンス制御）
（４） ボルト２２への軸合せ動作が失敗した場合の離脱（図５のGH間）、回転動作（図５のHI間）（全軸インピーダンス制御）
（５） ボルト２２への組付け動作（図５のOP間）（z軸力制御、その他の軸インピーダンス制御）
と記述できる。
（１） ボルト２２への接近、接触動作（図５のAB間、IJ間）（全軸インピーダンス制御）
（２） ボルト２２への押付け動作（図５のBC間、JK間）（z軸力制御、その他の軸インピーダンス制御）
（３） ボルト２２への軸合せ動作（図５のCG間、KO間）（z軸力制御、その他の軸インピーダンス制御）
（４） ボルト２２への軸合せ動作が失敗した場合の離脱（図５のGH間）、回転動作（図５のHI間）（全軸インピーダンス制御）
（５） ボルト２２への組付け動作（図５のOP間）（z軸力制御、その他の軸インピーダンス制御）
と記述できる。
（１）ボルト２２への接近、接触動作では、図５のAB間およびIJ間では、図５（e）からインピーダンス心を約10 [s]間にz軸方向に0.04 [m]（図５（e）のα1、β1間）移動させている。したがって、全軸（x、y、z、roll、pitch、 yaw軸）インピーダンス制御とし、インピーダンス中心をz軸方向に0.004 [m/s] で移動させ、ボルト２２に接近、接触させる。接触後、-6.0 [N]（図５（a）のα3）の力をz軸方向に発生させ、接触動作を終了する。ここで、初期位置からの位置誤差が吸収されていることが、図５（c）から確認できる。したがって、ボルト２２への接近、接触動作は、タスクスキルのモデルを使って以下のように記述できる。
・初期条件：Σnのz軸とΣbのz軸がある程度一致しており、動作開始時ΣnをΣsと設定する。z軸方向でのナット２１とボルト２２の距離は 0.1 [m]以内とする。
・タスクスキル動作：全軸インピーダンス制御で、インピーダンス中心をz軸方向に0.004 [m/s] で移動させる。目標位置はナット２１とボルト２２の距離よりも大きく設定し、0.1 [m]とする。
・終了条件：z軸方向に-6.0[N] 発生した時点で終了する。この時点でのΣnをΣsと再設定する。
・初期条件：Σnのz軸とΣbのz軸がある程度一致しており、動作開始時ΣnをΣsと設定する。z軸方向でのナット２１とボルト２２の距離は 0.1 [m]以内とする。
・タスクスキル動作：全軸インピーダンス制御で、インピーダンス中心をz軸方向に0.004 [m/s] で移動させる。目標位置はナット２１とボルト２２の距離よりも大きく設定し、0.1 [m]とする。
・終了条件：z軸方向に-6.0[N] 発生した時点で終了する。この時点でのΣnをΣsと再設定する。
（２）ボルト２２への押付け動作では、図５のBC間およびJK間では、約7[s]間、z軸方向に-6.0 [N]で押付ける。ボルト２２への押付け動作は、タスクスキルのモデルを使って以下のように記述できる。
・初期条件：z軸方向に-6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御で、z軸方向に -6.0 [N] で押付ける。
・終了条件：7.0 [s]間押付けた時点で終了する。
・初期条件：z軸方向に-6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御で、z軸方向に -6.0 [N] で押付ける。
・終了条件：7.0 [s]間押付けた時点で終了する。
ナット２１をボルト２２に組付ける場合、ナット２１のΣnのz軸がボルト２２のΣbのz軸に対して一直線上に存在しないと、組付けを実現することはできない。そこで、（３）ボルト２２への軸合せ動作では、ナット２１のΣnのz軸をボルト２２のΣbのz軸と一直線上に設定するための、軸合せ動作手順と軸合せ評価基準を設定する。軸合せ動作は、ナット２１をボルト２２に押付けたまま、コンプライアンス中心の姿勢を変化させることである。軸合せが成功した場合には、ナット２１に大きなモーメントが発生するため、このモーメントに注目しながら、軸合せを実施する必要がある。
図６にナット２１の面をΣsに関してxy平面で8分割した図を示す。操作者は、インピーダンス中心を図６に示された AA'（pitch軸周り）、BB’、CC’（roll軸周り）、DD’方向に順次姿勢を変化させ軸合せを実施する。以下に詳しく手順を述べる。
図５のCD間では、ナット２１をz軸方向に-6.0 [N] で押付けたまま、約32 [s]間、図６に示したAA'方向（pitch軸周り）に0.0 [rad] から -0.3 [rad]（図５（f）のα2）へと回転させ、次に-0.3 [rad] から 0.3 [rad]（図５（f）のβ2）へと回転させ、さらに 0.3 [rad] から 0.0 [rad]へと回転させる。ここで、動作時間と回転角度から、回転速度を 0.04 [rad/s] とする。さらに、図５のDE間、EF間、FG間と順次CD間と同様に図６に示したBB'方向、CC'方向（roll軸周り）、DD'方向で姿勢を変化させる。
軸合せの評価基準は、0.3 [Nm] 以上のモーメント（図５（b）のα4、β4）が1.0[s] 以上発生する状態と定義し、この時点でのΣnをΣsとして再設定する。さらに、この状態が図６のAA'方向の姿勢変化からDD'方向の姿勢変化間に一度でも発生すれば、その後この状態が4回発生するまで、軸合せ動作を繰り返すとする。図５（b）において、CG間では、一度も軸合せの評価基準を満たしていなので、軸合せは失敗となり、GI間に示す離脱、回転動作へと移行する。KO間では、4回軸合せの評価基準を満たしたので、軸合せは成功となり、OP間に示す組付け動作へと移行する。
さらに、図５（e）では、CD間にインピーダンス中心の移動が確認できる。インピーダンス中心の姿勢が図６のAA'方向（pitch軸周り）に0.0 [rad] から -0.3 [rad]に回転する際にはx軸方向に0.004 [m/s]で0.0 [m] から0.004 [m]に移動し、-0.3 [rad] から0.3 [rad]に回転する際にはx軸方向に 0.004 [m/s] で0.004[m] から-0.004 [m]に移動し、さらに 0.3 [rad] から0.0 [rad] へと回転する際にはx軸方向に0.004 [m/s] で-0.004[m] から0.004 [m]移動している。図５のDE間、EF間、FG間も同様にインピーダンス中心の並進動作が確認できる。したがって、ボルト２２への軸合せ動作は、図５のCD間およびKL間、DE間およびLM間、EF間およびMN間、FG間およびNO間に分けてタスクスキルモデルを使って以下のように記述できる。
（３−１）図５のCD間およびKL間
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御とする。
z軸方向の力は -6.0 [N]を維持する。
インピーダンス中心をx軸方向に 0.004 [m/s]で0.0[m] から 0.004 [m]に移動させると同時にpitch軸周り（図６のAA'方向）に0.04 [rad/s] で 0.0 [rad] から-0.3 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.004 [m/s]で0.004 [m] から -0.004 [m]に移動させると同時にpitch軸周り（図６のAA'方向）に0.04 [rad/s] で -0.3 [rad] から0.3 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.004 [m/s]で-0.004 [m] から 0.004 [m]に移動させると同時にpitch軸周り（図６のAA'方向）に0.04 [rad/s] で 0.3 [rad] から0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし(3-2)へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３-２）へ移行する。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御とする。
z軸方向の力は -6.0 [N]を維持する。
インピーダンス中心をx軸方向に 0.004 [m/s]で0.0[m] から 0.004 [m]に移動させると同時にpitch軸周り（図６のAA'方向）に0.04 [rad/s] で 0.0 [rad] から-0.3 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.004 [m/s]で0.004 [m] から -0.004 [m]に移動させると同時にpitch軸周り（図６のAA'方向）に0.04 [rad/s] で -0.3 [rad] から0.3 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.004 [m/s]で-0.004 [m] から 0.004 [m]に移動させると同時にpitch軸周り（図６のAA'方向）に0.04 [rad/s] で 0.3 [rad] から0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし(3-2)へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３-２）へ移行する。
（３−２）図５のDE間およびLM間
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御とする。
z軸方向の力は -6.0 [N]を維持する。
インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] 、y軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0.028 [rad/s] で 0.0 [rad] から0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.0 [rad] から -0.21 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0028 [m] から -0.0028 [m] 、y軸方向に0.0028 [m/s] で 0.0028 [m] から-0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0。028 [rad/s] で 0.21 [rad] から-0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で-0.21 [rad] から 0.21 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.0028 [m/s] で-0.0028 [m] から 0.0028 [m] 、y軸方向に0.0028 [m/s] で -0.0028 [m] から0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0.028 [rad/s] で -0.21 [rad] から0.0 [rad]、 pitch軸周りに 0.028 [rad/s] で0.21 [rad] から 0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし(3-3)へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３-３）へ移行する。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御とする。
z軸方向の力は -6.0 [N]を維持する。
インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] 、y軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0.028 [rad/s] で 0.0 [rad] から0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.0 [rad] から -0.21 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0028 [m] から -0.0028 [m] 、y軸方向に0.0028 [m/s] で 0.0028 [m] から-0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0。028 [rad/s] で 0.21 [rad] から-0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で-0.21 [rad] から 0.21 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.0028 [m/s] で-0.0028 [m] から 0.0028 [m] 、y軸方向に0.0028 [m/s] で -0.0028 [m] から0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0.028 [rad/s] で -0.21 [rad] から0.0 [rad]、 pitch軸周りに 0.028 [rad/s] で0.21 [rad] から 0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし(3-3)へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３-３）へ移行する。
（３−３）図５のEF間およびMN間
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御とする。
z軸方向の力は -6.0 [N]を維持する。
インピーダンス中心をy軸方向に 0.004 [m/s]で0.0[m] から 0.004 [m]に移動させると同時にroll軸周り（図６のCC'方向）に0.04 [rad/s] で 0.0 [rad] から0.3 [rad]に移動させる。
次に、インピーダンス中心をy軸方向に 0.004 [m/s]で0.004 [m] から -0.004 [m]に移動させると同時にroll軸周り（図６のCC'方向）に0.04 [rad/s] で 0.3 [rad] から-0.3 [rad]に移動させる。
最後に、インピーダンス中心をy軸方向に 0.004 [m/s]で -0.004[m] から 0.004 [m]に移動させると同時にroll軸周り（図６のCC'方向）に0.04 [rad/s] で -0.3 [rad] から0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし（３−４）へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−４）へ移行する。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御とする。
z軸方向の力は -6.0 [N]を維持する。
インピーダンス中心をy軸方向に 0.004 [m/s]で0.0[m] から 0.004 [m]に移動させると同時にroll軸周り（図６のCC'方向）に0.04 [rad/s] で 0.0 [rad] から0.3 [rad]に移動させる。
次に、インピーダンス中心をy軸方向に 0.004 [m/s]で0.004 [m] から -0.004 [m]に移動させると同時にroll軸周り（図６のCC'方向）に0.04 [rad/s] で 0.3 [rad] から-0.3 [rad]に移動させる。
最後に、インピーダンス中心をy軸方向に 0.004 [m/s]で -0.004[m] から 0.004 [m]に移動させると同時にroll軸周り（図６のCC'方向）に0.04 [rad/s] で -0.3 [rad] から0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし（３−４）へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−４）へ移行する。
（３−４）図５のFG間およびNO間
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御とする。
z軸方向の力は -6.0 [N]を維持する。
インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0 [m] から -0.0028 [m] 、y軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で 0.0 [rad] から0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.0 [rad] から 0.21 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.0028 [m/s] で-0.0028 [m] から 0.0028 [m] 、y軸方向に0.0028 [m/s] で 0.0028 [m] から-0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で 0.21 [rad] から-0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.21 [rad] から -0.21 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0028 [m] から -0.0028 [m] 、y軸方向に0.0028 [m/s] で -0.0028 [m] から0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で -0.21 [rad] から0.0 [rad]、 pitch軸周りに 0.028 [rad/s] で-0.21 [rad] から 0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし（３−１）へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−１）へ移行する。
ここで、ボルトの軸合せ動作の終了条件は、軸合せの評価基準を4回満たすまで軸合せ動作を繰り返し、4回発生した時点と設定する。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御とする。
z軸方向の力は -6.0 [N]を維持する。
インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0 [m] から -0.0028 [m] 、y軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で 0.0 [rad] から0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.0 [rad] から 0.21 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.0028 [m/s] で-0.0028 [m] から 0.0028 [m] 、y軸方向に0.0028 [m/s] で 0.0028 [m] から-0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で 0.21 [rad] から-0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.21 [rad] から -0.21 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0028 [m] から -0.0028 [m] 、y軸方向に0.0028 [m/s] で -0.0028 [m] から0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で -0.21 [rad] から0.0 [rad]、 pitch軸周りに 0.028 [rad/s] で-0.21 [rad] から 0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし（３−１）へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−１）へ移行する。
ここで、ボルトの軸合せ動作の終了条件は、軸合せの評価基準を4回満たすまで軸合せ動作を繰り返し、4回発生した時点と設定する。
（４）ボルト２２への軸合せ動作が失敗した場合の離脱、回転動作では、図５のGH間では約7 [s]間でインピーダンス中心をz軸方向に -0.02 [m]移動させているため、移動速を0.003 [m/s]とする。図５のHI間では約 14 [s]間でインピーダンス中心をz軸周りに 3.14/2 [rad]回転させるため、回転速度を 0.1 [rad/s]とする。したがって、ボルト２２への軸合せ動作が失敗した場合の離脱、回転動作は、タスクスキルのモデルを使って以下のように記述できる。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：全軸インピーダンス制御で、インピーダンス中心をz軸方向に0.003 [m/s] で -0.02 [m]まで移動させる。その後、インピーダンス中心をz軸周りに 0.1 [rad/s] で3.14/2 [rad]まで回転させる。
・終了条件：タスクスキル動作が完了した時点で終了とする。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：全軸インピーダンス制御で、インピーダンス中心をz軸方向に0.003 [m/s] で -0.02 [m]まで移動させる。その後、インピーダンス中心をz軸周りに 0.1 [rad/s] で3.14/2 [rad]まで回転させる。
・終了条件：タスクスキル動作が完了した時点で終了とする。
（５）ボルト２２への組付け動作では、図５のOP間では約35[s]間でインピーダンス中心をz軸周りに3.14 [rad]回転させているため、回転速度を 0.1 [rad/s]とする。したがって、ボルト２２への組付け動作は、タスクスキルモデルを使って以下のように記述できる。
・初期条件：z軸方向に-6.0 [N] 発生状態とする。
・作業スキル動作：z軸力制御、その他の軸インピーダンス制御で、z軸方向の力は-6.0 [N]を維持したまま、インピーダンス中心をz軸回りに 0.1 [rad/s] で3.14 [rad]回転させる。
・終了条件：タスクスキル動作が完了した時点で終了とする。
・初期条件：z軸方向に-6.0 [N] 発生状態とする。
・作業スキル動作：z軸力制御、その他の軸インピーダンス制御で、z軸方向の力は-6.0 [N]を維持したまま、インピーダンス中心をz軸回りに 0.1 [rad/s] で3.14 [rad]回転させる。
・終了条件：タスクスキル動作が完了した時点で終了とする。
以上、本発明に関わるタスクスキル動作にインピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置を実施するための最良の形態を実施例に基づいて説明した。既に実施例１で生成したナット組付けタスクスキルを利用して、ナットの組付け作業実施した。このナット組付けタスクスキルを実装したロボットは、異なるサイズのナット２１や位置・姿勢誤差を含んだ様々な環境下でナット組付け作業をすべて実現することができ、本発明で生成されるタスクスキルが実際に使用できることが確認された。
図１は、本発明に関わるタスクスキル動作にインピーダンス制御を利用したタスクスキル生成装置１の全体構成図である。スレーブ装置１１は、ロボット２（本実施例ではロボットアーム）、力センサ３、ハンド４、カメラ５、ロボット制御装置６、ハンド制御装置７、力センサ情報取得装置８、カメラ制御装置９、コマンド・データ送受信装置１０を有する。
ロボット２は、多関節構造であり、ロボット制御装置６により位置制御で動作する。さらに、ロボット２を駆動するモータの電流を利用して力センサ３の代わりに利用することもできる。ハンド４の手先位置は、ロボット２の関節に設置されている関節角度計測装置（例、ポテンショメータ）により計算できることは周知技術である。
ハンド４は、多指ハンドであり、ハンド制御装置７により指先が位置制御で動作する。
コマンド・データ送受信装置１０は、ロボット制御装置６に送信するロボット２の目標手先位置指令値とハンド制御装置７に送信するハンド４の目標指位置指令値をマスタ装置２０のコマンド・データ送受信装置１９から受信し、ロボット制御装置６で計算されるロボット２の現在手先位置情報と力センサ情報取得装置８で取得する力センサ３の情報とハンド制御装置７で計算されるハンド４の現在指位置情報とカメラ制御装置９で取得するカメラ５の映像をマスタ装置２０のコマンド・データ送受信装置１９に送信する。
マスタ装置２０は、動作入力・提示装置１２、力センサ１３、動作入力・提示装置用制御装置１４、力センサ情報取得装置１５、遠隔操作システム制御装置１６、力センサ情報提示装置１７、カメラ映像提示装置１８、コマンド・データ送受信装置１９を有する。
動作入力・提示装置１２は、多関節構造であり、動作入力・提示装置用制御装置１４により位置制御で動作する。さらに、動作入力・提示装置１２を駆動するモータの電流を利用して力センサ１３の代わりに利用することもできる。操作者が把持する動作入力・提示装置１２の把持部の位置は、動作入力・提示装置の関節に設置されている関節角度計測装置（例、ポテンショメータ）により把持部の位置が計測できることは周知技術である。
力センサ情報提示装置１７は、スレーブ装置１１の力センサ３の情報とマスタ装置２０の力センサ１３の情報を提示する装置である。
カメラ映像提示装置１８は、スレーブ装置１１のカメラ５の映像を提示する装置である。
図２は、遠隔操作システム制御装置１６に実装される並列型バイラテラル遠隔操作方式のブロック図である。遠隔操作システム制御装置１６は、スレーブ装置１１の力センサ３の情報とマスタ装置２０の力センサの１３情報を基にしてスレーブ装置１１のロボット２の目標手先位置とマスタ装置２０の動作入力・提示装置１２の目標把持部位置を計算する。計算式は、スレーブ装置１１の力センサ３の情報をFs、マスタ装置２０の力センサ１３の情報をFm、スレーブ装置１１のロボット２の目標手先位置とマスタ装置２０の動作入力・提示装置１２の目標把持部位置をPbref、ゲインをKbとすると、
Pbref = Kb (Fm + Fs)
となる。
Pbref = Kb (Fm + Fs)
となる。
コマンド・データ送受信装置１９は、ロボット制御装置６に送信するロボット２の目標手先位置指令値とハンド制御装置７に送信するハンド４の目標指位置指令値をスレーブ装置１１のコマンド・データ送受信装置１０に送信し、ロボット制御装置６で計算されるロボット２の現在手先位置情報と力センサ情報取得装置８で取得する力センサ３の情報とハンド制御装置７で計算されるハンド４の現在指位置情報とカメラ制御装置９で取得するカメラ５の映像をスレーブ装置１１のコマンド・データ送受信装置１０から受信する。
図３は、ボルト２２にナット２１を組付ける作業の概要図である。ボルト２２は環境に固定されており、ナット２１はスレーブ装置１１のハンド４に把持される。Σnはナット２１に固定されたナット座標系であり、点０が原点である。Σbはボルト２２に固定されたボルト座標系であり、点Bが原点である。ロボット２の手先座標系は、ナット２１のナット座標系Σnと一致する。ナット２１を動かすタスクスキル動作は、タスクスキル動作座標系Σsで記述されるとする。Σsは、Σnを基準として決定されるが、ナット２１が移動すると同時にΣnも移動するため、ある時点でのΣnをΣsと設定し、Σnが引き続き移動したとしてもΣsは設定された時点の位置に固定される。また、一度ΣsがΣnにより設定され、Σsを基準にしてΣnが移動したとしても、移動後のΣnを利用してΣsを新規に再設定できる。
操作者は、遠隔操作によりナット組付け作業が実行可能な遠隔操作手順を考え、その手順に沿ってナット組付け作業を実施する。したがって、この遠隔操作手順は、ロボット２にとってナット組付け作業を実際に実施した手順と考えることができるため、この遠隔操作手順をナット組付けタスクスキルの動作手順とする。図４は、ナット組付けタスクスキルの動作手順である。遠隔操作時、動作入力・提示装置１２の手先位置（制御点）は、ハンド４に把持されたナット２１の点Oと対応している。したがって、操作者は、動作入力・提示装置１２を介して、ナット２１の点Oを操作することとなる。
図５は、操作者が本発明装置を使ってボルト２２にナット２１を組付け作業を実施した実験結果である。
図５（a）がナット２１の点Oに作用する力、図５（b）がナット２１の点Oに作用するトルク、図５（c）がナット２１の点Oの位置、図５（d）がナット２１の点Oの姿勢である。図５で使用する座標系（x、y、z軸、roll、pitch、yaw軸）は、空間の一点に固定される必要があるため、ナット組付け作業開始時のΣnを図５で使用する座標系とし、点Oを原点とした。スレーブ装置１１のハンド４に把持されたナット２１の点Oに作用する力は、力センサ４と力センサ情報取得装置８で取得し、ナット２１の点Oの位置は、ロボット２とロボット制御装置６から取得できる。ナット２１の点Oに作用する力をFs、ナット２１の点Oの位置をPs、剛性ゲインをKiとすると、ナット２１のインピーダンス中心Picは、
Pic = Ps + Ki Fs
となる。
図５（a）がナット２１の点Oに作用する力、図５（b）がナット２１の点Oに作用するトルク、図５（c）がナット２１の点Oの位置、図５（d）がナット２１の点Oの姿勢である。図５で使用する座標系（x、y、z軸、roll、pitch、yaw軸）は、空間の一点に固定される必要があるため、ナット組付け作業開始時のΣnを図５で使用する座標系とし、点Oを原点とした。スレーブ装置１１のハンド４に把持されたナット２１の点Oに作用する力は、力センサ４と力センサ情報取得装置８で取得し、ナット２１の点Oの位置は、ロボット２とロボット制御装置６から取得できる。ナット２１の点Oに作用する力をFs、ナット２１の点Oの位置をPs、剛性ゲインをKiとすると、ナット２１のインピーダンス中心Picは、
Pic = Ps + Ki Fs
となる。
この式から計算したナット２１のインピーダンス中心の位置を図５（e）、姿勢を図５（f）に示す。ここで剛性ゲインKiはx、y、z軸、roll、pitch、 yaw軸周りについてそれぞれ500.0 [N/m]、500.0 [N/m]、 500.0 [N/m]、5.0 [Nm/rad]、 5.0 [Nm/rad]、 5.0[Nm/rad]とした。
ここで、ナット２１に力、モーメントが作用しない場合には、ナット２１の点Oとナットのインピーダンス中心は一致する。
ここで、ナット２１に力、モーメントが作用しない場合には、ナット２１の点Oとナットのインピーダンス中心は一致する。
操作者による遠隔操作手順とハイブリッド制御における制御軸の決定を基に、ナット組付け作業のタスクスキル動作手順を決定し、このタスクスキル手順を図５に対応させると、
（１）ボルト２２への接近、接触動作（図５のAB間、IJ間）
（２）ボルト２２への押付け動作（図５のBC間、JK間）
（３）ボルト２２への軸合せ動作（図５のCG間、KO間）
（４）ボルト２２への軸合せ動作が失敗した場合の離脱（図５のGH間）、回転動作（図５のHI間）
（５）ボルト２２への組付け動作（図５のOP間）
と記述できる。
（１）ボルト２２への接近、接触動作（図５のAB間、IJ間）
（２）ボルト２２への押付け動作（図５のBC間、JK間）
（３）ボルト２２への軸合せ動作（図５のCG間、KO間）
（４）ボルト２２への軸合せ動作が失敗した場合の離脱（図５のGH間）、回転動作（図５のHI間）
（５）ボルト２２への組付け動作（図５のOP間）
と記述できる。
（１）ボルト２２への接近、接触動作では、図５のAB間およびIJ間では、図５（e）からインピーダンス中心を約10 [s]間にz軸方向に0.04 [m]（図５のα1、β1間）移動させている。したがって、インピーダンス中心をz軸方向に 0.004 [m/s] で移動させ、ボルト２２に接近、接触させる。接触後、-6.0 [N]（図５（a）のα3）の力をz軸方向に発生させ、接触動作を終了する。ここで、初期位置からの位置誤差が吸収されていることが、図５（c）から確認できる。したがって、ボルト２２への接近、接触動作は、タスクスキルのモデルを使って以下のように記述できる。
・初期条件：Σnのz軸とΣbのz軸がある程度一致しており、動作開始時ΣnをΣsと設定する。z軸方向でのナット２１とボルト２２の距離は 0.1 [m]以内とする。
・タスクスキル動作：インピーダンス中心をz軸方向に0.004 [m/s] で移動させる。目標位置はナット２１とボルト２２の距離よりも大きく設定し、0.1 [m]とする。
・終了条件：z軸方向に-6.0 [N] 発生した時点で終了する。この時点でのΣnをΣsと再設定する。
・初期条件：Σnのz軸とΣbのz軸がある程度一致しており、動作開始時ΣnをΣsと設定する。z軸方向でのナット２１とボルト２２の距離は 0.1 [m]以内とする。
・タスクスキル動作：インピーダンス中心をz軸方向に0.004 [m/s] で移動させる。目標位置はナット２１とボルト２２の距離よりも大きく設定し、0.1 [m]とする。
・終了条件：z軸方向に-6.0 [N] 発生した時点で終了する。この時点でのΣnをΣsと再設定する。
（２）ボルト２２への押付け動作では、図５のBC間およびJK間では、約7[s]間、インピーダンス中心を固定し、z軸方向に-6.0 [N]発生させている。したがって、ボルトへの押付け動作は、タスクスキルのモデルを使って以下のように記述できる。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心を固定し -6.0 [N] 発生させる。
・終了条件：7.0 [s]間押付けた時点で終了する。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心を固定し -6.0 [N] 発生させる。
・終了条件：7.0 [s]間押付けた時点で終了する。
ナット２１をボルト２２に組付ける場合、ナット２１のΣnのz軸がボルト２２のΣbのz軸に対して一直線上に存在しないと、組付けを実現することはできない。そこで、（３）ボルト２２への軸合せ動作では、ナット２１のΣnのz軸をボルト２２のΣbのz軸と一直線上に設定するための、軸合せ動作手順と軸合せ評価基準を設定する。軸合せ動作は、ナット２１をボルト２２に押付けたまま、コンプライアンス中心の姿勢を変化させることである。軸合せが成功した場合には、ナット２１に大きなモーメントが発生するため、このモーメントに注目しながら、軸合せを実施する必要がある。
図６にナット２１の面をΣsに関してxy平面で8分割した図を示す。操作者は、インピーダンス中心を図６に示された AA'（pitch軸周り）、BB’、CC’（roll軸周り）、DD’方向に順次姿勢を変化させ軸合せを実施する。以下に詳しく手順を述べる。
図５のCD間では、ナット２１をz軸方向に-6.0 [N] で押付けたまま、約32 [s]間、図６に示したAA'方向（pitch軸周り）に0.0 [rad] から -0.3 [rad]（図５（f）のα2）へと回転させ、次に-0.3 [rad] から 0.3 [rad]（図５（f）のβ2）へと回転させ、さらに 0.3 [rad] から 0.0 [rad]へと回転させる。ここで、動作時間と回転角度から、回転速度を 0.04 [rad/s] とする。さらに、図５のDE間、EF間、FG間と順次CD間と同様に図６に示したBB'方向、CC'方向（roll軸周り）、DD'方向で姿勢を変化させる。
軸合せの評価基準は、0.3 [Nm] 以上のモーメント（図５（b）のα4、β4）が1.0[s] 以上発生する状態と定義し、この時点でのΣnをΣsとして再設定する。さらに、この状態が図６のAA'方向の姿勢変化からDD'方向の姿勢変化間に一度でも発生すれば、その後この状態が4回発生するまで、軸合せ動作を繰り返すとする。図５（b）において、CG間では、一度も軸合せの評価基準を満たしていなので、軸合せは失敗となり、GI間に示す離脱、回転動作へと移行する。KO間では、4回軸合せの評価基準を満たしたので、軸合せは成功となり、OP間に示す組付け動作へと移行する。
さらに、図５（e）では、CD間にインピーダンス中心の移動が確認できる。インピーダンス中心の姿勢がAA'方向（pitch軸周り）に0.0 [rad] から -0.3 [rad]に回転する際にはx軸方向に0.004 [m/s]で0.0 [m] から0.004 [m]に移動し、-0.3 [rad] から0.3 [rad]に回転する際にはx軸方向に 0.004 [m/s] で0.004[m] から-0.004 [m]に移動し、さらに 0.3 [rad] から0.0 [rad] へと回転する際にはx軸方向に0.004 [m/s] で-0.004[m] から0.004 [m]移動している。DE間、EF間、FG間も同様にインピーダンス中心の並進動作が確認できる。したがって、ボルト２２への軸合せ動作は、図５のCD間およびKL間、DE間およびLM間、EF間およびMN間、FG間およびNO間に分けてタスクスキルモデルを使って以下のように記述できる。
（３−１）CD間およびKL間
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をx軸方向に0.004 [m/s]で0.0 [m] から0.004 [m]に移動させると同時にpitch軸周り（AA'方向）に0.04 [rad/s] で 0.0 [rad] から-0.3 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.004 [m/s]で0.004 [m] から -0.004 [m]に移動させると同時にpitch軸周り（AA'方向）に0.04 [rad/s] で -0.3 [rad] から0.3 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.004 [m/s]で-0.004 [m] から 0.004 [m]に移動させると同時にpitch軸周り（AA'方向）に0.04 [rad/s] で 0.3 [rad] から0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし(3-2)へ移行する。ただし、0.3[Nm]以上のモーメントが1.0 [s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−２）へ移行する。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をx軸方向に0.004 [m/s]で0.0 [m] から0.004 [m]に移動させると同時にpitch軸周り（AA'方向）に0.04 [rad/s] で 0.0 [rad] から-0.3 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.004 [m/s]で0.004 [m] から -0.004 [m]に移動させると同時にpitch軸周り（AA'方向）に0.04 [rad/s] で -0.3 [rad] から0.3 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.004 [m/s]で-0.004 [m] から 0.004 [m]に移動させると同時にpitch軸周り（AA'方向）に0.04 [rad/s] で 0.3 [rad] から0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし(3-2)へ移行する。ただし、0.3[Nm]以上のモーメントが1.0 [s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−２）へ移行する。
（３−２）DE間およびLM間
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をx軸方向に0.0028 [m/s] で 0.0 [m] から0.0028 [m] 、y軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0.028 [rad/s] で 0.0 [rad] から0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.0 [rad] から -0.21 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0028 [m] から -0.0028 [m] 、y軸方向に0.0028 [m/s] で 0.0028 [m] から-0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0。028 [rad/s] で 0.21 [rad] から-0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で-0.21 [rad] から 0.21 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.0028 [m/s] で-0.0028 [m] から 0.0028 [m] 、y軸方向に0.0028 [m/s] で -0.0028 [m] から0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0.028 [rad/s] で -0.21 [rad] から0.0 [rad]、 pitch軸周りに 0.028 [rad/s] で0.21 [rad] から 0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし(3-3)へ移行する。ただし、0.3[Nm]以上のモーメントが1.0 [s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−３）へ移行する。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をx軸方向に0.0028 [m/s] で 0.0 [m] から0.0028 [m] 、y軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0.028 [rad/s] で 0.0 [rad] から0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.0 [rad] から -0.21 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0028 [m] から -0.0028 [m] 、y軸方向に0.0028 [m/s] で 0.0028 [m] から-0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0。028 [rad/s] で 0.21 [rad] から-0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で-0.21 [rad] から 0.21 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.0028 [m/s] で-0.0028 [m] から 0.0028 [m] 、y軸方向に0.0028 [m/s] で -0.0028 [m] から0.0028 [m] に移動させると同時に図６のBB'方向となる roll軸周りに0.028 [rad/s] で -0.21 [rad] から0.0 [rad]、 pitch軸周りに 0.028 [rad/s] で0.21 [rad] から 0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし(3-3)へ移行する。ただし、0.3[Nm]以上のモーメントが1.0 [s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−３）へ移行する。
（３−３）EF間およびMN間
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をy軸方向に0.004 [m/s]で0.0 [m] から0.004 [m]に移動させると同時にroll軸周り（CC'方向）に0.04 [rad/s] で 0.0 [rad] から0.3 [rad]に移動させる。
次に、インピーダンス中心をy軸方向に 0.004 [m/s]で0.004 [m] から -0.004 [m]に移動させると同時にroll軸周り（CC'方向）に0.04 [rad/s] で 0.3 [rad] から-0.3 [rad]に移動させる。
最後に、インピーダンス中心をy軸方向に 0.004 [m/s]で-0.004 [m] から 0.004 [m]に移動させると同時にroll軸周り（CC'方向）に0.04 [rad/s] で -0.3 [rad] から0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし（３−４）へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−４）へ移行する。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をy軸方向に0.004 [m/s]で0.0 [m] から0.004 [m]に移動させると同時にroll軸周り（CC'方向）に0.04 [rad/s] で 0.0 [rad] から0.3 [rad]に移動させる。
次に、インピーダンス中心をy軸方向に 0.004 [m/s]で0.004 [m] から -0.004 [m]に移動させると同時にroll軸周り（CC'方向）に0.04 [rad/s] で 0.3 [rad] から-0.3 [rad]に移動させる。
最後に、インピーダンス中心をy軸方向に 0.004 [m/s]で-0.004 [m] から 0.004 [m]に移動させると同時にroll軸周り（CC'方向）に0.04 [rad/s] で -0.3 [rad] から0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし（３−４）へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−４）へ移行する。
（３−４）FG間およびNO間
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をx軸方向に0.0028 [m/s] で 0.0 [m] から-0.0028 [m] 、y軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で 0.0 [rad] から0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.0 [rad] から 0.21 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.0028 [m/s] で-0.0028 [m] から 0.0028 [m] 、y軸方向に0.0028 [m/s] で 0.0028 [m] から-0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で 0.21 [rad] から-0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.21 [rad] から -0.21 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0028 [m] から -0.0028 [m] 、y軸方向に0.0028 [m/s] で -0.0028 [m] から0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で -0.21 [rad] から0.0 [rad]、 pitch軸周りに 0.028 [rad/s] で-0.21 [rad] から 0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし（３−１）へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−１）へ移行する。
ここで、ボルトの軸合せ動作の終了条件は、軸合せの評価基準を4回満たすまで軸合せ動作を繰り返し、4回発生した時点と設定する。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をx軸方向に0.0028 [m/s] で 0.0 [m] から-0.0028 [m] 、y軸方向に 0.0028 [m/s] で0.0 [m] から 0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で 0.0 [rad] から0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.0 [rad] から 0.21 [rad]に移動させる。
次に、インピーダンス中心をx軸方向に 0.0028 [m/s] で-0.0028 [m] から 0.0028 [m] 、y軸方向に0.0028 [m/s] で 0.0028 [m] から-0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で 0.21 [rad] から-0.21 [rad]、 pitch軸周りに 0.028 [rad/s] で0.21 [rad] から -0.21 [rad]に移動させる。
最後に、インピーダンス中心をx軸方向に 0.0028 [m/s] で0.0028 [m] から -0.0028 [m] 、y軸方向に0.0028 [m/s] で -0.0028 [m] から0.0028 [m] に移動させると同時に図６のDD'方向となる roll軸周りに0.028 [rad/s] で -0.21 [rad] から0.0 [rad]、 pitch軸周りに 0.028 [rad/s] で-0.21 [rad] から 0.0 [rad]に移動させる。
・終了条件：タスクスキル動作が完了した時点で終了とし（３−１）へ移行する。ただし、0.3 [Nm]以上のモーメントが1.0[s]以上発生（軸合せの評価基準を満た）した時点でも終了とし、この時点でのΣnをΣsと再設定して（３−１）へ移行する。
ここで、ボルトの軸合せ動作の終了条件は、軸合せの評価基準を4回満たすまで軸合せ動作を繰り返し、4回発生した時点と設定する。
（４）ボルト２２への軸合せ動作が失敗した場合の離脱、回転動作では、図５のGH間では約7 [s]間でインピーダンス中心をz軸方向に -0.02 [m]移動させているため、移動速を0.003 [m/s]とする。図５のHI間では約 14 [s]間でインピーダンス中心をz軸周りに 3.14/2 [rad]回転させるため、回転速度を 0.1 [rad/s]とする。したがって、ボルト２２への軸合せ動作が失敗した場合の離脱、回転動作は、タスクスキルのモデルを使って以下のように記述できる。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をz軸方向に0.003 [m/s] で -0.02 [m]まで移動させる。その後、インピーダンス中心をz軸周りに 0.1 [rad/s] で3.14/2 [rad]まで回転させる。
・終了条件：タスクスキル動作が完了した時点で終了とする。
・初期条件：z軸方向に -6.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心をz軸方向に0.003 [m/s] で -0.02 [m]まで移動させる。その後、インピーダンス中心をz軸周りに 0.1 [rad/s] で3.14/2 [rad]まで回転させる。
・終了条件：タスクスキル動作が完了した時点で終了とする。
（５）ボルト２２への組付け動作では、図のOP間では約35[s]間でインピーダンス中心をz軸周りに3.14 [rad]回転させているため、回転速度を 0.1 [rad/s]とする。したがって、ボルト２２への組付け動作は、タスクスキルモデルを使って以下のように記述できる。
・初期条件：z軸方向に-6.0 [N] 発生状態とする。
・作業スキル動作：インピーダンス中心をz軸回りに0.1 [rad/s] で 3.14 [rad]回転させる。
・終了条件：タスクスキル動作が完了した時点で終了とする。
・初期条件：z軸方向に-6.0 [N] 発生状態とする。
・作業スキル動作：インピーダンス中心をz軸回りに0.1 [rad/s] で 3.14 [rad]回転させる。
・終了条件：タスクスキル動作が完了した時点で終了とする。
以上、本発明に関わるタスクスキル動作にインピーダンス制御を利用したタスクスキル生成装置を実施するための最良の形態を実施例に基づいて説明した。既に実施例２で生成したナット組付けタスクスキルを利用して、ナット組付け作業実施した。このナット組付けタスクスキルを実装したロボットは、異なるサイズのナット２１や位置・姿勢誤差を含んだ様々な環境下でナット組付け作業をすべて実現することができ、本発明で生成されるタスクスキルが実際に使用できることが確認された。
これまで試行錯誤的に作成者の勘に頼って作成していたタスクスキルを、本発明では前記のように一連の流れに沿ってタスクスキルを生成することができるため、実施例で示したナット組付けタスクスキルに限らず、さらに多くのタスクスキルを簡単に生成することが可能である。したがって、人が普段の生活の中で発揮している器用な動作の多くをロボットのタスクスキルとして生成可能となるため、各種の産業用ロボットに適用できるだけでなく、今後人の生活の中に入ってくるロボットにも適用できる。
１ タスクスキル生成装置
２ ロボット
３ 力センサ
４ ハンド
５ カメラ
６ ロボット制御装置
７ ハンド制御装置
８ 力センサ情報取得装置
９ カメラ制御装置
１０ コマンド・データ送受信装置
１１ スレーブ装置
１２ 動作入力・提示装置
１３ 力センサ
１４ 動作入力・提示装置用制御装置
１５ 力センサ情報取得装置
１６ 遠隔操作システム制御装置
１７ 力センサ情報提示装置
１８ カメラ映像提示装置
１９ コマンド・データ送受信装置
２０ マスタ装置
２１ ナット
２２ ボルト
２ ロボット
３ 力センサ
４ ハンド
５ カメラ
６ ロボット制御装置
７ ハンド制御装置
８ 力センサ情報取得装置
９ カメラ制御装置
１０ コマンド・データ送受信装置
１１ スレーブ装置
１２ 動作入力・提示装置
１３ 力センサ
１４ 動作入力・提示装置用制御装置
１５ 力センサ情報取得装置
１６ 遠隔操作システム制御装置
１７ 力センサ情報提示装置
１８ カメラ映像提示装置
１９ コマンド・データ送受信装置
２０ マスタ装置
２１ ナット
２２ ボルト
Claims (10)
- ロボットと、
力センサと、
ハンドと、
カメラと、
ロボットを制御する制御装置と、
力センサの情報を取得する装置と、
ハンドを制御する制御装置と、
カメラを制御する制御装置と、
を有するスレーブ装置の動作を生成する基となる操作者動作情報を操作者が入力しかつ前記スレーブ装置の動作情報を操作者に提示する動作入力・提示装置と、
前記スレーブ装置の動作を生成する基となる操作者力情報を操作者が入力する力センサと、
前記スレーブ装置の力センサ情報を操作者に提示する力センサ情報提示装置と、
前記スレーブ装置のカメラ映像を操作者に提示するカメラ映像提示装置と、
前記動作入力・提示装置を制御する制御装置と、
前記力センサの情報を取得する装置と、
操作者が入力する前記力センサ情報と前記スレーブ装置からの動作情報と力センサ情報を受信・処理し、前記動作入力・提示装置への動作指令情報と前記スレーブ装置への動作指令情報を生成する遠隔操作システム制御装置を有するマスタ装置と、
を有するインピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置。 - 前記スレーブ装置のロボットは多関節構造であり、ロボットを駆動するモータの電流を利用して力センサの代わりに利用することができることを特徴とする請求項１記載のインピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置。
- 前記マスタ装置の動作入力・提示装置は多関節構造ロボットであり、操作者に動作情報と力情報を提示でき、本装置を駆動するモータの電流を利用して力センサの代わりに利用することができることを特徴とする請求項１記載のインピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置。
- 前記タスクスキルは、ロボットがある基本動作を実行できるだけでなく、上位言語のレベルから再利用可能なモジュールであり、該タスクスキルのモデルは、初期条件、タスクスキル動作、終了条件からなる一連の状態遷移を実現するものであることを特徴とする請求項１記載のインピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置。
- 前記タスクスキル動作は、インピーダンスと力のハイブリッド制御を利用することを特徴とする請求項４記載のインピーダンスと力のハイブリッド制御を利用したタスクスキル生成装置。
- ロボットと、
力センサと、
ハンドと、
カメラと、
ロボットを制御する制御装置と、
力センサの情報を取得する装置と、
ハンドを制御する制御装置と、
カメラを制御する制御装置と、
を有するスレーブ装置の動作を生成する基となる操作者動作情報を操作者が入力しかつ前記スレーブ装置の動作情報を操作者に提示する動作入力・提示装置と、
前記スレーブ装置の動作を生成する基となる操作者力情報を操作者が入力する力センサと、
前記スレーブ装置の力センサ情報を操作者に提示する力センサ情報提示装置と、
前記スレーブ装置のカメラ映像を操作者に提示するカメラ映像提示装置と、
前記動作入力・提示装置を制御する制御装置と、
前記力センサの情報を取得する装置と、
操作者が入力する前記力センサ情報と前記スレーブ装置からの動作情報と力センサ情報を受信・処理し、前記動作入力・提示装置への動作指令情報と前記スレーブ装置への動作指令情報を生成する遠隔操作システム制御装置を有するマスタ装置と、
を有するインピーダンス制御を利用したタスクスキル生成装置。 - 請求項６記載のスレーブ装置のロボットは多関節構造であり、ロボットを駆動するモータの電流を利用して力センサの代わりに利用することができることを特徴とする請求項６記載のインピーダンス制御を利用したタスクスキル生成装置。
- 請求項６記載のマスタ装置の動作入力・提示装置は多関節構造ロボットであり、操作者に動作情報と力情報を提示でき、本装置を駆動するモータの電流を利用して力センサの代わりに利用することができることを特徴とする請求項６記載のインピーダンス制御を利用したタスクスキル生成装置。
- 請求項６記載のタスクスキルは、ロボットがある基本動作を実行できるだけでなく、上位言語のレベルから再利用可能なモジュールであり、該タスクスキルのモデルは、初期条件、タスクスキル動作、終了条件からなる一連の状態遷移を実現するものであることを特徴とする請求項６記載のインピーダンス制御を利用したタスクスキル生成装置。
- 請求項６記載のタスクスキル動作は、インピーダンス制御を利用することを特徴とする請求項９記載のインピーダンス制御を利用したタスクスキル生成装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005028658A JP4534015B2 (ja) | 2005-02-04 | 2005-02-04 | マスタ・スレーブ式ロボット制御情報確定方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005028658A JP4534015B2 (ja) | 2005-02-04 | 2005-02-04 | マスタ・スレーブ式ロボット制御情報確定方法 |
Related Child Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2010099579A Division JP5004108B2 (ja) | 2010-04-23 | 2010-04-23 | ロボット及びハンドの制御情報を確定するためのマスタ・スレーブ装置及び制御情報確定方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2006212741A true JP2006212741A (ja) | 2006-08-17 |
| JP4534015B2 JP4534015B2 (ja) | 2010-09-01 |
Family
ID=36976368
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2005028658A Expired - Fee Related JP4534015B2 (ja) | 2005-02-04 | 2005-02-04 | マスタ・スレーブ式ロボット制御情報確定方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4534015B2 (ja) |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008030167A (ja) * | 2006-07-31 | 2008-02-14 | Nagaoka Univ Of Technology | モーション習得システムおよびその制御方法 |
| JP2009509787A (ja) * | 2005-09-29 | 2009-03-12 | 本田技研工業株式会社 | 人型ロボットのための拡張可能なタスクエンジンフレームワーク |
| WO2011021376A1 (ja) * | 2009-08-21 | 2011-02-24 | パナソニック株式会社 | ロボットアームの制御装置及び制御方法、家事ロボット、ロボットアームの制御プログラム、及び、ロボットアーム制御用集積電子回路 |
| WO2011021375A1 (ja) * | 2009-08-21 | 2011-02-24 | パナソニック株式会社 | ロボットアームの制御装置及び制御方法、組立ロボット、ロボットアームの制御プログラム、及び、ロボットアームの制御用集積電子回路 |
| JP2011067943A (ja) * | 2009-09-22 | 2011-04-07 | Gm Global Technology Operations Inc | インターアクティブロボット制御システム及び使用方法 |
| WO2012029227A1 (ja) * | 2010-08-31 | 2012-03-08 | パナソニック株式会社 | マスタースレーブロボットの制御装置及び制御方法、マスタースレーブロボット、制御プログラム、並びに、集積電子回路 |
| US9545717B2 (en) | 2012-01-04 | 2017-01-17 | Samsung Electronics Co., Ltd. | Robot hand and humanoid robot having the same |
| JP2020522394A (ja) * | 2017-05-29 | 2020-07-30 | フランカ エミカ ゲーエムベーハーＦＲＡＮＫＡ ＥＭＩＫＡ ＧｍｂＨ | 多関節ロボットのアクチュエータを制御するシステムおよび方法 |
| WO2022074825A1 (ja) * | 2020-10-09 | 2022-04-14 | 日本電気株式会社 | 動作指令生成装置、動作指令生成方法及び記憶媒体 |
| WO2022209924A1 (ja) * | 2021-03-31 | 2022-10-06 | 本田技研工業株式会社 | ロボット遠隔操作制御装置、ロボット遠隔操作制御システム、ロボット遠隔操作制御方法、およびプログラム |
Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS57152008A (en) * | 1981-03-13 | 1982-09-20 | Agency Of Ind Science & Technol | Playback controlling method by program of artificial arm |
| JPS62199376A (ja) * | 1986-02-26 | 1987-09-03 | 株式会社日立製作所 | 遠隔マニピユレ−シヨン方法及び装置 |
| JPH03251376A (ja) * | 1990-02-28 | 1991-11-08 | Fujitsu Ltd | 制御装置 |
| JPH04189495A (ja) * | 1990-11-22 | 1992-07-07 | Matsushita Electric Ind Co Ltd | 位置決め方法及びその装置 |
| JPH08106320A (ja) * | 1994-10-07 | 1996-04-23 | Hitachi Ltd | 自動機械及び自動機械の制御方法 |
| JPH08174378A (ja) * | 1994-12-27 | 1996-07-09 | Nippon Telegr & Teleph Corp <Ntt> | ロボット制御装置 |
| JPH08194521A (ja) * | 1995-01-19 | 1996-07-30 | Fanuc Ltd | 力制御ロボットを用いて嵌合データを取得する方法 |
| JP2002023826A (ja) * | 2000-07-03 | 2002-01-25 | Fukuoka Prefecture | ロボット軌跡の教示方法 |
| JP2002085353A (ja) * | 2000-09-11 | 2002-03-26 | Mamoru Mitsuishi | 遠隔診断システム |
| JP2005028532A (ja) * | 2003-07-08 | 2005-02-03 | Fanuc Ltd | 嵌合装置 |
-
2005
- 2005-02-04 JP JP2005028658A patent/JP4534015B2/ja not_active Expired - Fee Related
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS57152008A (en) * | 1981-03-13 | 1982-09-20 | Agency Of Ind Science & Technol | Playback controlling method by program of artificial arm |
| JPS62199376A (ja) * | 1986-02-26 | 1987-09-03 | 株式会社日立製作所 | 遠隔マニピユレ−シヨン方法及び装置 |
| JPH03251376A (ja) * | 1990-02-28 | 1991-11-08 | Fujitsu Ltd | 制御装置 |
| JPH04189495A (ja) * | 1990-11-22 | 1992-07-07 | Matsushita Electric Ind Co Ltd | 位置決め方法及びその装置 |
| JPH08106320A (ja) * | 1994-10-07 | 1996-04-23 | Hitachi Ltd | 自動機械及び自動機械の制御方法 |
| JPH08174378A (ja) * | 1994-12-27 | 1996-07-09 | Nippon Telegr & Teleph Corp <Ntt> | ロボット制御装置 |
| JPH08194521A (ja) * | 1995-01-19 | 1996-07-30 | Fanuc Ltd | 力制御ロボットを用いて嵌合データを取得する方法 |
| JP2002023826A (ja) * | 2000-07-03 | 2002-01-25 | Fukuoka Prefecture | ロボット軌跡の教示方法 |
| JP2002085353A (ja) * | 2000-09-11 | 2002-03-26 | Mamoru Mitsuishi | 遠隔診断システム |
| JP2005028532A (ja) * | 2003-07-08 | 2005-02-03 | Fanuc Ltd | 嵌合装置 |
Cited By (22)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009509787A (ja) * | 2005-09-29 | 2009-03-12 | 本田技研工業株式会社 | 人型ロボットのための拡張可能なタスクエンジンフレームワーク |
| JP4701400B2 (ja) * | 2006-07-31 | 2011-06-15 | 国立大学法人長岡技術科学大学 | モーション習得システムおよびその制御方法 |
| JP2008030167A (ja) * | 2006-07-31 | 2008-02-14 | Nagaoka Univ Of Technology | モーション習得システムおよびその制御方法 |
| US9211646B2 (en) | 2009-08-21 | 2015-12-15 | Panasonic Intellectual Property Management Co., Ltd. | Control apparatus and control method for robot arm, assembly robot, control program for robot arm, and control-purpose integrated electronic circuit for robot arm |
| JPWO2011021375A1 (ja) * | 2009-08-21 | 2013-01-17 | パナソニック株式会社 | ロボットアーム制御用の装置、方法、プログラム及び集積電子回路、並びに、組立ロボット |
| WO2011021375A1 (ja) * | 2009-08-21 | 2011-02-24 | パナソニック株式会社 | ロボットアームの制御装置及び制御方法、組立ロボット、ロボットアームの制御プログラム、及び、ロボットアームの制御用集積電子回路 |
| JP4759660B2 (ja) * | 2009-08-21 | 2011-08-31 | パナソニック株式会社 | ロボットアーム制御用の装置、方法、プログラム及び集積電子回路、並びに、組立ロボット |
| CN102292194A (zh) * | 2009-08-21 | 2011-12-21 | 松下电器产业株式会社 | 机器人手臂的控制装置及控制方法、装配机器人、机器人手臂的控制程序及机器人手臂的控制用集成电路 |
| WO2011021376A1 (ja) * | 2009-08-21 | 2011-02-24 | パナソニック株式会社 | ロボットアームの制御装置及び制御方法、家事ロボット、ロボットアームの制御プログラム、及び、ロボットアーム制御用集積電子回路 |
| JP2011067943A (ja) * | 2009-09-22 | 2011-04-07 | Gm Global Technology Operations Inc | インターアクティブロボット制御システム及び使用方法 |
| US8504206B2 (en) | 2010-08-31 | 2013-08-06 | Panasonic Corporation | Control apparatus and method for master-slave robot, master-slave robot, control program, and integrated electronic circuit |
| JP5032716B2 (ja) * | 2010-08-31 | 2012-09-26 | パナソニック株式会社 | マスタースレーブロボットの制御装置及び制御方法、並びに、制御プログラム |
| CN102686366A (zh) * | 2010-08-31 | 2012-09-19 | 松下电器产业株式会社 | 主从机器人的控制装置及控制方法、主从机器人、控制程序、以及集成电子电路 |
| JPWO2012029227A1 (ja) * | 2010-08-31 | 2013-10-28 | パナソニック株式会社 | マスタースレーブロボットの制御装置及び制御方法、並びに、制御プログラム |
| US9089967B2 (en) | 2010-08-31 | 2015-07-28 | Panasonic Intellectual Property Management Co., Ltd. | Control apparatus and method for master-slave robot, master-slave robot, control program, and integrated electronic circuit |
| WO2012029227A1 (ja) * | 2010-08-31 | 2012-03-08 | パナソニック株式会社 | マスタースレーブロボットの制御装置及び制御方法、マスタースレーブロボット、制御プログラム、並びに、集積電子回路 |
| US9545717B2 (en) | 2012-01-04 | 2017-01-17 | Samsung Electronics Co., Ltd. | Robot hand and humanoid robot having the same |
| JP2020522394A (ja) * | 2017-05-29 | 2020-07-30 | フランカ エミカ ゲーエムベーハーＦＲＡＮＫＡ ＥＭＩＫＡ ＧｍｂＨ | 多関節ロボットのアクチュエータを制御するシステムおよび方法 |
| JP7244087B2 (ja) | 2017-05-29 | 2023-03-22 | フランカ エーミカ ゲーエムベーハー | 多関節ロボットのアクチュエータを制御するシステムおよび方法 |
| WO2022074825A1 (ja) * | 2020-10-09 | 2022-04-14 | 日本電気株式会社 | 動作指令生成装置、動作指令生成方法及び記憶媒体 |
| JP7435815B2 (ja) | 2020-10-09 | 2024-02-21 | 日本電気株式会社 | 動作指令生成装置、動作指令生成方法及びプログラム |
| WO2022209924A1 (ja) * | 2021-03-31 | 2022-10-06 | 本田技研工業株式会社 | ロボット遠隔操作制御装置、ロボット遠隔操作制御システム、ロボット遠隔操作制御方法、およびプログラム |
Also Published As
| Publication number | Publication date |
|---|---|
| JP4534015B2 (ja) | 2010-09-01 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4534015B2 (ja) | マスタ・スレーブ式ロボット制御情報確定方法 | |
| US11474510B2 (en) | Programming a robot by demonstration | |
| CN110573308B (zh) | 用于机器人设备的空间编程的基于计算机的方法及*** | |
| CN106945043B (zh) | 一种主从式遥操作手术机器人多臂协同控制*** | |
| JP6924145B2 (ja) | ロボット教示方法及びロボットアーム制御装置 | |
| Kofman et al. | Teleoperation of a robot manipulator using a vision-based human-robot interface | |
| JP6450960B2 (ja) | ロボット、ロボットシステム及び教示方法 | |
| Li et al. | Vision-based robotic manipulation of flexible PCBs | |
| Li et al. | Survey on mapping human hand motion to robotic hands for teleoperation | |
| JP2006334774A (ja) | エフェクタの軌道を制御するための方法 | |
| Rambow et al. | Autonomous manipulation of deformable objects based on teleoperated demonstrations | |
| TWI651175B (zh) | 機械手臂之控制裝置及其教導系統與方法 | |
| JP5004108B2 (ja) | ロボット及びハンドの制御情報を確定するためのマスタ・スレーブ装置及び制御情報確定方法 | |
| Peers et al. | Development of a Teleoperative Quadrupedal Manipulator | |
| Pettinger et al. | Reducing the teleoperator’s cognitive burden for complex contact tasks using affordance primitives | |
| JP7263920B2 (ja) | 演算装置、制御プログラム、機械学習器及び把持装置 | |
| JP4441615B2 (ja) | 電源用３ピンプラグの挿入を行うためのロボットアーム制御装置 | |
| JP2016221653A (ja) | ロボット制御装置およびロボットシステム | |
| Capolei et al. | Positioning the laparoscopic camera with industrial robot arm | |
| JP2015085499A (ja) | ロボット、ロボットシステム、制御装置及び制御方法 | |
| JP4715296B2 (ja) | ロボットハンドの持ち替え把持制御方法。 | |
| CN112805127A (zh) | 用于创建机器人控制程序的方法和设备 | |
| CN116252298A (zh) | 基于力反馈技术的机器人遥操作方法及*** | |
| Sanches et al. | Scalable. Intuitive Human to Robot Skill Transfer with Wearable Human Machine Interfaces: On Complex, Dexterous Tasks | |
| TWM509713U (zh) | 具軌跡教導之多關節機械手臂控制系統 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070213 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20081024 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081028 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20081225 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090602 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090803 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100223 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100423 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20100518 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20100518 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130625 Year of fee payment: 3 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 4534015 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130625 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130625 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130625 Year of fee payment: 3 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |