JP5941762B2 - マニピュレータシステム - Google Patents

Description

本発明は、マニピュレータシステムに関するものである。

従来、内視鏡を移動可能に支持する支持手段によって内視鏡を移動させた場合に、該支持手段の移動量に基づいて、内視鏡画像を表示する表示部を覗き込む視線の延長線上に内視鏡先端部の光軸が配置されるように、表示部を移動させる観察装置が知られている（例えば、特許文献１参照。）。

特許文献１の観察装置によれば、術者が内視鏡を直接操作して患者の体腔内の観察位置を変更した場合でも、特別な作業をすることなく手術作業に最適な姿勢を得ることができるという効果がある。

特開２００３−２３００７３号公報

しかしながら、内視鏡の先端面から突出させた処置具は、術者が両手で操作ハンドルを操作することにより操作され、内視鏡の先端部に備えられた湾曲部は、通常、スイッチによって、術者が手足を大きく移動させることなく操作される。このため、湾曲部の湾曲の度合いを変化させて内視鏡の視野方向を変更すると、処置具を操作していなくても、表示部に表示される処置具の向きが変化してしまうという不都合がある。

すなわち、湾曲部の操作前後において、処置具に同じ動作をさせる場合の操作ハンドルの移動方向は同一であるのに対し、表示部に表示される処置具の移動方向は変化するので、術者は、頭の中で、表示部内の処置具の前後左右方向がどちらであるのかを常に確認しながら操作ハンドルを操作しなければならず、直感的な操作を行うことができないという問題がある。

本発明は、上述した事情に鑑みてなされたものであって、被写体の観察方向を切り替えても、表示部に表示される処置具を直感的に操作することができるマニピュレータシステムを提供することを目的としている。

上記目的を達成するために、本発明は以下の手段を提供する。
本発明の一態様は、被写体を処置する処置部と、前記被写体および処置部を撮影する撮影部と、該撮影部により取得された画像を表示する表示部と、該表示部を支持して移動させる表示部駆動部と、前記処置部を操作する操作部と、該操作部を支持し１て移動させる操作部駆動部と、前記表示部と前記操作部との相対位置関係を、前記処置部と前記撮影部との相対位置関係に近づけるように前記表示部駆動部および前記操作部駆動部を制御する制御部とを備えるマニピュレータシステムを提供する。

本態様によれば、被写体および処置部に対して撮影部を移動させることにより、被写体および処置部を撮影する方向を変化させると、処置部と撮影部との相対位置関係が変化するので、制御部が、表示部駆動部により表示部を移動させるとともに、操作部駆動部により操作部を移動させるように制御する。処置部に対する撮影部の位置変更により、表示部には、被写体および処置部を異なる角度から撮影した画像が表示される。

この場合に、制御部が、表示部と操作部との相対位置関係を処置部と撮影部との相対位置関係に近づけるように表示部駆動部および操作部駆動部を制御するので、撮影部の位置変更の前後において、表示部に表示された画像中の処置部の移動方向に対する操作部の移動方向の相対関係が大きく変化してしまうことを抑えることができ、操作者が表示部に表示される処置部を直感的に操作し続けることができる。

上記態様においては、前記撮影部による被写体の撮影角度を検出する検出部を備え、前記制御部が、検出部により検出された撮影角度に基づいて、前記表示部駆動部および前記操作部駆動部を制御してもよい。
このようにすることで、検出部により検出された撮影部による被写体の撮影角度に基づいて、制御部が、表示部と操作部との相対位置関係を処置部と撮影部との相対位置関係に近づけるように表示部駆動部および操作部駆動部を制御することができる。

また、上記態様においては、前記表示部駆動部が、前記表示部の法線の水平方向に対する角度である表示部角度を変化させてもよい。
このようにすることで、撮影部が、被写体の撮影角度を変化させたときに、これに合わせて表示部角度を変化させることができる。これにより、表示部を見ている操作者は、自身の視界の変更によって被写体の観察方向を変更しているかのように感じることができ、被写体に対して、より直感的に処置を行うことができる。

