JP2012055996A - マスタスレーブマニピュレータ - Google Patents

Abstract

【課題】冗長関節を有するマスタスレーブマニピュレータにおいて、遠隔操作装置とスレーブアームとの構造が異なる構造であっても、逆運動学計算にかかる負荷を低減可能なマスタスレーブマニピュレータを提供すること。
【解決手段】遠隔操作装置１００からの操作信号を受けて、マスタ制御部２０１は、操作部１０１の姿勢変化に係る等価回転ベクトルＶ_ｒ（ｔ）と直前の操作部１０１のマスタロール軸Ｘ_ｍ（ｔ）とを算出する（ステップＳ１）。Ｖ_ｒ（ｔ）とＸ_ｍ（ｔ）のなす角φが規定値以下の場合には、冗長関節１（Ｒｏｌｌ２）と、関節１と冗長関係にある関節４（Ｒｏｌｌ１）のうち、Ｒｏｌｌ２を駆動関節とし、Ｒｏｌｌ１を固定関節として（ステップＳ３）、逆運動学計算を行う。角度φが規定値を以下でない場合には、Ｒｏｌｌ１を駆動関節とし、Ｒｏｌｌ２を固定関節として（ステップＳ４）、逆運動学計算を行う。
【選択図】図５

Description

本発明は、冗長関節を有するマスタスレーブマニピュレータに関する。

近年、医療施設の省人化を図るため、ロボットによる医療処置の研究が行われている。特に、外科分野では、多自由度（多関節）アームを有するマニピュレータによって患者の処置をするマニピュレータシステムについての各種の提案がなされている。このようなマニピュレータシステムにおいて、患者の体腔に直接接触するマニピュレータ（スレーブマニピュレータ）を、遠隔操作装置によって遠隔操作できるようにしたマスタスレーブマニピュレータが知られている。

ここで、内視鏡下手術で特に困難な針かけ動作を、マスタスレーブマニピュレータを用いて行う場合、スレーブアームの先端に取り付けられたグリッパーをローリングさせながら針をかけることになる。このとき、先端にロール軸関節がないスレーブアームでは、先端に取り付けられたグリッパーをローリングさせるためのローリングに伴って他の関節を協調動作させることになる。この場合、多数の関節が動作して、周囲の臓器等に衝突する可能性が考えられる。これに対し、先端部に冗長関節を設けることにより、先端のみの位置・姿勢決めを可能としたマスタスレーブマニピュレータが例えば特許文献１において提案されている。

特開昭６３−２６７１７７号公報

一般に、特許文献１等の先端に冗長関節を有するマスタスレーブマニピュレータの場合、遠隔操作装置からの指令値に従ってスレーブアームの各関節の駆動量を計算するための逆運動学計算が複雑化する。このような場合、例えばスレーブアームの自由度と遠隔操作装置の自由度とを一致させ、スレーブアームの各関節を１対１で対応させるようにすれば逆運動学計算を簡略化することができる。しかしながら、通常、自由度の多い遠隔操作装置を片手で操作することは困難である。

本発明は、上記の事情に鑑みてなされたもので、冗長関節を有するマスタスレーブマニピュレータにおいて、遠隔操作装置とスレーブアームとの構造が異なる構造であっても、逆運動学計算にかかる負荷を低減可能なマスタスレーブマニピュレータを提供することを目的とする。

上記の目的を達成するために、本発明の第１の態様のマスタスレーブマニピュレータは、複数の自由度に対応した操作情報を与えるマスタとしての遠隔操作装置と、複数の自由度に対応した複数の関節を有し、該複数の関節の中に冗長関節が含まれるスレーブマニピュレータと、前記操作情報に従って、前記関節の動作を制御する制御部と、を具備し、前記制御部は、前記操作情報から前記遠隔操作装置の姿勢変化を算出し、該姿勢変化を用いて、所定時間毎に、前記関節のうちで冗長関係にある関節の１つを選択して駆動することを特徴とする。

本発明によれば、冗長関節を有するマスタスレーブマニピュレータにおいて、遠隔操作装置とスレーブアームとの構造が異なる構造であっても、逆運動学計算にかかる負荷を低減可能である。

