JP2013220273A - 外力算出方法 - Google Patents

外力算出方法 Download PDF

Info

Publication number
JP2013220273A
JP2013220273A JP2012095039A JP2012095039A JP2013220273A JP 2013220273 A JP2013220273 A JP 2013220273A JP 2012095039 A JP2012095039 A JP 2012095039A JP 2012095039 A JP2012095039 A JP 2012095039A JP 2013220273 A JP2013220273 A JP 2013220273A
Authority
JP
Japan
Prior art keywords
external force
displacement
state quantity
pressure
calculated
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.)
Pending
Application number
JP2012095039A
Other languages
English (en)
Inventor
Kotaro Tadano
耕太郎 只野
Kenji Kawashima
健嗣 川嶋
Yu Okamoto
悠 岡本
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tokyo Institute of Technology NUC
Original Assignee
Tokyo Institute of Technology NUC
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Tokyo Institute of Technology NUC filed Critical Tokyo Institute of Technology NUC
Priority to JP2012095039A priority Critical patent/JP2013220273A/ja
Priority to PCT/JP2013/053930 priority patent/WO2013157295A1/ja
Publication of JP2013220273A publication Critical patent/JP2013220273A/ja
Pending legal-status Critical Current

Links

Images

Classifications

    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B11/00Servomotor systems without provision for follow-up action; Circuits therefor
    • F15B11/08Servomotor systems without provision for follow-up action; Circuits therefor with only one servomotor
    • F15B11/10Servomotor systems without provision for follow-up action; Circuits therefor with only one servomotor in which the servomotor position is a function of the pressure also pressure regulators as operating means for such systems, the device itself may be a position indicating system
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/70Manipulators specially adapted for use in surgery
    • A61B34/76Manipulators having means for providing feel, e.g. force or tactile feedback
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B90/00Instruments, 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
    • A61B90/06Measuring instruments not otherwise provided for
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B19/00Testing; Calibrating; Fault detection or monitoring; Simulation or modelling of fluid-pressure systems or apparatus not otherwise provided for
    • F15B19/007Simulation or modelling
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01LMEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L1/00Measuring force or stress, in general
    • G01L1/04Measuring force or stress, in general by measuring elastic deformation of gauges, e.g. of springs
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01LMEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/0061Force sensors associated with industrial machines or actuators
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B17/00Surgical instruments, devices or methods, e.g. tourniquets
    • A61B2017/00535Surgical instruments, devices or methods, e.g. tourniquets pneumatically or hydraulically operated
    • A61B2017/00544Surgical instruments, devices or methods, e.g. tourniquets pneumatically or hydraulically operated pneumatically
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B90/00Instruments, 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
    • A61B90/06Measuring instruments not otherwise provided for
    • A61B2090/061Measuring instruments not otherwise provided for for measuring dimensions, e.g. length
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B90/00Instruments, 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
    • A61B90/06Measuring instruments not otherwise provided for
    • A61B2090/064Measuring instruments not otherwise provided for for measuring force, pressure or mechanical tension
    • A61B2090/065Measuring instruments not otherwise provided for for measuring force, pressure or mechanical tension for measuring contact or contact pressure
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B90/00Instruments, 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
    • A61B90/08Accessories or related features not otherwise provided for
    • A61B2090/0813Accessories designed for easy sterilising, i.e. re-usable
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B13/00Details of servomotor systems ; Valves for servomotor systems
    • F15B13/14Special measures for giving the operating person a "feeling" of the response of the actuated device
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/50Pressure control
    • F15B2211/515Pressure control characterised by the connections of the pressure control means in the circuit
    • F15B2211/5158Pressure control characterised by the connections of the pressure control means in the circuit being connected to a pressure source and an output member
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/50Pressure control
    • F15B2211/52Pressure control characterised by the type of actuation
    • F15B2211/526Pressure control characterised by the type of actuation electrically or electronically
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/60Circuit components or control therefor
    • F15B2211/63Electronic controllers
    • F15B2211/6303Electronic controllers using input signals
    • F15B2211/6306Electronic controllers using input signals representing a pressure
    • F15B2211/6313Electronic controllers using input signals representing a pressure the pressure being a load pressure
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/60Circuit components or control therefor
    • F15B2211/63Electronic controllers
    • F15B2211/6303Electronic controllers using input signals
    • F15B2211/632Electronic controllers using input signals representing a flow rate
    • F15B2211/6326Electronic controllers using input signals representing a flow rate the flow rate being an output member flow rate
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/60Circuit components or control therefor
    • F15B2211/665Methods of control using electronic components
    • F15B2211/6653Pressure control
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/60Circuit components or control therefor
    • F15B2211/665Methods of control using electronic components
    • F15B2211/6656Closed loop control, i.e. control using feedback
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/70Output members, e.g. hydraulic motors or cylinders or control therefor
    • F15B2211/705Output members, e.g. hydraulic motors or cylinders or control therefor characterised by the type of output members or actuators
    • F15B2211/7051Linear output members
    • F15B2211/7052Single-acting output members
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/70Output members, e.g. hydraulic motors or cylinders or control therefor
    • F15B2211/76Control of force or torque of the output member
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/70Output members, e.g. hydraulic motors or cylinders or control therefor
    • F15B2211/765Control of position or angle of the output member
    • F15B2211/7656Control of position or angle of the output member with continuous position control
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/80Other types of control related to particular problems or conditions
    • F15B2211/857Monitoring of fluid pressure systems
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/80Other types of control related to particular problems or conditions
    • F15B2211/885Control specific to the type of fluid, e.g. specific to magnetorheological fluid
    • F15B2211/8855Compressible fluids, e.g. specific to pneumatics

Abstract

【課題】変位センサ等の機械的センサを設けないことによる装置の小型化かつ滅菌洗浄の容易さの実現可能な外力算出方法を提供する。
【解決手段】治具15に接続された駆動部13を備える空気圧アクチュエータ10Aにおける、治具15に負荷される外力Fを算出する方法であって、治具15への外力Fの負荷によって駆動部13が移動した時におけるエアの状態量を、状態量測定手段20,30によって測定する状態量測定ステップと、前記状態量測定ステップにおいて測定された状態量、及び、状態量と治具15に負荷される外力Fとの関係式に基づき、治具15に負荷される外力Fを演算部によって算出する外力算出ステップと、を有する。
【選択図】図1

Description

本発明は外力算出方法に関し、例えば低侵襲外科手術におけるマニピュレータの駆動等に適用される外力算出方法に関する。
患者への痛みを低減したり、手術後の手術痕を目立ちにくいものとしたりすることを目的として、低侵襲外科手術が広く行われている。低侵襲外科手術においては、例えばマニピュレータ(例えば鉗子)が手術者等によって使用される。具体的には、手術者等が、患者の体表面に設けられた挿入孔からマニピュレータを挿入して駆動させ、手術者が手術を行うようになっている。
このような手術の際、より正確な作業を行う観点から、マニピュレータに負荷される圧力(外力)が、手術者に対して提示されることが望まれている。即ち、マニピュレータに臓器等が接触した時に負荷される圧力が手術者に提示されれば、マニピュレータのより適切な駆動が可能になると考えられる。そこで、このような技術に関連して、例えば非特許文献1に記載の技術が知られている。
非特許文献1の記載の技術においては、図9に示すように、シリンダ11と、スプリング12と、ピストン13と、ロッド14と、マニピュレータ15とを備えた空気圧アクチュエータ10Dが用いられている。シリンダ11には、変位センサ(具体的にはロータリーエンコーダ)18が設けられている。マニピュレータ15に外力Fが負荷されると、ピストン13は移動する。そこで、変位センサ18がピストン13の移動量を測定し、当該移動量に基づいて、外力Fが算出されている。
空気圧サーボを用いた力センシング機能を有する多自由度鉗子システムのバイラテラル制御、日本コンピュータ外科学会誌、pp25〜31、(2005)、只野耕太郎、川嶋健嗣
非特許文献1に記載の技術においては、ロータリーエンコーダを用いて、外力Fが算出されている。このように、非特許文献1に記載の技術においては、ロータリーエンコーダ等の物理的な変位センサ(機械的手段)を用いないと、外力Fの算出を行うことができない。即ち、非特許文献1に記載の技術においては、変位センサを設置するための空間(領域)が必要とされるため、空気圧アクチュエータ等の装置の小型化が困難であるという課題がある。
本発明は前記課題を解決するべく為されたものであり、その目的は、変位センサ等の機械的センサを設けないことによる装置の小型化かつ滅菌洗浄の容易さを実現可能な外力算出方法を提供することを目的とする。
本発明者らは前記課題を解決するべく鋭意検討を行った。具体的には、装置の小型化及び滅菌洗浄の容易さの実現を図るために、物理的な変位センサに代わる手段が無いか検討を行った。その結果、本発明者らは、物理的な変位センサを設ける代わりに、空気圧アクチュエータに供給されるエアの状態量と外力Fとの関係式を用いて外力Fを算出できることを見出した。
即ち、本発明は、以下に示す手段により実施される。
(1)
治具に接続された駆動部を備える空気圧アクチュエータにおける、前記治具に負荷される外力を算出する方法であって、
前記治具への外力の負荷によって前記駆動部が移動した時におけるエアの状態量を、状態量測定手段によって測定する状態量測定ステップと、
前記状態量測定ステップにおいて測定された状態量、及び、状態量と前記治具に負荷される外力との関係式に基づき、前記治具に負荷される外力を演算部によって算出する外力算出ステップと、を有する。
(2)
前記状態量測定ステップにおいて測定される状態量が少なくとも圧力であり、前記状態量測定手段によって測定された圧力、及び、圧力と前記駆動部の変位との関係式に基づき、前記駆動部の変位を前記演算部によって算出する変位算出ステップを有し、
前記外力算出ステップにおいて、前記変位算出ステップにおいて算出された変位、及び、変位と前記治具に負荷される外力との関係式に基づき、前記治具に負荷される外力を前記演算部によって算出する。
(3)
前記駆動部の移動時の速度を前記演算部によって算出する速度算出ステップを有する。
(4)
前記状態量測定ステップにおいて測定される状態量が圧力及び流量であり、前記状態量測定手段によって測定された圧力及び流量、及び、圧力と流量と前記駆動部の変位との関係式に基づき、前記駆動部の変位を前記演算部によって算出する変位算出ステップを有し、
前記外力算出ステップにおいて、前記変位算出ステップにおいて算出された変位、及び、変位と前記治具に負荷される外力との関係式に基づき、前記治具に負荷される外力を前記演算部によって算出する。
(5)
前記空気圧アクチュエータは、前記駆動部の移動により弾性変形する弾性部材を備え、
前記状態量測定ステップにおいて測定される状態量が、前記弾性部材が弾性変形した時に生じる状態量であり、前記状態量測定手段によって測定された状態量、及び、状態量と前記駆動部の変位との関係式に基づき、前記駆動部の変位を前記演算部によって算出する変位算出ステップを有し、
前記外力算出ステップにおいて、前記変位算出ステップにおいて算出された変位、及び、変位と前記治具に負荷される外力との関係式に基づき、前記治具に負荷される外力を前記演算部によって算出する。
前記(1)によれば、従来用いられていた変位センサ等の機械的センサを設ける必要がない。そのため、装置を小型化することができる。また、変位センサを設ける必要がないため、部品点数が少なくなり、装置構成が簡素化される。そのため、装置のメンテナンス(洗浄や滅菌等)を容易に行うことができる。また、部品点数が少なくなるため、防爆性や耐水性が要求される用途等、空気圧アクチュエータの利用可能な用途を拡げることができる。また、変位センサのような電力により制御される物理的な手段を設けないため、装置の設置場所が限定されることがない。さらには、外力Fが、エアの状態量と外力Fとの関係式を用いて算出されるため、どのような種類の状態量を用いても外力Fを簡便に算出することができる。また、関係式を用いて算出することによって状態量の大きさが制限されないため、汎用性が拡大する。
また、前記(2)によれば、圧力センサ等の簡便なセンサを用いて外力Fを算出することができる。そのため、外力計算のために特殊な手段を用いる必要がなく、既存の装置を利用して外力Fを算出することができる。
さらに、前記(3)によれば、速度センサ等を設ける必要がないため、装置全体の構成を簡素化することができる。そのため、外力計算のために装置を過度に複雑化させることがなく、設置やメンテナンス(滅菌や洗浄等)が容易になる。
また、前記(4)によれば、圧力センサ、流量センサ等の簡便なセンサを用いて外力Fを算出することができる。そのため、外力計算のために特殊な手段を用いる必要がなく、既存の装置を利用して外力Fを算出することができる。
さらに、前記(5)によれば、より精度よく、外力Fを算出することができる。
第1実施形態の外力算出方法を説明する図である。 第1実施形態の外力を算出するフローである。 第2実施形態の外力算出方法を説明する図である。 外力が負荷された時の管形状の変化を説明する図である。 第2実施形態の外力を算出するフローである。 第3実施形態の外力算出方法を説明する図である。 外力が負荷された時のバルーンの変化を説明する図である。 第3実施形態の外力を算出するフローである。 従来の外力算出方法を説明する図である。
以下、図面を参照しながら、本発明を実施するための形態(本実施形態)を説明する。なお、本実施形態は以下の内容に何ら限定されず、本発明の要旨を逸脱しない範囲内で任意に変更して実施可能である。なお、各図において、図示の便宜上、各手段を適宜拡大縮小して示している。また、各図において、図示の簡略化のために、各手段を適宜簡略化して示している。
[1.第1実施形態]
第1実施形態の外力算出方法に適用可能な外力算出システム100を図1に示す。図1に示すように、外力算出システム100は、空気圧アクチュエータ10Aと、圧力センサ20(状態量測定手段)と、流量センサ30(状態量測定手段)と、空気圧サーボ弁40と、を備えている。また、外力算出システム100は、図示しない演算部を備えている。
空気圧アクチュエータ10A、圧力センサ20、流量センサ30及び空気圧サーボ弁40は管(図示しない)により接続されている。この管には、空気が通流するようになっている。なお、より精度よく外力を算出する観点から、この管における圧力損失はできるだけ小さくすることが好ましい。また、圧力センサ20、流量センサ30及び空気圧サーボ弁40は、図示しない電気信号線により、演算部に接続されている。
空気圧アクチュエータ10Aは、シリンダ11と、スプリング12と、ピストン13と、ロッド14と、マニピュレータ15と、を備えている。シリンダ11内には、スプリング12及びピストン13が備えられている。シリンダ11内であってロッド14の外周を取り囲んで、スプリング12が設けられている。ピストン13には、ロッド14を介して、マニピュレータ15が接続されている。
ピストン13は、シリンダ11内で、シリンダ11の軸方向に摺動可能になっている。そのため、シリンダ11とピストン13とにより形成される空間にエアが供給されると、ピストン11がスプリング12の弾性力に逆らって紙面右方向に摺動するようになっている。これにより、マニピュレータ15は、シリンダ11の軸方向の位置が制御されるようになっている。
マニピュレータ15は、本実施形態においては、鉗子である。マニピュレータ15は、図示しない駆動手段及び制御部により、その先端が手術者により制御可能になっている。
圧力センサ20及び流量センサ30(状態量測定手段)は、シリンダ11内に供給されるエアの圧力及び流量を測定するものである。各手段を接続する管の圧力損失は小さいと考えることができるため、圧力センサ20により測定される圧力は、シリンダ11内の圧力と考えることができる。圧力センサ20としては、例えば任意の圧力計を用いることができる。また、流量センサ30としては、例えば任意の流量計を用いることができる。
空気圧サーボ弁40は、エア(例えば外気)を取り込んでシリンダ11内に供給するものである。また、空気圧サーボ弁40は、シリンダ11に供給するエアの圧力を調整するものである。具体的には、空気圧サーボ弁40は、シリンダ11内のエア圧力が所定の圧力になるように、圧力及び流量を調整するようになっている。ここで、シリンダ11内のエア圧力とは、マニピュレータ15をシリンダ11の軸方向の所望の位置に移動させるために必要な圧力である。空気圧サーボ弁40としては、例えば流量制御タイプのスプール型空気圧サーボ弁を用いることができる。また、空気圧サーボ弁40は、手術者の指示に応じて、図示しない制御部により制御されるようになっている。
演算部は、圧力センサ20及び流量センサ30により、エアの圧力及び流量を測定するものである。演算部は、例えばCPU(Central Processing Unit)、ROM(Read Only Memory)、RAM(Random Access Memory)、HDD(Hard Disk Drive)等を備え、ROMに格納されている所定のプログラムがCPUによって実行されることにより具現化される。
次に、外力算出システム100における外力算出方法を、図1及び図2を参照しながら説明する。図2は、外力Fを算出するフローである。図2に示すフローは、マニピュレータ15(治具)に接続されたピストン13(駆動部)を備える空気圧アクチュエータ10Aにおける、マニピュレータ15(治具)に負荷される外力を算出する方法である。
このフローは、前記した状態変量測定手段により測定された状態量と、状態量と外力Fとの関係式とに基づき、前記した演算部によって行われる。具体的には、空気圧アクチュエータ10Aに供給されるエアの状態量(本実施形態においては、流量及び圧力)に基づいて、マニピュレータ15(治具)に負荷される外力Fを算出する。このフローは、空気圧サーボ弁40により所定流量でエアがシリンダ11に供給されて状態(定常状態)で、マニピュレータ15に外力Fが負荷された時に行われる。
なお、演算部は、定常状態における、シリンダ11とピストン13とにより形成される空間(エアが供給される空間)の容積(体積)Vを予め計算し、HDD等に記憶している。容積Vは、圧力センサ20により測定される圧力を用い、例えば気体の状態方程式等により計算される。また、演算部は、定常状態における、圧力センサ20により圧力Pを測定し、HDD等に記憶している。さらに、演算部は、定常状態における、流量センサ30により流量Gを測定し、HDD等に記憶している。
また、以下の算出時には、空気圧サーボ弁40の駆動条件は変化しないものとする。
マニピュレータ15に外力Fが負荷されてピストン13が移動すると、シリンダ11内の圧力は増加する。即ち、空気圧サーボ弁40の駆動条件が変化しなければ、ピストン11が移動してシリンダ内の容積が小さくなった分、シリンダ11内の圧力が増加することになる。さらには、外力Fが負荷されると、流量に変化が生じる。そこで、演算部は、圧力センサ20により、外力負荷後の圧力を測定する(ステップS101)。また、演算部は、流量センサ30により、外力負荷後の流量を測定する(ステップS102)。
即ち、圧力センサ20(状態量測定手段)は、マニピュレータ15(治具)への外力Fの負荷によってピストン13(駆動部)が移動した時におけるエアの圧力(状態量)を測定する(状態量測定ステップ)。また、流量センサ30(状態量測定手段)は、外力Fの負荷によってピストン13(駆動部)が移動した時におけるエアの流量(状態量)を測定する(状態量測定ステップ)。
演算部は、ステップS101及びステップS102において測定した圧力及び流量に基づき、ピストン13の移動時の速度vを算出する(ステップS103)。即ち、演算部は、ピストン13(駆動部)の移動時の速度vを算出する(速度算出ステップ)。ピストン13の速度vは、以下の式(1)に基づいて算出される。なお、供給されるエアの温度は、通常は変化しない。そこで、本実施形態においては、温度は一定であるものとする。また、計算の簡略化のために、エアは理想気体であるものとする。
Figure 2013220273
ただし、P、A、v、V、P’、G、R及びTは、以下の値である。
:定常状態における、シリンダ11とピストン13とにより形成される空間の圧力
A:ピストン13の受圧面積(ピストン13の摺動方向に垂直な方向の断面積;定数)
v:ピストン13の速度
:定常状態における、シリンダ11とピストン13とにより形成される空間の容積
P’:定常状態からの圧力変化量の時間微分値
G:流量センサ30により測定された流量
R:気体定数
次に、演算部は、前記式(1)に基づき算出された速度vを積分し、変位xを算出する(ステップS104)。ここで、変位xは、定常状態のピストン13の位置を基準とした変位(定常状態からの変位量)である。即ち、演算部は、圧力センサ20及び流量センサ30(状態量測定手段)によって測定された圧力及び流量から速度vを算出し、算出された速度vとピストン13(駆動部)の変位xとの関係式(x=∫vdt)に基づき、ピストン13(駆動部)の変位xを算出する(変位算出ステップ)。
そして、演算部は、算出された変位xに基づき、外力Fを算出する(ステップS105)。即ち、演算部は、前記状態量測定ステップにおいて測定された圧力及び流量(状態量)、及び、これらと外力Fとの関係式に基づき外力Fを算出する(外力算出ステップ)。より具体的には、演算部は、算出された変位x、及び、変位xと外力Fとの関係式(以下の式(2))に基づき外力Fを算出する。外力Fは、以下の式(2)に基づいて算出される。
Figure 2013220273
ただし、P、A、B、v、K及びxは、以下の値である。
P:圧力センサ20により測定されたシリンダ11内の圧力
A:前記式(1)と同様の値(ピストン13の受圧面積;定数)
B:ピストン13摺動時における、ピストン13の粘性係数(予め実験等により決定される;定数)
v:ステップS103において算出した速度v
K:スプリング12のばね定数(予め実験等により決定される;定数)
x:ステップS104において算出した変位x
このようにして、外力Fが算出される。算出された外力Fは、演算部により、手術者に提示される。提示の形態は、例えば、外力Fの大きさに応じて、手術者に反動を与えること等が挙げられる。
外力Fの算出に際して、前記のように、変位xの測定(実測)を行っていない。そのため、従来用いられていた変位センサを設ける必要がない。これにより、空気圧アクチュエータを用いた装置全体を小型化することができる。しかも、外力Fの算出に用いられる各パラメータは、既存の手段により測定される値が用いられる。そのため、外力Fを算出するために、新たな手段を導入する必要がない。
特に、外力Fが、エアの状態量と外力Fとの関係式を用いて算出されるため、どのような種類の状態量を用いても外力Fを簡便に算出することができる。また、関係式を用いて算出することによって、状態量の大きさが制限されないため、汎用性が拡大する。また、例えば外力Fと変位x又は流量Gと等の関係を予め実験等によって決定しなくてもよいため、例えばスプリング12、ピストン13の仕様変更等が生じたとしても、式(1)及び式(2)で用いる値のみを変更すれば新たな条件で外力Fを算出することができる。従って、様々な条件や仕様の変更が生じたとしても、新たな条件の下で、簡便に外力Fを算出することができる。
また、変位センサを設ける必要がないため、部品点数が少なくなり、装置構成が簡素化される。そのため、装置のメンテナンス(洗浄や滅菌等)を容易に行うことができる。また、部品点数が少なくなるため、防爆性や耐水性が要求される用途等、空気圧アクチュエータの利用可能な用途を拡げることができる。
さらには、従来用いられていた変位センサは、通常は電力を利用して駆動する。そのため、電力の通電による磁力等が変位センサから発生することがある。そのため、装置の設置場所が限定されたり、磁力等への対策を要したりすることがあった。しかしながら、本実施形態の外力算出方法においては、物理的な測定手段である変位センサを設けずに既存の手段によって外力Fが測定可能である。従って、変位センサにより発生しうる外部への磁力等の発生を考慮する必要がない。そのため、装置の設置場所が限定されることなく、外力算出方法は様々な用途に適用可能となる。
また、本実施形態においては、圧力センサ、流量センサ等の簡便なセンサを用いて外力が算出される。そのため、外力計算のために特殊な手段を用いる必要がなく、前記のように、既存の装置を利用して外力を算出することができる。また、速度センサ等を設ける必要がないため、装置全体の構成を簡素化することができる。そのため、外力計算のために装置を過度に複雑化させることがなく、設置やメンテナンス(滅菌や洗浄等)が容易になる。
第1実施形態の外力算出方法は、空気圧アクチュエータを用いた装置に適用される。そのため、空気圧アクチュエータ10Aのマニピュレータ15に外力が負荷されると、シリンダ11内の空気は圧縮可能であるため、ピストン11が移動する。そして、この現象を利用し、外力Fが算出される。これにより、負荷された外力Fの提示が行われる。そのため、手術等において、精度よく作業を行うことができる。
[2.第2実施形態]
第2実施形態の外力算出方法に適用可能な外力算出システム200を図3に示す。図3において、図1に示す外力算出システム100と同じものについては同じ符号を付すものとし、その詳細な説明は省略する。
図3に示す外力算出システム200は、空気圧アクチュエータ10Bと、圧力センサ20と、空気圧サーボ弁40(第1サーボ弁)40と、流量センサ50と、空気圧サーボ弁60(第2サーボ弁)と、を備えている。また、外力算出システム200は、図示しない演算部を備えている。
外力算出システム200における空気圧アクチュエータ10Bにおいては、前記した第1実施形態の空気圧アクチュエータ10Aの構成に加えて、弾性体により構成される管(例えばゴム管)16が備えられている。管16は、シリンダ11の壁面及びロッド14を貫通して設けられている。また、管16は、スプリング12に狭持されている。
管16には、空気圧サーボ弁60からのエアが通流している。そして、管16を通流するエアの流量は、流量センサ50により測定されるようになっている。流量センサ50及び空気圧サーボ弁60は、図示しない電気信号線により、演算部に接続されている。
ここで、外力Fが負荷されていない時の管16の様子と、外力Fが負荷されている時の管16の様子を、図4を参照しながら説明する。なお、図4において、管16が配置される様子が現実とは異なることがあるが、図4においては、管16の挙動をより明確に表すために、管16の配置の様子を簡略化して示している。
空気圧サーボ弁40は、第1実施形態において説明したように、シリンダ11内のエア圧力が所定の圧力になるように、供給するエアの圧力及び流量を調整するようになっている(定常状態)。そして、この状態において、管16内には、空気圧サーボ弁60により供給されるエアが、一定の割合で通流している(図4(a)に示す状態)。
定常状態において、外力Fがマニピュレータ15に負荷されると、ピストン13が紙面左方向にシリンダ11内を摺動する。この時、スプリング12の間隔は、定常状態よりも狭くなる。従って、スプリング11に狭持された管16の形状が、スプリング12によって歪められる。このため、管16内の流路は狭くなる(負荷状態;図4(b)に示す状態)。
そこで、第2実施形態では、このような流路の変化を利用し、外力Fが算出される。即ち、空気圧アクチュエータ10Bは、ピストン13(駆動部)の移動により弾性変形する管16(弾性部材)を備えている。そして、ピストン13(駆動部)が移動すると、管16(弾性部材)が弾性変形する。これにより管16内の流路が狭くなり、通過するエアの流量に変化が生じる。この際の流量を流量センサ50で測定することで、ピストン13(駆動部)の変位xを算出する。
このことを換言すれば、測定される流量(状態量)Gが、管16(弾性部材)が弾性変形した時に変化するものであり、演算部は、測定された流量(状態量)G、及び、流量(状態量)と外力Fとの関係式(式(2)及び以下の式(3))に基づき外力Fを算出する。より具体的には、演算部は、流量Gと以下の式(3)に基づき変位xを算出し、算出された変位xと前記の式(2)に基づき外力Fを算出する。
以下、具体的に、第2実施形態の外力算出方法を、図5を参照しながら説明する。第1実施形態と同様、定常状態において外力Fがマニピュレータ15に負荷された時に、図5に示すフローが行われる。
外力Fがマニピュレータ15に負荷されると、前記のように、管16内の流路が狭くなる。そのため、管16を通流するエアの流量が減少する。そこで、演算部は、外力Fの負荷後に管16を通流するエアの流量(状態量)を測定する(ステップS201)。
次に、測定された流量Gに基づいて、変位xを算出する(ステップS202)。なお、ピストン13の移動に伴う流量Gと変位xとの関係は、予め予備実験等により決定される。具体的には、変位xは、予め予備実験等により、流量Gの関数fとして決定される。即ち、この関数は、以下の式(3)で表される。
Figure 2013220273
ここで、ピストン13の移動量が多くなれば(変位xが大きくなれば)、管16の弾性変形は大きくなる。これにより、管16の流路断面は小さくなる。そのため、管16内を通流するエアの流量Gは減少する。このように、流量Gと変位xとの間に成立する関係(式(3))を用い、変位xが流量Gに基づき算出される。なお、式(3)は、例えば、反比例の式(x=1/G)等になる。
演算部は、算出された変位xを微分することにより、ピストン13の速度vを算出する(ステップS203;速度算出ステップ)。さらに、演算部は、圧力センサ20により、シリンダ11内の圧力Pを測定する(ステップS204)。そして、演算部は、ステップS202において算出された変位x、ステップS203において算出された速度v、及び、ステップS204において測定された圧力Pを前記式(2)に代入することにより、外力Fを算出する(ステップS205)。即ち、演算部は、少なくとも、式(3)に基づき算出された変位x、及び、変位xと外力Fとの関係式(式(2))に基づき外力Fを算出する。
このようにして、外力Fが算出される。算出された外力Fは、演算部により、手術者に提示される。提示の形態は、例えば、外力Fの大きさに応じて、手術者に反動を与えること等が挙げられる。
第2実施形態においては、外力Fの算出に際して、積分計算が行われない。そのため、誤差の蓄積が小さいという利点がある。具体的には、第2実施形態においては、空気圧アクチュエータ10Bへのエアの供給路を2系統としている。そして、これらのうちの1系統の供給路において、スプリング12の間隔が狭くなることを利用して外力Fが算出される。そのため、1系統の場合と比べて、より精度よく、外力Fが算出される。これにより、負荷された外力Fの提示が精度よく行われる。そのため、手術等において、より精度よく作業を行うことができる。
また、第1実施形態と同様に、外力Fの算出に際して、変位xの測定を行う必要がない。これにより、空気圧アクチュエータを用いた装置全体を小型化することができる。さらには、装置の設置やメンテナンスの容易さ、構成の簡素化、適用用途の拡大化、汎用性の拡大等の利点がある。
[3.第3実施形態]
第3実施形態の外力算出方法に適用可能な外力算出システム300を図6に示す。図6において、図1に示す外力算出システム100、及び、図3に示す外力算出システム200と同じものについては同じ符号を付すものとし、その詳細な説明は省略する。
図6に示す外力算出システム300においては、空気圧アクチュエータ10Cと、圧力センサ(第1圧力センサ)20と、空気圧サーボ弁40と、チャンバ70と、圧力センサ(第2圧力センサ)80と、を備えている。また、外力F算出システム300は、図示しない演算部を備えている。
外力算出システム300における空気圧アクチュエータ10Cにおいては、前記した第1実施形態の空気圧アクチュエータ10Aの構成に加えて、弾性体により構成される、中空状のバルーン17(例えばゴム製)が備えられている。バルーン17は、シリンダ11の壁面及びロッド14を貫通して設けられている。また、バルーン17は、スプリング12に狭持されている。
ここで、外力Fが負荷されていない時のバルーン17の様子と、外力Fが負荷されている時のバルーン17の様子を、図7を参照しながら説明する。なお、図7において、バルーン17が配置される様子が現実とは異なることがあるが、図7においては、バルーン17の挙動をより明確に表すために、バルーン17の配置の様子を簡略化して示している。
空気圧サーボ弁40は、第1実施形態において説明したように、シリンダ11内のエア圧力が所定の圧力になるように、供給するエアの流量を調整するようになっている(定常状態)。この時、スプリング12に挟持されているバルーン17は、図7(a)に示すように、変形していない。従って、定常状態においては、バルーン17内の圧力は一定である。
定常状態において、外力Fがマニピュレータ15に負荷されると、ピストン13が紙面左方向にシリンダ11内を摺動する(負荷状態)。すると、スプリング12の間隔は、定常状態よりも狭くなる。これにより、図7(b)に示すように、スプリング12に狭持されたバルーン17は変形する(潰される)。その結果、バルーン17の内容積が減少する。内容積が減少すると、バルーン17及びチャンバ70並びにそれらを接続する管内のエアが圧縮され、チャンバ70内の圧力は上昇する。なお、チャンバ70内の圧力は、チャンバ70に設けられている圧力センサ80により測定される。
そこで、第3実施形態では、バルーン17の変形による圧力の変化を利用し、外力Fが算出される。即ち、原理としては第2実施形態と同様であるが、第3実施形態においては、弾性変形によりバルーン17の内容積変化に伴う圧力変化に基づいて、外力Fの算出が行われる。
以下、具体的に、第3実施形態の外力算出方法を、図8を参照しながら説明する。第1実施形態及び第2実施形態と同様、定常状態において外力Fがマニピュレータ15に負荷された時に、図8に示すフローが行われる。なお、演算部は、定常状態における、圧力センサ80によりチャンバ70内の圧力を測定し、HDD等に記憶している。
はじめに、演算部は、圧力センサ80により、圧力上昇後のチャンバ70の圧力(状態量)を測定する(ステップS301)。そして、演算部は、測定されたチャンバ70の圧力に基づき、容積変化量dVを算出する(ステップS302)。ここで、チャンバ70の圧力と容積変化量dVとの関係について説明する。
外力Fがマニピュレータ15に負荷されると、前記のように、バルーン17の内容積が減少し、チャンバ70内の圧力が上昇する。これらの状態変化は、エアの温度が変化しない場合、式(4)で表される。
Figure 2013220273
ただし、P、V、dP、V及びdVは、以下の値である。
:初期圧力(圧力センサ80により測定される、定常状態の圧力)
:定常状態における、バルーン17の内容積とチャンバ70の内容積との合計初期容積
dP:定常状態から負荷状態に変化したときの、初期圧力Pからの圧力変化量
dV:定常状態から負荷状態に変化したときの、合計初期容積Vからの容積変化量
なお、Vは、厳密には、バルーン17の内容積とチャンバ70の内容積とこれらを接続する管の内容積との合計容積である。しかしながら、管の内容積は、通常、バルーン17の内容積とチャンバ70の内容積との合計容積と比べて、極めて小さい。そのため、これらの合計容積を測定して用いることも可能ではあるが、前記式(4)において、管の内容積を考慮せずとも精度は十分良好である。
圧力変化量dPは、圧力センサ80により測定されたチャンバ70の圧力Pから初期圧力Pを減ずることにより算出される。そして、P、V及び算出されたdPを前記式(4)に代入することにより、容積変化量dVが算出される。即ち、チャンバ70の圧力P(=P+dP)に基づき、容積変化量dVが算出される。
次に、算出された容積変化量dVに基づき、変位xが算出される(ステップS303)。容積変化量dVと変位xとの関係は、予め予備実験等により決定される。具体的には、変位xは、予め予備実験等により、容積変化量dVの関数gとして決定される。即ち、この関数は、以下の式(5)で表される。なお、式(5)は、例えば、比例の式(x=a×dP(ただしaは定数))等になる。
Figure 2013220273
このように、前記式(5)に容積変化量dVを代入することにより、変位xが算出される。
その後は、第2実施形態と同様にして、外力Fを算出する(ステップS303〜S306)。算出された外力Fは、演算部により、手術者に提示される。提示の形態は、例えば、外力Fの大きさに応じて、手術者に反動を与えること等が挙げられる。
第3実施形態においては、エアを供給する空気圧サーボ弁が1つのみ設けられている。もう1系統は流量を制御することなく、バルーン17内の圧力を一定に保つための系統である。そのため、制御を簡素化することができる。また、バルーン17へのエア供給路を設ける必要が無いため、装置構成を簡素化することができる。
ただし、第2実施形態とは異なりエアの流量制御の供給路は1系統のみであるが、スプリング12に予め狭持された弾性部材(バルーン17)の内容積変化dVに伴う圧力変化dPを利用する。そのため、第2実施形態と同様に、外力Fの算出に際して、積分計算が行われない。そのため、より精度よく、外力Fが算出される。また、第1実施形態と同様に、外力Fの算出に際して、変位xの測定を行う必要がない。これにより、空気圧アクチュエータを用いた装置全体を小型化することができる。さらには、装置の設置やメンテナンスの容易さ、構成の簡素化、適用用途の拡大化等の利点がある。
[4.変更例]
以上、3つの実施形態を挙げて本実施形態を説明したが、本実施形態は前記の内容に何ら限定されるものではない。即ち、本発明は、その要旨を逸脱しない範囲内で任意に変更して実施可能である。
例えば、治具としてのマニピュレータとして鉗子を挙げて本実施形態を説明したが、本実施形態の外力算出方法が適用可能なマニピュレータは鉗子に何ら限定されない。また、本実施形態の外力算出方法が適用可能な治具はマニピュレータに何ら限定されない。本実施形態の外力算出方法が適用可能な治具としては、例えば内視鏡、把持部材、手術用ロボットへの適用等が挙げられる。また、本実施形態の外力算出方法が適用可能な治具は、手術用治具以外の治具であってもよく、例えば半導体製造用途、防爆性が要求される用途、水中での作業用途等、任意の用途への適用が可能である。
また、例えば、本実施形態の外力算出方法が適用可能な構成は図示の例に何ら限定されず、外力が負荷される治具に応じて、部材や手段を適宜選択して使用すればよい。例えば、空気圧アクチュエータを駆動させるために、空気圧サーボ弁や空気圧電磁弁が接続されることができる。また、必要に応じて、図示の例から一部の手段や部材を省略してもよい。
さらに、例えば、前記した各実施形態においては空気圧サーボ弁が用いられているが、空気圧サーボ弁に代えて、空圧電空比例弁等が用いられてもよい。
また、例えば、前記した各実施形態においては、シリンダとピストンとを組み合わせて空気圧アクチュエータとしているが、空気圧アクチュエータの構成は図示の例に何ら限定されるものではない。例えば、シリンダとプランジャとを組み合わせた空気圧アクチュエータとしてもよい。また、空気圧アクチュエータに供給されるエアは必ずしも空気でなくてもよく、任意の気体を供給すればよい。
さらに、各空気圧アクチュエータに備えられるスプリング12は、必ずしも図示の位置に設けられる必要はない。即ち、図示の例では、スプリング12は、シリンダ11内であってピストン13とマニピュレータ15との間に設けられているが、シリンダ11内であって空気圧サーボ弁40とピストン13との間に設けられるようにしてもよい。より具体的には、空気圧サーボ弁40からのエアが供給される空間に、スプリング12が設けられるようにしてもよい。また、スプリング12は、ロッド14を取り囲んで設けられているが、例えばロッド14の外周面に平行にロッド14を取り囲むことなく、単数或いは複数のスプリングが設けられるようにしてもよい。
また、例えば、図3における管16の設置形態、図6におけるバルーン17の設置形態も、図示の例に何ら限定されない。即ち、図示の例では、スプリング12により管16及びバルーン17が変形されるようにしているが、例えばピストン13と管16又はバルーン17が接触することより、これらが変形するようにしてもよい。また、これらの手段の設置位置も特に限定されず、管16及びバルーン17が変形して前記した作用を生じる位置であれば、どのような位置に設けてもよい。また、図3の例では管16を用いているが、外力Fが負荷されることにより変形し、流量変化が生じるものであれば、どのようなものを用いてもよい。さらに、図4の例ではバルーン17を用いているが、外力Fが負荷されることにより変形し、圧力変化が生じるものであれば、どのようなものを用いてもよい。
さらに、例えば、前記した各実施形態において用いた式や方法は本発明を実施するための一例である。従って、前記した式や方法は、本発明を実施することができる式や方法であれば、任意に変更して実施可能である。
例えば、外力算出システム300において、ステップ303〜ステップS306は、外力算出システム200におけるステップS202〜ステップS205と同様にしているが、例えばステップS304において速度vを算出する際、式(1)を用いて算出してもよい。ただし、外力算出システム300においては、バルーン17にエアは新たに供給されない。従って、ステップS304において用いる式(1)は、G(流量)=0として計算される。
また、例えば、図2、図5及び図8を参照しながら説明したフローは、本実施形態を説明するためのフローの一例であり、任意に変更して実施可能である。
例えば、図3の例では流量変化量に基づいて圧縮量を算出しているが、圧力センサを設け、圧力変化量に基づいて圧縮量を算出してもよい。また、図6の例では圧力変化量に基づいて圧縮量を算出しているが、流量センサを設け、流量変化量に基づいて圧縮量を算出してもよい。さらに、図3及び図6のいずれの例においても、圧力変化量及び流量変化量の両方を用いて圧縮量を算出してもよい。
また、例えば、前記した各実施形態における状態量は適宜変更して実施可能である。即ち、ピストン13(駆動部)が移動することにより生じる状態量の変化に基づき外力Fが算出されれば、どのような状態量を用いてもよい。状態量としては、前記した圧力及び流量のほか、例えば、容積、温度等が挙げられる。そして、これに対応して、各種センサ(状態量測定手段)を設ければよい。
10A 空気圧アクチュエータ
10B 空気圧アクチュエータ
10C 空気圧アクチュエータ
11 シリンダ
12 スプリング
13 ピストン(駆動部)
15 マニピュレータ(治具)
16 管(弾性部材)
17 バルーン(弾性部材)
20 圧力センサ(状態量測定手段)
30 流量センサ(状態量測定手段)
50 流量センサ(状態量測定手段)
80 圧力センサ(状態量測定手段)
100 外力算出システム
200 外力算出システム
300 外力算出システム

Claims (5)

  1. 治具に接続された駆動部を備える空気圧アクチュエータにおける、前記治具に負荷される外力を算出する方法であって、
    前記治具への外力の負荷によって前記駆動部が移動した時におけるエアの状態量を、状態量測定手段によって測定する状態量測定ステップと、
    前記状態量測定ステップにおいて測定された状態量、及び、状態量と前記治具に負荷される外力との関係式に基づき、前記治具に負荷される外力を演算部によって算出する外力算出ステップと、を有する
    ことを特徴とする、外力算出方法。
  2. 前記状態量測定ステップにおいて測定される状態量が少なくとも圧力であり、前記状態量測定手段によって測定された圧力、及び、圧力と前記駆動部の変位との関係式に基づき、前記駆動部の変位を前記演算部によって算出する変位算出ステップを有し、
    前記外力算出ステップにおいて、前記変位算出ステップにおいて算出された変位、及び、変位と前記治具に負荷される外力との関係式に基づき、前記治具に負荷される外力を前記演算部によって算出する
    ことを特徴とする、請求項1に記載の外力算出方法。
  3. 前記駆動部の移動時の速度を前記演算部によって算出する速度算出ステップを有する
    ことを特徴とする、請求項1又は2に記載の外力算出方法。
  4. 前記状態量測定ステップにおいて測定される状態量が圧力及び流量であり、前記状態量測定手段によって測定された圧力及び流量、及び、圧力と流量と前記駆動部の変位との関係式に基づき、前記駆動部の変位を前記演算部によって算出する変位算出ステップを有し、
    前記外力算出ステップにおいて、前記変位算出ステップにおいて算出された変位、及び、変位と前記治具に負荷される外力との関係式に基づき、前記治具に負荷される外力を前記演算部によって算出する
    ことを特徴とする、請求項1〜3の何れか1項に記載の外力算出方法。
  5. 前記空気圧アクチュエータは、前記駆動部の移動により弾性変形する弾性部材を備え、
    前記状態量測定ステップにおいて測定される状態量が、前記弾性部材が弾性変形した時に変化する状態量であり、前記状態量測定手段によって測定された状態量、及び、状態量と前記駆動部の変位との関係式に基づき、前記駆動部の変位を前記演算部によって算出する変位算出ステップを有し、
    前記外力算出ステップにおいて、前記変位算出ステップにおいて算出された変位、及び、変位と前記治具に負荷される外力との関係式に基づき、前記治具に負荷される外力を前記演算部によって算出する
    ことを特徴とする、請求項1〜3の何れか1項に記載の外力算出方法。
