(57)【要約】【課題】内視鏡の目標となる視野範囲を変更するために湾曲部が大きく変動する場合においても、患部を見失ったり違和感を覚えたりする不都合の発生を緩和する。【解決手段】挿入部の先端に設けられた湾曲部の異なる２つの制御状態の切替指示を受け付ける切替指示ステップＳ６と、該切替指示ステップＳ６において切替指示が受け付けられた時点の湾曲部の現在角度θｅと、切替後の制御状態における湾曲部の最終目標角度θｇとの角度差を算出する角度差算出ステップＳ１３と、算出された角度差が所定の閾値θｔｈを超える場合に、閾値θｔｈより小さい微小角度Δθと現在角度θｅとを加算して目標角度θｒｅｆを算出し、角度差が閾値θｔｈ以下の場合に、角度差を現在角度θｅに加算して目標角度θｒｅｆを算出する目標算出ステップＳ４，Ｓ１５と、算出された目標角度θｒｅｆまで湾曲部を駆動する駆動ステップＳ５とを含む医療用システムの制御方法を提供する。【選択図】図２
2015159891.tif 000002
【特許請求の範囲】
【請求項１】
トロッカの貫通孔を介して体内に内視鏡の挿入部を挿入した医療用システムにおいて、前記挿入部の先端に設けられた湾曲部の異なる２つの制御状態を切り替えて制御する医療用システムの制御方法であって、
制御状態の切替指示を受け付ける切替指示ステップと、
該切替指示ステップにおいて切替指示が受け付けられた時点の前記湾曲部の現在角度と、切替後の制御状態における前記湾曲部の最終目標角度との角度差を算出する角度差算出ステップと、
該角度差算出ステップにより算出された角度差が所定の閾値を超える場合に、当該閾値より小さい微小角度と前記現在角度とを加算して目標角度を算出し、前記角度差が前記閾値以下の場合に、該角度差を前記現在角度に加算して目標角度を算出する目標算出ステップと、
該目標算出ステップにおいて算出された目標角度まで前記湾曲部を駆動する駆動ステップとを含む医療用システムの制御方法。
【請求項２】
前記微小角度が、前記角度差に１／ｎ（ｎは２より大きい整数）を乗算した角度である請求項１に記載の医療用システムの制御方法。
【請求項３】
前記トロッカにおける前記挿入部の長手軸の傾斜角度および長手軸方向の挿入量を検出する検出ステップと、
切替後の制御状態における特定の基準点の座標値と、前記挿入量および前記傾斜角度とに応じて前記最終目標角度を算出する最終目標角度算出ステップを含む請求項１または請求項２に記載の医療用システムの制御方法。
【請求項４】
切替前の制御状態が、前記湾曲部を手動の指令に従って湾曲させる制御状態である請求項３に記載の医療用システムの制御方法。
【請求項５】
切替前の制御状態が、他の基準点の座標値と、前記挿入量および前記傾斜角度とに応じて前記湾曲部を湾曲させる制御状態である請求項３に記載の医療用システムの制御方法。
【請求項６】
前記切替指示ステップの後に、切替後の制御状態における前記湾曲部の先端と基準点との距離を算出し、該距離が距離閾値より小さいときには、前記湾曲部の先端を移動させないように制御する請求項４に記載の医療用システムの制御方法。
【請求項７】
前記挿入部が複数の湾曲部を備え、
各湾曲部の湾曲量の比率を複数記憶し、
前記制御状態の切替の前後において湾曲量の比率を切り替える請求項１から請求項６のいずれかに記載の医療用システムの制御方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、医療用システムの制御方法に関するものである。
【背景技術】
【０００２】
従来、腹部を貫通するトロッカを介して、先端に湾曲部を有する内視鏡および処置具を腹腔内に挿入し、トロッカに設けたセンサにより検出された処置具の先端位置に一致するように視野範囲が移動するように内視鏡の湾曲部を制御する医療用システムが知られている（例えば、特許文献１参照。）。
【０００３】
この特許文献１の医療用システムにおいては、一の患部を処置している状態で、処置具の先端位置に迅速に追従するように内視鏡の湾曲部を制御している状態から、異なる患部を処置するために処置具の先端が大きく移動させられると、同様に処置具の先端位置に迅速に追従するように内視鏡の湾曲部も大きく湾曲させられる。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】米国特許出願公開第２００５／０１４９００３号明細書
【発明の概要】
【発明が解決しようとする課題】
【０００５】
しかしながら、このような場合には内視鏡の視野範囲は短時間に急激に変化するため、内視鏡の画像をモニタによって観察している術者は患部を見失ったり違和感を覚えたりすることになるという不都合がある。
本発明は、上述した事情に鑑みてなされたものであって、内視鏡の目標となる視野範囲を変更するために湾曲部が大きく変動する場合においても、患部を見失ったり違和感を覚えたりする不都合の発生を緩和することができる医療用システムの制御方法を提供することを目的としている。
【課題を解決するための手段】
【０００６】
上記目的を達成するために、本発明は以下の手段を提供する。
本発明の一態様は、トロッカの貫通孔を介して体内に内視鏡の挿入部を挿入した医療用システムにおいて、前記挿入部の先端に設けられた湾曲部の異なる２つの制御状態を切り替えて制御する医療用システムの制御方法であって、制御状態の切替指示を受け付ける切替指示ステップと、該切替指示ステップにおいて切替指示が受け付けられた時点の前記湾曲部の現在角度と、切替後の制御状態における前記湾曲部の最終目標角度との角度差を算出する角度差算出ステップと、該角度差算出ステップにより算出された角度差が所定の閾値を超える場合に、当該閾値より小さい微小角度と前記現在角度とを加算して目標角度を算出し、前記角度差が前記閾値以下の場合に、該角度差を前記現在角度に加算して目標角度を算出する目標算出ステップと、該目標算出ステップにおいて算出された目標角度まで前記湾曲部を駆動する駆動ステップとを含む医療用システムの制御方法を提供する。
【０００７】
本態様によれば、トロッカの貫通孔に挿入部を挿入した内視鏡の先端を体内に配置して体内の観察を行う場合に、挿入部をトロッカに対して長手軸方向に移動させるとともにその長手軸の傾斜角度を変更し、挿入部の先端の湾曲部を湾曲させて視野範囲を変更しながら観察が行われる。この場合に、一の制御状態から湾曲部の状態が異なる他の制御状態への切替指示が受け付けられたときには、そのときの湾曲部の現在角度と切替後の制御状態における湾曲部の最終目標角度との角度差が角度差算出ステップにおいて算出され、角度差が閾値より大きいときには一度に最終目標角度まで移動させるのではなく、その途中の角度を目標角度として駆動ステップによりその目標角度まで湾曲部を駆動することにより、内視鏡の視野の急激な変化を防止することができる。一方、角度差が閾値以下の場合には、視野の急激な変化はないので、一度に最終目標角度まで移動させることで異なる制御状態を迅速に切り替えることができる。
【０００８】
上記態様においては、前記微小角度が、前記角度差に１／ｎ（ｎは２より大きい整数）を乗算した角度であってもよい。
このようにすることで、現在位置に加算する微小角度を角度差に比例する値に設定することができ、角度差が大きいほど、微小角度を大きくして、移動速度を増大させることができる。
【０００９】
また、上記態様においては、前記トロッカにおける前記挿入部の長手軸の傾斜角度および長手軸方向の挿入量を検出する検出ステップと、切替後の制御状態における特定の基準点の座標値と、前記挿入量および前記傾斜角度とに応じて前記最終目標角度を算出する最終目標角度算出ステップを含んでいてもよい。
このようにすることで、一旦設定された最終目標角度に基づく制御中にも、トロッカに対して挿入部の挿入量や傾斜角度が変化した場合には、検出ステップにおいて検出された挿入量や傾斜角度に基づいて、最終目標角度算出ステップにおいて新たな最終目標角度に更新されるので、操作に伴って徐々に第２の制御状態へと近づけることができる。
【００１０】
また、上記態様においては、切替前の制御状態は、前記湾曲部を手動の指令に従って湾曲させる制御状態であってもよいし、切替前の制御状態は、他の基準点の座標値と、前記挿入量および前記傾斜角度とに応じて前記湾曲部を湾曲させる制御状態であってもよい。
【００１１】
また、上記態様においては、前記切替指示ステップの後に、切替後の制御状態における前記湾曲部の先端と基準点との距離を算出し、該距離が距離閾値より小さいときには、前記湾曲部の先端を移動させないように制御してもよい。
【００１２】
また、上記態様においては、前記挿入部が複数の湾曲部を備え、各湾曲部の湾曲量の比率を複数記憶し、前記制御状態の切替の前後において湾曲量の比率を切り替えてもよい。
【発明の効果】
【００１３】
本発明によれば、内視鏡の目標となる視野範囲を変更するために湾曲部が大きく変動する場合においても、患部を見失ったり違和感を覚えたりする不都合の発生を緩和することができるという効果を奏する。
【図面の簡単な説明】
【００１４】
【図１】本発明の第１の実施形態に係る制御方法を適用する医療用システムを示す全体構成図である。
【図２】図１の制御方法を示すフローチャートである。
【図３】図１の制御方法を説明する内視鏡の先端部を示す図である。
【図４】本発明の第２の実施形態に係る医療用システムの制御方法を説明する内視鏡の先端部を示す図である。
【図５】図４の制御方法を示すフローチャートである。
【図６】図４の制御方法の第１の変形例における（ａ）内視鏡の先端部、（ｂ）関節の可動範囲をそれぞれ示す図である。
【図７】図４の制御方法の第２の変形例における（ａ）内視鏡の先端部、（ｂ）関節の可動範囲をそれぞれ示す図である。
【図８】図４の制御方法の第３の変形例における（ａ）内視鏡の先端部、（ｂ）関節の可動範囲をそれぞれ示す図である。
【図９】本発明の第３の実施形態に係る医療用システムの制御方法を説明する内視鏡の先端部を示す図である。
【図１０】図９の制御方法を示すフローチャートである。
【発明を実施するための形態】
【００１５】
本発明の第１の実施形態に係る医療用システム１の制御方法について、図面を参照して以下に説明する。
本実施形態に係る制御方法は、図１に示される医療用システム１に適用されるものである。
【００１６】
この医療用システム１は、図１に示されるように、体表組織Ａを貫通して配置されたトロッカ２と、該トロッカ２内に挿入される硬性の内視鏡３と、該内視鏡３の挿入部４の先端に配置された関節（湾曲部）５の揺動角度を手動により指令する操作部６と、体内の患部Ｂ等の観察すべき部位の基準となる基準点Ｐの座標の設定および制御状態の切替指令を行う入力部７と、前記関節５を駆動する駆動部８と、該駆動部８を制御する制御部９と、内視鏡３により取得された信号から画像を生成する画像処理部１０と、該画像処理部１０により生成された画像を表示するモニタ１１とを備えている。
トロッカ２には、挿入されている内視鏡３の挿入部４の長手軸方向の挿入量Ｉ１と、鉛直線に対する長手軸の傾斜角度Ｉ２とをそれぞれ検出するセンサ（図示略）が設けられている。
【００１７】
本実施形態においては、内視鏡３は、単一の関節５を備えている。関節５は、硬性の挿入部４の先端に設けられ、挿入部４の長手軸に対する先端部３ａの長手軸の角度を変更するようになっている。
【００１８】
制御部９は、操作部６からの指令信号に基づいて、指令信号の通りに関節５を揺動させるように駆動部８を駆動する第１の制御状態と、先端部３ａの長手軸が設定された基準点Ｐを通過するように関節５を揺動させる第２の制御（協調制御）状態とにより駆動部８を制御するようになっている。また、制御部９は、入力部７から第１の制御状態から第２の制御状態に切り替える切替指令を受け付けたときに第１の制御状態から第２の制御状態に移行させるための第３の制御状態を実施するようになっている。
【００１９】
次に、本実施形態に係る医療用システム１の制御方法について、図２および図３を参照して説明する。
本実施形態に係る制御方法は、図２に示されるように、第１の制御状態が選択されている状態（ステップＳ１）では、術者がモニタ１１に表示されている内視鏡３による画像を観察しながら、操作部６を操作することにより、操作部６を介した手動による操作量に応じた関節５の最終目標角度θｇが算出され（ステップＳ２）、フラグｉがゼロに設定される（ステップＳ３）。そして、関節５の目標角度θｒｅｆとしても最終目標角度θｇが設定され（ステップＳ４）、関節５が目標角度θｒｅｆとなるように駆動部８が駆動される（ステップＳ５）。切替指令が入力されない限り、ステップＳ２〜Ｓ５の工程が繰り返され、第１の制御状態が維持される。
【００２０】
次いで、術者が、入力部７から第２の制御状態への切替指令を入力すると（ステップＳ６，Ｓ７）、まず、基準点Ｐの座標を指定するよう促され、術者は、モニタ１１上に表示された画像において、患部Ｂ等を特定するための基準点Ｐを指定することにより（ステップＳ８）、指定された基準点Ｐの座標値が記憶される（ステップＳ９）。この後にフラグｉが１に設定される（ステップＳ１０）。なお、基準点Ｐの座標は予め記憶されていてもよく、その場合にはステップＳ８，Ｓ９は省略される。
【００２１】
そして、記憶されている基準点Ｐの座標値から最終目標角度θｇが算出される（ステップＳ１１）。最終目標角度θｇは、次のようにして算出される。
すなわち、トロッカ２に設けられたセンサにより検出された硬性の挿入部４の挿入量Ｉ１および傾斜角度Ｉ２から、挿入部４の先端に設けられた関節５の座標が算出されるので、トロッカ２の座標と関節５の座標とを結ぶ線分（挿入部４の長手軸）と、関節５の座標と基準点Ｐの座標とを結ぶ線分（先端部３ａの長手軸）とがなす角度が最終目標角度θｇとして算出される。
この最終目標角度θｇは、先端部３ａの先端に設けられた内視鏡３の撮影光学系の光軸上に基準点Ｐが配置され、内視鏡３が基準点Ｐを直視する状態となるときの関節５の揺動角度を示している。
【００２２】
そして、その後に、第２の制御状態への切替指令が入力された直後であるか否かが、フラグｉが１であるか否かによって判定され（ステップＳ１２）、フラグｉが１である場合には第３の制御状態が実施される。
第３の制御状態においては、まず、関節５の最終目標角度θｇと現在角度θｅとの差分｜θｇ−θｅ｜が算出され（ステップＳ１３）、差分｜θｇ−θｅ｜が所定の閾値θｔｈ以下か否かが判定される（ステップＳ１４）。判定の結果、差分｜θｇ−θｅ｜が閾値θｔｈより大きい場合には、閾値θｔｈより小さい微小角度Δθを現在角度に加えた角度が目標角度θｒｅｆとして設定され（ステップＳ１５）、ステップＳ５からの工程が繰り返される。ここで、微小角度Δθとしては、例えば、閾値θｔｈより十分に小さい定数を設定すればよい。
【００２３】
判定の結果、差分Δθが閾値θｔｈ以下である場合には、フラグｉが２に変更された後に（ステップＳ１６）、ステップＳ４からの工程が繰り返される。これにより、その後は、基準点Ｐの座標値を追従するように関節５が駆動される第２の制御状態が実施される。
【００２４】
すなわち、本実施形態に係る医療用システム１の制御方法によれば、手動操作による操作量に従って駆動部８により関節５を駆動していた第１の制御状態から、基準点Ｐを設定して自動的に駆動部８により基準点Ｐを追従するように関節５を駆動する第２の制御状態に切り替える際に、現在角度θｅと最終目的角度θｇとの差分｜θｇ−θｅ｜が所定の閾値θｔｈより大きいときには、直接的に制御状態を切り替えないので、直接切り替えた場合のような内視鏡３の画像の急激な変化を防止することができる。
【００２５】
そして、第１の制御状態から第２の制御状態に切り替える前に、一旦、現在角度θｅから微小角度Δθだけ移動する角度を目標角度θｒｅｆとして設定して関節５を湾曲させる第３の制御状態を実行するので、モニタ１１に表示される画像を徐々に変化させることができ、術者が患部Ｂを見失ったり、違和感を覚えたりしないようにすることができるという利点がある。
【００２６】
なお、本実施形態においては、微小角度Δθとして閾値θｔｈより十分に小さい定数を設定したが、これに代えて、最終目標角度θｇと現在角度θｅとの差分｜θｇ−θｅ｜に１／ｎ（ｎは２より大きい整数）を乗算した値を微小角度Δθとしてもよい。これにより、差分｜θｇ−θｅ｜の大きさに比例する微小角度Δθを設定し、差分｜θｇ−θｅ｜が大きい場合にはより速く、小さい場合にはより遅く関節５を駆動することができる。
【００２７】
また、第３の制御状態の実行中に、内視鏡３が操作されることによって挿入部４の挿入量Ｉ１や傾斜角度Ｉ２が変更された場合には、その移動量ΔＰに比例する閾値θｔｈより小さい値を微小角度Δθとして設定してもよい。これにより、挿入部４の移動量ΔＰが大きい場合にはより速く、小さい場合にはより遅く関節５を駆動することができる。ここで、挿入部４の移動量ΔＰは挿入量Ｉ１または傾斜角度Ｉ２のいずれかでもよいし、両者を合成したベクトルの大きさであってもよい。
【００２８】
すなわち、手動による第１の制御状態から自動による第２の制御状態への移行の際に、挿入部４の進退（挿入量Ｉ１変更）操作やあおり（傾斜角度Ｉ２変更）操作が行われた場合には、操作に応じて目標角度θｒｅｆが更新されていくので、徐々に第２の制御状態による理想的な状態に近づけて、より自然に制御状態を切り替えることができる。
【００２９】
次に、本発明の第２の実施形態に係る医療用システム２０の制御方法について、図面を参照して以下に説明する。
本実施形態の説明において、上述した第１の実施形態に係る医療用システム１の制御方法と構成を共通とする箇所には同一符号を付して説明を省略する。
【００３０】
本実施形態に係る制御方法は、図４に示されるように、挿入部４の先端に平行な軸線回りに揺動する２つの関節２１，２２を有する内視鏡３を備える医療用システム２０に適用される。
これら２つの関節２１，２２の動作についても、制御部９は、操作部６からの指令信号に基づいて、操作量に応じた角度だけ関節２１，２２を揺動させるように駆動部８を駆動する第１の制御状態と、先端部３ａの長手軸が設定された基準点Ｐを通過するように関節２１，２２を揺動させるように駆動部８を駆動する第２の制御状態を実施するようになっている。
【００３１】
さらに具体的には、第２の制御状態は、まず、先端側の関節２１の揺動角度をゼロ（基端側の関節２２から先が一直線に配されている状態）とし、基端側の関節２２のみを揺動させたときに、設定された基準点Ｐが先端部３ａの長手軸上に配置されることとなる揺動角度θ１を求め、該揺動角度θ１の半分の角度を基端側の関節２２の最終目標角度θｇ２に設定する。次いで、基端側の関節２２が最終目標角度θｇ２だけ揺動された状態で、先端側の関節２１のみを揺動させたときに、設定された基準点Ｐが先端部３ａの長手軸上に配置されることとなる揺動角度を求め、該揺動角度を先端側の関節２１の最終目標角度θｇ１に設定するようになっている。そして、第２の制御状態においては、制御部９は、これらの最終目標角度θｇ１，θｇ２が各サンプリング周期において達成されるように２つの関節２１，２２を揺動させる駆動部８を制御するようになっている。
【００３２】
また、本実施形態に係る医療用システム２０の制御方法においては、図５に示されるように、第１の制御状態においては、操作部６を介した手動による操作量に応じた関節２１，２２の最終目標角度θｇ１，θｇ２が算出され（ステップＳ２０）、フラグｉがゼロに設定され（ステップＳ３）、関節２１，２２の目標角度θｒｅｆ１，θｒｅｆ２としても最終目標角度θｇ１，θｇ２が設定され（ステップＳ２１）、関節２１，２２が目標角度θｒｅｆ１，θｒｅｆ２となるように駆動部８が駆動される（ステップＳ５）。
【００３３】
次いで、術者により、第１の制御状態から第２の制御状態への切替指令が入力され（ステップＳ６，Ｓ７）、基準点Ｐの座標が指定および記憶されると（ステップＳ８，Ｓ９）と、上記最終目標角度θｇ１，θｇ２が算出される（ステップＳ２２）とともに、該最終目標角度θｇ１，θｇ２が達成されたときの内視鏡３の先端と、基準点Ｐとの距離ｄが算出される（ステップＳ２３）。そして、算出された距離ｄが所定の閾値ｄｔｈより大きいか否かが判定される（ステップＳ２４）。
【００３４】
距離ｄが閾値ｄｔｈより大きい場合には、基端側の関節２２の最終目標角度θｇ２と現在角度θｅ２との差分｜θｇ２−θｅ２｜が算出され（ステップＳ２５）、差分｜θｇ２−θｅ２｜が所定の閾値θｔｈ以下か否かが判定される（ステップＳ２６）。
判定の結果、差分｜θｇ２−θｅ２｜が閾値θｔｈより大きい場合には、閾値θｔｈより小さい微小角度Δθ2を現在角度θｅ２に加えた角度が目標角度θｒｅｆ２として設定されるとともに、基端側の関節２２が目標角度θｒｅｆ２だけ移動した場合の先端側の関節２１の目標角度θｒｅｆ１が算出され（ステップＳ２７）、ステップＳ５からの工程が繰り返される。
【００３５】
そして、判定の結果、差分｜θｇ２−θｅ２｜が閾値θｔｈ以下となった場合には、ステップＳ２１からの工程が繰り返される。
一方、算出された距離ｄが小さい場合には、閾値ｄｔｈと一致する算出距離ｄとなるように設定し（ステップＳ２８）、関節２１，２２の作動を停止して、術者による挿入部４の操作により挿入量Ｉ１あるいは傾斜角度Ｉ２が変更されることにより、変更後の距離ｄが新たな閾値ｄｔｈより大きくなるのを待つ（ステップＳ２９）ようになっている。すなわち、ステップＳ２２からの工程が繰り返される。そして、術者による挿入部４の操作後に、新たに最終目標角度θｇ１，θｇ２が算出され（ステップＳ２２）、新たな最終目標角度θｇ１，θｇ２に基づいて算出された距離ｄが閾値ｄｔｈより大きくなった場合には、ステップＳ２５からの動作が行われる。
【００３６】
このように構成された本実施形態に係る医療用システム２０の制御方法によれば、手動による第１の制御状態から自動による第２の制御状態に切り替える際に、第２の制御状態に移行した場合の先端から基準点Ｐまでの距離ｄが閾値ｄｔｈ以下の場合に、第２の制御状態への移行を停止して、挿入部３の先端が患部Ｂに近接し過ぎることを防止することができるという利点がある。
また、上記距離ｄが閾値ｄｔｈより大きい場合には、第１の実施形態と同様に、モニタ１１に表示される画像を徐々に変化させるように関節２１，２２を駆動することができ、術者が患部Ｂを見失ったり、違和感を覚えたりしないようにすることができるという利点がある。
【００３７】
なお、本実施形態においては、基端側の関節２２のみを揺動させたときに、設定された基準点Ｐが先端部３ａの長手軸上に配置されることとなる揺動角度θ１を求め、該揺動角度θ１の半分の角度を基端側の関節２２の最終目標角度θｇ２に設定したが、これに限定されるものではなく、設定された比率Ｋを乗じてθｇ２を算出してもよい。
【００３８】
例えば、比率Ｋとして１／３を採用する場合には、図６（ａ），（ｂ）に示されるように、基端側の関節２２を小さく、先端側の関節２１を大きく動作させる可動範囲Ｃ１となるので、入口が狭い空間でも先端を大きく動かせる狭い空間での観察に適している。
また、比率Ｋとして１／２を採用する上記方法では、図７（ａ），（ｂ）に示されるように、先端側の関節２１と基端側の関節２２とで同等の可動範囲Ｃ２として平均的な観察を行うことができる。
【００３９】
さらに、比率Ｋとして２／３を採用する場合には、図８（ａ），（ｂ）に示されるように、基端側の関節２２を大きく動作させる可動範囲Ｃ３となるので、基端側の関節２２の広い可動範囲Ｃ３によって大空間をくまなく観察する用途に適している。
これらの比率Ｋを複数登録しておき、観察の種類に合わせて選択することにすればよい。
【００４０】
次に、本発明の第３の実施形態に係る医療用システム３０の制御方法について、図面を参照して以下に説明する。
本実施形態の説明において、上述した第１の実施形態に係る医療用システム１の制御方法と構成を共通とする箇所には同一符号を付して説明を省略する。
【００４１】
本実施形態に係る医療用システム３０の制御方法は、第１の実施形態に係る制御方法が、手動の第１の制御状態から自動の第２の制御状態に移行する場合であったのに対し、自動の第１の制御状態から自動の第２の制御状態に移行する場合の制御方法である点で相違している。
【００４２】
すなわち、本実施形態に係る制御方法においては、図９に示されるように、２以上の異なる基準点Ｐ１，Ｐ２の座標を記憶しており、挿入部４の挿入量Ｉ１や傾斜角度Ｉ２が変更されても一の基準点Ｐ１を追従するように関節５が駆動されていた第１の制御状態から、他の基準点Ｐ２を追従するように関節５を駆動する第２の制御状態に移行する際に、第３の制御状態を実施する。
【００４３】
この場合にも、図１０に示されるように、第１の実施形態と同様にして、第１の制御状態（ステップＳ１）においては、一の基準点Ｐ１が選択され（ステップＳ３０）、記憶されている一の基準点Ｐ１の座標値から最終目標角度θｇが算出される（ステップＳ３１）。そして、その後に、第２の制御状態への切替指令が入力された直後であるか否かが、フラグｉが１であるか否かによって判定され（ステップＳ１２）、フラグｉが１である場合には基準点Ｐ２に切り替えられて（ステップＳ３２）、第３の制御状態が実施される。
【００４４】
第３の制御状態においては、まず、関節５の最終目標角度θｇと現在角度θｅとの差分｜θｇ−θｅ｜が算出され（ステップＳ１３）、差分｜θｇ−θｅ｜が所定の閾値θｔｈ以下か否かが判定される（ステップＳ１４）。
判定の結果、差分｜θｇ−θｅ｜が閾値θｔｈより大きい場合には、閾値θｔｈより小さい微小角度Δθを現在角度θｅに加えた角度が目標角度θｒｅｆとして設定され（ステップＳ１５）、ステップＳ５からの工程が繰り返される。
【００４５】
判定の結果、差分｜θｇ−θｅ｜が閾値θｔｈ以下である場合には、フラグｉが２に変更された後に（ステップＳ１６）、最終目標角度θｇが目標角度θｒｅｆとして設定され、駆動部８の駆動により関節５が最終目標角度θｇまで揺動させられる。これにより、第２の制御状態に切り替えられる。
【００４６】
本実施形態に係る制御方法によれば、一の基準点Ｐ１を追従するように関節５が制御されている第１の制御状態から、他の基準点Ｐ２を追従するように関節５が制御される第２の制御状態に移行する際にも、現在角度θｅから微小角度Δθだけ移動する角度を目標角度θｒｅｆとして設定して関節５を揺動させるので、モニタ１１に表示される画像を徐々に変化させることができ、術者が患部Ｂを見失ったり、違和感を覚えたりしないようにすることができるという利点がある。
【符号の説明】
【００４７】
ｄ  距離
ｄｔｈ  距離閾値
Ｉ１  挿入量
Ｉ２  傾斜角度
Ｐ，Ｐ１，Ｐ２  基準点
θｅ，θｅ２  現在角度
θｇ，θg１，θｇ２  最終目標角度
θｒｅｆ，θｒｅｆ１，θｒｅｆ２  目標角度
θｔｈ  閾値
Δθ  微小角度
Ｓ２，Ｓ２０  最終目標角度算出ステップ
Ｓ５  駆動ステップ
Ｓ６  切替指示ステップ
Ｓ１３  角度差算出ステップ
Ｓ１５  目標算出ステップ
Ｓ２９  検出ステップ
１，２０，３０  医療用システム
２  トロッカ
３  内視鏡
４  挿入部
５，２１，２２  関節（湾曲部）
【図１】
2015159891.tif 000003
【図２】
2015159891.tif 000004
【図３】
2015159891.tif 000005
【図４】
2015159891.tif 000006
【図５】
2015159891.tif 000007
【図６】
2015159891.tif 000008
【図７】
2015159891.tif 000009
【図８】
2015159891.tif 000010
【図９】
2015159891.tif 000011
【図１０】
2015159891.tif 000012