本発明の一実施形態に係るマスタスレーブマニピュレータの全体構成を示す図である。 遠隔操作装置の構成例を示す図である。 スレーブマニピュレータの構成例を示す図である。 本発明の一実施形態における関節選択の考え方について説明するための図である。 本発明の一実施形態におけるマスタスレーブマニピュレータの動作を示すフローチャートである。 冗長関節をヨー軸関節とした変形例を示す図である。 冗長関節をピッチ軸関節とした変形例を示す図である。 冗長関係にある関節が、隣接しており、かつ、独立して駆動可能なスレーブアームの構成例を示す図である。

以下、図面を参照して本発明の実施形態を説明する。
図１は、本発明の一実施形態に係るマスタスレーブマニピュレータの全体構成を示す図である。図１に示すように、本実施形態に係るマスタスレーブマニピュレータは、遠隔操作装置１００と、制御装置２００と、スレーブマニピュレータ３００と、を有している。なお、図１の例は、本実施形態のマスタスレーブマニピュレータの医療用途への適用例である。しかしながら、本実施形態のマスタスレーブマニピュレータは、医療用途以外の各種の用途に適用可能である。

遠隔操作装置１００は、本マスタスレーブマニピュレータにおけるマスタとして機能するものであって、操作部１０１と、表示部１０２と、を有している。
操作部１０１は、例えば図２（ａ）に示すように、回転機構より構成された駆動軸と、直動機構より構成された駆動軸と、を含む駆動部を有している。さらに、操作部１０１の終端部（操作者１０によって把持される側とする）には、グリッパー部１０１１が設けられている。このような構成において、操作者１０が、グリッパー部１０１１を把持した状態で、操作部１０１を移動させたり、回転させたり、グリッパー部１０１１を操作したりすることにより、操作部１０１を構成する各駆動軸が駆動される。各駆動軸の駆動量（回転機構の場合には回転角、直動機構の場合には変位量）は、各駆動軸に設けられた図示しない位置検出器（例えばエンコーダ）によって検出され、各位置検出器の検出信号が、スレーブマニピュレータ３００のスレーブアーム３０１の手先の位置・姿勢を指令するための、操作部１０１の操作情報を示す信号（操作信号）として制御装置２００に出力される。ここで、図２（ａ）において、操作部１０１は、駆動軸が６個設けられており、この６個の駆動軸の駆動によって、６個の指令値を算出するための６自由度に対応した操作信号（位置に関する信号（θ_１，ｄ_１，ｄ_２）と姿勢に関する信号（θ_２，θ_３，θ_４））を出力する。

なお、操作部１０１は、スレーブアーム３０１の手先の位置・姿勢を指令できるものであれば、その構成は特に限定されるものではない。例えば、操作部１０１に水平３軸の並進移動を検出するためのセンサ（例えば加速度センサ）と各軸周りの回転を検出するためのセンサ（例えば角速度センサ）を設けるようにすれば、例えば図２（ｂ）に示すように、操作部１０１を手持ち式として構成することもできる。図２（ｂ）の例において、操作者１０が手持ち式の操作部１０１を３次元空間内で移動させたり、回転させたりすることで、６自由度に対応した操作信号を与えることが可能である。なお、図２（ｂ）は、操作部１０１で得られた操作信号を、無線通信部１０３を経由して無線通信可能とした例を示している。勿論、図２（ｂ）の例において、操作部１０１で得られた操作信号を有線通信するようにしても良い。

表示部１０２は、例えば液晶ディスプレイから構成され、制御装置２００から入力された画像信号に基づいて画像を表示する。後述するが、制御装置２００から入力される画像信号は、スレーブアーム３０１に取り付けられた電子カメラ（電子内視鏡）を介して得られた画像信号を、制御装置２００において処理したものである。このような画像信号に基づく画像を、表示部１０２に表示させることにより、遠隔操作装置１００の操作者１０は、遠隔操作装置１００から離れた場所に配置されたスレーブマニピュレータ３００の手先の画像を確認することが可能である。

制御部としての制御装置２００は、マスタ制御部２０１と、マニピュレータ制御部２０２と、画像処理部２０３と、を有している。
マスタ制御部２０１は、遠隔操作装置１００からの６自由度に対応した操作信号に従って、スレーブアーム３０１の手先の位置・姿勢の指令値を算出する。また、マスタ制御部２０１は、遠隔操作装置１００からの操作信号に従って、スレーブアーム３０１の各関節のうち冗長関係にある関節の中の１つを駆動関節として選択し、この選択結果を示す関節選択信号を、位置・姿勢の指令値とともにマニピュレータ制御部２０２に出力する。
ここで冗長関係にあるとは、関節の回転軸がお互いに並行にある関係を示している。

マニピュレータ制御部２０２は、遠隔操作装置１００からの位置・姿勢の指令値と関節選択信号とを受けて、スレーブアーム３０１の手先の位置・姿勢を指令値に一致させるために必要なスレーブアーム３０１の各関節の駆動量を、逆運動学計算によって算出する。後述するが、本実施形態のスレーブアーム３０１は、７自由度に対応した関節であるが、１つの関節を固定関節として各関節の駆動を行うため、７自由度の全ての駆動量が未知の場合よりも逆運動学計算で算出する関節数を低減でき，逆運動学計算を簡略化することができる。

画像処理部２０３は、スレーブアーム３０１の先端に設けられた電子カメラ（電子内視鏡等）から得られた画像信号を処理し、表示部１０２の表示用の画像信号を生成して表示部１０２に出力する。
スレーブマニピュレータ３００は、スレーブアーム３０１と、手術台３０２とを有している。
スレーブアーム３０１は、７自由度に対応した関節を有し、マニピュレータ制御部２０２からの制御信号に従って各関節が駆動される。図３にスレーブアーム３０１の構造の一例を示す。図３に示すスレーブアーム３０１は、７個の関節１〜７が連設して配置され、先端部に先端効果器（end effector）３０１１が取り付けられている。なお、図３で示した先端効果器３０１１は、グリッパー（把持器）の例を示している。この他、先端部にカメラ（電子内視鏡）等を取り付けても良い。

図３に示す関節のうち、関節１、４はロール軸（図２に示すマスタのＸ軸に対応）周りに回転する関節であり、関節２、７はヨー軸（図２に示すマスタのＺ軸に対応）周りに回転する関節であり、関節３、６はピッチ軸（図２に示すマスタのＹ軸に対応）周りに回転する関節である。また、関節５はロール軸に沿って伸縮する関節である。ここで、図３の例においては、７個の関節は全てが独立している。特に、図３は、隣り合う関節が異なる駆動軸に対応して動作する例を示している。

図３に示した関節２〜７を協調させながら駆動させることによって、スレーブアーム３０１における手先の位置の３自由度と姿勢の３自由度とが実現される。また、これらの関節に加えて図３では、先端効果器３０１１をローリングさせるための関節１を冗長関節として設けている。このような構成により、例えば、スレーブアーム３０１をローリングさせる場合において、先端側に遠い側である関節４をローリングさせるか、または、先端側に近い側である関節１をローリングさせるかを適時選択することが可能である。本実施形態では、関節１と関節４とは同時に駆動させないようにして逆運動学計算を簡略化する。

手術台３０２は、患者２０が戴置される台であって、例えばこの手術台３０２にスレーブアーム３０１が設置される。
以下、本実施形態のマスタスレーブマニピュレータの動作について説明する。遠隔操作装置１００を把持している操作者１０が、遠隔操作装置１００の操作部１０１に設けられたグリッパー部１０１１を把持した状態で、操作部１０１を移動させたり、回転させたり、グリッパー部１０１１を操作したりすることにより、操作部１０１を構成する各駆動軸が駆動される。各駆動軸が駆動されると、その駆動量が図示しない位置検出器によって検出され、各位置検出器の検出信号（操作信号）が制御装置２００に出力される。なお、操作信号は、所定時間Δｔ毎に出力される。

制御装置２００のマスタ制御部２０１は、遠隔操作装置１００からの６自由度に対応した操作信号に従って、スレーブアーム３０１の手先の位置・姿勢の指令値を算出する。また、マスタ制御部２０１は、遠隔操作装置１００からの操作信号に従って、スレーブアーム３０１の各関節のうち冗長関係にある関節の中の１つを駆動関節とし、残りを固定関節として選択し、この選択結果を示す関節選択信号を、位置・姿勢の指令値とともにマニピュレータ制御部２０２に出力する。