また、上記態様においては、前記操作部駆動部が、前記操作部と前記表示部とを結ぶ直線の水平方向に対する角度である操作部角度を変化させてもよい。
このようにすることで、撮影部が、被写体の撮影角度を変化させたときに、これに合わせて操作部角度を変化させることができる。これにより、表示部に表示されている画像上で移動した処置部に合わせて、処置部を作動させるための操作部が移動するので、表示部を見ている操作者が被写体の観察方向の変化の前後において、処置部を所望の方向に移動させるための操作部の移動方向をより直感的に判断することができる。

また、上記態様においては、前記制御部が、前記撮影角度と前記表示部角度とを一致させるように前記表示部駆動部を制御してもよい。
また、上記態様においては、前記制御部が、前記撮影角度と前記操作部角度とを一致させるように前記操作部駆動部を制御してもよい。

また、上記態様においては、前記操作部駆動部が、前記操作部と前記表示部とを結ぶ直線の水平方向に対する角度である操作部角度を変化させ、前記制御部が、前記撮影角度、前記操作部角度および前記表示部角度を一致させるように前記表示部駆動部および前記操作部駆動部を制御してもよい。
このようにすることで、撮影部が、被写体の撮影角度を変化させたときに、これに一致させるように表示部角度および操作部角度を変化させることができる。

また、上記態様においては、前記撮影角度と前記表示部角度との関係を示す第1の関数を記憶する関数記憶部を備え、前記制御部が、前記関数記憶部に記憶されている前記第１の関数に基づいて、前記表示部駆動部を制御してもよい。
このようにすることで、関数記憶部に記憶されている第１の関数を用いて、簡易に表示部角度を決定することができ、処理を高速に行うことができる。

また、上記態様においては、前記第１の関数が、前記撮影角度の角度範囲の両端に向かって傾きの小さくなる関数であってもよい。
このようにすることで、撮影角度の変化に応じて第１の関数に従って表示部角度を変化させる場合に、撮影角度が大きく変化してその角度範囲の両端に近づくほど、表示部角度も大きく変化するが、角度範囲の両端に近づくほどその傾きを小さくすることにより、操作者に無理な姿勢を強いずに済む。

また、上記態様においては、前記第１の関数が、前記撮影角度の全角度範囲にわたって、前記撮影角度の変化量に対する前記表示部角度の変化量が１以下となる関数であってもよい。
このようにすることで、撮影角度の変化に応じて第１の関数に従って表示部角度を変化させる場合に、撮影角度が大きく変化してその角度範囲の両端に近づくほど、表示部角度も大きく変化するが、撮影角度の全角度範囲にわたってその傾きを１以下にすることにより、角度範囲の両端において操作者に無理な姿勢を強いずに済む。

また、上記態様においては、前記撮影角度と前記操作部角度との関係を示す第２の関数を記憶する関数記憶部を備え、前記制御部が、前記関数記憶部に記憶されている前記第２の関数に基づいて、前記操作部駆動部を制御してもよい。
このようにすることで、関数記憶部に記憶されている第２の関数を用いて、簡易に操作部角度を決定することができ、処理を高速に行うことができる。

また、上記態様においては、前記第２の関数が、前記撮影角度の角度範囲の両端に向かって傾きの小さくなる関数であってもよい。
このようにすることで、撮影角度の変化に応じて第２の関数に従って操作部角度を変化させる場合に、撮影角度が大きく変化してその角度範囲の両端に近づくほど、操作部角度も大きく変化するが、角度範囲の両端に近づくほどその傾きを小さくすることにより、操作者に無理な姿勢を強いずに済む。

また、上記態様においては、前記第２の関数が、前記撮影角度の全角度範囲にわたって、前記撮影角度の変化量に対する前記操作部角度の変化量が１以下となる関数であってもよい。
このようにすることで、撮影角度の変化に応じて第２の関数に従って操作部角度を変化させる場合に、撮影角度が大きく変化してその角度範囲の両端に近づくほど、操作部角度も大きく変化するが、撮影角度の全角度範囲にわたってその傾きを１以下にすることにより、角度範囲の両端において操作者に無理な姿勢を強いずに済む。

本発明によれば、被写体の観察方向を切り替えても、表示部に表示される操作部を直感的に操作することができるという効果を奏する。

