JP2007029288A - Medical controlling apparatus - Google Patents
Medical controlling apparatus Download PDFInfo
- Publication number
- JP2007029288A JP2007029288A JP2005214727A JP2005214727A JP2007029288A JP 2007029288 A JP2007029288 A JP 2007029288A JP 2005214727 A JP2005214727 A JP 2005214727A JP 2005214727 A JP2005214727 A JP 2005214727A JP 2007029288 A JP2007029288 A JP 2007029288A
- Authority
- JP
- Japan
- Prior art keywords
- link member
- unit
- link members
- link
- calculation unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000005452 bending Methods 0.000 claims abstract description 129
- 238000003780 insertion Methods 0.000 claims abstract description 83
- 230000037431 insertion Effects 0.000 claims abstract description 83
- 238000001514 detection method Methods 0.000 claims abstract description 65
- 238000004364 calculation method Methods 0.000 claims description 187
- 230000008859 change Effects 0.000 claims description 16
- 230000036544 posture Effects 0.000 abstract description 50
- 238000012545 processing Methods 0.000 abstract description 50
- 230000006870 function Effects 0.000 description 107
- 230000004048 modification Effects 0.000 description 43
- 238000012986 modification Methods 0.000 description 43
- 238000010586 diagram Methods 0.000 description 41
- 238000000034 method Methods 0.000 description 34
- 230000007246 mechanism Effects 0.000 description 31
- 230000014509 gene expression Effects 0.000 description 30
- 230000008569 process Effects 0.000 description 25
- 239000011159 matrix material Substances 0.000 description 24
- 230000010354 integration Effects 0.000 description 18
- 230000000968 intestinal effect Effects 0.000 description 16
- 230000001276 controlling effect Effects 0.000 description 13
- 238000011156 evaluation Methods 0.000 description 13
- 239000013598 vector Substances 0.000 description 10
- 238000006073 displacement reaction Methods 0.000 description 9
- 238000003384 imaging method Methods 0.000 description 8
- 210000002429 large intestine Anatomy 0.000 description 6
- 210000001599 sigmoid colon Anatomy 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 4
- 230000004069 differentiation Effects 0.000 description 3
- 238000005286 illumination Methods 0.000 description 3
- 238000011282 treatment Methods 0.000 description 3
- 238000012935 Averaging Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 2
- 238000000354 decomposition reaction Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012886 linear function Methods 0.000 description 2
- 230000007935 neutral effect Effects 0.000 description 2
- 230000001154 acute effect Effects 0.000 description 1
- 230000003466 anti-cipated effect Effects 0.000 description 1
- 210000000436 anus Anatomy 0.000 description 1
- 238000005260 corrosion Methods 0.000 description 1
- 230000007797 corrosion Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 210000000056 organ Anatomy 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000012887 quadratic function Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Abstract
Description
本発明は、医療用具の湾曲部に対して湾曲動作を行わせるための駆動手段を制御する医療用制御装置に関する。 The present invention relates to a medical control apparatus for controlling a driving unit for causing a bending operation of a bending portion of a medical device.
従来より、医療用具として内視鏡は、幅広く利用されている。内視鏡の細長の挿入部を体腔内に挿入することにより、術者は、体腔内臓器などを観察したり、必要に応じて処置具チャンネル内に挿通した処置具を用いて各種治療処置ができる。また、工業分野においても、作業者は、内視鏡の細長の挿入部を挿入することにより、ボイラ,タービン,エンジン,化学プラントなどの内部の傷や腐蝕などを観察したり検査することができる。 Conventionally, endoscopes have been widely used as medical tools. By inserting the elongated insertion portion of the endoscope into the body cavity, the surgeon can observe the organs in the body cavity or perform various treatments using the treatment tool inserted into the treatment instrument channel as necessary. it can. Also in the industrial field, workers can observe and inspect internal scratches and corrosion of boilers, turbines, engines, chemical plants, etc. by inserting elongated insertion parts of endoscopes. .
このような内視鏡には、細長な挿入部の先端部基端側に湾曲自在な湾曲部が設けられている。前記内視鏡において、術者等の使用者は、操作部に設けられた湾曲操作レバー等の湾曲操作入力手段を操作することにより、湾曲部を湾曲動作させるための湾曲駆動手段に、前記湾曲部の湾曲方向や湾曲の速度が湾曲量として指示入力される。 Such an endoscope is provided with a bendable bending portion on the proximal end side of the distal end portion of the elongated insertion portion. In the endoscope, a user such as a surgeon operates the bending operation input unit such as a bending operation lever provided in the operation unit, so that the bending driving unit for bending the bending unit is used as the bending driving unit. The bending direction and bending speed of the part are input as a bending amount.
そして、前記湾曲駆動手段は、前記湾曲操作レバーによる湾曲量に基づき、前記湾曲部を構成する湾曲駒に接続された湾曲操作ワイヤを機械的に牽引又は弛緩させることにより、前記湾曲部を湾曲動作させる。 Then, the bending drive means mechanically pulls or relaxes the bending operation wire connected to the bending piece constituting the bending portion based on the bending amount by the bending operation lever, thereby bending the bending portion. Let
この種の従来の内視鏡には、湾曲駆動手段として例えば内視鏡内部に内蔵したモータを電気的に回動制御してこのモータの駆動力により湾曲操作ワイヤを牽引又は弛緩して前記湾曲部を湾曲動作させる電気的湾曲駆動方式、つまり電動湾曲内視鏡がある。 In this type of conventional endoscope, for example, a motor built in the endoscope as a bending driving means is electrically controlled to rotate, and the bending operation wire is pulled or relaxed by the driving force of the motor, so that the bending is performed. There is an electric bending drive method in which a part is bent, that is, an electric bending endoscope.
例えば、特許2917263号公報には、電動湾曲内視鏡において、前記湾曲操作ワイヤを牽引するプーリを有しこのプーリに対応するモータのトルクを内視鏡挿入部の種類に合うように設定できる制御手段等に関する技術が開示されている。
また、特許2845255号公報には、電動湾曲内視鏡において、湾曲部の全操作範囲のモータにかかる負荷を均一にできる内視鏡の湾曲操作装置に関する技術が開示されている。
Japanese Patent No. 2845255 discloses a technique related to an endoscope bending operation apparatus that can uniformly apply a load applied to a motor in the entire operation range of a bending portion in an electric bending endoscope.
しかしながら、前記従来の電動湾曲内視鏡は、湾曲入力手段を操作して指示入力される湾曲量に基づいて湾曲駆動手段であるモータを電気的に回動制御することにより、湾曲操作ワイヤを牽引又は弛緩して前記湾曲部を湾曲動作させるものである。この湾曲部には複数の湾曲駒が連接されており、湾曲時に湾曲部は湾曲部全体に渡って湾曲するといった構成であるため、例えば大腸などの管腔内に挿入する際、湾曲部の先端側をこの管腔内の形状に合わせた形状に湾曲固定させて挿入することはできず、例えばS状結腸部への挿入については熟練した操作を要していた。 However, the conventional electric bending endoscope pulls the bending operation wire by electrically controlling the motor as the bending driving means based on the bending amount input by operating the bending input means. Alternatively, the bending portion is bent and the bending portion is bent. A plurality of bending pieces are connected to the bending portion, and the bending portion is configured to bend over the entire bending portion at the time of bending. For example, when inserted into a lumen such as the large intestine, the distal end of the bending portion The side cannot be inserted in a shape that matches the shape in the lumen and cannot be inserted. For example, the insertion into the sigmoid colon requires a skillful operation.
本発明は前記事情に鑑みてなされたものであり、湾曲部の先端側を固定すると同時に湾曲部が管腔内の形状に合った形状になるように湾曲部の駆動を制御することにより、医療用具の挿入部の挿入性を向上できる医療用制御装置を提供することを目的とする。 The present invention has been made in view of the above circumstances, and by fixing the distal end side of the bending portion and simultaneously controlling the driving of the bending portion so that the bending portion has a shape that matches the shape in the lumen. An object of the present invention is to provide a medical control device that can improve the insertion property of the insertion portion of the tool.
本発明の医療用制御装置は、被検体内に挿入される挿入部の先端側に、複数のリンク部材がそれぞれ回動自在に連設された湾曲部を有する医療用具と、前記複数のリンク部材をそれぞれ回動させて前記湾曲部を湾曲動作させるための駆動手段と、前記複数のリンク部材の内、最も先端側のリンク部材の位置と向きを指定する指定手段と、前記複数のリンク部材のそれぞれ隣り合うリンク部材のなす角度を演算する際に、前記隣り合うリンク部材のなす角度が予め設定された許容範囲内になるようにするためのパラメータを設定する設定手段と、前記医療用具の前記湾曲部が移動したときに前記指定手段により指定された位置と向きを維持しながら前記最も先端側のリンク部材及びこのリンク部材に連なる他のリンク部材が前記位置を通過するように、前記設定手段により設定されたパラメータに基づいて前記複数のリンク部材のそれぞれの角度を演算し、この演算結果に基づいて、前記複数のリンク部材を回動させるように前記駆動手段を制御する制御手段と、を有している。 The medical control device of the present invention includes a medical device having a curved portion in which a plurality of link members are rotatably connected to the distal end side of an insertion portion to be inserted into a subject, and the plurality of link members. Each of the plurality of link members, a designation unit for designating the position and orientation of the most distal link member, and a plurality of link members. A setting means for setting parameters for causing the angle formed by the adjacent link members to fall within a preset allowable range when calculating the angle formed by the adjacent link members, and the medical device When the bending portion moves, the most distal link member and other link members connected to the link member pass through the position while maintaining the position and orientation specified by the specifying means. As described above, the angle of each of the plurality of link members is calculated based on the parameter set by the setting unit, and the drive unit is controlled to rotate the plurality of link members based on the calculation result. Control means.
本発明によれば、湾曲部の先端側を固定すると同時に湾曲部が管腔内の形状に合った形状になるように湾曲部の駆動を制御することにより、医療用具の挿入部の挿入性を向上できる医療用制御装置の実現が可能となる。 According to the present invention, by fixing the distal end side of the bending portion and simultaneously controlling the driving of the bending portion so that the bending portion matches the shape in the lumen, the insertion property of the insertion portion of the medical device can be improved. A medical control device that can be improved can be realized.
以下、図面を参照して本発明の実施例を説明する。 Embodiments of the present invention will be described below with reference to the drawings.
図1乃至図29は本発明の実施例1における医療用制御装置の基本構成を説明するためのもので、図1は医療用制御装置を用いて内視鏡装置として構成した場合のシステム構成図である。 FIGS. 1 to 29 are for explaining the basic configuration of the medical control apparatus according to the first embodiment of the present invention. FIG. 1 is a system configuration diagram when the medical control apparatus is configured as an endoscope apparatus. It is.
図1に示すように、本発明に係る医療用制御装置を用いた内視鏡装置1は、挿入部先端部内に図示しない撮像手段を備え、操作部10内あるいは湾曲部14内に後述する挿入部9の湾曲部14を湾曲させるための駆動部10bを備えた医療用具としての電子内視鏡(以下、単に内視鏡)2と、前記内視鏡2に着脱自在に接続され、この内視鏡2に照明光を供給する光源装置3と、前記内視鏡2に着脱自在に接続され、前記内視鏡2の前記撮像手段を制御すると共に、この撮像手段から得られた信号を処理して標準的な映像信号を出力するビデオプロセッサ4と、前記ビデオプロセッサ4内あるいはこのビデオプロセッサ4とは別体に設けられ、前記湾曲部14を湾曲動作させるように前記内視鏡2の駆動部10bを制御するコントローラ5と、前記ビデオプロセッサ4で信号処理して得られた内視鏡画像を表示するモニタ6と、前記コントローラ5に電気的に接続される指定手段としての操作指令部7と、前記コントローラ5に電気的に接続される設定値入力手段としての設定値指令部8と、を有している。
なお、前記ビデオプロセッサ4には、図示しないVTRデッキ,ビデオプリンタ,ビデオディスク,画像ファイル記録装置などが接続できるようになっている。
As shown in FIG. 1, an
The
前記内視鏡2は、観察対象部位へ挿入する細長の挿入部9と、この挿入部9の基端部に連設され、ビデオスイッチや送気・送水スイッチ等の操作部10aを有する把持部12と、この把持部12の側面より延設され、図示しない撮像手段に接続する信号ケーブルや照明光を伝達するライトガイドなどを内蔵したユニバーサルコード11と、このユニバーサルコード11の端部に設けられ、前記光源装置3及びビデオプロセッサ4に着脱自在に接続されるコネクタ部12と、を有している。
The
前記挿入部9は、先端に設けられた先端部13と、この先端部13の後部(被検体に挿入される挿入部9の先端側)に設けられた湾曲自在の湾曲部14と、この湾曲部14の後部に設けられ、軟性の管状の部材より形成される長尺で可撓性を有する可撓管部15とが連設されて構成している。
The
前記先端部13は、撮像手段としてCCDなどの図示しない固体撮像素子及びこの固体撮像素子を駆動するための回路基板などが組み込まれた撮像部や、体腔内の観察対象部位を照明するための照明光を伝達する図示しないライトガイドなどを内蔵して構成されている。なお、前記湾曲部14の構成については後述する。
The
前記コントローラ5には、接続線7bを介して前記操作指令部7が電気的に接続されている。この操作指令部7は、例えばジョイスティック7aを備えて構成されたものであり、このジョイスティック7aを操作することにより前記湾曲部14を湾曲動作させるための操作指令値信号を出力する。
The operation command unit 7 is electrically connected to the
また、前記コントローラ5には、接続線8bを介して設定値指令部8が電気的に接続されている。この設定値指令部8は、例えばキーボード8aを用いて構成されたものであり、このキーボード8aによるキー操作によって、コントローラ5に対し前記湾曲部14を湾曲させるのに必要な各種設定値の入力を行う。
The
次に、前記湾曲部14の構成について、図3乃至図8を参照しながら説明する。また、前記湾曲部14については、簡単のため、平面的動作駆動部としての取り扱いとして説明を行う(2次元の平面動作)。
図3及び図4はリンク構造の駆動機構を備えた湾曲部を有する挿入部先端側の概略構成を説明するもので、図3は挿入部先端側の斜視図、図4は挿入部先端側の断面図である。また、図5は駆動機構がモータ及びギアで構成された湾曲部の構成を示す断面図、図6は図5に示す湾曲部の変形例1の構成を示す断面図、図7は図5に示す湾曲部の変形例2の構成を示す断面図、図8はモータとフレシキブルシャフトとの接続構成を示す斜視図である。
Next, the configuration of the
3 and 4 illustrate a schematic configuration of the distal end side of the insertion portion having a bending portion having a link structure drive mechanism. FIG. 3 is a perspective view of the distal end side of the insertion portion, and FIG. It is sectional drawing. 5 is a cross-sectional view showing the configuration of the bending portion in which the drive mechanism is constituted by a motor and a gear, FIG. 6 is a cross-sectional view showing the configuration of Modification Example 1 of the bending portion shown in FIG. 5, and FIG. Sectional drawing which shows the structure of the
図3及び図4に示すように、前記挿入部9の湾曲部14は、被検体内に挿入される挿入部9の先端側に設けられいる。この湾曲部14は、挿入部駆動機構20を有し、この挿入部駆動機構20は、複数のリンク部材21a、21b、21c…21nが複数の関節部材20a、20b、20c…20nによってそれぞれ回動自在に連接されることにより、構成している。つまり、挿入部駆動機構20は、多関節のリンク構造を有している。
As shown in FIGS. 3 and 4, the
また、前記駆動部10bは、前記複数のリンク部材21a、21b、21c…21nをそれぞれ回動させるための駆動源であるモータ27(図5及び図8参照)である。
この駆動部10bであるモータ27が前記操作部10内に設けられた場合には、図8に示すようにモータ27の駆動軸27aにはジョイント30aを介してフレシキブルシャフト30が連結される。そして、このフレシキブルシャフト30は、図示しないが挿入部9内に延設され、基端部が前記複数のリンク部材21a、21b、21c…21nに連結される。このことにより、それぞれのモータ27の回転力がフレシキブルシャフト30を介して、前記複数のリンク部材21にそれぞれ伝達されるようになっている。
The
When the
また、前記駆動部10bであるモータ27が挿入部9の湾曲部14内に設けられた場合には、図5に示すように、モータ27は、前記挿入部駆動機構20を構成する前記複数のリンク部材21a、21b、21c…21n内にそれぞれ配設される。そして、モータ27の回転力は、前記モータ27と連結する連結ギア26等によって前記複数のリンク部材21a、21b、21c…21nにそれぞれ伝達されるようになっている。
Further, when the
なお、前記リンク部材21及び関節部材20の数は、図中に示す構成例に限定されるものではなく、前記内視鏡2の目的に応じて適宜その数を増減して構成することも可能である。また、前記リンク部材21aは、先端部13の最先端側に配置されたもので、このリンク部材21aの後端側には順にリンク部材21b、21c…21nが連結されるようになっている。また、これに伴い、前記関節部材20a、20b、20c…20nついても先端部13側から順にリンク部材21との間にそれぞれ配置されることになる。
The number of the
図5には前記湾曲部14の具体的な構成が示されている。
図5に示すように、前記湾曲部14の挿入部駆動機構20は、前記駆動部10bであるモータ27を前記複数のリンク部材21a、21b、21c…21n内にそれぞれ配設している。
前記複数のリンク部材21a、21b、21c…21nは、前記関節部材20a、20b、20c…20nであるジョイントシャフト22によってそれぞれ回動自在に連結されている。前記ジョイントシャフト22は軸部材であり、このジョイントシャフト22には、それぞれ検出手段としてのポテンショメータ23が装着されている。
FIG. 5 shows a specific configuration of the bending
As shown in FIG. 5, in the insertion
The plurality of
このポテンショメータ23は、ジョイントシャフト22の回転量を検出してリンク部材21の状態量検知信号として図示しない信号線を介して前記コントローラ5に出力するようになっている。
The
また、前記複数のリンク部材21a、21b、21c…21nの各基端側には、前記ジョイントシャフト22を回動自在に軸止した歯車24がそれぞれ固定されている。この歯車24には連結ギア26の歯車25が噛合される。この連結ギア26は、前記リンク部材21a、21b、21c…21n毎に設けられたモータ27の図示しない駆動軸と連結しており、この駆動軸の回転力は軸26aを介して前記歯車25に伝達されるようになっている。
Further, gears 24 are rotatably fixed to the base ends of the plurality of
このことにより、モータ27の回転力が連結ギア26の軸26a及び歯車25を介して歯車24に伝達されて、この歯車24が固定されたリンク部材21を所定方向に回動させることが可能である。
As a result, the rotational force of the
また、図5に示す湾曲部14は、各リンク部材21毎に挿入部駆動機構20を構成する、モータ27、連結ギア26,歯車24、25を有しているので、前記複数のリンク部材21a〜21nの内、指定したリンク部材21のモータ27の回転制御を行えば、前記指定されたリンク部材21のみを回転動作させることが可能である。
5 has the
なお、本実施例では、前記湾曲部14における駆動機構20を、図6に示す変形例1、あるいは図7に示す変形例2のように構成しても良い。このような湾曲部14の変形例1、変形例2を図6及び図7を参照しながら説明する。
In the present embodiment, the
変形例1及び変形例2における湾曲部14は、図5に示す湾曲部14とは異なり、各リンク部材21毎にモータ27を設けずに、駆動部10bであるモータ27を操作部10内に複数設けている。そして、これらのモータ27の回転力は、これらのモータ27の駆動軸30bにジョイント30aを介してそれぞれ連結され且つ挿入部9内に延設されるそれぞれのフレシキブルシャフト30を介して、これらのフレシキブルシャフト30にそれぞれ連結している前記複数のリンク部材21a、21b、21c…21nに伝達されるようになっている。
Unlike the bending
図6に示すように、変形例1の湾曲部14は、図5に示す挿入部駆動機構20と略同様の構成であるが、各リンク部材21毎に延設されるフレシキブルシャフト30の先端側に歯車29を設けている。
As shown in FIG. 6, the bending
この歯車29には、前記歯車25を逆側に設けた連結歯車28ギアが噛合する。この連結ギア28は前記リンク部材21内部に内装されており、この連結ギア28の軸29aの逆側に設けた歯車25を介して、フレシキブルシャフト30からの回転力を歯車24に伝達するようになっている。
このことにより、モータ27の回転力が、駆動軸30b、ジョイント30a、フレシキブルシャフト30、歯車29、連結歯車28、軸29a及び歯車25を介して歯車24に伝達されて、この歯車24が固定されたリンク部材21を所定方向に回動させることが可能である。
The
As a result, the rotational force of the
変形例1の湾曲部14は、図5に示す湾曲部14と同様に、各リンク部材21毎に挿入部駆動機構20を構成する、フレシキブルシャフト30、連結歯車28、歯車24、25を有しているので、前記複数のリンク部材21a〜21nの内、指定したリンク部材21のモータ27の回転制御を行えば、前記指定されたリンク部材21のみを回転動作させることがで可能である。
Similar to the bending
また、図7に示すように、変形例2の湾曲部14は、前記変形例1の挿入部駆動機構20と略同様の構成であるが、前記連結歯車28を無くし、各リンク部材21毎に延設されるフレシキブルシャフト30を各リンク部材21内部に配設するように構成している。
Further, as shown in FIG. 7, the bending
前記フレシキブルシャフト30の先端側には前記歯車25が設けられている。したがって、フレシキブルシャフト30からの回転力は、前記歯車25を介して、連結歯車28等の連結部材を介さすとも直に各リンク部材21の後端側に固定された歯車24に伝達されるようになっている。このことにより、前記変形例1と同様に前記歯車24が固定されたリンク部材21を所定方向に回動させることが可能である。
The
変形例2の湾曲部14は、前記変形例1と同様に各リンク部材21毎に挿入部駆動機構20を構成する、フレシキブルシャフト30、歯車24、25を有しているので、前記複数のリンク部材21a〜21nの内、指定したリンク部材21のモータ27の回転制御を行えば、前記指定されたリンク部材21のみを回転動作させることが可能である。
Since the bending
次に、このような湾曲部14を有する内視鏡2を備えた内視鏡装置1の電気的な主要構成について図2を参照しながら説明する。
図2は内視鏡装置1の主要構成部分の電気的な構成を示すブロック図である。
図2に示すように、前記内視鏡装置1は、例えばジョイスティック7aを用いて構成される操作手段及び指定手段としての操作指令部7と、キーボード8aを用いて構成される設定値入力手段としての設定値指令部8と、前記操作指令部7からの操作指令値信号、前記設定値指令部8により設定された設定値及び前記ポテンショメータ23等からの状態量検知信号に基づいて前記駆動部10bを制御するための駆動指令値信号を出力するコントローラ5と、前記コントローラ5からの駆動指令値信号に基づいてそれぞれ回転制御されるモータ27等の駆動部10bと、この駆動部10bの回転力によって姿勢制御される湾曲部14内に設けられた挿入部駆動機構20と、を有して主要部を構成している。
Next, an electrical main configuration of the
FIG. 2 is a block diagram showing an electrical configuration of main components of the
As shown in FIG. 2, the
前記操作指令部7は、ジョイスティック7aを用いて前記湾曲部14の湾曲を指示するための操作手段であり、操作に基づく操作指令値信号を前記コントローラ5に出力する。また、前記操作指令部7は、前記湾曲部14を構成する前記複数のリンク部材21a〜21nの内、2次元における位置と向きを固定するリンク部材21を指定する指定手段であり、この操作に基づく前記操作指令値信号を前記コントローラ5に出力する。
The operation command section 7 is an operation means for instructing the bending of the
前記コントローラ5、駆動部10b及び挿入部駆動機構20を有する主要部の制御ブロック図が図9に示されている。
図9に示すように、前記コントローラ5(図2参照)は、指令制御部5Aを有している。この指令制御部5Aには、前記操作指令部7からの操作指令値信号が供給されるようになっている。
FIG. 9 shows a control block diagram of the main part having the
As shown in FIG. 9, the controller 5 (see FIG. 2) has a command control unit 5A. An operation command value signal from the operation command unit 7 is supplied to the command control unit 5A.
前記指令制御部5Aは、供給された操作指令値信号及び状態量検知信号に基づき、アクチュエータ制御ブロック31に設けられた駆動部10bを制御するのに必要な演算処理等を行うものである。
The command control unit 5A performs arithmetic processing necessary to control the
前記指令制御部5Aには、前記湾曲部14の挿入部駆動機構20を構成する複数のリンク部材21毎に設けられた複数の第1、第2…第nアクチュエータ制御ブロック31a〜31nが電気的に接続されている。
The command control unit 5A is electrically provided with a plurality of first, second... Nth actuator control blocks 31a to 31n provided for each of the plurality of
図10は図9に示す前記指令制御部5A及びアクチュエータ制御ブロック31の具体的な構成を示すブロック図である。
図10に示すように、前記指令制御部5Aは、前記操作指令部7からの操作指令値信号を入力するための入力部I/F33と、前記設定値指令部8からの設定指令値を入力するための入力部I/F34、35と、これらのI/F33〜35を介して入力された各種指令値信号に基づき、前記第1、第2、…第nアクチュエータ制御ブロック31a〜31n内の駆動部10bを制御する中央処理演算装置(例えばCPU)32と、を有している。
FIG. 10 is a block diagram showing a specific configuration of the command control unit 5A and the
As shown in FIG. 10, the
なお、前記入力部I/F33は、ジョイスティック7aがアナログの操作指令値信号を出力するものである場合にはこのアナログ信号の入力が可能である。また、前記入力部I/F33は、操作指令部7が他のデジタルの操作指令値信号を出力する操作手段である場合にはこのデジタル信号の入力が可能である。
The input unit I /
また、前記入力部I/F34は、連続的に動作するのに必要なアナログの設定値指令信号の入力が可能であり、前記入力部I/F35はパラメータ変更などのデジタルの設定指令値の入力が可能である。前記入力部I/F34と前記入力部I/F35とは1つのI/Fとして構成しても良い。
The input unit I /
一方、前記アクチュエータ制御ブロック31は、高速で各種の演算処理を行うとともに、演算結果に基づき駆動指令値信号を生成し出力するデジタルシグナルプロセッサ(Digital Signal Processor で、以下、DSPと称す)36と、このDSP36からの駆動指令値信号(サーボ指令値信号)に基づき操作出力値信号(駆動信号)を生成し出力する制御指令値出力部37と、この制御指令値出力部37からの操作出力値信号に基づき回転が制御される駆動部10bであるモータ27と、このモータ27の回転位置を検出するエンコーダやリンク部材21の回転角度を検出するポテンショメータ23等の検出手段であるセンサ38と、このセンサ38により検出された位置情報である状態量検知信号を検出して前記DSP36に出力するための信号入力部39と、を有している。
On the other hand, the
なお、本実施例では、前記駆動部10bとしてモータ27を用いているが、これに限定されることはなく、他のアクチュエータを駆動部10bとして用いるように構成しても良い。
In this embodiment, the
図11は前記アクチュエータ制御ブロックの具体的な構成を示すブロック図であり、図12は図11のサーボ制御コントローラのブロック図を示している。
図10に示すアクチュエータ制御ブロック31において、前記DSP36は図11に示すサーボ制御コントローラ36Aを構成し、このサーボ制御コントローラ36Aは、供給されたサーボ指令値信号に基づく操作出力値信号(駆動信号)を生成し、前記制御指令値出力部37であるドライバ(アンプ)37aに出力する。なお、前記サーボ制御コントローラ36Aは、図10に示すCPU32に置き換えて構成しても良い。
FIG. 11 is a block diagram showing a specific configuration of the actuator control block, and FIG. 12 is a block diagram of the servo controller shown in FIG.
In the
前記ドライバ37aは、供給された操作出力値信号を増幅してモータ27を回転させる。すると、このモータ27の回転により図5に示すリンク部材21は回動動作する。このとき、前記センサ38は、リンク部材21の状態量検知信号を生成し、前記信号入力部39である検知部(アンプ)39aに出力する。
The driver 37a amplifies the supplied operation output value signal and rotates the
前記検知部39aは、供給された状態量検知信号を増幅して前記サーボ制御コントローラ36Aに出力する。このことにより、サーボ制御コントローラ36Aは、供給された状態量検知信号とサーボ指令値信号との比較を行いながら前記モータ27の回転制御を行うようになっている。
The detection unit 39a amplifies the supplied state quantity detection signal and outputs it to the servo controller 36A. Thus, the servo controller 36A controls the rotation of the
この場合、前記サーボ制御コントローラ36Aは、図12に示すように、供給されたサーボ指令値信号と、前記センサ38により得られたモータ27の変位情報である状態検出信号とに基づいて、PD制御部40を用いて公知の比例・微分制御等のPD制御を行って操作出力値信号(駆動信号)を生成し、モータ27に与えることにより回転制御する。
In this case, the servo controller 36A performs PD control based on the supplied servo command value signal and a state detection signal which is displacement information of the
ところで、このような多関節のリンク構造の湾曲部14を備えた内視鏡2では、大腸などの管腔内の形状に合わせた形状で挿入するためには、先端側のリンク部材21aを最適な姿勢角度に制御すると同時に、これに連動してこの先端側のリンク部材21aに連なる複数他のリンク部材21についても制御する必要がある。このような本発明に用いられる基本的な制御方法を図13乃至15を参照しながら説明する。
By the way, in the
図13乃至図15は他関節のリンク構造を有する湾曲部の姿勢制御を説明するもので先端部13側のリンク部材21a〜21cに対応した説明図であり、図13は先端部13側のリンク部材21aが所定の先端位置及び姿勢ベクトルの状態である図、図14は図13のリンク部材21aの姿勢状態である場合に予想される他のリンク部材の状態を示す図、図15は先端部13側のリンク部材21aのみを独立的に姿勢制御した所定の位置及び姿勢ベクトルの状態を示す図である。
FIGS. 13 to 15 are explanatory views corresponding to the link members 21a to 21c on the
本実施例のコントローラ5の指令制御部5Aは、前記湾曲部14を構成する複数のリンク部材21a〜21nをそれぞれ姿勢制御する際に、後述する運動学(順運動学及び逆運動学)に基づく演算処理を行うようになっている。
The command control unit 5A of the
なお、順運動学に基づく演算処理とは、各関節(各リンク部材21)の角度が得られたとき、先端部の位置・姿勢ベクトルを求めるための演算処理であり、逆運動学に基づく演算処理とは、先端部の位置・姿勢ベクトルが得られたとき、各関節(各リンク部材21)の角度を求めるための演算処理を意味している。今後、簡単のため、3リンク及び前述した様に2次元平面に限った動作説明を行うが、2次元平面動作から3次元空間動作に置換することは、よく知られているロボットの座標変換処理と同様にDH法(Denavit−Hartenberg表記法)による処理に差し替えることで対応可能となる。
前記指令制御部5Aは、後述するロボットの運動学を定量化する基本式に基づき、演算処理を行う。このようなロボットの運動学を定量化する基本式を下記に示す。
ここで、xを手先座標、qを関節座標、及びJをヤコビアン(速度ベクトル)とすると、下記の式が定義できる。なお、x、q、Jは、それぞれのベクトルを示すものとする。
(式1)
(式2)
そして、以上の式(式1、式2)と各リンク拘束条件の運動学(ラグランジュアン)を解けば、下記のロボットダイナミクス(関節座標におけるトルクτ(または(∂2q/∂t2 ))とダイナミクスとの関係)を導出することが可能である。
(式3)
ただし、H(q)は慣性行列項、hはコリオリ及び姿勢変化に依存するダイナミクス項、gは重力項、τEXTは外乱要素を表す。
The arithmetic processing based on forward kinematics is arithmetic processing for obtaining the position / posture vector of the tip when the angle of each joint (each link member 21) is obtained. The process means a calculation process for obtaining the angle of each joint (each link member 21) when the position / posture vector of the tip portion is obtained. In the future, for the sake of simplicity, the explanation will be given only for the three links and the two-dimensional plane as described above. However, replacing the two-dimensional plane movement with the three-dimensional spatial movement is a well-known robot coordinate transformation process. Similarly, it can be handled by replacing the processing with the DH method (Denavit-Hartenberg notation).
The command control unit 5A performs arithmetic processing based on a basic expression for quantifying the kinematics of the robot described later. The basic formula for quantifying the kinematics of such a robot is shown below.
Here, when x is a hand coordinate, q is a joint coordinate, and J is a Jacobian (speed vector), the following equation can be defined. Note that x, q, and J represent respective vectors.
(Formula 1)
(Formula 2)
Solving the above equations (
(Formula 3)
Here, H (q) is an inertia matrix term, h is a dynamics term depending on Coriolis and posture change, g is a gravity term, and τEXT is a disturbance element.
各関節(各リンク部材21であり図13中のq1、q2、q3)と手先位置(先端側のリンク部材21aの位置でありq1)とにおいて、手先位置加速度と関節加速度との動的関係については、前記(式1)〜(式3)の関係と、前記(式2)両辺を時間による微分操作を行った結果を用いて、
X=J・(d2q/dt2)+(dJ/dt)・(dq/dt)の関係と、右辺を行列分解(特異値分解など)することで行列空間を核空間(Kernell)と零空間(Null)に分解することができる。
Regarding the dynamic relationship between the hand position acceleration and the joint acceleration at each joint (each
X = J · (d 2 q / dt 2 ) + (dJ / dt) · (dq / dt) and matrix decomposition (singular value decomposition or the like) on the right side makes the matrix space a kernel space (Kernell). It can be decomposed into a null space (Null).
これにより、下記に示す(式4)を導出することが可能である。 This makes it possible to derive (Equation 4) shown below.
(式4)
ただし、(式4)中の表記#は擬似逆行列を表している。概して、前記(式4)において、左辺第1項は手先位置の動きを表し、第2項は手先以外の各関節の動きを表している。したがって、手先位置(先端側リンク部材21aの位置でq1)を決定する場合にそれ以降の関節姿勢(他のリンク部材21b〜21nでq1,q2)は、一意に決定されない。
(Formula 4)
However, the notation # in (Expression 4) represents a pseudo inverse matrix. In general, in the (Equation 4), the first term on the left side represents the movement of the hand position, and the second term represents the movement of each joint other than the hand. Therefore, when the hand position (q1 at the position of the distal end side link member 21a) is determined, the joint postures thereafter (q1, q2 for the
つまり、図14に示すように、先端部のq1の位置が指定した場合、このq1を含むq2、q3からなるリンク部材の姿勢の取り方は、図中実線に示す姿勢以外に点線で示す姿勢のとり方も行うことができ、姿勢が一意には決まるものではない。すなわち、湾曲部14の各リンク部材21は、ロボットの姿勢の冗長性を有することになる。
That is, as shown in FIG. 14, when the position of q1 at the tip is designated, the posture of the link member composed of q2 and q3 including q1 is determined by the dotted line in addition to the solid line in the figure. The attitude is not uniquely determined. That is, each
そして、コントローラ5の指令制御部5Aは、前記(式3)、(式4)のリンク運動方程式を実時間で制御するための各リンクに付与すべきトルク計算、すなわち後述する(式7)、(式8)の計算を行うが、図15に示すように、先端部から次段のリンク部材21b、21c(q2、q3)についてはリンク位置・姿勢の運動学に基づく演算処理を行い、先端側のリンク部材21a(q1)については、独立的に駆動制御するアルゴリズム(図示しないメモリに記憶されている)に基づいて演算処理を行うようになっている。
Then, the command control unit 5A of the
このことにより、先端側のリンク部材21aの位置、姿勢(向き)が決定すると、前記演算処理を行うことにより、先端側のリンク部材21aに連なる他のリンク部材21の角度を求めることが可能である。
Accordingly, when the position and orientation (orientation) of the link member 21a on the distal end side are determined, the angle of the
次に、前記運動学(順運動学及び逆運動学)に基づく演算処理を行うためのサーボ制御コントローラ36Aの具体的な構成及び制御方法について図16乃至21を参照しながら説明する。 Next, a specific configuration and control method of the servo controller 36A for performing arithmetic processing based on the kinematics (forward kinematics and inverse kinematics) will be described with reference to FIGS.
図16乃至図21はサーボ制御コントローラ36Aの具体的な構成及び制御方法を説明するためのもので、図16はサーボ制御コントローラ36Aの概略構成を示すブロック図、図17は図16の制御則演算部36Bの具体的な構成を示すブロック図、図18は図17のダイナミックス演算部43の概略構成を示すブロック図、図19は図18のダイナミックス演算部43の具体的な構成を示すブロック図、図20は図17の運動学演算部41の概略構成を示すブロック図、図21は図20の運動学演算部41の具体的な構成を示すブロック図をそれぞれ示している。
16 to 21 are diagrams for explaining a specific configuration and control method of the servo control controller 36A. FIG. 16 is a block diagram showing a schematic configuration of the servo control controller 36A. FIG. 17 is a control law calculation of FIG. 18 is a block diagram showing a specific configuration of the unit 36B, FIG. 18 is a block diagram showing a schematic configuration of the
図16に示すように、サーボ制御コントローラ36Aは、制御則演算部36Bを有しており、この制御則演算部36Bには、先端側のリンク部材21aあるいは各リンク部材21におけるサーボ指令値信号を含む設定指令値信号等の指令値情報(設定値情報も含む)と、各リンク部材21における状態量検知信号などの位置フィードバック情報(以下、位置F/B情報と称す)とが供給される。
As shown in FIG. 16, the servo controller 36A has a control law calculation unit 36B. The control law calculation unit 36B receives the servo command value signal from the link member 21a on the distal end side or each
そして、前記制御則演算部36Bは、供給された指令値情報と位置F/B情報とに基づいて、後述する運動学演算部41及びダイナミックス演算部43に各リンク部材21に対応する駆動指令値信号としての関節トルク指令値信号を得るための演算処理を行い、駆動部10bに出力する。
Based on the supplied command value information and position F / B information, the control law calculation unit 36B sends a drive command corresponding to each
前記制御則演算部36Bの具体的な構成が図17に示されている。 A specific configuration of the control law calculation unit 36B is shown in FIG.
図17に示すように、前記制御則演算部36Bは、先端側のリンク部材21aの先端位置座標である指令値位置情報と、各関節(各リンク部材21)の関節位置F/B情報とを入力して、これらの情報を用いて運動学に基づく演算処理を行う運動学演算部41と、この運動学演算部41の演算結果と、前記指令値情報及び関節位置F/B情報とを入力して、これらの情報を用いて各リンク部材21の変化量に関する動的な部分を導き出すためにダイナミクス演算処理を行うダイナミックス演算部43と、前記指令値情報と前記運動学演算部41及び前記ダイナミックス演算部43との各演算結果とを入力し、これらの情報に基づいて各リンク部材21を制御するのに必要な関節トルク指令値信号を演算処理する制御演算部42と、を有している。
As shown in FIG. 17, the control law calculation unit 36B obtains command value position information that is the tip position coordinates of the link member 21a on the tip side, and joint position F / B information of each joint (each link member 21). The
そして、前記制御則演算部36Bは、生成された前記関節トルク指令値信号を、前記アクチュエータ制御ブロック31内の駆動部10bに供給することにより、挿入部駆動機構(マニピュレータ)20を制御する。
このとき、マニピュレータ20は、前記アクチュエータ制御ブロック31内のセンサ38によって検出された、状態量検知信号である各関節の関節位置F/B情報を前記運動学演算部41及びダイナミックス演算部43に出力する。
The control law calculation unit 36B controls the insertion unit drive mechanism (manipulator) 20 by supplying the generated joint torque command value signal to the
At this time, the
図18に前記ダイナミックス演算部43の概略構成を示し、図19に前記ダイナミクス演算部の具体的な構成が示されている。
図18に示すように、前記ダイナミックス演算部43は、前記運動学演算部41の演算結果である後述するヤコビアン(速度ベクトルで、JあるいはヤコビアンJとして説明することもある)と、前記指令値情報及び関節位置F/B情報とを入力して、これらの情報を用いてダイナミックス演算処理を行うことにより、各リンク部材21の変化量に関する動的な部分、すなわち、各リンク部材21の位置偏差、ヤコビアンJ、関節位置速度・加速度を導き出し、演算処理結果として出力する。
FIG. 18 shows a schematic configuration of the
As shown in FIG. 18, the
具体的には、前記ダイナミックス演算部43は、図19に示すように、順運動学演算部44と、時間微分演算部45と、時間微分演算部46と、を有している。
Specifically, the
前記順運動学演算部44は、前記関節位置F/B情報に基づいて前記した順運動学に基づく演算処理を行う。この演算出力結果は、減算器によって先端部のリンク部材21aの先端位置情報から差し引かれることにより、各リンク部材21の位置偏差eが導きだされる。
The forward
前記時間微分演算部45は、前記関節位置F/B情報とヤコビアンJとが入力され、前記関節位置F/B情報とヤコビアンJとを用いて時間微分演算処理を行うことにより、各リンク部材21の変位量、すなわち、ヤコビアン速度 ∂J/∂t、関節位置速度∂q/∂tを生成する。
The time
前記時間微分演算部46は、前記関節位置速∂q/∂tを入力して時間微分演算処理を行うことにより、関節位置加速度∂2q/∂t2 を生成する。
The time
図20に前記運動学演算部41の概略構成を示し、図21に前記運動学演算部41の具体的な構成が示されている。
図20に示すように、前記運動学演算部41は、前記指令値情報及び関節位置F/B情報を入力して、これらの情報を用いて運動学に基づく演算処理を行うことにより、先端側のリンク部材21aのヤコビアンJ、ヤコビアンJの疑似逆行列J+、及びヤコビアンJの零空間疑似逆行列(I−J+J)を導き出し、演算処理結果として出力する。
FIG. 20 shows a schematic configuration of the
As shown in FIG. 20, the
具体的には、前記運動学演算部41は、図21に示すように、ヤコビアン演算部47と、疑似逆行列演算部48と、ヤコビアン零空間演算部49と、を有している。
前記ヤコビアン演算部47は、前記指令位置情報と位置F/B情報に基づいてヤコビアンJを得るための演算処理を行い、得られたヤコビアンJを図17に示す制御演算部42、前記疑似逆行列演算部48及び前記ヤコビアン零空間演算部49に出力する。
Specifically, the
The
なお、前記ヤコビアン演算部47によるヤコビアン演算処理に基づく(式5)を下記に示す。
In addition, (Formula 5) based on the Jacobian arithmetic processing by the Jacobian
(式5)
前記疑似逆行列演算部48は、前記ヤコビアンJが入力され、このヤコビアンJに一般化逆行列演算処理を行うことにより、疑似逆後列J+を生成し、図17に示す制御演算部42及び前記ヤコビアン零空間演算部49に出力する。
(Formula 5)
The pseudo inverse matrix calculation unit 48 receives the Jacobian J and performs a generalized inverse matrix calculation process on the Jacobian J, thereby generating a pseudo inverse rear sequence J + , and the
なお、一般化逆行列演算処理に基づく(式6)を下記に示す。 Note that (Equation 6) based on the generalized inverse matrix calculation processing is shown below.
(式6)
ただし、式中のスーパースクリプトTは転置行列を表している。
(Formula 6)
However, the superscript T in the formula represents a transposed matrix.
前記ヤコビアン零空間演算部49は、供給されたヤコビアンJと前記疑似逆後列J+とにヤコビアン零空間演算処理を行うことにより、行列擬似逆行列1−J+Jを生成し、前記図17に示す制御演算部42に出力する。
The Jacobian null
したがって、前記ヤコビアンJ、ヤコビアンJの疑似逆行列J+及びヤコビアン零空間疑似逆行列(I−J+J)は前記運動学演算部41の演算処理結果として、図17に示す制御演算部42に供給されることになる。制御演算部42においては、前述した指令値と状態量とに基づくPD制御を行う。
Therefore, the Jacobian J, the Jacobian J pseudo-inverse matrix J + and the Jacobian null space pseudo-inverse matrix (I−J + J) are stored in the
次に、前述した図17に示す制御則演算部36B内にて行われる各種演算処理に必要な制御則式を説明する。
本発明の医療用制御装置を用いた内視鏡装置1は、複数のリンク部材21と、複数の関節部材20aとを有してマニピュレータを構成する挿入部駆動機構20を備えている。このため、前記図17に示す制御則演算部36Bは、マニピュレータ運動方程式である前記(式3)、(式4)を基本とし、さらに、後述するマニピュレータ制御則に基づく各式を用いて各種演算処理を行うことにより、前記関節トルク指令値信号を導いている。
Next, control law formulas necessary for various arithmetic processes performed in the control law calculation unit 36B shown in FIG. 17 will be described.
The
前記マニピュレータ制御則に基づく式を下記に示す。この場合、関節トルクをτとし、位置偏差eとすると、
(式7)
となる。
An expression based on the manipulator control law is shown below. In this case, if the joint torque is τ and the position deviation is e,
(Formula 7)
It becomes.
ただし、KP は制御量比例ゲイン、KD は制御量微分ゲイン、eは指令値と状態量から算出される位置偏差、φは前述した冗長性に重み付けするための制御パラメータ、h(*,*)、gは前述したパラメータである。 Where KP is the control amount proportional gain, KD is the control amount derivative gain, e is the position deviation calculated from the command value and the state quantity, φ is the control parameter for weighting the redundancy described above, and h ( * , * ) , G are the parameters described above.
(式8)
となる。なお、KNULL は、前記制御演算部42にて用いられる係数である。
(Formula 8)
It becomes. K NULL is a coefficient used in the
前記(式7)においては、図17に示す前記運動学演算部41、前記ダイナミックス演算部43及び前記制御演算部42によって各種求められた演算処理結果を当てはめることにより、関節トルクτを得ることができる。
In (Equation 7), the joint torque τ is obtained by applying the calculation processing results obtained by the
また、前記(式8)において、前記KNULL 以外の値については、前記運動学演算部41によって求められた演算結果である。
In the above (Expression 8), values other than the K NULL are calculation results obtained by the
ところで、前記構成の内視鏡2の挿入部9を体腔内の挿入する場合、湾曲部14が剛体とならないように、湾曲部自体が柔らかなダイナミクス特性にすることが望ましい、そのためには、図22に示すようなばね20a及びダンパ20bの組み合わせによるダイナミクス特性を先端部で有することで実現している。
By the way, when inserting the
言い換えれば、ばね200a及びダンパ200bによる粘弾性作用により、図22中に示す力量Fが挿入部9の先端部13に加えられると、前記湾曲部14は、柔らかな特性、すなわち、コンプライアンス特性を有することになる。
以下、制御演算部42に実装される制御則についての説明を行う。
In other words, when the force F shown in FIG. 22 is applied to the
Hereinafter, the control law implemented in the
まず、図22におけるダイナミクス特性の運動方程式は、(式9)の通りに記述される。 First, the equation of motion of the dynamics characteristic in FIG. 22 is described as (Equation 9).
(式9)
(式9)から、マニピュレータ手先の指令位置をX、手先に加わる外力をFTIP 、その結果、生じる位置をXDとすれば、コンプライアンス特性を有する先端のダイナミクス特性は、(式10)の通りとなる。
(Formula 9)
From (Equation 9), if the command position of the manipulator hand is X, the external force applied to the hand is F TIP , and the resulting position is X D , the dynamics characteristic of the tip having compliance characteristics is as follows (Equation 10) It becomes.
(式10)
ここで、FTIPに抗する等価な関節力τFは、(式11)の通りである。
(Formula 10)
Here, the equivalent joint force tau F against the F TIP, is as (Equation 11).
(式11)
また、簡単のため先端部が拘束された状態で外部環境から外力Fを受けたときの運動方程式は、先端部質量Mについてのみに対して記述すると(式12)の通りとなる。
(Formula 11)
For simplicity, the equation of motion when the external force F is received from the external environment while the tip is constrained is expressed as (Formula 12) when only the tip mass M is described.
(式12)
さて、前述したように、マニピュレータの運動方程式は、(式13)より、(式14a)及び(式14b)が導出される。
(Formula 12)
As described above, the equations of motion of the manipulator are derived from (Expression 13) and (Expression 14a) and (Expression 14b).
(式13)
(式14a)
(式14b)
ここで、改めて、各リンクのパラメータを含めたマニピュレータダイナミクスの記述を行ったときのコンプライアンス特性は(式15)の通りとなる。
(Formula 13)
(Formula 14a)
(Formula 14b)
Here, the compliance characteristics when the manipulator dynamics including the parameters of each link are described again are as shown in (Equation 15).
(式15)
前記(式15)を前記(式14a)に代入すると、(式16)の通りとなる。
(Formula 15)
Substituting (Equation 15) into (Equation 14a) yields (Equation 16).
(式16)
前記(式16)は(式7)と同様なものを別の形で示したものである。ここでは、簡単のため先端部にバネ特性Kを有するトルク指令の制御式を導出する。
(Formula 16)
The above (Formula 16) shows the same thing as (Formula 7) in another form. Here, for simplicity, a control formula for a torque command having a spring characteristic K at the tip is derived.
(式16)において、速度が小さいときには、下記に示す(式17)の右辺1,2項を省略することが可能となるため、(式17)が導出され、さらに、D=0、KF=Iとし、先端変位量△X=(X−XD)が比較的小さいと仮定すれば、近似的に△X=J(q)・△qが正立する。
In (Expression 16), when the speed is low, it is possible to omit the
その結果、(式18)が導出される。これは、所望のコンプライアンス特性としてKを設定した場合の各関節にどのようなトルク指令を生成させたかを示している。 As a result, (Equation 18) is derived. This indicates what kind of torque command is generated for each joint when K is set as the desired compliance characteristic.
(式17)
(式18)
前述のことから、(式7)、(式16)に関して、概して、(式4)において左辺第1項は手元位置の動きを表し、第2項は関節の動きを表していることが解る。
(Formula 17)
(Formula 18)
From the above, with regard to (Expression 7) and (Expression 16), it can be generally understood that in (Expression 4), the first term on the left side represents the movement of the hand position, and the second term represents the movement of the joint.
そこで、前記コントローラ5の指令制御部5Aは、前述したように前記(式7)、(式8)を実時間でトルク計算を行うが、前記(式7)の2項に該当する値を、リンク部材21の可動範囲に応じた重み付けを演算処理した結果として、駆動部10bを駆動制御するアルゴリズムに基づいて、演算処理を行うようにしても良い。
Therefore, the command control unit 5A of the
つまり、前記(式7)の2項の(I−J#xJ)・(d2q/dt2)のアルゴリズムを、例えば図24に示すようなパラメータである重み関数φに変更して演算処理を行う。すなわち、前記重み関数φは、各リンク部材21の角度を決定する際に、各リンク可動範囲限界においては重みが大きくなり、可動範囲中立位置近傍においては重みが小さくなるような演算処理を行う。すなわち、各リンクの姿勢は出来るだけ、中立付近になるような姿勢となる重み設定となり、無理な姿勢を排除し、動き安い範囲内で動作するための係数である。
In other words, the algorithm of (I−J # xJ) · (d 2 q / dt 2 ) in the second term of (Equation 7) is changed to a weight function φ that is a parameter as shown in FIG. I do. That is, when determining the angle of each
なお、予め設定された許容範囲内とは、例えば隣り合うリンク部材21のなす角度が±90度の範囲内を意味している。つまり、前記パラメータは、前記隣り合うリンク部材21のなす角度が鋭角にならないようにするためのものとなっている。
Note that “within a preset allowable range” means, for example, that the angle formed by
このことにより、前記挿入部駆動機構20の各リンク部材21が動き安く、且つ滑らかな姿勢制御が可能となる。
As a result, each
なお、前記重み関数φは、後述する図25乃至図29のいずれかのグラフに示すような重み関数を用いても良い。 The weight function φ may be a weight function as shown in any of the graphs of FIGS. 25 to 29 described later.
このような図25乃至図29に示す重み関数の特性を説明する。なお、これら25乃至図29の縦軸は(式8)におけるKNULL を示し、横軸は各リンク部材21の動作範囲(各リンク部材21の検出された角度)を示している。また、正の動作制限値は90度であり、負の動作制限値は−90度としている。 The characteristics of the weight function shown in FIGS. 25 to 29 will be described. The vertical axes of these 25 to 29 indicate K NULL in (Equation 8), and the horizontal axis indicates the operating range of each link member 21 (detected angle of each link member 21). The positive operation limit value is 90 degrees, and the negative operation limit value is −90 degrees.
図25は重み関数φの変形例1の特性を示すグラフである。図25に示すように、前記重み関数φは1次関数であり、各リンク部材21の位置変化に対応する下記に示すように演算処理することにより得た重み関数としたものである。
FIG. 25 is a graph showing the characteristics of
(式19)
なお、この場合αを負定値、qiを各リンク位置、qi_orgをリンク原点位置とする。 また、図26は重み関数φの変形例2の特性を示すグラフである。図26に示すように、前記重み関数φは2次関数であり、各リンク部材21の位置変化に対応する下記に示すように演算処理することにより得た重み関数としたものである。
(Formula 19)
In this case, α is a negative definite value, qi is each link position, and qi_org is the link origin position. FIG. 26 is a graph showing the characteristics of
(式20)
なお、この場合、αは負定値である。
(Formula 20)
In this case, α is a negative definite value.
また、図27は重み関数φの変形例3の特性を示すグラフである。図27に示すように、前記重み関数φは、各リンク部材21の位置変化に対応する偏微分を下記に示すように演算処理することにより得た重み関数としたものである。
FIG. 27 is a graph showing the characteristics of
(式21)
なお、この場合、αは負定値、qiは各リンク位置、qi_orgはリンク原点位置、qi_maxはリンク上限角度値、qi_minはリンク下限角度値である。
(Formula 21)
In this case, α is a negative definite value, qi is each link position, qi_org is a link origin position, qi_max is a link upper limit angle value, and qi_min is a link lower limit angle value.
また、図28は重み関数φの変形例4の特性を示すグラフである。図28に示すように、前記重み関数φは、場合によっては前記図27に示す重み関数とは逆に、出来るだけ動作制限値近傍になるような重み関数として、後述する(式22)にφのオフセット値を加えて新たにφとしαを正定値とすることで図28の重み関数も実現できる。なお、この場合αは正定値である。
FIG. 28 is a graph showing the characteristics of
また、図29は重み関数φの変形例5の特性を示すグラフである。図29示すように、前記重み関数φは、前記変形例4の同様の効果として、図中波線部分を含むような三角関数の絶対値を(式22)の通り用いたものでも良い。
FIG. 29 is a graph showing the characteristics of
(式22)
なお、この場合、αは負定値である。
(Formula 22)
In this case, α is a negative definite value.
したがって、前述した図25乃至図29のいずれかのグラフに示すような前記重み関数φを用いて演算処理を行うことにより、無理な姿勢を排除し、動き易い範囲内で動作するための角度を各リンク部材21毎に取得することが可能である。
Therefore, by performing arithmetic processing using the weight function φ as shown in any of the graphs of FIG. 25 to FIG. 29 described above, an excessive posture is eliminated, and an angle for operating within a range in which movement is easy is obtained. It can be acquired for each
また、本実施例では、各リンク部材21毎に重み付けを行うのではなく、マニピュレータ20全体に対して、無理な姿勢を排除し、動き易い範囲内で動作するための重み付けを行うことも可能である。
Further, in this embodiment, instead of weighting each
このような場合、前記重み関数φは、マニピュレータ姿勢の特異度を評価指標としたものを用いる。すなわち、ヤコビアンJに対する可操作性指標Mを下記に示す(式23)のように定義し、この可操作性指標Mを前記重み関数φに替えて用いても良い。 In such a case, as the weight function φ, a value using the specificity of the manipulator posture as an evaluation index is used. That is, the manipulability index M for the Jacobian J may be defined as shown in the following (Equation 23), and this manipulability index M may be used in place of the weight function φ.
(式23)
また、J・JTの固有値を計算すると、
(式24)
となる。
(Formula 23)
In addition, when you calculate the eigenvalues of J · J T,
(Formula 24)
It becomes.
つまり、前記(式23)及び(式24)に示すように、J・JTの固有値を計算すれば、通常、行列J・JTの階数=Rank(i)となるが、特異姿勢の場合には、行列J・JTの階数<Rank(i)となり行列Mが退化される。すなわち、前記重み関数φに替えて、前記可操作性指標Mを用いて演算処理を行うことにより、各リンク部材21毎ではなく、マニピュレータ20全体に対して、無理な姿勢を排除し、動き易い範囲内で動作するための重み付けを行うことが可能である。この場合、各リンク部材21は一意に制御されない。
In other words, the as shown in (Equation 23) and (Equation 24), by calculating the eigenvalues of J · J T, usually the rank = Rank (i) of the matrix J · J T, if the singularity , the rank of the matrix J · J T <Rank (i ) becomes a matrix M is degenerate. In other words, by performing arithmetic processing using the manipulability index M instead of the weight function φ, an unreasonable posture is eliminated with respect to the
以上示した通り幾つかの姿勢制御における重み関数を示しているが、場合によっては後述する軸切り替え手段により、前記重み関数の組み合わせを、各リンク間での異なる重みの組み合わせを選択的に行うことも可能である。 As shown above, several weight functions in posture control are shown. In some cases, the weight function combinations are selectively performed by the axis switching means described later, and different weight combinations between the links. Is also possible.
なお、本発明では、前記図25乃至図29に示す重み関数や、(式23)及び(式24)に示すような可操作性指標Mを用いた重み関数は、それぞれテーブル毎に格納されるようになっている。そして、コントローラ5(具体的にはCPU32)は、前記複数のテーブルの内、いずれかのテーブルに基づく重み関数を選択し、選択した重み関数を用いて、各リンク部材21の角度の演算処理、あるいはマニピュレータ全体に対する各リンク部材21の各角度の演算処理を行うようになっている。
In the present invention, the weight function shown in FIGS. 25 to 29 and the weight function using the manipulability index M as shown in (Expression 23) and (Expression 24) are stored for each table. It is like that. Then, the controller 5 (specifically, the CPU 32) selects a weighting function based on any one of the plurality of tables, and uses the selected weighting function to calculate the angle of each
次に、前述したような湾曲部14の姿勢駆動制御を行うコントローラ5の実施例1について図30乃至図41を参照しながら説明する。
図30乃至図41は本発明の実施例1に係り、図30は内視鏡装置1のコントローラ5の具体的な構成を示すブロック図、図31及び図32は湾曲部14を構成する挿入部駆動機構20の姿勢制御を説明するもので、図31は先端側のリンク部材21aをポイントロックした状態を示す説明図、図32は先端側のリンク部材21aをポイントロックすることにより次段のリンク部材が冗長性を有している状態を示す説明図である。また、図33は図30のポイントロック演算部50の具体的な構成を示すブロック図、図34は図33の逆運動学演算部52の具体的な構成を示すブロック図、図35は先端側のリンク部材21aをポイントロックしたときの姿勢状態を説明する説明図、図36は腸壁との接触により生じる負荷を検出する負荷検出部を各リンク部材毎に設けた挿入部駆動機構の構成を示す概略構成図、図37は図36の負荷検出部及び制御則演算部36B内に含まれるダイナミックス演算部を示すブロック図、図38は負荷検出部からの検出結果と重み関数を決定する係数との特性を示すグラフ、図39は図37の特性とは異なる特性の一例を示すグラフである。また、図40及び図41は実施例1の変形例1を示し、図40は負荷検出部からの検出結果と時間との特性を示すグラフ、図41は変形例1を実施するための主要ブロック構成を示すブロック図、図42及び図43は実施例1の変形例2を示し、図42は負荷検出部として用いた変位センサからの検出結果と時間との特性を示すグラフ、図43は変形例2を実施するための主要ブロック構成を示すブロック図をそれぞれ示している。
Next, a first embodiment of the
30 to 41 relate to the first embodiment of the present invention, FIG. 30 is a block diagram showing a specific configuration of the
本実施例におけるコントローラ5は、上述したような湾曲部14の姿勢制御を行うサーボ制御コントローラ36Aを有し、このサーボコントローラ36Aには、前記制御則演算部36Bの演算処理機能を有するポイントロック演算部50が設けられている。
The
前記サーボコントローラ36は、前記ポイントロック演算部50を用いて、前記湾曲部14が挿入されることによって移動したときに前記操作指令部7により指定された位置と向きを維持しながら前記操作指令部7により指定されたリンク部材21a及びこのリンク部材21aに連なる他のリンク部材21が前記位置を通過するように、前記複数のリンク部材21のそれぞれの角度を演算処理し、この演算結果に基づいて、前記複数のリンク部材21を回動させるように駆動部10bを制御する。
The
また、本実施例において、サーボコントローラ36は、前記ポイントロック演算部50により前記複数のリンク部材21のそれぞれの角度を求めるための演算処理を行う際に、前記図25乃至図29のグラフに示す特性等の重み関数を格納したそれぞれのテーブルの内、手動、あるいは自動的にいずれかのテーブルを選択し、このテーブルに基づく重み関数を用いて演算処理を行うようになっている。
Further, in this embodiment, the
このような演算処理を行うポイントロック演算部50の構成について図30、図33及び図34を参照しながら説明する。
The configuration of the point
図30に示すように、前記ポイントロック演算部50には、先端側のリンク部材21aにおけるサーボ指令値信号を含む設定指令値信号等の先端指令値情報と、前記リンク部材21aにおける状態量検知信号などの位置F/B情報とが供給される。
As shown in FIG. 30, the point
そして、前記ポイントロック演算部50は、供給された先端指令値情報と位置F/B情報とに基づいて、後述する先端リンク根元座標位置計算部51及び逆運動学演算部52によって各リンク部材21に対応する駆動指令値信号としてのサーボ位置指令信号(関節トルク指令値信号を含む)を得るための演算処理を行う。
Then, the point
すなわち、前記ポイントロック演算部50は、供給された先端指令値情報と位置F/B情報とに基づいて、前記湾曲部14が挿入されることによって移動したときに前記操作指令部7により指定された位置と向きを維持しながら前記操作指令部7により指定されたリンク部材21a及びこのリンク部材21aに連なる他のリンク部材22が前記位置を通過するように、前記複数のリンク部材21のそれぞれの角度を演算処理し、この演算結果をサーボ位置指令値信号として駆動部10bに出力する。
That is, the point
なお、前記ポイントロック演算部40の演算処理に用いられる前記先端指令値情報と前記位置F/B情報とは、検出手段であるセンサ38によって検出される、前記複数のリンク部材21が互いになす角度及びその角度の変化量を示している。
Note that the tip command value information and the position F / B information used for the calculation processing of the point
このことにより、駆動部10bは、供給されたサーボ位置指令信号に基づき指定されたリンク部材21の回動をそれぞれ制御することにより、前記挿入部駆動機構20を有する湾曲部14は、挿入する管腔内の形状に合わせた形状に湾曲されることになる。
Thus, the driving
図31には先端側のリンク部材21aのみが指示された所定の姿勢位置でポイントロックされた状態が示されている。
このような姿勢状態に制御する場合、前記ポイントロック演算部50は、図32に示すように、先端部側のリンク部材21aの関節部材20aをポイントロックR1とすると、このポイントロックR1のポイントロック座標値を演算処理することにより先端側のリンク部材21aを2次元における位置と向きを姿勢制御するのに必要なサーボ位置指令信号を生成する。
FIG. 31 shows a state where only the distal end side link member 21a is point-locked at a designated posture position.
In the case of controlling to such a posture state, the point
また、図32に示すように、先端側のリンク部材21aがポイントロックされている姿勢状態では、前記ポイントロックR1以降の複数のリンク部材21b、21c、21dで構成されるリンク部20Bは、前述した姿勢制御によって冗長性を有し、図中波線で示すように規制されない任意な姿勢に変化可能となる。
Further, as shown in FIG. 32, in the posture state where the link member 21a on the distal end side is point-locked, the link portion 20B composed of the plurality of
図33に前記ポイントロック演算部50の具体的な構成が示されている。図33に示すように、前記ポイントロック演算部50は、先端リンク根元座標位置計算部51と、逆運動学演算部52と、を有している。
FIG. 33 shows a specific configuration of the point
前記先端リンク根元座標位置計算部51は、リンク部材21の関節角度情報と、先端側のリンク部材21aの位置情報である先端指令値情報と、位置F/B情報とが入力され、これらの情報に基づき、先端側のリンク部材21aの先端リンク根元座標位置を算出し、算出結果を逆運動学演算部52に出力する。
The tip link root coordinate position calculation unit 51 receives joint angle information of the
前記逆運動学演算部52は、前記先端リンク根元座標位置計算部51からの先端指令値情報と前記位置F/B情報とが入力され、これらの情報に基づき、前記先端側のリンク部材21a以降のリンク部材21における根元座標位置を演算処理し、先端側のリンク部材21a以外のサーボ位置指令値信号を生成し出力する。
The inverse
図34に前記逆運動学演算部52の具体的な構成が示されている。図34に示すように、前記逆運動学演算部52は、機構パラメータ演算部53と、順運動学演算部54と、ヤコビアン演算部55と、ゲイン56と、行列演算部57と、積分回路58と、を有している。 前記機構パラメータ演算部53は、位置F/B情報をもとに先端側のリンク部材21aを微妙な姿勢に調整制御するための先端リンクオフセット値を演算処理して生成する。この先端リンクオフセット値は、前記先端指令値信号とで差分が求められ、この差分値は、前記順運動学演算部54により演算処理された指令値F/B情報とで再度差分が求められる。このことにより、この差分値は2段目位置指令情報として前記ゲイン56に供給される。前記ゲイン56は、供給された2段目位置指令情報を増幅し、前記行列演算部57に出力する。
FIG. 34 shows a specific configuration of the inverse
一方、前記ヤコビアン演算部55は、図21にて説明したものと同様に、指令値情報を元に演算処理することによりヤコビアンJを生成し、前記行列演算部57に出力する。
On the other hand, the
前記行列演算部57は、供給された2段目位置指令情報を基に、リンク部材21の姿勢状態に応じた2段目以降のリンク部材21の姿勢(角度)を決定するための行列演算処理を行い、得られた演算結果を積分回路58により積分処理を施した後、2段目以降のサーボ指令値信号として駆動部10bに出力する。
The
なお、前記積分回路58の出力、すなわち、2段目以降のサーボ指令値信号は、前記ヤコビアン演算部55及び順運動学演算部54を介して先端指令値情報と位置F/B情報との偏差値にフィードバックされている。これは、逆運動学を解く際の特異解を出来るだけ発生しないよう考慮しているためである。
The output of the
通常逆運動学であれば解析的に解を求めるが、特異解が発生した場合に解が求まらないことが生じる。そのため、ここでは、逆運動学を用いずに、順運動学による逆運動学を求める手法を用いており、ゲイン56の値によって収束速度を設定する構造になっている。
Usually, inverse kinematics seeks an analytical solution, but when a singular solution occurs, the solution may not be found. For this reason, here, a method for obtaining inverse kinematics by forward kinematics without using inverse kinematics is used, and the convergence speed is set by the value of
このことにより、2段目以降のリンク部材21は、前記先端側のリンク部材21aの姿勢制御に連動して微妙な姿勢となるように制御されることになる。
As a result, the second and
図35は実施例1のポイントロック演算部50によって姿勢制御された湾曲部14の湾曲状態を示している。
例えば、操作者が操作指令部7を用いて先端側のリンク部材21aのみをポイントロックするための指示を入力すると、前記ポイントロック演算部50は、前記したように演算処理を行うことにより、ポイントロックR1のポイントロック座標値(2次元における位置と向き)にて先端側のリンク部材21aをポイントロックするためのサーボ位置指令値信号を生成し、駆動部10bに与えて制御する。
FIG. 35 shows a bending state of the bending
For example, when an operator inputs an instruction for point-locking only the link member 21a on the distal end side using the operation command unit 7, the point
このことにより、湾曲部14の先端側のリンク部材21aは、図35に示すようにポイントロックR1にて指示された姿勢ベクトル(2次元における位置と向き)でポイントロックされる。
また、このとき、前記ポイントロックR1以降の複数のリンク部材21b、21c、21dで構成されるリンク部20Bは、前記図33及び図34のブロック図にて説明したように、前記ポイントロック演算部50によって、前記先端側のリンク部材21aの姿勢制御に連動した冗長性を有する姿勢制御が行われるので、例えば図中矢印A方向に対してその姿勢が任意となる。
As a result, the link member 21a on the distal end side of the bending
At this time, the link part 20B composed of a plurality of
すなわち、ポイントロック演算部50は、前記湾曲部14が挿入されることによって移動したときに前記操作指令部7により指定された位置と向きを維持しながら前記操作指令部7により指定されたリンク部材21a及びこのリンク部材21aに連なる他のリンク部材22が前記位置を通過するように、前記複数のリンク部材21のそれぞれの角度を演算処理し、この演算結果に基づいて前記複数のリンク部材21を回動させるように駆動部10bを制御する。
That is, the point
なお、前記ポイントロック演算部50は、前記複数のリンク部材21のそれぞれの角度を演算処理する場合、前記設定値指令部8により指定された重み関数テーブルに基づく重み関数を用いて演算処理する。これにより、複数のリンク部材21やマニピュレータ20の無理な姿勢を排除し、動き安い範囲内で動作させるのに必要な角度が前記複数のリンク部材21毎に取得でき、この演算結果に基づき、各リンク部材21の回動が制御される。
In addition, the said point
このような内視鏡装置1において、挿入部9を大腸に挿入する場合、術者は、湾曲部14を有する挿入部9を肛門を介して挿入する。そして、挿入部9の先端部14がS状結腸部に到達すると、サーボコントローラ36Aは先端側のリンク部材21aを操作指令部7により指定した2次元における位置と向きにポイントロックさせる。
In such an
そして、術者は2次元における位置と向きにポイントロックされた先端側のリンク部21aをS状結腸部の腸壁に沿ってさらに奥へと挿入する。 Then, the surgeon inserts the distal end side link portion 21a, which is point-locked in a two-dimensional position and orientation, further into the back along the intestinal wall of the sigmoid colon.
すると、前記先端側のリンク部材21a及びこのリンク部材21aに連なる他のリンク部材21は、前記操作指令部7により指定された位置と向きを維持しながら前記位置を通過するような角度に制御されることになる。すなわち、湾曲部14はS状結腸部の形状に合った形状に湾曲動作しながら挿入されることになる。なお、2段目以降のリンク部材21b〜21nは、前記したように冗長性を有する姿勢制御が行われることになる。
Then, the link member 21a on the distal end side and the
このことにより、従来、挿入に困難を要していたS状結腸部に合わせた形状で挿入することができるので、S状結腸部を容易に通過させることが可能となる。よって、さらに、大腸の深部へと容易に挿入することができるので、挿入性を向上させることができる。 As a result, it is possible to insert the sigmoid colon in a shape that has conventionally been difficult to insert, so that the sigmoid colon can be easily passed. Therefore, since it can be easily inserted into the deep part of the large intestine, the insertability can be improved.
ところで、本実施例の内視鏡装置1は、前記湾曲部14を管腔内に挿入した際に、前記湾曲部14を構成する複数のリンク部材21あるいは複数のリンク部材21内の任意のリンク部材21の角度に関し重み関数を用いて演算処理を行う場合に、後述する負荷検出部60からの検出結果に基づいて自動的に最適なパラメータである重み関数を決定することが可能である。
By the way, in the
図36に示すように、挿入部9の湾曲部14を構成する各リンク部材21には、負荷検出手段として負荷検出部60がそれぞれ設けられている。
As shown in FIG. 36, each
この負荷検出部60は、例えば歪ゲージ等のテンションセンサを用いて構成されたもので、各リンク部材21の周面上の予め設定された箇所(例えば90度毎に設けた場合には4箇所)に配置されるように、各リンク部材21を覆う外皮チューブ(図示せず)内にそれぞれ設けられている。
The
図36及び図37に示すように、前記負荷検出部60は、湾曲部14が管腔内に挿入されている際に、腸壁等の接触により生じる力(またはテンションともいう)を検出し、検出結果を力F/B情報としてダイナミックス演算部43Aに出力する。
ダイナミックス演算部43Aには、前記負荷検出部60からの検出結果に基づき、重み関数を決定する演算処理を行うのに必要なパラメータ値を生成するとともにこのパラメータ値に応じた重み関数を演算処理する設定手段としての重み切り替え演算部62が設けられている。
As shown in FIGS. 36 and 37, the
Based on the detection result from the
この重み切り替え演算部62は、例えば前記図25乃至図29に示す重み関数や、(式24)及び(図式)に示すような可操作性指標Mを用いた重み関数をそれぞれ格納した重み関数テーブル62aを有している。なお、この重み関数テーブル62aは、前記重み切り替え演算部62内ではなく、指令制御部5A内等に設けて構成しても良い。
The weight switching
前記ダイナミックス演算部43Aは、各リンク部材21の角度の変化量である位置F/B情報に基づいて前記重み切り替え演算部62を用いて前記複数のリンク部材21の角度に関し重み関数を用いて演算処理を行わせることにより、重み付けされたサーボ指令値信号を駆動部10bに出力する。
The dynamics calculation unit 43A uses a weight function with respect to the angles of the plurality of
この場合、重み切り替え演算部62は、前記負荷検出部60からの検出結果に基づき、重み関数を決定する演算処理を行うのに必要なパラメータ値を生成する。
In this case, the weight switching
そして、重み切り替え演算部62は、操作指令部7により予め設定された前記重み関数テーブル62aのいずれかのテーブルの重み関数と前記生成したパラメータ値とを用いて演算処理を行う。
Then, the weight switching
つまり、下記(式25)に示すように、
(式25)
重み切り替え演算部62は、前記(式25)に示す負荷検出部60からの検出結果である(F)が変化することによって、パラメータ値であるKNULL を決定する。
That is, as shown in (Equation 25) below,
(Formula 25)
The weight switching
このパラメータ値の特性の一例が図38のグラフに示されている。 An example of the characteristic of this parameter value is shown in the graph of FIG.
図38に示すように、前記パラメータ値である前記KNULL は、前記力F/B情報の値が予め設定された値になるまで大きくなり、この設定値以降については常に一定の値となる。すなわち、力F/B情報に応じてKNULL ゲインが線形に変化し、予め設定された任意の閾値で飽和するパラメータ値となる。前記パラメータ値KNULL 閾値の設定値は、前記設定値指令部8により入力することも可能である。 As shown in FIG. 38, the parameter value K NULL increases until the value of the force F / B information reaches a preset value, and the value after this set value is always a constant value. That is, the K NULL gain changes linearly according to the force F / B information, and becomes a parameter value that saturates at a predetermined threshold value. The set value of the parameter value K NULL threshold can be input by the set value command unit 8.
以上のことから、前記湾曲部14近傍において、腸壁にあたるなどの外乱に応じて、外乱作用を受けないようにする姿勢となる重み関数値φとなる。
From the above, in the vicinity of the bending
また、前記示した線形な重み関数パラメータ以外にも、センサ特性・センサ実装などにより生じる非線形成分を相殺することや、動作の姿勢を意識的に非線形にしたい場合などがあるが、その一例として、重み関数パラメータKNULL を下記(式26)、(式27)に示す非線形関数としても良い。 In addition to the linear weight function parameters shown above, there are cases where it is desirable to cancel non-linear components caused by sensor characteristics, sensor mounting, etc. The weight function parameter K NULL may be a non-linear function represented by the following (Expression 26) and (Expression 27).
パラメータ値であるKNULL のゲイン最大値をKNULLMAX とし、前記力F/B情報を(F)とすると、
(式26)
(式27)
となる。ただし、β>0 とする。
When the maximum gain value of K NULL which is a parameter value is K NULLMAX and the force F / B information is (F),
(Formula 26)
(Formula 27)
It becomes. However, β> 0.
この場合、図39のグラフに示すような前記パラメータ値の特性となる。 In this case, the parameter value characteristics are as shown in the graph of FIG.
また、図39に示すグラフ特性以外にも、(式28)、(式29)のような高次の関数を用いても構わない。このような(式28)〜(式29)を下記に示す。 In addition to the graph characteristics shown in FIG. 39, higher-order functions such as (Expression 28) and (Expression 29) may be used. Such (Formula 28) to (Formula 29) are shown below.
(式28)
(式29)
となる。ただし、β、α>0(任意値)とする。
(Formula 28)
(Formula 29)
It becomes. However, β and α> 0 (arbitrary values) are set.
したがって、以上説明したように前記重み切り替え演算部62は、負荷検出部60からの力F/B情報に基づき、各リンク部材21の角度に重み付けを付けて演算処理する際のパラメータ値を変更して演算処理を行うことにより、最適な重み関数を得ることができる。すなわち、ダイナミックス演算部43Aによって、前記負荷検出部60からの力F/B情報に応じて重み付けがなされたサーボ指令値信号を得ることができ、任意のリンク部材21あるいはマニピュレータ20全体に対して無理な姿勢を排除し、動き易い範囲内で動作させることが可能となる。
Therefore, as described above, the weight switching
以上、負荷検出部60からの負荷情報を用いて最適な姿勢での動作を可能にしているが、負荷検出部60の取り付け方法によっては、姿勢変化で生じる負荷と外乱負荷が重畳してしまう。このために、姿勢変化で生じる負荷の特性を予めパラメータでありセンサ既知特性として前記コントローラ5内に記憶させておき、重み切り替え演算部62にて前記センサ既知特性分を差し引くことで、外乱検知としての情報を取得できることも可能である。
As described above, the operation in the optimum posture is enabled using the load information from the
また、前記センサ既知特性は、湾曲部14を動作させるための負荷センサとすることで状態量検知信号部に力情報フィードバック情報を用いて緻密なダイナミクス制御を実施しても構わない。
In addition, the sensor known characteristic may be a load sensor for operating the bending
ところで、本実施例の内視鏡装置1は、挿入部9の管腔内への挿入時、挿入部9の湾曲部14が管腔内の腸壁等に接触しこの接触状態が継続した場合でも、より安全に挿入することが可能である。
By the way, in the
すなわち、本実施例では、前記負荷検出部60による検出結果に基づく複数のリンク部材21の角度の重み付けの演算処理を行う場合に、時間を考慮すると同時に腸壁等に接触しているリンク部材21を回避させるようなマニピュレータ20全体に対する重み関数を得るようにしている。このような変形例を図40乃至図43に示す。
That is, in the present embodiment, when performing the calculation processing of the weighting of the angles of the plurality of
図40及び図41は実施例1の変形例1を説明するもので、図40は負荷検出部からの検出結果と時間との特性を示すグラフ、図41はダイナミックス演算部内の重み切り替え演算部を含む主要部の構成を示すブロック図を示している。なお、図40中の縦軸は負荷検出部であるテンションセンサ(歪ゲージ)により得られたテンションセンサ値(力F/B情報)、横軸は時間(t)を示し、軸1、軸2は一、二番目のリンク部材21をそれぞれ示している。
40 and 41 illustrate a first modification of the first embodiment. FIG. 40 is a graph showing characteristics of the detection result from the load detection unit and time. FIG. 41 is a weight switching calculation unit in the dynamics calculation unit. The block diagram which shows the structure of the principal part containing is shown. 40, the vertical axis represents the tension sensor value (force F / B information) obtained by a tension sensor (strain gauge) as a load detection unit, the horizontal axis represents time (t), and the
図40に示すように、内視鏡装置1の挿入部9の管腔内への挿入時に、二番目のリンク部21bの負荷検出部60によるテンションセンサ値は、例えば時間が経過するにつれて小さくなるが、一番目(先端側)のリンク部21bの負荷検出部60によるテンションセンサ値は、ある所定時間を境にして大きくなっている。
As shown in FIG. 40, when the
すなわち、一番目のリンク部材21aが、ある所定時間において、大腸などの腸壁に接触したことにより、時間に伴いテンションセンサ値が高くなったことを示し、以降、前記リンク部材21aの腸壁への接触状態が継続されていることにより、さらにテンションセンサ値が高くなったことを示している。 That is, when the first link member 21a comes into contact with the intestinal wall such as the large intestine at a predetermined time, the tension sensor value increases with time. This indicates that the tension sensor value is further increased by continuing the contact state.
そこで、本実施例では、このような任意のリンク部材21が腸壁に対する接触状態が継続された場合でも、このときに検出されたテンションセンサ値に基づき、この接触状態を回避できるような重み関数を演算処理して求めるようにしている。すなわち、複数のリンク部材21の角度を決定する際に、実施例1で用いた各リンク部材21毎の重み関数ではなく、複数のリンク部材21全体、つまり、マニピュレータ20全体に重み付けをするような重み関数を生成するようにしている。
Therefore, in this embodiment, even when such an
具体的には、図41に示すように、ダイナミックス演算部43内の重み関数切り替え演算部62Aには、複数のリンク部材21毎に設けられた時間積分演算部61a、61b…61nが接続されるようになっている。
Specifically, as shown in FIG. 41, time integration calculation units 61a, 61b,... 61n provided for each of the plurality of
各時間積分演算部61a、61b…61nには、それぞれのリンク部材21に設けられた負荷検出部60からのテンションセンサ値F1、F2…Fnがそれぞれ供給される。
The tension sensor values F1, F2,... Fn from the
前記時間積分演算部61aは、供給されたテンションセンサ値F1を用いて評価関数を得るための時間積分演算処理を行い、評価関数SF1 を得て重み関数切り替え演算部62Aに出力する。 The time integration calculation unit 61a performs a time integration calculation process for obtaining an evaluation function using the supplied tension sensor value F1, and obtains an evaluation function SF1 and outputs it to the weighting function switching calculation unit 62A.
また、前記時間積分演算部61b…についても同様に時間積分演算処理を行って、それぞれ評価関数SF2 、SFn を求め、前記重み関数切替演算部62Aにそれぞれ出力する。 Similarly, the time integration calculation unit 61b... Performs the time integration calculation process to obtain the evaluation functions SF2 and SFn, respectively, and outputs them to the weight function switching calculation unit 62A.
前記各時間積分演算部61a、61b…61nによる演算処理に基づく式を下記に示す。 Expressions based on calculation processing by the time integration calculation units 61a, 61b,... 61n are shown below.
(式30)
そして、前記重み関数切り替え演算部62は、それぞれ供給された評価関数SFK を用いて次の(式31)により平均化処理して評価関数SSUM を求め、さらに、この評価関数SSUM を用いて(式32)に基づく演算処理を行うことにより、マニピュレータ20全体の重み関数φFiを得る。(式31)及び(式32)を下記に示す。
(Formula 30)
Then, the weight function switching
(式31)
(式32)
なお、前記重み切り替え演算部62A内に前記実施例1にて用いた重み関数テーブル62aを設け、必要に応じてこれらの少なくとも1つの重み関数テーブルの重み関数と、前記演算処理にて得られた重み関数φFiとを切り替えて用いるようにしても良い。このことにより、挿入部9の挿入状態に応じて幅広い湾曲制御を行うことができる。
(Formula 31)
(Formula 32)
In addition, the weight function table 62a used in the first embodiment is provided in the weight switching calculation unit 62A, and the weight function of at least one of these weight function tables is obtained by the calculation process as necessary. The weight function φ Fi may be switched and used. Thereby, a wide range of bending control can be performed according to the insertion state of the
したがって、変形例1によれば、上記したようにマニピュレータ20全体に対し、腸壁等の接触状態が回避されるような重み関数φFiが得られて複数のリンク部材21の角度が制御されることにより、挿入部9の管腔内への挿入時、挿入部9の湾曲部14が管腔内の腸壁等に接触しこの接触状態が継続された場合でも、マニピュレータ20全体が腸壁から回避されるような角度で湾曲動作するため、より安全に且つ円滑に挿入することができる。
Therefore, according to the modified example 1, as described above, the weighting function φ Fi that avoids the contact state of the intestinal wall or the like is obtained with respect to the
なお、前記変形例1では、負荷検出部60の検出結果を用いた構成について説明したが、本実施例では、これに限定されるものではなく、負荷検出部60であるテンションセンサの有無に拘わらず、マニピュレータ20全体に対する重み関数を得ることも可能である。このような変形例2を下記に示す。
In the first modification, the configuration using the detection result of the
図42及び図43は実施例1の変形例2を説明するもので、図42はアクチュエータ制御ブロックのセンサからの検出結果と時間との特性を示すグラフ、図43はダイナミックス演算部内の重み切り替え演算部を含む主要部の構成を示すブロック図である。なお、図42中の縦軸はセンサにより得られた各リンク部材21の動く角度の変位量(P)、横軸は時間(t)を示し、軸1、軸2は一、二番目のリンク部材21をそれぞれ示している。
42 and 43 illustrate a second modification of the first embodiment. FIG. 42 is a graph showing characteristics of the detection result from the sensor of the actuator control block and time. FIG. 43 is a weight switching in the dynamics calculation unit. It is a block diagram which shows the structure of the principal part containing a calculating part. 42, the vertical axis indicates the displacement (P) of the moving angle of each
図42に示すように、前記変形例1と同様に、内視鏡装置1の挿入部9の管腔内への挿入時に、二番目のリンク部21bのセンサ38(図10、図11参照)による変化量値(P)は、例えば時間が経過するにつれて小さくなるが、一番目(先端側)のリンク部21bのセンサ38による変化量値(P)は、所定時間を境にして大きくなっている。
As shown in FIG. 42, as in the first modification, when the
すなわち、一番目のリンク部材21aが、所定時間において、大腸などの腸壁に接触したことにより、時間に伴い変量値が高くなったことを示し、以降、前記リンク部材21aの腸壁への接触状態が継続されているためさらに先端側のリンク部材21を回動することにより、リンク部材21aの動く角度の変位量値がさらに高くなったことを示している。
That is, the first link member 21a is in contact with the intestinal wall such as the large intestine at a predetermined time, and thus the variable value increases with time. Thereafter, the link member 21a contacts the intestinal wall. Since the state is continued, the displacement amount value of the moving angle of the link member 21a is further increased by further rotating the
そこで、本実施例では、このような任意のリンク部材21が腸壁に対する接触状態が継続された場合でも、このときに検出された変位量値に基づき、この接触状態を回避できるような重み関数を演算処理して求めるようにしている。すなわち、複数のリンク部材21の角度を決定する際に、実施例1で用いた各リンク部材21毎の重み関数ではなく、複数のリンク部材21全体、つまり、マニピュレータ20全体に重み付けをするような重み関数を生成するようにしている。
Therefore, in this embodiment, even when such an
具体的には、図43に示すように、ダイナミックス演算部43内の重み関数切り替え演算部62Bには、複数のリンク部材21毎に設けられた時間積分演算部61A、61B…61Nが接続されるようになっている。
Specifically, as shown in FIG. 43, the time
各時間積分演算部61A、61B…61Nには、それぞれのリンク部材21に設けられたアクチュエータ制御ブロック31内のセンサ38からの変位量値P1、P2…Pnが供給される。
Displacement values P1, P2,... Pn from the
前記時間積分演算部61Aは、供給された変化量P1を用いて評価関数を得るための時間積分演算処理を行い、評価関数SP1 を得て重み関数切り替え演算部62Bに出力する。 The time integration calculation unit 61A performs a time integration calculation process for obtaining an evaluation function using the supplied change amount P1, and obtains an evaluation function SP1 and outputs it to the weighting function switching calculation unit 62B.
また、前記時間積分演算部61B…についても同様に時間積分演算処理を行って、それぞれ評価関数SP2 、SPn を求め、前記重み関数切替演算部62Bに出力する。
Similarly, the time
前記各時間積分演算部61A、61B…61Nによる演算処理に基づく式を下記に示す。
Expressions based on calculation processing by the time
(式33)
そして、前記重み関数切り替え演算部62Bは、それぞれ供給された評価関数SPK を用いて次の(式34)により平均化処理して評価関数SSUM を求め、さらに、この評価関数SSUM を用いて(式35)に基づく演算処理を行うことにより、マニピュレータ20全体の重み関数φiを得る。(式34)及び(式35)を下記に示す。
(Formula 33)
Then, the weight function switching calculation unit 62B uses the supplied evaluation function S PK to perform an averaging process according to the following (formula 34) to obtain the evaluation function S SUM , and further uses this evaluation function S SUM . Thus, the weighting function φ i of the
(式34)
(式35)
なお、前記重み切り替え演算部62ABに前記実施例1にて用いた重み関数テーブル62aを設け、必要に応じてこれらの少なくとも1つの重み関数テーブルの重み関数と、前記演算処理にて得られた重み関数φiとを切り替えて用いるようにしても良い。このことにより、挿入部9の挿入状態に応じて幅広い湾曲制御を行うことができる。
(Formula 34)
(Formula 35)
The weight switching calculation unit 62AB is provided with the weight function table 62a used in the first embodiment, and if necessary, the weight function of at least one of these weight function tables and the weight obtained by the calculation process. The function φ i may be switched and used. Thereby, a wide range of bending control can be performed according to the insertion state of the
したがって、上記したように、負荷検出部60であるテンションセンサを設けなくても、マニピュレータ20全体に対し、腸壁等の接触状態が回避されるような重み関数φFiを得ることが可能となる。そして、この重み関数φiを用いて複数のリンク部材21の角度が制御されることにより、挿入部9の管腔内への挿入時、挿入部9の湾曲部14が管腔内の腸壁等に接触しこの接触状態が継続された場合でも、変形例1と同様にマニピュレータ20全体が腸壁から回避されるような角度で湾曲動作するため、より安全に且つ円滑に挿入することができる。
Therefore, as described above, it is possible to obtain the weighting function φ Fi that avoids the contact state of the intestinal wall or the like with respect to the
以上、述べたように本実施例によれば、挿入部9の湾曲部14を構成する複数のリンク部材21の内、先端側のリンク部材21aをポイントロックするとともに、他のリンク部材については冗長性を有する任意の姿勢となるように姿勢制御することができるので、挿入部9の湾曲部14を管腔内の形状に合わせた形状で挿入することが可能となる。よって、挿入部の挿入性を向上できるといった効果を得る。
As described above, according to the present embodiment, among the plurality of
また、本実施例の内視鏡装置1は、前記湾曲部14を管腔内に挿入した際に、前記湾曲部14を構成する複数のリンク部材21あるいは複数のリンク部材21内の任意のリンク部材21の角度に関し重み関数を用いて演算処理を行う場合に、負荷検出部60からの検出結果に基づいて自動的に最適な重み関数を決定することが可能である。このことにより、複数のリンク部材21やマニピュレータ20の無理な姿勢を排除し、動き安い範囲内で動作させるのに必要な角度が前記複数のリンク部材21毎に取得できるので、管腔内への挿入を滑らかに行うことが可能となる。
In addition, the
なお、本実施例では、前記複数のリンク部材21の内、先端側のリンク部材21aの2次元における位置と向きをポイントロックすることについて説明したが、これに限定されるものではなく、3次元における位置と向きをポイントロックするように構成しても良い。
In addition, although the present Example demonstrated point-locking the two-dimensional position and direction of the link member 21a of the front end side among the said some
また、本実施例において、マニピュレータを構成する挿入部駆動機構20を有する湾曲部14は、内視鏡2の挿入部9に設けられたものとして説明したが、前記湾曲部14は内視鏡2の挿入部9を挿通させて管腔内に対する挿入部9の挿入を補助する内視鏡挿入補助具の挿入部に設けて構成しても良い。
In the present embodiment, the bending
本発明は、以上述べた実施例及び変形例のみに限定されるものではなく、発明の要旨を逸脱しない範囲で種々変形実施可能である。 The present invention is not limited to the embodiments and modifications described above, and various modifications can be made without departing from the spirit of the invention.
1…内視鏡装置、
2…内視鏡、
3…光源装置、
4…ビデオプロセッサ、
5…コントローラ、
6…モニタ、
5A…指令制御部、
7…操作指令部、
7a…ジョイスティック、
8…設定値指令部、
9…挿入部、
10…操作部、
10b…駆動部、
13…先端部、
14…湾曲部、
20…挿入部駆動機構(マニピュレータ)、
20a〜20n…関節部材、
21a〜21n…リンク部材、
22…ジョイントシャフト、
23…ポテンショメータ、
24、25…歯車、
26…連結ギア、
27…モータ、
28…連結ギア、
28…連結歯車、
30…フレシキブルシャフト、
31…アクチュエータ制御ブロック、
31a〜31n…アクチュエータ制御ブロック、
36A…サーボ制御コントローラ、
36B…制御則演算部、
37…制御指令値出力部、
37a…ドライバ、
38…センサ、
39…信号入力部、
39a…検知部、
40…PD制御部、
41…運動学演算部、
42…制御演算部、
43…ダイナミックス演算部、
44…順運動学演算部、
45、46…時間微分演算部、
47…ヤコビアン演算部、
48…疑似逆行列演算部、
49…ヤコビアン零空間演算部、
50…ポイントロック演算部、
50A〜50C…ポイントロック演算部、
51…先端リンク根元座標位置計算部、
52…逆運動学演算部、
53…機構パラメータ演算部、
54…順運動学演算部、
55…ヤコビアン演算部、
56…アンプ、
57…行列演算部、
58…積分回路、
60…負荷検出部、
61a〜61n…時間積分演算部、
62…重み切り替え演算部、
62a…重み関数テーブル。
1 ... Endoscopic device,
2. Endoscope,
3 ... light source device,
4 ... Video processor,
5 ... Controller,
6 ... Monitor,
5A: Command control unit,
7: Operation command section,
7a ... Joystick,
8: Setting value command section,
9 ... Insertion part,
10 ... operation part,
10b ... drive unit,
13 ... the tip,
14: curved part,
20: Insertion section drive mechanism (manipulator),
20a to 20n ... joint members,
21a-21n ... Link member,
22 ... Joint shaft,
23 ... Potentiometer,
24, 25 ... gears,
26: Connecting gear,
27 ... motor,
28 ... Connecting gear,
28: Connecting gear,
30 ... Flexible shaft,
31 ... Actuator control block,
31a-31n ... Actuator control block,
36A ... Servo controller
36B: Control law calculation unit,
37 ... Control command value output section,
37a ... driver,
38 ... sensor,
39: Signal input section,
39a ... detection part,
40 ... PD control unit,
41 ... kinematics calculation part,
42... Control arithmetic unit,
43. Dynamics calculation unit,
44 ... Forward kinematics calculation unit,
45, 46 ... time derivative calculation unit,
47 ... Jacobian operation part,
48 ... pseudo-inverse matrix calculation unit,
49 ... Jacobian null space arithmetic unit,
50: Point lock calculation unit,
50A to 50C: Point lock calculation unit,
51 ... Tip link root coordinate position calculation unit,
52. Inverse kinematics calculation unit,
53. Mechanism parameter calculation unit,
54: Forward kinematics calculation unit,
55 ... Jacobian operation part,
56 ... Amplifier,
57 ... Matrix operation unit,
58. Integration circuit,
60 ... load detection unit,
61a to 61n: time integration calculation unit,
62 ... Weight switching calculation unit,
62a ... Weight function table.
Claims (4)
前記複数のリンク部材をそれぞれ回動させて前記湾曲部を湾曲動作させるための駆動手段と、
前記複数のリンク部材の内、最も先端側のリンク部材の位置と向きを指定する指定手段と、
前記複数のリンク部材のそれぞれ隣り合うリンク部材のなす角度を演算する際に、前記隣り合うリンク部材のなす角度が予め設定された許容範囲内になるようにするためのパラメータを設定する設定手段と、
前記医療用具の前記湾曲部が移動したときに前記指定手段により指定された位置と向きを維持しながら前記最も先端側のリンク部材及びこのリンク部材に連なる他のリンク部材が前記位置を通過するように、前記設定手段により設定されたパラメータに基づいて前記複数のリンク部材のそれぞれの角度を演算し、この演算結果に基づいて、前記複数のリンク部材を回動させるように前記駆動手段を制御する制御手段と、
を具備したことを特徴とする医療用制御装置。 A medical device having a curved portion in which a plurality of link members are rotatably connected to the distal end side of the insertion portion to be inserted into the subject;
Driving means for rotating each of the plurality of link members to bend the bending portion;
Of the plurality of link members, designation means for designating the position and orientation of the most distal link member;
A setting means for setting a parameter for causing the angle formed by the adjacent link members to fall within a preset allowable range when calculating the angle formed by the adjacent link members of the plurality of link members; ,
When the bending portion of the medical device moves, the most distal link member and other link members connected to the link member pass through the position while maintaining the position and orientation specified by the specifying means. Further, each angle of the plurality of link members is calculated based on the parameter set by the setting unit, and the drive unit is controlled to rotate the plurality of link members based on the calculation result. Control means;
A medical control device comprising:
前記制御手段は、前記検出結果に応じて前記パラメータを変更し、この変更したパラメータに基づいて、前記複数のリンク部材における隣り合うリンク部材のそれぞれの角度を演算し、この演算結果に基づいて、前記複数のリンク部材を回動させるように前記駆動手段を制御することを特徴とする請求項1に記載の医療用制御装置。 Detecting means for detecting the force exerted on each of the plurality of link members for each link member;
The control unit changes the parameter according to the detection result, calculates the angle of each of the adjacent link members in the plurality of link members based on the changed parameter, and based on the calculation result, The medical control apparatus according to claim 1, wherein the driving unit is controlled to rotate the plurality of link members.
前記制御手段は、前記検出結果に応じて前記パラメータを変更し、この変更したパラメータに基づいて、前記複数のリンク部材における隣り合うリンク部材のそれぞれの角度を演算し、この演算結果に基づいて、前記複数のリンク部材を回動させるように前記駆動手段を制御することを特徴とする請求項1に記載の医療用制御装置。 Detecting means for detecting an angle between the plurality of link members and a change amount of the angle;
The control unit changes the parameter according to the detection result, calculates the angle of each of the adjacent link members in the plurality of link members based on the changed parameter, and based on the calculation result, The medical control apparatus according to claim 1, wherein the driving unit is controlled to rotate the plurality of link members.
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005214727A JP4754898B2 (en) | 2005-07-25 | 2005-07-25 | Medical control device |
KR1020087001916A KR20080028959A (en) | 2005-07-25 | 2006-07-20 | Medical controller |
EP06768326A EP1908389B1 (en) | 2005-07-25 | 2006-07-20 | Medical controll apparatus |
PCT/JP2006/314398 WO2007013350A1 (en) | 2005-07-25 | 2006-07-20 | Medical controller |
US12/019,375 US8523765B2 (en) | 2005-07-25 | 2008-01-24 | Medical control apparatus |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005214727A JP4754898B2 (en) | 2005-07-25 | 2005-07-25 | Medical control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007029288A true JP2007029288A (en) | 2007-02-08 |
JP4754898B2 JP4754898B2 (en) | 2011-08-24 |
Family
ID=37789254
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005214727A Expired - Fee Related JP4754898B2 (en) | 2005-07-25 | 2005-07-25 | Medical control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4754898B2 (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4930494A (en) * | 1988-03-09 | 1990-06-05 | Olympus Optical Co., Ltd. | Apparatus for bending an insertion section of an endoscope using a shape memory alloy |
US20030191367A1 (en) * | 2000-04-03 | 2003-10-09 | Amir Belson | Steerable segmented endoscope and method of insertion |
JP2004283618A (en) * | 2000-10-02 | 2004-10-14 | Olympus Corp | Endoscope |
JP2005126843A (en) * | 2003-10-22 | 2005-05-19 | Olympus Corp | Woven fabric structure, and endoscope |
-
2005
- 2005-07-25 JP JP2005214727A patent/JP4754898B2/en not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4930494A (en) * | 1988-03-09 | 1990-06-05 | Olympus Optical Co., Ltd. | Apparatus for bending an insertion section of an endoscope using a shape memory alloy |
US20030191367A1 (en) * | 2000-04-03 | 2003-10-09 | Amir Belson | Steerable segmented endoscope and method of insertion |
JP2004283618A (en) * | 2000-10-02 | 2004-10-14 | Olympus Corp | Endoscope |
JP2005126843A (en) * | 2003-10-22 | 2005-05-19 | Olympus Corp | Woven fabric structure, and endoscope |
Also Published As
Publication number | Publication date |
---|---|
JP4754898B2 (en) | 2011-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1908389B1 (en) | Medical controll apparatus | |
US20230072380A1 (en) | Tension control in actuation of jointed instruments | |
EP3684280B1 (en) | Systems and methods for controlling a robotic manipulator or associated tool | |
Lee et al. | Nonparametric online learning control for soft continuum robot: An enabling technique for effective endoscopic navigation | |
KR101889432B1 (en) | Tension control in actuation of multi-joint medical instruments | |
EP3046454B1 (en) | Control apparatus for tendon-driven device | |
KR102435989B1 (en) | Systems and methods for medical instrument force sensing | |
EP2382939B1 (en) | Multi-joint manipulator device and endoscope system having the same | |
Ding et al. | Design and coordination kinematics of an insertable robotic effectors platform for single-port access surgery | |
JP4580973B2 (en) | Treatment instrument system | |
JP5085684B2 (en) | Treatment instrument system and manipulator system | |
JP4754899B2 (en) | Medical control device | |
US11850014B2 (en) | Control system, control method, and surgical arm system | |
CN100566652C (en) | Medical controlling apparatus | |
JP7183062B2 (en) | CONTINUOUS ROBOT CONTROL DEVICE, CONTINUOUS ROBOT CONTROL METHOD AND PROGRAM | |
CN104736094A (en) | Phantom degrees of freedom for manipulating the movement of surgical systems | |
Fraś et al. | Static modeling of multisection soft continuum manipulator for stiff-flop project | |
Heunis et al. | Reconstructing endovascular catheter interaction forces in 3D using multicore optical shape sensors | |
KR20220019271A (en) | Estimation of joint friction and tracking error of robot end effectors | |
JP4839036B2 (en) | Medical control device | |
JP4754898B2 (en) | Medical control device | |
Xu et al. | A feed-forward friction compensation motion controller for a tendon-sheath-driven flexible robotic gripper | |
Low et al. | Master-slave robotic system for therapeutic gastrointestinal endoscopic procedures | |
CN111936078A (en) | Arm device, control method, and program |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080624 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20110517 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20110526 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140603 Year of fee payment: 3 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 4754898 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140603 Year of fee payment: 3 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313111 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |