JP4415109B2 - レバーハンドルバルブ操作用ロボットハンド制御装置 - Google Patents

Description

本発明は、器用な作業のひとつであるレバーハンドルの開放・閉鎖操作を実現するのに必要な、一連の動作を実現するための機能（以下「タスクスキル」という。）を実装したレバーハンドルバルブ操作用ロボットハンド制御装置に関するものである。

プラントなどでは、配管内を流れる液体や気体の制御に多くのレバーハンドルバルブを利用しており、レバーハンドルバルブ操作は、人の手により実行されている。

しかし、プラントにおけるコスト削減を実現するには、バルブ操作員を削減する必要がある。また、原子力プラント、宇宙空間、深海などの極限環境下では、人が直接レバーハンドルバルブを操作するには放射線の影響など危険性が極めて高い。

この改善策として、バルブに駆動機構を付加する方法や、遠隔地からバルブを開閉する装置が開発されているが、既に使用されているバルブに適用するには、追加部品の設置などが必要となる（特許文献１、２参照）。さらに、ロボットなどによるレバーハンドルバルブ操作の実現も考えられているが、ロボットのハンドとレバーハンドルの位置・姿勢誤差問題を解決することができていない。
特開平３−１９３６５号公報 特開２０００−５５２３５号公報

そこで、本発明は、既に幅広く使用されているレバーハンドルバルブを、人の代わりに操作できる特性を有し、レバーハンドルバルブを操作するハンドとレバーハンドル間に位置・姿勢誤差があってもレバーハンドルバルブ操作を可能とするため、レバーハンドルバルブ操作に必要な一連の動作を分類し、各動作毎にロボットハンドの各軸についてインピーダンス制御、力制御を最適に割り当てることにより、レバーハンドルバルブ操作用ロボットハンド制御装置を実現することを課題とする。

本発明は前記課題を解決するために、以下の手段を採用する。

本発明のレバーハンドルバルブ操作用ロボットハンド制御装置は、ロボットと、力センサと、ハンドと、カメラと、ロボットを制御する制御装置と、力センサ情報を取得する装置と、ハンドを制御する制御装置と、カメラを制御する制御装置とを有し、前記カメラの映像情報に基づいて前記ロボットハンドと前記レバーハンドルバルブの軸方向をある程度一致させた上で、以後行う前記レバーハンドルバルブの操作を、
（ａ）接近・接触動作
（ｂ）押し付け動作
（ｃ）力解除動作
（ｄ）ハンド閉動作
（ｅ）力解除動作
（ｆ）レバーハンドルバルブの開放・閉鎖動作
（ｇ）力解除動作
（ｈ）ハンド開動作
（ｉ）離脱動作
に分類し、これらの動作（ａ）ないし（ｉ）のそれぞれを実現するために、ロボットハンド各軸の制御に、次のようにインピーダンス制御、力制御を割り当てた。
（ａ）接近・接触動作
接近方向と逆向きに所定の力が生じるまで、ロボットハンドの全軸についてインピーダンス制御
（ｂ）押し付け動作
動作（ａ）における所定の力を維持した上で、所定時間経過するまで、接近方向の軸について力制御、その他の軸についてインピーダンス制御
（ｃ）力解除動作
作用する力が０となりこれが所定時間継続するまで、全軸について力制御
（ｄ）ハンド閉動作
ハンドが閉じこれが所定時間継続するまで、全軸についてインピーダンス制御
（ｅ）力解除動作
作用する力が０となりこれが所定時間継続するまで、全軸について力制御
（ｆ）レバーハンドルバルブの開放・閉鎖動作
ｙａｗ軸周りに所定角度回転させ、ｙａｗ軸周りのモーメントが絶対値で所定の大きさになり、これが所定時間継続するまで、接近方向及びこれに直交する平面内の軸について力制御、その他の軸についてインピーダンス制御
（ｇ）力解除動作
作用する力が０となりこれが所定時間継続するまで、全軸について力制御
（ｈ）ハンド開動作
所定時間経過するまで全軸についてインピーダンス制御
（ｉ）離脱動作（ｃ）
接近方向と逆向きに所定距離移動するまで、全軸についてインピーダンス制御