本発明の一実施形態に係るマニピュレータシステムの（ａ）マスタ装置、（ｂ）スレーブ装置を示す図である。 図１のマニピュレータシステムに備えられたコントローラの一例を示すブロック図である。 図１のコントローラに備えられる角度αと角度β，γとの関係を示すグラフである。 図１のマニピュレータシステムの観察位置変更後の状態の（ａ）マスタ装置、（ｂ）スレーブ装置を示す図である。 図１のマニピュレータシステムのモニタに表示される画像の一例であって、患部および処置具をより浅い角度で観察している画像を示す図である。 図４の状態より深き角度で観察している場合の患部および処置具の画像を示す図である。 図１のマニピュレータシステムのコントローラの変形例を示すブロック図である。 図１のマニピュレータシステムのコントローラに備えられる第１，第２の関数の変形例を示す図である。 図７の第１の関数および図８の第２の関数を備えるコントローラを示すブロック図である。 図７の第１の関数および図８の第２の関数の変形例を示すグラフである。 図７の第１の関数および図８の第２の関数の他の変形例を示すグラフである。 図２のコントローラの他の変形例を示すブロック図である。

本発明の一実施形態に係るマニピュレータシステム１について、図面を参照して以下に説明する。
本実施形態に係るマニピュレータシステム１は、医療用のマニピュレータシステム１であって、図１（ａ）に示されるマスタ装置２と、図１（ｂ）に示されるスレーブ装置３と、これらを制御するコントローラ（制御部）４とを備えている。

スレーブ装置３は、患者の体内に挿入される硬質材料からなる円筒状の外套管５と、該外套管５の先端開口から突出させられて患者の体内の患部（被写体）Ａを処置する処置具（処置部）６と、外套管５の先端開口から突出させられて患部Ａおよび処置具６を撮影するための内視鏡７とを備えている。
マスタ装置２は、内視鏡７により取得された画像を表示するモニタ（表示部）８と、モニタ８を移動させるモニタ駆動部９と、処置具６を操作するハンドル（操作部）１０と、ハンドル１０を移動させるハンドル駆動部１１と、フットスイッチ１２とを備えている。

処置具６は、患部Ａを処置する鉗子６ａと、該鉗子６ａを先端に取り付けた図示しない１以上の関節を有する処置具アーム６ｂとを備えている。処置具アーム６ｂは関節を伸縮させることにより、先端の鉗子６ａを外套管５の長手方向に進退させることができるようになっている。処置具６は、医師Ｄの両手でそれぞれ操作されるように左右一対（図中１つのみ表示している。）設けられている。
処置具アーム６ｂおよび鉗子６ａには図示しないモータ等が備えられており、コントローラ４によって制御されるようになっている。

内視鏡７は、先端に配置された図示しない照明部およびカメラ（撮影部）１３を備え、カメラ１３の基端側に長手方向に間隔をあけて配置された２つの湾曲部７ａ，７ｂを備えている。これら２つの湾曲部７ａ，７ｂは、図１（ｂ）に示されるように、２つの処置具６の配置される平面（本実施形態においては水平面）６Ａに直交する平面内において湾曲するように構成され、カメラ１３の光軸１３ａを上記平面６Ａに対して交差させ、かつその交差角度αを調節することができるようになっている。

内視鏡７には、該内視鏡７の湾曲部７ａ，７ｂを湾曲させるための図示しないモータおよび外套管５に対してその長手方向に進退させる図示しないモータが備えられ、各モータには、各湾曲部７ａ，７ｂの湾曲角度および外套管５の長手方向に沿う移動距離を検出するエンコーダ（検出部）が設けられている。各モータはコントローラ４によって制御されるようになっている。モニタ８は、内視鏡７のカメラ１３により取得された画像を表示するディスプレイ（図示略）と接眼部８ａとを備えている。

モニタ駆動部９は、モニタ８を支持するモニタ用アーム１４と、該モニタ用アーム１４を地面に固定された支持フレーム１５に対して水平方向および鉛直方向に移動させる直動アクチュエータ１６とを備えている。モニタ用アーム１４は、モニタ８を水平軸線回りに揺動可能に支持する支持するベース部１４ａと、該ベース部１４ａに対してモニタ８を揺動させる揺動アクチュエータ１４ｂとを備えている。

ハンドル１０は、医師Dの両手によって操作されるように左右一対設けられ、医師Dの両手によって独立に把持されるグリップ１０ａと、該グリップ１０ａの位置を水平方向に進退させる１以上の関節を備えた操作アーム１０ｂとを備えている。
グリップ１０ａには、把持の度合いを検出する図示しない把持検出部が備えられ、操作アーム１０ｂにはグリップ１０ａの水平方向位置を検出する図示しない位置検出部が備えられている。

ハンドル駆動部１１は、支持フレーム１５に対して操作アーム１０ｂを水平方向および鉛直方向に移動させる直動アクチュエータ１７を備えている。
フットスイッチ１２は、医師Dが足により操作するもので、その踏み込み量を調節することができるようになっている。

コントローラ４は、図２に示されるように、内視鏡７のカメラ１３により取得された画像信号に基づいて画像を生成し、モニタ８に出力する画像生成部１８を備えている。
また、コントローラ４は、フットスイッチ１２の踏み込み量に基づいて内視鏡７の各モータの作動量を算出し、各モータに指令する内視鏡制御部１９を備えている。内視鏡制御部１９は、例えば、医師がフットスイッチ１２を踏み込むと、内視鏡７を長手方向に前進させるとともに各湾曲部７ａ，７ｂの湾曲角度を増大させるようになっている。これにより、カメラ１３の光軸１３ａは、患部に交差させられたままの状態で、水平面６Ａに対する角度αを増大させられるようになっている。

また、コントローラ４は、医師Dによるハンドル１０の操作量に基づいて、処置具アーム６ｂおよび鉗子６ａの各モータの作動量を算出し、各モータに指令する処置具制御部２０を備えている。
処置具制御部２０は、例えば、医師Dがハンドル１０のグリップ１０ａを把持していくと、鉗子６ａが閉じられ、グリップ１０ａを解放していくと、鉗子６ａが開かれるように鉗子６ａのモータを制御するようになっている。

また、処置具制御部２０は、医師Dがハンドル１０を水平方向に前進させると、位置検出部により検出された水平方向の移動量に基づいて、鉗子６ａの位置を前進させる移動量を算出し、処置具アーム６ｂの関節を伸ばして、鉗子６ａの位置を前進させるようになっている。

また、コントローラ４は、内視鏡７のモータに備えられたエンコーダにより検出された２つの湾曲部７ａ，７ｂの湾曲角度が入力されて、モニタ駆動部９を制御するモニタ駆動制御部２１と、ハンドル駆動部１１を制御するハンドル駆動制御部２２とを備えている。

モニタ駆動制御部２１は、２つの湾曲部７ａ，７ｂの湾曲角度に基づいて、カメラ１３の光軸１３ａが水平面６Ａに対してなす角度αを算出し、モニタ８の接眼部８ａの光軸が水平面に対してなす角度βをカメラ１３の光軸１３ａの角度αに一致させるようにモニタ駆動部９を制御するようになっている。
すなわち、本実施形態においては、モニタ駆動制御部２１は、角度αと角度βとが、図３に示されるような正比例の関係で変化する関数（第１の関数）に基づいて変化するように、モニタ駆動部９を制御するようになっている。

また、モニタ駆動制御部２１は、揺動アクチュエータ１４ｂを作動させてモニタ用アーム１４のベース部１４ａに対するモニタ８の角度βを、カメラ１３の光軸１３ａの角度αに一致するように制御するだけでなく、これとともに、直動アクチュエータ１６を作動させて、支持フレーム１５に対するモニタ用アーム１４の水平方向および鉛直方向位置を調節するようになっている。

すなわち、本実施形態においては、図１（ａ）に示されるように、モニタ駆動制御部２１は、医師Ｄの首の位置に配置される頭部の回転中心Ｐの位置座標を記憶している。そして、モニタ駆動制御部２１は、この回転中心Ｐを中心とした鉛直面内の円Ｓに沿ってモニタ８の接眼部８ａが移動するように、揺動アクチュエータ１４ｂと直動アクチュエータ１６とを同期して作動させるようになっている。

また、ハンドル駆動制御部２２は、モニタ８の接眼部８ａとグリップ１０ａとの相対位置関係が、カメラ１３と処置具６との相対位置関係に一致するようにハンドル駆動部１１を制御するようになっている。ここで、相対位置関係が一致するとは、カメラ１３の光軸１３ａと水平面６Ａとの角度αが、接眼部８ａとグリップ１０ａとを結ぶ直線と水平面との角度γと略一致することを意味し、角度αと角度γとが、図３に示されるような正比例の関係で変化する関数（第２の関数）に基づいて変化するように、ハンドル駆動部１１を制御するようになっている。

本実施形態においては、ハンドル駆動制御部２２は、上述したように角度αと角度γとが一致し、かつ、カメラ１３と処置具６との距離と接眼部８ａとグリップ１０ａとの距離との比が、一定となる（例えば、１：１０となる）ようにハンドル駆動部１１を制御するようになっている。
これにより、図１（ａ）に示されるように、カメラ１３の光軸１３ａの水平面６Ａに対する角度αと一致する角度βで傾斜したモニタ８の接眼部８ａの光軸の延長上にグリップ１０ａが配置されるようになっている。

このように構成された本実施形態に係るマニピュレータシステム１の作用について、以下に説明する。
本実施形態に係るマニピュレータシステム１を用いて医師Ｄが患者の患部Ａを処置する場合には、スレーブ装置３の内視鏡７および処置具６を患者の体内の患部Ａに近接して配置し、内視鏡７のカメラ１３により患部Ａおよび処置具６を撮影する。

内視鏡７により取得された画像情報は、コントローラ４の画像生成部１８に送られ、画像生成部１８においてモニタ８に表示される画像が生成される。生成された画像はマスタ装置２のモニタ８に送られて、モニタ８に備えられたディスプレイに表示される。

また、医師Ｄは、マスタ装置２のグリップ１０ａを握り、フットスイッチ１２に足をおくとともに、モニタ８の接眼部８ａに眼をあてて、ディスプレイに表示されている画像を観察する。モニタ駆動制御部２１は、カメラ１３の光軸１３ａの角度αとモニタ８の角度βとを一致させ、かつ、接眼部８ａが予め記憶されている医師Ｄの首の回転中心Ｐを中心とした医師Ｄの眼を通過する円Ｓ上に配置されるようにモニタ駆動部９を制御する。これにより、医師Ｄが接眼部８ａに眼をあてると、自然な姿勢で、ディスプレイに表示された画像を観察することができる。

また、ハンドル駆動制御部２２は、接眼部８ａとグリップ１０ａとを結ぶ直線の水平面に対する角度γが、カメラ１３の光軸１３ａの水平面６Ａに対する角度αと一致するようにハンドル駆動部１１を制御するので、接眼部８ａを介して画像を見ている医師Ｄは、両手で把持しているグリップ１０ａがあたかも画像上の処置具６と同じものであるかのように認識することができる。

すなわち、医師Ｄが両手で把持しているグリップ１０ａの把持の度合いを変化させることにより、これに同期させて画像内の処置具６を開閉することができ、画像上の処置具６の前後方向に一致する方向にグリップ１０ａを押し引きすると、グリップ１０ａが前後方向に動き、これに同期させて画像内の処置具６を前後に移動させることができる。

また、医師Ｄが患部Ａおよび処置具６の観察角度を変更したい場合には、フットスイッチ１２を足で操作する。これにより、フットスイッチ１２の踏み込み量がコントローラ４内の内視鏡制御部１９に送信され、内視鏡制御部１２が、踏み込み量に応じて内視鏡７の２つの湾曲部７ａ，７ｂの湾曲角度を変化させる。例えば、図１（ｂ）に示される状態から、フットスイッチ１２の踏み込み量を変化させると、図４（ｂ）に示されるように、カメラ１３の光軸１３ａの水平面６Ａに対する角度αが大きくなるように２つの湾曲部７ａ，７ｂの湾曲角度が変化する。

その結果、モニタ８内のディスプレイに表示される画像は、図５の状態から図６の状態に変化する。
そして、内視鏡７の湾曲部７ａ，７ｂの湾曲角度が変化すると、湾曲部７ａ，７ｂを駆動するモータのエンコーダにより検出された角度がモニタ駆動制御部２１およびハンドル駆動制御部２２に送られる。

モニタ駆動制御部２１は、エンコーダにより検出された各湾曲部７ａ，７ｂの角度から内視鏡７のカメラ１３の光軸１３ａの水平面６Ａに対する角度αを算出し、該角度αに基づいて、モニタ８の揺動角度βを角度αに一致するように揺動アクチュエータ１４ｂを作動させる。画像における患部Ａおよび処置具６の観察方向の変化に合わせて、図４（ａ）に示されるように、モニタ８の揺動角度βを変化させることで、あたかも自身の視線の方向を変えることで患部Ａ等の観察方向を変えたかのように医師Ｄに感じさせることができ、処置具６のより直感的な操作を可能にすることができる。

この場合において、モニタ駆動制御部２１は、モニタ８の接眼部８ａが、医師Ｄの首を湾曲させる中心位置Ｐを中心とした円Ｓに沿って移動するように、揺動アクチュエータ１４ｂおよび直動アクチュエータ１４ａを同期して作動させ、角度βが角度αに一致した時点で、両アクチュエータ１４ａ，１４ｂの作動を停止する。これにより、医師Ｄは、身体の他の部分を動かすことなく首の傾きを変えるだけで、常に、無理のない姿勢で接眼部８ａからディスプレイに表示された画像を観察することができる。

さらに、本実施形態によれば、ハンドル駆動制御部２２が、エンコーダにより検出された各湾曲部７ａ，７ｂの角度から内視鏡７のカメラ１３の光軸１３ａの水平面６Ａに対する角度αを算出し、該角度αに基づいて、ハンドル駆動部１１を制御する。すなわち、ハンドル駆動制御部２２は、接眼部８ａとグリップ１０ａとを結ぶ直線の水平面に対する角度γが、図４（ａ）に示されるように、カメラ１３の光軸１３ａの水平面６Ａに対する角度αと一致するようにハンドル駆動部１１を制御するので、接眼部８ａを介して画像を見ている医師Ｄは、画像上の処置具６が常にグリップ１０ａの位置にあるかのように認識することができる。

さらに具体的には、接眼部８ａを介してディスプレイに表示された画像を見ている医師Ｄにとって、処置具６の移動方向は、図５の状態では、ディスプレイ画面に交差する方向であったのに対し、図６の状態では、よりディスプレイ画面に沿う方向に変化している。そして、医師Ｄはグリップ１０ａを画像上の処置具６の移動方向に一致する方向に移動させることにより、処置具６を進退させることができる。したがって、グリップ１０ａの直感的な操作により処置具６を駆動させることができ、患部Ａの処置をより容易にすることができるという利点がある。

なお、本実施形態においては、外套管５として、硬質な直管状の部材を例示したが、これに限定されるものではなく、処置具６および内視鏡７の方向を一体的に変化させるように、長手方向の途中位置に湾曲部（図示略）を有するものを採用してもよい。外套管５の湾曲部の湾曲方向は、水平方向、鉛直方向およびこれらを組み合わせた方向のいずれであってもよい。

また、本実施形態においては、内視鏡７の湾曲部７ａ，７ｂを湾曲させるモータに備えられたエンコーダによる検出信号に基づいて、カメラ１３の光軸１３ａの水平面６Ａに対する角度αをモニタ駆動制御部２１およびハンドル駆動制御部２２がそれぞれ算出することとしたが、これに代えて、図７に示されるように、共通の角度算出部２３を配置し、該角度算出部２３により算出された角度αをモニタ駆動制御部２１およびハンドル駆動制御部２２に入力することにしてもよい。

また、本実施形態においては、比例係数１の正比例関数である第１の関数および第２の関数に基づいて、モニタ８の角度βおよび接眼部８ａとグリップ１０ａとを結ぶ直線の角度γを調節することとしたが、これに代えて、図８に示される第１、第２の関数を使用してもよい。

