JP4422257B2

JP4422257B2 - Manipulator control device

Info

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

Description

【０００１】
【発明の属する技術分野】
本発明は、生体の、例えば体腔内に挿入したマニピュレータを操作手段によって遠隔的に操作し、診断・処置等の手術を行う手術用のマニピュレータ制御装置に関する。
【０００２】
【従来の技術】
一般に、腹壁等の体壁に穴を開け、この穴を通じて内視鏡や処置具を経皮的に体腔内に挿入することにより、その体腔内での様々な処置を行なう経皮的内視鏡下手術が、大きな切開を要しない低侵襲なものとして、近年、注目されている。こうした術式は胆のう摘出手術や肺の一部を摘出除去する手術等で広く行なわれている。
【０００３】
このような手術において、マニピュレータに内視鏡や処置具を搭載し、そのマニピュレータによる内視鏡や処置具を用いた手術を術者に代わって間接的に行う手術用マニピュレータシステムが、米国特許第５，２１７，００３号や、特開平７−３２８０１６号公報などに示されている。
【０００４】
図１３はこの手術用マニピュレータシステムの概略構成を示すものである。このマニピュレータシステムには術野にアクセスするように設置されているスレーブマニピュレータａと、術者が操作できる領域内に設置されたジョイスティックなどのマスターマニピュレータｂとが設けられている。ここで、スレーブマニピュレータａにはスレーブ制御部ｃ、マスターマニピュレータｂにはマスター制御部ｄがそれぞれ連結されている。
【０００５】
さらに、スレーブ制御部ｃとマスター制御部ｄとの間は信号ケーブルなどの通信手段を介して連結されている。ここで、マスター制御部ｄにはマスターマニピュレータｂの操作部の操作を検出する検出手段が設けられている。そして、このマスター制御部ｄによって検出されたマスターマニピュレータｂの操作部の操作状態が制御信号に変換されて通信手段を介してスレーブ制御部ｃに伝送されるようになっている。また、スレーブ制御部ｃからはマスター制御部ｄから送られるマスターマニピュレータｂの操作部の操作に追従した動きをスレーブマニピュレータａに伝達する制御信号が出力されるようになっている。
【０００６】
そして、こうした手術用マニピュレータの遠隔操作では、内視鏡等の観察手段によりモニターに映し出された腹腔内の患部の状態を見ながら、操作者がジョイスティックなどのマスターマニピュレータｂの操作部を操作することによって例えばマスターマニピュレータｂの操作部の操作方向にスレーブマニピュレータａを動作させるようになっている。
【０００７】
また、マスターマニピュレータｂとして例えば略鋏型の開閉動作可能な操作部を使用するとともに、スレーブマニピュレータａとして例えば把持鉗子のように開閉可能な１対の鉗子片を備えた処置部を使用するシステムが考えらている。ここでは、マスターマニピュレータｂの操作部を開閉操作した場合にこのマスターマニピュレータｂの操作部を開閉動作に応じてスレーブマニピュレータａの把持鉗子の１対の鉗子片が開閉駆動されるようになっている。このとき、スレーブマニピュレータａの把持鉗子の１対の鉗子片の開閉動作（動作量）を検出し、スレーブマニピュレータａの１対の鉗子片間の開閉動作が異常動作か、正常な動作かを判別する判別手段を設けた構成が考えられている。
【０００８】
また、マスターマニピュレータｂの操作部の操作前にマスターマニピュレータｂの初期位置と、スレーブマニピュレータａの初期位置とを位置合わせする初期位置調整用のキャリブレーション（イニシャライズ）を行った状態で、スレーブマニピュレータａの動作範囲を検査することにより、スレーブマニピュレータａの機械的な異常の有無（スレーブマニピュレータａの動作範囲が規定通りか否か）を確認する作業を行うことが一般的である。
【０００９】
【発明が解決しようとする課題】
ところで、手術用マニピュレータシステムの使用開始時に初期位置調整用のキャリブレーションを行う場合には例えばマスターマニピュレータｂの現在位置とスレーブマニピュレータａの現在位置とが検出されるとともに、マスターマニピュレータｂの現在位置と対応する位置に合わせるように電気制御によってスレーブマニピュレータａの駆動機構を動かしてスレーブマニピュレータａの位置を移動させる初期位置調整作業が行われている。このとき、スレーブマニピュレータａを現在位置から調整位置まで移動させる際にはスレーブ制御部ｃから出力される制御信号がスレーブマニピュレータａの駆動機構部に入力されると同時に、マスターマニピュレータｂのズレ量がスレーブマニピュレータａに即座に反映され、スレーブマニピュレータａが急速に調整位置まで移動される。そのため、このスレーブマニピュレータａを現在位置から調整位置まで移動させる移動時には、スレーブマニピュレータａの駆動機構部に作用する機械的な負荷が大きくなるので、スレーブマニピュレータａの駆動機構部の耐久性の向上を図るうえで問題がある。
【００１０】
さらに、このキャリブレーション作業時にスレーブマニピュレータａの移動量が大きい場合にはスレーブマニピュレータａの駆動機構部に作用する機械的な負荷が一層大きくなる問題がある。
【００１１】
本発明は上記事情に着目してなされたもので、その目的は、マスターマニピュレータとスレーブマニピュレータとの位置・姿勢のキャリブレーションの作業時にスレーブマニピュレータの駆動機構側に作用する機械的な負荷を軽減させることができ、システム全体の耐久性の向上を図ることができるマニピュレータ制御装置を提供することにある。
【００１２】
【課題を解決するための手段】
請求項１の発明は、術野にアクセスするように設置されたスレーブマニピュレータと、
術者が操作できる領域内に設置され、前記スレーブマニピュレータを遠隔的に操作するマスターマニピュレータと、
このマスターマニピュレータに接続され、前記マスターマニピュレータの操作を電気信号に変換するマスター制御部と、
前記スレーブマニピュレータおよび前記マスター制御部にそれぞれ接続され、前記マスター制御部から送られる前記マスターマニピュレータの操作に追従した動きを前記スレーブマニピュレータに伝達する制御信号を出力するスレーブ制御部と、
前記マスターマニピュレータの動作開始時に前記マスターマニピュレータの現在位置と前記スレーブマニピュレータの現在位置との間の位置ズレ量を検出する位置ズレ量検出手段と、
この位置ズレ量検出手段からの検出結果にもとづいて前記マスターマニピュレータの位置と前記スレーブマニピュレータの位置とを整合させるキャリブレーション作業時に前記スレーブマニピュレータの駆動機構に作用する機械的な負荷を低減させる負荷低減手段と
を具備したことを特徴とするマニピュレータ制御装置である。
【００１３】
そして、本請求項１の発明では、マスターマニピュレータの動作開始時には位置ズレ量検出手段によってマスターマニピュレータの現在位置とスレーブマニピュレータの現在位置との間の位置ズレ量を検出し、この位置ズレ量検出手段からの検出結果にもとづいてマスターマニピュレータの位置とスレーブマニピュレータの位置とを整合させるキャリブレーション作業が行われる。このキャリブレーション作業時には負荷低減手段によってスレーブマニピュレータの駆動機構に作用する機械的な負荷を低減させるようにしたものである。
【００１４】
請求項２の発明は、前記負荷低減手段は、前記キャリブレーション作業時に前記スレーブマニピュレータの移動速度を前記スレーブマニピュレータ駆動機構の機械的な負荷が低減できる程度に減速する減速手段によって形成されていることを特徴とする請求項１に記載のマニピュレータ制御装置である。
【００１５】
そして、本請求項２の発明では、キャリブレーション作業時に減速手段によってスレーブマニピュレータの移動速度をスレーブマニピュレータ駆動機構の機械的な負荷が低減できる程度に減速するようにしたものである。
【００１６】
請求項３の発明は、前記負荷低減手段は、前記キャリブレーション作業時に前記マスターマニピュレータの位置検出用の座標系を前記スレーブマニピュレータの現在位置に合わせて前記位置ズレ量を補完する状態に再構築する座標補完手段によって形成されることを特徴とする請求項１に記載のマニピュレータ制御装置である。
【００１７】
そして、本請求項３の発明では、キャリブレーション作業時に座標補完手段によってマスターマニピュレータの位置検出用の座標系をスレーブマニピュレータの現在位置に合わせて位置ズレ量を補完する状態に再構築するようにしたものである。
【００１８】
請求項４の発明は、前記負荷低減手段は、前記キャリブレーション作業時に前記スレーブマニピュレータの移動が可能な動作範囲内で、前記動作範囲の中心位置から一定量離れた所定の設定範囲に位置整合動作の制御実行範囲を予め設定し、前記スレーブマニピュレータの現在位置が前記制御実行範囲外である場合には前記位置整合動作を行わずに前記スレーブマニピュレータの現在位置が前記制御実行範囲外である状態を報知する報知手段を備えたことを特徴とする請求項１に記載のマニピュレータ制御装置である。
【００１９】
そして、本請求項４の発明では、キャリブレーション作業時にスレーブマニピュレータの移動が可能な動作範囲内で、動作範囲の中心位置から一定量離れた所定の設定範囲に位置整合動作の制御実行範囲を予め設定し、スレーブマニピュレータの現在位置が制御実行範囲外である場合には位置整合動作を行わずに報知手段によってスレーブマニピュレータの現在位置が制御実行範囲外である状態を報知するようにしたものである。
【００２０】
【発明の実施の形態】
以下、本発明の第１の実施の形態を図１乃至図８（Ａ），（Ｂ）を参照して説明する。図１は本実施の形態のマニピュレータ制御装置１のシステム全体の概略構成を示すものである。本実施の形態のマニピュレータ制御装置１には術野にアクセスするように設置されたスレーブマニピュレータ２と、術者が操作できる領域内に設置され、スレーブマニピュレータ２を遠隔的に操作するマスターマニピュレータ３とが設けられている。ここで、スレーブマニピュレータ２には２組のスレーブマニピュレータ、すなわち左側スレーブマニピュレータ２ａと、右側スレーブマニピュレータ２ｂとが設けられている。さらに、マスターマニピュレータ３にも同様に左側スレーブマニピュレータ２ａを操作する左側マスターマニピュレータ３ａと、右側スレーブマニピュレータ２ｂを操作する右側マスターマニピュレータ３ｂとが設けられている。
【００２１】
また、２つのスレーブマニピュレータ２ａ，２ｂ、マスターマニピュレータ３ａ，３ｂはそれぞれ略同一構成になっているので、ここでは一方の左側のスレーブマニピュレータ２ａおよびマスターマニピュレータ３ａの構成のみを説明し、右側のスレーブマニピュレータ２ｂおよびマスターマニピュレータ３ｂの同一部分には同一の符号を付してその説明を省略する。
【００２２】
すなわち、本実施の形態の左側のスレーブマニピュレータ２ａには細長い挿入部４を備えたマニピュレータ本体５と、このマニピュレータ本体５を駆動するスレーブ駆動部６とが設けられている。さらに、挿入部４の先端部には図３に示すように例えば把持鉗子のように開閉可能な１対の把持部材７ａ，７ｂを備えた先端把持部７が設けられている。これらの把持部材７ａ，７ｂの基端部間は挿入部４の先端部に回動ピン８を中心に回動可能に連結されている。そして、これらの把持部材７ａ，７ｂはリンク機構部９によって回動ピン８を中心に開閉可能に支持されている。
【００２３】
また、マニピュレータ本体５はスレーブ駆動部６内の図示しないマニピュレータ本体駆動ユニットによって図３中で、Ｘ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動可能に駆動され、かつＸ軸の軸回り方向、Ｙ軸の軸回り方向、Ｚ軸の軸回り方向にそれぞれ回動駆動されるようになっている。さらに、マニピュレータ本体５の先端把持部７も同様にスレーブ駆動部６内の図示しない先端把持部駆動ユニットによって把持部材７ａ，７ｂ間が回動ピン８を中心に開閉駆動されるようになっている。なお、図３中で、Ｏ_Ｓはスレーブマニピュレータ２ａのマニピュレータ本体５の原点位置である。
【００２４】
また、左側マスターマニピュレータ３ａには図２に示すように例えば略鋏型の開閉動作可能なハンドル（操作部）１０と、このハンドル１０を図２中で、Ｘ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動可能に、かつＸ軸の軸回り方向、Ｙ軸の軸回り方向、Ｚ軸の軸回り方向にそれぞれ回動可能に支持する支持機構部１１（図４に示す）とが設けられている。なお、図２中で、Ｏ_M はマスターマニピュレータ３ａのハンドル１０の原点位置である。
【００２５】
また、ハンドル１０には図２に示すようにトッププレート１２に一端部が固定された支軸１３と、この支軸１３の他端部に回動軸１４を中心に回動可能に連結された２つのハンドル部材１５ａ，１５ｂとが設けられている。さらに、２つのハンドル部材１５ａ，１５ｂ間には回動軸１４側にリンク部材１６、自由端部側に板ばね部材１７がそれぞれ配設されている。そして、このハンドル１０は板ばね部材１７のばね力によって図２中に実線で示すように全開位置方向に付勢されている。
【００２６】
また、このハンドル１０の一方のハンドル部材１５ａにはストッパ１８が他方のハンドル部材１５ｂ側に向けて突設されている。そして、このハンドル１０の閉操作時には図２中に仮想線で示すようにハンドル部材１５ａのストッパ１８がハンドル部材１５ｂに突き当たることにより、このハンドル１０の閉操作が規制され、この状態が全閉位置に設定されている。
【００２７】
さらに、ハンドル１０のハンドル部材１５ａにはポテンショメータ１９が取付けられている。そして、このポテンショメータ１９によってハンドル１０の開閉角度が検出されるようになっている。
【００２８】
また、マスターマニピュレータ３ａの支持機構部１１はパンタグラフ機構を複数組み合わせて構成された多自由度マニピュレータによって形成されている。ここで、出力節であるトッププレート１２には、３つのパンタグラフと３つの回転対偶軸とが取付けられている。なお、各パンダグラフ、対偶軸には、図示しないエンコーダが取付けられている。そして、このエンコーダによってハンドル１０の操作を検出する検出手段が形成されている。さらに、マスターマニピュレータ３にはこのマスターマニピュレータ３を操作不能なロック状態と、このマスターマニピュレータ３の操作が可能なロック解除状態とに切換える例えば電磁ロック式の図示しないロック機構部が組込まれている。
【００２９】
また、マスターマニピュレータ３にはこのマスターマニピュレータ３の操作を電気信号に変換するマスター制御部２０が接続されている。このマスター制御部２０にはマスターマニピュレータ３のポテンショメータ１９および支持機構部１１のエンコーダなどの位置検出装置２１と、例えば位置計算用のコンピュータによって形成される演算回路２２とが設けられている。そして、位置検出装置２１による左右のマスターマニピュレータ３ａ，３ｂの操作状態の検出データ（Ｌ検出信号、Ｒ検出信号）は演算回路２２に入力され、この演算回路２２で位置計算されてマスターマニピュレータ３のハンドル１０の操作状態や、ハンドル１０の開閉状態などのデータが算出されるようになっている。
【００３０】
さらに、このマスター制御部２０にはマスターマニピュレータ３のロック機構部の制御用のフットスイッチ２３が接続されている。このフットスイッチ２３には２つのペダル２３ａ，２３ｂが設けられている。そして、一方のペダル２３ａによってマスターマニピュレータ３のロック状態と、ロック解除状態とを切換えるロック状態の切換え操作部、他方のペダル２３ｂによって移動用クラッチの切換え操作部がそれぞれ形成されている。
【００３１】
なお、マスターマニピュレータ３を操作する術者の近傍位置にはモニター２４が配置されている。そして、このモニター２４に表示される表示画面を見ながらマスターマニピュレータ３の操作が行われるようになっている。
【００３２】
また、スレーブマニピュレータ２にはマスターマニピュレータ３の操作に追従した動きをスレーブマニピュレータ２に伝達する制御信号を出力するスレーブ制御部２５が接続されている。このスレーブ制御部２５にはスレーブマニピュレータ２のスレーブ駆動部６に組込まれている複数の駆動モータ２６を制御するモータ駆動回路２７と、例えばスレーブマニピュレータ制御用のコンピュータによって形成される演算回路２８とが設けられている。
【００３３】
さらに、スレーブ制御部２５の演算回路２８とマスター制御部２０の演算回路２２との間は例えば光ファイバーケーブルなどの通信手段２９を介して接続されている。そして、スレーブ制御部２５ではマスター制御部２０から送られるマスターマニピュレータ３の操作に追従した動きをスレーブマニピュレータ２に伝達する制御信号を出力するようになっている。
【００３４】
また、スレーブ制御部２５の演算回路２８には図５に示すようにキャリブレーション動作の開始状態を検出するキャリブレーション動作検出手段２８ａと、スレーブマニピュレータ２の現在位置（Ｘ方向の位置Ｘｓ、Ｙ方向の位置Ｙｓ、Ｚ方向の位置Ｚｓ、Ｘ軸回り方向の回動角度θｘｓ、Ｙ軸回り方向の回動角度θｙｓ、Ｚ軸回り方向の回動角度θｚｓ）を検出するスレーブマニピュレータ位置検出手段２８ｂと、キャリブレーション動作の開始時にマスターマニピュレータ３の現在位置（Ｘ方向の位置Ｘｍ、Ｙ方向の位置Ｙｍ、Ｚ方向の位置Ｚｍ、Ｘ軸回り方向の回動角度θｘｍ、Ｙ軸回り方向の回動角度θｙｍ、Ｚ軸回り方向の回動角度θｚｍ）とスレーブマニピュレータ２の現在位置（Ｘｓ、Ｙｓ、Ｚｓ、θｘｓ、θｙｓ、θｚｓ）との間の位置ズレ量を検出する位置ズレ量検出手段２８ｃと、キャリブレーション動作の開始時に位置ズレ量検出手段２８ｃからの検出結果にもとづいてスレーブマニピュレータ２をマスターマニピュレータ３の現在位置（Ｘｍ、Ｙｍ、Ｚｍ、θｘｍ、θｙｍ、θｚｍ）と対応するキャリブレーション位置（Ｘｃ、Ｙｃ、Ｚｃ、θｘｃ、θｙｃ、θｚｃ）に移動させる際のスレーブ駆動部６に作用する機械的な負荷を低減させる負荷低減手段であるスレーブ駆動部６の減速手段２８ｄと、ＣＰＵ２８ｅとが設けられている。ここで、減速手段２８ｄはキャリブレーション動作時にスレーブマニピュレータ２の移動速度をスレーブ駆動部６の機械的な負荷が低減できる程度、例えばスレーブマニピュレータ２のＸ方向、Ｙ方向、Ｚ方向の各移動速度を１００ｍＳｅｃ（１step）毎に２ｍｍの移動量で、かつＸ軸回り方向の回動角度θｘ、Ｙ軸回り方向の回動角度θｙ、Ｚ軸回り方向の回動角度θｚが１００ｍＳｅｃ（１step）毎に２°の移動量でそれぞれ回動動作させる状態に減速する手段によって形成されている。
【００３５】
次に、上記構成の作用について説明する。本実施の形態のマニピュレータ制御装置１の使用時には、マスターマニピュレータ３が術者が操作できる領域内に設置される。さらに、スレーブマニピュレータ２は術野にアクセスするように設置される。例えば、図４に示すように予め診断・処置等の手術を行う患者の腹壁等の体壁Ｈに図示しないトロッカーによって穴を開け、この穴に刺入されたトロッカー外套管内にスレーブマニピュレータ２の挿入部４が挿入され、このトロッカー外套管内を通じてスレーブマニピュレータ２の挿入部４が経皮的に体腔内に挿入された状態にセットされる。このとき、マスターマニピュレータ３を操作する術者の近傍位置のモニター２４にはスレーブマニピュレータ２とは別の場所から経皮的に体腔内に挿入された内視鏡による術野の内視鏡像、或いはコンピュータグラフィック装置によって合成された術野のコンピュータグラフィック画像（ＣＧ画像）などが表示される。
【００３６】
また、スレーブマニピュレータ２およびマスターマニピュレータ３のセット後、スレーブ制御部２５のキャリブレーション動作検出手段２８ａによってキャリブレーション動作の開始状態が検出されると、スレーブマニピュレータ２の位置と、マスターマニピュレータ３の位置とを対応させるキャリブレーション動作が行われる。このキャリブレーション動作は図６のフローチャートにしたがって行われる。なお、キャリブレーション動作の開始前は、左右のスレーブマニピュレータ２ａ，２ｂおよび左右のマスターマニピュレータ３ａ，３ｂはそれぞれ任意の位置で保持されている。図７はマスターマニピュレータ３ａ，３ｂの現在位置（Ｘｍ、Ｙｍ、Ｚｍ、θｘｍ、θｙｍ、θｚｍ）を示す。
【００３７】
また、キャリブレーション動作の開始時にはスレーブマニピュレータ位置検出手段２８ｂによって左右のスレーブマニピュレータ２ａ，２ｂの現在位置（Ｘｓ、Ｙｓ、Ｚｓ、θｘｓ、θｙｓ、θｚｓ）が検出される。そして、ステップＳ１で、左右のスレーブマニピュレータ２ａ，２ｂが図８に示すように原点位置Ｏｓ（Ｘ方向の位置Ｘｓ＝０、Ｙ方向の位置Ｙｓ＝０、Ｚ方向の位置Ｚｓ＝０、Ｘ軸回り方向の回動角度θｘｓ＝０、Ｙ軸回り方向の回動角度θｙｓ＝０、Ｚ軸回り方向の回動角度θｚｓ＝０）に移動される。
【００３８】
その後、次のステップＳ２で、左右のスレーブマニピュレータ２ａ，２ｂが原点位置Ｏｓか否かが判断される。このステップＳ２で、左右のスレーブマニピュレータ２ａ，２ｂが原点位置Ｏｓではないと判断された場合にはステップＳ１に戻される。そして、ステップＳ２で、左右のスレーブマニピュレータ２ａ，２ｂが原点位置Ｏｓと確認された場合には次のステップＳ３に進む。
【００３９】
このステップＳ３では図７に示すマスターマニピュレータ３ａ，３ｂの現在位置（Ｘｍ、Ｙｍ、Ｚｍ、θｘｍ、θｙｍ、θｚｍ）が検出される。なお、マスターマニピュレータ３ａ，３ｂの使用開始位置は操作者により位置・姿勢が多少ズレることが普通である。このとき、位置ズレ量検出手段２８ｃによってキャリブレーション動作の開始時のマスターマニピュレータ３ａ，３ｂの現在位置（Ｘｍ、Ｙｍ、Ｚｍ、θｘｍ、θｙｍ、θｚｍ）とスレーブマニピュレータ２ａ，２ｂの現在位置（Ｘｓ、Ｙｓ、Ｚｓ、θｘｓ、θｙｓ、θｚｓ）との間の位置ズレ量が検出される。
【００４０】
その後、次のステップＳ４に進む。このステップＳ４ではマスターマニピュレータ３のロックが解除状態か、否かが判断される。ここで、フットスイッチ２３のペダル２３ａを踏むことにより、マスターマニピュレータ３のロックが解除される。この状態では左右のマスターマニピュレータ３ａ，３ｂが図２中で、Ｘ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動可能、かつＸ軸の軸回り方向、Ｙ軸の軸回り方向、Ｚ軸の軸回り方向にそれぞれ回動可能な状態にそれぞれ切換えられるとともに、左右のマスターマニピュレータ３ａ，３ｂの２つのハンドル部材１５ａ，１５ｂ間が開閉動作可能な状態にそれぞれ切換えられる。このとき、マスターマニピュレータ３ａ，３ｂの現在位置（Ｘｍ、Ｙｍ、Ｚｍ、θｘｍ、θｙｍ、θｚｍ）の情報がスレーブ制御部２５に送られる。
【００４１】
そして、ステップＳ４で、ロックが解除されていないと判断された場合にはステップＳ３に戻される。また、ステップＳ４で、ロック解除状態と判断された場合には次のステップＳ５に進む。
【００４２】
このステップＳ５ではスレーブマニピュレータ２ａ，２ｂを現在位置（Ｘｓ、Ｙｓ、Ｚｓ、θｘｓ、θｙｓ、θｚｓ）から減速状態で、左右のマスターマニピュレータ３ａ，３ｂの現在位置（Ｘｍ、Ｙｍ、Ｚｍ、θｘｍ、θｙｍ、θｚｍ）と対応するキャリブレーション位置（Ｘｃ、Ｙｃ、Ｚｃ、θｘｃ、θｙｃ、θｚｃ）に移動させる動作が行われる。このとき、スレーブ駆動部６の減速手段２８ｄによってスレーブマニピュレータ２ａ，２ｂの移動速度がスレーブ駆動部６の機械的な負荷が低減できる程度、例えばスレーブマニピュレータ２ａ，２ｂのＸ方向、Ｙ方向、Ｚ方向の各移動速度を１００ｍＳｅｃ（１step）毎に２ｍｍの移動量で、かつＸ軸回り方向の回動角度θｘ、Ｙ軸回り方向の回動角度θｙ、Ｚ軸回り方向の回動角度θｚが１００ｍＳｅｃ（１step）毎に２°の移動量でそれぞれ回動動作させる状態に減速される。
【００４３】
その後、次のステップＳ６で、スレーブマニピュレータ２ａ，２ｂのキャリブレーション位置（Ｘｃ、Ｙｃ、Ｚｃ、θｘｃ、θｙｃ、θｚｃ）が左右のマスターマニピュレータ３ａ，３ｂの現在位置（Ｘｍ、Ｙｍ、Ｚｍ、θｘｍ、θｙｍ、θｚｍ）と等しいか、否かが判断される。ここで、両方のマニピュレータ２ａ，２ｂ、３ａ，３ｂの位置が等しくないと判断された場合にはステップＳ５に戻される。また、ステップＳ６で、両方のマニピュレータ２ａ，２ｂ、３ａ，３ｂの位置が等しいと判断された場合にはキャリブレーション動作が終了する。
【００４４】
さらに、このキャリブレーション動作の終了後、本実施の形態のマニピュレータ制御装置１による診断・処置等の手術が開始される。この手術時には術者はモニター２４に表示される術野の内視鏡像、或いはＣＧ画像の画面を見ながらマスターマニピュレータ３の左右のマスターマニピュレータ３ａ，３ｂがそれぞれ操作される。このとき、左側マスターマニピュレータ３ａのハンドル１０が術者の左手、右側マスターマニピュレータ３ｂのハンドル１０が術者の右手で握られた状態でそれぞれ操作され、左側マスターマニピュレータ３ａによって左側スレーブマニピュレータ２ａ、右側マスターマニピュレータ３ｂによって右側スレーブマニピュレータ２ｂがそれぞれ独立に遠隔操作される。
【００４５】
例えば、左側マスターマニピュレータ３ａのハンドル１０を図２中で、Ｘ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動させ、かつＸ軸の軸回り方向、Ｙ軸の軸回り方向、Ｚ軸の軸回り方向にそれぞれ回動させた場合にはこのときのマスターマニピュレータ３ａの動作がマスター制御部２０の位置検出装置２１で検出される。この位置検出装置２１からの検出データは演算回路２２に入力され、この演算回路２２で位置計算されてマスターマニピュレータ３のハンドル１０の操作状態や、ハンドル１０の開閉状態などのデータが算出される。
【００４６】
さらに、マスター制御部２０の演算回路２２で位置計算された算出データは光ファイバーケーブルなどの通信手段２９を介してスレーブ制御部２５に送信される。
【００４７】
また、スレーブ制御部２５では受信された制御信号にもとづいて演算回路２８によってスレーブ駆動部６に組込まれているモータ駆動回路２７の複数の駆動モータ２６を制御する制御信号が算出される。そして、このスレーブ制御部２５から出力される制御信号が左側スレーブマニピュレータ２ａに伝達され、左側スレーブマニピュレータ２ａが遠隔的に操作される。このとき、左側スレーブマニピュレータ２ａは左側マスターマニピュレータ３ａのハンドル１０の動きに追従して動く。なお、右側マスターマニピュレータ３ｂの操作時にも同様の作用によって右側スレーブマニピュレータ２ｂの動作が制御され、右側マスターマニピュレータ３ｂの操作に追従して右側スレーブマニピュレータ２ｂが動くようになっている。
【００４８】
そこで、上記構成のものにあっては次の効果を奏する。すなわち、本実施の形態ではマスターマニピュレータ３の動作開始時にはスレーブ制御部２５の演算回路２８における位置ズレ量検出手段２８ｃによってマスターマニピュレータ３の現在位置とスレーブマニピュレータ２の現在位置との間の位置ズレ量を検出し、この位置ズレ量検出手段２８ｃからの検出結果にもとづいてマスターマニピュレータ３の位置とスレーブマニピュレータ２の位置とを整合させるキャリブレーション作業が行われる。このキャリブレーション作業時には負荷低減手段であるスレーブ駆動部６の減速手段２８ｄによってスレーブマニピュレータ２の移動速度を低減させるようにしたので、マスターマニピュレータ３の位置とスレーブマニピュレータ２の位置との間に座標のズレ量が有ったとしてもスレーブマニピュレータ２がマスターマニピュレータ３の位置と対応する位置に急激に移動することない。そのため、マスターマニピュレータ３とスレーブマニピュレータ２との位置・姿勢のキャリブレーションの作業時にスレーブマニピュレータ２の駆動機構であるスレーブ駆動部６側に作用する機械的な負荷を軽減させることができ、システム全体の耐久性の向上を図ることができる。
【００４９】
また、図９乃至図１２は本発明の第２の実施の形態を示すものである。本実施の形態は第１の実施の形態（図１乃至図８（Ａ），（Ｂ）参照）のマニピュレータ制御装置１のスレーブ制御部２５の構成を次の通り変更したものである。
【００５０】
すなわち、本実施の形態ではスレーブ制御部２５の演算回路２８は図９に示すように構成されている。ここで、本実施の形態の演算回路２８には第１の実施の形態と同様にキャリブレーション動作検出手段２８ａと、スレーブマニピュレータ位置検出手段２８ｂと、位置ズレ量検出手段２８ｃと、ＣＰＵ２８ｅとが設けられている。さらに、ＣＰＵ２８ｅにはキャリブレーション作業時にマスターマニピュレータ３の位置検出用の座標系をスレーブマニピュレータ２の現在位置に合わせて位置ズレ量を補完する状態に再構築する座標補完手段３１が接続されている。
【００５１】
そして、本実施の形態のマニピュレータ制御装置１では使用開始時にスレーブマニピュレータ２の位置と、マスターマニピュレータ３の位置とを対応させるキャリブレーション動作は図１０のフローチャートにしたがって行われる。
【００５２】
まず、キャリブレーション動作の開始時にはステップＳ１１で、図１１（Ａ）に示す現在のマスターマニピュレータ３の座標系（Ｘ−Ｙ−Ｚ）と、図１１（Ｂ）に示す現在のスレーブマニピュレータ２の座標系（Ｘ−Ｙ−Ｚ）とを対応させる動作が行われる。このとき、スレーブマニピュレータ位置検出手段２８ｂによって左右のスレーブマニピュレータ２ａ，２ｂの現在位置（Ｘｓ、Ｙｓ、Ｚｓ、θｘｓ、θｙｓ、θｚｓ）が検出される。そして、次のステップＳ１２で、左右のスレーブマニピュレータ２ａ，２ｂが図１１（Ｂ）に示すように原点位置Ｏｓ（Ｘ方向の位置Ｘｓ＝０、Ｙ方向の位置Ｙｓ＝０、Ｚ方向の位置Ｚｓ＝０、Ｘ軸回り方向の回動角度θｘｓ＝０、Ｙ軸回り方向の回動角度θｙｓ＝０、Ｚ軸回り方向の回動角度θｚｓ＝０）に移動される。
【００５３】
その後、次のステップＳ１３で、左右のスレーブマニピュレータ２ａ，２ｂが原点位置Ｏｓか否かが判断される。このステップＳ１３で、左右のスレーブマニピュレータ２ａ，２ｂが原点位置Ｏｓではないと判断された場合にはステップＳ１２に戻される。そして、ステップＳ１３で、左右のスレーブマニピュレータ２ａ，２ｂが原点位置Ｏｓと確認された場合には次のステップＳ１４に進む。
【００５４】
このステップＳ１４では図１１（Ａ）に示すマスターマニピュレータ３ａ，３ｂの現在位置（Ｘｍ、Ｙｍ、Ｚｍ、θｘｍ、θｙｍ、θｚｍ）が検出される。このとき、位置ズレ量検出手段２８ｃによってキャリブレーション動作の開始時のマスターマニピュレータ３ａ，３ｂの現在位置（Ｘｍ、Ｙｍ、Ｚｍ、θｘｍ、θｙｍ、θｚｍ）とスレーブマニピュレータ２ａ，２ｂの現在位置（Ｘｓ、Ｙｓ、Ｚｓ、θｘｓ、θｙｓ、θｚｓ）との間の位置ズレ量が検出される。
【００５５】
その後、次のステップＳ１５に進む。このステップＳ１５ではマスターマニピュレータ３のロックが解除状態か、否かが判断される。ここで、フットスイッチ２３のペダル２３ａを踏むことにより、マスターマニピュレータ３のロックが解除される。この状態では左右のマスターマニピュレータ３ａ，３ｂがＸ軸方向（左右方向）、Ｙ軸方向（上下方向）、Ｚ軸方向（前後方向）にそれぞれ移動可能、かつＸ軸の軸回り方向、Ｙ軸の軸回り方向、Ｚ軸の軸回り方向にそれぞれ回動可能な状態にそれぞれ切換えられるとともに、左右のマスターマニピュレータ３ａ，３ｂの２つのハンドル部材１５ａ，１５ｂ間が開閉動作可能な状態にそれぞれ切換えられる。
【００５６】
そして、ステップＳ１５で、ロックが解除されていないと判断された場合にはステップＳ１４に戻される。また、ステップＳ１５で、ロック解除状態と判断された場合には次のステップＳ１６に進む。
【００５７】
このステップＳ１６では図１２中に点線で示すマスターマニピュレータ３の位置検出用の座標系（Ｘ−Ｙ−Ｚ）を図１１（Ｂ）に示すスレーブマニピュレータ２の座標系（Ｘ−Ｙ−Ｚ）に合わせて回転させ、位置ズレ量を補完する図１２中に実線で示す新座標系（Ｘ１−Ｙ１−Ｚ１）に再構築する座標補完作業が行われる。
【００５８】
その後、次のステップＳ１７で、マスターマニピュレータ３の新座標系（Ｘ１−Ｙ１−Ｚ１）と、スレーブマニピュレータ２の座標系（Ｘ−Ｙ−Ｚ）とが等しいか、否かが判断される。ここで、マスターマニピュレータ３の新座標系（Ｘ１−Ｙ１−Ｚ１）と、スレーブマニピュレータ２の座標系（Ｘ−Ｙ−Ｚ）とが等しくないと判断された場合にはステップＳ１６に戻される。また、ステップＳ１７で、マスターマニピュレータ３の新座標系（Ｘ１−Ｙ１−Ｚ１）と、スレーブマニピュレータ２の座標系（Ｘ−Ｙ−Ｚ）とが等しいと判断された場合にはこのマスターマニピュレータ３の新座標系（Ｘ１−Ｙ１−Ｚ１）を元にマスターマニピュレータ３の位置、姿勢情報が作成されてスレーブマニピュレータ２側にその情報データが送信され、キャリブレーション動作が終了する。
【００５９】
さらに、このキャリブレーション動作の終了後、第１の実施の形態のマニピュレータ制御装置１と同様の手順によって診断・処置等の手術が開始される。
【００６０】
そこで、本実施の形態ではキャリブレーション作業時にはスレーブ制御部２５の演算回路２８における座標補完手段３１によってマスターマニピュレータ３の位置検出用の座標系（Ｘ−Ｙ−Ｚ）をスレーブマニピュレータ２の現在位置に合わせて位置ズレ量を補完する状態に再構築した新座標系（Ｘ１−Ｙ１−Ｚ１）を作るようにしたので、キャリブレーション作業時にスレーブマニピュレータ２を動かすこと無く、かつマスターマニピュレータ３の開始位置がずれたままの状態で診断・処置等の手術を開始させることができる。そのため、マスターマニピュレータ３とスレーブマニピュレータ２との位置・姿勢のキャリブレーションの作業時に格別にスレーブマニピュレータ２を動かす必要が無いので、スレーブマニピュレータ２の駆動機構であるスレーブ駆動部６側に作用する機械的な負荷を軽減させることができ、システム全体の耐久性の向上を図ることができる。さらに、キャリブレーション作業時にスレーブマニピュレータ２や、マスターマニピュレータ３の動きによって操作者に違和感を与えることがない、安定したキャリブレーション作業を行うことができる。
【００６１】
なお、本発明は上記実施の形態に限定されるものではない。例えば、キャリブレーション作業時にスレーブマニピュレータ２の移動が可能な動作範囲内で、この動作範囲の中心位置から一定量離れた所定の設定範囲に位置整合動作の制御実行範囲を予め設定し、スレーブマニピュレータ２の現在位置が制御実行範囲外である場合には位置整合動作を行わずにスレーブマニピュレータ２の現在位置が制御実行範囲外である状態を報知する報知手段を設けてもよい。この場合には、キャリブレーション作業時にスレーブマニピュレータ２の現在位置が制御実行範囲外である場合には報知手段によってその状態を報知することができるので、無駄な位置整合動作を行わずに済む効果がある。
【００６２】
さらに、その他、本発明の要旨を逸脱しない範囲で種々変形実施できることは勿論である。
次に、本出願の他の特徴的な技術事項を下記の通り付記する。
記
（付記項１）マスタ開始位置のズレを検出するズレ量検出手段と、ズレた差分をマスタスレーブ操作開始時に任意のスピードでキャリブレーションを実行するスローキャリブレーション手段を備えたマスタースレーブ装置。
【００６３】
（付記項２）マスタ開始位置のズレを検出するズレ量検出手段と、前記ズレ値からマスタの座標系を再構築する座標補完手段を備えたマスタースレーブ装置。
【００６４】
（付記項３）可動範囲の中心より、一定量離れた位置の場合、キャリブレーションを行わず、範囲外であることを報知する報知手段を備えた１、または２のマスタースレーブ装置。
【００６５】
（付記項１〜３の従来技術）マスターマニピュレータの開閉角度を任意の固定倍率でデータ変換後スレーブマニピュレータ開閉角度として扱っている。
【００６６】
（付記項１、３が解決しようとする課題）マスタとスレーブの操作開始時にマスタのズレ量がスレーブに即座に反映される為、メカ的負荷がかかる。
【００６７】
（付記項２、３が解決しようとする課題）ズレの位置合わせによる移動により、操作者に違和感を与えてしまう。
【００６８】
（付記項１、３の目的）マスタとスレーブの位置・姿勢のキャリブレーションでメカの負荷を軽減させる制御方法の提供。
【００６９】
（付記項２、３の目的）操作者に違和感を与えない制御方法の提供。
【００７０】
【発明の効果】
請求項１の発明によれば、マスターマニピュレータの動作開始時にマスターマニピュレータの現在位置とスレーブマニピュレータの現在位置との間の位置ズレ量を検出する位置ズレ量検出手段を設けるとともに、この位置ズレ量検出手段からの検出結果にもとづいてマスターマニピュレータの位置とスレーブマニピュレータの位置とを整合させるキャリブレーション作業時にスレーブマニピュレータの駆動機構に作用する機械的な負荷を低減させる負荷低減手段けたので、マスターマニピュレータとスレーブマニピュレータとの位置・姿勢のキャリブレーションの作業時にスレーブマニピュレータの駆動機構側に作用する機械的な負荷を軽減させることができ、システム全体の耐久性の向上を図ることができる。
【００７１】
請求項２の発明によれば、キャリブレーション作業時に減速手段によってスレーブマニピュレータの移動速度をスレーブマニピュレータ駆動機構の機械的な負荷が低減できる程度に減速することができる。これにより、マスターマニピュレータとスレーブマニピュレータとの位置・姿勢のキャリブレーションの作業時にスレーブマニピュレータの駆動機構側に作用する機械的な負荷を軽減させることができる。
【００７２】
請求項３の発明によれば、キャリブレーション作業時に座標補完手段によってマスターマニピュレータの位置検出用の座標系をスレーブマニピュレータの現在位置に合わせて位置ズレ量を補完する状態に再構築するようにしたので、マスターマニピュレータとスレーブマニピュレータとの位置・姿勢のキャリブレーションの作業時にスレーブマニピュレータの駆動機構側に作用する機械的な負荷を軽減させることができる。
【００７３】
請求項４の発明によれば、キャリブレーション作業時にスレーブマニピュレータの移動が可能な動作範囲内で、動作範囲の中心位置から一定量離れた所定の設定範囲に位置整合動作の制御実行範囲を予め設定し、スレーブマニピュレータの現在位置が制御実行範囲外である場合には位置整合動作を行わずに報知手段によってスレーブマニピュレータの現在位置が制御実行範囲外である状態を報知するようにしたので、キャリブレーション作業時にスレーブマニピュレータの現在位置が制御実行範囲外である場合にはその状態を確実に確認することができる。
【図面の簡単な説明】
【図１】本発明の第１の実施の形態におけるマニピュレータ制御装置のシステム全体の概略構成図。
【図２】第１の実施の形態のマニピュレータ制御装置におけるマスターマニピュレータの操作部を一部断面にして示す側面図。
【図３】第１の実施の形態のマニピュレータ制御装置におけるスレーブマニピュレータの先端把持部を示す要部の斜視図。
【図４】第１の実施の形態のマニピュレータ制御装置の使用状態を示す全体の概略構成図。
【図５】第１の実施の形態のマニピュレータ制御装置におけるスレーブ制御部の演算回路の概略構成図。
【図６】第１の実施の形態のマニピュレータ制御装置におけるキャリブレーション動作を説明するためのフローチャート。
【図７】第１の実施の形態のマニピュレータ制御装置におけるマスターマニピュレータの現在位置を説明するための説明図。
【図８】第１の実施の形態のマニピュレータ制御装置におけるスレーブマニピュレータの動作を説明するもので、（Ａ）はスレーブマニピュレータのキャリブレーション動作開始位置を説明するための説明図、（Ｂ）はスレーブマニピュレータのキャリブレーション位置を説明するための説明図。
【図９】本発明の第２の実施の形態のマニピュレータ制御装置におけるスレーブ制御部の演算回路の概略構成図。
【図１０】第２の実施の形態のマニピュレータ制御装置におけるキャリブレーション動作を説明するためのフローチャート。
【図１１】第２の実施の形態のマニピュレータ制御装置におけるマスターマニピュレータの動作を説明するもので、（Ａ）はマスターマニピュレータの動作開始位置を説明するための説明図、（Ｂ）はマスターマニピュレータのキャリブレーション状態を説明するための説明図。
【図１２】第２の実施の形態におけるマニピュレータ制御装置のスレーブマニピュレータの動作開始位置を説明するための説明図。
【図１３】従来の手術用マニピュレータシステムの概略構成図。
【符号の説明】
２スレーブマニピュレータ
３マスターマニピュレータ
６スレーブ駆動部（スレーブマニピュレータの駆動機構）
２０マスター制御部
２１位置検出装置
２５スレーブ制御部
２８ｃ位置ズレ量検出手段
２８ｄスレーブ駆動部の減速手段（負荷低減手段）
３１座標補完手段（負荷低減手段）[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. 13 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 for detecting the operation of the operation unit of the master manipulator b. The operation state of the operation unit of the master manipulator b detected by the master control unit d is converted into a control signal and transmitted to the slave control unit c via the communication means. 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.
[0006]
In such remote operation of the surgical manipulator, the operator operates the operation part of the master manipulator b such as a joystick while observing the state of the affected part in the abdominal cavity displayed on the monitor by observation means such as an endoscope. For example, the slave manipulator a is operated in the operation direction of the operation unit of the master manipulator b.
[0007]
In addition, there is a system that uses, for example, a substantially bowl-shaped operation unit that can be opened and closed as the master manipulator b, and a treatment unit that includes a pair of forceps pieces that can be opened and closed, such as grasping forceps, as the slave manipulator a. I am thinking. Here, when the operation unit of the master manipulator b is opened and closed, a pair of forceps pieces of the grasping forceps of the slave manipulator a are driven to open and close according to the opening and closing operation of the operation unit of the master manipulator b. . At this time, the opening / closing operation (operation amount) of the pair of forceps pieces of the grasping forceps of the slave manipulator a is detected to determine whether the opening / closing operation between the pair of forceps pieces of the slave manipulator a is an abnormal operation or a normal operation. A configuration in which a discriminating means is provided is considered.
[0008]
The slave manipulator a is calibrated (initialized) to adjust the initial position of the master manipulator b and the initial position of the slave manipulator a before the operation of the operation unit of the master manipulator b. It is common to perform an operation to check whether or not the slave manipulator a is mechanically abnormal (whether the operation range of the slave manipulator a is as specified) or not.
[0009]
[Problems to be solved by the invention]
By the way, when performing calibration for initial position adjustment at the start of use of the surgical manipulator system, for example, the current position of the master manipulator b and the current position of the slave manipulator a are detected, and the current position of the master manipulator b An initial position adjustment operation is performed to move the position of the slave manipulator a by moving the drive mechanism of the slave manipulator a by electric control so as to match the corresponding position. At this time, when the slave manipulator a is moved from the current position to the adjustment position, the control signal output from the slave control unit c is input to the drive mechanism unit of the slave manipulator a, and at the same time, the deviation amount of the master manipulator b is increased. The slave manipulator a is immediately reflected and the slave manipulator a is rapidly moved to the adjustment position. Therefore, when moving the slave manipulator a from the current position to the adjustment position, the mechanical load acting on the drive mechanism portion of the slave manipulator a increases, so that the durability of the drive mechanism portion of the slave manipulator a is improved. There is a problem in trying.
[0010]
Further, when the movement amount of the slave manipulator a is large at the time of the calibration work, there is a problem that the mechanical load acting on the drive mechanism unit of the slave manipulator a is further increased.
[0011]
The present invention has been made paying attention to the above circumstances, and its purpose is to reduce the mechanical load acting on the drive mechanism side of the slave manipulator during the calibration of the position and orientation of the master manipulator and the slave manipulator. An object of the present invention is to provide a manipulator control device that can improve the durability of the entire system.
[0012]
[Means for Solving the Problems]
The invention of claim 1 is a slave manipulator installed to access the surgical field;
A master manipulator that is installed in an area that can be operated by an operator and that remotely operates the slave manipulator;
A master control unit connected to the master manipulator for converting the operation of the master manipulator into an electric 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;
A positional deviation amount detecting means for detecting a positional deviation amount between a current position of the master manipulator and a current position of the slave manipulator at the start of operation of the master manipulator;
Load reduction that reduces the mechanical load acting on the drive mechanism of the slave manipulator during the calibration operation for aligning the position of the master manipulator and the position of the slave manipulator based on the detection result from the positional deviation amount detection means Means and
It is the manipulator control apparatus characterized by comprising.
[0013]
In the first aspect of the present invention, when the operation of the master manipulator is started, the positional deviation amount detecting means detects the positional deviation amount between the current position of the master manipulator and the current position of the slave manipulator, and this positional deviation amount detecting means. Based on the detection result from, a calibration operation for aligning the position of the master manipulator and the position of the slave manipulator is performed. During this calibration operation, the mechanical load acting on the drive mechanism of the slave manipulator is reduced by the load reducing means.
[0014]
According to a second aspect of the present invention, the load reducing means is formed by a speed reducing means for reducing the moving speed of the slave manipulator to the extent that the mechanical load of the slave manipulator driving mechanism can be reduced during the calibration operation. The manipulator control device according to claim 1.
[0015]
According to the second aspect of the present invention, the moving speed of the slave manipulator is reduced by the reduction means during the calibration operation to such an extent that the mechanical load of the slave manipulator driving mechanism can be reduced.
[0016]
According to a third aspect of the present invention, the load reducing unit reconstructs the coordinate system for detecting the position of the master manipulator in a state of complementing the amount of displacement by matching the current position of the slave manipulator during the calibration operation. The manipulator control device according to claim 1, wherein the manipulator control device is formed by coordinate complementing means.
[0017]
In the invention of claim 3, the coordinate system for detecting the position of the master manipulator is reconstructed by the coordinate complementing means at the time of calibration work so as to complement the positional deviation amount according to the current position of the slave manipulator. Is.
[0018]
According to a fourth aspect of the present invention, the load reducing means performs a position matching operation within a predetermined setting range that is a predetermined amount away from a center position of the operation range within an operation range in which the slave manipulator can move during the calibration operation. If the current position of the slave manipulator is out of the control execution range, the position of the slave manipulator is out of the control execution range without performing the position alignment operation. The manipulator control device according to claim 1, further comprising notification means for notifying.
[0019]
In the fourth aspect of the present invention, the control execution range of the position alignment operation is set in advance within a predetermined setting range that is a predetermined amount away from the center position of the operation range within the operation range in which the slave manipulator can be moved during the calibration work. If the current position of the slave manipulator is outside the control execution range, the notification means notifies the state that the current position of the slave manipulator is outside the control execution range without performing the position alignment operation. .
[0020]
DETAILED DESCRIPTION OF THE INVENTION
The first embodiment of the present invention will be described below with reference to FIGS. 1 to 8A and 8B. FIG. 1 shows a schematic configuration of the entire system of the manipulator control device 1 of the present embodiment. The manipulator control device 1 according to the present embodiment includes a slave manipulator 2 installed so as to access the operative field, a master manipulator 3 installed in an area where the operator can operate, and remotely operating the slave manipulator 2 Is provided. Here, the slave manipulator 2 is provided with two sets of slave manipulators, that is, a left slave manipulator 2a and a right slave manipulator 2b. Further, the master manipulator 3 is also provided with a left master manipulator 3a for operating the left slave manipulator 2a and a right master manipulator 3b for operating the right slave manipulator 2b.
[0021]
Since the two slave manipulators 2a and 2b and the master manipulators 3a and 3b have substantially the same configuration, only the configuration of one left slave manipulator 2a and master manipulator 3a will be described here, and the right slave manipulator The same parts of 2b and master manipulator 3b are denoted by the same reference numerals, and the description thereof is omitted.
[0022]
That is, the left slave manipulator 2a of the present embodiment is provided with a manipulator body 5 having an elongated insertion portion 4 and a slave driving portion 6 for driving the manipulator body 5. Further, as shown in FIG. 3, the distal end portion of the insertion portion 4 is provided with a distal end gripping portion 7 including a pair of gripping members 7a and 7b that can be opened and closed, such as gripping forceps. The base end portions of the gripping members 7a and 7b are connected to the distal end portion of the insertion portion 4 so as to be rotatable around a rotation pin 8. These gripping members 7a and 7b are supported by the link mechanism portion 9 so as to be openable and closable around the rotation pin 8.
[0023]
The manipulator body 5 is moved in the X-axis direction (left-right direction), Y-axis direction (up-down direction), and Z-axis direction (front-rear direction) in FIG. 3 by a manipulator body drive unit (not shown) in the slave drive unit 6. It is driven in such a manner that it is driven to rotate in the direction around the X axis, the direction around the Y axis, and the direction around the Z axis. Furthermore, the tip gripping portion 7 of the manipulator body 5 is similarly driven to open and close between the gripping members 7a and 7b around the rotation pin 8 by a tip gripping portion drive unit (not shown) in the slave drive portion 6. . In FIG. 3, O_SIs the origin position of the manipulator body 5 of the slave manipulator 2a.
[0024]
Further, as shown in FIG. 2, the left master manipulator 3a has, for example, a substantially saddle-shaped handle (operation unit) 10 that can be opened and closed, and this handle 10 in FIG. Support mechanism that can move in each direction (vertical direction) and Z-axis direction (front-rear direction), and that can rotate around the X-axis, Y-axis, and Z-axis. A portion 11 (shown in FIG. 4) is provided. In FIG. 2, O_M Is the origin position of the handle 10 of the master manipulator 3a.
[0025]
Further, as shown in FIG. 2, the handle 10 is connected to a support shaft 13 having one end fixed to the top plate 12 and to the other end of the support shaft 13 so as to be rotatable about a rotation shaft 14. Two handle members 15a and 15b are provided. Further, a link member 16 is disposed on the rotating shaft 14 side, and a leaf spring member 17 is disposed on the free end side between the two handle members 15a and 15b. The handle 10 is biased toward the fully open position by the spring force of the leaf spring member 17 as shown by the solid line in FIG.
[0026]
Further, a stopper 18 is provided on one handle member 15a of the handle 10 so as to project toward the other handle member 15b. When the handle 10 is closed, the stopper 18 of the handle member 15a hits the handle member 15b as shown by the phantom line in FIG. 2, so that the operation of closing the handle 10 is restricted, and this state is the fully closed position. Is set to
[0027]
Further, a potentiometer 19 is attached to the handle member 15 a of the handle 10. The potentiometer 19 detects the opening / closing angle of the handle 10.
[0028]
The support mechanism 11 of the master manipulator 3a is formed by a multi-degree-of-freedom manipulator configured by combining a plurality of pantograph mechanisms. Here, three pantographs and three rotating pair shafts are attached to the top plate 12 which is an output node. In addition, an encoder (not shown) is attached to each panda graph and the even axis. And the detection means which detects operation of the handle | steering-wheel 10 by this encoder is formed. Further, the master manipulator 3 incorporates a lock mechanism (not shown) of, for example, an electromagnetic lock type that switches between a locked state in which the master manipulator 3 cannot be operated and a unlocked state in which the master manipulator 3 can be operated.
[0029]
The master manipulator 3 is connected to a master control unit 20 that converts the operation of the master manipulator 3 into an electrical signal. The master control unit 20 is provided with a position detection device 21 such as a potentiometer 19 of the master manipulator 3 and an encoder of the support mechanism unit 11 and an arithmetic circuit 22 formed by, for example, a computer for position calculation. Then, the detection data (L detection signal, R detection signal) of the operation state of the left and right master manipulators 3a, 3b by the position detection device 21 is input to the arithmetic circuit 22, the position is calculated by this arithmetic circuit 22, and the master manipulator 3 Data such as an operation state of the handle 10 and an opening / closing state of the handle 10 is calculated.
[0030]
Furthermore, a foot switch 23 for controlling the lock mechanism of the master manipulator 3 is connected to the master controller 20. The foot switch 23 is provided with two pedals 23a and 23b. Then, one pedal 23a forms a locked state switching operation portion for switching between the locked state and the unlocked state of the master manipulator 3, and the other pedal 23b forms a moving clutch switching operation portion.
[0031]
A monitor 24 is arranged in the vicinity of the operator who operates the master manipulator 3. The master manipulator 3 is operated while viewing the display screen displayed on the monitor 24.
[0032]
The slave manipulator 2 is connected to a slave control unit 25 that outputs a control signal for transmitting the movement following the operation of the master manipulator 3 to the slave manipulator 2. The slave control unit 25 includes a motor drive circuit 27 that controls a plurality of drive motors 26 incorporated in the slave drive unit 6 of the slave manipulator 2 and an arithmetic circuit 28 formed by a computer for controlling the slave manipulator, for example. Is provided.
[0033]
Further, the arithmetic circuit 28 of the slave control unit 25 and the arithmetic circuit 22 of the master control unit 20 are connected via a communication means 29 such as an optical fiber cable. The slave control unit 25 outputs a control signal for transmitting the movement following the operation of the master manipulator 3 sent from the master control unit 20 to the slave manipulator 2.
[0034]
Further, as shown in FIG. 5, the arithmetic circuit 28 of the slave control unit 25 includes a calibration operation detection means 28a for detecting the start state of the calibration operation, and the current position of the slave manipulator 2 (positions Xs in the X direction, X direction). A slave manipulator position detecting means 28b for detecting a position Ys of Z, a position Zs in the Z direction, a rotation angle θxs around the X axis, a rotation angle θys around the Y axis, and a rotation angle θzs around the Z axis) The current position of the master manipulator 3 at the start of the calibration operation (position Xm in the X direction, position Ym in the Y direction, position Zm in the Z direction, rotation angle θxm around the X axis, rotation angle around the Y axis) θym, the rotation angle θzm around the Z axis) and the current position (Xs, Ys, Zs, θxs, θys, θzs) of the slave manipulator 2 Based on the detection result from the positional deviation amount detection means 28c when the calibration operation is started, the slave manipulator 2 is moved to the current position (Xm, Ym, Zm, θxm, θym, θzm) and corresponding calibration positions (Xc, Yc, Zc,θxc, θyc, θzc) Is provided with a speed reduction means 28d of the slave drive section 6 and a CPU 28e, which are load reduction means for reducing the mechanical load acting on the slave drive section 6 at the time of movement. Here, the decelerating means 28d adjusts the moving speed of the slave manipulator 2 during the calibration operation to such an extent that the mechanical load of the slave driving unit 6 can be reduced, for example, the moving speed of the slave manipulator 2 in the X direction, Y direction, and Z direction. 100mSecThe amount of movement is 2 mm per (1 step), and the rotation angle θx around the X axis, the rotation angle θy around the Y axis, and the rotation angle θz around the Z axis are 100.mSecIt is formed by means for decelerating to a state in which it is rotated by a moving amount of 2 ° every (1 step).
[0035]
Next, the operation of the above configuration will be described. When the manipulator control device 1 of the present embodiment is used, the master manipulator 3 is installed in an area that can be operated by the operator. Further, the slave manipulator 2 is installed so as to access the surgical field. For example, as shown in FIG. 4, a body wall H such as an abdominal wall of a patient who performs an operation such as diagnosis and treatment is made with a trocar (not shown), and the slave manipulator 2 is inserted into the trocar mantle tube inserted into the hole. The portion 4 is inserted, and the insertion portion 4 of the slave manipulator 2 is set percutaneously into the body cavity through the trocar mantle. At this time, the monitor 24 in the vicinity of the operator who operates the master manipulator 3 has an endoscopic image of the surgical field by an endoscope percutaneously inserted into the body cavity from a place different from the slave manipulator 2, or A computer graphic image (CG image) of the operative field synthesized by the computer graphic device is displayed.
[0036]
Further, after the slave manipulator 2 and the master manipulator 3 are set, if the calibration operation detection means 28a of the slave control unit 25 detects the start state of the calibration operation, the position of the slave manipulator 2, the position of the master manipulator 3, and A calibration operation is performed to correspond to. This calibration operation is performed according to the flowchart of FIG. Note that before the start of the calibration operation, the left and right slave manipulators 2a and 2b and the left and right master manipulators 3a and 3b are respectively held at arbitrary positions. FIG. 7 shows the current positions (Xm, Ym, Zm, θxm, θym, θzm) of the master manipulators 3a, 3b.
[0037]
At the start of the calibration operation, the slave manipulator position detection means 28b detects the current positions (Xs, Ys, Zs, θxs, θys, θzs) of the left and right slave manipulators 2a, 2b. In step S1, the left and right slave manipulators 2a and 2b are moved to the origin position Os (X-direction position Xs = 0, Y-direction position Ys = 0, Z-direction position Zs = 0, X-axis, as shown in FIG. The rotation angle θxs = 0 in the rotation direction, the rotation angle θys = 0 in the rotation direction around the Y axis, and the rotation angle θzs = 0 in the rotation direction around the Z axis are moved.
[0038]
Thereafter, in the next step S2, it is determined whether or not the left and right slave manipulators 2a and 2b are at the origin position Os. If it is determined in step S2 that the left and right slave manipulators 2a and 2b are not at the origin position Os, the process returns to step S1. If it is confirmed in step S2 that the left and right slave manipulators 2a and 2b are at the origin position Os, the process proceeds to the next step S3.
[0039]
In this step S3, the current positions (Xm, Ym, Zm, θxm, θym, θzm) of the master manipulators 3a, 3b shown in FIG. 7 are detected. It should be noted that the use start positions of the master manipulators 3a and 3b are usually slightly shifted in position / posture by the operator. At this time, the current position (Xm, Ym, Zm, θxm, θym, θzm) of the master manipulators 3a and 3b at the start of the calibration operation and the current position (Xs, Ys, Zs, θxs, θys, θzs) are detected.
[0040]
Thereafter, the process proceeds to the next step S4. In step S4, it is determined whether or not the master manipulator 3 is unlocked. Here, by depressing the pedal 23a of the foot switch 23, the lock of the master manipulator 3 is released. In this state, the left and right master manipulators 3a and 3b can move in the X-axis direction (left-right direction), Y-axis direction (vertical direction), and Z-axis direction (front-rear direction) in FIG. And a state in which the two handle members 15a, 15b of the left and right master manipulators 3a, 3b can be opened / closed. Respectively. At this time, information on the current positions (Xm, Ym, Zm, θxm, θym, θzm) of the master manipulators 3a, 3b is sent to the slave control unit 25.
[0041]
If it is determined in step S4 that the lock has not been released, the process returns to step S3. If it is determined in step S4 that the lock is released, the process proceeds to the next step S5.
[0042]
In this step S5, the slave manipulators 2a and 2b are decelerated from the current positions (Xs, Ys, Zs, θxs, θys, θzs), and the current positions (Xm, Ym, Zm, θxm, θym) of the left and right master manipulators 3a, 3b. , Θzm) and the corresponding calibration position (Xc, Yc, Zc,θxc, θyc, θzc) Is moved. At this time, the moving speed of the slave manipulators 2a and 2b can be reduced by the speed reduction unit 28d of the slave driving unit 6 so that the mechanical load of the slave driving unit 6 can be reduced, for example, the X direction, Y direction, and Z direction of the slave manipulators 2a and 2b. Each moving speed of 100mSecThe amount of movement is 2 mm per (1 step), and the rotation angle θx around the X axis, the rotation angle θy around the Y axis, and the rotation angle θz around the Z axis are 100.mSecEach (1 step) is decelerated to a state in which it is rotated by a moving amount of 2 °.
[0043]
Thereafter, in the next step S6, the calibration positions (Xc, Yc, Zc,θxc, θyc, θzc) Is equal to the current position (Xm, Ym, Zm, θxm, θym, θzm) of the left and right master manipulators 3a, 3b. Here, if it is determined that the positions of the two manipulators 2a, 2b, 3a, 3b are not equal, the process returns to step S5. If it is determined in step S6 that the positions of both manipulators 2a, 2b, 3a, 3b are equal, the calibration operation ends.
[0044]
Further, after this calibration operation is completed, an operation such as diagnosis / treatment by the manipulator control device 1 of the present embodiment is started. During this operation, the operator operates the left and right master manipulators 3a and 3b of the master manipulator 3 while viewing the endoscopic image of the operative field displayed on the monitor 24 or the screen of the CG image. At this time, the handle 10 of the left master manipulator 3a is operated with the operator's left hand and the handle 10 of the right master manipulator 3b held with the operator's right hand, and the left master manipulator 3a operates the left slave manipulator 2a and the right master. The right slave manipulator 2b is remotely operated independently by the manipulator 3b.
[0045]
For example, the handle 10 of the left master manipulator 3a is moved in the X-axis direction (left-right direction), Y-axis direction (up-down direction), and Z-axis direction (front-back direction) in FIG. When the Y-axis and the Z-axis are rotated, the position of the master manipulator 3a is detected by the position detection device 21 of the master control unit 20. Detection data from the position detection device 21 is input to the arithmetic circuit 22, and a position is calculated by the arithmetic circuit 22 to calculate data such as an operation state of the handle 10 of the master manipulator 3 and an opening / closing state of the handle 10.
[0046]
Further, the calculated data whose position is calculated by the arithmetic circuit 22 of the master control unit 20 is transmitted to the slave control unit 25 via the communication means 29 such as an optical fiber cable.
[0047]
In the slave control unit 25, control signals for controlling the plurality of drive motors 26 of the motor drive circuit 27 incorporated in the slave drive unit 6 are calculated by the arithmetic circuit 28 based on the received control signal. Then, the control signal output from the slave control unit 25 is transmitted to the left slave manipulator 2a, and the left slave manipulator 2a is operated remotely. At this time, the left slave manipulator 2a moves following the movement of the handle 10 of the left master manipulator 3a. The operation of the right slave manipulator 2b is controlled by the same action when the right master manipulator 3b is operated, and the right slave manipulator 2b moves following the operation of the right master manipulator 3b.
[0048]
Therefore, the above configuration has the following effects. That is, in the present embodiment, when the operation of the master manipulator 3 is started, the positional deviation amount between the current position of the master manipulator 3 and the current position of the slave manipulator 2 is detected by the positional deviation amount detection means 28c in the arithmetic circuit 28 of the slave control unit 25. And a calibration operation for aligning the position of the master manipulator 3 and the position of the slave manipulator 2 is performed based on the detection result from the positional deviation detection means 28c. During the calibration work, the moving speed of the slave manipulator 2 is reduced by the deceleration means 28d of the slave drive unit 6 which is a load reducing means, so that the coordinate between the position of the master manipulator 3 and the position of the slave manipulator 2 is Even if there is a deviation, the slave manipulator 2 does not move suddenly to a position corresponding to the position of the master manipulator 3. Therefore, it is possible to reduce the mechanical load acting on the slave drive unit 6 that is the drive mechanism of the slave manipulator 2 during the calibration of the position / posture of the master manipulator 3 and the slave manipulator 2. Durability can be improved.
[0049]
9 to 12 show a second embodiment of the present invention. In the present embodiment, the configuration of the slave control unit 25 of the manipulator control device 1 according to the first embodiment (see FIGS. 1 to 8A and 8B) is changed as follows.
[0050]
That is, in this embodiment, the arithmetic circuit 28 of the slave control unit 25 is configured as shown in FIG. Here, the arithmetic circuit 28 of the present embodiment is provided with a calibration operation detecting means 28a, a slave manipulator position detecting means 28b, a positional deviation amount detecting means 28c, and a CPU 28e, as in the first embodiment. It has been. Further, the CPU 28e is connected with a coordinate complementing means 31 for reconstructing the coordinate system for detecting the position of the master manipulator 3 in the calibration operation so as to complement the positional deviation amount according to the current position of the slave manipulator 2.
[0051]
In the manipulator control device 1 of the present embodiment, the calibration operation for associating the position of the slave manipulator 2 with the position of the master manipulator 3 at the start of use is performed according to the flowchart of FIG.
[0052]
First, at the start of the calibration operation, in step S11, the coordinate system (XYZ) of the current master manipulator 3 shown in FIG. 11A and the coordinates of the current slave manipulator 2 shown in FIG. An operation for associating the system (XYZ) is performed. At this time, the current position (Xs, Ys, Zs, θxs, θys, θzs) of the left and right slave manipulators 2a, 2b is detected by the slave manipulator position detection means 28b. In the next step S12, the left and right slave manipulators 2a and 2b are moved to the origin position Os (X-direction position Xs = 0, Y-direction position Ys = 0, Z-direction position Zs as shown in FIG. 11B). = 0, rotation angle θxs around the X axis = 0, rotation angle θys around the Y axis = 0, and rotation angle θzs = 0 around the Z axis.
[0053]
Thereafter, in the next step S13, it is determined whether or not the left and right slave manipulators 2a and 2b are at the origin position Os. If it is determined in step S13 that the left and right slave manipulators 2a and 2b are not at the origin position Os, the process returns to step S12. If it is confirmed in step S13 that the left and right slave manipulators 2a and 2b are at the origin position Os, the process proceeds to the next step S14.
[0054]
In step S14, the current positions (Xm, Ym, Zm, θxm, θym, θzm) of the master manipulators 3a, 3b shown in FIG. 11A are detected. At this time, the current position (Xm, Ym, Zm, θxm, θym, θzm) of the master manipulators 3a and 3b at the start of the calibration operation and the current position (Xs, Ys, Zs, θxs, θys, θzs) are detected.
[0055]
Thereafter, the process proceeds to next Step S15. In step S15, it is determined whether or not the master manipulator 3 is unlocked. Here, by depressing the pedal 23a of the foot switch 23, the lock of the master manipulator 3 is released. In this state, the left and right master manipulators 3a and 3b can move in the X-axis direction (left-right direction), Y-axis direction (vertical direction), and Z-axis direction (front-rear direction), respectively, and the X-axis rotation direction and Y-axis direction It is switched to a state in which it can be rotated in the direction around the axis and the direction around the Z axis, respectively, and the two handle members 15a, 15b of the left and right master manipulators 3a, 3b are respectively switched to a state in which opening and closing operations are possible.
[0056]
If it is determined in step S15 that the lock has not been released, the process returns to step S14. If it is determined in step S15 that the lock is released, the process proceeds to next step S16.
[0057]
In this step S16, the coordinate system (XYZ) for detecting the position of the master manipulator 3 indicated by a dotted line in FIG. 12 is changed to the coordinate system (XYZ) of the slave manipulator 2 shown in FIG. A coordinate complementing operation is performed to reconstruct the new coordinate system (X1-Y1-Z1) indicated by a solid line in FIG.
[0058]
Thereafter, in the next step S17, it is determined whether or not the new coordinate system (X1-Y1-Z1) of the master manipulator 3 and the coordinate system (XYZ) of the slave manipulator 2 are equal. If it is determined that the new coordinate system (X1-Y1-Z1) of the master manipulator 3 is not equal to the coordinate system (XYZ) of the slave manipulator 2, the process returns to step S16. If it is determined in step S17 that the new coordinate system (X1-Y1-Z1) of the master manipulator 3 is equal to the coordinate system (XYZ) of the slave manipulator 2, the master manipulator 3 Based on the new coordinate system (X1-Y1-Z1), the position and orientation information of the master manipulator 3 is created, the information data is transmitted to the slave manipulator 2 side, and the calibration operation ends.
[0059]
Further, after this calibration operation is completed, an operation such as diagnosis / treatment is started by the same procedure as that of the manipulator control device 1 of the first embodiment.
[0060]
Therefore, in the present embodiment, the coordinate system (XYZ) for detecting the position of the master manipulator 3 is set to the current position of the slave manipulator 2 by the coordinate complementing means 31 in the arithmetic circuit 28 of the slave control unit 25 in the calibration operation. In addition, since the new coordinate system (X1-Y1-Z1) reconstructed so as to complement the positional displacement amount is created, the slave manipulator 2 is not moved during the calibration operation, and the start position of the master manipulator 3 is determined. Surgery such as diagnosis and treatment can be started in a deviated state. For this reason, there is no need to move the slave manipulator 2 during calibration of the position and orientation of the master manipulator 3 and the slave manipulator 2, so that the mechanical force acting on the slave drive unit 6 side that is the drive mechanism of the slave manipulator 2 is not required. Load can be reduced and the durability of the entire system can be improved. Furthermore, it is possible to perform a stable calibration operation that does not give the operator a sense of incongruity due to the movement of the slave manipulator 2 and the master manipulator 3 during the calibration operation.
[0061]
The present invention is not limited to the above embodiment. For example, within the operation range in which the slave manipulator 2 can be moved during calibration work, a control execution range of the position alignment operation is set in advance to a predetermined setting range that is a predetermined amount away from the center position of the operation range, and the slave manipulator 2 When the current position of the slave manipulator 2 is outside the control execution range, a notification unit may be provided that notifies the state that the current position of the slave manipulator 2 is outside the control execution range without performing the position alignment operation. In this case, when the current position of the slave manipulator 2 is out of the control execution range during the calibration operation, the state can be notified by the notification unit, so that an unnecessary position alignment operation can be avoided. is there.
[0062]
Furthermore, it goes without saying that 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) A master-slave device including a deviation amount detection unit that detects a deviation of the master start position and a slow calibration unit that performs calibration at an arbitrary speed when the master-slave operation is started.
[0063]
(Additional Item 2) A master-slave device including a deviation amount detection unit that detects a deviation of the master start position and a coordinate complementing unit that reconstructs the coordinate system of the master from the deviation value.
[0064]
(Additional Item 3) One or two master-slave devices provided with notifying means for notifying the outside of the range without performing calibration when the position is a predetermined amount away from the center of the movable range.
[0065]
(Prior Art of Additional Items 1 to 3) The opening / closing angle of the master manipulator is handled as the opening / closing angle of the slave manipulator after data conversion at an arbitrary fixed magnification.
[0066]
(Additional items 1 and 3 are problems to be solved) When the master and slave operations are started, the master misalignment is immediately reflected in the slave, so a mechanical load is applied.
[0067]
(Problems to be solved by the additional items 2 and 3) The movement due to the misalignment causes the operator to feel uncomfortable.
[0068]
(Purpose of Supplementary Items 1 and 3) Providing a control method that reduces the mechanical load by calibration of the position and orientation of the master and slave.
[0069]
(Purpose of Supplementary Items 2 and 3) Providing a control method that does not give the operator an uncomfortable feeling
[0070]
【The invention's effect】
According to the first aspect of the present invention, the positional deviation amount detecting means for detecting the positional deviation amount between the current position of the master manipulator and the current position of the slave manipulator when the operation of the master manipulator is started is provided, and this positional deviation amount detection is performed. Since the load reduction means for reducing the mechanical load acting on the drive mechanism of the slave manipulator during the calibration work for aligning the position of the master manipulator and the position of the slave manipulator based on the detection result from the means, the master manipulator and the slave The mechanical load acting on the drive mechanism side of the slave manipulator during the calibration of the position / orientation with the manipulator can be reduced, and the durability of the entire system can be improved.
[0071]
According to the second aspect of the present invention, the moving speed of the slave manipulator can be reduced by the reduction means during the calibration operation to such an extent that the mechanical load of the slave manipulator driving mechanism can be reduced. As a result, it is possible to reduce the mechanical load acting on the drive mechanism side of the slave manipulator during the calibration work of the position / posture of the master manipulator and the slave manipulator.
[0072]
According to the invention of claim 3, since the coordinate system for detecting the position of the master manipulator is reconstructed in a state of complementing the positional deviation amount by matching the current position of the slave manipulator by the coordinate complementing means during the calibration operation. The mechanical load acting on the drive mechanism side of the slave manipulator during calibration of the position / posture of the master manipulator and the slave manipulator can be reduced.
[0073]
According to the fourth aspect of the present invention, the control execution range of the position alignment operation is set in advance within a predetermined setting range that is a predetermined amount away from the center position of the operation range within the operation range in which the slave manipulator can be moved during the calibration work. When the current position of the slave manipulator is outside the control execution range, the notification means notifies the state that the current position of the slave manipulator is outside the control execution range without performing the position alignment operation. When the current position of the slave manipulator is out of the control execution range during work, the state can be reliably confirmed.
[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 slave control unit in the manipulator control device according to the first embodiment.
FIG. 6 is a flowchart for explaining a calibration operation in the manipulator control device according to the first embodiment;
FIG. 7 is an explanatory diagram for explaining a current position of a master manipulator in the manipulator control device according to the first embodiment.
8A and 8B are diagrams for explaining the operation of the slave manipulator in the manipulator control device according to the first embodiment. FIG. 8A is an explanatory diagram for explaining the calibration operation start position of the slave manipulator, and FIG. Explanatory drawing for demonstrating the calibration position of a manipulator.
FIG. 9 is a schematic configuration diagram of an arithmetic circuit of a slave control unit in a manipulator control device according to a second embodiment of the present invention.
FIG. 10 is a flowchart for explaining a calibration operation in the manipulator control device according to the second embodiment;
FIGS. 11A and 11B illustrate the operation of the master manipulator in the manipulator control device according to the second embodiment. FIG. 11A is an explanatory diagram for explaining the operation start position of the master manipulator, and FIG. Explanatory drawing for demonstrating a calibration state.
FIG. 12 is an explanatory diagram for explaining an operation start position of a slave manipulator of the manipulator control device according to the second embodiment.
FIG. 13 is a schematic configuration diagram of a conventional surgical manipulator system.
[Explanation of symbols]
2 Slave manipulator
3 Master manipulator
6 Slave drive unit (slave manipulator drive mechanism)
20 Master controller
21 Position detection device
25 Slave controller
28c Position shift amount detection means
28d Deceleration means (load reduction means) of slave drive unit
31 Coordinate complementing means (load reducing means)

Claims

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;
A master control unit connected to the master manipulator for converting the operation of the master manipulator into an 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;
A positional deviation amount detecting means for detecting a positional deviation amount between a current position of the master manipulator and a current position of the slave manipulator at the start of operation of the master manipulator;
Load reduction that reduces the mechanical load acting on the drive mechanism of the slave manipulator during the calibration operation for aligning the position of the master manipulator and the position of the slave manipulator based on the detection result from the displacement amount detection means And a manipulator control device.

2. The load reducing means is formed by a speed reducing means that decelerates the moving speed of the slave manipulator to the extent that the mechanical load of the slave manipulator driving mechanism can be reduced during the calibration operation. The manipulator control device described in 1.

The load reducing means is formed by coordinate complementing means for reconstructing the coordinate system for detecting the position of the master manipulator in a state of complementing the positional deviation amount according to the current position of the slave manipulator during the calibration operation. The manipulator control device according to claim 1.

The load reducing means presets a control execution range of a position alignment operation within a predetermined setting range that is a predetermined amount away from a center position of the operation range within an operation range in which the slave manipulator can move during the calibration operation. And when the current position of the slave manipulator is outside the control execution range, a notification means for notifying the state where the current position of the slave manipulator is outside the control execution range without performing the position alignment operation is provided. The manipulator control device according to claim 1.