上記のレバーハンドルバルブ操作用ロボットハンド制御装置において、ロボットを駆動するモータの電流を利用して力センサの代わりに利用することができるようにした。

本発明に係るレバーハンドルバルブ操作用ロボットハンド制御装置によれば、操作対象であるレバーハンドルの位置を位置誤差無しに正確に計測する必要が無くなり、既に使用されているレバーハンドルバルブの操作を人に代わって実行することができるため、コスト削減に貢献するだけでなく、原子力プラントなど非常に危険な環境でもレバーハンドルバルブ操作を実現できるという利点がある。

本発明に係るレバーハンドルバルブ操作用ロボットハンド制御装置を実施するための最良の形態を以下に説明する。本発明は前記課題を解決するために、前記タスクスキルを利用する。前記タスクスキルは、ロボットがある基本動作を実行できるだけでなく、上位言語のレベルから再利用可能なモジュールである。

該タスクスキルのモデルは、初期条件、タスクスキル動作、終了条件からなる一連の状態遷移を実現するものであることを特徴とする。本発明では、レバーハンドルバルブ操作タスクスキルにおけるタスクスキル動作に、インピーダンスと力のハイブリッド制御、またはインピーダンス制御が実装（適用）される点を特徴とする。

即ち、本発明におけるレバーハンドルバルブ操作用ロボットハンド制御装置では、タスクスキル動作を、インピーダンスと力のハイブリッド制御、またはインピーダンス制御に基づいて行うプログラムが実装されたタスクスキル実装装置（具体的にはタスクスキルを実行するプログラムが実装されたコンピュータ）を備えている。

タスクスキル動作にインピーダンスと力のハイブリッド制御を実装（適用）することにより、自由空間での軌道追従性を確保し、対象物や環境との位置誤差に対しても過大な力が発生することを防止できる点が主な特徴である。そして、位置と姿勢のそれぞれ軸に対し操作者の意図に合わせてインピーダンス制御と力制御を適用できる点も特徴である。

さらに、タスクスキル動作にインピーダンスと力のハイブリッド制御を実装する場合、ひとつの軸においてインピーダンス制御から力制御、あるいは力制御からインピーダンス制御に切り替えるとき、制御の安定化問題が生じるが、タスクスキル動作にインピーダンス制御を実装すると、このような制御の切り替え問題がなくなることも本発明の特徴である。

ここで、本発明に係るレバーハンドルバルブ操作用ロボットハンド制御装置を実施するための最良の形態を、タスクスキル動作にインピーダンスと力のハイブリッド制御を利用した実施例１及びタスクスキル動作にインピーダンス制御を利用した実施例２に基づいて、図面を参照して、以下説明する。

なお、図４は実施例１を説明する図であり、図５は実施例２を説明する図であるが、図１〜３は、実施例１及び実施例２に共通な図である。

図１は、本発明に関わるタスクスキル動作にインピーダンスと力のハイブリッド制御を利用したタスクスキルによるレバーハンドルバルブ操作装置１の全体構成図である。タスクスキル実行装置１０は、ロボット２（本実施例１ではロボットアーム）、力センサ３、ハンド４、カメラ５、ロボット制御装置６、ハンド制御装置７、力センサ情報取得装置８、カメラ制御装置９を有する。

ロボット２は、多関節方式であり、ロボット制御装置６により位置制御で動作する。さらに、ロボット２を駆動するモータの電流を利用して力センサ３の代わりに利用することもできる。ハンド４の手先位置は、ロボット２の関節に設置されている関節角度計測装置（例、ポテンショメータ）により計算できることは周知技術である。

ハンド４は、多指ハンドであり、ハンド制御装置７により指先が位置制御で動作する。

タスクスキル実行装置１０は、ロボット制御装置６に送信するロボット２の目標手先位置指令値とハンド制御装置７に送信するハンド４の目標指位置指令値をタスクスキル実装装置１１から受信し、ロボット制御装置６で計算されるロボット２の現在手先位置情報と力センサ情報取得装置８で取得する力センサ３の情報とハンド制御装置７で計算されるハンド４の現在指位置情報とカメラ制御装置９で取得するカメラ５の映像をタスクスキル実装装置１１へ送信する。

