WO2013157295A1 - 外力算出方法 - Google Patents

外力算出方法 Download PDF

Info

Publication number
WO2013157295A1
WO2013157295A1 PCT/JP2013/053930 JP2013053930W WO2013157295A1 WO 2013157295 A1 WO2013157295 A1 WO 2013157295A1 JP 2013053930 W JP2013053930 W JP 2013053930W WO 2013157295 A1 WO2013157295 A1 WO 2013157295A1
Authority
WO
WIPO (PCT)
Prior art keywords
external force
displacement
state quantity
calculated
pressure
Prior art date
Application number
PCT/JP2013/053930
Other languages
English (en)
French (fr)
Inventor
耕太郎 只野
健嗣 川嶋
悠 岡本
Original Assignee
国立大学法人 東京工業大学
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 国立大学法人 東京工業大学 filed Critical 国立大学法人 東京工業大学
Publication of WO2013157295A1 publication Critical patent/WO2013157295A1/ja

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

Definitions

  • the present invention relates to an external force calculation method, for example, an external force calculation method applied to driving a manipulator in a minimally invasive surgical operation.
  • Minimally invasive surgery is widely performed for the purpose of reducing pain to patients and making surgical marks after surgery less noticeable.
  • a manipulator for example, forceps
  • an operator or the like inserts and drives a manipulator from an insertion hole provided on the patient's body surface so that the operator performs an operation.
  • Non-Patent Document 1 a technique described in Non-Patent Document 1 is known in relation to such a technique.
  • a pneumatic actuator 10 ⁇ / b> D including a cylinder 11, a spring 12, a piston 13, a rod 14, and a manipulator 15 is used.
  • the cylinder 11 is provided with a displacement sensor (specifically, a rotary encoder) 18.
  • a displacement sensor specifically, a rotary encoder
  • the external force F is calculated using a rotary encoder.
  • the external force F cannot be calculated unless a physical displacement sensor (mechanical means) such as a rotary encoder is used. That is, the technique described in Non-Patent Document 1 has a problem that it is difficult to reduce the size of a device such as a pneumatic actuator because a space (region) for installing a displacement sensor is required.
  • the present invention has been made to solve the above-mentioned problems, and an object of the present invention is to provide an external force calculation method that can realize downsizing of the apparatus and ease of sterilization cleaning by not providing a mechanical sensor such as a displacement sensor.
  • the purpose is to provide.
  • the present inventors have intensively studied to solve the above problems. Specifically, in order to reduce the size of the apparatus and realize the ease of sterilization cleaning, an examination was made as to whether there was a means to replace the physical displacement sensor. As a result, the present inventors have found that the external force F can be calculated using a relational expression between the state quantity of air supplied to the pneumatic actuator and the external force F instead of providing a physical displacement sensor.
  • the present invention is implemented by the following means.
  • a pneumatic actuator having a drive unit connected to a jig, a method for calculating an external force applied to the jig, A state quantity measuring step of measuring a state quantity of air when the driving unit is moved by a load of an external force applied to the jig by a state quantity measuring unit; An external force calculation step of calculating an external force applied to the jig by an arithmetic unit based on the state quantity measured in the state quantity measurement step and a relational expression between the state quantity and the external force applied to the jig; Have.
  • the state quantity measured in the state quantity measurement step is at least pressure, and the displacement of the driving unit is calculated based on the pressure measured by the state quantity measuring unit and the relational expression between the pressure and the displacement of the driving unit.
  • the state quantity measured in the state quantity measurement step is pressure and flow rate, and based on the pressure and flow rate measured by the state quantity measurement means, and the relational expression of the pressure, flow rate, and displacement of the drive unit,
  • the external force calculation step based on the displacement calculated in the displacement calculation step and a relational expression between the displacement and the external force applied to the jig, the external force applied to the jig is calculated by the calculation unit. .
  • the pneumatic actuator includes an elastic member that is elastically deformed by movement of the drive unit,
  • the state quantity measured in the state quantity measuring step is a state quantity generated when the elastic member is elastically deformed, and the state quantity measured by the state quantity measuring means, the state quantity, and the displacement of the drive unit
  • the apparatus can be reduced in size. Further, since there is no need to provide a displacement sensor, the number of parts is reduced, and the apparatus configuration is simplified. Therefore, maintenance (cleaning, sterilization, etc.) of the apparatus can be easily performed. In addition, since the number of parts is reduced, it is possible to expand the applications where the pneumatic actuator can be used, such as applications that require explosion-proof properties and water resistance. Further, since no physical means controlled by electric power such as a displacement sensor is provided, the installation location of the apparatus is not limited.
  • the external force F is calculated using a relational expression between the air state quantity and the external force F, the external force F can be easily calculated using any kind of state quantity. Moreover, since the size of the state quantity is not limited by calculating using the relational expression, versatility is expanded.
  • the external force F can be calculated using a simple sensor such as a pressure sensor. Therefore, it is not necessary to use special means for calculating the external force, and the external force F can be calculated using an existing device.
  • the configuration of the entire apparatus can be simplified. Therefore, the apparatus is not excessively complicated for external force calculation, and installation and maintenance (sterilization, washing, etc.) are facilitated.
  • the external force F can be calculated using a simple sensor such as a pressure sensor or a flow rate sensor. Therefore, it is not necessary to use special means for calculating the external force, and the external force F can be calculated using an existing device.
  • the external force F can be calculated with higher accuracy.
  • this embodiment is not limited to the following content at all, and can be implemented by changing arbitrarily within the range which does not deviate from the gist of the present invention.
  • each means is appropriately enlarged and reduced for the convenience of illustration.
  • each means is simplified as appropriate for simplification of illustration.
  • FIG. 1 An external force calculation system 100 applicable to the external force calculation method of the first embodiment is shown in FIG.
  • the external force calculation system 100 includes a pneumatic actuator 10A, a pressure sensor 20 (state quantity measuring means), a flow sensor 30 (state quantity measuring means), and a pneumatic servo valve 40.
  • the external force calculation system 100 includes a calculation unit (not shown).
  • the pneumatic actuator 10A, the pressure sensor 20, the flow sensor 30, and the pneumatic servo valve 40 are connected by a pipe (not shown). Air is allowed to flow through this tube. In addition, it is preferable to make the pressure loss in this pipe as small as possible from the viewpoint of calculating the external force with higher accuracy. Moreover, the pressure sensor 20, the flow sensor 30, and the pneumatic servo valve 40 are connected to the calculation unit by an electric signal line (not shown).
  • the pneumatic actuator 10 ⁇ / b> A includes a cylinder 11, a spring 12, a piston 13, a rod 14, and a manipulator 15.
  • a spring 12 and a piston 13 are provided in the cylinder 11.
  • a spring 12 is provided in the cylinder 11 so as to surround the outer periphery of the rod 14.
  • a manipulator 15 is connected to the piston 13 via a rod 14.
  • the piston 13 is slidable in the axial direction of the cylinder 11 in the cylinder 11. Therefore, when air is supplied to the space formed by the cylinder 11 and the piston 13, the piston 11 slides in the right direction of the paper against the elastic force of the spring 12. Thereby, the manipulator 15 is configured to control the position of the cylinder 11 in the axial direction.
  • the manipulator 15 is a forceps in this embodiment.
  • the tip of the manipulator 15 can be controlled by the operator by a driving means and a control unit (not shown).
  • the pressure sensor 20 and the flow rate sensor 30 measure the pressure and flow rate of the air supplied into the cylinder 11. Since the pressure loss of the pipe connecting each means can be considered to be small, the pressure measured by the pressure sensor 20 can be considered as the pressure of the air in the cylinder 11.
  • the pressure sensor 20 for example, an arbitrary pressure gauge can be used.
  • the pneumatic servo valve 40 takes in air (for example, outside air) and supplies it into the cylinder 11.
  • the pneumatic servo valve 40 adjusts the pressure of air supplied to the cylinder 11.
  • the pneumatic servo valve 40 adjusts the pressure and flow rate so that the air pressure in the cylinder 11 becomes a predetermined pressure.
  • the air pressure in the cylinder 11 is a pressure required to move the manipulator 15 to a desired position in the axial direction of the cylinder 11.
  • a flow control type spool type pneumatic servo valve can be used as the pneumatic servo valve 40.
  • the pneumatic servo valve 40 is controlled by a control unit (not shown) according to an instruction from the operator.
  • the calculation unit measures the pressure and flow rate of air using the pressure sensor 20 and the flow rate sensor 30.
  • the arithmetic unit includes, for example, a CPU (Central Processing Unit), a ROM (Read Only Memory), a RAM (Random Access Memory), an HDD (Hard Disk Drive), and the like, and a predetermined program stored in the ROM is executed by the CPU. It is embodied by.
  • FIG. 2 is a flow for calculating the external force F.
  • the flow shown in FIG. 2 is a method of calculating an external force applied to the manipulator 15 (jig) in the pneumatic actuator 10A including the piston 13 (drive unit) connected to the manipulator 15 (jig).
  • This flow is performed by the above-described arithmetic unit based on the state quantity measured by the state variable measuring means and the relational expression between the state quantity and the external force F. Specifically, the external force F applied to the manipulator 15 (jig) is calculated based on the state quantity of air supplied to the pneumatic actuator 10A (in this embodiment, the flow rate and pressure). This flow is performed when an external force F is applied to the manipulator 15 in a state (steady state) in which air is supplied to the cylinder 11 by the pneumatic servo valve 40 at a predetermined flow rate.
  • the computing unit calculates in advance a volume (volume) V 0 of a space (a space to which air is supplied) formed by the cylinder 11 and the piston 13 in a steady state, and stores the volume in an HDD or the like.
  • the volume V 0 is calculated by, for example, a gas equation of state using the pressure measured by the pressure sensor 20. Further, the calculation unit measures the pressure P 0 by the pressure sensor 20 in a steady state and stores it in the HDD or the like. Further, the arithmetic unit is in the steady state, the flow rate G 0 is measured by the flow rate sensor 30, stored in the HDD or the like.
  • the calculation unit measures the pressure after the external force load by the pressure sensor 20 (step S101). Further, the calculation unit measures the flow rate after the external force load by the flow rate sensor 30 (step S102).
  • the pressure sensor 20 measures the air pressure (state quantity) when the piston 13 (drive unit) is moved by the load of the external force F applied to the manipulator 15 (jig) (state quantity). Measurement step). Further, the flow sensor 30 (state quantity measuring means) measures the air flow rate (state quantity) when the piston 13 (drive unit) is moved by the load of the external force F (state quantity measurement step).
  • the calculation unit calculates the speed v when the piston 13 moves based on the pressure and flow rate measured in Step S101 and Step S102 (Step S103). That is, the calculation unit calculates the speed v when the piston 13 (drive unit) moves (speed calculation step).
  • the speed v of the piston 13 is calculated based on the following equation (1). Note that the temperature of the supplied air does not normally change. Therefore, in this embodiment, the temperature is assumed to be constant. In order to simplify the calculation, it is assumed that air is an ideal gas.
  • P 0 , A, v, V 0 , P ′, G, R, and T are the following values.
  • P 0 Pressure in the space formed by the cylinder 11 and the piston 13 in a steady state
  • A Pressure receiving area of the piston 13 (cross-sectional area in a direction perpendicular to the sliding direction of the piston 13; constant)
  • v Speed of the piston 13
  • V 0 Volume of the space formed by the cylinder 11 and the piston 13 in the steady state
  • P ′ Time differential value of the pressure change amount from the steady state
  • G Flow rate measured by the flow sensor 30
  • the calculation unit integrates the velocity v calculated based on the equation (1) to calculate the displacement x (step S104).
  • the calculation unit calculates an external force F based on the calculated displacement x (step S105). That is, the calculation unit calculates the external force F based on the pressure and flow rate (state quantity) measured in the state quantity measurement step and the relational expression between these and the external force F (external force calculation step). More specifically, the calculation unit calculates the external force F based on the calculated displacement x and a relational expression between the displacement x and the external force F (the following expression (2)). The external force F is calculated based on the following formula (2).
  • P, A, B, v, K, and x are the following values.
  • P Pressure in the cylinder 11 measured by the pressure sensor 20: Value similar to the above formula (1) (pressure receiving area of the piston 13; constant)
  • B Viscosity coefficient of the piston 13 when the piston 13 slides (predetermined by experiment etc .; constant)
  • v Speed v calculated in step S103
  • K Spring constant of the spring 12 (predetermined by experiment etc .; constant)
  • x Displacement x calculated in step S104
  • the calculated external force F is presented to the surgeon by the calculation unit. Examples of the form of presentation include giving a reaction to the surgeon according to the magnitude of the external force F.
  • each parameter used for calculating the external force F is a value measured by an existing means. Therefore, it is not necessary to introduce a new means for calculating the external force F.
  • the external force F is calculated using a relational expression between the air state quantity and the external force F, the external force F can be easily calculated using any kind of state quantity. Further, by calculating using the relational expression, the size of the state quantity is not limited, so that versatility is expanded. Further, for example, the relationship between the external force F and the displacement x or the flow rate G does not have to be determined in advance through experiments or the like. Therefore, even if the specifications of the spring 12 and the piston 13 are changed, for example, If only the value used in (2) is changed, the external force F can be calculated under new conditions. Therefore, even if various conditions and specifications are changed, the external force F can be easily calculated under new conditions.
  • the number of parts is reduced and the device configuration is simplified. Therefore, maintenance (cleaning, sterilization, etc.) of the apparatus can be easily performed.
  • the number of parts is reduced, it is possible to expand the applications where the pneumatic actuator can be used, such as applications that require explosion-proof properties and water resistance.
  • the external force F can be measured by existing means without providing a displacement sensor that is a physical measurement means. Therefore, it is not necessary to consider the generation of an external magnetic force that can be generated by the displacement sensor. Therefore, the external force calculation method can be applied to various uses without limiting the installation location of the apparatus.
  • the external force is calculated using a simple sensor such as a pressure sensor or a flow rate sensor. Therefore, it is not necessary to use special means for calculating the external force, and the external force can be calculated using an existing device as described above. Moreover, since it is not necessary to provide a speed sensor etc., the structure of the whole apparatus can be simplified. Therefore, the apparatus is not excessively complicated for external force calculation, and installation and maintenance (sterilization, washing, etc.) are facilitated.
  • the external force calculation method of the first embodiment is applied to a device using a pneumatic actuator. Therefore, when an external force is applied to the manipulator 15 of the pneumatic actuator 10A, the air in the cylinder 11 can be compressed, so the piston 11 moves. Then, using this phenomenon, the external force F is calculated. Thereby, the loaded external force F is presented. Therefore, it is possible to perform work with high accuracy in surgery and the like.
  • FIG. 3 An external force calculation system 200 applicable to the external force calculation method of the second embodiment is shown in FIG. 3, the same components as those in the external force calculation system 100 shown in FIG. 1 are denoted by the same reference numerals, and detailed description thereof is omitted.
  • the external force calculation system 200 shown in FIG. 3 includes a pneumatic actuator 10B, a pressure sensor 20, a pneumatic servo valve 40 (first servo valve) 40, a flow sensor 50, a pneumatic servo valve 60 (second servo valve), It has. Further, the external force calculation system 200 includes a calculation unit (not shown).
  • the pneumatic actuator 10B in the external force calculation system 200 includes a tube (for example, a rubber tube) 16 made of an elastic body in addition to the configuration of the pneumatic actuator 10A of the first embodiment described above.
  • the pipe 16 is provided through the wall surface of the cylinder 11 and the rod 14. Further, the tube 16 is held between the springs 12.
  • the air from the pneumatic servo valve 60 flows through the pipe 16.
  • the flow rate of air flowing through the pipe 16 is measured by the flow rate sensor 50.
  • the flow sensor 50 and the pneumatic servo valve 60 are connected to the calculation unit by an electric signal line (not shown).
  • the pneumatic servo valve 40 adjusts the pressure and flow rate of air to be supplied so that the air pressure in the cylinder 11 becomes a predetermined pressure (steady state). .
  • the air supplied by the pneumatic servo valve 60 flows through the pipe 16 at a constant rate (the state shown in FIG. 4A).
  • the external force F is calculated using such a flow path change.
  • the pneumatic actuator 10B includes a tube 16 (elastic member) that is elastically deformed by the movement of the piston 13 (drive unit).
  • the tube 16 (elastic member) is elastically deformed.
  • the flow path in the pipe 16 is narrowed, and the flow rate of the passing air changes.
  • the flow rate (state quantity) G to be measured changes when the tube 16 (elastic member) is elastically deformed
  • the calculation unit calculates the measured flow rate (state quantity) G
  • the external force F is calculated based on the relational expression (formula (2) and the following formula (3)) between the flow rate (state quantity) and the external force F. More specifically, the calculation unit calculates the displacement x based on the flow rate G and the following expression (3), and calculates the external force F based on the calculated displacement x and the above expression (2).
  • the calculation unit measures the flow rate (state quantity) of the air flowing through the pipe 16 after the external force F is loaded (step S201).
  • the displacement x is calculated based on the measured flow rate G (step S202). Note that the relationship between the flow rate G and the displacement x accompanying the movement of the piston 13 is determined in advance by a preliminary experiment or the like. Specifically, the displacement x is determined in advance as a function f of the flow rate G by a preliminary experiment or the like. That is, this function is expressed by the following equation (3).
  • the displacement x is calculated based on the flow rate G using the relationship (formula (3)) established between the flow rate G and the displacement x.
  • the calculation unit calculates the speed v of the piston 13 by differentiating the calculated displacement x (step S203; speed calculation step). Further, the calculation unit measures the pressure P in the cylinder 11 by the pressure sensor 20 (step S204). The computing unit calculates the external force F by substituting the displacement x calculated in step S202, the velocity v calculated in step S203, and the pressure P measured in step S204 into the equation (2). (Step S205). That is, the calculation unit calculates the external force F based on at least the displacement x calculated based on the formula (3) and the relational expression (formula (2)) between the displacement x and the external force F.
  • the calculated external force F is presented to the surgeon by the calculation unit. Examples of the form of presentation include giving a reaction to the surgeon according to the magnitude of the external force F.
  • integral calculation is not performed when calculating the external force F. Therefore, there is an advantage that error accumulation is small.
  • the external force F is calculated using the fact that the interval between the springs 12 becomes narrow in one of the supply paths. Therefore, the external force F is calculated more accurately than in the case of one system. Thereby, the loaded external force F is accurately presented. Therefore, the operation can be performed with higher accuracy in surgery and the like.
  • the whole apparatus using a pneumatic actuator can be reduced in size. Furthermore, there are advantages such as ease of installation and maintenance of the apparatus, simplification of the configuration, expansion of application, and versatility.
  • FIG. 6 An external force calculation system 300 applicable to the external force calculation method of the third embodiment is shown in FIG. 6, the same components as those in the external force calculation system 100 illustrated in FIG. 1 and the external force calculation system 200 illustrated in FIG. 3 are denoted by the same reference numerals, and detailed description thereof is omitted.
  • the external force calculation system 300 shown in FIG. 6 includes a pneumatic actuator 10C, a pressure sensor (first pressure sensor) 20, a pneumatic servo valve 40, a chamber 70, and a pressure sensor (second pressure sensor) 80. ing. Further, the external force F calculation system 300 includes a calculation unit (not shown).
  • the pneumatic actuator 10C in the external force calculation system 300 includes a hollow balloon 17 (for example, made of rubber) made of an elastic body.
  • the balloon 17 is provided through the wall surface of the cylinder 11 and the rod 14. The balloon 17 is held between the springs 12.
  • the state of the balloon 17 when the external force F is not loaded and the state of the balloon 17 when the external force F is loaded will be described with reference to FIG.
  • the manner in which the balloon 17 is arranged may be different from the actual situation.
  • the manner in which the balloon 17 is arranged is simplified. Show.
  • the pneumatic servo valve 40 adjusts the flow rate of supplied air so that the air pressure in the cylinder 11 becomes a predetermined pressure (steady state). At this time, the balloon 17 held between the springs 12 is not deformed as shown in FIG. Accordingly, in the steady state, the pressure in the balloon 17 is constant.
  • the external force F is calculated using the change in pressure caused by the deformation of the balloon 17. That is, the principle is the same as in the second embodiment, but in the third embodiment, the external force F is calculated based on the pressure change accompanying the change in the internal volume of the balloon 17 due to elastic deformation.
  • the external force calculation method of the third embodiment will be specifically described with reference to FIG.
  • the flow shown in FIG. 8 is performed.
  • the calculation unit measures the pressure in the chamber 70 by the pressure sensor 80 in a steady state and stores the pressure in the HDD or the like.
  • the calculation unit measures the pressure (state quantity) of the chamber 70 after the pressure increase by the pressure sensor 80 (step S301). Then, the calculation unit calculates the volume change amount dV based on the measured pressure of the chamber 70 (step S302).
  • the relationship between the pressure of the chamber 70 and the volume change amount dV will be described.
  • Equation (4) when the air temperature does not change.
  • P 0 , V 0 , dP, V, and dV are the following values.
  • P 0 Initial pressure (steady-state pressure measured by the pressure sensor 80)
  • V 0 Total initial volume dP of the inner volume of the balloon 17 and the inner volume of the chamber 70 in the steady state
  • dP Pressure change amount from the initial pressure P 0 when the steady state changes to the loaded state
  • dV From the steady state Volume change from total initial volume V 0 when changed to load state
  • V 0 is the total volume of the internal volume of the balloon 17, the internal volume of the chamber 70, and the internal volume of the pipe connecting them.
  • the internal volume of the tube is usually extremely small compared to the total volume of the internal volume of the balloon 17 and the internal volume of the chamber 70. Therefore, it is possible to measure and use these total volumes, but the accuracy is sufficiently good in the above formula (4) without considering the internal volume of the tube.
  • the displacement x is calculated based on the calculated volume change amount dV (step S303).
  • the relationship between the volume change amount dV and the displacement x is determined in advance by a preliminary experiment or the like. Specifically, the displacement x is determined in advance as a function g of the volume change amount dV through a preliminary experiment or the like. That is, this function is expressed by the following equation (5).
  • the displacement x is calculated by substituting the volume change amount dV into the equation (5).
  • the external force F is calculated in the same manner as in the second embodiment (steps S303 to S306).
  • the calculated external force F is presented to the surgeon by the calculation unit. Examples of the form of presentation include giving a reaction to the surgeon according to the magnitude of the external force F.
  • only one pneumatic servo valve for supplying air is provided.
  • the other system is a system for keeping the pressure in the balloon 17 constant without controlling the flow rate. Therefore, the control can be simplified.
  • the apparatus configuration can be simplified.
  • a manipulator to which the external force calculation method of the present embodiment is applicable is not limited to forceps.
  • a jig to which the external force calculation method of the present embodiment can be applied is not limited to a manipulator. Examples of the jig to which the external force calculation method of this embodiment can be applied include application to an endoscope, a gripping member, and a surgical robot.
  • the jig to which the external force calculation method of the present embodiment can be applied may be a jig other than a surgical jig, such as a semiconductor manufacturing application, an application that requires explosion-proof properties, and an underwater work application. Application to any use is possible.
  • the configuration to which the external force calculation method of the present embodiment can be applied is not limited to the illustrated example, and members and means may be appropriately selected and used according to the jig to which the external force is applied.
  • a pneumatic servo valve or a pneumatic solenoid valve can be connected to drive a pneumatic actuator.
  • a pneumatic servo valve is used, but an air piezoelectric air proportional valve or the like may be used instead of the pneumatic servo valve.
  • a cylinder and a piston are combined to form a pneumatic actuator, but the configuration of the pneumatic actuator is not limited to the illustrated example.
  • a pneumatic actuator that combines a cylinder and a plunger may be used.
  • the air supplied to the pneumatic actuator is not necessarily air, and any gas may be supplied.
  • the spring 12 provided in each pneumatic actuator is not necessarily provided at the position shown in the drawing. That is, in the illustrated example, the spring 12 is provided in the cylinder 11 and between the piston 13 and the manipulator 15, but is provided in the cylinder 11 and between the pneumatic servo valve 40 and the piston 13. You may be made to do. More specifically, the spring 12 may be provided in a space to which air from the pneumatic servo valve 40 is supplied. Further, although the spring 12 is provided so as to surround the rod 14, for example, one or a plurality of springs may be provided without surrounding the rod 14 in parallel to the outer peripheral surface of the rod 14.
  • the installation form of the tube 16 in FIG. 3 and the installation form of the balloon 17 in FIG. 6 are not limited to the illustrated example. That is, in the illustrated example, the tube 16 and the balloon 17 are deformed by the spring 12, but they may be deformed, for example, when the piston 13 and the tube 16 or the balloon 17 come into contact with each other. Also, the installation position of these means is not particularly limited, and any position may be used as long as the tube 16 and the balloon 17 are deformed to cause the above-described action. Moreover, although the pipe
  • steps S303 to S306 are the same as steps S202 to S205 in the external force calculation system 200.
  • the equation (1) is used. It may be calculated.
  • FIGS. 2, 5, and 8 is an example of a flow for explaining the present embodiment, and can be implemented with arbitrary changes.
  • the compression amount is calculated based on the flow rate change amount in the example of FIG. 3, a pressure sensor may be provided to calculate the compression amount based on the pressure change amount.
  • the compression amount is calculated based on the pressure change amount, but a flow rate sensor may be provided to calculate the compression amount based on the flow rate change amount.
  • the compression amount may be calculated using both the pressure change amount and the flow rate change amount.
  • the state quantities in the above-described embodiments can be appropriately changed and implemented. That is, any state quantity may be used as long as the external force F is calculated based on a change in the state quantity caused by the movement of the piston 13 (drive unit). Examples of the state quantity include the volume and temperature in addition to the pressure and flow rate described above. Correspondingly, various sensors (state quantity measuring means) may be provided.

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Physics & Mathematics (AREA)
  • Surgery (AREA)
  • Biomedical Technology (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Medical Informatics (AREA)
  • Molecular Biology (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • General Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Fluid Mechanics (AREA)
  • General Physics & Mathematics (AREA)
  • Robotics (AREA)
  • Analytical Chemistry (AREA)
  • Chemical & Material Sciences (AREA)
  • Pathology (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Manipulator (AREA)

Abstract

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

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実施形態の外力算出方法を説明する図である。 外力が負荷された時の管形状の変化を説明する図であり、(a)は定常状態の図、(b)は管が変形した状態の図である。 第2実施形態の外力を算出するフローである。 第3実施形態の外力算出方法を説明する図である。 外力が負荷された時のバルーンの変化を説明する図であり、(a)は定常状態の図、(b)は管が変形した状態の図である。 第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の駆動条件が変化しなければ、ピストン13が移動してシリンダ内の容積が小さくなった分、シリンダ11内の圧力が増加することになる。さらには、外力Fが負荷されると、流量に変化が生じる。そこで、演算部は、圧力センサ20により、外力負荷後の圧力を測定する(ステップS101)。また、演算部は、流量センサ30により、外力負荷後の流量を測定する(ステップS102)。
 即ち、圧力センサ20(状態量測定手段)は、マニピュレータ15(治具)への外力Fの負荷によってピストン13(駆動部)が移動した時におけるエアの圧力(状態量)を測定する(状態量測定ステップ)。また、流量センサ30(状態量測定手段)は、外力Fの負荷によってピストン13(駆動部)が移動した時におけるエアの流量(状態量)を測定する(状態量測定ステップ)。
 演算部は、ステップS101及びステップS102において測定した圧力及び流量に基づき、ピストン13の移動時の速度vを算出する(ステップS103)。即ち、演算部は、ピストン13(駆動部)の移動時の速度vを算出する(速度算出ステップ)。ピストン13の速度vは、以下の式(1)に基づいて算出される。なお、供給されるエアの温度は、通常は変化しない。そこで、本実施形態においては、温度は一定であるものとする。また、計算の簡略化のために、エアは理想気体であるものとする。
Figure JPOXMLDOC01-appb-M000001
 ただし、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 JPOXMLDOC01-appb-M000002
 ただし、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の間隔は、定常状態よりも狭くなる。従って、スプリング12に狭持された管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 JPOXMLDOC01-appb-M000003
 ここで、ピストン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 JPOXMLDOC01-appb-M000004
 ただし、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 JPOXMLDOC01-appb-M000005
 このように、前記式(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において、ステップS303~ステップ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項又は第2項に記載の外力算出方法。
  5.  前記空気圧アクチュエータは、前記駆動部の移動により弾性変形する弾性部材を備え、
     前記状態量測定ステップにおいて測定される状態量が、前記弾性部材が弾性変形した時に変化する状態量であり、前記状態量測定手段によって測定された状態量、及び、状態量と前記駆動部の変位との関係式に基づき、前記駆動部の変位を前記演算部によって算出する変位算出ステップを有し、
     前記外力算出ステップにおいて、前記変位算出ステップにおいて算出された変位、及び、変位と前記治具に負荷される外力との関係式に基づき、前記治具に負荷される外力を前記演算部によって算出する
    ことを特徴とする、請求の範囲第1項又は第2項に記載の外力算出方法。
PCT/JP2013/053930 2012-04-18 2013-02-19 外力算出方法 WO2013157295A1 (ja)

Applications Claiming Priority (2)

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

Publications (1)

Publication Number Publication Date
WO2013157295A1 true WO2013157295A1 (ja) 2013-10-24

Family

ID=49383264

Family Applications (1)

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

Country Status (2)

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

Families Citing this family (2)

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

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62151730A (ja) * 1985-12-26 1987-07-06 Aisin Seiki Co Ltd 流体圧利用アクチユエ−タの負荷検出装置
JPH0342706U (ja) * 1989-08-29 1991-04-23
JPH05216583A (ja) * 1992-02-04 1993-08-27 Fujitsu Ltd 6自由度情報入力装置
JP2000199502A (ja) * 1998-11-05 2000-07-18 Smc Corp アクチュエ―タ制御回路
JP2004257819A (ja) * 2003-02-25 2004-09-16 Railway Technical Res Inst ピストン変位検出装置及びダンパ装置
JP2011158027A (ja) * 2010-02-01 2011-08-18 Santest Co Ltd 位置と負荷の検出可能な流体圧アクチュエータ

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62151730A (ja) * 1985-12-26 1987-07-06 Aisin Seiki Co Ltd 流体圧利用アクチユエ−タの負荷検出装置
JPH0342706U (ja) * 1989-08-29 1991-04-23
JPH05216583A (ja) * 1992-02-04 1993-08-27 Fujitsu Ltd 6自由度情報入力装置
JP2000199502A (ja) * 1998-11-05 2000-07-18 Smc Corp アクチュエ―タ制御回路
JP2004257819A (ja) * 2003-02-25 2004-09-16 Railway Technical Res Inst ピストン変位検出装置及びダンパ装置
JP2011158027A (ja) * 2010-02-01 2011-08-18 Santest Co Ltd 位置と負荷の検出可能な流体圧アクチュエータ

Also Published As

Publication number Publication date
JP2013220273A (ja) 2013-10-28

Similar Documents

Publication Publication Date Title
JP5754820B2 (ja) 手術用ロボット
Gorissen et al. Theoretical and experimental analysis of pneumatic balloon microactuators
Milana et al. Artificial soft cilia with asymmetric beating patterns for biomimetic low‐Reynolds‐number fluid propulsion
CN109324641B (zh) 流量控制装置、流量控制方法和程序存储介质
CN110087575A (zh) 液压钳子系统
JP5931667B2 (ja) 流量センサの自己校正機構、自己校正方法、自己校正機構用プログラム、及び、マスフローコントローラ
WO2013157295A1 (ja) 外力算出方法
Fraś et al. Static modeling of multisection soft continuum manipulator for stiff-flop project
Comber et al. Design and precision control of an MR-compatible flexible fluidic actuator
Takeishi et al. A force sensing-based pneumatics for robotic surgery using neural network
KR101885429B1 (ko) 위치 전송기 모델을 이용한 공기구동 제어 밸브의 진단 방법 및 장치
US20210361363A1 (en) Arm device, control method, and program
Yan et al. Design and test of a new spiral driven pure torsional soft actuator
JP5704712B2 (ja) 力算出システム
JP6511010B2 (ja) アクチュエータ装置および制御方法
Liu et al. Impact of generic tendon routing on tension loss of tendon-driven continuum manipulators with planar deformation
JP7216524B2 (ja) シリンダ変位制御システム
Garriga-Casanovas et al. Optimised Design and Performance Comparison of Soft Robotic Manipulators
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
Lin Design of Pneumatic Soft Surgical Robot for Endoscopic NOTES and MIS Application with Reduced size
KR20220100894A (ko) 플로우 레퍼런스
JP5197221B2 (ja) 流体圧アクチュエータの試験装置
JP4499505B2 (ja) 内視鏡装置
Virdyawan et al. Design and Manufacturing of an Affordable Soft-Robotic Manipulator for Minimally Invasive Diagnosis

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: 13777818

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 13777818

Country of ref document: EP

Kind code of ref document: A1