ここで、関節選択信号について説明する。図３で示したように、本実施形態の例のスレーブアーム３０１は、６つの自由度に対応した関節に加えて、他の関節と独立して駆動可能な１つのロール軸関節を冗長関節として有し、これによって７自由度に対応した駆動を行う。スレーブアーム３０１の手先の位置・姿勢の指令値からスレーブアーム３０１の各関節の駆動量を求めるための逆運動学計算を行う場合において、指令値の数と、スレーブアーム３０１の駆動関節の数とが一致しているときには、逆運動学計算によって各関節の駆動量を一意に定めることができ、計算自体もそれほど複雑にはならない。これに対し、遠隔操作装置１００の指令値の数よりもスレーブアーム３０１の駆動関節の数のほうが多くなると、収束計算を行わなければ、各関節の駆動量を一意に定めることができず、計算が複雑化する。本実施形態では、冗長関節である関節１（Ｒｏｌｌ２とする）と、この関節１と冗長関係にある関節４（Ｒｏｌｌ１とする）との一方を固定関節とし、他方を駆動関節として逆運動学計算を行うようにする。これにより、逆運動学計算の際には、７自由度のスレーブアーム３０１を実質的に６自由度のスレーブアーム３０１と考えることができるので、逆運動学計算にかかる負荷を軽減することができる。関節選択信号は、マニピュレータ制御部２０２において、駆動関節と固定関節とを識別するための信号である。

Ｒｏｌｌ１とＲｏｌｌ２の何れを固定関節とするのかは、所定時間毎の遠隔操作装置１００の姿勢変化によって決定する。以下、この考え方について説明する。
まず、遠隔操作装置１００の姿勢変化について次のように定義する。例えば、ある時刻ｔにおいて、遠隔操作装置１００の操作部１０１の位置が、図４（ａ）に示す位置Ｏ_ｍ（ｔ）であるとする。また、時刻ｔにおける操作部１０１の姿勢が、マスタロール軸Ｘ_ｍ、マスタピッチ軸Ｙ_ｍ、マスタヨー軸Ｚ_ｍがそれぞれ、図４（ａ）に示すＸ_ｍ（ｔ）、Ｙ_ｍ（ｔ）、Ｚ_ｍ（ｔ）の方向を向くような姿勢であるとする。この状態から、所定時間Δｔ経過後の時刻ｔ＋１において、操作部１０１の位置が、図４（ａ）に示す位置Ｏ_ｍ（ｔ＋１）に変化したとする。また、時刻ｔ＋１における操作部１０１の姿勢が、マスタロール軸Ｘ_ｍ、マスタピッチ軸Ｙ_ｍ、マスタヨー軸Ｚ_ｍがそれぞれ、図４（ａ）に示すＸ_ｍ（ｔ＋１）、Ｙ_ｍ（ｔ＋１）、Ｚ_ｍ（ｔ＋１）の方向を向くような姿勢に変化したとする。このときの操作部１０１の姿勢変化は、マスタロール軸Ｘ_ｍ（ｔ）周りの回転と、マスタピッチ軸Ｙ_ｍ（ｔ）周りの回転と、マスタヨー軸Ｚ_ｍ（ｔ）の回転とを合成したものである。さらに、数学的には、このような３つの軸周りの回転を、１つの軸周りの回転に置き換えることが可能である。即ち、図４（ｂ）に示すように、ある回転軸Ｖ_ｒ（ｔ）を設定すると、時刻ｔから時刻ｔ＋１の間の操作部１０１の姿勢変化は、操作部１０１を回転軸Ｖ_ｒ（ｔ）周りにθ（ｔ）だけ回転させたものと等価である。一般に、このような回転軸Ｖ_ｒ（ｔ）を表わすベクトルを、等価回転ベクトル（等価回転軸ベクトル等とも呼ばれる）と言う。本実施形態では、この等価回転ベクトルを用いて、操作部１０１の姿勢変化を判定する。

ここで、スレーブアーム３０１の手先をローリングさせる動作を行う場合を考える。例えば、内視鏡下手術においては、術後の縫合の際に針かけ動作が必要となる。このような針かけ動作においては、スレーブアーム３０１の手先に取り付けられた先端効果器３０１１としてのグリッパーをローリングさせながら患者２０の必要な部位に針をかけることになる。上述したように、スレーブアーム３０１は、７つの関節を協調動作させながら、先端効果器３０１１の位置・姿勢を制御するものである。このとき、先端効果器３０１１から遠い関節であるＲｏｌｌ１をローリングさせると、先端効果器３０１１のローリングも行われる反面、その他の関節も大きく動作してしまってスレーブアーム３０１の関節が周囲の臓器等に衝突してしまう場合があり得る。