タスクスキル実装装置１１は、レバーハンドルバルブ操作タスクスキルが実装される。タスクスキルは、初期条件、タスクスキル動作、終了条件からなる一連の状態遷移を実現し、初期条件および終了条件はロボット２の位置、力センサ３の値、ハンド４の位置、カメラ５の映像情報で記述され、タスクスキル動作はインピーダンスと力のハイブリッド制御で記述される。

図２は、ハンド４によるレバーハンドルバルブ１２の開放、閉鎖作業の概要図である。レバーハンドルバルブ１２は環境に固定される。Σhはハンド４に固定されたハンド座標系であり、点０が原点である。Σlはレバーハンドルバルブ１２に固定されたレバーハンドルバルブ座標系であり、点Lが原点である。ロボット２の手先座標系は、ハンド４のハンド座標系Σhと一致する。

ハンド４を動かすタスクスキル動作は、タスクスキル動作座標系Σsで記述され、制御点はハンド４の点Oとするため、ハンド４に力、モーメントが作用しない場合には、ハンド４の点Oがハンド４のインピーダンス中心となる。Σsは、Σhを基準として決定され、原点も点Oと一致する。

ここで、ハンド４が移動すると同時にΣhも移動するため、ある時点でのΣhをΣsと設定し、Σhが引き続き移動したとしてもΣsは設定された時点の位置に固定される。また、一度ΣsがΣhにより設定され、Σsを基準にしてΣhが移動したとしても、移動後のΣhを利用してΣsを新規に再設定できる。

タスクスキル動作に実装されるインピーダンスと力のハイブリッド制御では、個々の制御軸（x、y、z軸、roll、pitch、yaw軸）に対してインピーダンス制御と力制御のどちらかの制御を設定する必要がある。

レバーハンドルバルブ操作タスクスキルの動作手順と個々の軸に対する制御方法は、
（１）レバーハンドルバルブ１２への接近・接触動作（全軸インピーダンス制御）
（２）レバーハンドルバルブ１２への押付け動作（z軸力制御、その他の軸インピーダンス制御）
（３）レバーハンドルバルブ１２からの力解除動作（全軸力制御）
（４）ハンド４の閉動作（全軸インピーダンス制御）
（５）レバーハンドルバルブ１２からの力解除動作（全軸力制御）
（６）レバーハンドルバルブ１２の開放・閉鎖動作（x、y、z軸力制御、その他の軸インピーダンス制御）
（７）レバーハンドルバルブ１２からの力解除動作（全軸力制御）
（８）ハンド４の開動作（全軸インピーダンス制御）
（９）レバーハンドルバルブ１２からの離脱動作（全軸インピーダンス制御）
と記述する。図３にレバーハンドルバルブ操作スクスキルの動作手順のブロック図を示す。

（１）レバーハンドルバルブ１２への接近・接触動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：カメラ５によりΣhのz軸とΣlのz軸をある程度一致させ、動作開始時ΣhをΣsとして設定する。
・タスクスキル動作：全軸インピーダンス制御とする。インピーダンス中心をz軸方向に
0.009 [m/s] で0.1 [m] 移動させる。
・終了条件：z軸方向に-4.0[N] 発生した時点で終了する。この時点でのΣhをΣsとして再設定する。

（２）レバーハンドルバルブ１２への押付け動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：z軸方向に-4.0 [N] 発生状態とする。
・タスクスキル動作：z軸力制御、その他の軸インピーダンス制御とする。z軸方向に-4.0 [N] で押付ける。
・終了条件：3.0 [s] 間押付けた時点で終了する。

（３）レバーハンドルバルブ１２からの力解除動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：全軸力制御とする。全軸0.5 [s] 間に 0.0 [N]、0.0[Nm]にする。
・終了条件：0.5 [s] 間経過した時点で終了する。この時点でのΣhをΣsとして再設定する。

