JP6203134B2 - 医療用マニピュレータの制御方法 - Google Patents
医療用マニピュレータの制御方法 Download PDFInfo
- Publication number
- JP6203134B2 JP6203134B2 JP2014127253A JP2014127253A JP6203134B2 JP 6203134 B2 JP6203134 B2 JP 6203134B2 JP 2014127253 A JP2014127253 A JP 2014127253A JP 2014127253 A JP2014127253 A JP 2014127253A JP 6203134 B2 JP6203134 B2 JP 6203134B2
- Authority
- JP
- Japan
- Prior art keywords
- drive
- motor
- medical manipulator
- trial
- driving
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 48
- 238000004804 winding Methods 0.000 claims description 39
- 238000001514 detection method Methods 0.000 claims description 26
- 230000008859 change Effects 0.000 claims description 25
- 230000004044 response Effects 0.000 claims description 9
- 238000011156 evaluation Methods 0.000 claims description 7
- 238000005452 bending Methods 0.000 description 30
- 238000012545 processing Methods 0.000 description 21
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 description 16
- 230000007246 mechanism Effects 0.000 description 12
- 238000012937 correction Methods 0.000 description 11
- 238000003780 insertion Methods 0.000 description 10
- 230000037431 insertion Effects 0.000 description 10
- 230000005540 biological transmission Effects 0.000 description 8
- 230000007423 decrease Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 6
- 230000033001 locomotion Effects 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 238000005286 illumination Methods 0.000 description 4
- 238000003384 imaging method Methods 0.000 description 4
- 239000012636 effector Substances 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000003111 delayed effect Effects 0.000 description 2
- 230000020169 heat generation Effects 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 239000013307 optical fiber Substances 0.000 description 2
- 230000001954 sterilising effect Effects 0.000 description 2
- 238000004659 sterilization and disinfection Methods 0.000 description 2
- 210000000683 abdominal cavity Anatomy 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009429 electrical wiring Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 210000001035 gastrointestinal tract Anatomy 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 239000011347 resin Substances 0.000 description 1
- 229920005989 resin Polymers 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/00131—Accessories for endoscopes
- A61B1/00133—Drive units for endoscopic tools inserted through or with the endoscope
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/012—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor characterised by internal passages or accessories therefor
- A61B1/018—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor characterised by internal passages or accessories therefor for receiving instruments
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
- A61B34/32—Surgical robots operating autonomously
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
- A61B34/37—Master-slave robots
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/70—Manipulators specially adapted for use in surgery
- A61B34/71—Manipulators operated by drive cable mechanisms
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B90/00—Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J3/00—Manipulators of master-slave type, i.e. both controlling unit and controlled unit perform corresponding spatial movements
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B1/00—Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
- A61B1/00002—Operational features of endoscopes
- A61B1/00039—Operational features of endoscopes provided with input arrangements for the user
- A61B1/00042—Operational features of endoscopes provided with input arrangements for the user for mechanical operation
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Engineering & Computer Science (AREA)
- Veterinary Medicine (AREA)
- Public Health (AREA)
- General Health & Medical Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Molecular Biology (AREA)
- Biomedical Technology (AREA)
- Heart & Thoracic Surgery (AREA)
- Medical Informatics (AREA)
- Robotics (AREA)
- Pathology (AREA)
- Radiology & Medical Imaging (AREA)
- Optics & Photonics (AREA)
- Biophysics (AREA)
- Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- Oral & Maxillofacial Surgery (AREA)
- Manipulator (AREA)
- Surgical Instruments (AREA)
- Endoscopes (AREA)
Description
このような医療用マニピュレータは、例えば、内視鏡や、内視鏡の処置具チャンネルに挿通して用いられる処置用マニピュレータなどのように、患者の体内で用いられることが多い。
このため、駆動力伝達部材が挿通される挿入部が種々の形状に湾曲することにより、操作方向などによって駆動負荷が異なってくる。この結果、各モータを同様の駆動条件で駆動しても、先端部の動作が想定される動作と異なる場合が生じる。
このような医療用マニピュレータとして、例えば、特許文献1には、内視鏡を含むマニピュレータシステムが記載されている。このマニピュレータシステムの内視鏡では、湾曲駒を駆動するワイヤの張力値を検出することによって負荷量を求め、この負荷量から予測される湾曲状態に応じて、モータの制御パラメータを変更するようにしている。
特許文献1における制御パラメータは、例えば、「観察用・処置用スレーブマニピュレータの教示データや、マスタースレーブスケール比、感度等」である。
例えば、特許文献1に記載のマニピュレータシステムでは、教示データであるモータ目標角度θ1を、内視鏡の湾曲状態を表す変数εに定数Dを乗じた値を加算したモータ目標角度θ2に変更することが記載されている。
例えば、特許文献1に記載の技術では、モータの負荷量が、駆動力伝達部材の湾曲状態によって、教示データと動作量とがずれてしまう場合に、そのズレ量を補正することができるが、モータ自体は、負荷量によらず正確に動作することを前提としている。
しかし、駆動負荷が大きくなるとモータの消費電力が上がるため、モータの発熱量が大きくなる。このため、モータの巻線温度が上昇して、巻線抵抗が大きくなる。医療用マニピュレータに用いられることが多いDCモータでは、駆動電力が一定で巻線抵抗が大きくなると、回転速度が低下することになる。
このため、負荷量によっては、モータの回転速度が低下することにより、被駆動部の応答時間が遅くなってしまうという問題がある。また、複数のモータによって、被駆動部を協調動作させる場合には、モータごとの被駆動部の応答時間にバラツキが生じるため、協調動作が乱れてしまうという問題がある。
医療用マニピュレータにおいては、外科手術などに用いられることが多いため、被駆動部の応答時間が遅れると術者の円滑な手技の妨げとなってしまう。また、被駆動部の協調動作が乱れると、例えば、多自由度の関節ロボットなどでは、想定しない屈曲状態が生じ、他の処置具と予期しない干渉などが発生するおそれがある。
特に、近年のDCモータは、PWM(Pulse Width Modulation;パルス幅変調)の出力周波数が、例えば、500kHz程度に高速化してきている。このことは、駆動電圧変動におけるPWM信号誤差(パルス幅誤差)の影響が相対的に高くなっていることを意味しており、モータを複数使用する場合に、負荷量の差とともに、モータの個体差の影響も大きくなっている。
まず、本実施形態の医療用マニピュレータの制御方法を用いて制御する医療用マニピュレータを含む医療用マニピュレータシステムについて説明する。
図1は、本発明の実施形態の医療用マニピュレータの制御方法によって制御される医療用マニピュレータを備える医療用マニピュレータシステムの構成を示す模式的なシステム構成図である。
まず、医療用マニピュレータ1が組み込まれる医療用マニピュレータシステムの構成について説明する。
マスターアーム500a、500bのリンク機構としては、例えば、医療用マニピュレータ1における可動部の位置や姿勢を操作するための多関節のリンクや、処置具の把持動作の開閉角度を操作するための開閉動作を行うリンクを挙げることができる。
図2は、本発明の実施形態の医療用マニピュレータの制御方法によって制御される医療用マニピュレータの先端部の外観を示す模式的な斜視図である。図3は、本発明の実施形態の医療用マニピュレータの制御方法によって制御される医療用マニピュレータおよび医療用マニピュレータシステムの主要部の模式的な構成図である。図4は、本発明の実施形態の医療用マニピュレータの制御方法を行うスレーブ制御部の主要部の機能構成を示す機能ブロック図である。
湾曲部11Bは、操作部600によって操作対象に切り替えられた際は、マスターアーム500a、500bへの操作入力によって、湾曲させることにより先端部11Aの向きを変更することができる。
湾曲部11Bを湾曲させる機構としては、例えば、節輪や湾曲コマの内周面に挿通され、先端部11Aに固定された駆動ワイヤを挿入部11C内に挿通させて、近位端側の駆動モータなどで牽引する周知の構成を採用することができる。
内視鏡マニピュレータ11単体も、医療用マニピュレータになっており、本実施形態の制御方法を適用することが可能である。
挿入部11Cおよび湾曲部11Bの内部には、マニピュレータ処置具20等の処置具を処置部位の近傍に送る経路である処置具チャンネル16が設けられている。
処置具チャンネル16は、少なくともマニピュレータ処置具20が挿通可能な内径を有する可撓性の管状部材で形成されている。図2に示すように、処置具チャンネル16の先端部16bは、先端部11Aを軸方向に貫通して、先端部11Aの先端面11aに開口する貫通孔部12の基端側に接続されている。
撮像機構13および照明機構14は、先端部11Aの内部に配置され、図示略の電気配線や光ファイバが、湾曲部11Bおよび挿入部11Cの内部に挿通され、スレーブ制御部400における電気回路や光源に連結されている。
撮像機構13および照明機構14は、先端部11Aの先端面11aにおいて、それぞれ光学的な開口窓を有しており、この開口窓を通して、先端部11Aの前方の外光を受光したり、照明光を前方に出射したりすることができる。
図3に示すように、マニピュレータ処置具20は、関節22(被駆動部)と、関節22に連結された軸状部21と、処置対象等を把持する把持部26と、可撓性を有する管状部材である筒状部23と、関節22および把持部26に駆動力を供給する駆動ユニット30と、を備える。
筒状部23は、最も基端側(近位端側)の軸状部21に接続されている。
以下では、関節22の一例として、近位端側から順に、マニピュレータ処置具20の延在方向に交差する方向に屈曲する関節22Bと、関節22Bの屈曲方向と直交する方向に屈曲する関節22Aとを有するものとして説明する。
関節22A、22Bは、いずれも、図示略のプーリを有しており、それぞれのプーリには、関節22A、22Bに駆動力を伝達する動力伝達部材である駆動ワイヤ24A、24Bが巻き回されて、その各端部が固定されている。
また、本明細書では、簡単のため、関節22A、22B、あるいは駆動ワイヤ24A、24Bに関連することが明らかな部材や部位の名称においても、対応関係を明示する場合にはそれぞれの符号に添字A、Bを付すことにする。これらは特に断らない限り、互いに略同じ(同じ場合を含む)の構成を有している。また、区別を明示する必要がない場合や総称する場合には、添字A、Bを省略する。
このため、軸状部21Cは、マニピュレータ処置具20において最も基端側の軸状部21になっており、関節22Bが接続された端部と反対側の端部が筒状部23の先端に固定されている。
軸状部21Aは、マニピュレータ処置具20において最も先端側の軸状部21になっており、関節22Aと反対側の端部である先端に、把持部26が固定されている。
軸状部21Bの両端部には、関節22B、22Aが連結されている。
以下では、このような軸状部21C、関節22B、軸状部21B、関節22A、軸状部21A、および把持部26からなる連結体を、先端屈曲部25と称する。
把持部26の駆動力の伝達手段は、特に限定されず、例えば、図示略の駆動ワイヤによって把持部材26a、26bに連結した図示略のリンクを駆動するなどの手段が可能である。本実施形態では、一例として、駆動ワイヤ24と同様な駆動ワイヤによって駆動される。
把持部26は、図3に示すように、被把持物を把持することなく閉じている場合には、連結された軸状部21の外形よりも突出しない大きさになっている。
駆動ワイヤ24A、24Bは、筒状部23の基端部から先端のプーリの近傍までの間では、両端部の位置が固定されたシース27の内部にそれぞれ挿通されている。
各シース27は、各駆動ワイヤ24と略同径の内径を有する密巻コイルなどによって形成され、これにより、外力を受けて湾曲しても、ほとんど長さが変化しないようになっている。
駆動ユニット30は、筒状部23の基端部に設けられた基端部筐体31の内部に、関節22を駆動する駆動ワイヤ24ごとに設けられた複数の駆動モータ34(モータ)を備える。すなわち、図3では、駆動モータ34として、駆動モータ34Bのみが示されているが、本実施形態では、図4に示すように、駆動モータ34は、駆動ワイヤ24A、24Bをそれぞれ駆動する駆動モータ34A、34Bを有している。
また、特に図示しないが、駆動ユニット30はスレーブアーム200dの内部の適宜位置に配置されている。
駆動モータ34Bは、DCモータで構成され、出力軸34Baの回転位置を検出するエンコーダ34Bbを有している。
そこで、以下では、一例として、図4を参照して、各駆動モータ34の動作を制御する制御ユニット36の構成について説明する。
制御ユニット36の制御動作は、各駆動モータ34を試し駆動する場合と本駆動する場合とでは異なる。ここで、本駆動とは、入力処理部700からの操作信号に基づいて各駆動モータ34を駆動する駆動を意味し、試し駆動とは、本駆動における後述の駆動条件を設定するための情報取得を目的として、本駆動に先行して行われる駆動である。
本駆動は、目標値に向かって各駆動モータ34が回転するように行われるのに対して、試し駆動は、駆動条件を設定する情報を取得する短時間の間に行われ、各駆動モータ34は、回転しないか、回転するとしても回転量はごくわずかである。
モータドライバ100A(100B)に印加される駆動信号としては、回転方向を指定する回転方向制御信号と、回転速度を制御するためパルス幅変調されたPWM信号と、回転にブレーキを掛けるブレーキ信号と、を挙げることができる。
電流検出部101によって検出された電流値の情報は、駆動条件設定部106、温度上昇解析部107に送出され、それぞれが行う演算に使用される。
PWM出力検出部102によって検出されたデューティ比の情報は、駆動条件設定部106に送出され、後述する試し駆動時にPWM出力補正値の算出に用いられる。
PWM出力検出部102によって検出された平均印加電圧の情報は、温度上昇解析部107に送出されて、後述する試し駆動時の温度上昇解析部107が行う温度上昇解析に用いられる。
回転検出部103によって検出された回転位置の情報は、動作制御部108の回転制御に用いられる。
回転検出部103によって検出された回転速度の情報は、温度上昇解析部107に送出されて、温度上昇解析部107が行う温度上昇解析に用いられる。
駆動条件設定部106は、試し駆動を行う前に、動作制御部108からの動作指令値の情報に基づいて試し駆動の駆動条件を設定する。
また、駆動条件設定部106は、本駆動を行う直前の試し駆動時に、温度上昇解析部107から取得する温度上昇に対応する情報と、電流検出部101からの電流変化に関する情報と、から、動作指令値に基づく本駆動時における駆動モータ34A、34Bの駆動条件を設定する。
駆動条件設定部106は、駆動条件として、駆動信号生成部104に対しては、PWM信号のデューティ比を設定し、出力タイミング設定部105に対しては、駆動信号生成部104で生成されるPWM信号をモータドライバ100A、100Bに出力する出力タイミングを設定する。
駆動条件設定部106は、動作制御部108と通信可能に接続されており、動作制御部108からの制御信号に基づいて動作する。
駆動条件の具体的な設定方法については、後述の動作説明の中で説明する。
温度上昇解析部107は、動作制御部108と通信可能に接続されており、動作制御部108からの制御信号に基づいて動作する。
巻線抵抗の変化の評価方法については、後述の動作説明の中で説明する。
そして、この動作量を実現するため、回転検出部103から送出される各駆動モータ34の回転位置の情報をフィードバックしながら、それぞれの動作指令値を生成する。
この動作指令値は、駆動条件設定部106、温度上昇解析部107に送出されて、駆動条件の設定に用いられるとともに、駆動信号生成部104に送出されて、駆動信号生成部104によって動作指令値に基づく駆動信号が生成される。
ただし、動作制御部108は、入力処理部700から操作信号を受信すると、この制御信号に基づく本駆動の動作制御を行う前に、本駆動時の駆動条件を設定するための情報を取得するため、予め決められた期間の間に、試し駆動を実行する。
動作制御部108が行う制御動作の詳細については、後述の動作説明の中で説明する。
図5は、本発明の実施形態の医療用マニピュレータの制御方法のフローを示すフローチャートである。図6は、本発明の実施形態の医療用マニピュレータの制御方法における駆動条件算出式の一例を示す模式的なグラフである。図6の縦軸は回転速度n、横軸は電流Iを示す。
次に、図2に示すように、マニピュレータ処置具20の先端屈曲部25を先端部11Aの前方に繰り出してから、先端屈曲部25の原点出しを行う。
これにより、マニピュレータ処置具20が操作可能な状態になる。操作者Opは、撮像機構13で撮像され、操作者用ディスプレイ900aに表示される処置対象および先端屈曲部25の画像を見ながら、マスターアーム500a、500b等を操作して、必要な手技を行う。
このため、処置具チャンネル16に挿通されるマニピュレータ処置具20の筒状部23も、処置具チャンネル16と同様に湾曲している。これにより、筒状部23内の各シース27も種々の形状に湾曲しており、各シース27に挿通される駆動ワイヤに湾曲形状に応じた駆動負荷が発生する。このような駆動負荷により、マニピュレータ処置具20には、動作遅れや動作量のバラツキが発生するおそれがある。
医療用マニピュレータにおいて、動作遅れや動作量のバラツキがあると、手技のタイミングが狂ったり、予期できない動きが発生したりして、円滑な手技が行えなくなる。
このような駆動負荷は、例えば、駆動ワイヤの張力を測定するなどして、動力伝達系の実際の負荷を検出し、負荷量に応じて動作指令値を変更すれば、ある程度は、補正することができる。
しかし、負荷量の大きさが個々の駆動モータに及ぼす影響は、駆動モータのモータ特性の個体差や、動作時の駆動モータの発熱などによっても異なる。このため、駆動モータによらず動作指令値に補正を入れても操作性を改善できない場合がある。
本実施形態の制御方法は、入力処理部700から駆動を行う操作信号が受信されるごとに、図5に示すステップS1〜S9を、図5に示すフローにしたがって実行する方法である。
医療用マニピュレータ1では、入力処理部700が、一定周期、例えば、1msごとに操作部600およびマスターアーム500a、500bの操作入力を監視する。
入力処理部700は、検出された操作入力が、マニピュレータ処置具20の先端屈曲部25を駆動する操作入力であることを解析すると、マニピュレータ処置具20の動作制御部108に操作信号を送出する。
操作者Opが、操作部600によって操作対象をスレーブアーム200dにおけるマニピュレータ処置具20に切り替えてから、マスターアーム500a、500bを操作すると、入力処理部700によって操作部600およびマスターアーム500a、500bの操作信号が解析される。
入力処理部700が解析した操作信号は、マニピュレータ処置具20が行うべき動作の情報として、制御ユニット36の動作制御部108に送出される。例えば、マニピュレータ処置具20の把持部26が移動すべき位置や移動後の姿勢などの情報が送出される。
動作制御部108では、このような把持部26の位置、姿勢を実現するために必要な先端屈曲部25における関節22A、22Bの駆動量を算出し、この駆動量を実現するための駆動モータ34A、34Bの回転方向、回転量、回転速度を表す動作指令値を生成する。
以上で、ステップS1が終了する。
本実施形態における試し駆動の目的は、主に3つある。
第1の目的は、各駆動モータ34に出力されるPWM信号のデューティ比の誤差を補正するPWM出力補正値を求めることである。
第2の目的は、各駆動モータ34の温度上昇に基づく巻線抵抗を求め、補正できるようにすることである。
第3の目的は、本駆動時に必要な最小電流量を評価することである。
いずれの目的でも、回転方向は、動作指令値の回転方向と一致させる。
第3の目的で行う試し駆動(以下、第2の試し駆動と称する)は、デューティ比を0%から漸次増大して駆動するため、ディーティ比を0%から100%まで増加させる際の時間が設定される。この時間設定は、動作指令値と無関係に設定することが可能であり、例えば、200μs程度に設定される。
いずれの試し駆動でも、駆動信号を出力するタイミングは、駆動信号生成部104に対して駆動条件が設定された後、特に時間差を設けず、ただちに、モータドライバ100A、100Bに出力するようなタイミングである。
これによりステップS2が終了する。
ステップS2が終了すると、動作制御部108は、駆動信号生成部104に、駆動信号の生成を開始させる制御信号を送出する。これにより、駆動信号生成部104は、駆動条件設定部106が設定した駆動条件に基づいて、PWM信号を生成する。このPWM信号は、出力タイミング設定部105に設定されたタイミングで、モータドライバ100A、100Bに出力される。これにより、駆動モータ34A、34Bの第1の試し駆動が開始される。
駆動条件設定部106は、出力したPWM信号のデューティ比D0と、PWM出力検出部102から送出されたデューティ比Doutとの差ΔD=Dout−D0を、駆動モータ34A、34Bごとに算出して、それぞれPWM出力補正値ΔDA、ΔDBとして記憶する。
このようなデューティ比の変化は、例えば、スイッチング部品等の信号伝送遅れなど、ハードウェア固有の原因によって生じるため、一般に、ΔDは、正値をとり、動作指令値に比べて過大なデューティ比になっている。
このため、PWM出力補正値ΔDA、ΔDBは、本駆動時において動作指令値から算出したデューティ比を補正するために用いられる。
これにより、ハードウェア固有のPWM信号の変化が補正されるため、動作指令値により忠実な駆動が可能となる。また、デューティ比の増大によって平均印加電圧が上昇することによる発熱も抑制することができる。
以上で、ステップS3が終了する。
また、駆動条件設定部106は、後述する本駆動時においても、Dout−D0を監視し、Dout−D0が予め決められた許容値を超えた場合には、故障と判断して、操作者用ディスプレイ900a、助手用ディスプレイ900bに警告メッセージを表示して、マニピュレータ処置具20の動作を停止させることが可能である。
本ステップは、第1の試し駆動が開始され、第1の試し駆動による温度上昇の測定が可能なタイミングであれば、適宜のタイミングで行うことができる。したがって、本ステップをステップS3の後で行うのは、一例であって、ステップS3の後で行うことは必須ではない。例えば、ステップS3に先行して、または、ステップS3と並行して行うことが可能である。
巻線抵抗Rは、温度Tの関数R(T)として、例えば、次式(2)のように表される。
例えば、25℃における上記式(1)を、図6における直線190で表すと、モータの温度上昇によって、温度がT(ただし、T>T25)になった場合の上記式(1)は、巻線抵抗がR(T)(ただし、R(T)>R25)になるため、図6において、直線191のように表される。
すなわち、駆動条件が変化しないと、温度上昇するにつれて、回転速度nが低下することになる。したがって、動作指令値の回転速度に比べて低速の動作になるため、駆動モータ34の応答時間が低下する。また、駆動モータ34ごとに温度上昇が異なると、応答時間の低下量が異なるため、各駆動モータ34の応答時間にバラツキが生じる結果、各関節22の協調動作が乱れることになる。
このような関節22の応答時間の低下、バラツキは、マニピュレータ処置具20の操作性を損ねるため、外科手術などの手技の支障となる可能性がある。
このため、本ステップでは、温度上昇解析部107は、次式(3)によって、基づいて、駆動モータ34A、34Bごとの温度上昇に基づく巻線抵抗の変化を評価して、駆動モータ34A、34Bごとに巻線抵抗RTを算出する。
温度上昇解析部107によって算出された巻線抵抗RTは、駆動モータ34A、34Bごとに、それぞれ巻線抵抗RTA、RTB(巻線抵抗の評価値)として、駆動条件設定部106に送出され、駆動条件設定部106に記憶される。
以上で、ステップS4が終了する。
駆動条件設定部106は、温度上昇解析部107から送出されたRTを用いて、駆動条件算出式として、次式(4)を設定する。
以下では、一例として、上記式(4)が、未知数を算出する数式として記憶されているものとして説明する。
駆動条件算出式の設定が終了したら、第1の試し駆動を終了する。
これにより、ステップS5が終了する。
動作制御部108は、第2の試し駆動を開始する制御信号を駆動条件設定部106に送出する。
駆動条件設定部106では、PWM信号のデューティ比が0%から順次増大して、各駆動モータ34を駆動する駆動条件を設定する。
駆動条件の設定が済んだら、動作制御部108は、駆動信号生成部104に、駆動信号の生成を開始させる制御信号を送出する。これにより、駆動信号生成部104は、駆動条件設定部106が設定した駆動条件に基づいて、PWM信号等の駆動信号を生成する。この駆動信号は、出力タイミング設定部105に設定されたタイミングで、モータドライバ100A、100Bに出力される。これにより、駆動モータ34A、34Bの第2の試し駆動が開始される。
駆動条件設定部106は、電流検出部101から送出される電流量を監視することにより、各駆動モータ34の回転の開始を検出する。
このため、駆動条件設定部106には、各駆動モータ34が回転を開始したことを電流量の変化から検出するために予め決められた電流量の変化の閾値が記憶されている。
駆動モータ34の回転が始まると、慣性によって電流量が減少するため、電流の変化率を監視することで、回転の開始を検出することができる。
駆動条件設定部106から駆動モータ34が回転を開始したことを通知された動作制御部108は、駆動信号生成部104に第2の試し駆動を停止する制御信号を送出する。
このようにして、第2の試し駆動が終了するとともに、最小電流量Iminが駆動モータ34ごとに、最小電流量IminA、IminBとして算出される。
以上でステップS6が終了する。
具体的には、駆動条件設定部106が、次式(5)に基づいて、本駆動時のデューティ比DOPを、駆動信号生成部104に設定する。
駆動条件として、上記式(5)の、nOP、RT、Imin、ΔDにそれぞれ、nOPA(nOPB)、RTA(RTB)、IminA(IminB)、ΔDA(ΔDB)を代入して算出されるデューティ比DOPA(DOPB)を設定することで、試し駆動で検出された巻線抵抗の変化および信号遅れによるデューティ比の誤差が補正される。このため、PWM信号が発生すると、動作指令値の回転速度nOPA、nOPBに基づく本駆動を開始することができる。
以上で、ステップS7が終了する。
ステップS6で算出された駆動モータ34A、34Bの第2の試し駆動における回転開始時の消費電流である最小電流量IminA、IminBは、駆動モータ34A、34Bの負荷量を表している。このように負荷量が異なると、同時に回転を開始しても一定回転速度に達するまでの加速時間が異なるため、その分だけ目標の駆動が終了するまでの時間差が生じることになる。
本実施形態では、このような原因による駆動時間のバラツキを抑制するため、最小電流量IminA、IminBの大きい方から先にPWM信号の出力を開始し、最小電流量IminA、IminBの小さい方の出力タイミングを遅らせる。
出力タイミングの遅延量は、予め、最小電流値に対応する負荷量と加速時間の関係を実験などによって求めておき、駆動条件設定部106に実験式やデータテーブルなどとして記憶しておく。
駆動条件設定部106は、例えば、IminA>IminBの場合、モータドライバ100Bへの出力タイミングの遅延量Δtを、予め設定された関数fに基づいて、Δt=f(IminA−IminB)として算出して、出力タイミング設定部105に設定する。
以上で、ステップS8が終了する。
動作制御部108は、駆動信号生成部104に、駆動信号の生成を開始させる制御信号を送出する。これにより、駆動信号生成部104は、駆動条件設定部106が設定した本駆動の駆動条件に基づいて、PWM信号を含む駆動信号を生成する。このPWM信号は、出力タイミング設定部105に設定された本駆動の出力タイミングで、モータドライバ100A、100Bに出力される。これにより、駆動モータ34A、34Bの本駆動が開始される。
これにより、駆動モータ34A、34Bが、動作制御部108が算出した動作指令値に基づいて、回転し、先端屈曲部25の関節22A、22Bが、マスターアーム500a、500bの操作に基づく位置、姿勢となるように駆動される。
以上で、ステップS9が終了する。
このようにして、動作制御部108に操作信号が送信されるごとに、このような試し駆動と本駆動とが繰り返されていく。
上記ステップS9は、第1のステップで設定されたモータの駆動条件に基づいて、操作入力に対応する駆動を行う第2のステップを構成している。
すなわち、操作信号が送信されるごとに、試し駆動を行って、負荷量や温度上昇に基づく巻線抵抗の変化を評価するため、手技の実行中に負荷量が変化してもモータを正確かつ迅速に動作させることができる。
また、モータが複数設けられている場合に、モータごとに試し駆動を行って、負荷量や温度上昇に基づく巻線抵抗の変化を評価するため、例えば、駆動方向など違いにより、モータごとに負荷量が変化してもモータを正確かつ迅速に動作させることができる。
特に、モータの駆動周波数が、例えば、500kHzといった高い周波数の場合には、信号出力遅延による誤差の影響で相対的に大きなデューティ比誤差が大きくなる。
例えば、駆動周波数が50kHzの場合と、500kHzの場合とでは、デューティ比が10%で、ハードウェアによる信号出力遅延による誤差が100ns生じたとする。この場合、50kHzでは、デューティ比誤差が5%(=100×100ns/2μs)であるのに対して、500kHzでは、デューティ比誤差が50%(=100×100ns/0.2μs)になる。このため、500kHzでは、デューティ比が10%から15%にもなってしまうが、本実施形態では、このような誤差の発生を防止することができる。
また、モータは1個のみでもよい。ただし、この場合、上記ステップS8は削除する。
11 内視鏡マニピュレータ(医療用マニピュレータ)
11B 湾曲部
16 処置具チャンネル
20 マニピュレータ処置具(医療用マニピュレータ)
22、22A、22B 関節(被駆動部)
23 筒状部
24、24A、24B 駆動ワイヤ
25 先端屈曲部
26 把持部
30 駆動ユニット
34、34A、34B 駆動モータ(モータ)
34Ab、34Bb エンコーダ
36 制御ユニット
100A、100B モータドライバ
101 電流検出部
102 PWM出力検出部
103 回転検出部
104 駆動信号生成部
105 出力タイミング設定部
106 駆動条件設定部
107 温度上昇解析部
108 動作制御部
240a、240b、240c 医療用マニピュレータ
400 スレーブ制御部
500a、500b マスターアーム(操作部)
600 操作部
700 入力処理部
800 画像処理部
ΔD、ΔDA、ΔDB PWM出力補正値
DOP、DOPA、DOPB デューティ比
Imin、IminA、IminB 最小電流量(駆動電流、消費電流)
M 医療用マニピュレータシステム
Op 操作者
P 患者
RT、RTA、RTB 巻線抵抗(巻線抵抗の評価値)
Claims (4)
- 操作部からの操作入力に応じてモータを回転することにより、被駆動部を駆動する医療用マニピュレータの制御方法であって、
前記操作入力が発生した際に、試し駆動を行って、前記モータの温度上昇に基づく巻線抵抗の変化を評価し、評価された巻線抵抗の変化に基づいて前記モータの駆動条件を設定する第1のステップと、
該第1のステップで設定された前記モータの駆動条件に基づいて、前記操作入力に対応する駆動を行う第2のステップと、
を備える、医療用マニピュレータの制御方法。 - 前記第1のステップでは、
前記試し駆動時におけるモータの消費電流、平均印加電圧、および回転速度を検出して、これらの検出値から駆動時の巻線抵抗の評価値を求め、
前記試し駆動時における回転開始電流を測定して、該回転開始電流を上回る駆動電流を設定し、
前記巻線抵抗の評価値および前記駆動電流に基づいて、駆動を行うためのPWM信号のデューティ比を算出する
ことにより、前記モータの駆動条件を設定する
ことを特徴とする、請求項1に記載の医療用マニピュレータの制御方法。 - 前記医療用マニピュレータが前記モータを複数備える場合に、
前記第1のステップでは、
前記試し駆動時における負荷量を評価し、
前記モータの駆動条件として、前記モータ間の駆動終了タイミングのバラツキを低減するため、前記負荷量が大きいモータから順に駆動を開始する駆動開始タイミングを前記モータごとに設定する
ことを特徴とする、請求項1または2に記載の医療用マニピュレータの制御方法。 - 前記第1のステップでは、
前記負荷量を、前記試し駆動時における消費電流から評価する
ことを特徴とする、請求項3に記載の医療用マニピュレータの制御方法。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014127253A JP6203134B2 (ja) | 2014-06-20 | 2014-06-20 | 医療用マニピュレータの制御方法 |
PCT/JP2015/065943 WO2015194368A1 (ja) | 2014-06-20 | 2015-06-02 | 医療用マニピュレータの制御方法 |
EP15810235.0A EP3159117A4 (en) | 2014-06-20 | 2015-06-02 | Method for controlling medical manipulator |
CN201580030100.1A CN106456262A (zh) | 2014-06-20 | 2015-06-02 | 医疗用机械手的控制方法 |
US15/375,388 US9943957B2 (en) | 2014-06-20 | 2016-12-12 | Method for controlling medical manipulator |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014127253A JP6203134B2 (ja) | 2014-06-20 | 2014-06-20 | 医療用マニピュレータの制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2016005512A JP2016005512A (ja) | 2016-01-14 |
JP6203134B2 true JP6203134B2 (ja) | 2017-09-27 |
Family
ID=54935358
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2014127253A Active JP6203134B2 (ja) | 2014-06-20 | 2014-06-20 | 医療用マニピュレータの制御方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US9943957B2 (ja) |
EP (1) | EP3159117A4 (ja) |
JP (1) | JP6203134B2 (ja) |
CN (1) | CN106456262A (ja) |
WO (1) | WO2015194368A1 (ja) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA3090336A1 (en) * | 2018-02-02 | 2019-08-08 | Covidien Lp | Surgical robotic system including synchronous and asynchronous networks and a method employing the same |
JP6865262B2 (ja) * | 2018-12-26 | 2021-04-28 | 川崎重工業株式会社 | ロボットシステムの制御装置 |
CN111568558B (zh) * | 2020-04-13 | 2022-02-22 | 上海市胸科医院 | 电子设备、手术机器人***及其控制方法 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS57160381A (en) * | 1981-03-25 | 1982-10-02 | Matsushita Electric Ind Co Ltd | Speed controlling device of direct current motor |
JPH01231676A (ja) * | 1988-03-09 | 1989-09-14 | Canon Inc | 直流モータの制御装置 |
JPH02206469A (ja) * | 1989-02-03 | 1990-08-16 | Aisin Seiki Co Ltd | ポンピング装置 |
JPH06121579A (ja) * | 1992-10-05 | 1994-04-28 | Matsushita Electric Ind Co Ltd | 直流モータの速度制御回路 |
JPH09182500A (ja) * | 1995-12-26 | 1997-07-11 | Hitachi Kiden Kogyo Ltd | モータ巻線抵抗値補正式センサレスベクトル制御インバータ |
DE19843106B4 (de) * | 1998-09-21 | 2005-08-18 | Ebm-Papst Mulfingen Gmbh & Co. Kg | System zur Drehzahlsteuerung von Wechselstrom-Motoren |
JP3986344B2 (ja) | 2002-03-25 | 2007-10-03 | 本田技研工業株式会社 | 電動パワーステアリング装置のデューティ不感帯補正方法 |
JP4613071B2 (ja) | 2005-01-07 | 2011-01-12 | 日立オートモティブシステムズ株式会社 | 制御方法 |
JP4580973B2 (ja) * | 2007-11-29 | 2010-11-17 | オリンパスメディカルシステムズ株式会社 | 処置具システム |
JP5102080B2 (ja) | 2008-03-17 | 2012-12-19 | 日立オートモティブシステムズ株式会社 | 車両用モータの制御装置 |
JP5085684B2 (ja) | 2010-05-19 | 2012-11-28 | オリンパスメディカルシステムズ株式会社 | 処置具システム及びマニピュレータシステム |
JP2013027105A (ja) * | 2011-07-19 | 2013-02-04 | Toshiba Corp | モータ駆動回路、および、モータ駆動システム |
JP2016534788A (ja) * | 2013-10-30 | 2016-11-10 | サノフィ−アベンティス・ドイチュラント・ゲゼルシャフト・ミット・ベシュレンクテル・ハフツング | モータ巻線の抵抗測定を含む装置、およびそのような装置を制御する方法 |
-
2014
- 2014-06-20 JP JP2014127253A patent/JP6203134B2/ja active Active
-
2015
- 2015-06-02 WO PCT/JP2015/065943 patent/WO2015194368A1/ja active Application Filing
- 2015-06-02 EP EP15810235.0A patent/EP3159117A4/en not_active Withdrawn
- 2015-06-02 CN CN201580030100.1A patent/CN106456262A/zh active Pending
-
2016
- 2016-12-12 US US15/375,388 patent/US9943957B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN106456262A (zh) | 2017-02-22 |
EP3159117A4 (en) | 2018-02-21 |
WO2015194368A1 (ja) | 2015-12-23 |
EP3159117A1 (en) | 2017-04-26 |
JP2016005512A (ja) | 2016-01-14 |
US9943957B2 (en) | 2018-04-17 |
US20170087714A1 (en) | 2017-03-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6278747B2 (ja) | マニピュレータのキャリブレーション方法、マニピュレータ、およびマニピュレータシステム | |
US20170080581A1 (en) | Manipulator control method, manipulator, and manipulator system | |
JP6265853B2 (ja) | 医療用機器 | |
EP3096672B1 (en) | Sensorless force control for transesophageal echocardiography probe | |
JP6230430B2 (ja) | 術具及び医療用マニピュレータシステム | |
JP5936607B2 (ja) | 位置測定を備える医療機器における駆動力制御 | |
JP4601727B2 (ja) | 内視鏡処置用ロボットシステム | |
GB2534558A (en) | Robot tool retraction | |
JP7085401B2 (ja) | 外科手術システム | |
JP2010214128A (ja) | 処置具システム及びマニピュレータシステム | |
US20170333143A1 (en) | Medical manipulator system | |
JP6064095B2 (ja) | 操作入力装置および医療用マニピュレータシステム | |
JP5959722B2 (ja) | 処置具交換装置及び医療システム | |
WO2015194262A1 (ja) | 手術用マニピュレータ操作装置および手術用マニピュレータシステム | |
JP6203134B2 (ja) | 医療用マニピュレータの制御方法 | |
US11033346B2 (en) | Medical master-slave manipulator system | |
JP7440540B2 (ja) | 制御された把持及びエネルギ送達のためのシステム及び方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20160926 |
|
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: 20170808 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170829 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6203134 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
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 |