JP4472072B2

JP4472072B2 - マニピュレータ制御装置

Info

Publication number: JP4472072B2
Application number: JP33311399A
Authority: JP
Inventors: 裕史高橋; 圭介三浦; 順一大西; 敬一関
Original assignee: Olympus Corp
Current assignee: Olympus Corp
Priority date: 1999-11-24
Filing date: 1999-11-24
Publication date: 2010-06-02
Anticipated expiration: 2019-11-24
Also published as: JP2001145639A

Description

【０００１】
【発明の属する技術分野】
本発明は、生体の、例えば体腔内に挿入したマニピュレータを操作手段によって遠隔的に操作し、診断・処置等の手術を行う手術用のマニピュレータ制御装置に関する。
【０００２】
【従来の技術】
一般に、腹壁等の体壁に穴を開け、この穴を通じて内視鏡や処置具を経皮的に体腔内に挿入することにより、その体腔内での様々な処置を行なう経皮的内視鏡下手術が、大きな切開を要しない低侵襲なものとして、近年、注目されている。こうした術式は胆のう摘出手術や肺の一部を摘出除去する手術等で広く行なわれている。
【０００３】
このような手術において、マニピュレータに内視鏡や処置具を搭載し、そのマニピュレータによる内視鏡や処置具を用いた手術を術者に代わって間接的に行う手術用マニピュレータシステムが、米国特許第５，２１７，００３号や、特開平７−３２８０１６号公報などに示されている。
【０００４】
図１０はこの手術用マニピュレータシステムの概略構成を示すものである。このマニピュレータシステムには術野にアクセスするように設置されているスレーブマニピュレータａと、術者が操作できる領域内に設置されたジョイスティックなどのマスターマニピュレータｂとが設けられている。ここで、スレーブマニピュレータａにはスレーブ制御部ｃ、マスターマニピュレータｂにはマスター制御部ｄがそれぞれ連結されている。
【０００５】
さらに、スレーブ制御部ｃとマスター制御部ｄとの間は信号ケーブルなどの通信手段を介して連結されている。ここで、マスター制御部ｄにはマスターマニピュレータｂの操作部の操作情報を検出するポテンショメータなどの検出手段が設けられている。そして、このポテンショメータなどの検出手段で得られたマスターマニピュレータｂの操作情報の検出信号であるアナログ出力がＡ／Ｄ変換器によってデジタル出力の制御信号に変換されてマスター制御部ｄから通信手段を介してスレーブ制御部ｃに伝送されるようになっている。
【０００６】
また、スレーブ制御部ｃからはマスター制御部ｄから送られるマスターマニピュレータｂの操作部の操作に追従した動きをスレーブマニピュレータａに伝達する制御信号が出力されるようになっている。
【０００７】
そして、こうした手術用マニピュレータの遠隔操作では、内視鏡等の観察手段によりモニターに映し出された腹腔内の患部の状態を見ながら、操作者がマスターマニピュレータｂの操作部を操作することによって例えばマスターマニピュレータｂの操作部の操作方向にスレーブマニピュレータａを動作させるようになっている。
【０００８】
【発明が解決しようとする課題】
上記従来構成の手術用マニピュレータシステムではマスターマニピュレータｂの位置・姿勢・鋏型の操作部の開閉角度などの動作情報はポテンショメータなどの検出手段で検出されたのち、このポテンショメータなどの検出手段からのアナログ出力がＡ／Ｄ変換器によって例えば２５６階調のデジタル出力の制御信号に変換されてマスター制御部ｄから通信手段を介してスレーブ制御部ｃに伝送されるようになっている。
【０００９】
しかしながら、マスター制御部ｄのＡ／Ｄ変換器などは１チップマイコンなどの安価な電子部品が使用されているので、検出信号のノイズ、またはＡ／Ｄ変換器の量子化誤差により、図１１に示すように検出データであるＡ／Ｄ値がｘの場合にｘ±１ｂｉｔ程度のデータ変化が発生する問題がある。このような現象は、例えばマスターマニピュレータｂの未使用時でも発生しているので、マスターマニピュレータｂの停止中にマスターマニピュレータｂの動作情報としてこの±１ｂｉｔ程度のデータ変化がマスター制御部ｄからスレーブ制御部ｃに伝送され、スレーブマニピュレータａの動きにつながる問題がある。そのため、マスターマニピュレータｂの停止中にスレーブマニピュレータａが微小な振動が発生するなどの不要な動きや、手ブレ現象などの不要な動作を誘発する問題がある。
【００１０】
本発明は上記事情に着目してなされたもので、その目的は、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができ、マスターマニピュレータの未使用時や、動作中のスレーブマニピュレータ挙動を安定化させて見栄えがよく、耐久性に優れたマニピュレータ制御装置を提供することにある。
【００１１】
【課題を解決するための手段】
請求項１の発明は、術野にアクセスするように設置されたスレーブマニピュレータと、
術者が操作できる領域内に設置され、前記スレーブマニピュレータを遠隔的に操作するマスターマニピュレータと、このマスターマニピュレータに接続され、前記マスターマニピュレータの操作をアナログ電気信号に変換し、前記アナログ電気信号をさらにデジタル電気信号の動作情報に変換するマスター制御部と、前記スレーブマニピュレータおよび前記マスター制御部にそれぞれ接続され、前記マスター制御部から送られる前記マスターマニピュレータの操作に追従した動きを前記スレーブマニピュレータに伝達する制御信号を出力するスレーブ制御部と、前記マスターマニピュレータの動作情報を検出する動作情報検出部と、この動作情報検出部からの検出結果にもとづいて前記マスターマニピュレータの動作情報が予め設定された前記スレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはその微小な動作情報が前記スレーブマニピュレータ側に伝達されることをキャンセルするキャンセル手段とを具備したマニピュレータ制御装置であって、前記キャンセル手段は、前記動作情報が所定の基準値Ｘに対して±１ｂｉｔ以内であるか否かを判断し、±１ｂｉｔ以内であれば前記制御信号の出力をキャンセルし、±１ｂｉｔ以内でなければ前記制御信号をリアルタイムで出力するマニピュレータ制御装置である。
【００１２】
そして、本請求項１の発明では、動作情報検出部によってマスターマニピュレータの動作情報を検出し、この動作情報検出部からの検出結果にもとづいてマスターマニピュレータの動作情報が予め設定されたスレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはキャンセル手段によってその微小な動作情報がスレーブマニピュレータ側に伝達されることをキャンセルすることにより、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐようにしたものである。
【００１３】
請求項２の発明は、前記キャンセル手段は、前記マスター制御部から前記スレーブ制御部に制御信号を送信する送信処理の開始時にデータ更新モードにセットされ、前記データ更新モードにセットされた場合には前記マスター制御部から前記スレーブ制御部にデータがリアルタイムで送信されて更新され、またデータキャンセルモードにセットされた場合にはデータがキャンセルされる処理が行われるステップＳ１と、前記マスター制御部の出力信号が読み込まれるステップＳ２と、前記基準値Ｘが取得されるステップＳ３と、タイマーによって任意の設定時間がプリセットされるステップＳ４と、前記基準値Ｘが±１ｂｉｔ以内（Ｘ≦±１ｂｉｔ）か否かが判断されるステップＳ５と、前記ステップＳ５でＸが±１ｂｉｔ以内ではない場合には基準値Ｘがクリアされたのち、前記ステップＳ２に戻されるステップＳ６と、前記ステップＳ５でＸが±１ｂｉｔ以内であると判断された場合にはｔ＝０か否かが判断され、ｔ＝０以外の場合にはステップＳ５に戻されるステップＳ７と、前記ステップＳ７でｔ＝０と判断された場合に前記データキャンセルモードにセットされ、データのキャンセル処理が行われるステップＳ８と、前記ステップＳ８でデータのキャンセル処理が行われた後、基準値Ｘが±１ｂｉｔ以内（Ｘ≦±１ｂｉｔ）か否かが判断され、前記Ｘが±１ｂｉｔ以内ではない場合にはステップＳ８に戻され、前記Ｘが±１ｂｉｔ以内であると判断された場合にはステップＳ１に戻されるステップＳ９と、を具備することを特徴とする請求項１に記載のマニピュレータ制御装置である。
【００１７】
請求項３の発明は、前記動作情報検出部は、前記マスターマニピュレータの可動部の動作情報を検出するセンサーを備え、前記キャンセル手段は、前記センサーからの検出結果にもとづいて前記マスターマニピュレータが操作されていない停止状態であることを判断し、前記マスターマニピュレータの停止状態の検出時には前記スレーブマニピュレータ側に伝達される前記動作情報を更新しないものであることを特徴とする請求項１に記載のマニピュレータ制御装置である。
【００１８】
そして、本請求項３の発明では、動作情報検出部のセンサーによってマスターマニピュレータの可動部の動作情報を検出し、このセンサーからの検出結果にもとづいてキャンセル手段によってマスターマニピュレータが操作されていない停止状態であることを判断する。ここで、マスターマニピュレータの停止状態が検出された場合にはスレーブマニピュレータ側に伝達される動作情報を更新しないようにしたものである。
【００１９】
【発明の実施の形態】
以下、本発明の第１の実施の形態を図１乃至図７を参照して説明する。図１は本実施の形態のマニピュレータ制御装置１のシステム全体の概略構成を示すものである。本実施の形態のマニピュレータ制御装置１には術野にアクセスするように設置されたスレーブマニピュレータ２と、術者が操作できる領域内に設置され、スレーブマニピュレータ２を遠隔的に操作するマスターマニピュレータ３とが設けられている。ここで、スレーブマニピュレータ２には２組のスレーブマニピュレータ、すなわち左側スレーブマニピュレータ２ａと、右側スレーブマニピュレータ２ｂとが設けられている。さらに、マスターマニピュレータ３にも同様に左側スレーブマニピュレータ２ａを操作する左側マスターマニピュレータ３ａと、右側スレーブマニピュレータ２ｂを操作する右側マスターマニピュレータ３ｂとが設けられている。
【００２０】
また、２つのスレーブマニピュレータ２ａ，２ｂ、マスターマニピュレータ３ａ，３ｂはそれぞれ略同一構成になっているので、ここでは一方の左側のスレーブマニピュレータ２ａおよびマスターマニピュレータ３ａの構成のみを説明し、右側のスレーブマニピュレータ２ｂおよびマスターマニピュレータ３ｂの同一部分には同一の符号を付してその説明を省略する。
【００２１】
すなわち、本実施の形態の左側のスレーブマニピュレータ２ａには細長い挿入部４を備えたマニピュレータ本体５と、このマニピュレータ本体５を駆動するスレーブ駆動部６とが設けられている。さらに、挿入部４の先端部には図３に示すように例えば把持鉗子のように開閉可能な１対の把持部材７ａ，７ｂを備えた先端把持部７が設けられている。これらの把持部材７ａ，７ｂの基端部間は挿入部４の先端部に回動ピン８を中心に回動可能に連結されている。そして、これらの把持部材７ａ，７ｂはリンク機構部９によって回動ピン８を中心に開閉可能に支持されている。
【００２２】
また、マニピュレータ本体５はスレーブ駆動部６内の図示しないマニピュレータ本体駆動ユニットによって図３中で、Ｘ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動可能に駆動され、かつＺ軸の軸回り方向に回動駆動されるようになっている。さらに、マニピュレータ本体５の先端把持部７も同様にスレーブ駆動部６内の図示しない先端把持部駆動ユニットによって把持部材７ａ，７ｂ間が回動ピン８を中心に開閉駆動されるようになっている。なお、図３中で、Ｏｓはスレーブマニピュレータ２ａのマニピュレータ本体５の原点位置である。
【００２３】
また、左側マスターマニピュレータ３ａには図２に示すように例えば略鋏型の開閉動作可能なハンドル（操作部）１０と、このハンドル１０を図２中で、Ｘ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動可能に、かつＺ軸の軸回り方向に回動可能に支持する支持機構部１１（図４に示す）とが設けられている。なお、図２中で、Ｏ_M はマスターマニピュレータ３ａのハンドル１０の原点位置である。
【００２４】
また、ハンドル１０には図２に示すようにトッププレート１２に一端部が固定された支軸１３と、この支軸１３の他端部に回動軸１４を中心に回動可能に連結された２つのハンドル部材１５ａ，１５ｂとが設けられている。さらに、２つのハンドル部材１５ａ，１５ｂ間には回動軸１４側にリンク部材１６、自由端部側に板ばね部材１７がそれぞれ配設されている。そして、このハンドル１０は板ばね部材１７のばね力によって図２中に実線で示すように全開位置方向に付勢されている。
【００２５】
また、このハンドル１０の一方のハンドル部材１５ａにはストッパ１８が他方のハンドル部材１５ｂ側に向けて突設されている。そして、このハンドル１０の閉操作時には図２中に仮想線で示すようにハンドル部材１５ａのストッパ１８がハンドル部材１５ｂに突き当たることにより、このハンドル１０の閉操作が規制され、この状態が全閉位置に設定されている。
【００２６】
さらに、ハンドル１０のハンドル部材１５ａにはポテンショメータ１９が取付けられている。そして、このポテンショメータ１９によってハンドル１０の開閉角度が検出されるようになっている。
【００２７】
また、マスターマニピュレータ３ａの支持機構部１１はパンタグラフ機構を複数組み合わせて構成された多自由度マニピュレータによって形成されている。ここで、出力節であるトッププレート１２には、３つのパンタグラフと３つの回転対偶軸とが取付けられている。なお、各パンダグラフ、対偶軸には、図示しないエンコーダが取付けられている。そして、このエンコーダによってハンドル１０の操作を検出する検出手段が形成されている。さらに、マスターマニピュレータ３にはこのマスターマニピュレータ３を操作不能なロック状態と、このマスターマニピュレータ３の操作が可能なロック解除状態とに切換える例えば電磁ロック式の図示しないロック機構部が組込まれている。
【００２８】
また、マスターマニピュレータ３にはこのマスターマニピュレータ３の操作を電気信号に変換するマスター制御部２０が接続されている。このマスター制御部２０にはマスターマニピュレータ３のポテンショメータ１９および支持機構部１１のエンコーダなどの位置検出装置（動作情報検出部）２１と、例えば位置計算用のコンピュータによって形成される演算回路２２とが設けられている。そして、位置検出装置２１による左右のマスターマニピュレータ３ａ，３ｂの操作状態の検出データ（Ｌ検出信号、Ｒ検出信号）は演算回路２２に入力され、この演算回路２２で位置計算されてマスターマニピュレータ３のハンドル１０の操作状態や、ハンドル１０の開閉状態などのデータが算出されるようになっている。
【００２９】
さらに、このマスター制御部２０にはマスターマニピュレータ３のロック機構部の制御用のフットスイッチ２３が接続されている。このフットスイッチ２３には２つのペダル２３ａ，２３ｂが設けられている。そして、一方のペダル２３ａによってマスターマニピュレータ３のロック状態と、ロック解除状態とを切換えるロック状態の切換え操作部、他方のペダル２３ｂによって移動用クラッチの切換え操作部がそれぞれ形成されている。
【００３０】
なお、マスターマニピュレータ３を操作する術者の近傍位置にはモニター２４が配置されている。そして、このモニター２４に表示される表示画面を見ながらマスターマニピュレータ３の操作が行われるようになっている。
【００３１】
また、スレーブマニピュレータ２にはマスターマニピュレータ３の操作に追従した動きをスレーブマニピュレータ２に伝達する制御信号を出力するスレーブ制御部２５が接続されている。このスレーブ制御部２５にはスレーブマニピュレータ２のスレーブ駆動部６に組込まれている複数の駆動モータ２６を制御するモータ駆動回路２７と、例えばスレーブマニピュレータ制御用のコンピュータによって形成される演算回路２８とが設けられている。
【００３２】
さらに、スレーブ制御部２５の演算回路２８とマスター制御部２０の演算回路２２との間は例えば光ファイバーケーブルなどの通信手段２９を介して接続されている。そして、スレーブ制御部２５ではマスター制御部２０から送られるマスターマニピュレータ３の操作に追従した動きをスレーブマニピュレータ２に伝達する制御信号を出力するようになっている。
【００３３】
また、マスター制御部２０の演算回路２２には図５に示すように位置検出装置２１に接続されたＡ／Ｄ変換器３０と、タイマー３１と、キャンセル手段３２と、ＣＰＵ３３とが設けられている。そして、マスターマニピュレータ３のポテンショメータ１９および支持機構部１１のエンコーダなどの位置検出装置２１で得られたマスターマニピュレータ３のハンドル１０の開閉角度や、ハンドル１０のＸ軸方向、Ｙ軸方向、Ｚ軸方向の各移動量や、Ｚ軸の軸回り方向の回動角度などのマスターマニピュレータ３の可動部の位置・姿勢などの操作情報の検出信号であるアナログ出力がＡ／Ｄ変換器３０によって例えば２５６階調のデジタル出力の制御信号に変換されてＣＰＵ３３に入力され、このデジタル出力の制御信号がマスター制御部２２から通信手段２９を介してスレーブ制御部２５に伝送されるようになっている。なお、ＣＰＵ３３には図示しない伝達倍率変換回路が内蔵されている。そして、マスターマニピュレータ３のハンドル１０のＸ軸方向、Ｙ軸方向、Ｚ軸方向の各移動量の検出データはこの伝達倍率変換回路によって任意の伝達倍率に変換されてスレーブ制御部２５に伝送され、ハンドル１０の開閉角度の検出データは１：１でスレーブ制御部２５に伝送されるようになっている。
【００３４】
また、キャンセル手段３２には位置検出装置２１からの検出結果にもとづいてマスターマニピュレータ３の動作情報が予め設定されたスレーブマニピュレータ２の動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ２側に伝達されることをキャンセルする機能が設けられている。ここで、キャンセル手段３２はマスターマニピュレータ３の動作情報の時間的変化量が予め設定されたスレーブマニピュレータ２の動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはスレーブマニピュレータ側に伝達される動作情報を更新しないように設定されている。なお、このキャンセル手段３２には位置検出装置２１で検出される動作情報の時間的変化量の設定範囲を任意に変更する設定値調整部（設定範囲調整手段）３４が接続されている。
【００３５】
次に、上記構成の作用について説明する。本実施の形態のマニピュレータ制御装置１の使用時には、マスターマニピュレータ３が術者が操作できる領域内に設置される。さらに、スレーブマニピュレータ２は術野にアクセスするように設置される。例えば、図４に示すように予め診断・処置等の手術を行う患者の腹壁等の体壁Ｈに図示しないトロッカーによって穴を開け、この穴に刺入されたトロッカー外套管内にスレーブマニピュレータ２の挿入部４が挿入され、このトロッカー外套管内を通じてスレーブマニピュレータ２の挿入部４が経皮的に体腔内に挿入された状態にセットされる。このとき、マスターマニピュレータ３を操作する術者の近傍位置のモニター２４にはスレーブマニピュレータ２とは別の場所から経皮的に体腔内に挿入された内視鏡による術野の内視鏡像、或いはコンピュータグラフィック装置によって合成された術野のコンピュータグラフィック画像（ＣＧ画像）などが表示される。
【００３６】
また、スレーブマニピュレータ２およびマスターマニピュレータ３のセット後、これらのスレーブマニピュレータ２およびマスターマニピュレータ３の原点（０点）位置を対応させるキャリブレーション動作が行われる。このキャリブレーション動作時にはフットスイッチ２３のペダル２３ａを踏むことにより、マスターマニピュレータ３のロックが解除され、マスターマニピュレータ３の左右のマスターマニピュレータ３ａ，３ｂが図２中で、Ｘ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動可能、かつＺ軸の軸回り方向に回動可能な状態にそれぞれ切換えられるとともに、左右のマスターマニピュレータ３ａ，３ｂの２つのハンドル部材１５ａ，１５ｂ間が開閉動作可能な状態にそれぞれ切換えられる。
【００３７】
この状態で、マスターマニピュレータ３の左右のマスターマニピュレータ３ａ，３ｂが任意の位置に移動され、左右のマスターマニピュレータ３ａ，３ｂの原点（０点）位置が設定される。
【００３８】
その後、スレーブマニピュレータ２における２つのスレーブマニピュレータ２ａ，２ｂのスレーブ駆動部６内の図示しないマニピュレータ本体駆動ユニットおよび先端把持部駆動ユニットが駆動される。これにより、マニピュレータ本体５が図３中で、Ｘ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動され、かつＺ軸の軸回り方向に回動駆動されて予め設定された左右のスレーブマニピュレータ２ａ，２ｂの原点（０点）位置に移動される。このとき、スレーブマニピュレータ２ａ，２ｂの移動範囲が予め決められた適正範囲でない場合は、警告表示等を行い異常を操作者に告知を行っている。
【００３９】
さらに、このキャリブレーション動作の終了後、本実施の形態のマニピュレータ制御装置１による診断・処置等の手術が開始される。この手術時には術者はモニター２４に表示される術野の内視鏡像、或いはＣＧ画像の画面を見ながらマスターマニピュレータ３の左右のマスターマニピュレータ３ａ，３ｂがそれぞれ操作される。このとき、左側マスターマニピュレータ３ａのハンドル１０が術者の左手、右側マスターマニピュレータ３ｂのハンドル１０が術者の右手で握られた状態でそれぞれ操作され、左側マスターマニピュレータ３ａによって左側スレーブマニピュレータ２ａ、右側マスターマニピュレータ３ｂによって右側スレーブマニピュレータ２ｂがそれぞれ独立に遠隔操作される。
【００４０】
例えば、左側マスターマニピュレータ３ａのハンドル１０を図２中で、Ｘ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動させ、かつＺ軸の軸回り方向に回動させた場合にはこのときのマスターマニピュレータ３ａの動作がマスター制御部２０の位置検出装置２１で検出される。この位置検出装置２１からの検出データは演算回路２２に入力される。このとき、マスターマニピュレータ３のポテンショメータ１９および支持機構部１１のエンコーダなどの位置検出装置２１で得られたマスターマニピュレータ３のハンドル１０の開閉角度や、ハンドル１０のＸ軸方向、Ｙ軸方向、Ｚ軸方向の各移動量や、Ｚ軸の軸回り方向の回動角度などのマスターマニピュレータ３の可動部の位置・姿勢などの操作情報の検出信号であるアナログ出力は演算回路２２のＡ／Ｄ変換器３０によって例えば２５６階調のデジタル出力の制御信号に変換されてＣＰＵ３３に入力される。そして、この演算回路２２のＣＰＵ３３で位置計算されてマスターマニピュレータ３のハンドル１０の操作状態や、ハンドル１０の開閉状態などのデータが算出される。
【００４１】
さらに、マスター制御部２０の演算回路２２で位置計算された算出データは光ファイバーケーブルなどの通信手段２９を介してスレーブ制御部２５に送信される。ここで、マスターマニピュレータ３のハンドル１０のＸ軸方向、Ｙ軸方向、Ｚ軸方向の各移動量の検出データはＣＰＵ３３内の図示しない伝達倍率変換回路によって任意の伝達倍率に変換されてスレーブ制御部２５に伝送され、ハンドル１０の開閉角度の検出データは１：１でスレーブ制御部２５に伝送される。
【００４２】
また、スレーブ制御部２５では受信された制御信号にもとづいて演算回路２８によってスレーブ駆動部６に組込まれているモータ駆動回路２７の複数の駆動モータ２６を制御する制御信号が算出される。そして、このスレーブ制御部２５から出力される制御信号が左側スレーブマニピュレータ２ａに伝達され、左側スレーブマニピュレータ２ａが遠隔的に操作される。このとき、左側スレーブマニピュレータ２ａは左側マスターマニピュレータ３ａのハンドル１０の動きに追従して動く。なお、右側マスターマニピュレータ３ｂの操作時にも同様の作用によって右側スレーブマニピュレータ２ｂの動作が制御され、右側マスターマニピュレータ３ｂの操作に追従して右側スレーブマニピュレータ２ｂが動くようになっている。
【００４３】
また、本実施の形態のマニピュレータ制御装置１の動作中、位置検出装置２１からの検出結果にもとづいてマスターマニピュレータ３の動作情報が予め設定されたスレーブマニピュレータ２の動作制御用の所定の設定範囲、例えばＡ／Ｄ値が基準値Ｘに対して±１ｂｉｔ以内の微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ２側に伝達されることをキャンセルするキャンセル動作が図７に示すフローチャートにしたがって次のように行われる。
【００４４】
すなわち、マスター制御部２２からスレーブ制御部２５に制御信号を送信する送信処理の開始時にはステップＳ１で、送信ビットが「０」にセットされる。ここで、送信ビットが「０」にセットされた場合にはマスター制御部２０からスレーブ制御部２５にデータがリアルタイムで送信されて更新され、また送信ビットが「１」にセットされた場合にはデータがキャンセルされる処理が行われる。
【００４５】
続いて、次のステップＳ２ではＡ／Ｄ変換器３０の出力信号が読み込まれ、次のステップＳ３で、図６に示す基準値Ｘが取得される。さらに、次のステップＳ４ではタイマー３１によって例えばｔ＝２秒がプリセットされる。
【００４６】
また、次のステップＳ５では基準値Ｘが±１ｂｉｔ以内（Ｘ≦±１ｂｉｔ）か否かが判断される。ここで、Ｘが±１ｂｉｔ以内ではない場合にはステップＳ６に進み、基準値Ｘがクリアされたのち、ステップＳ２に戻される。さらに、ステップＳ５でＸが±１ｂｉｔ以内であると判断された場合にはステップＳ７に進む。
【００４７】
このステップＳ７ではｔ＝０か否かが判断される。ここで、ｔ＝０以外の場合にはステップＳ５に戻される。ステップＳ７でｔ＝０と判断された場合には次のステップＳ８に進む。このステップＳ８では送信ビットが「１」にセットされ、データのキャンセル処理が行われる。
【００４８】
その後、次のステップＳ９で基準値Ｘが±１ｂｉｔ以内（Ｘ≦±１ｂｉｔ）か否かが判断される。ここで、Ｘが±１ｂｉｔ以内ではない場合にはステップＳ８に戻される。また、ステップＳ９でＸが±１ｂｉｔ以内であると判断された場合にはステップＳ１に戻される。
【００４９】
なお、位置検出装置２１にはマスターマニピュレータ３の位置検出用のポテンショメータ１９や、支持機構部１１のエンコーダなどの複数の検出要素が設けられているので、全て（ｎ個）の検出要素のＡ／Ｄ値に対して基準値ＸはＡ／Ｄ１〜Ａ／ＤｎのＡＮＤ条件でキャンセル期間が判定される。
【００５０】
これにより、時刻ｔ０で位置検出装置２１の出力信号を基準値Ｘとしてサンプリングしたのち、任意の設定時間ｔ（例えばｔ＝２秒）の間、基準値Ｘ±１ビット以内である状態を認識した場合には、マスターマニピュレータ３が停止している状態と判断（判定時間ｔ後）してマスターマニピュレータ３からスレーブマニピュレータ２に送信する位置・姿勢・開閉角の情報がキャンセルされる。また、基準値Ｘ±１ビット以上になった場合にはマスターマニピュレータ３が移動している状態と判断し、マスターマニピュレータ３からスレーブマニピュレータ２に送信する位置・姿勢・開閉角の情報が更新される。なお、基準値Ｘは定期的にサンプリングされ、判定期間ｔでＸ±１ビット以内であれば新たにマスターマニピュレータ３からスレーブマニピュレータ２に送信する情報はキャンセルされる。
【００５１】
また、設定値調整部３４によってキャンセル手段３２による位置検出装置２１で検出される動作情報の時間的変化量の設定範囲であるキャンセルｂｉｔの幅を任意に変更して設定することができる。
【００５２】
そこで、上記構成のものにあっては次の効果を奏する。すなわち、本実施の形態ではマニピュレータ制御装置１の動作中、位置検出装置２１からの検出結果にもとづいてマスターマニピュレータ３の動作情報が予め設定されたスレーブマニピュレータ２の動作制御用の所定の設定範囲、例えばＡ／Ｄ値が基準値Ｘに対して±１ｂｉｔ以内の微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ２側に伝達されることをキャンセルするキャンセル動作が行われる。そのため、位置検出装置２１のポテンショメータ１９などの出力信号に対するノイズの重畳で、スレーブマニピュレータ２が振動する動作（ノイズによる振動動作）や、Ａ／Ｄ変換器３０の量子化誤差によるデジタルノイズの影響でスレーブマニピュレータ２が振動する動作（ノイズによる振動）をキャンセルすることができる。したがって、マスターマニピュレータ３の未使用時にスレーブマニピュレータ２が振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができるので、マスターマニピュレータ３の未使用時や、動作中のスレーブマニピュレータ２の挙動を安定化させて見栄えがよく、耐久性に優れる。
【００５３】
さらに、格別に高精度なＡ／Ｄ変換器３０などの電子回路を使用することなく入力信号の不要な情報をソフトウエア的に取り除くことができるので、装置全体のコスト低下を図ることができる。
【００５４】
また、図８および図９は本発明の第２の実施の形態を示すものである。本実施の形態は第１の実施の形態（図１乃至図７参照）のマニピュレータ制御装置１の構成を次の通り変更したものである。
【００５５】
すなわち、本実施の形態ではマスターマニピュレータ３のトッププレート１２にハンドル１０のＸ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）の３方向の移動を検出する３軸加速度センサ４１を取付け、この３軸加速度センサ４１からの検出信号により、マスターマニピュレータ３の動作情報が予め設定されたスレーブマニピュレータ２の動作制御用の所定の設定範囲、例えばＡ／Ｄ値が基準値Ｘに対して±１ｂｉｔ以内の微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ２側に伝達されることをキャンセルするキャンセル動作を行わせる構成にしたものである。ここでは、３軸加速度センサ４１によって図９に示すようにハンドル１０のＸ軸方向、Ｙ軸方向、Ｚ軸方向の３方向の移動が検出されるので、この３軸加速度センサ４１によって停止期間ｔ_OFF を検出している間、スレーブマニピュレータ２に送信する情報をキャンセルする。
【００５６】
そこで、本実施の形態ではマスターマニピュレータ３の停止状態を確実に検出可能となる。さらに、マスター制御部２０の制御用ＣＰＵ３３の負荷を軽減させることが可能となる効果がある。
【００５７】
さらに、本発明は上記実施の形態に限定されるものではなく、本発明の要旨を逸脱しない範囲で種々変形実施できることは勿論である。
次に、本出願の他の特徴的な技術事項を下記の通り付記する。
記
（付記項１）マスタースレーブ装置において、マスター入力装置の位置・姿勢・開閉角度を検出する信号検出手段、前記信号検出手段でマスタ入力装置の未使用時（停止状態）を検出する移動量検出手段、前記移動量検出手段にてマスター入力装置が未使用（移動停止）していたことを利用してスレーブ側に送信する位置・姿勢・開閉角度の情報を更新しない情報キャンセル手段を備えたマスタースレーブ装置。
【００５８】
（付記項２）ポテンショメータの時間的変化量から前記未使用時を検出する前記付記項１のマスタースレーブ装置。
【００５９】
（付記項３）センサーを付加して前記未使用時を検出する前記付記項１のマスタースレーブ装置。
【００６０】
（付記項４）各リンク機構の傾き情報から位置・姿勢・開閉角度を算出できるマスター入力装置を備えたマスタースレーブ装置において、マスター入力装置の位置・姿勢・開閉角を算出する動作状態検出部、前記動作状態検出部にてマスター入力装置の位置・姿勢・開閉角の時間的変化量が規定の値以下ならば、前記位置・姿勢・開閉角の情報を更新しない情報キャンセル手段を備えたマスタースレーブ装置。
【００６１】
（付記項５）前記動作状態検出部で時間的変化量が任意に可変可能な前記情報キャンセル手段を備えた付記項４のマスタースレーブ装置。
【００６２】
（付記項６）前記マスター入力装置において、可動部の動きを検出するセンサーを備え、前記センサーの情報を元にマスター入力装置が操作されていないことを判断する停止状態検出手段、前記停止状態検出手段からマスター入力装置の未使用時状態を検出し、前記位置・姿勢・開閉角の情報を更新しない付記項４及び付記項５のマスタースレーブ装置。
【００６３】
（付記項１〜６の従来技術）手術用マニピュレータシステムが、米国特許第５，２１７，００３号や、特開平７−３２８０１６号公報などに示されている。
【００６４】
（付記項１〜６が解決しようとする課題）検出信号のノイズまたはＡ／Ｄの量子化誤差によるデータの変化値が、マスター入力装置の未使用時でもスレーブの動きにつながってスレーブの振動動作を誘発していた。
【００６５】
（付記項１〜６の目的）マスター入力装置の未使用時を検出することで、スレーブの不要な動作（振動）を防ぐことを目的とする。
【００６６】
（付記項１〜６の効果）高精度な回路を用いることなく、入力信号の不要な情報をソフトウエアにより取り除くことができる。操作を停止し、ハンドルを保持しているときの手の振動をスレーブに伝達しない（手ブレ補正）。確実にマスターアームの停止状態を検出可能。また、制御用ＣＰＵの負荷を軽減させることが可能。
【００６７】
【発明の効果】
請求項１の発明によれば、マスターマニピュレータの動作情報を検出する動作情報検出部と、この動作情報検出部からの検出結果にもとづいてマスターマニピュレータの動作情報が予め設定されたスレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはその微小な動作情報がスレーブマニピュレータ側に伝達されることをキャンセルするキャンセル手段とを設けたので、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができ、マスターマニピュレータの未使用時や、動作中のスレーブマニピュレータ挙動を安定化させて見栄えがよく、耐久性に優れる。
【００６８】
請求項２の発明によれば、マスターマニピュレータの操作部の操作によってスレーブマニピュレータの処置部の開閉動作およびスレーブマニピュレータの姿勢制御部を操作する際に、動作情報検出部によって検出されたマスターマニピュレータの処置部の開閉角度や、マスターマニピュレータの可動部の位置・姿勢などのマスターマニピュレータの姿勢情報などの動作情報の時間的変化量が予め設定されたスレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはキャンセル手段によってスレーブマニピュレータ側に伝達される動作情報を更新しないようにしたので、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができ、マスターマニピュレータの未使用時や、動作中のスレーブマニピュレータ挙動を安定化させて見栄えがよく、耐久性に優れる。
【００６９】
請求項３の発明によれば、キャンセル手段の設定範囲調整手段によって動作情報検出部で検出される動作情報の時間的変化量の設定範囲を任意に変更することができる。
【００７０】
請求項４の発明によれば、動作情報検出部のセンサーによってマスターマニピュレータの可動部の動作情報を検出し、このセンサーからの検出結果にもとづいてキャンセル手段によってマスターマニピュレータが操作されていない停止状態であることを判断してマスターマニピュレータの停止状態が検出された場合にはスレーブマニピュレータ側に伝達される動作情報を更新しないようにしたので、マスターマニピュレータの未使用時にスレーブマニピュレータが振動するなどの不要な動作や、手ブレ現象などの不要な動作を防ぐことができる。
【図面の簡単な説明】
【図１】本発明の第１の実施の形態におけるマニピュレータ制御装置のシステム全体の概略構成図。
【図２】第１の実施の形態のマニピュレータ制御装置におけるマスターマニピュレータの操作部を一部断面にして示す側面図。
【図３】第１の実施の形態のマニピュレータ制御装置におけるスレーブマニピュレータの先端把持部を示す要部の斜視図。
【図４】第１の実施の形態のマニピュレータ制御装置の使用状態を示す全体の概略構成図。
【図５】第１の実施の形態のマニピュレータ制御装置におけるマスター制御部の演算回路の概略構成図。
【図６】第１の実施の形態のマニピュレータ制御装置におけるマスターマニピュレータの動作を説明するための説明図。
【図７】第１の実施の形態のマニピュレータ制御装置におけるキャンセル手段の動作を説明するためのフローチャート。
【図８】本発明の第２の実施の形態のマニピュレータ制御装置におけるマスターマニピュレータの操作部を一部断面にして示す側面図。
【図９】第２の実施の形態のマニピュレータ制御装置におけるスレーブマニピュレータの動作を説明するための説明図。
【図１０】従来の手術用マニピュレータシステムの概略構成図。
【図１１】従来の手術用マニピュレータシステムにおけるスレーブマニピュレータの動作状態を説明するための説明図。
【符号の説明】
２スレーブマニピュレータ
３マスターマニピュレータ
２０マスター制御部
２１位置検出装置（動作情報検出部）
２２演算回路
２５スレーブ制御部
３２キャンセル手段