（４）ハンド４の閉動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：全軸インピーダンス制御とする。インピーダンス中心は固定したまま、ハンド４を閉じる。
・終了条件：2.0 [s] 間経過した時点で終了する。

（５）レバーハンドルバルブ１２からの力解除動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：全軸力制御とする。全軸1.7 [s] 間に 0.0 [N]、0.0[Nm]にする。
・終了条件：1.7 [s] 間経過した時点で終了する。この時点でのΣhをΣsとして再設定する。

（６）レバーハンドルバルブ１２の開放・閉鎖動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：x、y、z軸力制御、その他の軸インピーダンス制御とする。バルブ開放の場合、インピーダンス中心をyaw軸周りに0.14 [rad/s] で-3.14 [rad] 回転させる。バルブ閉鎖の場合、インピーダンス中心をyaw軸周りに0.14 [rad/s] で 3.14 [rad] 回転させる。x、y、z軸に対しては、目標力を0.0 [N]とする。
・終了条件：バルブV10Aに対しては、yaw軸周りのモーメントが絶対値で0.5 [Nm] 以上発生したまま1.0 [s] 間経過した状態を、バルブの開放・閉鎖完了評価条件とし、バルブの開放・閉鎖完了評価条件を満たした時点で終了する。
なお、バルブV25Aに対するバルブの開放・閉鎖完了評価条件は、yaw軸周りのモーメントが絶対値で1.5 [Nm] 以上発生したまま1.0 [s] 間経過した状態とし、バルブV40AおよびV50Aに対するバルブの開放・閉鎖完了評価条件は、yaw軸周りのモーメントが絶対値で2.0 [Nm] 以上発生したまま1.0 [s] 間経過した状態とする。

（７）レバーハンドルバルブ１２からの力解除動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：全軸力制御とする。全軸1.3 [s] 間に 0.0 [N]、0.0 [Nm]にする。
・終了条件：1.3 [s] 間経過した時点で終了する。この時点でのΣhをΣsとして再設定する。

（８）ハンド４の開動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：全軸インピーダンス制御とする。インピーダンス中心は固定したまま、ハンド４を開放する。
・終了条件：2.0 [s] 間経過した時点で終了する。

（９）レバーハンドルバルブ１２からの離脱動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：全軸インピーダンス制御とする。インピーダンス中心をz軸方向に0.017 [m/s] で -0.05 [m] 移動させる。
・終了条件：インピーダンス中心がz軸方向に-0.05 [m] 移動した時点で終了する。

図４にレバーハンドルバルブ操作タスクスキルを実装したレバーハンドルバルブ操作装置によるレバーハンドルバルブ開放操作の実行結果を示す。使用したレバーハンドルバルブはV25Aである。図４（a）はハンド４の点Oに作用する力、図４（b）はハンド４の点Oに作用するモーメント、図４（c）はハンド４の点Oの位置、図４（d）はハンド４の点Oの姿勢、図４（e）はインピーダンス中心の位置、図４（f）はインピーダンス中心の姿勢である。

動作手順は図３の（１）〜（９）となっている。位置誤差は、並進で10.0 [mm]、姿勢で10 [deg] 設定した。位置誤差がある状況でレバーハンドルバルブ開放操作は問題なく実行されている。また、V10A、V40A、V50Aにおいても、問題なくレバーハンドルバルブ開放・閉鎖操作が実行できた。

図１は、本発明に関わるタスクスキル動作にインピーダンス制御を利用したタスクスキルによるレバーハンドルバルブ操作装置１の全体構成図である。タスクスキル実行装置１０は、ロボット２（本実施例２ではロボットアーム）、力センサ３、ハンド４、カメラ５、ロボット制御装置６、ハンド制御装置７、力センサ情報取得装置８、カメラ制御装置９を有する。

ロボット２は、多関節方式であり、ロボット制御装置６により位置制御で動作する。さらに、ロボット２を駆動するモータの電流を利用して力センサ３の代わりに利用することもできる。ハンド４の手先位置は、ロボット２の関節に設置されている関節角度計測装置（例、ポテンショメータ）により計算できることは周知技術である。

