WO2016199228A1 - 医療用マニピュレータ制御装置 - Google Patents
医療用マニピュレータ制御装置 Download PDFInfo
- Publication number
- WO2016199228A1 WO2016199228A1 PCT/JP2015/066637 JP2015066637W WO2016199228A1 WO 2016199228 A1 WO2016199228 A1 WO 2016199228A1 JP 2015066637 W JP2015066637 W JP 2015066637W WO 2016199228 A1 WO2016199228 A1 WO 2016199228A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- load
- unit
- joint
- command signal
- medical manipulator
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
Definitions
- the present invention relates to a medical manipulator control device.
- a medical manipulator in which an end effector and a joint portion arranged at the distal end of a long insertion portion are driven via a wire arranged in the insertion portion by a driving portion arranged on the proximal end side of the insertion portion (for example, see Patent Document 1.)
- the medical manipulator disclosed in Patent Document 1 controls a drive unit arranged on the proximal end side of an insertion unit according to a command signal.
- a command signal When the end effector grips the tissue or hits the tissue and a load is applied to the joint, the wire stretches due to the tension applied to the wire, so even if the drive is driven according to the command signal, the joint at the tip Cannot be moved, and the target position and the actual position are different, and cannot be moved to an accurate position.
- the present invention has been made in view of the above-described circumstances, and an object thereof is to provide a medical manipulator control device that can accurately drive a joint even when a load applied to an end effector fluctuates. .
- One aspect of the present invention is a storage unit that stores a mathematical model of a medical manipulator that includes a joint unit that moves an end effector and a drive unit that drives the joint unit via a tension transmission member. Based on the stored mathematical model, the target command signal input to the drive unit, and the tension applied to the tension transmission member when the drive unit is driven by the target command signal, A load estimation unit that estimates a load to be applied, a load estimated by the load estimation unit, and a movement amount estimation unit that estimates an actual movement amount of the joint unit based on the drive amount of the drive unit; Correction for correcting the command signal output to the drive unit based on the actual movement amount of the joint part estimated by the movement amount estimation unit and the target movement amount of the joint part in the case of no load With department Ryoyo is a manipulator control device.
- the drive unit when the target command signal is input to the drive unit, the drive unit is driven, tension is generated in the tension transmitting member, the joint unit is operated, and the end effector is moved.
- the load estimating unit acts on the joint based on the detected tension, the mathematical model stored in the storage unit, and the target command signal. The load is estimated. Then, based on the estimated load and the driving amount of the driving unit, the actual moving amount of the joint portion is estimated by the moving amount estimating unit.
- the end effector can be moved by driving the joint portion so as to approach the unloaded target movement amount.
- the correction unit may correct the command signal when the load estimated by the load estimation unit changes. By doing in this way, according to the fluctuation
- amendment part may correct
- the correction unit outputs a larger command signal to the drive unit than when there is no load, so the load acting on the joint is reduced with the same command signal. Sometimes it gets moved too much.
- the command signal can be decreased to prevent the joint portion from being moved too much.
- the end effector includes a gripper that can be opened and closed, and opening / closing information of the gripper is input, and the correction unit corrects the command signal based on the input opening / closing information. Also good.
- the grasping part is opened and the object is released from the state where the grasping part is closed and the object is grasped, the load applied to the joint part changes rapidly. According to this aspect, it is possible to detect a change in the load at an early stage based on the opening / closing information of the gripping part, and to quickly correct the command signal.
- the correction unit may detect a load change from a time change of the load estimated by the load estimation unit. By doing so, it is possible to predict a change in load by time change of the load, for example, differentiation or twice differentiation, more quickly than detecting the estimated change in the load itself and correcting the command signal.
- the joint portion can be driven with high accuracy even if the load applied to the end effector fluctuates.
- the medical manipulator control device 1 is a device that controls the medical manipulator 2 in accordance with an operation command from an operation unit (not shown).
- the medical manipulator 2 includes one or more bending joints (joint portions) 4 that support the end effector 3 at the distal end, a wire (tension transmission member) 5 that transmits a tension T for driving the bending joint 4, and a base A motor (driving unit) 6 that is disposed on the end side and applies a tension T to the wire 5 and a tension detection unit 7 that detects the tension T of the wire 5 are provided.
- the end effector 3 is a grasping forceps having the grasping portion 8, for example.
- the operation unit has a lever (not shown) that is operated by the operator, and outputs a target command signal ⁇ s proportional to the tilt angle of the lever.
- the medical manipulator control device 1 As shown in FIG. 2, the medical manipulator control device 1 according to the present embodiment generates a drive command ⁇ m that is output to the motor 6 based on a target command signal ⁇ s input from the operation unit.
- a storage unit 10 that stores the mathematical models f1 and f2 of the medical manipulator 2, a load estimation unit 11 that estimates a load R acting on the end effector 3, and a load R estimated by the load estimation unit 11
- the movement amount estimation unit 12 that estimates the actual movement amount ⁇ 2 of the bending joint 4 and the drive that is output to the motor 6 based on the actual movement amount ⁇ 2 of the bending joint 4 estimated by the movement amount estimation unit 12
- a correction unit 13 that corrects the command ⁇ m.
- the load estimation unit 11 acts on the end effector 3 based on the target command signal ⁇ s, the tension T of the wire 5 detected by the tension detection unit 7, and the mathematical model f1 stored in the storage unit 10.
- FIG. 3 shows the tension T1 when there is no load and the tension T2 when the load R is applied.
- the mathematical model f2 is a linear function
- the relationship between the actual movement amount ⁇ and the target command signal ⁇ s varies depending on the magnitude of the load R, as shown in FIG. To do. Therefore, the actual movement amount ⁇ of the flexure joint 4 can be estimated by using the load R, the target command signal ⁇ s, and the mathematical model f2.
- FIG. 4 shows the actual movement amount ⁇ 1 of the bending joint 4 when there is no load, and the actual movement amount ⁇ 2 of the bending joint 4 when the load R is applied.
- the correction unit 13 calculates the movement amount ⁇ 1 in the case of no load from the target command signal ⁇ s.
- a difference ⁇ between the actual movement amount ⁇ 2 of the bending joint 4 estimated by the movement amount estimation unit 12 and the movement amount ⁇ 1 in the case of no load is calculated, a difference command signal ⁇ m for obtaining ⁇ is calculated, and driving The command ⁇ m is corrected to a new drive command ⁇ m + ⁇ m and output.
- the medical manipulator control device 1 When the bending joint 4 is driven in a state where the target object is gripped by the end effector 3, the load R acts as compared to the case of no load that is not gripped.
- the tension T of the wire 5 detected by the tension detection unit 7 and the target command signal ⁇ s are obtained.
- the correction unit 13 calculates the difference ⁇ between the movement amount ⁇ 1 of the flexion joint 4 and the actual movement amount ⁇ 2 in the case of no load calculated using the same mathematical model, and achieves the difference ⁇ .
- a difference command signal ⁇ m is calculated, and the drive command ⁇ m output from the drive command generator 9 is corrected to a new drive command ⁇ m + ⁇ m and output to the motor 6.
- the medical manipulator control device 1 According to the medical manipulator control device 1 according to the present embodiment, even if the operation command to the operation unit by the operator is the same, a larger drive command ⁇ m + ⁇ m is output as the load R applied to the end effector 3 increases. Since the drive command ⁇ m is corrected, there is an advantage that the end effector 3 can be moved almost similarly by the same operation regardless of the magnitude of the load R.
- the load R and the actual movement amount ⁇ of the bending joint 4 are estimated from the tension T applied to the wire 5, so that the movement amount ⁇ is detected by the bending joint 4. Therefore, there is an advantage that the structure of the medical manipulator 2 can be simplified, reduced in weight, or reduced in diameter.
- the present invention can also be applied when the load R acting on the end effector 3 decreases.
- the drive command ⁇ m is corrected so that the drive command ⁇ m + ⁇ m is reduced and output as the load R applied to the end effector 3 decreases.
- the load R acting on the end effector 3 may decrease rapidly.
- the object held by the end effector 3 may come off unexpectedly, or the object held at the moment when the end effector 3 is opened may be released. In these cases, it is conceivable that the end effector 3 moves greatly because the load R suddenly disappears in a state where a large drive command ⁇ m + ⁇ m when the load R is present is input to the motor 6.
- the load R is extinguished and the drive command ⁇ m + ⁇ m is decreased.
- the drive command ⁇ m + ⁇ m can be reduced more rapidly, and the end effector 3 can be prevented from moving suddenly.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
エンドエフェクタ(3)にかかる負荷が変動しても関節部(4)を精度よく駆動することを目的として、本発明の医療用マニピュレータ制御装置(1)は、エンドエフェクタ(3)を移動させる関節部(4)と、張力伝達部材(5)を介して関節部(4)を駆動する駆動部(6)とを備える医療用マニピュレータ(2)の数式モデルを記憶する記憶部と、記憶された数式モデルと、入力された目標指令信号と、張力伝達部材(5)にかかる張力とに基づいて、関節部(4)に作用する負荷を推定する負荷推定部と、推定された負荷と、駆動部(6)の駆動量とに基づいて、関節部(4)の実際の移動量を推定する移動量推定部と、推定された関節部(4)の実際の移動量と、無負荷の場合の関節部(4)の目標移動量とに基づいて、駆動部(6)に対して出力する指令信号を補正する補正部とを備える。
Description
本発明は、医療用マニピュレータ制御装置に関するものである。
長尺の挿入部の先端に配置したエンドエフェクタおよび関節部を、挿入部の基端側に配置した駆動部によって、挿入部内に配置したワイヤを介して駆動する医療用マニピュレータが知られている(例えば、特許文献1参照。)。
特許文献1の医療用マニピュレータは、挿入部の基端側に配置した駆動部を指令信号に従って制御するものである。
エンドエフェクタが組織を把持したり組織に当たったりして関節部に負荷がかかると、ワイヤにかかる張力によってワイヤが伸びるため、駆動部においては指令信号通りに駆動されていても、先端の関節部は移動できず、目標位置と実際の位置とが異なってしまい、正確な位置に移動させることができない。
エンドエフェクタが組織を把持したり組織に当たったりして関節部に負荷がかかると、ワイヤにかかる張力によってワイヤが伸びるため、駆動部においては指令信号通りに駆動されていても、先端の関節部は移動できず、目標位置と実際の位置とが異なってしまい、正確な位置に移動させることができない。
本発明は、上述した事情に鑑みてなされたものであって、エンドエフェクタにかかる負荷が変動しても関節部を精度よく駆動することができる医療用マニピュレータ制御装置を提供することを目的としている。
本発明の一態様は、エンドエフェクタを移動させる関節部と、張力伝達部材を介して前記関節部を駆動する駆動部とを備える医療用マニピュレータの数式モデルを記憶する記憶部と、該記憶部に記憶された数式モデルと、前記駆動部に入力された目標指令信号と、該目標指令信号によって前記駆動部が駆動されたときに、前記張力伝達部材にかかる張力とに基づいて、前記関節部に作用する負荷を推定する負荷推定部と、該負荷推定部により推定された負荷と、前記駆動部の駆動量とに基づいて、前記関節部の実際の移動量を推定する移動量推定部と、該移動量推定部により推定された前記関節部の実際の移動量と、無負荷の場合の前記関節部の目標移動量とに基づいて、前記駆動部に対して出力する指令信号を補正する補正部とを備える医療用マニピュレータ制御装置である。
本態様によれば、目標指令信号が駆動部に入力されると、駆動部が駆動され、張力伝達部材に張力が発生して関節部が動作させられてエンドエフェクタが移動させられる。張力伝達部材に発生している張力が検出されると、負荷推定部により、検出された張力と、記憶部に記憶されている数式モデルと、目標指令信号とに基づいて、関節部に作用する負荷が推定される。そして、推定された負荷と駆動部の駆動量とに基づいて移動量推定部により関節部の実際の移動量が推定される。
駆動部により張力伝達部材を介して関節部を駆動する場合には、関節部の実際の移動量は、関節部に作用する負荷によって異なってくるので、補正部により指令信号を補正することにより、負荷が存在していても無負荷の目標移動量に近づけるように関節部を駆動しエンドエフェクタを移動させることができる。
上記態様においては、前記補正部は、前記負荷推定部により推定された負荷が変化した場合に、前記指令信号を補正してもよい。
このようにすることで、負荷の変動に合わせて、無負荷の目標移動量に近づくように関節部を駆動することができる。
このようにすることで、負荷の変動に合わせて、無負荷の目標移動量に近づくように関節部を駆動することができる。
また、上記態様においては、前記補正部は、前記関節部に作用する負荷が減少したときに、前記指令信号を減少させるように補正してもよい。
関節部に負荷が作用している場合に、補正部は、駆動部に無負荷の場合よりも大きな指令信号を出力させているので、そのままの指令信号では、関節部に作用する負荷が減少したときには、移動させ過ぎになる。本態様によれば、負荷が減少したときには指令信号を減少させて関節部の移動させ過ぎを防止することができる。
関節部に負荷が作用している場合に、補正部は、駆動部に無負荷の場合よりも大きな指令信号を出力させているので、そのままの指令信号では、関節部に作用する負荷が減少したときには、移動させ過ぎになる。本態様によれば、負荷が減少したときには指令信号を減少させて関節部の移動させ過ぎを防止することができる。
また、上記態様においては、前記エンドエフェクタが開閉可能な把持部を備え、該把持部の開閉情報が入力され、前記補正部が、入力された前記開閉情報に基づいて前記指令信号を補正してもよい。
把持部を閉じて対象物を把持している状態から把持部を開いて対象物を解放すると、関節部にかかる負荷が急激に変化する。本態様によれば、把持部の開閉情報によって負荷の変化を早期に検出し、指令信号を迅速に補正することができる。
把持部を閉じて対象物を把持している状態から把持部を開いて対象物を解放すると、関節部にかかる負荷が急激に変化する。本態様によれば、把持部の開閉情報によって負荷の変化を早期に検出し、指令信号を迅速に補正することができる。
また、上記態様においては、前記補正部は、前記負荷推定部により推定された負荷の時間変化から負荷の変化を検出してもよい。
このようにすることで、推定された負荷自体の変化を検出して指令信号を補正するよりも迅速に負荷の時間変化、例えば、微分あるいは2回微分によって負荷の変化を予測することができる。
このようにすることで、推定された負荷自体の変化を検出して指令信号を補正するよりも迅速に負荷の時間変化、例えば、微分あるいは2回微分によって負荷の変化を予測することができる。
本発明によれば、エンドエフェクタにかかる負荷が変動しても関節部を精度よく駆動することができるという効果を奏する。
以下、本発明の一実施形態に係る医療用マニピュレータ制御装置1について、図面を参照して以下に説明する。
本実施形態に係る医療用マニピュレータ制御装置1は、図1に示されるように、操作部(図示略)からの操作指令に応じて医療用マニピュレータ2を制御する装置である。
本実施形態に係る医療用マニピュレータ制御装置1は、図1に示されるように、操作部(図示略)からの操作指令に応じて医療用マニピュレータ2を制御する装置である。
医療用マニピュレータ2は、先端のエンドエフェクタ3を支持する1以上の屈曲関節(関節部)4と、該屈曲関節4を駆動するための張力Tを伝達するワイヤ(張力伝達部材)5と、基端側に配置されてワイヤ5に張力Tを付与するモータ(駆動部)6と、ワイヤ5の張力Tを検出する張力検出部7とを備えている。エンドエフェクタ3は、例えば、把持部8を有する把持鉗子である。
操作部は、操作者により操作される図示しないレバーを有し、レバーの傾斜角度に比例した目標指令信号θsを出力するようになっている。
操作部は、操作者により操作される図示しないレバーを有し、レバーの傾斜角度に比例した目標指令信号θsを出力するようになっている。
本実施形態に係る医療用マニピュレータ制御装置1は、図2に示されるように、操作部から入力された目標指令信号θsに基づいてモータ6に出力する駆動指令θmを生成する駆動指令生成部9と、医療用マニピュレータ2の数式モデルf1,f2を記憶する記憶部10と、エンドエフェクタ3に作用している負荷Rを推定する負荷推定部11と、該負荷推定部11により推定された負荷Rに基づいて屈曲関節4の実際の移動量θ2を推定する移動量推定部12と、該移動量推定部12により推定された屈曲関節4の実際の移動量θ2に基づいてモータ6に出力する駆動指令θmを補正する補正部13とを備えている。
負荷推定部11は、目標指令信号θsと、張力検出部7により検出されたワイヤ5の張力Tと、記憶部10に記憶されている数式モデルf1とに基づいて、エンドエフェクタ3に作用している負荷Rを推定するようになっている。
負荷推定部11は、具体的には、記憶部10に記憶されている、式(1)で示される数式モデルf1を用いて負荷Rを推定するようになっている。
T=f1(θs,R) (1)
負荷推定部11は、具体的には、記憶部10に記憶されている、式(1)で示される数式モデルf1を用いて負荷Rを推定するようになっている。
T=f1(θs,R) (1)
説明を簡単にするために、数式モデルf1が1次関数であるとすると、図3に示されるように、張力Tと目標指令信号θsとの関係は、負荷Rの大きさによって変化する。したがって、張力Tと目標指令信号θsと数式モデルf1とを用いることにより、エンドエフェクタ3に作用している負荷Rを推定することができる。図3には、無負荷の場合の張力T1と、負荷Rが作用したときの張力T2とが示されている。
移動量推定部12は、負荷推定部11により推定された負荷Rと、記憶部10に記憶されている数式モデルf2と、操作部から入力されてきた目標指令信号θsとに基づいて、屈曲関節4の実際の移動量θを推定するようになっている。
移動量推定部12は、具体的には、記憶部10に記憶されている、式(2)で示される数式モデルf2を用いて実際の移動量θを推定するようになっている。
θ=f2(θs,R) (2)
移動量推定部12は、具体的には、記憶部10に記憶されている、式(2)で示される数式モデルf2を用いて実際の移動量θを推定するようになっている。
θ=f2(θs,R) (2)
説明を簡単にするために、数式モデルf2が1次関数であるとすると、図4に示されるように、実際の移動量θと目標指令信号θsとの関係は、負荷Rの大きさによって変化する。したがって、負荷Rと目標指令信号θsと数式モデルf2とを用いることにより、屈曲関節4の実際の移動量θを推定することができる。図4には、無負荷の場合の屈曲関節4の実際の移動量θ1と、負荷Rが作用したときの屈曲関節4の実際の移動量θ2とが示されている。
補正部13は、目標指令信号θsから無負荷の場合の移動量θ1を算出する。移動量推定部12により推定された屈曲関節4の実際の移動量θ2と、無負荷の場合の移動量θ1との差分Δθを演算し、Δθを得るための差分指令信号Δθmを算出し、駆動指令θmを新たな駆動指令θm+Δθmに補正して出力するようになっている。
このように構成された本実施形態に係る医療用マニピュレータ制御装置1の作用について説明する。
エンドエフェクタ3によって対象物が把持された状態で屈曲関節4を駆動する場合には、把持していない無負荷の場合と比較して負荷Rが作用する。
エンドエフェクタ3によって対象物が把持された状態で屈曲関節4を駆動する場合には、把持していない無負荷の場合と比較して負荷Rが作用する。
本実施形態に係る医療用マニピュレータ制御装置1によれば、操作部が操作されて目標指令信号θsが入力されると、張力検出部7により検出されたワイヤ5の張力Tと目標指令信号θsと、記憶部10に記憶されている数式モデルT=f1(θs,R)とに基づいて、負荷Rが推定される。次いで、推定された負荷Rと、目標指令信号θsと、記憶部10に記憶されている数式モデルθ=f2(θs,R)とから屈曲関節4の実際の移動量θが算出される。
そして、補正部13において、同じ数式モデルを用いて算出された無負荷の場合の屈曲関節4の移動量θ1と実際の移動量θ2との差分Δθが算出され、かつ、当該差分Δθを達成するための差分指令信号Δθmが算出されて、駆動指令生成部9から出力された駆動指令θmが新たな駆動指令θm+Δθmに補正されてモータ6に出力される。
その結果、本実施形態に係る医療用マニピュレータ制御装置1によれば、操作者による操作部に対する操作指令が同じでも、エンドエフェクタ3にかかる負荷Rが大きいほど大きな駆動指令θm+Δθmが出力されるように駆動指令θmが補正されるので、負荷Rの大きさに関わらず、同じ操作によってほぼ同様にエンドエフェクタ3を移動させることができるという利点がある。
また、本実施形態に係る医療用マニピュレータ制御装置1によれば、ワイヤ5にかかる張力Tから負荷Rおよび実際の屈曲関節4の移動量θを推定するので、屈曲関節4に移動量θを検出するセンサを配置する必要がなく、医療用マニピュレータ2の構造を単純化、軽量化あるいは細径化することができるという利点がある。
なお、本実施形態においては、エンドエフェクタ3に作用する負荷Rが増えた場合を例示して説明したが、エンドエフェクタ3に作用する負荷Rが減少した場合にも適用できることは言うまでもない。この場合、操作者によって操作部に入力される目標指令信号θsが同じでも、エンドエフェクタ3にかかる負荷Rが小さくなればなるほど駆動指令θm+Δθmが減少されて出力されるように駆動指令θmが補正される。
また、エンドエフェクタ3に作用する負荷Rが急激に減少する場合がある。例えば、エンドエフェクタ3により把持していた対象物が不意に外れたり、あるいは、エンドエフェクタ3を開いた瞬間に把持していた対象物が解放されたりする場合である。これらの場合には、負荷Rがある場合の大きな駆動指令θm+Δθmがモータ6に入力されている状態で、突然負荷Rがなくなるので、エンドエフェクタ3が大きく移動してしまうことが考えられる。
そこで、これらの場合には負荷変動を早期に検出して現在の移動量θが維持されるように駆動指令θm+Δθmを減少させる必要がある。
負荷変動を早期に検出する方法としては、負荷推定部11により推定される負荷Rの時間変化を検出することが挙げられる。すなわち、負荷Rの変動速度あるいは負荷Rの変動加速度を検出することにより、負荷変動を予測して早期に対応することができる。
負荷変動を早期に検出する方法としては、負荷推定部11により推定される負荷Rの時間変化を検出することが挙げられる。すなわち、負荷Rの変動速度あるいは負荷Rの変動加速度を検出することにより、負荷変動を予測して早期に対応することができる。
また、負荷変動を早期に検出する方法として、把持部8の開閉情報を検出することにより、把持部8が開かれたときには、負荷Rが消滅するものとして駆動指令θm+Δθmを減少させることにしてもよい。これにより、さらに迅速に駆動指令θm+Δθmを減少させてエンドエフェクタ3が急激に移動してしまうことを防止することができる。
1 医療用マニピュレータ制御装置
2 医療用マニピュレータ
3 エンドエフェクタ
4 屈曲関節(関節部)
5 ワイヤ(張力伝達部材)
6 モータ(駆動部)
8 把持部
10 記憶部
11 負荷推定部
12 移動量推定部
13 補正部
θ 移動量
θs 目標指令信号
f1,f2 数式モデル
R 負荷
T 張力
2 医療用マニピュレータ
3 エンドエフェクタ
4 屈曲関節(関節部)
5 ワイヤ(張力伝達部材)
6 モータ(駆動部)
8 把持部
10 記憶部
11 負荷推定部
12 移動量推定部
13 補正部
θ 移動量
θs 目標指令信号
f1,f2 数式モデル
R 負荷
T 張力
Claims (5)
- エンドエフェクタを移動させる関節部と、張力伝達部材を介して前記関節部を駆動する駆動部とを備える医療用マニピュレータの数式モデルを記憶する記憶部と、
該記憶部に記憶された数式モデルと、前記駆動部に入力された目標指令信号と、該目標指令信号によって前記駆動部が駆動されたときに、前記張力伝達部材にかかる張力とに基づいて、前記関節部に作用する負荷を推定する負荷推定部と、
該負荷推定部により推定された負荷と、前記駆動部の駆動量とに基づいて、前記関節部の実際の移動量を推定する移動量推定部と、
該移動量推定部により推定された前記関節部の実際の移動量と、無負荷の場合の前記関節部の目標移動量とに基づいて、前記駆動部に対して出力する指令信号を補正する補正部とを備える医療用マニピュレータ制御装置。 - 前記補正部は、前記負荷推定部により推定された負荷が変化した場合に、前記指令信号を補正する請求項1に記載の医療用マニピュレータ制御装置。
- 前記補正部は、前記関節部に作用する負荷が減少したときに、前記指令信号を減少させるように補正する請求項2に記載の医療用マニピュレータ制御装置。
- 前記エンドエフェクタが開閉可能な把持部を備え、該把持部の開閉情報が入力され、
前記補正部が、入力された前記開閉情報に基づいて前記指令信号を補正する請求項3に記載の医療用マニピュレータ制御装置。 - 前記補正部は、前記負荷推定部により推定された負荷の時間変化から負荷の変化を検出する請求項2または請求項3に記載の医療用マニピュレータ制御装置。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017522795A JP6532531B2 (ja) | 2015-06-09 | 2015-06-09 | 医療用マニピュレータ制御装置 |
PCT/JP2015/066637 WO2016199228A1 (ja) | 2015-06-09 | 2015-06-09 | 医療用マニピュレータ制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2015/066637 WO2016199228A1 (ja) | 2015-06-09 | 2015-06-09 | 医療用マニピュレータ制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2016199228A1 true WO2016199228A1 (ja) | 2016-12-15 |
Family
ID=57503512
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2015/066637 WO2016199228A1 (ja) | 2015-06-09 | 2015-06-09 | 医療用マニピュレータ制御装置 |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP6532531B2 (ja) |
WO (1) | WO2016199228A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020121353A (ja) * | 2019-01-29 | 2020-08-13 | 新東工業株式会社 | ロボット |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009107074A (ja) * | 2007-10-30 | 2009-05-21 | Olympus Medical Systems Corp | マニピュレータ装置および医療機器システム |
JP2010035768A (ja) * | 2008-08-04 | 2010-02-18 | Olympus Medical Systems Corp | 能動駆動式医療機器 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4580973B2 (ja) * | 2007-11-29 | 2010-11-17 | オリンパスメディカルシステムズ株式会社 | 処置具システム |
CN102341057B (zh) * | 2009-11-10 | 2014-03-05 | 奥林巴斯医疗株式会社 | 多关节机械手装置以及具有该装置的内窥镜系统 |
-
2015
- 2015-06-09 JP JP2017522795A patent/JP6532531B2/ja active Active
- 2015-06-09 WO PCT/JP2015/066637 patent/WO2016199228A1/ja active Application Filing
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009107074A (ja) * | 2007-10-30 | 2009-05-21 | Olympus Medical Systems Corp | マニピュレータ装置および医療機器システム |
JP2010035768A (ja) * | 2008-08-04 | 2010-02-18 | Olympus Medical Systems Corp | 能動駆動式医療機器 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020121353A (ja) * | 2019-01-29 | 2020-08-13 | 新東工業株式会社 | ロボット |
Also Published As
Publication number | Publication date |
---|---|
JPWO2016199228A1 (ja) | 2018-03-29 |
JP6532531B2 (ja) | 2019-06-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4319232B2 (ja) | パワーアシスト装置およびその制御方法 | |
WO2011161765A1 (ja) | ロボット制御装置 | |
EP3053711B1 (en) | Robot hand controlling method and robotics device | |
US8155790B2 (en) | Robot control apparatus | |
JP5897644B2 (ja) | ロボットの制御装置 | |
WO2012077335A1 (ja) | ロボットの制御装置及び制御方法、ロボット、並びに、制御プログラム | |
WO2016151770A1 (ja) | 軟性マニピュレータ制御装置および医療用マニピュレータシステム | |
JP2010076012A (ja) | マニピュレータシステムおよびその制御方法 | |
JP2010069587A5 (ja) | ロボットシステムおよびロボットの制御方法 | |
US20110218673A1 (en) | Robot control apparatus | |
JP2019198904A (ja) | ロボット、制御装置およびロボットの制御方法 | |
JP2008110406A (ja) | ロボットの直接教示装置 | |
US11540699B2 (en) | Medical manipulator system | |
JP6714734B2 (ja) | 医療用マニピュレータおよびその作動方法 | |
JP2018202497A (ja) | ロボットハンド、ロボットハンドの制御方法、ロボット装置 | |
WO2017098989A1 (ja) | 外力追従制御システム | |
WO2016199228A1 (ja) | 医療用マニピュレータ制御装置 | |
CN107000209B (zh) | 控制驱动组件使特别机器人引导的工具运动的方法和装置 | |
CN110871456B (zh) | 机器人 | |
WO2019215998A1 (ja) | ロボットの制御方法 | |
JP4618433B2 (ja) | マニピュレータの柔軟制御装置および柔軟制御方法 | |
JP5492168B2 (ja) | 把持機構 | |
JP5660482B2 (ja) | 工作機械の送り駆動系の制御方法及び制御装置 | |
JP6943906B2 (ja) | ロボット | |
JP5299255B2 (ja) | ロボット制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 15894913 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2017522795 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 15894913 Country of ref document: EP Kind code of ref document: A1 |