Claims

術野にアクセスするように設置されたスレーブマニピュレータと、
術者が操作できる領域内に設置され、前記スレーブマニピュレータを遠隔的に操作するマスターマニピュレータと、
このマスターマニピュレータに接続され、前記マスターマニピュレータの操作をアナログ電気信号に変換し、前記アナログ電気信号をさらにデジタル電気信号の動作情報に変換するマスター制御部と、
前記スレーブマニピュレータおよび前記マスター制御部にそれぞれ接続され、前記マスター制御部から送られる前記マスターマニピュレータの操作に追従した動きを前記スレーブマニピュレータに伝達する制御信号を出力するスレーブ制御部と、
前記マスターマニピュレータの動作情報を検出する動作情報検出部と、
この動作情報検出部からの検出結果にもとづいて前記マスターマニピュレータの動作情報が予め設定された前記スレーブマニピュレータの動作制御用の所定の設定範囲よりも小さい微小な動作情報の場合にはその微小な動作情報が前記スレーブマニピュレータ側に伝達されることをキャンセルするキャンセル手段と
を具備したマニピュレータ制御装置であって、
前記キャンセル手段は、前記動作情報が所定の基準値Ｘに対して±１ｂｉｔ以内であるか否かを判断し、±１ｂｉｔ以内であれば前記制御信号の出力をキャンセルし、±１ｂｉｔ以内でなければ前記制御信号をリアルタイムで出力するマニピュレータ制御装置。
前記キャンセル手段は、
前記マスター制御部から前記スレーブ制御部に制御信号を送信する送信処理の開始時にデータ更新モードにセットされ、前記データ更新モードにセットされた場合には前記マスター制御部から前記スレーブ制御部にデータがリアルタイムで送信されて更新され、またデータキャンセルモードにセットされた場合にはデータがキャンセルされる処理が行われるステップＳ１と、
前記マスター制御部の出力信号が読み込まれるステップＳ２と、
前記基準値Ｘが取得されるステップＳ３と、
タイマーによって任意の設定時間がプリセットされるステップＳ４と、
前記基準値Ｘが±１ｂｉｔ以内（Ｘ≦±１ｂｉｔ）か否かが判断されるステップＳ５と、
前記ステップＳ５でＸが±１ｂｉｔ以内ではない場合には基準値Ｘがクリアされたのち、前記ステップＳ２に戻されるステップＳ６と、
前記ステップＳ５でＸが±１ｂｉｔ以内であると判断された場合にはｔ＝０か否かが判断され、ｔ＝０以外の場合にはステップＳ５に戻されるステップＳ７と、
前記ステップＳ７でｔ＝０と判断された場合に前記データキャンセルモードにセットされ、データのキャンセル処理が行われるステップＳ８と、
前記ステップＳ８でデータのキャンセル処理が行われた後、基準値Ｘが±１ｂｉｔ以内（Ｘ≦±１ｂｉｔ）か否かが判断され、前記Ｘが±１ｂｉｔ以内ではない場合にはステップＳ８に戻され、前記Ｘが±１ｂｉｔ以内であると判断された場合にはステップＳ１に戻されるステップＳ９と、
を具備することを特徴とする請求項１に記載のマニピュレータ制御装置。
前記動作情報検出部は、前記マスターマニピュレータの可動部の動作情報を検出するセンサーを備え、
前記キャンセル手段は、前記センサーからの検出結果にもとづいて前記マスターマニピュレータが操作されていない停止状態であることを判断し、前記マスターマニピュレータの停止状態の検出時には前記スレーブマニピュレータ側に伝達される前記動作情報を更新しないものであることを特徴とする請求項１に記載のマニピュレータ制御装置。