JP4472072B2 - Manipulator control device - Google Patents
Manipulator control device Download PDFInfo
- Publication number
- JP4472072B2 JP4472072B2 JP33311399A JP33311399A JP4472072B2 JP 4472072 B2 JP4472072 B2 JP 4472072B2 JP 33311399 A JP33311399 A JP 33311399A JP 33311399 A JP33311399 A JP 33311399A JP 4472072 B2 JP4472072 B2 JP 4472072B2
- Authority
- JP
- Japan
- Prior art keywords
- manipulator
- master
- slave
- bit
- control unit
- 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 - Fee Related
Links
- 238000001514 detection method Methods 0.000 claims description 60
- 230000033001 locomotion Effects 0.000 claims description 48
- 230000005540 biological transmission Effects 0.000 claims description 18
- 238000000034 method Methods 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 12
- 238000012545 processing Methods 0.000 claims description 7
- 230000008859 change Effects 0.000 description 12
- 230000007246 mechanism Effects 0.000 description 11
- 238000011282 treatment Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 7
- 230000002123 temporal effect Effects 0.000 description 7
- 238000004891 communication Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 4
- 238000003780 insertion Methods 0.000 description 4
- 230000037431 insertion Effects 0.000 description 4
- 238000001356 surgical procedure Methods 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000003745 diagnosis Methods 0.000 description 3
- 238000013139 quantization Methods 0.000 description 3
- 210000003815 abdominal wall Anatomy 0.000 description 2
- 239000013307 optical fiber Substances 0.000 description 2
- 208000025174 PANDAS Diseases 0.000 description 1
- 208000021155 Paediatric autoimmune neuropsychiatric disorders associated with streptococcal infection Diseases 0.000 description 1
- 240000000220 Panda oleosa Species 0.000 description 1
- 235000016496 Panda oleosa Nutrition 0.000 description 1
- 210000000683 abdominal cavity Anatomy 0.000 description 1
- 230000005856 abnormality Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000000881 depressing effect Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 210000000232 gallbladder Anatomy 0.000 description 1
- 230000001939 inductive effect Effects 0.000 description 1
- 210000004072 lung Anatomy 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
Images
Landscapes
- Surgical Instruments (AREA)
- Manipulator (AREA)
Description
【0001】
【発明の属する技術分野】
本発明は、生体の、例えば体腔内に挿入したマニピュレータを操作手段によって遠隔的に操作し、診断・処置等の手術を行う手術用のマニピュレータ制御装置に関する。
【0002】
【従来の技術】
一般に、腹壁等の体壁に穴を開け、この穴を通じて内視鏡や処置具を経皮的に体腔内に挿入することにより、その体腔内での様々な処置を行なう経皮的内視鏡下手術が、大きな切開を要しない低侵襲なものとして、近年、注目されている。こうした術式は胆のう摘出手術や肺の一部を摘出除去する手術等で広く行なわれている。
【0003】
このような手術において、マニピュレータに内視鏡や処置具を搭載し、そのマニピュレータによる内視鏡や処置具を用いた手術を術者に代わって間接的に行う手術用マニピュレータシステムが、米国特許第5,217,003号や、特開平7−328016号公報などに示されている。
【0004】
図10はこの手術用マニピュレータシステムの概略構成を示すものである。このマニピュレータシステムには術野にアクセスするように設置されているスレーブマニピュレータaと、術者が操作できる領域内に設置されたジョイスティックなどのマスターマニピュレータbとが設けられている。ここで、スレーブマニピュレータaにはスレーブ制御部c、マスターマニピュレータbにはマスター制御部dがそれぞれ連結されている。
【0005】
さらに、スレーブ制御部cとマスター制御部dとの間は信号ケーブルなどの通信手段を介して連結されている。ここで、マスター制御部dにはマスターマニピュレータbの操作部の操作情報を検出するポテンショメータなどの検出手段が設けられている。そして、このポテンショメータなどの検出手段で得られたマスターマニピュレータbの操作情報の検出信号であるアナログ出力がA/D変換器によってデジタル出力の制御信号に変換されてマスター制御部dから通信手段を介してスレーブ制御部cに伝送されるようになっている。
【0006】
また、スレーブ制御部cからはマスター制御部dから送られるマスターマニピュレータbの操作部の操作に追従した動きをスレーブマニピュレータaに伝達する制御信号が出力されるようになっている。
【0007】
そして、こうした手術用マニピュレータの遠隔操作では、内視鏡等の観察手段によりモニターに映し出された腹腔内の患部の状態を見ながら、操作者がマスターマニピュレータbの操作部を操作することによって例えばマスターマニピュレータbの操作部の操作方向にスレーブマニピュレータaを動作させるようになっている。
【0008】
【発明が解決しようとする課題】
上記従来構成の手術用マニピュレータシステムではマスターマニピュレータbの位置・姿勢・鋏型の操作部の開閉角度などの動作情報はポテンショメータなどの検出手段で検出されたのち、このポテンショメータなどの検出手段からのアナログ出力がA/D変換器によって例えば256階調のデジタル出力の制御信号に変換されてマスター制御部dから通信手段を介してスレーブ制御部cに伝送されるようになっている。
【0009】
しかしながら、マスター制御部dのA/D変換器などは1チップマイコンなどの安価な電子部品が使用されているので、検出信号のノイズ、またはA/D変換器の量子化誤差により、図11に示すように検出データであるA/D値がxの場合にx±1bit程度のデータ変化が発生する問題がある。このような現象は、例えばマスターマニピュレータbの未使用時でも発生しているので、マスターマニピュレータbの停止中にマスターマニピュレータbの動作情報としてこの±1bit程度のデータ変化がマスター制御部dからスレーブ制御部cに伝送され、スレーブマニピュレータaの動きにつながる問題がある。そのため、マスターマニピュレータbの停止中にスレーブマニピュレータaが微小な振動が発生するなどの不要な動きや、手ブレ現象などの不要な動作を誘発する問題がある。
【0010】
本発明は上記事情に着目してなされたもので、その目的は、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができ、マスターマニピュレータの未使用時や、動作中のスレーブマニピュレータ挙動を安定化させて見栄えがよく、耐久性に優れたマニピュレータ制御装置を提供することにある。
【0011】
【課題を解決するための手段】
請求項1の発明は、術野にアクセスするように設置されたスレーブマニピュレータと、
術者が操作できる領域内に設置され、前記スレーブマニピュレータを遠隔的に操作するマスターマニピュレータと、このマスターマニピュレータに接続され、前記マスターマニピュレータの操作をアナログ電気信号に変換し、前記アナログ電気信号をさらにデジタル電気信号の動作情報に変換するマスター制御部と、前記スレーブマニピュレータおよび前記マスター制御部にそれぞれ接続され、前記マスター制御部から送られる前記マスターマニピュレータの操作に追従した動きを前記スレーブマニピュレータに伝達する制御信号を出力するスレーブ制御部と、前記マスターマニピュレータの動作情報を検出する動作情報検出部と、この動作情報検出部からの検出結果にもとづいて前記マスターマニピュレータの動作情報が予め設定された前記スレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはその微小な動作情報が前記スレーブマニピュレータ側に伝達されることをキャンセルするキャンセル手段とを具備したマニピュレータ制御装置であって、前記キャンセル手段は、前記動作情報が所定の基準値Xに対して±1bit以内であるか否かを判断し、±1bit以内であれば前記制御信号の出力をキャンセルし、±1bit以内でなければ前記制御信号をリアルタイムで出力するマニピュレータ制御装置である。
【0012】
そして、本請求項1の発明では、動作情報検出部によってマスターマニピュレータの動作情報を検出し、この動作情報検出部からの検出結果にもとづいてマスターマニピュレータの動作情報が予め設定されたスレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはキャンセル手段によってその微小な動作情報がスレーブマニピュレータ側に伝達されることをキャンセルすることにより、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐようにしたものである。
【0013】
請求項2の発明は、前記キャンセル手段は、前記マスター制御部から前記スレーブ制御部に制御信号を送信する送信処理の開始時にデータ更新モードにセットされ、前記データ更新モードにセットされた場合には前記マスター制御部から前記スレーブ制御部にデータがリアルタイムで送信されて更新され、またデータキャンセルモードにセットされた場合にはデータがキャンセルされる処理が行われるステップS1と、前記マスター制御部の出力信号が読み込まれるステップS2と、前記基準値Xが取得されるステップS3と、タイマーによって任意の設定時間がプリセットされるステップS4と、前記基準値Xが±1bit以内(X≦±1bit)か否かが判断されるステップS5と、前記ステップS5でXが±1bit以内ではない場合には基準値Xがクリアされたのち、前記ステップS2に戻されるステップS6と、前記ステップS5でXが±1bit以内であると判断された場合にはt=0か否かが判断され、t=0以外の場合にはステップS5に戻されるステップS7と、前記ステップS7でt=0と判断された場合に前記データキャンセルモードにセットされ、データのキャンセル処理が行われるステップS8と、前記ステップS8でデータのキャンセル処理が行われた後、基準値Xが±1bit以内(X≦±1bit)か否かが判断され、前記Xが±1bit以内ではない場合にはステップS8に戻され、前記Xが±1bit以内であると判断された場合にはステップS1に戻されるステップS9と、を具備することを特徴とする請求項1に記載のマニピュレータ制御装置である。
【0017】
請求項3の発明は、前記動作情報検出部は、前記マスターマニピュレータの可動部の動作情報を検出するセンサーを備え、前記キャンセル手段は、前記センサーからの検出結果にもとづいて前記マスターマニピュレータが操作されていない停止状態であることを判断し、前記マスターマニピュレータの停止状態の検出時には前記スレーブマニピュレータ側に伝達される前記動作情報を更新しないものであることを特徴とする請求項1に記載のマニピュレータ制御装置である。
【0018】
そして、本請求項3の発明では、動作情報検出部のセンサーによってマスターマニピュレータの可動部の動作情報を検出し、このセンサーからの検出結果にもとづいてキャンセル手段によってマスターマニピュレータが操作されていない停止状態であることを判断する。ここで、マスターマニピュレータの停止状態が検出された場合にはスレーブマニピュレータ側に伝達される動作情報を更新しないようにしたものである。
【0019】
【発明の実施の形態】
以下、本発明の第1の実施の形態を図1乃至図7を参照して説明する。図1は本実施の形態のマニピュレータ制御装置1のシステム全体の概略構成を示すものである。本実施の形態のマニピュレータ制御装置1には術野にアクセスするように設置されたスレーブマニピュレータ2と、術者が操作できる領域内に設置され、スレーブマニピュレータ2を遠隔的に操作するマスターマニピュレータ3とが設けられている。ここで、スレーブマニピュレータ2には2組のスレーブマニピュレータ、すなわち左側スレーブマニピュレータ2aと、右側スレーブマニピュレータ2bとが設けられている。さらに、マスターマニピュレータ3にも同様に左側スレーブマニピュレータ2aを操作する左側マスターマニピュレータ3aと、右側スレーブマニピュレータ2bを操作する右側マスターマニピュレータ3bとが設けられている。
【0020】
また、2つのスレーブマニピュレータ2a,2b、マスターマニピュレータ3a,3bはそれぞれ略同一構成になっているので、ここでは一方の左側のスレーブマニピュレータ2aおよびマスターマニピュレータ3aの構成のみを説明し、右側のスレーブマニピュレータ2bおよびマスターマニピュレータ3bの同一部分には同一の符号を付してその説明を省略する。
【0021】
すなわち、本実施の形態の左側のスレーブマニピュレータ2aには細長い挿入部4を備えたマニピュレータ本体5と、このマニピュレータ本体5を駆動するスレーブ駆動部6とが設けられている。さらに、挿入部4の先端部には図3に示すように例えば把持鉗子のように開閉可能な1対の把持部材7a,7bを備えた先端把持部7が設けられている。これらの把持部材7a,7bの基端部間は挿入部4の先端部に回動ピン8を中心に回動可能に連結されている。そして、これらの把持部材7a,7bはリンク機構部9によって回動ピン8を中心に開閉可能に支持されている。
【0022】
また、マニピュレータ本体5はスレーブ駆動部6内の図示しないマニピュレータ本体駆動ユニットによって図3中で、X軸方向(左右方向)、Y軸方向(上下方向)、Z軸方向(前後方向)にそれぞれ移動可能に駆動され、かつZ軸の軸回り方向に回動駆動されるようになっている。さらに、マニピュレータ本体5の先端把持部7も同様にスレーブ駆動部6内の図示しない先端把持部駆動ユニットによって把持部材7a,7b間が回動ピン8を中心に開閉駆動されるようになっている。なお、図3中で、Osはスレーブマニピュレータ2aのマニピュレータ本体5の原点位置である。
【0023】
また、左側マスターマニピュレータ3aには図2に示すように例えば略鋏型の開閉動作可能なハンドル(操作部)10と、このハンドル10を図2中で、X軸方向(左右方向)、Y軸方向(上下方向)、Z軸方向(前後方向)にそれぞれ移動可能に、かつZ軸の軸回り方向に回動可能に支持する支持機構部11(図4に示す)とが設けられている。なお、図2中で、OM はマスターマニピュレータ3aのハンドル10の原点位置である。
【0024】
また、ハンドル10には図2に示すようにトッププレート12に一端部が固定された支軸13と、この支軸13の他端部に回動軸14を中心に回動可能に連結された2つのハンドル部材15a,15bとが設けられている。さらに、2つのハンドル部材15a,15b間には回動軸14側にリンク部材16、自由端部側に板ばね部材17がそれぞれ配設されている。そして、このハンドル10は板ばね部材17のばね力によって図2中に実線で示すように全開位置方向に付勢されている。
【0025】
また、このハンドル10の一方のハンドル部材15aにはストッパ18が他方のハンドル部材15b側に向けて突設されている。そして、このハンドル10の閉操作時には図2中に仮想線で示すようにハンドル部材15aのストッパ18がハンドル部材15bに突き当たることにより、このハンドル10の閉操作が規制され、この状態が全閉位置に設定されている。
【0026】
さらに、ハンドル10のハンドル部材15aにはポテンショメータ19が取付けられている。そして、このポテンショメータ19によってハンドル10の開閉角度が検出されるようになっている。
【0027】
また、マスターマニピュレータ3aの支持機構部11はパンタグラフ機構を複数組み合わせて構成された多自由度マニピュレータによって形成されている。ここで、出力節であるトッププレート12には、3つのパンタグラフと3つの回転対偶軸とが取付けられている。なお、各パンダグラフ、対偶軸には、図示しないエンコーダが取付けられている。そして、このエンコーダによってハンドル10の操作を検出する検出手段が形成されている。さらに、マスターマニピュレータ3にはこのマスターマニピュレータ3を操作不能なロック状態と、このマスターマニピュレータ3の操作が可能なロック解除状態とに切換える例えば電磁ロック式の図示しないロック機構部が組込まれている。
【0028】
また、マスターマニピュレータ3にはこのマスターマニピュレータ3の操作を電気信号に変換するマスター制御部20が接続されている。このマスター制御部20にはマスターマニピュレータ3のポテンショメータ19および支持機構部11のエンコーダなどの位置検出装置(動作情報検出部)21と、例えば位置計算用のコンピュータによって形成される演算回路22とが設けられている。そして、位置検出装置21による左右のマスターマニピュレータ3a,3bの操作状態の検出データ(L検出信号、R検出信号)は演算回路22に入力され、この演算回路22で位置計算されてマスターマニピュレータ3のハンドル10の操作状態や、ハンドル10の開閉状態などのデータが算出されるようになっている。
【0029】
さらに、このマスター制御部20にはマスターマニピュレータ3のロック機構部の制御用のフットスイッチ23が接続されている。このフットスイッチ23には2つのペダル23a,23bが設けられている。そして、一方のペダル23aによってマスターマニピュレータ3のロック状態と、ロック解除状態とを切換えるロック状態の切換え操作部、他方のペダル23bによって移動用クラッチの切換え操作部がそれぞれ形成されている。
【0030】
なお、マスターマニピュレータ3を操作する術者の近傍位置にはモニター24が配置されている。そして、このモニター24に表示される表示画面を見ながらマスターマニピュレータ3の操作が行われるようになっている。
【0031】
また、スレーブマニピュレータ2にはマスターマニピュレータ3の操作に追従した動きをスレーブマニピュレータ2に伝達する制御信号を出力するスレーブ制御部25が接続されている。このスレーブ制御部25にはスレーブマニピュレータ2のスレーブ駆動部6に組込まれている複数の駆動モータ26を制御するモータ駆動回路27と、例えばスレーブマニピュレータ制御用のコンピュータによって形成される演算回路28とが設けられている。
【0032】
さらに、スレーブ制御部25の演算回路28とマスター制御部20の演算回路22との間は例えば光ファイバーケーブルなどの通信手段29を介して接続されている。そして、スレーブ制御部25ではマスター制御部20から送られるマスターマニピュレータ3の操作に追従した動きをスレーブマニピュレータ2に伝達する制御信号を出力するようになっている。
【0033】
また、マスター制御部20の演算回路22には図5に示すように位置検出装置21に接続されたA/D変換器30と、タイマー31と、キャンセル手段32と、CPU33とが設けられている。そして、マスターマニピュレータ3のポテンショメータ19および支持機構部11のエンコーダなどの位置検出装置21で得られたマスターマニピュレータ3のハンドル10の開閉角度や、ハンドル10のX軸方向、Y軸方向、Z軸方向の各移動量や、Z軸の軸回り方向の回動角度などのマスターマニピュレータ3の可動部の位置・姿勢などの操作情報の検出信号であるアナログ出力がA/D変換器30によって例えば256階調のデジタル出力の制御信号に変換されてCPU33に入力され、このデジタル出力の制御信号がマスター制御部22から通信手段29を介してスレーブ制御部25に伝送されるようになっている。なお、CPU33には図示しない伝達倍率変換回路が内蔵されている。そして、マスターマニピュレータ3のハンドル10のX軸方向、Y軸方向、Z軸方向の各移動量の検出データはこの伝達倍率変換回路によって任意の伝達倍率に変換されてスレーブ制御部25に伝送され、ハンドル10の開閉角度の検出データは1:1でスレーブ制御部25に伝送されるようになっている。
【0034】
また、キャンセル手段32には位置検出装置21からの検出結果にもとづいてマスターマニピュレータ3の動作情報が予め設定されたスレーブマニピュレータ2の動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ2側に伝達されることをキャンセルする機能が設けられている。ここで、キャンセル手段32はマスターマニピュレータ3の動作情報の時間的変化量が予め設定されたスレーブマニピュレータ2の動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはスレーブマニピュレータ側に伝達される動作情報を更新しないように設定されている。なお、このキャンセル手段32には位置検出装置21で検出される動作情報の時間的変化量の設定範囲を任意に変更する設定値調整部(設定範囲調整手段)34が接続されている。
【0035】
次に、上記構成の作用について説明する。本実施の形態のマニピュレータ制御装置1の使用時には、マスターマニピュレータ3が術者が操作できる領域内に設置される。さらに、スレーブマニピュレータ2は術野にアクセスするように設置される。例えば、図4に示すように予め診断・処置等の手術を行う患者の腹壁等の体壁Hに図示しないトロッカーによって穴を開け、この穴に刺入されたトロッカー外套管内にスレーブマニピュレータ2の挿入部4が挿入され、このトロッカー外套管内を通じてスレーブマニピュレータ2の挿入部4が経皮的に体腔内に挿入された状態にセットされる。このとき、マスターマニピュレータ3を操作する術者の近傍位置のモニター24にはスレーブマニピュレータ2とは別の場所から経皮的に体腔内に挿入された内視鏡による術野の内視鏡像、或いはコンピュータグラフィック装置によって合成された術野のコンピュータグラフィック画像(CG画像)などが表示される。
【0036】
また、スレーブマニピュレータ2およびマスターマニピュレータ3のセット後、これらのスレーブマニピュレータ2およびマスターマニピュレータ3の原点(0点)位置を対応させるキャリブレーション動作が行われる。このキャリブレーション動作時にはフットスイッチ23のペダル23aを踏むことにより、マスターマニピュレータ3のロックが解除され、マスターマニピュレータ3の左右のマスターマニピュレータ3a,3bが図2中で、X軸方向(左右方向)、Y軸方向(上下方向)、Z軸方向(前後方向)にそれぞれ移動可能、かつZ軸の軸回り方向に回動可能な状態にそれぞれ切換えられるとともに、左右のマスターマニピュレータ3a,3bの2つのハンドル部材15a,15b間が開閉動作可能な状態にそれぞれ切換えられる。
【0037】
この状態で、マスターマニピュレータ3の左右のマスターマニピュレータ3a,3bが任意の位置に移動され、左右のマスターマニピュレータ3a,3bの原点(0点)位置が設定される。
【0038】
その後、スレーブマニピュレータ2における2つのスレーブマニピュレータ2a,2bのスレーブ駆動部6内の図示しないマニピュレータ本体駆動ユニットおよび先端把持部駆動ユニットが駆動される。これにより、マニピュレータ本体5が図3中で、X軸方向(左右方向)、Y軸方向(上下方向)、Z軸方向(前後方向)にそれぞれ移動され、かつZ軸の軸回り方向に回動駆動されて予め設定された左右のスレーブマニピュレータ2a,2bの原点(0点)位置に移動される。このとき、スレーブマニピュレータ2a,2bの移動範囲が予め決められた適正範囲でない場合は、警告表示等を行い異常を操作者に告知を行っている。
【0039】
さらに、このキャリブレーション動作の終了後、本実施の形態のマニピュレータ制御装置1による診断・処置等の手術が開始される。この手術時には術者はモニター24に表示される術野の内視鏡像、或いはCG画像の画面を見ながらマスターマニピュレータ3の左右のマスターマニピュレータ3a,3bがそれぞれ操作される。このとき、左側マスターマニピュレータ3aのハンドル10が術者の左手、右側マスターマニピュレータ3bのハンドル10が術者の右手で握られた状態でそれぞれ操作され、左側マスターマニピュレータ3aによって左側スレーブマニピュレータ2a、右側マスターマニピュレータ3bによって右側スレーブマニピュレータ2bがそれぞれ独立に遠隔操作される。
【0040】
例えば、左側マスターマニピュレータ3aのハンドル10を図2中で、X軸方向(左右方向)、Y軸方向(上下方向)、Z軸方向(前後方向)にそれぞれ移動させ、かつZ軸の軸回り方向に回動させた場合にはこのときのマスターマニピュレータ3aの動作がマスター制御部20の位置検出装置21で検出される。この位置検出装置21からの検出データは演算回路22に入力される。このとき、マスターマニピュレータ3のポテンショメータ19および支持機構部11のエンコーダなどの位置検出装置21で得られたマスターマニピュレータ3のハンドル10の開閉角度や、ハンドル10のX軸方向、Y軸方向、Z軸方向の各移動量や、Z軸の軸回り方向の回動角度などのマスターマニピュレータ3の可動部の位置・姿勢などの操作情報の検出信号であるアナログ出力は演算回路22のA/D変換器30によって例えば256階調のデジタル出力の制御信号に変換されてCPU33に入力される。そして、この演算回路22のCPU33で位置計算されてマスターマニピュレータ3のハンドル10の操作状態や、ハンドル10の開閉状態などのデータが算出される。
【0041】
さらに、マスター制御部20の演算回路22で位置計算された算出データは光ファイバーケーブルなどの通信手段29を介してスレーブ制御部25に送信される。ここで、マスターマニピュレータ3のハンドル10のX軸方向、Y軸方向、Z軸方向の各移動量の検出データはCPU33内の図示しない伝達倍率変換回路によって任意の伝達倍率に変換されてスレーブ制御部25に伝送され、ハンドル10の開閉角度の検出データは1:1でスレーブ制御部25に伝送される。
【0042】
また、スレーブ制御部25では受信された制御信号にもとづいて演算回路28によってスレーブ駆動部6に組込まれているモータ駆動回路27の複数の駆動モータ26を制御する制御信号が算出される。そして、このスレーブ制御部25から出力される制御信号が左側スレーブマニピュレータ2aに伝達され、左側スレーブマニピュレータ2aが遠隔的に操作される。このとき、左側スレーブマニピュレータ2aは左側マスターマニピュレータ3aのハンドル10の動きに追従して動く。なお、右側マスターマニピュレータ3bの操作時にも同様の作用によって右側スレーブマニピュレータ2bの動作が制御され、右側マスターマニピュレータ3bの操作に追従して右側スレーブマニピュレータ2bが動くようになっている。
【0043】
また、本実施の形態のマニピュレータ制御装置1の動作中、位置検出装置21からの検出結果にもとづいてマスターマニピュレータ3の動作情報が予め設定されたスレーブマニピュレータ2の動作制御用の所定の設定範囲、例えばA/D値が基準値Xに対して±1bit以内の微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ2側に伝達されることをキャンセルするキャンセル動作が図7に示すフローチャートにしたがって次のように行われる。
【0044】
すなわち、マスター制御部22からスレーブ制御部25に制御信号を送信する送信処理の開始時にはステップS1で、送信ビットが「0」にセットされる。ここで、送信ビットが「0」にセットされた場合にはマスター制御部20からスレーブ制御部25にデータがリアルタイムで送信されて更新され、また送信ビットが「1」にセットされた場合にはデータがキャンセルされる処理が行われる。
【0045】
続いて、次のステップS2ではA/D変換器30の出力信号が読み込まれ、次のステップS3で、図6に示す基準値Xが取得される。さらに、次のステップS4ではタイマー31によって例えばt=2秒がプリセットされる。
【0046】
また、次のステップS5では基準値Xが±1bit以内(X≦±1bit)か否かが判断される。ここで、Xが±1bit以内ではない場合にはステップS6に進み、基準値Xがクリアされたのち、ステップS2に戻される。さらに、ステップS5でXが±1bit以内であると判断された場合にはステップS7に進む。
【0047】
このステップS7ではt=0か否かが判断される。ここで、t=0以外の場合にはステップS5に戻される。ステップS7でt=0と判断された場合には次のステップS8に進む。このステップS8では送信ビットが「1」にセットされ、データのキャンセル処理が行われる。
【0048】
その後、次のステップS9で基準値Xが±1bit以内(X≦±1bit)か否かが判断される。ここで、Xが±1bit以内ではない場合にはステップS8に戻される。また、ステップS9でXが±1bit以内であると判断された場合にはステップS1に戻される。
【0049】
なお、位置検出装置21にはマスターマニピュレータ3の位置検出用のポテンショメータ19や、支持機構部11のエンコーダなどの複数の検出要素が設けられているので、全て(n個)の検出要素のA/D値に対して基準値XはA/D1〜A/DnのAND条件でキャンセル期間が判定される。
【0050】
これにより、時刻t0で位置検出装置21の出力信号を基準値Xとしてサンプリングしたのち、任意の設定時間t(例えばt=2秒)の間、基準値X±1ビット以内である状態を認識した場合には、マスターマニピュレータ3が停止している状態と判断(判定時間t後)してマスターマニピュレータ3からスレーブマニピュレータ2に送信する位置・姿勢・開閉角の情報がキャンセルされる。また、基準値X±1ビット以上になった場合にはマスターマニピュレータ3が移動している状態と判断し、マスターマニピュレータ3からスレーブマニピュレータ2に送信する位置・姿勢・開閉角の情報が更新される。なお、基準値Xは定期的にサンプリングされ、判定期間tでX±1ビット以内であれば新たにマスターマニピュレータ3からスレーブマニピュレータ2に送信する情報はキャンセルされる。
【0051】
また、設定値調整部34によってキャンセル手段32による位置検出装置21で検出される動作情報の時間的変化量の設定範囲であるキャンセルbitの幅を任意に変更して設定することができる。
【0052】
そこで、上記構成のものにあっては次の効果を奏する。すなわち、本実施の形態ではマニピュレータ制御装置1の動作中、位置検出装置21からの検出結果にもとづいてマスターマニピュレータ3の動作情報が予め設定されたスレーブマニピュレータ2の動作制御用の所定の設定範囲、例えばA/D値が基準値Xに対して±1bit以内の微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ2側に伝達されることをキャンセルするキャンセル動作が行われる。そのため、位置検出装置21のポテンショメータ19などの出力信号に対するノイズの重畳で、スレーブマニピュレータ2が振動する動作(ノイズによる振動動作)や、A/D変換器30の量子化誤差によるデジタルノイズの影響でスレーブマニピュレータ2が振動する動作(ノイズによる振動)をキャンセルすることができる。したがって、マスターマニピュレータ3の未使用時にスレーブマニピュレータ2が振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができるので、マスターマニピュレータ3の未使用時や、動作中のスレーブマニピュレータ2の挙動を安定化させて見栄えがよく、耐久性に優れる。
【0053】
さらに、格別に高精度なA/D変換器30などの電子回路を使用することなく入力信号の不要な情報をソフトウエア的に取り除くことができるので、装置全体のコスト低下を図ることができる。
【0054】
また、図8および図9は本発明の第2の実施の形態を示すものである。本実施の形態は第1の実施の形態(図1乃至図7参照)のマニピュレータ制御装置1の構成を次の通り変更したものである。
【0055】
すなわち、本実施の形態ではマスターマニピュレータ3のトッププレート12にハンドル10のX軸方向(左右方向)、Y軸方向(上下方向)、Z軸方向(前後方向)の3方向の移動を検出する3軸加速度センサ41を取付け、この3軸加速度センサ41からの検出信号により、マスターマニピュレータ3の動作情報が予め設定されたスレーブマニピュレータ2の動作制御用の所定の設定範囲、例えばA/D値が基準値Xに対して±1bit以内の微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ2側に伝達されることをキャンセルするキャンセル動作を行わせる構成にしたものである。ここでは、3軸加速度センサ41によって図9に示すようにハンドル10のX軸方向、Y軸方向、Z軸方向の3方向の移動が検出されるので、この3軸加速度センサ41によって停止期間tOFF を検出している間、スレーブマニピュレータ2に送信する情報をキャンセルする。
【0056】
そこで、本実施の形態ではマスターマニピュレータ3の停止状態を確実に検出可能となる。さらに、マスター制御部20の制御用CPU33の負荷を軽減させることが可能となる効果がある。
【0057】
さらに、本発明は上記実施の形態に限定されるものではなく、本発明の要旨を逸脱しない範囲で種々変形実施できることは勿論である。
次に、本出願の他の特徴的な技術事項を下記の通り付記する。
記
(付記項1) マスタースレーブ装置において、マスター入力装置の位置・姿勢・開閉角度を検出する信号検出手段、前記信号検出手段でマスタ入力装置の未使用時(停止状態)を検出する移動量検出手段、前記移動量検出手段にてマスター入力装置が未使用(移動停止)していたことを利用してスレーブ側に送信する位置・姿勢・開閉角度の情報を更新しない情報キャンセル手段を備えたマスタースレーブ装置。
【0058】
(付記項2) ポテンショメータの時間的変化量から前記未使用時を検出する前記付記項1のマスタースレーブ装置。
【0059】
(付記項3) センサーを付加して前記未使用時を検出する前記付記項1のマスタースレーブ装置。
【0060】
(付記項4) 各リンク機構の傾き情報から位置・姿勢・開閉角度を算出できるマスター入力装置を備えたマスタースレーブ装置において、マスター入力装置の位置・姿勢・開閉角を算出する動作状態検出部、前記動作状態検出部にてマスター入力装置の位置・姿勢・開閉角の時間的変化量が規定の値以下ならば、前記位置・姿勢・開閉角の情報を更新しない情報キャンセル手段を備えたマスタースレーブ装置。
【0061】
(付記項5) 前記動作状態検出部で時間的変化量が任意に可変可能な前記情報キャンセル手段を備えた付記項4のマスタースレーブ装置。
【0062】
(付記項6) 前記マスター入力装置において、可動部の動きを検出するセンサーを備え、前記センサーの情報を元にマスター入力装置が操作されていないことを判断する停止状態検出手段、前記停止状態検出手段からマスター入力装置の未使用時状態を検出し、前記位置・姿勢・開閉角の情報を更新しない付記項4及び付記項5のマスタースレーブ装置。
【0063】
(付記項1〜6の従来技術) 手術用マニピュレータシステムが、米国特許第5,217,003号や、特開平7−328016号公報などに示されている。
【0064】
(付記項1〜6が解決しようとする課題) 検出信号のノイズまたはA/Dの量子化誤差によるデータの変化値が、マスター入力装置の未使用時でもスレーブの動きにつながってスレーブの振動動作を誘発していた。
【0065】
(付記項1〜6の目的) マスター入力装置の未使用時を検出することで、スレーブの不要な動作(振動)を防ぐことを目的とする。
【0066】
(付記項1〜6の効果) 高精度な回路を用いることなく、入力信号の不要な情報をソフトウエアにより取り除くことができる。操作を停止し、ハンドルを保持しているときの手の振動をスレーブに伝達しない(手ブレ補正)。確実にマスターアームの停止状態を検出可能。また、制御用CPUの負荷を軽減させることが可能。
【0067】
【発明の効果】
請求項1の発明によれば、マスターマニピュレータの動作情報を検出する動作情報検出部と、この動作情報検出部からの検出結果にもとづいてマスターマニピュレータの動作情報が予め設定されたスレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ側に伝達されることをキャンセルするキャンセル手段とを設けたので、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができ、マスターマニピュレータの未使用時や、動作中のスレーブマニピュレータ挙動を安定化させて見栄えがよく、耐久性に優れる。
【0068】
請求項2の発明によれば、マスターマニピュレータの操作部の操作によってスレーブマニピュレータの処置部の開閉動作およびスレーブマニピュレータの姿勢制御部を操作する際に、動作情報検出部によって検出されたマスターマニピュレータの処置部の開閉角度や、マスターマニピュレータの可動部の位置・姿勢などのマスターマニピュレータの姿勢情報などの動作情報の時間的変化量が予め設定されたスレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはキャンセル手段によってスレーブマニピュレータ側に伝達される動作情報を更新しないようにしたので、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができ、マスターマニピュレータの未使用時や、動作中のスレーブマニピュレータ挙動を安定化させて見栄えがよく、耐久性に優れる。
【0069】
請求項3の発明によれば、キャンセル手段の設定範囲調整手段によって動作情報検出部で検出される動作情報の時間的変化量の設定範囲を任意に変更することができる。
【0070】
請求項4の発明によれば、動作情報検出部のセンサーによってマスターマニピュレータの可動部の動作情報を検出し、このセンサーからの検出結果にもとづいてキャンセル手段によってマスターマニピュレータが操作されていない停止状態であることを判断してマスターマニピュレータの停止状態が検出された場合にはスレーブマニピュレータ側に伝達される動作情報を更新しないようにしたので、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができる。
【図面の簡単な説明】
【図1】 本発明の第1の実施の形態におけるマニピュレータ制御装置のシステム全体の概略構成図。
【図2】 第1の実施の形態のマニピュレータ制御装置におけるマスターマニピュレータの操作部を一部断面にして示す側面図。
【図3】 第1の実施の形態のマニピュレータ制御装置におけるスレーブマニピュレータの先端把持部を示す要部の斜視図。
【図4】 第1の実施の形態のマニピュレータ制御装置の使用状態を示す全体の概略構成図。
【図5】 第1の実施の形態のマニピュレータ制御装置におけるマスター制御部の演算回路の概略構成図。
【図6】 第1の実施の形態のマニピュレータ制御装置におけるマスターマニピュレータの動作を説明するための説明図。
【図7】 第1の実施の形態のマニピュレータ制御装置におけるキャンセル手段の動作を説明するためのフローチャート。
【図8】 本発明の第2の実施の形態のマニピュレータ制御装置におけるマスターマニピュレータの操作部を一部断面にして示す側面図。
【図9】 第2の実施の形態のマニピュレータ制御装置におけるスレーブマニピュレータの動作を説明するための説明図。
【図10】 従来の手術用マニピュレータシステムの概略構成図。
【図11】 従来の手術用マニピュレータシステムにおけるスレーブマニピュレータの動作状態を説明するための説明図。
【符号の説明】
2 スレーブマニピュレータ
3 マスターマニピュレータ
20 マスター制御部
21 位置検出装置(動作情報検出部)
22 演算回路
25 スレーブ制御部
32 キャンセル手段[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a manipulator control device for a surgical operation in which a manipulator inserted in a body cavity, for example, a living body is remotely operated by an operation means to perform a diagnosis or treatment operation.
[0002]
[Prior art]
In general, a percutaneous endoscope that performs various treatments in a body cavity by making a hole in a body wall such as an abdominal wall and inserting an endoscope or a treatment tool percutaneously into the body cavity through the hole. In recent years, lower surgery has attracted attention as a minimally invasive technique that does not require a large incision. Such an operation is widely performed in gallbladder extraction surgery or surgery for removing a part of the lung.
[0003]
In such an operation, a surgical manipulator system in which an endoscope and a treatment tool are mounted on a manipulator and an operation using the endoscope and the treatment tool by the manipulator is performed indirectly on behalf of an operator is disclosed in US Pat. No. 5,217,003, Japanese Patent Laid-Open No. 7-328016, and the like.
[0004]
FIG. 10 shows a schematic configuration of this surgical manipulator system. This manipulator system is provided with a slave manipulator a that is installed so as to access the operative field, and a master manipulator b such as a joystick that is installed in an area where the operator can operate. Here, a slave control unit c is connected to the slave manipulator a, and a master control unit d is connected to the master manipulator b.
[0005]
Further, the slave control unit c and the master control unit d are connected via communication means such as a signal cable. Here, the master control unit d is provided with detection means such as a potentiometer that detects operation information of the operation unit of the master manipulator b. Then, an analog output, which is a detection signal of operation information of the master manipulator b obtained by the detection means such as the potentiometer, is converted into a digital output control signal by the A / D converter and is transmitted from the master control unit d via the communication means. Are transmitted to the slave controller c.
[0006]
The slave control unit c outputs a control signal for transmitting the movement following the operation of the operation unit of the master manipulator b sent from the master control unit d to the slave manipulator a.
[0007]
In such remote operation of the surgical manipulator, the operator operates the operation unit of the master manipulator b while observing the state of the affected part in the abdominal cavity displayed on the monitor by observation means such as an endoscope. The slave manipulator a is operated in the operation direction of the operation unit of the manipulator b.
[0008]
[Problems to be solved by the invention]
In the surgical manipulator system having the above-described conventional configuration, the operation information such as the position / posture of the master manipulator b and the opening / closing angle of the saddle-shaped operation unit is detected by a detecting means such as a potentiometer, The output is converted to a digital output control signal of, for example, 256 gradations by an A / D converter, and transmitted from the master control unit d to the slave control unit c via communication means.
[0009]
However, since an inexpensive electronic component such as a one-chip microcomputer is used for the A / D converter or the like of the master control unit d, the detection signal noise or the quantization error of the A / D converter causes an error in FIG. As shown, there is a problem that data change of about x ± 1 bit occurs when the A / D value as detection data is x. Such a phenomenon occurs even when, for example, the master manipulator b is not used. Therefore, when the master manipulator b is stopped, the data change of about ± 1 bit is performed by the master control unit d as slave operation information. There is a problem of being transmitted to the part c and leading to the movement of the slave manipulator a. Therefore, there is a problem that the slave manipulator a induces unnecessary movement such as minute vibrations and unnecessary movement such as a camera shake phenomenon while the master manipulator b is stopped.
[0010]
The present invention was made paying attention to the above circumstances, and its purpose is to prevent unnecessary operations such as vibration of the slave manipulator when the master manipulator is not used, and unnecessary operations such as a camera shake phenomenon, An object of the present invention is to provide a manipulator control device that is excellent in appearance and excellent in durability by stabilizing the behavior of a slave manipulator when the master manipulator is not used or during operation.
[0011]
[Means for Solving the Problems]
The invention of
A master manipulator that is installed in an area where an operator can operate and remotely operates the slave manipulator, and is connected to the master manipulator, and operates the master manipulator.analogConvert to electrical signalThe analog electrical signal is further converted into digital electrical signal operation information.And a slave control unit that is connected to the slave manipulator and the master control unit, and outputs a control signal that transmits the movement following the operation of the master manipulator sent from the master control unit to the slave manipulator A motion information detection unit that detects motion information of the master manipulator, and a predetermined control for motion control of the slave manipulator in which the motion information of the master manipulator is preset based on a detection result from the motion information detection unit. In the case of minute movement information smaller than the set range, there is provided canceling means for canceling transmission of the minute movement information to the slave manipulator side.TamaNipulator control deviceThe cancel means determines whether the operation information is within ± 1 bit with respect to a predetermined reference value X, and cancels the output of the control signal if within ± 1 bit, and ± 1 bit. A manipulator control device that outputs the control signal in real time if not withinIt is.
[0012]
In the first aspect of the present invention, the operation information of the master manipulator is detected by the operation information detection unit, and the operation information of the master manipulator is preset based on the detection result from the operation information detection unit. In the case of minute movement information smaller than a predetermined setting range for control, the slave manipulator can be operated when the master manipulator is not used by canceling that the minute movement information is transmitted to the slave manipulator side by the canceling means. It is intended to prevent unnecessary movements such as vibration and unnecessary movements such as camera shake.
[0013]
The invention of claim 2The canceling unit is set in a data update mode at the start of transmission processing for transmitting a control signal from the master control unit to the slave control unit, and when set in the data update mode, the master control unit sends the slave to the slave Step S1 in which data is transmitted and updated in real time to the control unit, and when the data cancel mode is set, a process for canceling the data is performed, and step S2 in which the output signal of the master control unit is read. Step S3 in which the reference value X is acquired, Step S4 in which an arbitrary set time is preset by a timer, and Step S5 in which it is determined whether or not the reference value X is within ± 1 bit (X ≦ ± 1 bit). If X is not within ± 1 bit in step S5, the reference value X is cleared. After that, if it is determined in step S6 returned to step S2 and in step S5 that X is within ± 1 bit, it is determined whether or not t = 0. Step S7 returned to step S5, step S8 in which the data cancel mode is set when t = 0 is determined in step S7, and the data cancel process is performed in step S8. After the determination, it is determined whether or not the reference value X is within ± 1 bit (X ≦ ± 1 bit). If the X is not within ± 1 bit, the process returns to step S8, and the X is within ± 1 bit. Step S9 is returned to Step S1 if it is determined thatThe manipulator control device according to
[0017]
Claim3In the invention, the motion information detection unit includes a sensor that detects motion information of the movable portion of the master manipulator, and the cancel unit stops when the master manipulator is not operated based on a detection result from the sensor. 2. The manipulator control device according to
[0018]
And this claim3In the invention, the motion information of the movable part of the master manipulator is detected by the sensor of the motion information detection unit, and based on the detection result from this sensor, it is determined that the master manipulator is in a stopped state where the master manipulator is not operated. . Here, when the stop state of the master manipulator is detected, the operation information transmitted to the slave manipulator side is not updated.
[0019]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, a first embodiment of the present invention will be described with reference to FIGS. FIG. 1 shows a schematic configuration of the entire system of the
[0020]
Since the two
[0021]
That is, the
[0022]
The
[0023]
Further, as shown in FIG. 2, the
[0024]
Further, as shown in FIG. 2, the
[0025]
Further, a
[0026]
Further, a
[0027]
The
[0028]
The master manipulator 3 is connected to a
[0029]
Furthermore, a
[0030]
A
[0031]
The slave manipulator 2 is connected to a
[0032]
Further, the
[0033]
Further, the
[0034]
Further, in the canceling
[0035]
Next, the operation of the above configuration will be described. When the
[0036]
In addition, after the slave manipulator 2 and the master manipulator 3 are set, a calibration operation is performed to match the origin (0 point) positions of the slave manipulator 2 and the master manipulator 3. When the calibration operation is performed, the master manipulator 3 is unlocked by depressing the pedal 23a of the
[0037]
In this state, the left and
[0038]
Thereafter, the manipulator body drive unit and the tip gripping unit drive unit (not shown) in the slave drive unit 6 of the two
[0039]
Further, after this calibration operation is completed, an operation such as diagnosis / treatment by the
[0040]
For example, the
[0041]
Further, the calculated data whose position is calculated by the
[0042]
In the
[0043]
In addition, during the operation of the
[0044]
That is, at the start of transmission processing for transmitting a control signal from the
[0045]
Subsequently, in the next step S2, the output signal of the A / D converter 30 is read, and in the next step S3, the reference value X shown in FIG. 6 is acquired. Further, in the next step S4, for example, t = 2 seconds is preset by the
[0046]
In the next step S5, it is determined whether or not the reference value X is within ± 1 bit (X ≦ ± 1 bit). If X is not within ± 1 bit, the process proceeds to step S6, and after the reference value X is cleared, the process returns to step S2. Further, if it is determined in step S5 that X is within ± 1 bit, the process proceeds to step S7.
[0047]
In step S7, it is determined whether t = 0. If t = 0 is not satisfied, the process returns to step S5. If it is determined in step S7 that t = 0, the process proceeds to the next step S8. In this step S8, the transmission bit is set to “1”, and data cancellation processing is performed.
[0048]
Thereafter, in the next step S9, it is determined whether or not the reference value X is within ± 1 bit (X ≦ ± 1 bit). If X is not within ± 1 bit, the process returns to step S8. If it is determined in step S9 that X is within ± 1 bit, the process returns to step S1.
[0049]
Since the
[0050]
Thereby, after sampling the output signal of the
[0051]
In addition, the setting
[0052]
Therefore, the above configuration has the following effects. That is, in the present embodiment, during operation of the
[0053]
Furthermore, since unnecessary information of the input signal can be removed by software without using an electronic circuit such as the highly accurate A / D converter 30, the cost of the entire apparatus can be reduced.
[0054]
8 and 9 show a second embodiment of the present invention. In the present embodiment, the configuration of the
[0055]
That is, in the present embodiment, the
[0056]
Therefore, in the present embodiment, the stop state of the master manipulator 3 can be reliably detected. Furthermore, there is an effect that the load on the
[0057]
Furthermore, the present invention is not limited to the above-described embodiment, and various modifications can be made without departing from the scope of the present invention.
Next, other characteristic technical matters of the present application are appended as follows.
Record
(Additional Item 1) In the master-slave device, signal detection means for detecting the position / posture / opening / closing angle of the master input device, and movement amount detection means for detecting when the master input device is not used (stopped) by the signal detection means. The master / slave provided with the information canceling means that does not update the position / posture / opening / closing angle information to be transmitted to the slave side using the fact that the master input device is not used (moving stopped) in the moving amount detecting means apparatus.
[0058]
(Additional Item 2) The master-slave device according to
[0059]
(Additional Item 3) The master-slave device according to
[0060]
(Additional Item 4) In a master-slave device including a master input device capable of calculating a position / posture / opening / closing angle from inclination information of each link mechanism, an operation state detection unit for calculating the position / posture / opening / closing angle of the master input device; A master-slave comprising information canceling means that does not update the position / posture / opening / closing angle information if the temporal change amount of the position / posture / opening / closing angle of the master input device is equal to or less than a predetermined value in the operation state detection unit apparatus.
[0061]
(Additional Item 5) The master-slave device according to
[0062]
(Additional Item 6) The master input device includes a sensor that detects the movement of the movable portion, and a stop state detection unit that determines that the master input device is not operated based on information of the sensor, the stop state detection The master-slave device according to any one of
[0063]
(Prior Art of Additional Items 1-6) A manipulator system for surgery is shown in US Pat. No. 5,217,003, Japanese Patent Laid-Open No. 7-328016, and the like.
[0064]
(Problems to be solved by the
[0065]
(Purpose of
[0066]
(Effects of
[0067]
【The invention's effect】
According to the first aspect of the present invention, the operation information detecting unit for detecting the operation information of the master manipulator and the operation control of the slave manipulator in which the operation information of the master manipulator is preset based on the detection result from the operation information detecting unit. In the case of minute movement information smaller than a predetermined setting range for use, the slave manipulator is provided with canceling means for canceling transmission of the minute movement information to the slave manipulator side. Can prevent unnecessary movements such as vibrations and hand movements, and stabilizes the behavior of the slave manipulator when the master manipulator is not in use or in operation. Excellent.
[0068]
According to the second aspect of the present invention, the operation of the master manipulator detected by the operation information detecting unit when operating the opening / closing operation of the treatment unit of the slave manipulator and the attitude control unit of the slave manipulator by operating the operation unit of the master manipulator. The amount of time change of the operation information such as the opening / closing angle of the unit and the master manipulator posture information such as the position and posture of the movable part of the master manipulator is smaller than the predetermined setting range for the operation control of the slave manipulator In the case of minute movement information, the movement information transmitted to the slave manipulator side is not updated by cancellation means, so unnecessary movement such as vibration of the slave manipulator when the master manipulator is not used, camera shake phenomenon, etc. Prevent unnecessary behavior It can, when not in use and a master manipulator, look good to stabilize the slave manipulator behavior during operation may, excellent durability.
[0069]
According to the invention of claim 3, the setting range of the temporal change amount of the motion information detected by the motion information detector by the setting range adjusting unit of the canceling unit can be arbitrarily changed.
[0070]
According to the invention of
[Brief description of the drawings]
FIG. 1 is a schematic configuration diagram of an entire system of a manipulator control device according to a first embodiment of the present invention.
FIG. 2 is a side view showing a partial cross section of an operation unit of a master manipulator in the manipulator control device of the first embodiment.
FIG. 3 is a perspective view of a main part showing a tip gripping part of a slave manipulator in the manipulator control device of the first embodiment.
FIG. 4 is an overall schematic configuration diagram illustrating a usage state of the manipulator control device according to the first embodiment.
FIG. 5 is a schematic configuration diagram of an arithmetic circuit of a master control unit in the manipulator control device according to the first embodiment.
6 is an explanatory diagram for explaining an operation of a master manipulator in the manipulator control device according to the first embodiment; FIG.
FIG. 7 is a flowchart for explaining the operation of the canceling unit in the manipulator control device according to the first embodiment;
FIG. 8 is a side view showing a partial cross section of an operation unit of a master manipulator in a manipulator control device according to a second embodiment of the present invention.
FIG. 9 is an explanatory diagram for explaining an operation of a slave manipulator in the manipulator control device according to the second embodiment.
FIG. 10 is a schematic configuration diagram of a conventional surgical manipulator system.
FIG. 11 is an explanatory diagram for explaining an operation state of a slave manipulator in a conventional surgical manipulator system.
[Explanation of symbols]
2 Slave manipulator
3 Master manipulator
20 Master controller
21 Position detector (motion information detector)
22 Arithmetic circuit
25 Slave controller
32 Canceling means
Claims (3)
術者が操作できる領域内に設置され、前記スレーブマニピュレータを遠隔的に操作するマスターマニピュレータと、
このマスターマニピュレータに接続され、前記マスターマニピュレータの操作をアナログ電気信号に変換し、前記アナログ電気信号をさらにデジタル電気信号の動作情報に変換するマスター制御部と、
前記スレーブマニピュレータおよび前記マスター制御部にそれぞれ接続され、前記マスター制御部から送られる前記マスターマニピュレータの操作に追従した動きを前記スレーブマニピュレータに伝達する制御信号を出力するスレーブ制御部と、
前記マスターマニピュレータの動作情報を検出する動作情報検出部と、
この動作情報検出部からの検出結果にもとづいて前記マスターマニピュレータの動作情報が予め設定された前記スレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはその微小な動作情報が前記スレーブマニピュレータ側に伝達されることをキャンセルするキャンセル手段と
を具備したマニピュレータ制御装置であって、
前記キャンセル手段は、前記動作情報が所定の基準値Xに対して±1bit以内であるか否かを判断し、±1bit以内であれば前記制御信号の出力をキャンセルし、±1bit以内でなければ前記制御信号をリアルタイムで出力するマニピュレータ制御装置。A slave manipulator installed to access the operative field,
A master manipulator that is installed in an area that can be operated by an operator and that remotely operates the slave manipulator;
Connected to the master manipulator, and the operation of the master manipulator is converted into an analog electrical signal, the master control unit for converting the operation information of the further digital electric signal the analog electrical signal,
A slave control unit that is connected to the slave manipulator and the master control unit and outputs a control signal that transmits a movement following the operation of the master manipulator sent from the master control unit to the slave manipulator;
An operation information detector for detecting operation information of the master manipulator;
In the case where the operation information of the master manipulator is minute operation information smaller than a predetermined setting range for controlling the operation of the slave manipulator based on the detection result from the operation information detection unit, the minute operation is performed. information is a manipulators controller with a canceling means for canceling to be transmitted to the slave manipulator side,
The cancellation means determines whether the operation information is within ± 1 bit with respect to a predetermined reference value X, and cancels the output of the control signal if within ± 1 bit, and if not within ± 1 bit. A manipulator control device for outputting the control signal in real time .
前記マスター制御部から前記スレーブ制御部に制御信号を送信する送信処理の開始時にデータ更新モードにセットされ、前記データ更新モードにセットされた場合には前記マスター制御部から前記スレーブ制御部にデータがリアルタイムで送信されて更新され、またデータキャンセルモードにセットされた場合にはデータがキャンセルされる処理が行われるステップS1と、
前記マスター制御部の出力信号が読み込まれるステップS2と、
前記基準値Xが取得されるステップS3と、
タイマーによって任意の設定時間がプリセットされるステップS4と、
前記基準値Xが±1bit以内(X≦±1bit)か否かが判断されるステップS5と、
前記ステップS5でXが±1bit以内ではない場合には基準値Xがクリアされたのち、前記ステップS2に戻されるステップS6と、
前記ステップS5でXが±1bit以内であると判断された場合にはt=0か否かが判断され、t=0以外の場合にはステップS5に戻されるステップS7と、
前記ステップS7でt=0と判断された場合に前記データキャンセルモードにセットされ、データのキャンセル処理が行われるステップS8と、
前記ステップS8でデータのキャンセル処理が行われた後、基準値Xが±1bit以内(X≦±1bit)か否かが判断され、前記Xが±1bit以内ではない場合にはステップS8に戻され、前記Xが±1bit以内であると判断された場合にはステップS1に戻されるステップS9と、
を具備することを特徴とする請求項1に記載のマニピュレータ制御装置。 The canceling means is
Data update mode is set at the start of transmission processing for transmitting a control signal from the master control unit to the slave control unit. When the data update mode is set, data is transferred from the master control unit to the slave control unit. Step S1 in which processing is performed in which data is transmitted and updated in real time, and data is canceled when the data cancel mode is set;
Step S2 in which an output signal of the master control unit is read;
Step S3 in which the reference value X is acquired;
Step S4 in which an arbitrary set time is preset by a timer;
Step S5 in which it is determined whether or not the reference value X is within ± 1 bit (X ≦ ± 1 bit);
When X is not within ± 1 bit in step S5, after the reference value X is cleared, step S6 is returned to step S2, and
If it is determined in step S5 that X is within ± 1 bit, it is determined whether or not t = 0, and if other than t = 0, step S7 is returned to step S5;
Step t8 in which the data cancel mode is set and data cancel processing is performed when t = 0 is determined in step S7;
After the data cancellation process is performed in step S8, it is determined whether or not the reference value X is within ± 1 bit (X ≦ ± 1 bit). If X is not within ± 1 bit, the process returns to step S8. If it is determined that X is within ± 1 bit, step S9 is returned to step S1, and
The manipulator control device according to claim 1, comprising:
前記キャンセル手段は、前記センサーからの検出結果にもとづいて前記マスターマニピュレータが操作されていない停止状態であることを判断し、前記マスターマニピュレータの停止状態の検出時には前記スレーブマニピュレータ側に伝達される前記動作情報を更新しないものであることを特徴とする請求項1に記載のマニピュレータ制御装置。The operation information detection unit includes a sensor that detects operation information of the movable unit of the master manipulator,
The cancellation means determines that the master manipulator is in a stopped state based on a detection result from the sensor, and the operation transmitted to the slave manipulator side when detecting the stop state of the master manipulator The manipulator control device according to claim 1, wherein the information is not updated.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP33311399A JP4472072B2 (en) | 1999-11-24 | 1999-11-24 | Manipulator control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP33311399A JP4472072B2 (en) | 1999-11-24 | 1999-11-24 | Manipulator control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2001145639A JP2001145639A (en) | 2001-05-29 |
JP4472072B2 true JP4472072B2 (en) | 2010-06-02 |
Family
ID=18262441
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP33311399A Expired - Fee Related JP4472072B2 (en) | 1999-11-24 | 1999-11-24 | Manipulator control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4472072B2 (en) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6804333B1 (en) | 1999-01-28 | 2004-10-12 | International Business Machines Corporation | Dynamically reconfigurable distributed interactive voice response system |
JP2012171088A (en) * | 2011-02-24 | 2012-09-10 | Olympus Corp | Master operation input device, and master-slave manipulator |
JP6012498B2 (en) * | 2013-02-14 | 2016-10-25 | アルプス電気株式会社 | Input device |
JP6227200B1 (en) | 2015-12-16 | 2017-11-08 | オリンパス株式会社 | MEDICAL MANIPULATOR SYSTEM AND MEDICAL MANIPULATOR CONTROL METHOD |
JP2019130602A (en) * | 2018-01-30 | 2019-08-08 | ソニー株式会社 | Information processing device, information processing method and program |
CN113611047B (en) * | 2021-07-28 | 2022-09-06 | 北京博研盛科科技有限公司 | Multi-axis motion system |
-
1999
- 1999-11-24 JP JP33311399A patent/JP4472072B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2001145639A (en) | 2001-05-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9283049B2 (en) | Control system configured to compensate for non-ideal actuator-to-joint linkage characteristics in a medical robotic system | |
JP4580973B2 (en) | Treatment instrument system | |
JP5085684B2 (en) | Treatment instrument system and manipulator system | |
US9179979B2 (en) | Medical robot system | |
EP1584300A2 (en) | Manipulator apparatus | |
JP2002059380A (en) | Master-slave device | |
KR20150118586A (en) | Systems and methods for proximal control of a surgical instrument | |
JPH08224248A (en) | Mdical manipulator | |
JPH07328016A (en) | Surgical manipulator system | |
JP2000300579A (en) | Multifunctional manipulator | |
JP3628743B2 (en) | Medical manipulator | |
JP4472072B2 (en) | Manipulator control device | |
WO2016013308A1 (en) | Treatment device and treatment device system | |
JPH08280697A (en) | Manipulator device for operation | |
JPH08196541A (en) | Manipulator for operation | |
CN116138881A (en) | Endoscopic surgery robot control device and endoscopic surgery robot system | |
JP4422257B2 (en) | Manipulator control device | |
WO2020049718A1 (en) | Manipulator system | |
JP2001334481A (en) | Manipulator control device | |
JP2001346808A (en) | Manipulator controller | |
JP2001145637A (en) | Manipulator controller | |
WO2018008106A1 (en) | Medical instrument holding device, medical system, medical instrument holding device operating method, and medical system operating method | |
US20220370165A1 (en) | Console for controlling a robotic manipulator | |
US20220401175A1 (en) | Surgery-assisting device | |
JP2012065889A (en) | Medical manipulator |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20061106 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20091110 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100108 |
|
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: 20100209 |
|
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: 20100303 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130312 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130312 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140312 Year of fee payment: 4 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
LAPS | Cancellation because of no payment of annual fees |