図８の第１、第２の関数は、カメラ１３の光軸１３ａの角度αの角度範囲（０°〜９０°）が５つの領域に区画され、中央の領域（４０°〜５０°）において、角度β，γが比例係数１の正比例関数として表され、その両側の４つの領域（０°〜２０°、２０°〜４０°、５０°〜７０°、７０°〜９０°）においては、角度範囲の両端に向かうに従って傾きが徐々に小さくなり、角度範囲全体としては不連続な関数となっている。図中、鎖線は、比例係数１で正比例する図３の関数を示している。

これら第１の関数および第２の関数は、それぞれ、図９に示されるように、モニタ駆動制御部２１およびハンドル駆動制御部２２に接続される記憶部２４，２５に記憶されていればよい。そして、角度算出部２３により算出された角度αに基づいて、モニタ駆動制御部２１およびハンドル駆動制御部２２が記憶部２４，２５内に記憶されている第１の関数および第２の関数によって角度βおよび角度γを算出することにしてもよい。

図８に示す例では、フットスイッチ１２の操作によって内視鏡７の湾曲部７ａ，７ｂの角度が変化し、カメラ１３の光軸１３ａの角度αが４０°〜５０°の角度範囲で変化する場合には、モニタ駆動制御部２１およびハンドル駆動制御部２２はモニタ８の角度βおよび接眼部８ａとグリップ１０ａとを結ぶ直線の角度γを角度αに一致させるように制御するようになっている。

また、カメラ１３の光軸１３ａの角度αが２０°〜４０°、５０°〜７０°の角度範囲で変化する場合には、モニタ駆動制御部２１およびハンドル駆動制御部２２は、角度βおよび角度γを角度αに比例係数０．５を乗算した値となるように制御するようになっている。さらに、カメラ１３の光軸１３ａの角度αが０°〜２０°、７０°〜９０°の角度範囲で変化する場合には、モニタ駆動制御部２１およびハンドル駆動制御部２２は、角度βおよび角度γを角度αに比例係数０．１を乗算した値となるように制御するようになっている。

図３に示されるように、角度αの全角度範囲にわたって、角度β，γが比例係数１で正比例する場合には、角度αがその角度範囲の両端に近づくほど、グリップ１０ａが医師Ｄの身体から離れすぎたり近づき過ぎたりして、医師Ｄの姿勢が窮屈になる。これに対して、図８の第１の関数および第２の関数を使用することにより、角度αの角度範囲の両端におけるモニタ８およびグリップ１０ａの移動量が少なくなる。これにより、グリップ１０ａの直感的な操作を可能としながら、姿勢が窮屈になり過ぎないようにすることができるという利点がある。

なお、本実施形態においては、比例係数を１，０．５，０．１としたが、これに限定されるものではなく、任意のものを採用することができる。
また、角度範囲の領域分割についても、上記分割に限定されるものではなく任意に設定することができる。
また、角度範囲の最も端に位置する領域においては、角度αの変化に関わらず、角度β、γを変化させないことにしてもよい。

また、領域毎に比例係数を不連続に変化させることとしたが、図１０に示されるように、有限の領域に分けることなく、連続的に変化する関数を使用してもよい。
また、図１１に示されるように、角度αの全角度範囲にわたって、１より小さい比例係数で比例する関数を採用してもよい。このようにしても、接眼部８ａとグリップ１０ａとの相対位置関係がカメラ１３と処置具６との相対位置関係に近づくようにモニタ８およびグリップ１０ａが作動させられるので、グリップ１０ａの操作の直感性は維持される。

また、第１の関数および第２の関数を同じ関数としたが、これに限定されるものではなく、異なる関数を使用してもよい。また、第１，第２の関数のいずれか一方については、比例係数１の正比例関数を採用してもよい。

また、上記実施形態においては、内視鏡７として、カメラ１３の光軸１３ａが内視鏡７の長手方向に一致する直視形式の内視鏡７を例示したが、側視形式または斜視形式の内視鏡７を採用してもよい。この場合に、内視鏡７の湾曲部７ａ，７ｂの湾曲角度とカメラ１３の光軸１３ａの角度αとの関係はそれぞれ異なる。