このため、針かけ動作のような、主にローリング動作が必要な場合には、他の関節が不必要に動作しないよう、スレーブアーム３０１の手先に近い側の関節であるＲｏｌｌ２をローリングさせることが望ましい。この場合には、Ｒｏｌｌ１を固定関節としても特に問題はなく、Ｒｏｌｌ１を固定関節とすることにより、逆運動学計算を簡略化することが可能となる。一方、Ｒｏｌｌ１を固定関節とすると、スレーブアーム３０１の手先の位置・姿勢の取り得る範囲が大きく制限されるため、ローリング以外の回転も必要な動作の場合には、Ｒｏｌｌ１をローリングさせることが望ましい。この場合には、Ｒｏｌｌ２は固定関節としても特に問題はなく、Ｒｏｌｌ２を固定関節とすることにより、逆運動学計算を簡略化することが可能となる。

操作部１０１の操作によって主に先端のロール軸関節を動作させるよう指令されたか否かは、図４（ｃ）に示す、等価回転ベクトルＶ_ｒ（ｔ）とマスタロール軸Ｘ_ｍ（ｔ）とのなす角φ（ｔ）によって判別することができる。即ち、等価回転ベクトルＶ_ｒ（ｔ）とマスタロール軸Ｘ_ｍ（ｔ）とが一致（φ（ｔ）＝０）していれば、時刻ｔから時刻ｔ＋１の間の操作部１０１の姿勢変化は、ローリングによる姿勢変化のみであると考えることができる。この場合には、操作部１０１により、スレーブアーム３０１の手先のローリングのみが必要な動作が指令されたと考えることができる。実際には、等価回転ベクトルＶ_ｒ（ｔ）とマスタロール軸Ｘ_ｍ（ｔ）とが完全に一致する場合だけでなく、他の動作も入るが主に手先のローリング操作である場合も含め、等価回転ベクトルＶ_ｒ（ｔ）とマスタロール軸Ｘ_ｍ（ｔ）とのなす角φ（ｔ）にある規定値を設定し、φ（ｔ）がこの規定値以下の場合には、先端のロール軸関節を主に動かす操作とみなす。

図５は、以上のような考え方に従ったスレーブアーム３０１の駆動制御の流れについて示すフローチャートである。図５の処理は、所定時間Δｔ毎に実行される。図５の処理において、遠隔操作装置１００から操作信号が入力されると、マスタ制御部２０１は、入力された操作信号から、時刻ｔから時刻ｔ＋１の間の姿勢変化を表わすための等価回転ベクトルＶ_ｒ（ｔ）と時刻ｔにおけるマスタロール軸Ｘ_ｍ（ｔ）とを算出する（ステップＳ１）。

等価回転ベクトルＶ_ｒ（ｔ）とマスタロール軸Ｘ_ｍ（ｔ）とを算出した後、マスタ制御部２０１は、Ｖ_ｒ（ｔ）とＸ_ｍ（ｔ）とのなす角φが規定値以下であるか否かを判定する（ステップＳ２）。ステップＳ２の判定において、角度φが規定値以下である、即ちＶ_ｒ（ｔ）とＸ_ｍ（ｔ）とが略一致している場合に、マスタ制御部２０１は、先端効果器３０１１が取り付けられている関節（Ｒｏｌｌ２）を駆動関節とし、この関節と冗長関係にある関節（Ｒｏｌｌ１）を固定関節とする（ステップＳ３）。一方、ステップＳ２の判定において、角度φが規定値を越えている場合に、マスタ制御部２０１は、先端効果器３０１１が取り付けられている関節（Ｒｏｌｌ２）を固定関節とし、この関節と冗長関係にある関節（Ｒｏｌｌ１）を駆動関節とする（ステップＳ４）。

Ｒｏｌｌ１とＲｏｌｌ２の何れを駆動関節とし、何れを固定関節とするかを選択した後、マスタ制御部２０１は、スレーブアーム３０１の手先の位置・姿勢を指令するための指令値とともに、Ｒｏｌｌ１とＲｏｌｌ２の何れを駆動関節とし、何れを固定関節とするかを示す関節選択信号を、マニピュレータ制御部２０２に送信する。これを受けてマニピュレータ制御部２０２は、Ｒｏｌｌ１とＲｏｌｌ２の何れかを固定関節とした状態で逆運動学計算を行ってスレーブアーム３０１の各関節（固定関節とした関節以外）の駆動量を算出する。そして、マニピュレータ制御部２０２は、算出した駆動量に従ってスレーブアーム３０１の各関節を駆動する（ステップＳ５）。なお、逆運動学計算については、例えば解析的な手法等の従来周知の各種の手法を用いることができる。ここでは、その詳細についての説明は省略する。

以上説明したように、本発明によれば、スレーブアーム３０１自体をローリングさせるための関節に加えて、先端効果器３０１１をローリングさせるための関節Ｒｏｌｌ２を冗長関節として有するスレーブアーム３０１において、遠隔操作装置１００の操作部１０１の姿勢変化から、針かけ動作のような、主にローリングが必要な動作の指示がなされたかを判別するようにしている。そして、この判別の結果、主にローリングが必要な動作をさせるように指示されたと判別できる場合（等価回転ベクトルＶ_ｒ（ｔ）とマスタロール軸Ｘ_ｍ（ｔ）とが略一致している場合）には、Ｒｏｌｌ２を駆動関節、Ｒｏｌｌ１を固定関節として逆運動学計算を行うようにしている。一方、ローリング以外の姿勢変化も必要な動作をさせるように指示されたと判別できる場合（等価回転ベクトルＶ_ｒ（ｔ）とマスタロール軸Ｘ_ｍ（ｔ）とが略一致していない場合）には、Ｒｏｌｌ１を駆動関節、Ｒｏｌｌ２を固定関節として逆運動学計算を行うようにしている。このように、本実施形態では、所定時間毎の操作部１０１の姿勢変化に応じて、Ｒｏｌｌ１とＲｏｌｌ２との使い分けを行うようにすることで、仮に遠隔操作装置とスレーブアームとの構造が異なる構造であっても、操作者１０の操作の意図を反映しつつ、逆運動学計算にかかる負荷を低減することができる。また、本実施形態では、Ｒｏｌｌ１とＲｏｌｌ２との使い分けを自動的に行うことができ、スイッチなどにより駆動関節を切り替える必要がなく、操作者１０の手間を軽減することも可能である。

また、操作部１０１の姿勢変化を等価回転ベクトルＶ_ｒ（ｔ）により表わすようにしているため、種々の構造の遠隔操作装置１００に対して、操作部１０１の姿勢変化を適切に求めることが可能である。
ここで、上述した例では、遠隔操作装置１００の操作部１０１の自由度が６自由度（位置３自由度、姿勢３自由度）、スレーブアーム３０１の自由度が７自由度（位置３自由度、姿勢３自由度、手先のローリング）の例を示している。これに対し、遠隔操作装置１００の操作部１０１の自由度とスレーブアーム３０１の自由度との関係は上述した例に限るものではない。例えば位置の自由度をなくした場合（即ち、操作部１０１の自由度が３自由度で、スレーブアーム３０１の自由度が４自由度の場合）であっても、上述した本実施形態の技術を適用できる。さらに、上述した例は、冗長関節が１つの例を示しているが、冗長関節の数は１つに限るものではない。例えば、図３において、関節２と関節３との間に別のロール軸関節が配されても本実施形態の技術を適用できる。なお、この場合には、関節２と関節３の間に配される関節を常に駆動関節とする。

また、図３の例では、先端効果器３０１１が取り付けられている冗長関節をロール軸関節としているが、例えば、図６（ａ）に示すように、先端効果器３０１１がヨー軸関節に取り付けられた構造であっても、また図７（ａ）に示すように、先端効果器３０１１がピッチ軸関節に取り付けられた構造であっても、上述した本実施形態の技術を適用できる。ただし、図６（ａ）の構造の場合には、ステップＳ２の判定において、等価回転ベクトルＶ_ｒ（ｔ）とマスタヨー軸Ｚ_ｍ（ｔ）のなす角φ_ｚ（ｔ）（図６（ｂ）にφ_ｚ（ｔ）を示している）が規定値以下か否かを判定し、規定値以下の場合には先端効果器３０１１側の関節（図６（ａ）の関節１）を駆動関節とする。また、図７（ａ）の構造の場合には、ステップＳ２の判定において、等価回転ベクトルＶ_ｒ（ｔ）とマスタピッチ軸Ｙ_ｍ（ｔ）のなす角φ_ｙ（ｔ）（図７（ｂ）にφ_ｙ（ｔ）を示している）が規定値以下か否かを判定し、規定値以下の場合には先端効果器３０１１側の関節（図７（ａ）の関節１）を駆動関節とする。このように、本実施形態における、冗長関節と、冗長関節と冗長関係にある関節との選択は、遠隔操作装置１００の姿勢変化を表わすための等価回転ベクトルと、スレーブアーム３０１の構造によって遠隔操作装置１００に予め定められた軸と、のなす角を判定することにより、種々の構造のスレーブアーム３０１に対応して行うことが可能である。