ハンド４は、多指ハンドであり、ハンド制御装置７により指先が位置制御で動作する。

タスクスキル実行装置１０は、ロボット制御装置６に送信するロボット２の目標手先位置指令値とハンド制御装置７に送信するハンド４の目標指位置指令値をタスクスキル実装装置１１から受信し、ロボット制御装置６で計算されるロボット２の現在手先位置情報と力センサ情報取得装置８で取得する力センサ３の情報とハンド制御装置７で計算されるハンド４の現在指位置情報とカメラ制御装置９で取得するカメラ５の映像をタスクスキル実装装置１１へ送信する。

タスクスキル実装装置１１は、レバーハンドルバルブ操作タスクスキルが実装される。タスクスキルは、初期条件、タスクスキル動作、終了条件からなる一連の状態遷移を実現し、初期条件および終了条件はロボット２の位置、力センサ３の値、ハンド４の位置、カメラ５の映像情報で記述され、タスクスキル動作はインピーダンス制御で記述される。

図２は、ハンド４によるレバーハンドルバルブ１２の開放、閉鎖作業の概要図である。レバーハンドルバルブ１２は環境に固定される。Σhはハンド４に固定されたハンド座標系であり、点０が原点である。Σlはレバーハンドルバルブ１２に固定されたレバーハンドルバルブ座標系であり、点Lが原点である。ロボット２の手先座標系は、ハンド４のハンド座標系Σhと一致する。

ハンド４を動かすタスクスキル動作は、タスクスキル動作座標系Σsで記述され、制御点はハンド４の点Oとするため、ハンド４に力、モーメントが作用しない場合には、ハンド４の点Oがハンド４のインピーダンス中心となる。Σsは、Σhを基準として決定され、原点も点Oと一致する。

ここで、ハンド４が移動すると同時にΣhも移動するため、ある時点でのΣhをΣsと設定し、Σhが引き続き移動したとしてもΣsは設定された時点の位置に固定される。また、一度ΣsがΣhにより設定され、Σsを基準にしてΣhが移動したとしても、移動後のΣhを利用してΣsを新規に再設定できる。

レバーハンドルバルブ操作タスクスキルの動作手順と個々の軸に対する制御方法は、
（１）レバーハンドルバルブ１２への接近・接触動作
（２）レバーハンドルバルブ１２への押付け動作
（３）レバーハンドルバルブ１２からの力解除動作
（４）ハンド４の閉動作
（５）レバーハンドルバルブ１２からの力解除動作
（６）レバーハンドルバルブ１２の開放・閉鎖動作
（７）レバーハンドルバルブ１２からの力解除動作
（８）ハンド４の開動作
（９）バーハンドルバルブ１２からの離脱動作
と記述する。図３にレバーハンドルバルブ操作スクスキルの動作手順のブロック図を示す。

（１）レバーハンドルバルブ１２への接近・接触動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：カメラ５によりΣhのz軸とΣlのz軸をある程度一致させ、動作開始時ΣhをΣsとして設定する。
・タスクスキル動作：インピーダンス中心をz軸方向に0.009 [m/s] で0.1 [m] 移動させる。
・終了条件：z軸方向に-4.0 [N] 発生した時点で終了する。

（２）レバーハンドルバルブ１２への押付け動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：z軸方向に-4.0 [N] 発生状態とする。
・タスクスキル動作：インピーダンス中心を固定する。
・終了条件：3.0 [s] 間経過した時点で終了する。

（３）レバーハンドルバルブ１２からの力解除動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：全軸0.5 [s] 間に0.0 [N]、0.0 [Nm]になるようにインピーダンス中心を移動する。
・終了条件：0.5 [s] 間経過した時点で終了する。この時点でのΣhをΣsとして再設定する。

（４）ハンド４の閉動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：インピーダンス中心は固定したまま、ハンド４を閉じる。
・終了条件：2.0 [s] 間経過した時点で終了する。

