JPH0829509B2 - マニピユレ−タの制御装置 - Google Patents
マニピユレ−タの制御装置Info
- Publication number
- JPH0829509B2 JPH0829509B2 JP61294832A JP29483286A JPH0829509B2 JP H0829509 B2 JPH0829509 B2 JP H0829509B2 JP 61294832 A JP61294832 A JP 61294832A JP 29483286 A JP29483286 A JP 29483286A JP H0829509 B2 JPH0829509 B2 JP H0829509B2
- Authority
- JP
- Japan
- Prior art keywords
- arm
- master arm
- slave
- slave arm
- master
- 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.)
- Expired - Lifetime
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J3/00—Manipulators of leader-follower type, i.e. both controlling unit and controlled unit perform corresponding spatial movements
- B25J3/04—Manipulators of leader-follower type, i.e. both controlling unit and controlled unit perform corresponding spatial movements involving servo mechanisms
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Program-control systems
- G05B19/02—Program-control systems electric
- G05B19/42—Recording and playback systems, i.e. in which the program is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
- G05B19/427—Teaching successive positions by tracking the position of a joystick or handle to control the positioning servo of the tool head, leader-follower control
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
- Numerical Control (AREA)
Description
【発明の詳細な説明】 〔産業上の利用分野〕 本発明はマスタスレーブ形のマニピユレータに係り、
特に人間にとつて耐え難い環境および宇宙空間内での作
業を安全に行うに好適なマスタスレーブ形のマニピユレ
ータの制御装置に関するものである。
特に人間にとつて耐え難い環境および宇宙空間内での作
業を安全に行うに好適なマスタスレーブ形のマニピユレ
ータの制御装置に関するものである。
従来のマスタスレーブ形のマニピユレータはマスタア
ームとスレーブアームが同一形状又は相似形状でなけれ
ばならないという制約条件があり、そのアーム構造の自
由な設計ができなかつた。
ームとスレーブアームが同一形状又は相似形状でなけれ
ばならないという制約条件があり、そのアーム構造の自
由な設計ができなかつた。
最近では、コンピユータの技術が急速に進歩し演算速
度が向上したため、従来難しかつたマニピユレータのリ
アルタイム演算制御が実現できるようになつてきた。こ
れに伴い、従来アナログサーボが主体であつたマスタス
レーブ形のマニピユレータの制御をより複雑で高度な制
御が可能である計算機制御にして操業性を改善しようと
する試みが行われている。その一例としては、アイ・イ
ー・コン′84(IECON′84)の第40頁〜第45頁に示され
るように、形状の異なるマスタアームとスレーブアーム
との手先の運動を計算機を用いた高速座標変換演算によ
り1対1に対応させているものである。
度が向上したため、従来難しかつたマニピユレータのリ
アルタイム演算制御が実現できるようになつてきた。こ
れに伴い、従来アナログサーボが主体であつたマスタス
レーブ形のマニピユレータの制御をより複雑で高度な制
御が可能である計算機制御にして操業性を改善しようと
する試みが行われている。その一例としては、アイ・イ
ー・コン′84(IECON′84)の第40頁〜第45頁に示され
るように、形状の異なるマスタアームとスレーブアーム
との手先の運動を計算機を用いた高速座標変換演算によ
り1対1に対応させているものである。
上述した従来技術では、マスタアームとスレーブアー
ムの基準座標とアーム手先の位置の2点を一致させてい
るため、各アームの運動の比率は1対1となつている。
このため、スレーブアームによつて精密な作業を実現す
る場合にはマスタアームをスレーブアームの要求動作と
同様に細かな微少操作を行わなければならず、またこれ
とは逆にスレーブアームが大きな動作を必要とする場合
には同様にマスタアームを大きく動作しなければなら
ず、スレーブアームの作業内容に対応してマスタアーム
の操作性が良好でないという憾みがあつた。
ムの基準座標とアーム手先の位置の2点を一致させてい
るため、各アームの運動の比率は1対1となつている。
このため、スレーブアームによつて精密な作業を実現す
る場合にはマスタアームをスレーブアームの要求動作と
同様に細かな微少操作を行わなければならず、またこれ
とは逆にスレーブアームが大きな動作を必要とする場合
には同様にマスタアームを大きく動作しなければなら
ず、スレーブアームの作業内容に対応してマスタアーム
の操作性が良好でないという憾みがあつた。
本発明は上述の事柄にもとづいてなされたもので、マ
スタアームによって操作されるスレーブアームの手先位
置を微少に操作することができるマニピユレータの制御
装置を提供することを目的とする。
スタアームによって操作されるスレーブアームの手先位
置を微少に操作することができるマニピユレータの制御
装置を提供することを目的とする。
本発明の上記の目的は、マスタアームと、このマスタ
アームの動きに追従して作動し、マスタアームと異なる
機構のスレーブアームと、前記マスタアームの位置情報
を示す演算結果に対し、拡大または縮少するためのスケ
ール変換マトリクス演算を行い、この演算結果をスレー
ブアームに出力する演算回路とを備えるマニピュレータ
において、前記演算回路は、前記マスタアームの手先の
位置の微少変化量を、ヤコビ行列およひスケール変換演
算によってスレーブアームの手先の位置の微少変化量に
変換して出力することにより達成される。
アームの動きに追従して作動し、マスタアームと異なる
機構のスレーブアームと、前記マスタアームの位置情報
を示す演算結果に対し、拡大または縮少するためのスケ
ール変換マトリクス演算を行い、この演算結果をスレー
ブアームに出力する演算回路とを備えるマニピュレータ
において、前記演算回路は、前記マスタアームの手先の
位置の微少変化量を、ヤコビ行列およひスケール変換演
算によってスレーブアームの手先の位置の微少変化量に
変換して出力することにより達成される。
演算回路はマスタアームの移動によりその位置情報を
演算し、その演算結果に対し、予め設定した拡大または
縮少するためのスケール変換マトリクス演算およびヤコ
ビ行列演算を行い、この演算結果をスレーブアームに出
力する。これにより、スレーブアームはマスタアームの
微少移動に対してスケール変換されて作動する。その結
果、マスタアームの微少移動に対してスレーブアームを
精細に移動操作することができる。
演算し、その演算結果に対し、予め設定した拡大または
縮少するためのスケール変換マトリクス演算およびヤコ
ビ行列演算を行い、この演算結果をスレーブアームに出
力する。これにより、スレーブアームはマスタアームの
微少移動に対してスケール変換されて作動する。その結
果、マスタアームの微少移動に対してスレーブアームを
精細に移動操作することができる。
以下本発明の実施例を図面を参照して説明する。
まず、本発明の装置の一実施例を説明するに先立つ
て、本発明の動作原理を第5図を用いて説明する。この
図において、1はマスタアーム、2はスレーブアーム
で、この例ではスレーブアーム2はマスタアーム1と異
なる構造に形成されている。いま、マスタアーム1の基
準座標系をM、この基準座標系Mからマスタアーム1の
手先までの座標変換マトリクスをT6 m、スレーブアーム
2の基準座標系をS、この基準座標系Sからスレーブア
ーム2の手先までの座標変換マトリクスをT6 sとし、前
述した座標変換マトリクスT6 m,T6 s間でのスケール変換
マトリクスをKとすると、座標変換演算の手順は次のよ
うになる。すなわち、 マスタアーム1の各リンクのパラメータを各リンク連
結軸の位置とから前述したマスタアーム手先までの座標
変換マトリクスT6 mを求めることができる。次にマスタ
アーム手先までの座標変換マトリクスT6 mとスレーブア
ーム手先までの座標変換マトリクスT6 sとの間でスケー
ル変換を含んだ座標変換演算は次の(1)式で表わされ
る。
て、本発明の動作原理を第5図を用いて説明する。この
図において、1はマスタアーム、2はスレーブアーム
で、この例ではスレーブアーム2はマスタアーム1と異
なる構造に形成されている。いま、マスタアーム1の基
準座標系をM、この基準座標系Mからマスタアーム1の
手先までの座標変換マトリクスをT6 m、スレーブアーム
2の基準座標系をS、この基準座標系Sからスレーブア
ーム2の手先までの座標変換マトリクスをT6 sとし、前
述した座標変換マトリクスT6 m,T6 s間でのスケール変換
マトリクスをKとすると、座標変換演算の手順は次のよ
うになる。すなわち、 マスタアーム1の各リンクのパラメータを各リンク連
結軸の位置とから前述したマスタアーム手先までの座標
変換マトリクスT6 mを求めることができる。次にマスタ
アーム手先までの座標変換マトリクスT6 mとスレーブア
ーム手先までの座標変換マトリクスT6 sとの間でスケー
ル変換を含んだ座標変換演算は次の(1)式で表わされ
る。
T6 s=K・T6 m …(1) ここでKは とすると、T6 sはT6 mをマスタアーム1の基準座標系Mの
x軸方向にa倍,y軸方向にb倍,z軸方向にc倍にしたも
のとなる。そして3軸方向に均等に拡大する場合にはa
=b=cとすればよいことになる。そして、前述した
(1)式により得られた変換マトリクスT6 sに対し、ス
レーブアーム2のリンクパラメータを与え、スレーブア
ームの各軸の目標値を逆座標変換演算により求める。こ
のようにして得られたスレーブアーム2の各軸の目標値
に対し、各軸ごとにサーボ制御すれば、各アームの可動
領域内では、アームの形状に係りなくマスタアーム1の
運動を任意に拡大または縮少してスレーブアーム2を操
作することができる。
x軸方向にa倍,y軸方向にb倍,z軸方向にc倍にしたも
のとなる。そして3軸方向に均等に拡大する場合にはa
=b=cとすればよいことになる。そして、前述した
(1)式により得られた変換マトリクスT6 sに対し、ス
レーブアーム2のリンクパラメータを与え、スレーブア
ームの各軸の目標値を逆座標変換演算により求める。こ
のようにして得られたスレーブアーム2の各軸の目標値
に対し、各軸ごとにサーボ制御すれば、各アームの可動
領域内では、アームの形状に係りなくマスタアーム1の
運動を任意に拡大または縮少してスレーブアーム2を操
作することができる。
次に上述した本発明の原理にもとづいて、本発明の装
置の一実施例を第1図を用いて説明する。この図におい
て、1はマスタアーム、2はスレーブアームで、このス
レーブアーム2はこの例ではマスタアームとは異なる形
状に構成されている。3A〜3Cはマスタアーム1の各関節
軸に設けた位置検出センサ、4はセンサ入力処理回路、
5は演算回路で、この演算回路5は前述した演算処理を
行つてスレーブアームの各関節軸の目標値を求める。6
はサーボ制御回路、7A〜7Cはスレーブアーム2の各関節
軸に設けたアクチユエータ、8A〜8Cはスレーブアーム2
の各関節軸に設けた角度検出器である。
置の一実施例を第1図を用いて説明する。この図におい
て、1はマスタアーム、2はスレーブアームで、このス
レーブアーム2はこの例ではマスタアームとは異なる形
状に構成されている。3A〜3Cはマスタアーム1の各関節
軸に設けた位置検出センサ、4はセンサ入力処理回路、
5は演算回路で、この演算回路5は前述した演算処理を
行つてスレーブアームの各関節軸の目標値を求める。6
はサーボ制御回路、7A〜7Cはスレーブアーム2の各関節
軸に設けたアクチユエータ、8A〜8Cはスレーブアーム2
の各関節軸に設けた角度検出器である。
次に前述したセンサ入力処理回路4の具体的な構成を
第2図に示す。この図において位置検出センサ3A〜3Cと
しては回転式パルス発生器を用いている。この位置検出
センサ3A〜3Cからは90°位相のずれた1組のパルス信号
すなわちA相及びB相が回転角に応じて発生する。この
信号は方向判別回路4Aに入力されて回転角の方向判別を
行う。一方A相またはB相の信号がカウンタ4Bに入力さ
れ、パルス数をカウントする。前記の方向判別回路4Aよ
り出力される方向信号4Cはカウンタ4Bに入力され、パル
ス数の増減の切換えを行う。したがつて、カウンタ4Bの
値は回転角の増減に対応して増減するので、カウンタ4B
の出力4Dを外部から読み込むことによつて回転角を検知
することができる。
第2図に示す。この図において位置検出センサ3A〜3Cと
しては回転式パルス発生器を用いている。この位置検出
センサ3A〜3Cからは90°位相のずれた1組のパルス信号
すなわちA相及びB相が回転角に応じて発生する。この
信号は方向判別回路4Aに入力されて回転角の方向判別を
行う。一方A相またはB相の信号がカウンタ4Bに入力さ
れ、パルス数をカウントする。前記の方向判別回路4Aよ
り出力される方向信号4Cはカウンタ4Bに入力され、パル
ス数の増減の切換えを行う。したがつて、カウンタ4Bの
値は回転角の増減に対応して増減するので、カウンタ4B
の出力4Dを外部から読み込むことによつて回転角を検知
することができる。
第3図は演算回路5の具体的な構成例を示す。この中
にはデータの入出力制御及び加減算等を行うプロセツサ
5A、三角関数表やマニピユレータのリンクパラメタなど
のデータを格納するメモリ5B、掛算器5C及び割算器5Dが
バス回路5Eで接続されている。さらにこのバス回路5Eに
はシリアルまたはパラレルのインタフエイス回路5F,5G
が接続されている。インタフエイス回路5Gには位置検出
センサのセンサ入力処理回路4およびサーボ制御回路6
が接続されている。プロセツサ5Aはバス回路5Eを介して
バス回路5Eに接続されている全ての機器にアクセスし、
データを処理することができる。
にはデータの入出力制御及び加減算等を行うプロセツサ
5A、三角関数表やマニピユレータのリンクパラメタなど
のデータを格納するメモリ5B、掛算器5C及び割算器5Dが
バス回路5Eで接続されている。さらにこのバス回路5Eに
はシリアルまたはパラレルのインタフエイス回路5F,5G
が接続されている。インタフエイス回路5Gには位置検出
センサのセンサ入力処理回路4およびサーボ制御回路6
が接続されている。プロセツサ5Aはバス回路5Eを介して
バス回路5Eに接続されている全ての機器にアクセスし、
データを処理することができる。
第4図はサーボ制御回路32の具体例を示す。演算回路
5からの出力は減算器6Aを通過した後、デジタルアナロ
グ変換回路5Bを介してアナログ信号に変換され、アクチ
ユエータ7A〜7Cに入力される。アクチユエータ7A〜7Cは
アームの関節を駆動するとともに角度検出器8A〜8Cを回
転させる。角度検出器8A〜8Cからの出力信号はインタフ
エース回路6Cに入力され、角度信号を発生し、第3図に
示すパラレルインタフエース回路5Gを介してプロセツサ
5Aに読み取られ、また、減算器5Cに入力される。減算器
6Aの出力は演算回路5から出力される目標値信号と角度
検出器8A〜8Cとによりインタフエイス回路6Cを介して入
力される角度信号の差となるので、この差が零になるよ
うにアクチユエータ7A〜7Cが駆動される。これによつて
スレーブアーム2の関節角を目標値に一致させることが
できる。7A〜7Cが駆動させる。これによつてスレーブア
ーム2の関節角を目標値に一致させることができる。
5からの出力は減算器6Aを通過した後、デジタルアナロ
グ変換回路5Bを介してアナログ信号に変換され、アクチ
ユエータ7A〜7Cに入力される。アクチユエータ7A〜7Cは
アームの関節を駆動するとともに角度検出器8A〜8Cを回
転させる。角度検出器8A〜8Cからの出力信号はインタフ
エース回路6Cに入力され、角度信号を発生し、第3図に
示すパラレルインタフエース回路5Gを介してプロセツサ
5Aに読み取られ、また、減算器5Cに入力される。減算器
6Aの出力は演算回路5から出力される目標値信号と角度
検出器8A〜8Cとによりインタフエイス回路6Cを介して入
力される角度信号の差となるので、この差が零になるよ
うにアクチユエータ7A〜7Cが駆動される。これによつて
スレーブアーム2の関節角を目標値に一致させることが
できる。7A〜7Cが駆動させる。これによつてスレーブア
ーム2の関節角を目標値に一致させることができる。
次に上述した本発明の装置の一実施例の動作を説明す
る。
る。
マスタアーム1を動作させると、マスタアーム1の各
関節角は位置検出センサ3A〜3Cにより検出される。この
検出信号はセンサ入力処理回路4を介して演算回路5に
入力される。演算回路5はマスタアーム1の手先座標系
MCのマスタアーム基準座標系Mに対する相対位置関係を
座標変換マトリクスT6 mとして記憶し、またマスタアー
ム1の手先運動に対するスレーブアーム2の手先の運動
の寸法比率すなわちスケール変換定数Kを記憶してい
る。そして、演算回路5はマスタアーム座標変換マトリ
クスT6 mに対しスケール変換演算を行ない、スレーブア
ーム座標変換マトリクスT6 sを得る。次に、スレーブア
ーム2の手先座標系SCのスレーブアーム基準座標系Sに
対する相対位置がスレーブアーム座標変換マトリクスT6
sに一致するようにしたときのスレーブアーム2の各関
節軸目標値を逆座標変換演算により求め、これをサーボ
制御回路6に出力する。サーボ制御回路6はアクチユエ
ータ7A〜7Cを駆動する。これにより、マスタアーム1の
手先の運動をスケール変換してスレーブアーム2の手先
の運動に伝達することができる。この結果、各アームの
可動領域内では、アームの形状に係りなく、マスタアー
ム1の運動を、任意に拡大または縮少してスレーブアー
ム2に伝えることができ、マスタアーム1の操作に対し
てスレーブアーム2を細かく運動させたり、粗雑である
が大きく動作を与えることができる。
関節角は位置検出センサ3A〜3Cにより検出される。この
検出信号はセンサ入力処理回路4を介して演算回路5に
入力される。演算回路5はマスタアーム1の手先座標系
MCのマスタアーム基準座標系Mに対する相対位置関係を
座標変換マトリクスT6 mとして記憶し、またマスタアー
ム1の手先運動に対するスレーブアーム2の手先の運動
の寸法比率すなわちスケール変換定数Kを記憶してい
る。そして、演算回路5はマスタアーム座標変換マトリ
クスT6 mに対しスケール変換演算を行ない、スレーブア
ーム座標変換マトリクスT6 sを得る。次に、スレーブア
ーム2の手先座標系SCのスレーブアーム基準座標系Sに
対する相対位置がスレーブアーム座標変換マトリクスT6
sに一致するようにしたときのスレーブアーム2の各関
節軸目標値を逆座標変換演算により求め、これをサーボ
制御回路6に出力する。サーボ制御回路6はアクチユエ
ータ7A〜7Cを駆動する。これにより、マスタアーム1の
手先の運動をスケール変換してスレーブアーム2の手先
の運動に伝達することができる。この結果、各アームの
可動領域内では、アームの形状に係りなく、マスタアー
ム1の運動を、任意に拡大または縮少してスレーブアー
ム2に伝えることができ、マスタアーム1の操作に対し
てスレーブアーム2を細かく運動させたり、粗雑である
が大きく動作を与えることができる。
次に本発明の装置の他の実施例を説明する。
本発明の装置の他の実施例を説明するに先立つて、こ
の実施例の原理を第8図を用いて説明する。この実施例
はマスタアーム1の手先の位置の微少変位に対し、スケ
ール変換演算を行つたものを、スレーブアーム2の手先
の微少変位としてスレーブアーム2に伝えるようにした
ものである。そして、第1図に示す実施例と同様にマス
タアーム1の基準座標系をM、基準座標系Mからマスタ
アーム1の手先までの座標変換マトリクスをT6 m、スケ
ール変換演算のためのスケール変換マトリクスをKとす
る。またスレーブアーム2の基準座標変換マトリクスを
T6 sとすると、座標変換演算の手順は次のようになる。
すなわち、マスタアーム1の各リンクパラメタとその各
関節軸の位置から座標変換マトリクスT6 mが求められ
る。またスレーブアーム2の各リンクパラメタとその手
先の位置を示す座標変換マトリクスT6 sが与えられれ
ば、スレーブアーム2の各軸の目標値が求められる。
の実施例の原理を第8図を用いて説明する。この実施例
はマスタアーム1の手先の位置の微少変位に対し、スケ
ール変換演算を行つたものを、スレーブアーム2の手先
の微少変位としてスレーブアーム2に伝えるようにした
ものである。そして、第1図に示す実施例と同様にマス
タアーム1の基準座標系をM、基準座標系Mからマスタ
アーム1の手先までの座標変換マトリクスをT6 m、スケ
ール変換演算のためのスケール変換マトリクスをKとす
る。またスレーブアーム2の基準座標変換マトリクスを
T6 sとすると、座標変換演算の手順は次のようになる。
すなわち、マスタアーム1の各リンクパラメタとその各
関節軸の位置から座標変換マトリクスT6 mが求められ
る。またスレーブアーム2の各リンクパラメタとその手
先の位置を示す座標変換マトリクスT6 sが与えられれ
ば、スレーブアーム2の各軸の目標値が求められる。
今ある時点でマトタアーム1とスレーブアーム2の運
動を同期させるものとすると、手先の位置の微少変位dT
6とマニピユレータ各軸の微少変位dQとの間には次の関
係がある。
動を同期させるものとすると、手先の位置の微少変位dT
6とマニピユレータ各軸の微少変位dQとの間には次の関
係がある。
dT6=JdQ …(3) (J:ヤコビ行列) 今、マスタアーム1を微少運動MDさせたとき、その各
関節軸の変位の変化をdQmとし、マスタアーム1のヤコ
ビ行列をJmとしたとき、マスタアーム1の手先の微少運
動dT6 mは次の式から得られる。
関節軸の変位の変化をdQmとし、マスタアーム1のヤコ
ビ行列をJmとしたとき、マスタアーム1の手先の微少運
動dT6 mは次の式から得られる。
dT6 m=Jm・dQm …(4) ここで、dT6 mをスケール変換してスレーブアーム2の手
先の微少運動dT6 sを次式から得る。
先の微少運動dT6 sを次式から得る。
dT6 s=KdT6 m …(5) 次にスレーブアーム2の各関節軸の微少変位dQsをス
レーブアーム2のヤコビ行列Jsの逆行列(Js)-1と解く
ことにより求める。すなわち、 dQs=(Js)-1・dT6 s …(6) 上式で得られたスレーブアーム2各関節軸の微少変位
dQsをスレーブアーム2の各関節軸の位置に加え、これ
をスレーブアーム2の各関節軸のサーボ制御回路の目標
値とする。
レーブアーム2のヤコビ行列Jsの逆行列(Js)-1と解く
ことにより求める。すなわち、 dQs=(Js)-1・dT6 s …(6) 上式で得られたスレーブアーム2各関節軸の微少変位
dQsをスレーブアーム2の各関節軸の位置に加え、これ
をスレーブアーム2の各関節軸のサーボ制御回路の目標
値とする。
次に上述した原理にもとづいて本発明の制御装置の他
の実施例を第6図を用いて説明する。この図において第
1図と同符号のものは同一部分または相当する部分であ
る。9は差分回路、10は増分回路である。前述した差分
回路9はサンプリングタイムにおけるセンサ3A〜3Cのセ
ンサ信号の変化分を検出する。演算回路5は前述した
(3)式〜(6)式で示された計算を行い、スレーブア
ーム2の各関節軸の変化分を求め、この変化分を増分回
路10に出力する。増分回路10はスレーブアーム2の各関
節軸毎に現在目標値に演算回路5を求めた変化分を加算
し、サーボ制御回路6に入力する。サーボ制御回路6は
スレーブアーム2の各関節軸に設けたアクチユエータ7A
〜7Cを駆動する。これにより、スレーブアーム2は駆動
されるが、その移動量は検出器8A〜8Cによつて検出さ
れ、サーボ制御回路6にフイードバツクされる。その結
果、マスタアーム1の手先の運動をスケール変換してス
レーブアームの手先に伝達することができる。
の実施例を第6図を用いて説明する。この図において第
1図と同符号のものは同一部分または相当する部分であ
る。9は差分回路、10は増分回路である。前述した差分
回路9はサンプリングタイムにおけるセンサ3A〜3Cのセ
ンサ信号の変化分を検出する。演算回路5は前述した
(3)式〜(6)式で示された計算を行い、スレーブア
ーム2の各関節軸の変化分を求め、この変化分を増分回
路10に出力する。増分回路10はスレーブアーム2の各関
節軸毎に現在目標値に演算回路5を求めた変化分を加算
し、サーボ制御回路6に入力する。サーボ制御回路6は
スレーブアーム2の各関節軸に設けたアクチユエータ7A
〜7Cを駆動する。これにより、スレーブアーム2は駆動
されるが、その移動量は検出器8A〜8Cによつて検出さ
れ、サーボ制御回路6にフイードバツクされる。その結
果、マスタアーム1の手先の運動をスケール変換してス
レーブアームの手先に伝達することができる。
上述した本発明の制御装置の他の実施例における演算
回路の演算処理動作を第7図を用いて説明する。
回路の演算処理動作を第7図を用いて説明する。
最初に、初期位置でスタートすると、マスタアーム1
の各関節の初期値を読み込でおく。次にマスタアーム1
とスレーブアームの関節角を入力し、前回のデータとの
差から関節角の変化量dQmを求める。次にテーブルを参
照して三角関数を求め、マスタアーム1のヤコビ行列Jm
を計算する。関節角変化量dQmとヤコビ行列Jmからマス
タアーム1の手先変位dT6 mを求める。スケール変換定数
Kは入力されたデータを用いて得る。マスタアームの手
先変位dT6 mにKを乗じてスレーブアームの手先変位dT6 s
を求める。次にスレーブアームのヤコビ逆行列(Js)-1
を求める。このdT6 sに(Js)-1を乗じることによりスレ
ーブアームの各関節角変位dQsを求めスレーブアームの
関節角QsとdQsの和をとつてスレーブアームの各サーボ
系に結果を出力する。上記手続きを運転終了まで繰返し
実行する。
の各関節の初期値を読み込でおく。次にマスタアーム1
とスレーブアームの関節角を入力し、前回のデータとの
差から関節角の変化量dQmを求める。次にテーブルを参
照して三角関数を求め、マスタアーム1のヤコビ行列Jm
を計算する。関節角変化量dQmとヤコビ行列Jmからマス
タアーム1の手先変位dT6 mを求める。スケール変換定数
Kは入力されたデータを用いて得る。マスタアームの手
先変位dT6 mにKを乗じてスレーブアームの手先変位dT6 s
を求める。次にスレーブアームのヤコビ逆行列(Js)-1
を求める。このdT6 sに(Js)-1を乗じることによりスレ
ーブアームの各関節角変位dQsを求めスレーブアームの
関節角QsとdQsの和をとつてスレーブアームの各サーボ
系に結果を出力する。上記手続きを運転終了まで繰返し
実行する。
この実施例によれば、第1図に示す実施例と同様な効
果が得られると共に、マスタアーム1とスレーブアーム
2の手先位置がどこにあつても同期スタートさせること
ができ、かつ任意のスケール変換が可能である。
果が得られると共に、マスタアーム1とスレーブアーム
2の手先位置がどこにあつても同期スタートさせること
ができ、かつ任意のスケール変換が可能である。
第9図は本発明の装置のさらに他の実施例を示すもの
で、この図において、第1図同符号のものは同一部分で
ある。この実施例は、スレーブアーム2の手先を撮影す
るテレビカメラ90のズーム比の変化に対応して、マスタ
アーム1の運動に対するスレーブアーム2の運動のスケ
ール変換の定数を変えるようにしたものであり、テレビ
カメラ90にそのズームレンズの動きを検出するセンサ91
を設け、このセンサ情報を演算回路5に入力する。演算
回路5はこのセンサ情報と予め求めておいて補正演算を
行うことにより、スケール変換マトリクスKを決定し、
前述した実施例と同様にスレーブアーム2の運動をマス
タアーム1のそれに対してスケール変換動作させるため
の目標値を演算する。第9図において、92はマスタアー
ム1側に設置したテレビモニタである。
で、この図において、第1図同符号のものは同一部分で
ある。この実施例は、スレーブアーム2の手先を撮影す
るテレビカメラ90のズーム比の変化に対応して、マスタ
アーム1の運動に対するスレーブアーム2の運動のスケ
ール変換の定数を変えるようにしたものであり、テレビ
カメラ90にそのズームレンズの動きを検出するセンサ91
を設け、このセンサ情報を演算回路5に入力する。演算
回路5はこのセンサ情報と予め求めておいて補正演算を
行うことにより、スケール変換マトリクスKを決定し、
前述した実施例と同様にスレーブアーム2の運動をマス
タアーム1のそれに対してスケール変換動作させるため
の目標値を演算する。第9図において、92はマスタアー
ム1側に設置したテレビモニタである。
次に上述した本発明の装置の他の実施例の動作を第10
図に示すフローチヤートを用いて説明する。
図に示すフローチヤートを用いて説明する。
まず初期位置でスタートすると、マスタアーム1の各
関節角を読み込む。次にテーブルを参照して三角関数の
値を求める。次に得られた三角関数の値を用いて手先座
標T6 mを求める。前述したようにテレビカメラ10のズー
ムレンズと同期させる場合、ズームレンズに装着したセ
ンサ101によりズーム比を検出し、スケール変換マトリ
クスKを決定する。ズームレンズと同期しない場合はあ
らかじめ入力されたスケール変換マトリクスKを用い
る。次にマスタアーム1の手先位置T6 mにKを乗じてス
レーブアーム2の手先位置T6 sを求める。このT6 sより逆
座標変換演算でスレーブアーム2の各関節の目標値を求
め、これをスレーブアームの各サーボ系に出力する。上
記操作を運転終了まで繰返し実行する。
関節角を読み込む。次にテーブルを参照して三角関数の
値を求める。次に得られた三角関数の値を用いて手先座
標T6 mを求める。前述したようにテレビカメラ10のズー
ムレンズと同期させる場合、ズームレンズに装着したセ
ンサ101によりズーム比を検出し、スケール変換マトリ
クスKを決定する。ズームレンズと同期しない場合はあ
らかじめ入力されたスケール変換マトリクスKを用い
る。次にマスタアーム1の手先位置T6 mにKを乗じてス
レーブアーム2の手先位置T6 sを求める。このT6 sより逆
座標変換演算でスレーブアーム2の各関節の目標値を求
め、これをスレーブアームの各サーボ系に出力する。上
記操作を運転終了まで繰返し実行する。
このように構成したことにより、テレビカメラ10のズ
ーム比を任意に変えても、マスタアーム1の手先の運動
とテレビモニタ11上のスレーブアーム2の手先映像の運
動の大きさの比率を常に一定に保つことができる。その
結果、常に適切な操作感覚が得られるので、操作性が向
上する。
ーム比を任意に変えても、マスタアーム1の手先の運動
とテレビモニタ11上のスレーブアーム2の手先映像の運
動の大きさの比率を常に一定に保つことができる。その
結果、常に適切な操作感覚が得られるので、操作性が向
上する。
なお、上述の実施例では説明の便宜上、2次元平面内
に関して説明したが、3軸方向に移動する場合にも適用
できる、さらにスケール変換定数をマトリクスが与えれ
ば、3軸方向の拡大率または縮少率を自由に設定するこ
とができる。
に関して説明したが、3軸方向に移動する場合にも適用
できる、さらにスケール変換定数をマトリクスが与えれ
ば、3軸方向の拡大率または縮少率を自由に設定するこ
とができる。
本発明によれば、マスタアームの手先の微少運動を拡
大または縮少してスレーブアームの手先に位置できるの
で、スレーブアームで細かな精密な作業を行うことがで
きる。その結果、遠隔地にある対象物に対する作業性,
操作性を向上させることができる。
大または縮少してスレーブアームの手先に位置できるの
で、スレーブアームで細かな精密な作業を行うことがで
きる。その結果、遠隔地にある対象物に対する作業性,
操作性を向上させることができる。
第1図は本発明の装置の一実施例の構成を示す図、第2
図は第1図に示す装置を構成する入力処理回路の一例を
示す構成図、第3図は本発明の装置を構成する演算回路
の具体例を示す図、第4図は本発明の装置を構成するサ
ーボ制御回路の一例を示す図、第5図は第1図に示す本
発明の装置の原理を示す説明図、第6図は本発明の装置
の他の実施例の構成を示す図、第7図は第6図に示す本
発明の装置の他の実施例における演算回路の処理内容を
示すフローチヤート図、第8図は第6図に示す本発明の
装置の他の実施例の原理を示す説明図、第9図は本発明
の装置のさらに他の実施例の構成を示す図、第10図はそ
の動作内容を示すフローチヤート図である。 1…マスタアーム、2…スレーブアーム、4…入力処理
回路、5…演算回路、6…サーボ制御回路、9…差分回
路、10…増分回路。
図は第1図に示す装置を構成する入力処理回路の一例を
示す構成図、第3図は本発明の装置を構成する演算回路
の具体例を示す図、第4図は本発明の装置を構成するサ
ーボ制御回路の一例を示す図、第5図は第1図に示す本
発明の装置の原理を示す説明図、第6図は本発明の装置
の他の実施例の構成を示す図、第7図は第6図に示す本
発明の装置の他の実施例における演算回路の処理内容を
示すフローチヤート図、第8図は第6図に示す本発明の
装置の他の実施例の原理を示す説明図、第9図は本発明
の装置のさらに他の実施例の構成を示す図、第10図はそ
の動作内容を示すフローチヤート図である。 1…マスタアーム、2…スレーブアーム、4…入力処理
回路、5…演算回路、6…サーボ制御回路、9…差分回
路、10…増分回路。
───────────────────────────────────────────────────── フロントページの続き (72)発明者 山本 広志 茨城県土浦市神立町502番地 株式会社日 立製作所機械研究所内 (56)参考文献 特開 昭61−252081(JP,A) 特開 昭59−24973(JP,A)
Claims (2)
- 【請求項1】マスタアームと、このマスタアームの動き
に追従して作動し、マスタアームと異なる機構のスレー
ブアームと、前記マスタアームの変位をスケール変換マ
トリクス演算によって拡大または縮少し、その結果をス
レーブアームに出力する演算回路とを備えたマニピュレ
ータの制御装置において、前記演算回路は、前記マスタ
アームの手先の位置の微少変化量に対応するマスタアー
ムの各関節軸の変位をマスタアームのヤコビ行列によっ
てマスタアームの手先の微少運動として求め、このマス
タアームの微少運動をスケール変換してスレーブアーム
の手先の微少運動に変換し、このスレーブアームの手先
の微少運動をスレーブアームのヤコビ行列によってスレ
ーブアームの各関節軸の微少変位として求め、これをス
レーブアームの各関節軸に出力することを特徴とするマ
ニピュレータの制御装置。 - 【請求項2】前記演算回路は、演算結果に対し、テレビ
カメラのズーム比に連動してスケール変換における拡大
または縮少比率を設定することを特徴とする特許請求の
範囲第1項記載のマニピュレータの制御装置。
Priority Applications (5)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP61294832A JPH0829509B2 (ja) | 1986-12-12 | 1986-12-12 | マニピユレ−タの制御装置 |
| US07/123,276 US4853874A (en) | 1986-12-12 | 1987-11-20 | Master-slave manipulators with scaling |
| CA000553760A CA1324199C (en) | 1986-12-12 | 1987-12-08 | Controlling apparatus of manipulator |
| EP87118387A EP0273273B1 (en) | 1986-12-12 | 1987-12-11 | Controlling apparatus of manipulator |
| DE3789374T DE3789374T2 (de) | 1986-12-12 | 1987-12-11 | Steuergerät für einen Manipulator. |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP61294832A JPH0829509B2 (ja) | 1986-12-12 | 1986-12-12 | マニピユレ−タの制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS63150172A JPS63150172A (ja) | 1988-06-22 |
| JPH0829509B2 true JPH0829509B2 (ja) | 1996-03-27 |
Family
ID=17812830
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP61294832A Expired - Lifetime JPH0829509B2 (ja) | 1986-12-12 | 1986-12-12 | マニピユレ−タの制御装置 |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US4853874A (ja) |
| EP (1) | EP0273273B1 (ja) |
| JP (1) | JPH0829509B2 (ja) |
| CA (1) | CA1324199C (ja) |
| DE (1) | DE3789374T2 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9283047B2 (en) | 2011-03-31 | 2016-03-15 | Olympus Corporation | Control device and control method for surgical system |
Families Citing this family (175)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2664205B2 (ja) * | 1988-06-10 | 1997-10-15 | 株式会社日立製作所 | マニピュレータ制御システム |
| JP2685602B2 (ja) * | 1988-10-19 | 1997-12-03 | 株式会社日立製作所 | マスタースレーブマニピュレータシステム |
| US5105367A (en) * | 1988-10-19 | 1992-04-14 | Hitachi, Ltd. | Master slave manipulator system |
| US5019761A (en) * | 1989-02-21 | 1991-05-28 | Kraft Brett W | Force feedback control for backhoe |
| US5159249A (en) * | 1989-05-16 | 1992-10-27 | Dalila Megherbi | Method and apparatus for controlling robot motion at and near singularities and for robot mechanical design |
| US5072361A (en) * | 1990-02-01 | 1991-12-10 | Sarcos Group | Force-reflective teleoperation control system |
| US5184319A (en) * | 1990-02-02 | 1993-02-02 | Kramer James F | Force feedback and textures simulating interface device |
| US5631861A (en) | 1990-02-02 | 1997-05-20 | Virtual Technologies, Inc. | Force feedback and texture simulating interface device |
| US5086400A (en) * | 1990-05-11 | 1992-02-04 | The United States Of America As Represented The The Administrator Of The National Aeronautics And Space Administration | Bilevel shared control for teleoperators |
| US5266875A (en) * | 1991-05-23 | 1993-11-30 | Massachusetts Institute Of Technology | Telerobotic system |
| JP2880590B2 (ja) * | 1991-07-24 | 1999-04-12 | 株式会社不二越 | 産業用ロボットの同期制御方法 |
| JP2702320B2 (ja) * | 1991-07-26 | 1998-01-21 | 川崎重工業株式会社 | ロボットの制御装置 |
| US5889670A (en) | 1991-10-24 | 1999-03-30 | Immersion Corporation | Method and apparatus for tactilely responsive user interface |
| US5631973A (en) | 1994-05-05 | 1997-05-20 | Sri International | Method for telemanipulation with telepresence |
| US6788999B2 (en) | 1992-01-21 | 2004-09-07 | Sri International, Inc. | Surgical system |
| US6963792B1 (en) | 1992-01-21 | 2005-11-08 | Sri International | Surgical method |
| EP1356781A3 (en) * | 1992-01-21 | 2013-07-24 | SRI International | Teleoperation surgical system |
| US5762458A (en) | 1996-02-20 | 1998-06-09 | Computer Motion, Inc. | Method and apparatus for performing minimally invasive cardiac procedures |
| US5657429A (en) | 1992-08-10 | 1997-08-12 | Computer Motion, Inc. | Automated endoscope system optimal positioning |
| US7074179B2 (en) | 1992-08-10 | 2006-07-11 | Intuitive Surgical Inc | Method and apparatus for performing minimally invasive cardiac procedures |
| US5524180A (en) * | 1992-08-10 | 1996-06-04 | Computer Motion, Inc. | Automated endoscope system for optimal positioning |
| US5629594A (en) * | 1992-12-02 | 1997-05-13 | Cybernet Systems Corporation | Force feedback system |
| US5323174A (en) * | 1992-12-02 | 1994-06-21 | Matthew H. Klapman | Device for determining an orientation of at least a portion of a living body |
| US5389865A (en) * | 1992-12-02 | 1995-02-14 | Cybernet Systems Corporation | Method and system for providing a tactile virtual reality and manipulator defining an interface device therefor |
| US6801008B1 (en) * | 1992-12-02 | 2004-10-05 | Immersion Corporation | Force feedback system and actuator power management |
| US7345672B2 (en) * | 1992-12-02 | 2008-03-18 | Immersion Corporation | Force feedback system and actuator power management |
| DE4306786C1 (de) * | 1993-03-04 | 1994-02-10 | Wolfgang Daum | Chirurgischer Manipulator |
| US5734373A (en) * | 1993-07-16 | 1998-03-31 | Immersion Human Interface Corporation | Method and apparatus for controlling force feedback interface systems utilizing a host computer |
| WO1995002801A1 (en) | 1993-07-16 | 1995-01-26 | Immersion Human Interface | Three-dimensional mechanical mouse |
| US5656903A (en) * | 1993-10-01 | 1997-08-12 | The Ohio State University Research Foundation | Master-slave position and motion control system |
| US5625576A (en) | 1993-10-01 | 1997-04-29 | Massachusetts Institute Of Technology | Force reflecting haptic interface |
| US5876325A (en) * | 1993-11-02 | 1999-03-02 | Olympus Optical Co., Ltd. | Surgical manipulation system |
| CN100507780C (zh) * | 1994-03-23 | 2009-07-01 | 株式会社安川电机 | 机器控制器 |
| US7053752B2 (en) | 1996-08-06 | 2006-05-30 | Intuitive Surgical | General purpose distributed operating room control system |
| US6646541B1 (en) | 1996-06-24 | 2003-11-11 | Computer Motion, Inc. | General purpose distributed operating room control system |
| US6463361B1 (en) | 1994-09-22 | 2002-10-08 | Computer Motion, Inc. | Speech interface for an automated endoscopic system |
| US5649956A (en) | 1995-06-07 | 1997-07-22 | Sri International | System and method for releasably holding a surgical instrument |
| US5814038A (en) | 1995-06-07 | 1998-09-29 | Sri International | Surgical manipulator for a telerobotic system |
| US6714841B1 (en) | 1995-09-15 | 2004-03-30 | Computer Motion, Inc. | Head cursor control interface for an automated endoscope system for optimal positioning |
| US6028593A (en) * | 1995-12-01 | 2000-02-22 | Immersion Corporation | Method and apparatus for providing simulated physical interactions within computer generated environments |
| US8508469B1 (en) | 1995-12-01 | 2013-08-13 | Immersion Corporation | Networked applications including haptic feedback |
| US6436107B1 (en) | 1996-02-20 | 2002-08-20 | Computer Motion, Inc. | Method and apparatus for performing minimally invasive surgical procedures |
| US5855583A (en) | 1996-02-20 | 1999-01-05 | Computer Motion, Inc. | Method and apparatus for performing minimally invasive cardiac procedures |
| US6911916B1 (en) | 1996-06-24 | 2005-06-28 | The Cleveland Clinic Foundation | Method and apparatus for accessing medical data over a network |
| US6496099B2 (en) | 1996-06-24 | 2002-12-17 | Computer Motion, Inc. | General purpose distributed operating room control system |
| US6084587A (en) | 1996-08-02 | 2000-07-04 | Sensable Technologies, Inc. | Method and apparatus for generating and interfacing with a haptic virtual reality environment |
| JP3115237B2 (ja) * | 1996-09-03 | 2000-12-04 | 株式会社東芝 | 制御プログラム作成装置及び制御プログラム作成方法 |
| US6024576A (en) * | 1996-09-06 | 2000-02-15 | Immersion Corporation | Hemispherical, high bandwidth mechanical interface for computer systems |
| US6132441A (en) | 1996-11-22 | 2000-10-17 | Computer Motion, Inc. | Rigidly-linked articulating wrist with decoupled motion transmission |
| US6050962A (en) | 1997-04-21 | 2000-04-18 | Virtual Technologies, Inc. | Goniometer-based body-tracking device and method |
| US6281651B1 (en) | 1997-11-03 | 2001-08-28 | Immersion Corporation | Haptic pointing devices |
| US6191796B1 (en) | 1998-01-21 | 2001-02-20 | Sensable Technologies, Inc. | Method and apparatus for generating and interfacing with rigid and deformable surfaces in a haptic virtual reality environment |
| US8414598B2 (en) | 1998-02-24 | 2013-04-09 | Hansen Medical, Inc. | Flexible instrument |
| US20080177285A1 (en) * | 1998-02-24 | 2008-07-24 | Hansen Medical, Inc. | Surgical instrument |
| US7758569B2 (en) * | 1998-02-24 | 2010-07-20 | Hansen Medical, Inc. | Interchangeable surgical instrument |
| US6860878B2 (en) * | 1998-02-24 | 2005-03-01 | Endovia Medical Inc. | Interchangeable instrument |
| US7297142B2 (en) * | 1998-02-24 | 2007-11-20 | Hansen Medical, Inc. | Interchangeable surgical instrument |
| US7713190B2 (en) | 1998-02-24 | 2010-05-11 | Hansen Medical, Inc. | Flexible instrument |
| US6843793B2 (en) | 1998-02-24 | 2005-01-18 | Endovia Medical, Inc. | Surgical instrument |
| US7775972B2 (en) | 1998-02-24 | 2010-08-17 | Hansen Medical, Inc. | Flexible instrument |
| US7371210B2 (en) * | 1998-02-24 | 2008-05-13 | Hansen Medical, Inc. | Flexible instrument |
| US8303576B2 (en) | 1998-02-24 | 2012-11-06 | Hansen Medical, Inc. | Interchangeable surgical instrument |
| US7090683B2 (en) | 1998-02-24 | 2006-08-15 | Hansen Medical, Inc. | Flexible instrument |
| US7789875B2 (en) * | 1998-02-24 | 2010-09-07 | Hansen Medical, Inc. | Surgical instruments |
| US7901399B2 (en) * | 1998-02-24 | 2011-03-08 | Hansen Medical, Inc. | Interchangeable surgical instrument |
| US6243621B1 (en) | 1998-03-13 | 2001-06-05 | Fanuc Robotics North America, Inc. | Method of determining workpiece positions including coordinated motion |
| US6429846B2 (en) | 1998-06-23 | 2002-08-06 | Immersion Corporation | Haptic feedback for touchpads and other touch controls |
| US6184868B1 (en) | 1998-09-17 | 2001-02-06 | Immersion Corp. | Haptic feedback control devices |
| US6552722B1 (en) | 1998-07-17 | 2003-04-22 | Sensable Technologies, Inc. | Systems and methods for sculpting virtual objects in a haptic virtual reality environment |
| US6417638B1 (en) | 1998-07-17 | 2002-07-09 | Sensable Technologies, Inc. | Force reflecting haptic interface |
| US6985133B1 (en) | 1998-07-17 | 2006-01-10 | Sensable Technologies, Inc. | Force reflecting haptic interface |
| US6421048B1 (en) | 1998-07-17 | 2002-07-16 | Sensable Technologies, Inc. | Systems and methods for interacting with virtual objects in a haptic virtual reality environment |
| US6398726B1 (en) | 1998-11-20 | 2002-06-04 | Intuitive Surgical, Inc. | Stabilizer for robotic beating-heart surgery |
| US8527094B2 (en) | 1998-11-20 | 2013-09-03 | Intuitive Surgical Operations, Inc. | Multi-user medical robotic system for collaboration or training in minimally invasive surgical procedures |
| US6659939B2 (en) | 1998-11-20 | 2003-12-09 | Intuitive Surgical, Inc. | Cooperative minimally invasive telesurgical system |
| US6951535B2 (en) | 2002-01-16 | 2005-10-04 | Intuitive Surgical, Inc. | Tele-medicine system that transmits an entire state of a subsystem |
| US6852107B2 (en) | 2002-01-16 | 2005-02-08 | Computer Motion, Inc. | Minimally invasive surgical training using robotics and tele-collaboration |
| US8944070B2 (en) | 1999-04-07 | 2015-02-03 | Intuitive Surgical Operations, Inc. | Non-force reflecting method for providing tool force information to a user of a telesurgical system |
| US6424885B1 (en) | 1999-04-07 | 2002-07-23 | Intuitive Surgical, Inc. | Camera referenced control in a minimally invasive surgical apparatus |
| JP2002543865A (ja) * | 1999-05-10 | 2002-12-24 | ブロック ロジャース サージカル インコーポレイティド | 外科器具 |
| US7217240B2 (en) | 1999-10-01 | 2007-05-15 | Intuitive Surgical, Inc. | Heart stabilizer |
| US6822635B2 (en) | 2000-01-19 | 2004-11-23 | Immersion Corporation | Haptic interface for laptop computers and other portable devices |
| US6726699B1 (en) | 2000-08-15 | 2004-04-27 | Computer Motion, Inc. | Instrument guide |
| ATE495703T1 (de) | 2000-11-28 | 2011-02-15 | Intuitive Surgical Operations | Endoskopischer stabilisator für das schlagende herz und gefässokklusionsverschluss |
| US6867770B2 (en) | 2000-12-14 | 2005-03-15 | Sensable Technologies, Inc. | Systems and methods for voxel warping |
| US6958752B2 (en) | 2001-01-08 | 2005-10-25 | Sensable Technologies, Inc. | Systems and methods for three-dimensional modeling |
| US7699835B2 (en) * | 2001-02-15 | 2010-04-20 | Hansen Medical, Inc. | Robotically controlled surgical instruments |
| US7766894B2 (en) | 2001-02-15 | 2010-08-03 | Hansen Medical, Inc. | Coaxial catheter system |
| US20030135204A1 (en) | 2001-02-15 | 2003-07-17 | Endo Via Medical, Inc. | Robotically controlled medical instrument with a flexible section |
| US8414505B1 (en) | 2001-02-15 | 2013-04-09 | Hansen Medical, Inc. | Catheter driver system |
| US20020165524A1 (en) | 2001-05-01 | 2002-11-07 | Dan Sanchez | Pivot point arm for a robotic system used to perform a surgical procedure |
| US20060178556A1 (en) | 2001-06-29 | 2006-08-10 | Intuitive Surgical, Inc. | Articulate and swapable endoscope for a surgical robot |
| US6817974B2 (en) | 2001-06-29 | 2004-11-16 | Intuitive Surgical, Inc. | Surgical tool having positively positionable tendon-actuated multi-disk wrist joint |
| US6728599B2 (en) | 2001-09-07 | 2004-04-27 | Computer Motion, Inc. | Modularity system for computer assisted surgery |
| US6839612B2 (en) | 2001-12-07 | 2005-01-04 | Institute Surgical, Inc. | Microwrist system for surgical procedures |
| US6793653B2 (en) | 2001-12-08 | 2004-09-21 | Computer Motion, Inc. | Multifunctional handle for a medical robotic system |
| US6671651B2 (en) | 2002-04-26 | 2003-12-30 | Sensable Technologies, Inc. | 3-D selection and manipulation with a multiple dimension haptic interface |
| US20040176751A1 (en) * | 2002-08-14 | 2004-09-09 | Endovia Medical, Inc. | Robotic medical instrument system |
| EP2359767B1 (en) | 2002-12-06 | 2017-08-30 | Intuitive Surgical Operations, Inc. | Flexible wrist for surgical tool |
| US7386365B2 (en) * | 2004-05-04 | 2008-06-10 | Intuitive Surgical, Inc. | Tool grip calibration for robotic surgery |
| US8830161B2 (en) | 2002-12-08 | 2014-09-09 | Immersion Corporation | Methods and systems for providing a virtual touch haptic effect to handheld communication devices |
| US8059088B2 (en) | 2002-12-08 | 2011-11-15 | Immersion Corporation | Methods and systems for providing haptic messaging to handheld communication devices |
| GB2414319A (en) * | 2002-12-08 | 2005-11-23 | Immersion Corp | Methods and systems for providing haptic messaging to handheld communication devices |
| DE602004019781D1 (de) * | 2003-06-20 | 2009-04-16 | Fanuc Robotics America Inc | Mehrfach-roboterarm-verfolgung und spiegel-jog |
| US7411576B2 (en) | 2003-10-30 | 2008-08-12 | Sensable Technologies, Inc. | Force reflecting haptic interface |
| US7382378B2 (en) | 2003-10-30 | 2008-06-03 | Sensable Technologies, Inc. | Apparatus and methods for stenciling an image |
| US7095418B2 (en) * | 2003-10-30 | 2006-08-22 | Sensable Technologies, Inc. | Apparatus and methods for texture mapping |
| US7626589B2 (en) | 2003-12-10 | 2009-12-01 | Sensable Technologies, Inc. | Haptic graphical user interface for adjusting mapped texture |
| US7889209B2 (en) | 2003-12-10 | 2011-02-15 | Sensable Technologies, Inc. | Apparatus and methods for wrapping texture onto the surface of a virtual object |
| US7149596B2 (en) | 2004-01-13 | 2006-12-12 | Sensable Technologies, Inc. | Apparatus and methods for modifying a model of an object to enforce compliance with a manufacturing constraint |
| US9789608B2 (en) | 2006-06-29 | 2017-10-17 | Intuitive Surgical Operations, Inc. | Synthetic representation of a surgical robot |
| EP1934848A2 (en) * | 2005-09-29 | 2008-06-25 | The General Hospital Corporation | Medical training system for casualty simulation |
| CZ304667B6 (cs) * | 2006-02-27 | 2014-08-27 | ÄŚVUT v Praze - Fakulta strojnĂ | Způsob a zařízení pro změnu tuhosti mechanických konstrukcí |
| US8062211B2 (en) | 2006-06-13 | 2011-11-22 | Intuitive Surgical Operations, Inc. | Retrograde instrument |
| US10008017B2 (en) | 2006-06-29 | 2018-06-26 | Intuitive Surgical Operations, Inc. | Rendering tool information as graphic overlays on displayed images of tools |
| US20090192523A1 (en) | 2006-06-29 | 2009-07-30 | Intuitive Surgical, Inc. | Synthetic representation of a surgical instrument |
| US9718190B2 (en) | 2006-06-29 | 2017-08-01 | Intuitive Surgical Operations, Inc. | Tool position and identification indicator displayed in a boundary area of a computer display screen |
| US12357400B2 (en) | 2006-06-29 | 2025-07-15 | Intuitive Surgical Operations, Inc. | Synthetic representation of a surgical robot |
| US10258425B2 (en) | 2008-06-27 | 2019-04-16 | Intuitive Surgical Operations, Inc. | Medical robotic system providing an auxiliary view of articulatable instruments extending out of a distal end of an entry guide |
| US9084623B2 (en) | 2009-08-15 | 2015-07-21 | Intuitive Surgical Operations, Inc. | Controller assisted reconfiguration of an articulated instrument during movement into and out of an entry guide |
| US9138129B2 (en) | 2007-06-13 | 2015-09-22 | Intuitive Surgical Operations, Inc. | Method and system for moving a plurality of articulated instruments in tandem back towards an entry guide |
| US9089256B2 (en) | 2008-06-27 | 2015-07-28 | Intuitive Surgical Operations, Inc. | Medical robotic system providing an auxiliary view including range of motion limitations for articulatable instruments extending out of a distal end of an entry guide |
| US8620473B2 (en) | 2007-06-13 | 2013-12-31 | Intuitive Surgical Operations, Inc. | Medical robotic system with coupled control modes |
| US9469034B2 (en) | 2007-06-13 | 2016-10-18 | Intuitive Surgical Operations, Inc. | Method and system for switching modes of a robotic system |
| KR100945884B1 (ko) * | 2007-11-14 | 2010-03-05 | 삼성중공업 주식회사 | 내장형 로봇 제어 시스템 |
| US8864652B2 (en) | 2008-06-27 | 2014-10-21 | Intuitive Surgical Operations, Inc. | Medical robotic system providing computer generated auxiliary views of a camera instrument for controlling the positioning and orienting of its tip |
| US12239396B2 (en) | 2008-06-27 | 2025-03-04 | Intuitive Surgical Operations, Inc. | Medical robotic system providing an auxiliary view including range of motion limitations for articulatable instruments extending out of a distal end of an entry guide |
| KR101056232B1 (ko) * | 2008-09-12 | 2011-08-11 | 정창욱 | 최소 침습 수술 도구 및 그 사용 방법 |
| KR101075363B1 (ko) * | 2008-10-31 | 2011-10-19 | 정창욱 | 최소 침습 수술 도구를 포함하는 수술용 로봇 시스템 |
| US12266040B2 (en) | 2009-03-31 | 2025-04-01 | Intuitive Surgical Operations, Inc. | Rendering tool information as graphic overlays on displayed images of tools |
| US8918211B2 (en) | 2010-02-12 | 2014-12-23 | Intuitive Surgical Operations, Inc. | Medical robotic system providing sensory feedback indicating a difference between a commanded state and a preferred pose of an articulated instrument |
| US9492927B2 (en) | 2009-08-15 | 2016-11-15 | Intuitive Surgical Operations, Inc. | Application of force feedback on an input device to urge its operator to command an articulated instrument to a preferred pose |
| US8606403B2 (en) | 2010-12-14 | 2013-12-10 | Harris Corporation | Haptic interface handle with force-indicating trigger mechanism |
| US8918215B2 (en) | 2011-01-19 | 2014-12-23 | Harris Corporation | Telematic interface with control signal scaling based on force sensor feedback |
| US8918214B2 (en) | 2011-01-19 | 2014-12-23 | Harris Corporation | Telematic interface with directional translation |
| US9314921B2 (en) | 2011-03-17 | 2016-04-19 | Sarcos Lc | Robotic lift device with human interface operation |
| US9205555B2 (en) | 2011-03-22 | 2015-12-08 | Harris Corporation | Manipulator joint-limit handling algorithm |
| US8977398B2 (en) | 2011-04-29 | 2015-03-10 | Sarcos Lc | Multi-degree of freedom torso support for a robotic agile lift system |
| US9789603B2 (en) | 2011-04-29 | 2017-10-17 | Sarcos Lc | Teleoperated robotic system |
| US8942846B2 (en) * | 2011-04-29 | 2015-01-27 | Raytheon Company | System and method for controlling a teleoperated robotic agile lift system |
| US8977388B2 (en) | 2011-04-29 | 2015-03-10 | Sarcos Lc | Platform perturbation compensation |
| US8694134B2 (en) | 2011-05-05 | 2014-04-08 | Harris Corporation | Remote control interface |
| US8639386B2 (en) | 2011-05-20 | 2014-01-28 | Harris Corporation | Haptic device for manipulator and vehicle control |
| US9026250B2 (en) | 2011-08-17 | 2015-05-05 | Harris Corporation | Haptic manipulation system for wheelchairs |
| US8996244B2 (en) | 2011-10-06 | 2015-03-31 | Harris Corporation | Improvised explosive device defeat system |
| US9802364B2 (en) | 2011-10-18 | 2017-10-31 | 3D Systems, Inc. | Systems and methods for construction of an instruction set for three-dimensional printing of a user-customizableimage of a three-dimensional structure |
| US9582178B2 (en) | 2011-11-07 | 2017-02-28 | Immersion Corporation | Systems and methods for multi-pressure interaction on touch-sensitive surfaces |
| US9616580B2 (en) | 2012-05-14 | 2017-04-11 | Sarcos Lc | End effector for a robotic arm |
| US8954195B2 (en) | 2012-11-09 | 2015-02-10 | Harris Corporation | Hybrid gesture control haptic system |
| US8965620B2 (en) | 2013-02-07 | 2015-02-24 | Harris Corporation | Systems and methods for controlling movement of unmanned vehicles |
| US10507066B2 (en) | 2013-02-15 | 2019-12-17 | Intuitive Surgical Operations, Inc. | Providing information of tools by filtering image areas adjacent to or on displayed images of the tools |
| US10086509B2 (en) | 2013-03-14 | 2018-10-02 | Elytra Technologies Llc | Device and method for controlled motion of a tool |
| JP6473919B2 (ja) | 2013-06-24 | 2019-02-27 | パナソニックIpマネジメント株式会社 | マスタスレーブロボットの制御装置及び制御方法、ロボット、マスタスレーブロボットの制御プログラム、並びに、マスタスレーブロボットの制御用集積電子回路 |
| JP6109001B2 (ja) * | 2013-07-26 | 2017-04-05 | オリンパス株式会社 | 医療用システムおよびその作動方法 |
| US9128507B2 (en) | 2013-12-30 | 2015-09-08 | Harris Corporation | Compact haptic interface |
| US10766133B2 (en) | 2014-05-06 | 2020-09-08 | Sarcos Lc | Legged robotic device utilizing modifiable linkage mechanism |
| US10292777B1 (en) | 2015-09-18 | 2019-05-21 | Elytra Technologies, Llc | Device and method for controlled motion of a tool |
| CA3003632A1 (en) * | 2015-12-10 | 2017-06-15 | Covidien Lp | Robotic surgical systems with independent roll, pitch, and yaw scaling |
| US10765537B2 (en) | 2016-11-11 | 2020-09-08 | Sarcos Corp. | Tunable actuator joint modules having energy recovering quasi-passive elastic actuators for use within a robotic system |
| US10919161B2 (en) | 2016-11-11 | 2021-02-16 | Sarcos Corp. | Clutched joint modules for a robotic system |
| US10821614B2 (en) | 2016-11-11 | 2020-11-03 | Sarcos Corp. | Clutched joint modules having a quasi-passive elastic actuator for a robotic assembly |
| US10828767B2 (en) | 2016-11-11 | 2020-11-10 | Sarcos Corp. | Tunable actuator joint modules having energy recovering quasi-passive elastic actuators with internal valve arrangements |
| US10843330B2 (en) | 2017-12-07 | 2020-11-24 | Sarcos Corp. | Resistance-based joint constraint for a master robotic system |
| US11331809B2 (en) | 2017-12-18 | 2022-05-17 | Sarcos Corp. | Dynamically controlled robotic stiffening element |
| US11241801B2 (en) | 2018-12-31 | 2022-02-08 | Sarcos Corp. | Robotic end effector with dorsally supported actuation mechanism |
| US11351675B2 (en) | 2018-12-31 | 2022-06-07 | Sarcos Corp. | Robotic end-effector having dynamic stiffening elements for conforming object interaction |
| US10906191B2 (en) | 2018-12-31 | 2021-02-02 | Sarcos Corp. | Hybrid robotic end effector |
| RU2751779C1 (ru) * | 2020-07-07 | 2021-07-16 | Владимир Иванович Пожбелко | Копирующий манипулятор |
| US11833676B2 (en) | 2020-12-07 | 2023-12-05 | Sarcos Corp. | Combining sensor output data to prevent unsafe operation of an exoskeleton |
| US11794345B2 (en) | 2020-12-31 | 2023-10-24 | Sarcos Corp. | Unified robotic vehicle systems and methods of control |
| US11826907B1 (en) | 2022-08-17 | 2023-11-28 | Sarcos Corp. | Robotic joint system with length adapter |
| US11717956B1 (en) | 2022-08-29 | 2023-08-08 | Sarcos Corp. | Robotic joint system with integrated safety |
| US12172298B2 (en) | 2022-11-04 | 2024-12-24 | Sarcos Corp. | Robotic end-effector having dynamic stiffening elements with resilient spacers for conforming object interaction |
| US11924023B1 (en) | 2022-11-17 | 2024-03-05 | Sarcos Corp. | Systems and methods for redundant network communication in a robot |
| US11897132B1 (en) | 2022-11-17 | 2024-02-13 | Sarcos Corp. | Systems and methods for redundant network communication in a robot |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2297697A1 (fr) * | 1975-01-20 | 1976-08-13 | Bretagne Atel Chantiers | Manipulateur programmable en continu |
| US4148403A (en) * | 1977-06-13 | 1979-04-10 | Westinghouse Electric Corp. | Remote access manipulator |
| FR2437274A1 (fr) * | 1978-09-29 | 1980-04-25 | Calhene | Manipulateur mecanique du type maitre-esclave a deplacements homothetiques |
| JPS5924973A (ja) * | 1982-07-29 | 1984-02-08 | 株式会社東芝 | マスタ・スレ−ブ形サ−ボマニピユレ−タ |
| EP0125776A2 (en) * | 1983-04-13 | 1984-11-21 | Nordson Corporation | Robot control system |
| JPS61146482A (ja) * | 1984-12-20 | 1986-07-04 | 工業技術院長 | 異構造異自由度バイラテラル・マスタスレイブ・マニピユレ−タの制御装置 |
| JPS61252081A (ja) * | 1985-04-30 | 1986-11-10 | 工業技術院長 | マスタ・スレ−ブ・マニピユレ−タ |
| GB8600920D0 (en) * | 1986-01-15 | 1986-02-19 | Witter R B | Robot teaching |
-
1986
- 1986-12-12 JP JP61294832A patent/JPH0829509B2/ja not_active Expired - Lifetime
-
1987
- 1987-11-20 US US07/123,276 patent/US4853874A/en not_active Expired - Lifetime
- 1987-12-08 CA CA000553760A patent/CA1324199C/en not_active Expired - Fee Related
- 1987-12-11 EP EP87118387A patent/EP0273273B1/en not_active Expired - Lifetime
- 1987-12-11 DE DE3789374T patent/DE3789374T2/de not_active Expired - Fee Related
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9283047B2 (en) | 2011-03-31 | 2016-03-15 | Olympus Corporation | Control device and control method for surgical system |
Also Published As
| Publication number | Publication date |
|---|---|
| EP0273273A3 (en) | 1989-10-25 |
| US4853874A (en) | 1989-08-01 |
| DE3789374D1 (de) | 1994-04-21 |
| EP0273273A2 (en) | 1988-07-06 |
| CA1324199C (en) | 1993-11-09 |
| DE3789374T2 (de) | 1994-09-01 |
| JPS63150172A (ja) | 1988-06-22 |
| EP0273273B1 (en) | 1994-03-16 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JPH0829509B2 (ja) | マニピユレ−タの制御装置 | |
| JP2664205B2 (ja) | マニピュレータ制御システム | |
| US4833624A (en) | Functioning-distributed robot control system | |
| Handlykken et al. | Control system analysis and synthesis for a six degree-of-freedom universal force-reflecting hand controller | |
| US4529921A (en) | Tracking control system of multijoint robot | |
| JPS62159286A (ja) | カーソル制御方法及び3次元図形表示装置 | |
| JPH1110575A (ja) | パラレルリンク機構 | |
| JP2610956B2 (ja) | マスタスレーブマニピュレータ | |
| JPH0811071A (ja) | マニピュレータの制御装置 | |
| JP2685602B2 (ja) | マスタースレーブマニピュレータシステム | |
| JP2645866B2 (ja) | マニピュレータの制御方法および装置 | |
| Heuring et al. | Visual head tracking and slaving for visual telepresence | |
| JP2629291B2 (ja) | マニピュレータ学習制御方法 | |
| JPH08305473A (ja) | 三次元データ入力システム | |
| JPH0442144B2 (ja) | ||
| JPH0588721A (ja) | 関節型ロボツトの制御装置 | |
| JPH08309680A (ja) | マニピュレータ制御システム | |
| JPS60205721A (ja) | ロボツト動作教示装置 | |
| JP2552977B2 (ja) | 力フィードバック型多軸操作装置 | |
| JP3240817B2 (ja) | 速度指令による三次元座標入力方法 | |
| JPH06114766A (ja) | マニピュレータの遠隔制御装置 | |
| JPH0428507B2 (ja) | ||
| JPH0962437A (ja) | コンピュータ入力装置 | |
| JP2830205B2 (ja) | ロボットの制御装置 | |
| JP2832903B2 (ja) | 倣い制御の座標切替方式 |