ここで、図７の例において、関節２を９０度回転させた場合、関節１はヨー軸関節と等価となる。このような場合には、関節１と関節３との間で、ステップＳ２の判定を行うことも可能である。このように、ステップＳ２の判定は、初期状態で回転軸が平行になっている関節同士で行うだけではなく、冗長自由度機構において、駆動中に回転軸同士が平行となった関節の間で行うことができる。

また、上述した各例は、回転軸が平行で冗長関係にある関節の間に、この関節に対して回転軸が直交した独立な関係にある関節が配置される構造のスレーブアーム３０１を示している。実際には、スレーブアーム３０１を構成する各関節が独立して駆動されるのであれば、冗長関係にある関節が隣接して配置されても良い。例えば、図８のような構造であっても、関節１と関節２とに対して上述した本実施形態の技術を適用可能である。

以上実施形態に基づいて本発明を説明したが、本発明は上述した実施形態に限定されるものではなく、本発明の要旨の範囲内で種々の変形や応用が可能なことは勿論である。
さらに、上記した実施形態には種々の段階の発明が含まれており、開示される複数の構成要件の適当な組合せにより種々の発明が抽出され得る。例えば、実施形態に示される全
構成要件からいくつかの構成要件が削除されても、上述したような課題を解決でき、上述したような効果が得られる場合には、この構成要件が削除された構成も発明として抽出され得る。

１００…遠隔操作装置、１０１…操作部、２００…制御装置、２０１…マスタ制御部、２０２…マニピュレータ制御部、２０３…画像処理部、３００…スレーブマニピュレータ、３０１…スレーブアーム

Claims (7)

1. 複数の自由度に対応した操作情報を与えるマスタとしての遠隔操作装置と、
   複数の自由度に対応した複数の関節を有し、該複数の関節の中に冗長関節が含まれるスレーブマニピュレータと、
   前記操作情報に従って、前記関節の動作を制御する制御部と、
   を具備し、
   前記制御部は、前記操作情報から前記遠隔操作装置の姿勢変化を算出し、該姿勢変化を用いて、所定時間毎に、前記関節のうちで冗長関係にある関節の１つを選択して駆動することを特徴とするマスタスレーブマニピュレータ。
2. 前記制御部は、前記姿勢変化を表わすための軸と前記遠隔操作装置の予め定められた軸とのなす角度から、前記関節のうちで冗長関係にある関節の１つを選択して駆動することを特徴とする請求項１に記載のマスタスレーブマニピュレータ。
3. 前記姿勢変化を表わすための軸は、前記姿勢変化を、姿勢変化前から姿勢変化後の回転とみた場合の回転軸に対応していることを特徴とする請求項２に記載のマスタスレーブマニピュレータ。
4. 前記冗長関係にある関節の間には、前記関節の軸と直交する回転軸を有する関節が存在していることを特徴とする請求項１乃至３の何れか１項に記載のマスタスレーブマニピュレータ。
5. 前記冗長関係にある関節は、隣接して配置されていることを特徴とする請求項１乃至３の何れか１項に記載のマスタスレーブマニピュレータ。
6. 前記制御部は、前記姿勢変化を表わすための軸と前記遠隔操作装置の予め定められた軸とのなす角度が規定値以下の場合に、前記冗長関係にある関節のうち、前記スレーブマニピュレータの先端側に最も近い関節を選択して駆動し、前記姿勢変化を表わすための軸と前記遠隔操作装置の予め定められた軸とのなす角度が前記規定値を越える場合に、前記冗長関係にある関節のうち、前記スレーブマニピュレータの先端側から最も遠い関節を選択して駆動することを特徴とする請求項２乃至５の何れか１項に記載のマスタスレーブマニピュレータ。
7. 前記制御部は、前記関節のうちで冗長関係にある関節のうちの選択しなかった関節を固定関節として、残りの関節の駆動量を逆運動学計算によって算出することを特徴とする請求項１乃至６の何れか１項に記載のマスタスレーブマニピュレータ。

Images