（５）レバーハンドルバルブ１２からの力解除動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：全軸1.7 [s] 間に0.0 [N]、0.0 [Nm]になるようにインピーダンス中心を移動する。
・終了条件：1.7 [s] 間経過した時点で終了する。この時点でのΣhをΣsとして再設定する。

（６）レバーハンドルバルブ１２の開放・閉鎖動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：バルブ開放の場合、インピーダンス中心をyaw軸周りに0.14 [rad/s] で -3.14 [rad] 回転させる。バルブ閉鎖の場合、インピーダンス中心をyaw軸周りに0.14 [rad/s] で 3.14 [rad] 回転させる。x、y、z軸に対しては、発生力が0.0 [N]となるようにインピーダンス中心を移動する。
・終了条件：バルブV10Aに対しては、yaw軸周りのモーメントが絶対値で0.5 [Nm] 以上発生したまま1.0 [s] 間経過した状態を、バルブの開放・閉鎖完了評価条件とし、バルブの開放・閉鎖完了評価条件を満たした時点で終了する。
なお、バルブV25Aに対するバルブの開放・閉鎖完了評価条件は、yaw軸周りのモーメントが絶対値で1.5 [Nm] 以上発生したまま1.0[s] 間経過した状態とし、バルブV40AおよびV50Aに対するバルブの開放・閉鎖完了評価条件は、yaw軸周りのモーメントが絶対値で2.0 [Nm] 以上発生したまま1.0 [s] 間経過した状態とする。

（７）レバーハンドルバルブ１２からの力解除動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：全軸1.3 [s] 間に0.0 [N]、0.0 [Nm]となるようにインピーダンス中心を移動する。
・終了条件：1.3 [s] 間経過した時点で終了する。この時点でのΣhをΣsとして再設定する。

（８）ハンド４の開動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：インピーダンス中心は固定したまま、ハンド４を開放する。
・終了条件：2.0 [s] 間経過した時点で終了する。

（９）レバーハンドルバルブ１２からの離脱動作は、タスクスキルのモデルを使って以下のように記述する。
・初期条件：初期条件無し。
・タスクスキル動作：インピーダンス中心をz軸方向に0.017 [m/s] で -0.05 [m] 移動させる。
・終了条件：インピーダンス中心がz軸方向に-0.05 [m] 移動した時点で終了する。

図５にレバーハンドルバルブ操作タスクスキルを実装したレバーハンドルバルブ操作装置によるレバーハンドルバルブ開放操作の実行結果を示す。使用したレバーハンドルバルブはV10Aである。図５（a）はハンド４の点Oに作用する力、図５（b）はハンド４の点Oに作用するモーメント、図５（c）はハンド４の点Oの位置、図５（d）はハンド４の点Oの姿勢、図５（e）はインピーダンス中心の位置、図５（f）はインピーダンス中心の姿勢である。

動作手順は図３の（１）〜（９）となっている。位置誤差は、並進で10.0 [mm]、姿勢で10 [deg] 設定した。位置誤差がある状況でレバーハンドルバルブ開放操作は問題なく実行されている。また、V25A、V40A、V50Aにおいても、問題なくレバーハンドルバルブ開放・閉鎖操作が実行できた。

以上、本発明に関わるレバーハンドルバルブ操作タスクスキルによるレバーハンドルバルブ操作装置を実施するための最良の形態を実施例１、実施例２に基づいて説明した。既に本発明を利用し、実施例で示したタスクスキルによるレバーハンドルバルブの開放・閉鎖操作を実行した。このタスクスキルによるレバーハンドルバルブ装置は、異なるサイズのレバーハンドルバルブ１２や位置・姿勢誤差を含んだ様々な環境下でレバーハンドルバルブ操作をすべて実現することができ、実際に使用できることが確認された。

これまでは、既にプラント内に設置されているレバーハンドルバルブの操作は、人に拠らなければならなかったり、新たに部品を設置したりする必要があった。さらに、ロボットにより、レバーハンドルバルブの操作を実施するには、ハンド４とレバーハンドルバルブ１２間に位置・姿勢誤差があると、レバーハンドルバルブ操作が遂行できなかったが、本発明では前記のように新たに部品を設置する必要もなく、位置・姿勢誤差があっても問題なくレバーハンドルバルブ操作を実現することができる。したがって、プラント内だけでなく、様々な環境下で使用されているレバーハンドルバルブの操作を本発明に関わるレバーハンドルバルブ操作用ロボットハンド制御装置で実現することができる。

本発明であるタスクスキルによるレバーハンドルバルブ操作装置の全体構成図である（実施例１、２）。 本発明でのレバーハンドルバルブとハンドの概要図である（実施例１、２）。 本発明でのレバーハンドルバルブ操作タスクスキル動作手順である（実施例１、２）。 本発明でのタスクスキル動作にインピーダンスと力のハイブリッド制御を使用したレバーハンドルバルブ操作装置による実行結果である（実施例１）。 本発明でのタスクスキル動作にインピーダンス制御を使用したレバーハンドルバルブ操作装置による実行結果である（実施例２）。

符号の説明

１ タスクスキルによるレバーハンドルバルブ操作装置
２ ロボット
３ 力センサ
４ ハンド
５ カメラ
６ ロボット制御装置
７ ハンド制御装置
８ 力センサ情報取得装置
９ カメラ制御装置
１０ タスクスキル実行装置
１１ タスクスキル実装装置
１２ レバーハンドルバルブ

Claims (2)

1. ロボットと、力センサと、ハンドと、カメラと、ロボットを制御する制御装置と、力センサ情報を取得する装置と、ハンドを制御する制御装置と、カメラを制御する制御装置とを有し、ロボットハンドによりレバーハンドルバルブの操作を行うレバーハンドルバルブ操作用ロボットハンド制御装置において、
   前記カメラの映像情報に基づいて前記ロボットハンドと前記レバーハンドルバルブの軸方向をある程度一致させた上で、以後行う前記レバーハンドルバルブの操作を、
   （ａ）接近・接触動作
   （ｂ）押し付け動作
   （ｃ）力解除動作
   （ｄ）ハンド閉動作
   （ｅ）力解除動作
   （ｆ）レバーハンドルバルブの開放・閉鎖動作
   （ｇ）力解除動作
   （ｈ）ハンド開動作
   （ｉ）離脱動作
   に分類し、これらの動作（ａ）ないし（ｉ）のそれぞれを実現するために、ロボットハンド各軸の制御に、次のようにインピーダンス制御、力制御を割り当てたことを特徴とするレバーハンドルバルブ操作用ロボットハンド制御装置。
   （ａ）接近・接触動作
   接近方向と逆向きに所定の力が生じるまで、ロボットハンドの全軸についてインピーダンス制御
   （ｂ）押し付け動作
   動作（ａ）における所定の力を維持した上で、所定時間経過するまで、接近方向の軸について力制御、その他の軸についてインピーダンス制御
   （ｃ）力解除動作
   作用する力が０となりこれが所定時間継続するまで、全軸について力制御
   （ｄ）ハンド閉動作
   ハンドが閉じこれが所定時間継続するまで、全軸についてインピーダンス制御
   （ｅ）力解除動作
   作用する力が０となりこれが所定時間継続するまで、全軸について力制御
   （ｆ）レバーハンドルバルブの開放・閉鎖動作
   ｙａｗ軸周りに所定角度回転させ、ｙａｗ軸周りのモーメントが絶対値で所定の大きさになり、これが所定時間継続するまで、接近方向及びこれに直交する平面内の軸について力制御、その他の軸についてインピーダンス制御
   （ｇ）力解除動作
   作用する力が０となりこれが所定時間継続するまで、全軸について力制御
   （ｈ）ハンド開動作
   所定時間経過するまで全軸についてインピーダンス制御
   （ｉ）離脱動作（ｃ）
   接近方向と逆向きに所定距離移動するまで、全軸についてインピーダンス制御
2. ロボットを駆動するモータの電流を利用して力センサの代わりに利用することができることを特徴とする請求項1記載のレバーハンドルバルブ操作用ロボットハンド制御装置。