そこで、図１２に示されるように、内視鏡７に備えられた形式情報を読み取る読み取り部２６と、形式情報に対応づけて補正情報を記憶する補正情報記憶部２７とを備えていて、角度算出部２３が、該読み取り部２６によって読み取られた形式情報を用いて補正情報記憶部２７内から読み出した補正情報を用いて角度αを算出することにしてもよい。

また、マスタ装置２とスレーブ装置３とは相互に近接して配置され、相互に電気的に接続されていてもよいし、相互に遠隔に配置され、無線送信によって信号の授受を行うことにしてもよい。

Ａ 患部（被写体）
α 角度（撮影角度）
β 角度（表示部角度）
γ 角度（操作部角度）
１ マニピュレータシステム
４ コントローラ（制御部）
６ 処置具（処置部）
８ モニタ（表示部）
９ モニタ駆動部（表示部駆動部）
１０ ハンドル（操作部）
１１ ハンドル駆動部（操作部駆動部）
１３ カメラ（撮影部）
２４，２５ 記憶部（関数記憶部）

Claims (13)

1. 被写体を処置する処置部と、
   前記被写体および処置部を撮影する撮影部と、
   該撮影部により取得された画像を表示する表示部と、
   該表示部を支持して移動させる表示部駆動部と、
   前記処置部を操作する操作部と、
   該操作部を支持して移動させる操作部駆動部と、
   前記表示部と前記操作部との相対位置関係を、前記処置部と前記撮影部との相対位置関係に近づけるように前記表示部駆動部および前記操作部駆動部を制御する制御部とを備えるマニピュレータシステム。
2. 前記撮影部による被写体の撮影角度を検出する検出部を備え、
   前記制御部が、検出部により検出された撮影角度に基づいて、前記表示部駆動部および前記操作部駆動部を制御する請求項１に記載のマニピュレータシステム。
3. 前記表示部駆動部が、前記表示部の法線の水平方向に対する角度である表示部角度を変化させる請求項２に記載のマニピュレータシステム。
4. 前記操作部駆動部が、前記操作部と前記表示部とを結ぶ直線の水平方向に対する角度である操作部角度を変化させる請求項２または請求項３に記載のマニピュレータシステム。
5. 前記制御部が、前記撮影角度と前記表示部角度とを一致させるように前記表示部駆動部を制御する請求項３に記載のマニピュレータシステム。
6. 前記制御部が、前記撮影角度と前記操作部角度とを一致させるように前記操作部駆動部を制御する請求項４に記載のマニピュレータシステム。
7. 前記操作部駆動部が、前記操作部と前記表示部とを結ぶ直線の水平方向に対する角度である操作部角度を変化させ、
   前記制御部が、前記撮影角度、前記操作部角度および前記表示部角度を一致させるように前記表示部駆動部および前記操作部駆動部を制御する請求項３に記載のマニピュレータシステム。
8. 前記撮影角度と前記表示部角度との関係を示す第1の関数を記憶する関数記憶部を備え、
   前記制御部が、前記関数記憶部に記憶されている前記第１の関数に基づいて、前記表示部駆動部を制御する請求項３に記載のマニピュレータシステム。
9. 前記第１の関数が、前記撮影角度の角度範囲の両端に向かって傾きの小さくなる関数である請求項８に記載のマニピュレータシステム。
10. 前記第１の関数が、前記撮影角度の全角度範囲にわたって、前記撮影角度の変化量に対する前記表示部角度の変化量が１以下となる関数である請求項８に記載のマニピュレータシステム。
11. 前記撮影角度と前記操作部角度との関係を示す第２の関数を記憶する関数記憶部を備え、
    前記制御部が、前記関数記憶部に記憶されている前記第２の関数に基づいて、前記操作部駆動部を制御する請求項４に記載のマニピュレータシステム。
12. 前記第２の関数が、前記撮影角度の角度範囲の両端に向かって傾きの小さくなる関数である請求項１１に記載のマニピュレータシステム。
13. 前記第２の関数が、前記撮影角度の全角度範囲にわたって、前記撮影角度の変化量に対する前記操作部角度の変化量が１以下となる関数である請求項１１に記載のマニピュレータシステム。

Images