JP2012095039A 2012-04-18 2012-04-18 外力算出方法 Pending JP2013220273A (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2012095039A JP2013220273A (ja) 2012-04-18 2012-04-18 外力算出方法
PCT/JP2013/053930 WO2013157295A1 (ja) 2012-04-18 2013-02-19 外力算出方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012095039A JP2013220273A (ja) 2012-04-18 2012-04-18 外力算出方法

Publications (1)

Publication Number Publication Date
JP2013220273A true JP2013220273A (ja) 2013-10-28

Family

ID=49383264

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012095039A Pending JP2013220273A (ja) 2012-04-18 2012-04-18 外力算出方法

Country Status (2)

Country Link
JP (1) JP2013220273A (ja)
WO (1) WO2013157295A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018123753A1 (ja) 2016-12-27 2018-07-05 川崎重工業株式会社 液圧鉗子システム
WO2021161706A1 (ja) * 2020-02-12 2021-08-19 リバーフィールド株式会社 手術用ロボット

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0663894B2 (ja) * 1985-12-26 1994-08-22 アイシン精機株式会社 流体圧利用アクチユエ−タの負荷検出装置
JPH0342706U (ja) * 1989-08-29 1991-04-23
JPH05216583A (ja) * 1992-02-04 1993-08-27 Fujitsu Ltd 6自由度情報入力装置
JP4054938B2 (ja) * 1998-11-05 2008-03-05 Smc株式会社 アクチュエータ制御回路
JP2004257819A (ja) * 2003-02-25 2004-09-16 Railway Technical Res Inst ピストン変位検出装置及びダンパ装置
JP5383535B2 (ja) * 2010-02-01 2014-01-08 サンテスト株式会社 位置と負荷の検出可能な流体圧アクチュエータ

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018123753A1 (ja) 2016-12-27 2018-07-05 川崎重工業株式会社 液圧鉗子システム
CN110087575A (zh) * 2016-12-27 2019-08-02 川崎重工业株式会社 液压钳子系统
US11053960B2 (en) 2016-12-27 2021-07-06 Kawasaki Jukogyo Kabushiki Kaisha Hydraulic forceps system
WO2021161706A1 (ja) * 2020-02-12 2021-08-19 リバーフィールド株式会社 手術用ロボット
JP2021126233A (ja) * 2020-02-12 2021-09-02 リバーフィールド株式会社 手術用ロボット

Also Published As

Publication number Publication date
WO2013157295A1 (ja) 2013-10-24

Similar Documents

Publication Publication Date Title
Black et al. Parallel continuum robots: Modeling, analysis, and actuation-based force sensing
JP5754820B2 (ja) 手術用ロボット
CN106029307B (zh) 机械手的校准方法、机械手和机械手系统
CN110087575A (zh) 液压钳子系统
Bertram et al. The onset of flow-rate limitation and flow-induced oscillations in collapsible tubes
JP5931667B2 (ja) 流量センサの自己校正機構、自己校正方法、自己校正機構用プログラム、及び、マスフローコントローラ
Decroly et al. Design, characterization and optimization of a soft fluidic actuator for minimally invasive surgery
JP2006316711A (ja) 薬液供給システム及び薬液供給ポンプ
WO2013157295A1 (ja) 外力算出方法
Svete et al. Dynamic pressure generator for dynamic calibrations at different average pressures based on a double-acting pneumatic actuator
Comber et al. Design and precision control of an MR-compatible flexible fluidic actuator
JP7221885B2 (ja) 注入器圧力較正システムおよび方法
Lindenroth et al. Toward intrinsic force sensing and control in parallel soft robots
JP5704712B2 (ja) 力算出システム
US20210361363A1 (en) Arm device, control method, and program
Lathrop et al. Concentric Dual-Chamber Pneumatic Artificial Muscles: Miniature Actuators Designed for Use in Minimally Invasive Surgical Instruments
JP6511010B2 (ja) アクチュエータ装置および制御方法
Perez-Guagnelli et al. Deflected Versus Preshaped soft pneumatic actuators: a design and performance analysis Toward reliable soft robots
Legrand et al. Concentric muscles–miniature pneumatic actuator with integrated channel for surgical instruments
JP2020085022A (ja) シリンダ変位制御システム
Lin Design of Pneumatic Soft Surgical Robot for Endoscopic NOTES and MIS Application with Reduced size
KR20220100894A (ko) 플로우 레퍼런스
BR102019026162A2 (pt) Sistema e método de controle de posição de pistão, e, sistema de controle hidráulico
Rad et al. Parameter identification and modeling of a pneumatic proportional valve with applicability in control design of servo-pneumatic systems
JP2016070132A (ja) ベローズ式ポンプ液体送出量の測定方法