(57)【要約】  マニピュレータは、駆動用指令信号に応じて回転する回転軸を備えたモータ（２３）と、回転軸に連結された減速機（４４）と、モータの動作状態を検出する検出部（４１）と、モータ（２３）により減速機（４４）を介して駆動される可動体（２２）を有する管体と、減速機（４４）を構成するギアの噛合位置の情報に関連つけて周期的な補正情報を予め記憶する記憶部（３６ｂ）と、モータ（２３）ヘ供給される駆動用指令信号と検出部（４１）の検出情報に対する演算処理を行い、更に補正情報を用いてモータに作用する負荷を推定値として算出する負荷算出部（３６ａ）と、負荷算出部（３６ａ）の算出結果を告知する告知部と、を有する。
2010090059.tif 000002
【特許請求の範囲】
【請求項１】
駆動用指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結された減速機と、
前記モータの動作状態を検出する検出部と、
前記モータにより前記減速機を介して駆動される可動体を有する管体と、
前記減速機を構成する複数のギアの噛合位置の情報に関連つけた周期的特性の補正情報を予め記憶する記憶部と、
前記モータヘ供給される前記駆動用指令信号と前記検出部の検出情報に対する演算処理を行い、更に前記補正情報を用いて前記モータに作用する負荷を推定値として算出する負荷算出部と、
前記負荷算出部の算出結果を告知する告知部と、
を有することを特徴とするマニピュレータ。
【請求項２】
前記管体は、体腔内に挿入される内視鏡挿入部の先端側に、該内視鏡挿入部の長手方向に前記可動体を形成する複数の湾曲駒を回転自在に連結し、前記モータの回転によりワイヤを牽引して前駆複数の湾曲駒を湾曲する湾曲部により形成されることを特徴とする請求項１に記載のマニピュレータ。
【請求項３】
前記負荷算出部は、前記モータヘ供給される前記駆動用指令信号と前記検出部の検出情報に対する演算処理を行い、前記モータに作用する負荷を推定する負荷推定部と、前記負荷推定部により推定された負荷推定値に対して、前記複数のギアの噛合のがたつきのために変動する前記負荷推定値を周期的特性の前記補正情報で補正して前記推定値を出力する補正部とからなることを特徴とする請求項１に記載のマニピュレータ。
【請求項４】
前記補正部は、前記複数のギア間の噛合位置の位置情報としての噛合位置情報によって、前記記憶部に記憶された前記補正情報を読み出し、前記負荷推定値を該補正情報で補正して前記推定値を出力することを特徴とする請求項３に記載のマニピュレータ。
【請求項５】
前記記憶部は、前記複数のギア間の噛合位置の位置情報としての噛合位置情報を記憶する噛合位置記憶部と、予め前記負荷推定値を前記噛合位置情報に関係付けて十分に補正可能とすることが調べられた情報を前記補正情報として記憶する補正情報記憶部とを有することを特徴とする請求項４に記載のマニピュレータ。
【請求項６】
さらに、前記推定値が、前記駆動用指令信号に対応した第１の状態に属するか、該第１の状態から逸脱した外力が作用している第２の状態であるか否かを判定する判定部を有することを特徴とする請求項４に記載のマニピュレータ。
【請求項７】
前記判定部は、前記駆動用指令信号に予め関連付けた基準の情報と、前記推定値とが許容される値以上に逸脱しているか否かを比較器により比較することを特徴とする請求項６に記載のマニピュレータ。 
【請求項８】
前記告知部は、前記内視鏡挿入部の先端部に設けられた撮像素子により撮像された画像の映像信号に、前記負荷算出結果を表示する信号を重畳して内視鏡画像表示部に出力することを特徴とする請求項２に記載のマニピュレータ。
【請求項９】
さらに、前記駆動用指令信号を前記モータに供給する場合には、前記減速機を構成する複数のギアの静摩擦状態を解消する振幅の振動信号成分を前記モータヘ重畳して印加する振動信号発生部を有することを特徴とする請求項１に記載のマニピュレータ。
【請求項１０】
さらに、前記駆動用指令信号を前記モータに供給する場合には、前記減速機を構成する複数のギアの静摩擦状態を解消する振幅の振動信号成分を前記モータヘ重畳して印加する振動信号発生部を有することを特徴とする請求項２に記載のマニピュレータ。
【請求項１１】
さらに、前記駆動用指令信号を前記モータに供給する場合には、前記減速機を構成する複数のギアの静摩擦状態を解消する振幅の振動信号成分を前記モータヘ重畳して印加する振動信号発生部を有することを特徴とする請求項３に記載のマニピュレータ。
【請求項１２】
前記駆動用指令信号を前記モータに供給しない期間に、前記モータに振動信号を、前記管体を可動させない程度の振幅で供給すると共に、前記負荷算出部の出力値の時間的な平均値を算出する平均値算出部を有することを特徴とする請求項１に記載のマニピュレータ。
【請求項１３】
前記駆動用指令信号を前記モータに供給しない期間に、前記モータに振動信号を、前記管体を可動させない程度の振幅で供給すると共に、前記負荷算出部の出力値の時間的な平均値を算出する平均値算出部を有することを特徴とする請求項２に記載のマニピュレータ。
【請求項１４】
前記駆動用指令信号を前記モータに供給しない期間に、前記モータに振動信号を、前記管体を可動させない程度の振幅で供給すると共に、前記負荷算出部の出力値の時間的な平均値を算出する平均値算出部を有することを特徴とする請求項３に記載のマニピュレータ。
【請求項１５】
前記負荷算出部の出力値が略極値付近で小さくなるように前記振動信号の振幅を可変制御する振幅制御部を有することを特徴とする請求項９に記載のマニピュレータ。
【請求項１６】
前記負荷算出部の出力値が略極値付近で小さくなるように前記振動信号の振幅を可変制御する振幅制御部を有することを特徴とする請求項１０に記載のマニピュレータ。
【請求項１７】
前記検出部は、前記モータの動作状態として、前記モータの回転位置と回転速度とを検出して前記検出情報として出力することを特徴とする請求項１に記載のマニピュレータ。
【請求項１８】
駆動用指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結された減速機と、
前記モータ及び前記減速機の動作状態を検出する検出部と、
前記モータにより前記減速機を介して駆動される可動体を有する管体と、
前記モータヘ供給される前記駆動用指令信号と前記検出部の検出情報に対する演算処理を行い、前記減速機に作用する負荷を推定値として算出する負荷算出部と、
前記負荷算出部の算出結果を告知する告知部と、
を有することを特徴とするマニピュレータ。
【請求項１９】
前記減速機を構成する複数のギアの位置情報を検出する位置情報検出部を有し、前記駆動用指令信号から前記ギアの位置信号を減算した減算値で前記モータを駆動する構成にして、前記負荷算出部は前記負荷を推定値として算出することを特徴とする請求項１６に記載のマニピュレータ。
【請求項２０】
前記モータ及び前記減速機を含む実体モデルシステムを模擬する仮想モデルシステムを設け、前記実体モデルシステム側の前記減速機に作用する負荷を、前記仮想モデルシステム側に設けた前記負荷算出部により算出することを特徴とする請求項１８に記載のマニピュレータ。
【請求項２１】
前記管体は、体腔内に挿入される内視鏡挿入部の先端側に、該内視鏡挿入部の長手方向に前記可動体を形成する複数の湾曲駒を回転自在に連結し、前記モータの回転によりワイヤを牽引して前駆複数の湾曲駒を湾曲する湾曲部により形成されることを特徴とする請求項１８に記載のマニピュレータ。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、湾曲部の湾曲操縦等を行うマニピュレータに関する。
【背景技術】
【０００２】
一般に、モータを駆動手段として用いた各種の電気機器が広く用いられるようになっている。また、医療機器としての例えば内視鏡においては、体腔内に挿入される挿入部に設けられた湾曲部を手動で湾曲駆動する手動方式の他に、操作性を向上するためにモータを駆動手段に用いた電動方式の内視鏡も実用化されている。  
このようにモータにより負荷を駆動する場合、モータの動作状態を検出する検出手段と共に、負荷の状態を検出するために通常センサが用いられる。例えば内視鏡の場合、湾曲部を駆動するために湾曲部に働く張力を検出するセンサを挿入部内に設けると、挿入部が太くなってしまったり、センサを洗浄や消毒に対する耐性を有する構造にする等が必要になり、コストアップする。【０００３】
このため、センサを設けることなく、モータの出力軸の回転速度等からモータの出力軸にかかる外乱（モータ自身が発生する駆動力を除いた成分）をソフトウェア的な演算処理により算出する外乱オブザーバという技術が特開２００７−１８５３５５号公報に記載されている。  
このように外乱オブザーバによる手法を採用することにより、センサを用いることなくモータの負荷値を外乱推定値として算出することができ、コストアップなどを解消できる。  
なお、モータにより湾曲部等の負荷側を駆動する場合、負荷を十分に駆動できるように減速機が使用される。【０００４】
しかしながら、上記特開２００７−１８５３５５号公報の従来例においては、湾曲部をモータにより湾曲動作させるときに、モータに連結された減速機内のギアの噛み合い（噛合）のガタつきや噛合位置に依存して、推定される外乱推定値としてのオブザーバ出力値が変動してしまう。  
また、従来例においては、算出結果をユーザに告知することが出来なかった。  
本発明は上述した点に鑑みてなされたもので、外乱オブザーバの手法等により推定される負荷を精度良く算出することができ、かつ告知することができるマニピュレータを提供することを目的とする。
【発明の開示】
【課題を解決するための手段】
【０００５】
本発明の一形態に係るマニピュレータは、駆動用指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結された減速機と、
前記モータの動作状態を検出する検出部と、
前記モータにより前記減速機を介して駆動される可動体を有する管体と、
前記減速機を構成するギアの噛合位置の情報に関連つけて周期的な補正情報を予め記憶する記憶部と、
前記モータヘ供給される前記駆動用指令信号と前記検出部の検出情報に対する演算処理を行い、更に前記補正情報を用いて前記モータに作用する負荷を推定値として算出する負荷算出部と、
前記負荷算出部の算出結果を告知する告知部と、
を有することを特徴とする。【０００６】
本発明の他の一形態に係るマニピュレータは、駆動用指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結された減速機と、
前記モータ及び前記減速機の動作状態を検出する検出部と、
前記モータにより前記減速機を介して駆動される可動体を有する管体と、
前記モータヘ供給される前記駆動用指令信号と前記検出部の検出情報に対する演算処理を行い、前記減速機に作用する負荷を推定値として算出する負荷算出部と、
前記負荷算出部の算出結果を告知する告知部と、
を有することを特徴とする。
【図面の簡単な説明】
【０００７】
【図１】図１は本発明の実施例１を備えた内視鏡システムの全体構成図。
【図２】図２は図１の内視鏡内に設けられたモータユニットの構成を示すブロック図。
【図３】図３はモータユニットにおけるモータ駆動系のシグナルフロー図。
【図４】図４は本実施例に用いられる外乱オブザーバによる負荷算出の原理を示すブロック線図。
【図５Ａ】図５Ａは本実施例に係るモータユニットに用いられている遊星ギヤの構成例を示す正面図。
【図５Ｂ】図５Ｂは本実施例に係るモータユニットに用いられている遊星ギヤの構成例を示す斜視図。
【図６】図６は図５を簡略化して示す図。
【図７】図７は図６における係合状態の例を示す説明図。
【図８】図８は模式モデルを示す図。
【図９】図９は実施例１における外乱オブザーバの手法を用いて外乱推定値を算出する構成を示すブロック図。
【図１０Ａ】図１０Ａはギアの噛合位置に対するオブザーバ出力値を示す説明図。
【図１０Ｂ】図１０Ｂは補正部のルックアップテーブルに予め格納されたギア位置とオブザーバ出力値との相関の情報を示す説明図。
【図１０Ｃ】図１０Ｃは図１０Ｂの情報を用いてオブザーバ出力値を補正した補正後の外乱トルク推定値を示す説明図。
【図１０Ｄ】図１０Ｄはオブザーバ補正出力値を算出する説明図。
【図１０Ｅ】図１０Ｅは図１０Ａの時系列データを簡易的に示す図。
【図１０Ｆ】図１０Ｆは実施例１の変形例における外乱オブザーバの手法を用いて外乱推定値を算出する構成を示すブロック図。
【図１１】図１１は本発明の実施例２のモータユニットの構成を示すブロック図。
【図１２】図１２は実施例２における外乱オブザーバの手法を用いて外乱推定値を算出する構成を示すブロック図。
【図１３Ａ】図１３Ａは実施例２の動作説明図。
【図１３Ｂ】図１３Ｂは外乱トルクに対するオブザーバ出力値がばらつく例を示す図。
【図１４】図１４は本発明の実施例３のモータユニットの構成を示すブロック図。
【図１５】図１５は実施例３における外乱オブザーバの手法を用いて外乱推定値を算出する構成を示すブロック図。
【図１６】図１６は静状態における噛合位置に対して観測されるオブザーバ出力値の特性例と、オブザーバ出力値の山と谷の値の平均値との関係を示す図。
【図１７】図１７は実施例３の動作説明図。
【図１８】図１８は実施例３の変形例における外乱オブザーバの手法を用いて外乱推定値を算出する構成を示すブロック図。
【図１９】図１９は変形例の動作説明図。
【図２０】本発明の実施例４におけるモータ駆動系の概略の構成を示すブロック線図。
【図２１】実施例４におけるギア外乱オブザーバを含むモータ駆動系の構成を示すブロック線図。
【図２２】実システムと仮想モデルとの関係を示すブロック線図。
【図２３】本発明の実施例５における状態推定オブザーバ等を含むモータ駆動系の構成を示すブロック線図。
【図２４】図２３における状態推定オブザーバ及びトルク推定オブザーバを含む仮想モデルシステム部分の構成を示すブロック線図。
【図２５】実施例５の変形例における状態推定オブザーバ等を含むモータ駆動系の構成を示すブロック線図。
【発明を実施するための最良の形態】
【０００８】
以下、図面を参照して本発明の実施例を説明する。  
図１に示すように本発明の実施例１を備えた内視鏡システム１は、被検体内に挿入される内視鏡２と、この内視鏡２が接続される制御装置３と、この制御装置３に接続され、湾曲の指令操作を行う操作司令部４と、制御装置３と接続され、内視鏡画像等の表示を行う内視鏡モニタ５とを有する。  
内視鏡２は、被検体内に挿入される細長で円管形状の挿入部６と、この挿入部６の後端に設けられた操作部７と、この操作部７から延出されたユニバーサルケーブル８とを有し、このユニバーサルケーブル８の端部のコネクタ９は、制御装置３のコネクタ受けに着脱自在に接続される。  
また、挿入部６は、その先端に設けられた先端部１１と、この先端部１１の後端に設けられた湾曲自在の湾曲部１２と、この湾曲部１２の後端から操作部７の前端に至る長尺で可撓性を有する可撓部１３とを有する。【０００９】
先端部１１には、照明光を出射する図示しない照明窓と、この照明窓に隣接して観察窓とが設けられており、観察窓には対物レンズ１４が取り付けられている。そして、この対物レンズ１４は、照明光で照明された被検体内の観察対象部位の光学像を結像する。  
この対物レンズ１４の結像位置には、例えば電荷結合素子（ＣＣＤと略記）１５が配置され、被検体内の観察対象部位を撮像する撮像部が形成されている。このＣＣＤ１５は信号線を介して、内視鏡２の外部の制御装置３内に設けられた映像信号生成部１６と接続される。  
映像信号生成部１６は、ＣＣＤ１５を駆動すると共に、ＣＣＤ１５により光電変換された撮像信号に対する信号処理を行い、映像信号を生成して、モニタケーブル１７を介して内視鏡モニタ５に出力する。内視鏡モニタ５は、ＣＣＤ１５の撮像面に結像された光学像に対応する内視鏡画像を内視鏡画像表示部５ａに表示する。【００１０】
上記湾曲部１２は、可動体としての複数の略円環形状の湾曲駒１８、１８，…、１８がその長手方向に回動（回転）自在に連結されて円管形状の管体が形成されている。なお、回動自在に連結する枢支部は、湾曲部１２の上下や、左右に対応する位置に設けられている。  
また、挿入部６内には、湾曲部１２の例えば上下の湾曲方向に対応する内壁に沿って、湾曲部１２の湾曲駒１８、１８，…、１８を湾曲させる駆動力を伝達する湾曲ワイヤ１９、１９が挿通されている。  
なお、図１等においては、簡単化のため例えば上下湾曲用の対となる湾曲ワイヤ１９，１９のみが示しているが、左右方向にも湾曲させる場合には、同様に対となる湾曲ワイヤ１９、１９が左右方向に沿って挿通される。対となる湾曲ワイヤ１９、１９の先端は最先端の湾曲駒１８或いは先端部１１に固着されている。【００１１】
また、対となる湾曲ワイヤ１９、１９の後端は、操作部７内に配置され、実施例１のマニピュレータを形成するモータユニット２１内のスプロケット２２に懸架されている。なお、このマニピュレータは、主にモータユニット２１、湾曲ワイヤ１９，１９及び湾曲部１２とより構成される。本実施例においては、図１に示すように表示モニタ５は、負荷値を表示する構成要素となるため、図１の内視鏡システム１がマニピュレータの１つの構成例と見なすこともできる。  
上記スプロケット２２を、モータユニット２１内のモータ２３（図２参照）により回転駆動することによって、スプロケット２２に懸架された対の湾曲ワイヤ１９、１９の一方を牽引し、他方を弛緩させる。そして、牽引された湾曲ワイヤ１９の方向に湾曲部１２の可動体としての湾曲駒１８、１８，…、１８は湾曲される。  
なお、スプロケット２２，モータ２３等も例えば上下方向に湾曲駆動するものを示しているが、左右方向にも湾曲させる場合には同様の構成のものを備える。【００１２】
また、後述するようにモータ２３による回転駆動力は、減速機を形成する遊星ギア減速機構４４を介してスプロケット２２に伝達される。このため、遊星ギア減速機構４４におけるギア間の噛合ガタ等の影響が発生するが、モータユニット２１は、その影響を低減して湾曲部１２を湾曲駆動制御する構成となる。  
このモータユニット２１は、モータ２３の負荷算出の演算処理を行う後述の負荷算出部７２の機能を備えた大規模集積回路部（ＬＳＩ部と略記）２４を備え、このＬＳＩ部２４はユニバーサルケーブル８内を挿通されるケーブルを介して制御装置３内の制御部２５に接続される。  
また、操作司令部４は操作司令部ケーブル（操作ケーブルと略記）２６を介して、この操作ケーブル２６の端部のコネクタ２７が制御装置３に着脱自在に接続される。【００１３】
操作司令部４には、湾曲方向及び湾曲量の操作指令をその傾動方向及び傾動角度（傾動量）で行う、例えばジョイスティック４ａが設けてある。このジョイスティック４ａの基端側は傾動自在に支持され、またジョイスティック４ａの傾動方向及び傾動角度を検出するポテンショメータ等のセンサ４ｂが設けられている。  
そして、このセンサ４ｂは検出値を操作司令部４による指令信号として操作ケーブル２６を介して制御部２５に伝達（出力）する。  
制御部２５は、操作司令部４からの指令信号を受けると、ユニバーサルケーブル８内のケーブルを介してモータユニット２１内のＬＳＩ部２４に指令信号を伝達（出力）する。  
そして、このＬＳＩ部２４は、指令信号によりモータ２３を回転駆動する駆動指令信号としての指令値をモータ２３に供給し、このモータ２３を回転駆動した際の電流値や位置情報等を検出部（後述するエンコーダ４１等）により取り込み、指令値に一致するようにフィードバック制御を行う。【００１４】
この場合、湾曲部１２が湾曲ワイヤ１９，１９を介してモータ２３によって、湾曲駆動される場合、湾曲ワイヤ１９，１９を牽引する際の負荷となる張力（テンション）量を歪みセンサ等のセンサにより検出することができる。しかし、そのようなセンサを設けると挿入部が太くなってしまうため、本実施例においてはセンサを設けないで、以下に説明するように外乱オブザーバの手法を用いてソフトウェア的な外乱推定算出手段を用いて負荷或いは負荷値を算出する。  
また、算出された負荷値は、制御部２５に出力され、この制御部２５は入力された負荷値を映像信号生成部１６に出力する。映像信号生成部１６は、入力された負荷値の情報を例えば映像信号に重畳して内視鏡モニタ５に出力し、内視鏡モニタ５における負荷値表示部５ｂには算出された負荷値が表示される。つまり負荷値を視覚的に告知する告知部が形成されている。【００１５】
なお、算出された負荷値を告知する告知部は、表示による告知の場合に限らず、制御部２５から操作司令部４に算出された負荷値に相当する力覚感覚の提示を行うようにしても良い。例えば、ジョイスティック４ａの回転軸にモータを設け、算出された負荷値に応じた反作用力量でモータを駆動しても良いし、操作司令部４に振動モータ等を配置してこの振動モータを負荷値に応じて振動させる等で告知を行うようにしても良い。また、算出された負荷値は、直接的にはモータ２３のモータ軸に働くトルク値として算出されるが、湾曲部１２の湾曲駆動等に適した量に適宜スケール変換して告知するようにしても良い。  図２はモータユニット２１の詳細な構成を示す。  
このモータユニット２１は、ユニバーサルケーブル８内を挿通された図示しないケーブルの端部が接続される電源コネクタ３１ａ、湾曲制御部コネクタ３１ｂ、及び撮像部コネクタ３１ｃが設けられている。  
制御装置３から電源を供給するケーブルと接続された電源コネクタ３１ａは、ＬＳＩ部２４内の制御電源回路３２と駆動電源回路３３とにそれぞれ駆動電源を供給する。【００１６】
制御電源回路３２は、制御電源を生成し、生成された制御電源をＬＳＩ部２４内の通信系ブロック３４と、ＤＣ／ＤＣコンバータ３５を介してのＦＰＧＡ(Field Programmable Gate Array)ブロック３６等に供給する。  
また、この制御電源は、フィードバック信号入力部（図２ではＦ／Ｂ信号と略記）３７，アナログインプット信号入力部（図２ではＡＩ信号と略記）３８，デジタルインプット信号入力部（図２ではＤＩ信号と略記）３９に供給されると共に、ＬＳＩ部２４の外部のエンコーダ４１及びポテンショメータ４２にも供給される。  
なお、ＤＣ／ＤＣコンバータ３５は、直流のＤＣ電源から高圧のＤＣを生成し、高圧のＤＣ電源を必要とし、プログラムすることが可能なＬＳＩとしてのＦＰＧＡブロック３６に供給する。【００１７】
また、駆動電源回路３３は、駆動電源を生成して、この駆動電源を（モータ２３を駆動指令信号としての指令値により回転する）モータドライバ４３に供給する。  
また、湾曲制御部コネクタ３１ｂに接続される通信系ブロック３４は、図１の制御部２５とＦＰＧＡブロック３６間での双方向の通信を行うインタフェースを形成している。例えば操作司令部４で生成された指令信号は、制御部２５から通信系ブロック３４を介してＦＰＧＡブロック３６に伝達され、ＦＰＧＡブロック３６はこの指令信号からモータドライバ４３を介してモータ２３に指令値を供給する。  
また、ＦＰＧＡブロック３６により算出された負荷値は、通信系ブロック３４を介して制御部２５に伝達される。そして、上述したように負荷値が表示により告知される。  
また、撮像部コネクタ３１ｃは、信号線を介してＣＣＤ１５と接続されている。なお、この撮像部コネクタ３１ｃは、モータユニット２１と別体に形成しても良い。【００１８】
上記モータドライバ４３により回転駆動されるモータ２３は、遊星ギア減速機構４４を介してスプロケット２２とメカニカルに係合している。  
この遊星ギア減速機構４４においては、モータ２３のモータ軸（回転軸）には駆動ギア４５が直接的に連結され、この駆動ギア４５はクラッチ４６を介してスプロケット２２の回転軸に連結されたギア４７と噛合している。そして、このクラッチ４６のＯＮ／ＯＦＦを行うスイッチ４８により噛合離脱（遮断）と、噛合状態（噛合連結状態）となる。  
このスイッチ４８のＯＮ／ＯＦＦ信号は、デジタルインプット信号としてデジタルインプット信号入力部３９を経てＦＰＧＡブロック３６に入力される。  
また、ギア４７の回転軸に連結されたポテンショメータ４２は、このギア４７の回転位置を検出し、その位置情報はアナログインプット信号としてアナログインプット信号入力部３８を経てＦＰＧＡブロック３６に入力される。つまり、ポテンショメータ４２は、減速機を構成するギア４７の位置（情報）検出部を形成する。【００１９】
また、モータ２３の回転位置（回動位置）は、そのモータ軸（つまり、回転軸）に連結されたエンコーダ４１により検出される。そして、このエンコーダ４１により検出された位置情報は、フィードバック信号としてフィードバック信号入力部３７を経てＦＰＧＡブロック３６に入力される。なお、エンコーダ４１は、モータ軸に連結された駆動ギア４５の回転位置の検出部を形成する。【００２０】
また、モータ２３に流れる電流値は、アナログインプット信号としてアナログインプット信号入力部３８を経てＦＰＧＡブロック３６に入力される。【００２１】
上記エンコーダ４１とモータ２３に流れる電流値の検出手段は、モータ２３の動作状態としてのモータ２３の回転位置、回転速度等を検出する検出部を形成する。  
ＦＰＧＡブロック３６は、ユーザの操作指令による指令信号に基づき、モータドライバ４３を介してモータ２３を回転駆動させ、可動体を有する管体としての湾曲部１２の湾曲制御するマニピュレータを形成する。【００２２】
この場合、ＦＰＧＡブロック３６は、モータ２３への負荷値を外乱オブザーバの手法を用いて外乱推定値（推定値）として推定（算出）する推定部３６ａと、その負荷値の算出を精度良く行うため、減速機を構成するギアの噛合位置に依存する周期的な補正情報を予め記憶（格納）する記憶部３６ｂとを備えている。より具体的には図９（のＬＵＴ７３）を参照して後述する。
図３はこのＦＰＧＡブロック３６によるモータ駆動系のシグナルフロー図を示す。図３に示すように操作司令部４からの指令信号に基づく指令値は、モータ２３の位置情報検出手段からの位置情報が減算された差分値がＦＰＧＡブロック３６の位置制御ブロック５１に入力される。  
位置制御ブロック５１は、差分値から生成した位置指令を、速度制御ブロック５２に出力する。この速度制御ブロック５２には、位置情報を微分要素で微分生成した速度情報も入力される。この速度制御ブロック５２は、位置指令と速度情報から生成した速度指令を電流制御ブロック５４に出力する。【００２３】
この電流制御ブロック５４には、モータ２３に流れる電流値も入力される。そして、この電流制御ブロック５４は、速度指令及び電流値から生成した電流指令をモータ２３に駆動電力として供給する。  
モータ２３は、電流指令に応じて目標位置に向けて回転駆動し、その際の位置情報等がモータ駆動制御系にフィードバックされる。  
この場合、モータ２３は、実際には遊星ギア減速機構４４を経て湾曲部１２を湾曲するように負荷が連結されており、本実施例においてはこの負荷を外乱負荷としてその推定値（負荷値）を算出する外乱オブザーバの手法を採用する。  
この場合、通常の湾曲駆動制御状態の他に、湾曲部の先端部１１が体壁等にあたり、通常の負荷の状態から逸脱する場合もあり得る。【００２４】
本実施例は、外乱オブザーバの手法により算出する負荷値の推定精度を向上することにより、通常の湾曲駆動制御状態の場合の他に、通常の湾曲駆動制御状態から逸脱した状態を判定する判定機能を備えた構成にしている。【００２５】
本実施例においては、モータ２３に対する外部の負荷を外乱負荷と見なして、その値を算出し、その算出結果に応じて、挿入部６の挿入状態に対応した適切な湾曲駆動制御を行う湾曲駆動制御のマニピュレータを形成する。これにより、センサを用いる事無く適切な湾曲駆動制御を行えるようにしている。  
図４は、上記外乱オブザーバにより負荷値を推定する原理説明のブロック線図を示す。図４における点線で示すモータモデルブロックＡに対して、モータドライバ４３からの電流指令により、その電流値に比例したトルクの指令値ｕがモータ２３（の電機子）に印加される。  
そして、モータ軸にはトルクの指令値ｕに応じたトルクが作用する。この場合、ラプラス演算子ｓを用いた場合には、このモータトルク定数Ｋｔとすると、ｕ・Ｋｔのトルクがモータ軸に作用する。【００２６】
そして、このモータ２３は、モータ軸にかかるそのトルクに対してモータ慣性モーメントＪに応じた回転数(回転Speed)で駆動される。ラプラス演算子ｓを用いた場合には１／（Ｊ・ｓ）で演算（つまり積分演算）した回転数となり、さらにその積分演算（１／ｓ）によりモータ位置が算出される。  
実際のモータ２３の場合、遊星ギア減速機構４４を介して、モータ軸には負荷がかかるので、それを反映するようにモータ軸に外乱負荷ｄのトルクが作用する。  
そして、このモータモデルブロックＡに対して２点鎖線５６で示すように、そのモータ２３の構成要素を、ソフトウェア的に或いは演算処理手段によって近似（又は模擬）する物理モデルブロック（或いは演算処理ブロック）を並列に配置する。【００２７】
但し、この物理モデルブロック５６は、外乱負荷ｄを算出するような演算要素で構成される。つまり、モータモデルブロックＡにおいては加算点に外乱負荷ｄが入力されるが、物理モデルブロック５６においては、減算ブロック５９が外乱負荷ｄを推定して出力するような演算ブロックとする。そのため、トルクの指令値ｕを、この物理モデルブロック５６内の（モータトルク定数Ｋｔを近似した）設計モータトルク定数Ｋｔｎの第１演算ブロック５７に入力する。  
また、モータ２３の回転数(回転Speed)の情報からモータ軸にかかるトルクを逆演算する第２演算ブロック５８（ラプラス演算子ｓを用いた場合にはＪｎ・ｓの演算）の出力情報から第１演算ブロック５７の演算出力を減算ブロック５９で減算してモータ軸にかかる外乱負荷ｄの値を推定した外乱推定値ｄａとして算出する。なお、Ｊｎは、モータ２３のモータ慣性モーメントＪを近似した設計モータ慣性モーメントを表す。  
図４の外乱オブザーバの手法を用いてオブザーバ出力値として外乱推定値ｄａを算出すると、その外乱推定値ｄａは、モータ軸に遊星ギア減速機構４４が連結されているため、その影響を受ける。【００２８】
図５Ａはこの遊星ギア減速機構４４を形成する１つの遊星ギア４４ａの正面からの透視図を示し、図５Ｂはその斜視図を示す。  
遊星ギア４４ａは、外側が固定され、内周面にギアが形成されているので内歯ギア（外輪ギアともいう）６１と、この内歯ギア６１の中心に配置される太陽ギア６２と、この太陽ギア６２を中心として自転しつつ、公転する３つの遊星ギア６３、６３，６３と、これら遊星ギア６３、６３，６３をそれぞれ回転自在に保持するアーム６４とを備える。  
図５Ｂに示しように太陽ギア６２に固着された入力側の回転軸６５ａによる回転を、遊星ギア６３、６３，６３を保持したアーム６４の中心に取り付けられた出力側の回転軸６５ｂに減速して、そのトルクを同軸的に伝達する。【００２９】
本実施例においては、この遊星ギア４４ａを主体としたものを複数個連結して、湾曲部１２を十分に湾曲駆動することが可能なトルクを発生する遊星ギア減速機構４４を形成している。  
この遊星ギア減速機構４４を簡略化して近似すると、図６のように互いに逆方向に回転する２つのギア６６ａ、６６ｂで表すことができる。  
なお、この２つのギア６６ａ、６６ｂは、図２の駆動ギア４５とギア４７を簡易的な機構モデルとして示したものである。  
この場合、２つのギア６６ａ、６６ｂの噛合状態として、図７に示すように例えば３つの状態が発生する。  
具体的には、図７の左側に示すギア６６ａにおける噛合に関与するギア片の（ある回転方向に関する）後縁に、他方のギア６６ｂにおける噛合に関与するギア片の前縁が接触した第１の状態と、図７の中央に示すように両ギア片の噛合状態が外れた第２の状態と、図７の右側に示すように両ギア６６ａ，６６ｂにおけるぞれぞれ２つのギア片同士が互いに接触した第３の状態が発生する。【００３０】
換言すると、両ギア６６ａ、６６ｂは、完全に両者が噛合した理想的な状態ではなく、噛合が外れたガタ付きのある状態が発生する。完全に噛合した状態では、両ギア６６ａ、６６ｂにおける一方の状態が決まると、他方のギアの状態が一意に決定される。しかし、本実施例のような遊星ギア減速機構４４の場合には、図７でその概略を示したようなガタ付きを持った駆動力伝達機構となってしまう。  
そして、図６にように簡略化したギア６６ａ、６６ｂをダイナミカルアナロジー的に模式化すると、図８のようなモデルで近似することができる。  
図８に示すようにモータ２３のモータ軸に連結された慣性モーメントがＪｐのギア６６ｃが、摩擦パッド６７とバネ・ダンパ６８を介して慣性モーメントがＪｑのギア６６ｄと連結したモデルで近似する。【００３１】
後述するように、遊星ギア減速機構４４の場合には、ギア間のがたつきが存在しても、遊星ギア減速機構４４を回転させた場合には、遊星ギア減速機構４４を構成するギアはそれぞれ所定のギア数で形成されているため、周期的な特性を示す。  
また、実際には、図２の駆動ギア４５とギア４７との噛合位置によって、観測されるオブザーバ出力値が変化する（図１０Ａに、噛合位置に対する負荷値毎（異なる負荷値）の場合のオブザーバ出力値の例を示す）。  
そして、本実施例は、図４に示した外乱オブザーバの手法を用い、図９に示すように減速機としての遊星ギア減速機構４４におけるギア間のがたつきとギアの噛合位置に起因する外乱推定値（推定値）の精度低下を低減、つまり精度の高い外乱推定値を算出可能とする補正部７１を設けている。図９は、本実施例における外乱オブザーバの手法を用いて外乱推定値としての負荷を算出する負荷算出部７２の構成を示す。【００３２】
図９に示すように本実施例においては、図４に示す構成において、外乱推定値ｄａをさらに補正部７１に入力し、補正部７１により補正する機能を備えた負荷算出部７２を形成している。  
図４に示す構成は、特開２００７−１８５３５５号公報の従来例により開示されている。この従来例の場合には減速機を構成するギア間のがたつきとギア間の噛合位置により精度の低い外乱推定値ｄａとなってしまっていた。これに対して、本実施例は、減速機を構成するギア間のがたつきに対する補正を行うと共に、ギア間の噛合位置に対する特性を反映する補正情報を用いて補正を行う補正部７１を備えている。  
この補正部７１は、減算ブロック５９から出力される補正前のオブザーバ出力値、つまり外乱推定値ｄａを入力として、周期的な補正情報、ここでは例えば正弦波状のデータ値を、補正された外乱推定値ｄｂとして出力するルックアップテーブル（ＬＵＴと略記）７３と、駆動ギア４５とギア４７間の噛合位置の位置情報に相当する位置データＰｄを発生してＬＵＴ７３に出力する位置データ発生部７４とを有する。【００３３】
位置データ発生部７４は、図２の（モータ２３の回転位置情報から、このモータ軸に連結された）駆動ギア４５の位置を検出するエンコーダ４１の出力値と、ギア４７の位置情報を検出するポテンショメータ４２の出力値とが入力されることにより、両ギア４５，４７間の噛合位置の位置データＰｄを発生する。  
また、ＬＵＴ７３には、図１０Ａに示す周期的に乱高下するオブザーバ出力値と、減速機を構成するギア間の噛合位置との関係の相関量を予め調べ、その結果、その高い相関量を良好に近似することができる周期的な補正情報のデータ値が、噛合位置の位置データＰｄと関連付けて格納されている。【００３４】
従って、ＬＵＴ７３は、両データｄａ、Ｐｄの入力により、減速機を構成するギア間のがたつきの影響を低減すると共に、駆動ギア４５とギア４７間の噛合位置に依存した略周期的な特性を反映してバラツキが低減された（つまり精度の高い）補正された外乱推定値ｄｂを出力する。  
このような構成による本実施例は次のような作用を有する。図４に示した外乱オブザーバの手法により算出されるオブザーバ出力値（外乱推定値ｄａ）は、図１０Ａのように、ギア間のがたつきとギア間の噛合位置とにより、周期的な特性を示すが、乱高下する。  
なお、図１０Ａは、異なる噛合位置に相当する場合の複数の出力値の特性例を示している。【００３５】
これに対して、本実施例は、図９で示したように補正部７１において、ギア間の噛合位置を検出して、その検出された噛合位置に依存して変化する特性を近似的に反映する（予めＬＵＴ７３に格納された）周期的な出力データを読み出す。【００３６】
LUT７３には図１０Ｂで示した様に、予めギア位置とオブザーバ出力値ｄａとの相関を記憶しておく。具体的には、図１０Ｃの通りギア噛合回転量（噛合位置）とオブザーバ出力値ｄａの関係をｃｏｓ関数のルックアップテーブルとして割り当てる。これは、オブザーバ出力値ｄａの時系列データをcos関数で置き換えたとすると、位置の情報がわかれば時系列データにおいてオブザーバ出力値ｄａがどの部分を示しているかが抽出できるためである。【００３７】
例えば、図１０Ｄ中のA点の部分のオブザーバ出力値ｄａを検知したとする。Ａのオブザーバ出力値ｄａはトルク真値を基準値とすると、振幅α／２にｃｏｓ（pos）を乗じた値として出力される。実際には、オフセット量βが存在するので、その分を加える事でトルク真値、すなわち補正されたオブザーバ出力値としての外乱推定値ｄｂの抽出が実現できる。【００３８】
したがって、Ａで出力されたオブザーバ出力値ｄａを下記の数式でオブザーバ補正出力値を算出することでトルクの真値トルクとなる外乱推定値ｄｂが抽出される。【００３９】
オブザーバ補正出力値  ＝１／（α・cos（posA）／２） x オブザーバ出力値 ＋  β
この算出式を用いて予めLUT７３にオブザーバ出力値に対するオブザーバ補正出力値を設定しておくことでトルク真値となる外乱推定値ｄｂを抽出できる。【００４０】
なお、図９においては、オブザーバ出力値ｄａをＬＵＴ７３に入力する構成にしているが、オブザーバ出力値ｄａをＬＵＴ７３に入力しないで、ブザーバ出力値ｄａをＬＵＴ７３の補正情報で減算または加算して外乱推定値ｄｂを生成する構成にしても良い。【００４１】
ところで、図１０Aの様に、実際には外乱トルクとしては一定のトルクのみならず様々なトルク量が印加される。図１０Ａの時系列データを簡易的に示したのが図１０Ｅである。図１０Ｅに示す通り印加されるトルク値に応じて、オブザーバ出力値の波高値およびオフセット値が異なる傾向がある。概して、印加されるトルクが大きくなればギア回転量−オブザーバ出力値daの時系列データは振幅が大きくなり、かつ、オフセット量が大きくなる。このため、振幅をα（ｏｂｓ）、オフセット量をβ（ｏｂｓ）とオブザーバ出力の関数としたオブザーバ補正値を下記の関数で導出された値をLUT７３に設定しておくことで任意の外乱量の検知も可能となる。【００４２】
オブザーバ補正出力値  ＝１／（α(obs)・cos（posA）／２） x オブザーバ出力値 ＋  β（obs）
以上の様に、ギアの噛合位置の情報を用いてオブザーバ出力値daを補正することにより、噛合位置に依存した周期的な特性を反映して、実際に精度良く近似する外乱推定値ｄｂをオブザーバ出力値として算出することができる。  
また、本実施例では余弦による三角関数を用いたが、正弦による三角関数を採用しても良い。【００４３】
このように本実施例によれば、湾曲駆動制御の際のテンション状態を比較的精度よく算出できるので、挿入部６内にセンサを設けることを必要としない。このため、細径の挿入部６の内視鏡２を実現でき、体腔内への挿入部６の挿入等による内視鏡検査の作業が容易となる。このため、挿入などの操作性を向上した電動湾曲制御装置や電動湾曲内視鏡装置を実現できるマニピュレータを提供できる。  
また、負荷算出部により算出した負荷の推定値の算出結果を術者等の使用者に告知することができる。また、判定部７５の判定結果Ｃにより、通常の湾曲駆動制御状態か否かの可能性を確認することができ、術者による内視鏡検査を行う際の操作性を向上できる。【００４４】
また、内視鏡画像を表示する表示手段としての内視鏡モニタ５上に負荷の推定値の算出結果を表示するようにしているので、術者は内視鏡画像を観察する状態で負荷の算出結果を確認することができる。【００４５】
（実施例１の変形例）
また、図９に示す実施例１の変形例として、図１０Ｆの通りの構成とすることで、負荷の判定を行うことも可能となる。【００４６】
図１０Ｆは、図９の実施例１の構成において負荷判定部７５を設けている。図１０Ｆの変形例は、補正部７１から出力される外乱推定値ｄｂが、通常の湾曲駆動制御状態（通常状態と略記）にあるか、先端部１１が体壁に接触して湾曲が規制された規制状態であるか否かの判定を行う判定部７５を備えている。換言すると、この判定部７５は、負荷の推定値が操作司令部４に基づく指令値（駆動指令信号）に対応した通常状態（の範囲内）であるか、この通常状態から逸脱した外力が作用している外力作用状態（規制状態）であるかの判定を行う。【００４７】
この判定部７５は、補正部７１からの外乱推定部ｄｂが入力されるウインドウ型比較器７６と、例えば指令値ｕのデータが入力されることにより対応する通常状態での基準の外乱推定値ｄｎｏｒを比較器７６に出力する第２のＬＵＴ７７とを備えている。ウインドウ型比較器７６は、２つの比較するデータ（ここでは、外乱オブザーバ出力ｄｂ及び基準の外乱推定値ｄｎｏｒ）を時系列データとして比較するため、２つのデータが全て一致するするかどうかで判断せず、２つのデータ系列に相関があるかないかを判断するための相関フィルタとなっている。【００４８】
第２のＬＵＴ７７には、例えば指令値ｕのデータに関連付けて対応する通常状態での基準の外乱推定値ｄｎｏｒの情報が予め格納されている。なお、指令値ｕのデータ以外のデータと基準の外乱推定値ｄｎｏｒの情報とを関連付けて格納するようにしても良い。  
そして、判定部７５を構成する比較器７６は、補正部７１により算出された外乱推定値ｄｂが通常状態で推定される基準の外乱推定値ｄｎｏｒから許容される値以上、逸脱している場合には、その判定結果Ｃの情報を通信系ブロック３４を介して制御部２５に出力する。  
制御部２５は、この判定結果Ｃを受けて、例えば負荷値表示部５ｂに、判定結果Ｃの情報も表示するように判定結果情報を映像信号生成部１６に出力する。そして、判定結果情報をユーザに例えば表示により告知する。【００４９】
例えば、補正部７１により算出された外乱推定値ｄｂが通常状態で推定される基準の外乱推定値ｄｎｏｒから許容される値以上に大きいと判定した判定結果Ｃの場合には、負荷値表示部５ｂにおいて、（湾曲部１２或いは先端部１１が体壁等に接触して）湾曲が規制された状態の可能性ありの表示又は告知を行う。  
この結果、力覚提示への情報提供の手段として構成することもできる。併せて、外乱オブザーバ出力ｄｂをそのまま力覚提示手段に情報を出し、内視鏡にかかる負荷を提示させることも可能である。【００５０】
（実施例２）
次に図１１から図１３Ｂを参照して本発明の実施例２を説明する。図１１は本発明の実施例２におけるモータユニットの構成を示し、図１２は外乱オブザーバの手法を用いて外乱推定値を算出する負荷算出部の構成を示し、図１３Ａは本実施例による動作説明図を示し、図１３Ｂは実際に負荷トルクに対するオブザーバ出力の関係の図を示す。【００５１】
図１３Ｂに示す通り、印加する外乱トルクに対して外乱オブザーバ出力にばらつきがあり、しかも、段階的な波形となっている。これは静摩擦の影響が支配的であるためである。【００５２】
このため、本実施例は、実施例１において、減速機を構成するギア間の静摩擦による影響を低減する。【００５３】
図１１に示すように本実施例におけるモータユニット２１Ｂは、図２のモータユニット２１において、例えばＦＰＧＡブロック３６は、静摩擦を解消する振幅の振動信号としてのディザー信号を発生するディザー信号発生部３６ｃを有する。  
そして、ＦＰＧＡブロック３６は、このディザー信号をモータドライバ４３に出力する。このため、ＦＰＧＡブロック３６からモータドライバ４３に、指令値ｕを出力させる指示信号が出力される時には、このディザー信号が重畳された状態で出力される。つまり、モータ２３には、モータドライバ４３を介して指令値ｕが印加される場合には、既にディザー信号が（振動信号成分として）重畳して印加される状態となるようにしている。【００５４】
なお、このディザー信号を、常時、モータドライバ４３に印加するようにしても良い。或いは、駆動ギア４５とギア４７とが連結された状態の湾曲部１２が湾曲可能となる期間に限定しても良い（具体的にはクラッチ４６のＯＦＦ／ＯＮに相当するスイッチ４８のＯＮ／ＯＦＦ信号によりディザー信号の印加のＯＮ／ＯＦＦを連動させても良い）。  
その他の構成は、実施例１の場合と同様である。図１２は、本実施例に係る負荷算出部７２の構成を示す。この負荷算出部７２の部分は、実施例１における図９と同じ構成である。  
但し、モータ２３に印加される指令値ｕは、この図１２に示すようにディザー信号Ｓｄが重畳されて印加される構成となっている。  
次に本実施例の動作を説明する。【００５５】
モータ２３により減速機としての遊星ギア減速機構４４を介して湾曲部１２の湾曲駆動制御を行う場合、遊星ギア減速機構４４を構成するギア間が静状態の場合と動状態の場合とで、駆動した時の摩擦係数の値が異なる。  
このため、算出される外乱推定値としてのオブザーバ出力値が、実際に駆動した時のギアが静摩擦状態か動摩擦状態か否かの影響を受けてその精度が低下する。実際に観測されるオブザーバ出力値の精度が低下する概略の特性例を図１３の２点鎖線で示す。  
静摩擦による影響により、例えば指示値としてのギア出力軸トルクに対し、その場合に実際に観測されるオブザーバ出力は１対１とならず、幅を持った或いは不連続な関係の特性になってしまう。このため、オブザーバ出力値を推定する場合にも、その精度が低下する。【００５６】
これに対して、本実施例においては、少なくとも湾曲部１２を駆動する場合には、動摩擦状態を維持する（換言すると静摩擦状態を解消する）ように振動信号としてのディザー信号Ｓｄをモータ２３に印加する構成にしている。  
このため、例えば術者がクラッチ４６を連結状態にして湾曲を行うことが可能な状態においては、駆動ギア４５とギア４７とには、例えば小さな振幅の振動的なトルクが印加されて、動摩擦状態が維持される。  
従って、図１３Ａの実線で示す概略の特性図のように、静摩擦による影響が解消され、動摩擦状態のみとの場合の（理想的には）１対１に対応した特性に改善できる。そして、実際に湾曲部１２を駆動する場合には、少なくとも動摩擦状態に維持できるので、静摩擦による影響を解消した精度の高い外乱推定値ｄｂを取得できる。  
このように本実施例によれば、少なくとも湾曲駆動する場合には、減速機を構成するギア間を動摩擦状態で駆動するようにしているので、静摩擦の影響を受けることを解消でき、実施例１の効果の他に、より精度の高い負荷値の算出が可能となる。その他、実施例１と同様の効果を有する。【００５７】
（実施例３）
次に図１４から図１７を参照して本発明の実施例３を説明する。図１４は、実施例３に係るモータユニットの構成を示し、図１５は実施例における負荷算出部の構成を示し、図１６は静状態における噛合位置に対して観測されるオブザーバ出力値の特性例と、オブザーバ出力値の山と谷の値の平均値との関係を示し、図１７は実施例３の動作説明図を示す。  
図１４に示すように本実施例に係るモータユニット２１Ｃは、実施例１において、実施例２のように振動信号の発生手段としてのディザー信号発生部３６ｃを有する。本実施例においては、以下に説明するように振幅が調整されたディザー信号Ｓｄとして出力するようにＦＰＧＡブロック３６は、その調整部（或いは設定部）３６ｄを備えている。また、本実施例は、モータ２３に指令値ｕを印加しない駆動停止或いは静状態の期間において、外乱推定値を精度良く算出するものである。  
図１５は、本実施例における負荷算出部７２Ｃの構成を示す。  
また、本実施例においては、実施例１で説明した補正部７１の出力から、その移動平均を算出する移動平均フィルタ８１を設け、この移動平均フィルタ８１から出力される平均推定値を外乱推定値ｄｃとする負荷算出部７２Ｃを形成している。【００５８】
なお、本実施例は、図１５の点線で示すように、減算ブロック５９の出力を、補正部７１を通さないで移動平均フィルタ８１に入力する構成の場合にも適用することができる。その他は、実施例１と同様の構成である。次に本実施例の動作を説明する。  
上述した図１０（Ａ）において、外乱オブザーバによる負荷値を算出する場合には、観測されるオブザーバ出力値は、ギアのがたつきや噛合位置のために、周期性を有するが、その値が乱高下することを説明した。  
これに対して、その静状態でトルク加重した際の観測されるオブザーバ出力値の山と谷の平均を行うと、その値は図１６に示すようにその乱高下する場合における実際の時間的な平均値と概ね比例関係となる。【００５９】
従って、本実施例においては、指令が出されていない（つまりモータ２３が駆動されていない）静状態において、ディザー信号Ｓｄ′を、図１７に示すようにオブザーバ出力値がその山と谷間を行ったり来たりするように印加（但し、負荷側を動かさない程度の振幅に維持して静状態を維持）して、その場合の時間的な平均値を算出して外乱推定値を算出する。  
図１５中に示すディザー信号Ｓｄ′は、ドットで示す山と谷を往復させる如くにモータ２３に（指令値ｕが出力されていない期間）印加されることを示している。  
このように、指令値ｕが出されていない停止した状態において、ディザー信号Ｓｄ′を、負荷（内視鏡駆動部）が動かさない程度で、その振幅を変化させるようにモータ２３に印加し、その時のオブザーバ出力値に対して移動平均フィルタ８１によりその出力値の時間平均化を行う。【００６０】
図１７は移動平均フィルタ８１の処理内容とその動作説明図を示す。【００６１】
図１７の左側に示すように、モータ２３にはディザー信号Ｓｄ′が、オブザーバ出力値の山と谷を往復させる周期で印加される。その場合に、補正部７１から出力される外乱推定値（オブザーバ出力値）は、図１７の右側に示す移動平均フィルタ８１に入力される。この移動平均フィルタ８１は、吹き出しの枠内に示すように（補正部７１から出力される）外乱推定値ｄｂを入力信号として、所定のサンプル期間ずつずらして、複数ｎ個サンプリングした各値を加算器Σにより加算（積算）し、その加算した値をサンプル数となる複数ｎで除算して平均推定値を移動平均フィルタ８１の出力値を外乱推定値ｄｃとして出力する。  
なお、図１７中における１／ｚは、入力信号を１サンプル時間、遅らせる記号を示す。そして、複数ｎ個のサンプル期間による平均推定値を１サンプル期間毎に時間的に移動して出力する。【００６２】
この場合、１サンプル期間の間隔と、複数ｎとの積が山と谷の周期に略一致するように設定されている。  
このようにすることにより、指令値ｕが出力されていない静状態においても、その場合の負荷値を精度良く算出することができる。  
なお、オブザーバ出力値の周期で平均値を算出する場合に限定されるものでなく、適宜の時間で平均化しても良い。  
また、実施例２と実施例３とを組み合わせるような構成にしても良い。例えば、指令値ｕが出力されていない静状態においては、実施例３のように湾曲部９を湾曲駆動制御し、指令値ｕが出力される期間においては実施例２のように湾曲駆動制御を切り替えるようにしても良い。  
次に本実施例の変形例を説明する。図１８は変形例における負荷算出部７２Ｄのブロック図を示す。【００６３】
本変形例は、図１５の構成において、移動平均フィルタ８１における途中のデータ（例えば加算器）から山と谷の周期におけるその周期における位相位置の推定を行う位置推定回路８５と、この位置推定回路８５の出力によりディザー信号の振幅を制御する振幅制御回路８６とを設けている。  
そして、この振幅制御回路８６からの振幅指令信号を振幅可変ディザー信号発生回路８７に印加し、山と谷の極値付近におけるディザー信号の振幅を（極値以外の期間よりも）小さく様に制御する。  
本変形例においては、このように、振幅可変ディザー信号発生回路８７は、振幅指令信号により、そのディザー信号の振幅が可変制御される。【００６４】
なお、負荷算出部７２Ｃ内に振幅可変ディザー信号発生回路８７を設けるようにしても良い。その他の構成は、実施例３と同様である。  
図１９は本変形例による振幅制御回路８６からの振幅指令信号の例を示す。図１９に示すように振幅指令信号は、（位置推定回路８５による推定された位置信号により）オブザーバ出力値が極値となる位相位置付近でその振幅が最小となり、それらの間では最大に近い振幅となる略パルス状の波形となっている。したがって、例えば、略パルス波形を検出しながら、略パルス波形の任意の半サイクル分を駆動する様に設定する事で必要最低限のディザー信号振幅を印加する事ができる。【００６５】
このような振幅指令信号により、ディザー信号の振幅を可変制御することにより、極値付近での駆動を抑制する。【００６６】
また、２つの極値を経過した１周期後には、駆動方向を反対方向に変更するため、このように極値付近での駆動を最小値に抑制すると、駆動方向の変更を円滑に行うことが可能になると共に、ギアを駆動した場合に発生する音を低減することもできる。その他、実施例１と同様の効果を有する。  
（実施例４）
次に図２０及び図２１を参照して本発明の実施例４を説明する。図２０は本発明の実施例４におけるモータ駆動系の概略の構成を示し、図２１は、ギア外乱オブザーバを含むモータ駆動系の構成を示す。  
上述したようにモータ２３には減速機としての例えば遊星ギア減速機構４４が連結して使用される。このような遊星ギア減速機構４４を構成する複数のギア間には摩擦、ロストモーション量（不感帯）等が伴う。そして、上述した実施例においては、摩擦等の影響が入ったモータモデルブロックＡ（例えば図４参照）を採用し、そのモータモデルブロックＡに対応するソフトウェアによる（モータ）物理モデルブロック５６を用い、さらにギアによる噛合位置に関連する周期的な補正情報で、補正する等して外乱推定値を算出する構成にしていた。【００６７】
外乱負荷ｄとしての内視鏡側からの反作用はギアを介してモータ側に印加されるが、上述した実施例においてはその反作用をモータ側で計測していたので、その補正を行う等してギアによる影響を低減していた。【００６８】
これに対して、本実施例は、モータと共に減速機、又はこの減速機を構成するギア部のモデルを用いると共に、外乱負荷ｄがギア部に印加されるように、その実体をより忠実に反映したモデルを用いる。そして、上述した実施例におけるギアの噛合位置に関連する周期的な補正情報を用いることなく、精度の高い外乱推定値を算出することができる構成にする。【００６９】
このため、本実施例は、モータモデルブロックと、これに連結された遊星ギア減速機構４４等のギア部を摩擦、ロストモーション量（不感帯）等の影響を含むようにモデル化したギアモデルブロックを形成すると共に、外乱負荷ｄもギアモデルブロック側に印加されるように（実体をより忠実に反映する構成に）する。【００７０】
そして、ギアモデルブロックに対応するギア物理モデル（具体的には負荷算出部としてのギア外乱オブザーバ）を形成して、このギア物理モデルにより、摩擦等の影響を低減して外乱負荷ｄを精度良く、推定する構成にしている。【００７１】
本実施例に係る内視鏡システムの構成及びモータユニットは、基本的には図１及び図２の構成と同じである。但し、図２におけるモータユニット駆動系の構成を図２０にその概略を示すように（モータ部９１を含む）モータ駆動部９２と、ギア部９３′とからなる構成としている。【００７２】
図８に示すようにモータ２３にギアが連結されたギアモデルに対する以下の（１）、（２）の運動方程式であらわされることができる。【００７３】
Ｊm・（ｄ2θm/ｄｔ2）＋ｒ・Ｄ・｛（ｒ・（ｄθm/ｄｔ）−（ｄθL/ｄｔ）｝＋ｒ・Ｋ・（ｒθm−θL）＝τ        （１）
ＪL・（ｄ2θL/ｄｔ2）＋FL・（ｄθL/ｄｔ）＋ｒ・Ｄ・｛ｒ・（ｄθm/ｄｔ）−（ｄθL/ｄｔ）｝＋Ｋ・（ｒθm−θL）＝0  （２）
なお、（１）、（２）におけるθm、θLは、それぞれモータ軸、ギア軸の角度を表す。Ｊm、ＪL  は、それぞれモータイナーシャ（慣性モーメント）、負荷を考慮したギアイナーシャを表す。また、ｒ、Ｄ、Ｋ、τ、FL は、それぞれギア比、粘性定数、弾性定数、モータ駆動トルク、ギア静摩擦定数となる。【００７４】
上記（１）、（２）の運動方程式をもとに、実際のモータ駆動部９２及びギア部９３’をブロック線図で表したものが図２０となる。【００７５】
そして、図２０のモータ駆動部９２とギア部９３′に対して、ギア外乱（推定）オブザーバ９５を追加することにより、図２１に示すように外乱推定値を算出可能な構成にしている。また、この場合、ギア部９３′におけるポテンショメータ４２（図２参照）により検出されるギア４７の位置情報を利用することにより、高精度で外乱推定値を算出可能にしている。【００７６】
なお、図２０におけるモータ駆動部９２は、モータ部９１と、このモータ部９１を駆動制御するモータ駆動ユニット部９４とからなる。【００７７】
このモータ駆動ユニット部９４は、図４に示したシグナルフロー図の構成要素ブロック（つまり、位置制御ブロック５１、速度制御ブロック５２，微分要素５３，電流制御ブロック５４）と、基本的には同じ構成である。【００７８】
また、モータ部９１も、基本的には図４に示したモータモデルブロックＡと同じである。図４においては、位置情報を出力する積分演算子（１／ｓ）を含めない構成でモータモデルブロックＡを定義していたのに対して、本実施例においては位置情報を利用する構成から、この積分演算子を含めてモータ部９１と定義している。【００７９】
また、図４においては、モータ部９１内に外乱負荷ｄが入力されるような単純化したモデル構成であったのに対して、本実施例においては外乱負荷ｄが（ギアモデルブロックとしての）ギア部９３′側に入力されるように、より現実に近いモデル構成にしている。【００８０】
このため、トルク定数Ｋｔを通した加え合わせ点（加算点）への信号入力が図４と図２０においては異なっている。【００８１】
図２０におけるこの加算点ａ２には、ギア部９３′のギア位置情報に対するギア剛性（Gear stiffness）、ギア比(Gear Ratio)の反作用を考慮した信号値が加算され、さらに（ギア部９３′の）ギア軸にかかる外乱負荷ｄが加えられる加算点ａ４で加算された信号値が減算される。【００８２】
なお、上述した実施例３までは、主にモータのイナーシャ（慣性モーメント）を考慮していたので、モータイナーシャをＪで表していたが、本実施例以降ではギアイナーシャも考慮するため、モータイナーシャをＪmで、ギアイナーシャをＪgで表している。【００８３】
図２０においては、ギア部９３′として、実際のギアモデル部分と、ＦＰＧＡブロック３６によるソフトウェアで演算される部分（具体的には上述した反作用の部分）を含めた構成で示している。【００８４】
これに対して、ギア外乱オブザーバ９５を追加した図２１のモータ駆動系のより詳細な構成においては、実際のギアモデル部分を符号９３で示し、ＦＰＧＡブロック３６によりソフトウェアによる演算で処理される部分を符号９６（３６）で示している。【００８５】
つまり、ＦＰＧＡブロック３６は、図２０で示したモータ駆動ユニット部９４と、ギア反作用の部分と、ギア外乱オブザーバ９５とを含む構成となる。【００８６】
図２０及び図２１において、モータ部９１のモータ位置情報は、加算点ａ１にフィードバックされ、指令値から減算されて位置制御ブロック５１の演算要素に入力される。【００８７】
また、図２１に示す構成においては、この加算点ａ１に、さらにギア部９３のギア位置情報が入力され、指令値から減算された偏差値でモータ駆動の制御を行う構成にしている。【００８８】
つまり、本実施例においては、ギア４７の位置情報を検出するポテンショメータ４２（図２参照）のギア位置情報を用いた誤差を低減できるモータ駆動系の構成にして、この構成により外乱推定値を算出する。このようにポテンショメータ４２によるギア位置情報を利用するため、負荷算出部としてのギア外乱オブザーバ９５自体の構成を単純化したものを採用した場合でも、精度良くギア外乱推定値の算出を可能にする。【００８９】
また、モータ部９１のモータ位置情報は、ギア比の演算要素を経て加算点ａ３において、ギア４７の位置情報が減算される。そして、バックラッシュ、ガタ等の不感帯（ＤＺ）、ギア剛性の演算要素を経て加算点ａ４において外乱負荷ｄが加算されると共に、速度情報に静的及び動的摩擦の演算された信号値が減算される。【００９０】
この加算点ａ４で加算された信号値は、上述ように加算点ａ２にフィードバックされて減算されると共に、ギアイナーシャＪgを用いた積分要素（１／（Ｊg・ｓ））、積分要素（１／ｓ）を経てポテンショメータ４２により検出されるギア位置情報となる。【００９１】
このギア位置情報は、ギア外乱オブザーバ９５の微分演算要素（ｄｕ／ｄｔ）に入力される。そして、このギア外乱オブザーバ９５において、図４で説明した場合と同様の演算処理（但し、モータをギアで置換）を行うことにより、外乱推定値を算出する。【００９２】
つまりギア位置情報は、微分演算要素によりギア速度情報が算出され、さらにギア部９３側の（１／（Ｊg・ｓ））の逆演算（Ｊg・ｓ）が施された値を加算点ａ５に入力する。この加算点において、この入力値から、不感帯（ＤＺ）が入った値に対して（ギア部９３側と同様に）ギア剛性（Ｋg）を考慮したトルクを減算して外乱出力端子から、算出された外乱推定値を出力する。 
なお、ギア外乱オブザーバ９５におけるギアイナーシャＪg、ギア剛性Ｋgは、設計値（公称値）である。【００９３】
また、算出された外乱推定値は、実施例１で説明したように通信系ブロック３４を介して制御部２５に伝達され、内視鏡モニタ５での表示等により告知される。【００９４】
このように本実施例においては、ポテンショメータ４２により検出されたギア位置情報をモータ２３への指令値にフィードバックして、その位置情報を陽に利用する構成にしているので、ギア部９３でのギア間の摩擦、不感帯要素の影響を相殺ないしは低減できる。【００９５】
また、ギア部９３に働く外乱トルクをギア部９３において直接検知する構成にしているので、内視鏡に働くテンション量等の負荷をセンサを用いること無く、精度良く算出することができる。【００９６】
また、算出された負荷値等を表示等により、術者等の使用者に告知することができる。【００９７】
（実施例５）  
次に図２２から図２４を参照して本発明の実施例５を説明する。本実施例は、実施例４と同様に外乱負荷ｄをギア部において考慮する構成にすると共に、さらに状態推定オブザーバの概念を導入して、同様に外乱推定値を算出する。【００９８】
このため、まず状態推定オブザーバの概念を説明する。この状態推定オブザーバにおいては、実システムの入力と出力の情報から、実システムを模擬する仮想モデルを用いて、実システムの状態量を推定することにある。【００９９】
実システム、仮想モデルに対する状態方程式は、各々以下の（３）、（４）式のようになる。【０１００】
実システム：dx/dt＝A・x+B・u    ｙ＝C・x+D・u   （３）
仮想モデル：dxm/dt＝A・xm+B・u  ym＝C・xm+D・u  （４）
ここで、A,B,C,Dは、システムのダイナミクスを決定する係数行列で、実システムと仮想モデルでは各パラメータは同一で、状態変数x，xmと出力ｙ,ymは異なる。【０１０１】
さて、実システムと仮想モデルの偏差e＝xm−xとした場合、
de/dt＝dxm/dt−dx/dt
＝A・xm−A・x＝A・(xm−x）＝A・e  （５）
となり、Aが安定なら収束するので、実システムと仮想モデルの間にフィードバック機構を持たせることにより状態量の収束時間を制御可能である。実システムと仮想モデルの状態との誤差ができるだけ早く収束するように、出力偏差をモデルにフィードバックした場合には、下記式の通りとなる。ただし、Lはフィードバックゲインとする。【０１０２】
dxm/dt＝A・xm＋B・u−L・（ym−y）
＝A・xm+B・u−L(C・xm＋D・u−y）
＝（A−L・C）xm＋B・u−L・Du＋L・y  （６）
となる。偏差eの時間変化は、 
de/dt＝dxm/dt−dx/dt
＝（A−L・C）xm＋B・u−L・D・u＋L・（C・x＋D・u）−（A・x＋B・u）
＝（A−L・C）（xm−x）
＝（A−L・C）e                （７）
となる。誤差eは、A−L・Cに収束する。【０１０３】
この様に、A-L・Cの値によって収束時間が決まるため、出来るだけ誤差eが収束するようにLの値を設定すれば、実時間で実システムの状態量と仮想モデルの状態量が一致する、すなわち仮想モデルの値から実システムの値を推定出来るという事になる。【０１０４】
フィードバックした両システムの関係をブロック線図で示すと図２２のようになる。【０１０５】
さて、本実施例におけるギア部を含めた実システムと、それを模擬した仮想モデルとなるオブザーバを構築したモータ駆動系の構成を図２３に示す。図２３の構成は、この図２３における符号９７で示す部分が図２０の構成全体と一致する。この図２３においては、９７中における符号９８で示す部分が実システムに相当する。【０１０６】
そして、本実施例においては、ＦＰＧＡブロック３６内に、この実システム９８を模擬（シミュレート）する仮想モデルシステム９９と、両システムを結合して状態量を推定する状態推定オブザーバ１００とを設ける。【０１０７】
つまり、図２３においては、実システム９８を除く全てがＦＰＧＡ３６内に構成される（なお、より厳密には、図２３における実システム９８における反作用部分は、実際にはＦＰＧＡブロック３６により演算される）。【０１０８】
図２３に示すように仮想モデルシステム９９は、実システム９８と同じ構成要素となるようにシミュレートする。【０１０９】
なお、図２３において、便宜上、実システム９８における加算点ａ１〜ａ４を、仮想モデルシステム９９においては、加算点ａ１′〜ａ４′にて示す。【０１１０】
また、仮想モデルシステム９９においては、上述した実施例４のギア外乱オブザーバ９５に相当するトルク推定オブザーバ９５′が追加して形成され、トルク推定オブザーバ９５′は、センサを用いることを不要として、外乱推定値を出力する。【０１１１】
なお、実施例４におけるギア外乱オブザーバ９５においては、実システム９８における例えばギア位置情報を用いていたが、本実施例においては仮想モデルシステム９９中におけるギア位置情報を用いる。ソフトウェアによる演算処理上の構成は、両者で同じである。【０１１２】
図２４は、図２３におけるトルク推定オブザーバ９５′を含む仮想モデルシステム９９と、状態推定オブザーバ１００部分の構成を示す。【０１１３】
仮想モデルシステム９９においては、実システム９８における電流制御ブロック５４（ゲイン）を通した信号値が加算点ａ６を経て加算点ａ２′に入力され、加算される。この場合、加算点２６は、状態推定オブザーバ１００の出力信号値を減算する。【０１１４】
また、状態推定オブザーバ１００は、３つのゲインＬ１，Ｌ２，Ｌ３を有し、ゲインＬ１には、加算点ａ７を介して仮想モデルシステム９９のモータ位置情報から実システム９８のモータ位置情報を減算した信号が入力される。また、ゲインＬ２、Ｌ３には仮想モデルシステム９９のギア位置情報とギア速度情報とがそれぞれ入力される。【０１１５】
そして、ゲインＬ１，Ｌ２，Ｌ３の出力信号値は、加算点ａ８で加算されて、仮想モデルシステム９９の加算点ａ６に出力される。【０１１６】
図２４に示すように（ＦＰＧＡブロック３６内ではモータを駆動する）電流（指令）値と、モータ位置情報からギアの挙動をシミュレートする状態推定オブザーバ１００が形成されている。また、仮想モデルシステム９９に対して、ギア外乱オブザーバ９５の場合と同様に外乱推定値を算出するためのトルク推定オブザーバ９５′が形成されている。そして、このトルク推定オブザーバ９５′により、外乱推定値を算出する。【０１１７】
上記のように、状態推定オブザーバ１００においてはゲインＬ２，Ｌ３により仮想モデルシステム９９のギア位置情報及びギア速度情報をフィードバックすることにより、仮想モデルシステム９９により、実システム９８をシミュレートした場合、短時間で実システム９８の状態に収束させることができるようにしている。【０１１８】
本実施例によれば、モータ側でのトルク検知の場合よりも、実際に外力が作用するギア部側に近い部分でギアの外乱推定値を算出するため、センサを用いること無く、精度の高い外乱推定値を得ることができる。【０１１９】
また、状態推定オブザーバ１００において仮想モデルシステム９９における複数の情報をフィードバックするループを形成する構成とすることにより、実システム９６を精度良くシミュレートする場合の応答速度を向上できる。また、算出された負荷値等を表示等により、術者等の使用者に告知することができる。【０１２０】
（実施例５の変形例）
図２５は、実施例５の変形例のモータユニット駆動系のグロック線図を示す。【０１２１】
図２３に示した実施例５における状態推定オブザーバ１００においては、モータ位置情報（実システム９８においてはモータ軸に取り付けられたエンコーダの情報）を用いていたが、本変形例においては、ギア位置情報（実システム９８ではポテンショメータ４２の位置情報）を利用する構成にしている。【０１２２】
このため、図２５の構成においては、仮想モデルシステム９９のギア位置情報から実システム９８のギア位置情報（ポテンショメータ４２の出力）が加算点ａ７により減算された信号がゲインＬ１に入力される。【０１２３】
また、本変形例では、ゲインＬ２、Ｌ３には仮想モデルシステム９９におけるギア速度情報とギア位置情報がそれぞれ入力される。【０１２４】
その他の構成は図２３と同様である。【０１２５】
本変形例によれば、ギア位置情報を用いているので、精度の高い外乱推定値を算出することができる。なお、図２３の構成の場合には、ポテンショメータ４２を有しない構成の場合にも広く適用でき、かつ従来例よりも精度の高い外乱推定値を算出することができる。【０１２６】
また、上述した実施例等を部分的に組み合わせる等して異なる実施例等を形成しても良い。  
なお、上述の説明では、マニピュレータとして、可動体として複数の湾曲駒を回転自在に連結した管体としての湾曲部を湾曲駆動制御する場合の例で説明したが、本発明はこれに限定されるものでなく、モータにより可動体を備えた管体を駆動する場合に広く適用することができる。
【産業上の利用可能性】
【０１２７】
モータの負荷に働く張力検出のセンサを必要としないで、外乱オブザーバの手法を用いることにより精度良く負荷値を推定する。【０１２８】
本出願は、２００９年２月３日に日本国に出願された特願２００９−２３０３２号を優先権主張の基礎として出願するものであり、上記の開示内容は、本願明細書、請求の範囲、図面に引用されるものとする。
【図１】
2010090059.tif 000003
【図２】
2010090059.tif 000004
【図３】
2010090059.tif 000005
【図４】
2010090059.tif 000006
【図５Ａ】
2010090059.tif 000007
【図５Ｂ】
2010090059.tif 000008
【図６】
2010090059.tif 000009
【図７】
2010090059.tif 000010
【図８】
2010090059.tif 000011
【図９】
2010090059.tif 000012
【図１０Ａ】
2010090059.tif 000013
【図１０Ｂ】
2010090059.tif 000014
【図１０Ｃ】
2010090059.tif 000015
【図１０Ｄ】
2010090059.tif 000016
【図１０Ｅ】
2010090059.tif 000017
【図１０Ｆ】
2010090059.tif 000018
【図１１】
2010090059.tif 000019
【図１２】
2010090059.tif 000020
【図１３Ａ】
2010090059.tif 000021
【図１３Ｂ】
2010090059.tif 000022
【図１４】
2010090059.tif 000023
【図１５】
2010090059.tif 000024
【図１６】
2010090059.tif 000025
【図１７】
2010090059.tif 000026
【図１８】
2010090059.tif 000027
【図１９】
2010090059.tif 000028
【図２０】
2010090059.tif 000029
【図２１】
2010090059.tif 000030
【図２２】
2010090059.tif 000031
【図２３】
2010090059.tif 000032
【図２４】
2010090059.tif 000033
【図２５】
2010090059.tif 000034
【手続補正書】
【提出日】平成22年6月22日(2010.6.22)
【手続補正１】
【補正対象書類名】明細書
【補正対象項目名】０００５
【補正方法】変更
【補正の内容】
【０００５】
本発明の一形態に係るマニピュレータは、湾曲可能な湾曲部を備えた長尺な管体と、
前記管体に設けられた前記湾曲部を湾曲操作するための湾曲ワイヤと、
駆動用指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結され、該回転軸の回転速度に対して速度を変更するために複数のギアを噛合わせて構成された減速機と、
前記湾曲部を操作するために前記湾曲ワイヤの基端と前記減速機とを連結する連結手段と、
前記駆動指令信号に応じて回転駆動された前記モータの動作状態を検出する検出部と、
前記減速機を構成する複数のギアの噛合わせによって周期的に生じる負荷変動値を補正情報として予め記憶する記憶部と、
前記モータに供給する駆動信号によって想定される前記モータの駆動予測情報と、前記検出部によって検出された前記モータの動作状態情報と、前記記憶部に記憶された前記補正情報に基づき、前記管体に対して生じる負荷を湾曲負荷推定値として算出する負荷算出部と、
前記負荷算出部の算出結果を湾曲負荷推定値として告知する告知部と、
を具備することを特徴とする。
【手続補正２】
【補正対象書類名】明細書
【補正対象項目名】０００６
【補正方法】変更
【補正の内容】
【０００６】
本発明の他の一形態に係るマニピュレータは、湾曲可能な湾曲部を備えた長尺な管体と、
前記管体に設けられた前記湾曲部を湾曲操作するための湾曲ワイヤと、
駆動用指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結され、該回転軸の回転速度に対して速度を変更するために複数のギアを噛合わせて構成された減速機と、
前記湾曲部を操作するために前記湾曲ワイヤの基端と前記減速機とを連結する連結手段と、
前記駆動指令信号に応じて回転駆動された前記モータ及び前記減速機の動作状態を検出する検出部と、
前記モータに供給する駆動信号によって想定される前記モータの駆動予測情報と、前記検出部によって検出された前記モータの動作状態情報に基づき、前記管体に対して生じる負荷を湾曲負荷推定値として算出する負荷算出部と、
前記負荷算出部の算出結果を湾曲負荷推定値として告知する告知部と、
を具備することを特徴とする。
【手続補正３】
【補正対象書類名】特許請求の範囲
【補正対象項目名】全文
【補正方法】変更
【補正の内容】
【特許請求の範囲】
【請求項１】
湾曲可能な湾曲部を備えた長尺な管体と、
前記管体に設けられた前記湾曲部を湾曲操作するための湾曲ワイヤと、
駆動用指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結され、該回転軸の回転速度に対して速度を変更するために複数のギアを噛合わせて構成された減速機と、
前記湾曲部を操作するために前記湾曲ワイヤの基端と前記減速機とを連結する連結手段と、
前記駆動指令信号に応じて回転駆動された前記モータの動作状態を検出する検出部と、
前記減速機を構成する複数のギアの噛合わせによって周期的に生じる負荷変動値を補正情報として予め記憶する記憶部と、
前記モータに供給する駆動信号によって想定される前記モータの駆動予測情報と、前記検出部によって検出された前記モータの動作状態情報と、前記記憶部に記憶された前記補正情報に基づき、前記管体に対して生じる負荷を湾曲負荷推定値として算出する負荷算出部と、
前記負荷算出部の算出結果を湾曲負荷推定値として告知する告知部と、
を具備することを特徴とするマニピュレータ。
【請求項２】
前記管体は、体腔内に挿入される内視鏡挿入部の先端側に、該内視鏡挿入部の長手方向に前記可動体を形成する複数の湾曲駒を回転自在に連結し、前記モータの回転により前記湾曲ワイヤを牽引して前記複数の湾曲駒を湾曲する湾曲部により形成され、
さらに、前記減速機を構成する前記複数のギアにおける前記モータの回転軸に連結された第１ギアと前記連結手段に連結された第２ギア間の噛合位置の情報を、前記モータの回転位置の情報及び前記第２ギアの回転位置の情報を用いて発生する噛合位置情報発生部を有し、前記記憶部は、前記噛合位置に対応して周期的な特性を持つ前記補正情報を記憶することを特徴とする請求項１に記載のマニピュレータ。
【請求項３】
前記負荷算出部は、前記モータヘ供給される前記駆動用指令信号と前記検出部の検出情報に対する演算処理を行い、前記モータに作用する負荷を推定する負荷推定部と、前記負荷推定部により推定された負荷推定値に対して、前記複数のギアの噛合のがたつきのために変動する前記負荷推定値を前記補正情報で補正して前記湾曲負荷推定値を出力する補正部とからなることを特徴とする請求項１に記載のマニピュレータ。
【請求項４】
前記補正部は、前記複数のギア間の噛合位置の位置情報としての噛合位置情報によって、前記記憶部に記憶された前記補正情報を読み出し、前記負荷推定値を該補正情報で補正して前記湾曲負荷推定値を出力することを特徴とする請求項３に記載のマニピュレータ。
【請求項５】
前記記憶部は、前記複数のギア間の噛合位置の位置情報としての噛合位置情報を記憶する噛合位置記憶部と、予め前記負荷推定値を前記噛合位置情報に関係付けて十分に補正可能とすることが調べられた情報を前記補正情報として記憶する補正情報記憶部とを有することを特徴とする請求項４に記載のマニピュレータ。
【請求項６】
さらに、前記湾曲負荷推定値が、前記駆動用指令信号に対応した第１の状態に属するか、該第１の状態から逸脱した外力が作用している第２の状態であるか否かを判定する判定部を有することを特徴とする請求項４に記載のマニピュレータ。
【請求項７】
前記判定部は、前記駆動用指令信号に予め関連付けた基準の情報と、前記湾曲負荷推定値とが許容される値以上に逸脱しているか否かを比較器により比較することを特徴とする請求項６に記載のマニピュレータ。 
【請求項８】
前記告知部は、前記内視鏡挿入部の先端部に設けられた撮像素子により撮像された画像の映像信号に、前記負荷算出結果を表示する信号を重畳して内視鏡画像表示部に出力することを特徴とする請求項２に記載のマニピュレータ。
【請求項９】
さらに、前記駆動用指令信号を前記モータに供給する場合には、前記減速機を構成する複数のギアの静摩擦状態を解消する振幅の振動信号成分を前記モータヘ重畳して印加する振動信号発生部を有することを特徴とする請求項１に記載のマニピュレータ。
【請求項１０】
さらに、前記駆動用指令信号を前記モータに供給する場合には、前記減速機を構成する複数のギアの静摩擦状態を解消する振幅の振動信号成分を前記モータヘ重畳して印加する振動信号発生部を有することを特徴とする請求項２に記載のマニピュレータ。
【請求項１１】
さらに、前記駆動用指令信号を前記モータに供給する場合には、前記減速機を構成する複数のギアの静摩擦状態を解消する振幅の振動信号成分を前記モータヘ重畳して印加する振動信号発生部を有することを特徴とする請求項３に記載のマニピュレータ。
【請求項１２】
前記駆動用指令信号を前記モータに供給しない期間に、前記モータに振動信号を、前記管体を可動させない程度の振幅で供給すると共に、前記負荷算出部の出力値の時間的な平均値を算出する平均値算出部を有することを特徴とする請求項１に記載のマニピュレータ。
【請求項１３】
前記駆動用指令信号を前記モータに供給しない期間に、前記モータに振動信号を、前記管体を可動させない程度の振幅で供給すると共に、前記負荷算出部の出力値の時間的な平均値を算出する平均値算出部を有することを特徴とする請求項２に記載のマニピュレータ。
【請求項１４】
前記駆動用指令信号を前記モータに供給しない期間に、前記モータに振動信号を、前記管体を可動させない程度の振幅で供給すると共に、前記負荷算出部の出力値の時間的な平均値を算出する平均値算出部を有することを特徴とする請求項３に記載のマニピュレータ。
【請求項１５】
前記負荷算出部の出力値が略極値付近で小さくなるように前記振動信号の振幅を可変制御する振幅制御部を有することを特徴とする請求項９に記載のマニピュレータ。
【請求項１６】
前記負荷算出部の出力値が略極値付近で小さくなるように前記振動信号の振幅を可変制御する振幅制御部を有することを特徴とする請求項１０に記載のマニピュレータ。
【請求項１７】
前記検出部は、前記モータの動作状態として、前記モータの回転位置と回転速度とを検出して前記検出情報として出力することを特徴とする請求項１に記載のマニピュレータ。
【請求項１８】
湾曲可能な湾曲部を備えた長尺な管体と、
前記管体に設けられた前記湾曲部を湾曲操作するための湾曲ワイヤと、
駆動用指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結され、該回転軸の回転速度に対して速度を変更するために複数のギアを噛合わせて構成された減速機と、
前記湾曲部を操作するために前記湾曲ワイヤの基端と前記減速機とを連結する連結手段と、
前記駆動指令信号に応じて回転駆動された前記モータ及び前記減速機の動作状態を検出する検出部と、
前記モータに供給する駆動信号によって想定される前記モータの駆動予測情報と、前記検出部によって検出された前記モータの動作状態情報に基づき、前記管体に対して生じる負荷を湾曲負荷推定値として算出する負荷算出部と、
前記負荷算出部の算出結果を湾曲負荷推定値として告知する告知部と、
を具備することを特徴とするマニピュレータ。
【請求項１９】
前記複数のギアにおける前記連結手段に連結されたギヤの位置情報を検出する位置情報検出部を有し、前記駆動用指令信号から前記ギアの位置情報を減算した減算値で前記モータを駆動する構成にして、前記負荷算出部は前記負荷を前記湾曲負荷推定値として算出することを特徴とする請求項１８に記載のマニピュレータ。
【請求項２０】
前記モータ及び前記減速機を含む実体モデルシステムを模擬する仮想モデルシステムを設け、前記実体モデルシステム側の前記減速機に作用する負荷を、前記仮想モデルシステム側に設けた前記負荷算出部により算出することを特徴とする請求項１８に記載のマニピュレータ。
【請求項２１】
前記管体は、体腔内に挿入される内視鏡挿入部の先端側に、該内視鏡挿入部の長手方向に前記可動体を形成する複数の湾曲駒を回転自在に連結し、前記モータの回転によりワイヤを牽引して前駆複数の湾曲駒を湾曲する湾曲部により形成されることを特徴とする請求項１８に記載のマニピュレータ。
【手続補正書】
【提出日】平成22年10月14日(2010.10.14)
【手続補正１】
【補正対象書類名】明細書
【補正対象項目名】０００５
【補正方法】変更
【補正の内容】
【０００５】
本発明の一形態に係るマニピュレータは、湾曲可能な湾曲部を備えた長尺な管体と、
前記管体に設けられた前記湾曲部を湾曲操作するための湾曲ワイヤと、
電流指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結され、該回転軸の回転速度に対して速度を変更するために複数のギアを噛合わせて構成された減速機と、
前記湾曲部を操作するために前記湾曲ワイヤと前記減速機とを連結する連結手段と、
前記電流指令信号に応じて回転駆動された前記モータの回転角度を検出するモータ角度検出部と、
前記回転駆動された前記モータにより駆動される前記減速機の回転角度を検出する減速機角度検出部と、  
前記モータの回転角度から前記回転軸に発生するトルク情報を算出するトルク情報算出部と、
前記電流指令信号を前記モータのモータモデルに供給することによって前記回転軸に発生すると想定される推定トルク情報とを算出する推定トルク算出部と、
前記トルク情報と前記推定トルク情報との差分値を前記モータの回転軸に発生する外乱トルク情報として算出する外乱トルク算出部と、
前記モータの回転角度と前記減速機の回転角度に基づき、前記複数のギア同士の噛合位置を位置データとして発生する位置データ発生部と、
前記位置データと前記外乱トルク情報に対応して、前記外乱トルクに対して重畳され、前記減速機を構成する複数のギアの噛合わせによって前記モータの回転軸に周期的に生じるトルク変動を予め補正情報として記憶する記憶部と、
前記記憶手段から補正情報を取得し、前記補正情報に基づき前記外乱トルク情報を補正して得られる前記管体に生じる負荷により前記モータの回転軸に発生する負荷トルクを演算する管体負荷算出部と、
を具備することを特徴とする。
【手続補正２】
【補正対象書類名】明細書
【補正対象項目名】０００６
【補正方法】削除
【補正の内容】
【手続補正３】
【補正対象書類名】特許請求の範囲
【補正対象項目名】全文
【補正方法】変更
【補正の内容】
【特許請求の範囲】
【請求項１】
湾曲可能な湾曲部を備えた長尺な管体と、
前記管体に設けられた前記湾曲部を湾曲操作するための湾曲ワイヤと、
電流指令信号に応じて回転する回転軸を備えたモータと、
前記回転軸に連結され、該回転軸の回転速度に対して速度を変更するために複数のギアを噛合わせて構成された減速機と、
前記湾曲部を操作するために前記湾曲ワイヤと前記減速機とを連結する連結手段と、
前記電流指令信号に応じて回転駆動された前記モータの回転角度を検出するモータ角度検出部と、
前記回転駆動された前記モータにより駆動される前記減速機の回転角度を検出する減速機角度検出部と、  
前記モータの回転角度から前記回転軸に発生するトルク情報を算出するトルク情報算出部と、
前記電流指令信号を前記モータのモータモデルに供給することによって前記回転軸に発生すると想定される推定トルク情報とを算出する推定トルク算出部と、
前記トルク情報と前記推定トルク情報との差分値を前記モータの回転軸に発生する外乱トルク情報として算出する外乱トルク算出部と、
前記モータの回転角度と前記減速機の回転角度に基づき、前記複数のギア同士の噛合位置を位置データとして発生する位置データ発生部と、
前記位置データと前記外乱トルク情報に対応して、前記外乱トルクに対して重畳され、前記減速機を構成する複数のギアの噛合わせによって前記モータの回転軸に周期的に生じるトルク変動を予め補正情報として記憶する記憶部と、
前記記憶手段から補正情報を取得し、前記補正情報に基づき前記外乱トルク情報を補正して得られる前記管体に生じる負荷により前記モータの回転軸に発生する負荷トルクを演算する管体負荷算出部と、
を具備することを特徴とするマニピュレータ。
【請求項２】
前記負荷トルクが、前記電流指令信号に対応した第１の状態に属するか、該第１の状態から逸脱した外力が作用している第２の状態であるか否かを判定する判定部を有することを特徴とする請求項１に記載のマニピュレータ。
【請求項３】
前記判定部は、前記電流指令信号に予め関連付けた基準の情報と、前記負荷トルクとが許容される値以上に逸脱しているか否かを比較器により比較することを特徴とする請求項２に記載のマニピュレータ。 
【請求項４】
前記管体負荷算出部で算出された前記負荷トルクを告知する告知手段を有することを特徴とする請求項１に記載のマニピュレータ。
【請求項５】
前記告知部は、前記管体の先端部に設けられた撮像素子により撮像された画像の映像信号に、前記管体負荷算出結果を表示する信号を重畳して内視鏡画像表示部に出力することを特徴とする請求項２に記載のマニピュレータ。
【請求項６】
前記電流指令信号を前記モータに供給する場合には、前記減速機を構成する複数のギアの静摩擦状態を解消する振幅の振動信号成分を前記モータヘ重畳して印加する振動信号発生部を有することを特徴とする請求項１に記載のマニピュレータ。
【請求項７】
前記電流指令信号を前記モータに供給しない期間に、前記モータに振動信号を、前記管体を可動させない程度の振幅で供給すると共に、前記管体負荷算出部の出力値の時間的な平均値を算出する平均値算出部を有することを特徴とする請求項１に記載のマニピュレータ。
【請求項８】
前記管体負荷算出部において算出される負荷トルクが略極値付近をとる際に前記振動信号の振幅が小さくなるように可変制御する振幅制御部を有することを特徴とする請求項６に記載のマニピュレータ。
【国際調査報告】
2010090059.tif 000035
2010090059.tif 000036
2010090059.tif 000037
2010090059.tif 000038