US10814499B2 - Actuator device and control method - Google Patents

Actuator device and control method Download PDF

Info

Publication number
US10814499B2
US10814499B2 US16/099,903 US201716099903A US10814499B2 US 10814499 B2 US10814499 B2 US 10814499B2 US 201716099903 A US201716099903 A US 201716099903A US 10814499 B2 US10814499 B2 US 10814499B2
Authority
US
United States
Prior art keywords
cylinder
actuator
pressure
piston
target
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
US16/099,903
Other versions
US20190143540A1 (en
Inventor
Hideki Tanaka
Hideki Watanabe
Mariko OGATA
Isamu Yoshimura
Tomohide Hattori
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.)
Kawasaki Motors Ltd
Original Assignee
Kawasaki Jukogyo KK
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 Kawasaki Jukogyo KK filed Critical Kawasaki Jukogyo KK
Assigned to KAWASAKI JUKOGYO KABUSHIKI KAISHA reassignment KAWASAKI JUKOGYO KABUSHIKI KAISHA ASSIGNMENT OF ASSIGNORS INTEREST (SEE DOCUMENT FOR DETAILS). Assignors: Hattori, Tomohide, OGATA, Mariko, TANAKA, HIDEKI, WATANABE, HIDEKI, YOSHIMURA, ISAMU
Publication of US20190143540A1 publication Critical patent/US20190143540A1/en
Application granted granted Critical
Publication of US10814499B2 publication Critical patent/US10814499B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • F15B7/00Systems in which the movement produced is definitely related to the output of a volumetric pump; Telemotors
    • F15B7/001With multiple inputs, e.g. for dual control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B17/00Surgical instruments, devices or methods, e.g. tourniquets
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/088Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/14Programme-controlled manipulators characterised by positioning means for manipulator elements fluid
    • B25J9/144Linear actuators
    • 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/02Systems essentially incorporating special features for controlling the speed or actuating force of an output member
    • F15B11/028Systems essentially incorporating special features for controlling the speed or actuating force of an output member for controlling the actuating force
    • 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
    • F15B21/00Common features of fluid actuator systems; Fluid-pressure actuator systems or details thereof, not covered by any other group of this subclass
    • F15B21/08Servomotor systems incorporating electrically operated control means
    • F15B21/087Control strategy, e.g. with block diagram
    • 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
    • F15B7/00Systems in which the movement produced is definitely related to the output of a volumetric pump; Telemotors
    • F15B7/06Details
    • F15B7/10Compensation of the liquid content in a system
    • 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
    • F15B9/00Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member
    • F15B9/02Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member with servomotors of the reciprocatable or oscillatable type
    • 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/00539Surgical instruments, devices or methods, e.g. tourniquets pneumatically or hydraulically operated hydraulically
    • 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/064Measuring instruments not otherwise provided for for measuring force, pressure or mechanical tension
    • 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/0807Indication means
    • A61B2090/0811Indication means for the position of a particular part of an instrument with respect to the rest of the instrument, e.g. position of the anvil of a stapling instrument
    • 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
    • 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/20Fluid pressure source, e.g. accumulator or variable axial piston pump
    • F15B2211/205Systems with pumps
    • F15B2211/20507Type of prime mover
    • F15B2211/20515Electric motor
    • 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/633Electronic controllers using input signals representing a state of the prime mover, e.g. torque or rotational speed
    • 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/6336Electronic controllers using input signals representing a state of the output member, e.g. position, speed or acceleration
    • 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/6651Control of the prime mover, e.g. control of the output torque or rotational speed
    • 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/7053Double-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/75Control of speed 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/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

Definitions

  • the present invention relates to an actuator device including a cylinder and a control method.
  • a surgical robot of PTL 1 is known as one example using an actuator device including a cylinder.
  • the surgical robot includes a forceps, and a piston and a cylinder are provided at the forceps so as to open and close an opening/closing portion of the forceps.
  • a hydraulic device of PTL 2 is known as a device configured to control a pressure of a pressure chamber of the cylinder while positioning the piston.
  • the hydraulic device includes a hydraulic cylinder, a rod, a hydraulic pump connected to the hydraulic cylinder through a channel, and an electric motor configured to drive the hydraulic pump.
  • the electric motor is controlled based on a position of the rod relative to the hydraulic cylinder and a pressure in the channel connected to the cylinder. Then, such position control and pressure control are switched from one to the other.
  • the pressure of the pressure chamber of the cylinder is required to be kept constant.
  • the hydraulic device of PTL 2 since the position control and the pressure control are performed while being switched from one to the other, it is difficult to keep the pressure of the cylinder constant. Therefore, highly-accurate positioning cannot be maintained.
  • the present invention was made to solve the above problems, and an object of the present invention is to provide an actuator device and a control method, each of which is capable of performing positioning with a high degree of accuracy.
  • An actuator device includes: a cylinder including an internal space; a piston accommodated in the internal space and forming a pair of pressure chambers together with the cylinder, the piston being configured to move relative to the cylinder; a first actuator connected to one of the pair of pressure chambers; a second actuator connected to the other of the pair of pressure chambers; a position detector configured to detect a position of the piston relative to the cylinder; a pressure detector configured to detect a pressure of any one of the pair of pressure chambers; and a controller configured to control the first actuator and the second actuator, wherein: the controller controls one of the first actuator and the second actuator such that the position detected by the position detector is made close to a target position; and the controller controls the other of the first actuator and the second actuator such that the pressure detected by the pressure detector is made close to a target pressure.
  • the position of the piston relative to the cylinder can be controlled by one of the first actuator and the second actuator, and at the same time, the pressure in the cylinder partitioned by the piston can be controlled by the other of the first actuator and the second actuator. Therefore, the piston can be positioned with a high degree of accuracy, and the positioning accuracy can be kept high
  • the cylinder may be a hydraulic cylinder configured such that pressures of liquids of the pair of pressure chambers are controlled by the respective first and second actuators or a pneumatic cylinder configured such that pressures of gases of the pair of pressure chambers are controlled by the respective first and second actuators.
  • each of the first actuator and the second actuator may be a hydraulic cylinder or a pneumatic cylinder.
  • the actuator device may further include a rod including: a tip end connected to a treating part of a medical instrument; and a base end coupled to the piston.
  • a method of controlling an actuator device is a method of controlling an actuator device, the actuator device including: a cylinder including an internal space; a piston accommodated in the internal space and forming a pair of pressure chambers together with the cylinder, the piston being configured to move relative to the cylinder; a first actuator connected to one of the pair of pressure chambers; a second actuator connected to the other of the pair of pressure chambers; a position detector configured to detect a position of the piston relative to the cylinder; and a pressure detector configured to detect a pressure of any one of the pair of pressure chambers, the method including: controlling one of the first actuator and the second actuator such that the position detected by the position detector is made close to a target position; and controlling the other of the first actuator and the second actuator such that the pressure detected by the pressure detector is made close to a target pressure.
  • the present invention is configured as explained above and has an effect of being able to provide an actuator device and a control method, each of which is capable of performing positioning with a high degree of accuracy.
  • FIG. 1 is a block diagram schematically showing the configuration of an actuator device according to an embodiment of the present invention.
  • an actuator device 10 according to an embodiment of the present invention will be explained with reference to FIG. 1 .
  • the following will explain a case where the actuator device 10 according to the present invention is applied to a medical instrument 11 .
  • the present embodiment is not limited to the case where the actuator device 10 is applied to the medical instrument 11 .
  • the medical instrument 11 is connected to a manipulator (not shown) of a robot arm.
  • the medical instrument 11 include a forceps, a cautery, an electric scalpel, and an image pickup apparatus.
  • the forceps is adopted.
  • the medical instrument 11 includes the actuator device 10 , a movable portion 12 , and a treating part 13 .
  • An opening/closing portion of the forceps is used as the treating part 13 .
  • the movable portion 12 is a link mechanism and converts movements of the actuator device 10 into movements corresponding to the treating part 13 .
  • the movable portion 12 converts movements of a piston 21 into opening/closing operations of the opening/closing portion that is the treating part 13 .
  • the actuator device 10 includes a cylinder 20 , the piston 21 , a first actuator 30 , a second actuator 40 , a position detector 22 , a pressure detector 23 , and a controller 50 .
  • the controller 50 may be connected to an input device (not shown) to which a command is input by manipulation of a user.
  • the cylinder 20 is a hydraulic cylinder.
  • a liquid such as oil or a physiological saline solution, is used as an operating fluid.
  • the cylinder 20 is a small cylinder having a small diameter, and the diameter is about 5 mm, for example.
  • the cylinder 20 includes an internal space and is constituted by, for example, a cylindrical side wall portion and end wall portions covering both respective end openings of the side wall portion.
  • the piston 21 is accommodated in the internal space of the cylinder 20 .
  • the piston 21 has, for example, a disc shape and forms a pair of pressure chambers 24 and 25 together with the cylinder 20 .
  • a packing 26 is provided at a side end of the piston 21 .
  • the packing 26 is made of resin, rubber, and the like and is interposed in a gap between the side end of the piston 21 and the side wall portion of the cylinder 20 . With this, the packing 26 seals the gap while realizing a state where the piston 21 can move relative to the cylinder 20 .
  • a rod 27 is, for example, a rod-shaped long member, and a base end of the rod 27 is coupled to the piston 21 .
  • the rod 27 passes through the internal space of the cylinder 20 and penetrates the end wall portion of the cylinder 20 .
  • the treating part 13 of the medical instrument 11 is connected to a tip end of the rod 27 .
  • the first actuator 30 is connected to the pressure chamber 24 (in the present embodiment, a rod-side pressure chamber) that is one of the pair of pressure chambers 24 and 25 through a first passage 28 .
  • the rod-side pressure chamber 24 is a rod 27 -side pressure chamber through which the rod 27 passes.
  • the first actuator 30 supplies or discharges a liquid to or from the rod-side pressure chamber 24 through the first passage 28 to adjust a pressure of the liquid in the rod-side pressure chamber 24 .
  • the first actuator 30 is a hydraulic cylinder.
  • the first actuator 30 includes a first cylinder 31 , a first piston 32 , a first rod 33 , a first linear motion mechanism 34 , and a first motor 35 .
  • the first cylinder 31 is a hydraulic cylinder.
  • a head-side pressure chamber (head-side first pressure chamber) 36 of the first cylinder 31 communicates with the rod-side pressure chamber 24 of the cylinder 20 through the first passage 28 .
  • the first rod 33 extends from the first piston 32 and is connected to the first motor 35 through the first linear motion mechanism 34 .
  • the first motor 35 is, for example, a servo motor that can rotate in both directions. A rotational movement of the first motor 35 is controlled by the controller 50 .
  • a first rotating speed sensor 37 configured to detect a rotating speed of the first motor 35 is provided at the first motor 35 , and a detected position detected by the first rotating speed sensor 37 is output to the controller 50 .
  • the first linear motion mechanism 34 converts the rotational movement of the first motor 35 into a straight movement, and the straight movement is transmitted to the first piston 32 through the first rod 33 .
  • the second actuator 40 is connected to the pressure chamber 25 (in the present embodiment, a head-side pressure chamber) that is the other of the pair of pressure chambers 24 and 25 through a second passage 29 .
  • the head-side pressure chamber 25 is a head-side pressure chamber through which the rod 27 does not pass.
  • the second actuator 40 supplies or discharges the liquid to or from the head-side pressure chamber 25 through the second passage 29 to adjust the pressure of the liquid in the head-side pressure chamber 25 .
  • the second actuator 40 is a hydraulic cylinder.
  • the second actuator 40 includes a second cylinder 41 , a second piston 42 , a second rod 43 , a second linear motion mechanism 44 , and a second motor 45 .
  • the second cylinder 41 is a hydraulic cylinder.
  • a head-side pressure chamber (head-side second pressure chamber) 46 of the second cylinder 41 communicates with the head-side pressure chamber 25 of the cylinder 20 through the second passage 29 .
  • the second rod 43 extends from the second piston 42 and is connected to the second motor 45 through the second linear motion mechanism 44 .
  • the second motor 45 is, for example, a servo motor that can rotate in both directions. A rotational movement of the second motor 45 is controlled by the controller 50 .
  • a second rotating speed sensor 47 configured to detect a rotating speed of the second motor 45 is provided at the second motor 45 , and a detected position detected by the second rotating speed sensor 47 is output to the controller 50 .
  • the second linear motion mechanism 44 converts the rotational movement of the second motor 45 into a straight movement, and the straight movement is transmitted to the second piston 42 through the second rod 43 .
  • the position detector 22 is a sensor configured to detect a position of the piston 21 relative to the cylinder 20 .
  • One example of the position detector 22 is a sensor utilizing light or magnetism.
  • the position of the piston 21 is a position in a moving direction of the piston 21 , for example, a position in a direction perpendicular to the piston 21 having the disc shape. Further, for example, the position of the piston 21 may be: a value obtained by integrating movement distances from an initial value; or a distance from a reference position of the cylinder 20 to the piston 21 .
  • the position detector 22 is provided at the rod 27 and outputs the detected position to the controller 50 .
  • the pressure detector 23 is a sensor configured to detect the pressure of the head-side pressure chamber 25 of the cylinder 20 and outputs the detected pressure to the controller 50 .
  • Examples of the pressure detector 23 include a strain gage and a sensor utilizing a piezoelectric effect.
  • the pressure detector 23 is provided at the second passage 29 .
  • the pressure detector 23 may be provided at the head-side pressure chamber 25 or the head-side second pressure chamber 46 of the second cylinder 41 .
  • the controller 50 includes a calculating portion (not shown) and a storage portion (not shown).
  • the controller 50 is, for example, a robot controller including a computer, such as a microcontroller. It should be noted that the controller 50 may be constituted by a single controller which performs centralized control or a plurality of controllers which cooperate to perform distributed control.
  • Used as the storage portion is a ROM, a RAM, and the like, and the storage portion stores information, such as a basic program for the robot controller and various fixed data.
  • Used as the calculating portion is a CPU or the like.
  • the calculating portion reads and executes software, such as the basic program stored in the storage portion, to control the first and second actuators 30 and 40 of the actuator device 10 .
  • the controller 50 includes a first control portion 51 and a second control portion 52 .
  • the first control portion 51 includes a position control portion 53 , a first speed control portion 54 , and a first inverter portion 55 .
  • the second control portion 52 includes a pressure control portion 56 , a second speed control portion 57 , and a second inverter portion 58 .
  • the first inverter portion 55 is connected to the first motor 35 through a first wire, and a first current sensor 59 is provided at the first wire.
  • the second inverter portion 58 is connected to the second motor 45 through a second wire, and a second current sensor 60 is provided at the second wire.
  • the first control portion 51 controls one of the first actuator 30 and the second actuator 40 (in the present embodiment, the first actuator 30 ) such that the position detected by the position detector 22 is made close to a target position.
  • the second control portion 52 controls the other of the first actuator 30 and the second actuator 40 (in the present embodiment, the second actuator 40 ) such that the pressure detected by the pressure detector 23 is made close to a target pressure.
  • This operation is controlled by the controller 50 .
  • the target position is input to the first control portion 51
  • the target pressure is input to the second control portion 52 .
  • the target position is such a position of the piston 21 that the medical instrument 11 is arranged at an arrival position.
  • the target pressure may be a pressure that changes depending on various conditions or may be a constant pressure that does not change.
  • the target pressure is such a pressure that the position of the piston 21 can be maintained so as not to be changed when external force is applied to the medical instrument 11 or when the direction of the medical instrument changes, and this changes the gravity of the medical instrument 11 acting on the piston 21 .
  • the target pressure is such a pressure that the frictional force between the cylinder 20 and the piston 21 is made as small as possible relative to the thrust of the piston 21 in order to suppress a stick-slip phenomenon when the piston 21 moves.
  • the target pressure is set in consideration of the durability of the cylinder 20 and the like.
  • the position control portion 53 of the first control portion 51 acquires the position (current position) of the piston 21 from the position detected by the position detector 22 . Then, the position control portion 53 calculates a difference (positional difference) between the target position of the piston 21 and the current position of the piston 21 and calculates a target rotating speed of the first motor 35 , the target rotating speed corresponding to the positional difference. For example, when the positional difference is large, the target rotating speed of the first motor 35 is set to be high in order to increase the rotating speed of the first motor 35 . When the positional difference is zero, the target rotating speed of the first motor 35 is set to zero. With this, the rotating speed of the first motor 35 becomes zero, and the piston 21 is positioned at the target position.
  • the first speed control portion 54 acquires the rotating speed (current rotating speed) of the first motor 35 detected by the first rotating speed sensor 37 . Then, the first speed control portion 54 calculates a difference (speed difference) between the current rotating speed of the first motor 35 and the target rotating speed of the first motor 35 and calculates a target current corresponding to the speed difference. It should be noted that a relation between the speed difference and the target current is determined in advance.
  • the first inverter portion 55 acquires the current (detected current) detected by the first current sensor 59 and calculates a difference (current difference) between the target current and the detected current. Then, the first inverter portion 55 controls the rotation of the first motor 35 such that the current difference is made small.
  • the first motor 35 rotates, and this rotational movement is transmitted to the first piston 32 through the first linear motion mechanism 34 .
  • the first piston 32 moves relative to the first cylinder 31 in accordance with the positional difference.
  • the liquid is supplied from the head-side first pressure chamber 36 to the rod-side pressure chamber 24 .
  • the first piston 32 moves toward the first rod 33 , the liquid is discharged from the rod-side pressure chamber 24 to the head-side first pressure chamber 36 .
  • the first piston 32 moves to the target position, and the medical instrument 11 connected to the first piston 32 is arranged at the arrival position.
  • the pressure control portion 56 of the second control portion 52 acquires the pressure (current pressure) of the rod-side pressure chamber 24 of the cylinder 20 from the pressure detected by the pressure detector 23 . Then, the pressure control portion 56 calculates a difference (pressure difference) between the target pressure of the rod-side pressure chamber 24 and the current pressure of the rod-side pressure chamber 24 and calculates the target rotating speed of the second motor 45 in accordance with the pressure difference.
  • a relation between the pressure difference and the target rotating speed of the second motor 45 is determined in advance. For example, as the pressure difference increases, the target rotating speed of the second motor 45 is set to increase in order to increase the rotating speed of the second motor 45 .
  • the target rotating speed of the second motor 45 is set to zero. With this, the rotating speed of the second motor 45 becomes zero, and the pressure of the rod-side pressure chamber 24 is kept at the target pressure.
  • the second speed control portion 57 acquires the rotating speed (current rotating speed) of the second motor 45 detected by the second rotating speed sensor 47 . Then, the second speed control portion 57 calculates a difference (speed difference) between the current rotating speed of the second motor 45 and the target rotating speed of the second motor 45 and calculates the target current corresponding to the speed difference. It should be noted that a relation between the speed difference and the target current is determined in advance.
  • the second inverter portion 58 acquires the current (detected current) detected by the second current sensor 60 , calculates a difference (current difference) between the target current and the detected current, and controls the rotation of the second motor 45 such that the current difference is made small.
  • the second motor 45 rotates, and this rotational movement is transmitted to the second piston 42 through the second linear motion mechanism 44 .
  • the second piston 42 moves relative to the second cylinder 41 in accordance with the pressure difference.
  • the liquid is supplied from the head-side second pressure chamber 46 to the head-side pressure chamber 25 .
  • the second piston 42 moves toward the second rod 43 , the liquid is discharged from the head-side pressure chamber 25 to the head-side second pressure chamber 46 .
  • the pressure of the head-side pressure chamber 25 is adjusted to the target pressure.
  • the cylinder 20 is controlled by the first actuator 30 and the second actuator 40 .
  • two variables that are the position of the piston 21 relative to the cylinder 20 and the pressure of the pressure chamber of the cylinder 20 can be controlled at the same time.
  • the position of the piston 21 relative to the cylinder 20 is controlled by one of the first actuator 30 and the second actuator 40 , and the pressure of the pressure chamber of the cylinder 20 is controlled by the other of the first actuator 30 and the second actuator 40 .
  • the pressure of the pressure chamber of the cylinder 20 can be adjusted to an arbitrary optimal pressure corresponding to various conditions.
  • F 1 and F 2 are extremely larger than F and F 3 (F, F 3 ⁇ F 1 , F 2 )
  • the position of the piston 21 can be determined with a high degree of accuracy.
  • a hydraulic cylinder is used as the cylinder 20 .
  • a pneumatic cylinder may be used as the cylinder 20 .
  • air or the like is used as an operating fluid in the pneumatic cylinder.
  • the first actuator 30 includes the first cylinder 31 and the like
  • the second actuator 40 includes the second cylinder 41 and the like.
  • the above embodiment is not limited to this as long as the first actuator 30 can adjust the pressure of the liquid of the rod-side pressure chamber 24 of the cylinder 20
  • the second actuator 40 can adjust the pressure of the liquid of the head-side pressure chamber 25 of the cylinder 20 .
  • hydraulic cylinders are used as the first cylinder 31 and the second cylinder 41 .
  • a pneumatic cylinder may be used as one or each of the first cylinder 31 and the second cylinder 41 .
  • air or the like is used as the operating fluid in the pneumatic cylinder.
  • the first actuator 30 is connected to the rod-side pressure chamber 24 of the cylinder 20
  • the second actuator 40 is connected to the head-side pressure chamber 25 of the cylinder 20
  • the first actuator 30 may be connected to the head-side pressure chamber 25 of the cylinder 20
  • the second actuator 40 may be connected to the rod-side pressure chamber 24 of the cylinder 20 .
  • the position of the piston 21 relative to the cylinder 20 is controlled by the first actuator 30
  • the pressure of the head-side pressure chamber 25 of the cylinder 20 is controlled by the second actuator 40
  • the above embodiment is not limited to this.
  • the position of the piston 21 relative to the cylinder 20 may be controlled by the second actuator 40
  • the pressure of the head-side pressure chamber 25 of the cylinder 20 may be controlled by the first actuator 30 .
  • the position control and the pressure control may be switched from one to the other during control.
  • the pressure detector 23 is provided at the first passage 28 , the rod-side pressure chamber 24 , or the head-side first pressure chamber 36 and detects the pressure of the rod-side pressure chamber 24 of the cylinder 20 .
  • the target current of the first motor 35 is calculated from the current rotating speed of the first motor 35 , the current rotating speed being based on the detected value detected by the first rotating speed sensor 37 .
  • the target current of the first motor 35 may be calculated from the movement speed of the piston 21 .
  • the first speed control portion 54 acquires the movement speed (current movement speed) of the piston 21 , the movement speed being obtained by differentiating the detected position detected by the position detector 22 . Then, the first speed control portion 54 calculates a difference (speed difference) between the current movement speed and the target rotating speed supplied from the position control portion 53 and calculates the target current corresponding to the speed difference. A relation between the speed difference and the target current is determined in advance.
  • the second control portion 52 includes the pressure control portion 56 , the second speed control portion 57 , and the second inverter portion 58 . Then, the pressure control portion 56 calculates the target rotating speed of the second motor 45 in accordance with the pressure difference, and the second speed control portion 57 calculates the target current in accordance with the difference between the target rotating speed and the current rotating speed supplied from the second rotating speed sensor 47 .
  • the second control portion 52 may include the pressure control portion 56 and the second inverter portion 58 . In this case, the pressure control portion 56 may calculate the target current of the second motor 45 in accordance with the pressure difference. It should be noted that a relation between the pressure difference and the target current is determined in advance.
  • the pressure detector 23 detects the pressure of the head-side pressure chamber 25 of the cylinder 20 .
  • the pressure detector 23 may detect the pressure of the rod-side pressure chamber 24 of the cylinder 20 .
  • the pressure detector 23 may be provided at the first passage 28 , the rod-side pressure chamber 24 , or the head-side first pressure chamber 36 .
  • the first rotating speed sensor 37 is provided at the first motor 35
  • the second rotating speed sensor 47 is provided at the second motor 45
  • a first position sensor may be provided at the first motor 35 instead of the first rotating speed sensor 37
  • a second position sensor may be provided at the second motor 45 instead of the second rotating speed sensor 47 .
  • the first position sensor detects the position of a rotor of the first motor 35 , stores a rotation amount of the first motor 35 , and outputs the rotation amount to the controller 50
  • the second position sensor detects the position of a rotor of the second motor 45 , stores a rotation amount of the second motor 45 , and outputs the rotation amount to the controller 50 .
  • the first speed control portion 54 of the controller 50 calculates the rotating speed (current rotating speed) of the first motor 35 by differentiating the rotation amount of the first position sensor, and the second speed control portion 57 of the controller 50 calculates the rotating speed (current rotating speed) of the second motor 45 by differentiating the rotation amount of the second position sensor.
  • the actuator device and the control method according to the present invention are useful as, for example, an actuator device and a control method, each of which can perform positioning with a high degree of accuracy.

Abstract

A piston accommodated in an internal space of a cylinder and forming a pair of pressure chambers together with the cylinder, the piston being configured to move relative to the cylinder; a first actuator connected to one pair of pressure chambers; a second actuator connected to the other of the pair of pressure chambers; a position detector configured to detect a position of the piston relative to the cylinder; a pressure detector configured to detect a pressure of one pair of pressure chambers; and a controller configured to control the first actuator and the second actuator. The controller controls one of the first actuator and the second actuator that the position detected by the position detector is made close to a target position and controls the other of the first actuator and the second actuator that the pressure detected by the pressure detector is made close to a target pressure.

Description

TECHNICAL FIELD
The present invention relates to an actuator device including a cylinder and a control method.
BACKGROUND ART
A surgical robot of PTL 1 is known as one example using an actuator device including a cylinder. The surgical robot includes a forceps, and a piston and a cylinder are provided at the forceps so as to open and close an opening/closing portion of the forceps.
Further, for example, a hydraulic device of PTL 2 is known as a device configured to control a pressure of a pressure chamber of the cylinder while positioning the piston. The hydraulic device includes a hydraulic cylinder, a rod, a hydraulic pump connected to the hydraulic cylinder through a channel, and an electric motor configured to drive the hydraulic pump. The electric motor is controlled based on a position of the rod relative to the hydraulic cylinder and a pressure in the channel connected to the cylinder. Then, such position control and pressure control are switched from one to the other.
CITATION LIST Patent Literature
PTL 1: Japanese Laid-Open Patent Application Publication No. 2015-100677
PTL 2: Japanese Laid-Open Patent Application Publication No. 2004-263645
SUMMARY OF INVENTION Technical Problem
Since the cylinder of the surgical robot of PTL 1 is small, frictional force between the piston and the cylinder is large relative to thrust acting on the piston. Therefore, when the piston is moved relative to the cylinder, a stick-slip phenomenon easily occurs by a difference between kinetic friction resistance and static friction resistance which act between the cylinder and the piston. With this, the piston does not move smoothly, and highly-accurate positioning cannot be performed.
In order to improve positioning accuracy, the pressure of the pressure chamber of the cylinder is required to be kept constant. However, according to the hydraulic device of PTL 2, since the position control and the pressure control are performed while being switched from one to the other, it is difficult to keep the pressure of the cylinder constant. Therefore, highly-accurate positioning cannot be maintained.
The present invention was made to solve the above problems, and an object of the present invention is to provide an actuator device and a control method, each of which is capable of performing positioning with a high degree of accuracy.
Solution to Problem
An actuator device according to one aspect of the present invention includes: a cylinder including an internal space; a piston accommodated in the internal space and forming a pair of pressure chambers together with the cylinder, the piston being configured to move relative to the cylinder; a first actuator connected to one of the pair of pressure chambers; a second actuator connected to the other of the pair of pressure chambers; a position detector configured to detect a position of the piston relative to the cylinder; a pressure detector configured to detect a pressure of any one of the pair of pressure chambers; and a controller configured to control the first actuator and the second actuator, wherein: the controller controls one of the first actuator and the second actuator such that the position detected by the position detector is made close to a target position; and the controller controls the other of the first actuator and the second actuator such that the pressure detected by the pressure detector is made close to a target pressure.
According to this configuration, the position of the piston relative to the cylinder can be controlled by one of the first actuator and the second actuator, and at the same time, the pressure in the cylinder partitioned by the piston can be controlled by the other of the first actuator and the second actuator. Therefore, the piston can be positioned with a high degree of accuracy, and the positioning accuracy can be kept high
In this actuator device, the cylinder may be a hydraulic cylinder configured such that pressures of liquids of the pair of pressure chambers are controlled by the respective first and second actuators or a pneumatic cylinder configured such that pressures of gases of the pair of pressure chambers are controlled by the respective first and second actuators.
In the actuator device, each of the first actuator and the second actuator may be a hydraulic cylinder or a pneumatic cylinder.
The actuator device may further include a rod including: a tip end connected to a treating part of a medical instrument; and a base end coupled to the piston. With this, the treating part of the medical instrument which requires high positioning accuracy can be linked with the movement of the piston, and thus, can be positioned with a high degree of accuracy.
A method of controlling an actuator device according to another aspect of the present invention is a method of controlling an actuator device, the actuator device including: a cylinder including an internal space; a piston accommodated in the internal space and forming a pair of pressure chambers together with the cylinder, the piston being configured to move relative to the cylinder; a first actuator connected to one of the pair of pressure chambers; a second actuator connected to the other of the pair of pressure chambers; a position detector configured to detect a position of the piston relative to the cylinder; and a pressure detector configured to detect a pressure of any one of the pair of pressure chambers, the method including: controlling one of the first actuator and the second actuator such that the position detected by the position detector is made close to a target position; and controlling the other of the first actuator and the second actuator such that the pressure detected by the pressure detector is made close to a target pressure.
Advantageous Effects of Invention
The present invention is configured as explained above and has an effect of being able to provide an actuator device and a control method, each of which is capable of performing positioning with a high degree of accuracy.
The above object, other objects, features, and advantages of the present invention will be made clear by the following detailed explanation of preferred embodiments with reference to the attached drawings.
BRIEF DESCRIPTION OF DRAWINGS
FIG. 1 is a block diagram schematically showing the configuration of an actuator device according to an embodiment of the present invention.
DESCRIPTION OF EMBODIMENTS
Hereinafter, embodiments of the present invention will be specifically explained with reference to the drawings. In the following explanations and the drawings, the same reference signs are used for the same or corresponding components, and a repetition of the same explanation is avoided.
Embodiment
First, the configuration of an actuator device 10 according to an embodiment of the present invention will be explained with reference to FIG. 1. The following will explain a case where the actuator device 10 according to the present invention is applied to a medical instrument 11. However, the present embodiment is not limited to the case where the actuator device 10 is applied to the medical instrument 11.
For example, the medical instrument 11 is connected to a manipulator (not shown) of a robot arm. Examples of the medical instrument 11 include a forceps, a cautery, an electric scalpel, and an image pickup apparatus. In the present embodiment, the forceps is adopted. The medical instrument 11 includes the actuator device 10, a movable portion 12, and a treating part 13. An opening/closing portion of the forceps is used as the treating part 13. The movable portion 12 is a link mechanism and converts movements of the actuator device 10 into movements corresponding to the treating part 13. In the present embodiment, the movable portion 12 converts movements of a piston 21 into opening/closing operations of the opening/closing portion that is the treating part 13.
The actuator device 10 includes a cylinder 20, the piston 21, a first actuator 30, a second actuator 40, a position detector 22, a pressure detector 23, and a controller 50. For example, the controller 50 may be connected to an input device (not shown) to which a command is input by manipulation of a user.
The cylinder 20 is a hydraulic cylinder. A liquid, such as oil or a physiological saline solution, is used as an operating fluid. The cylinder 20 is a small cylinder having a small diameter, and the diameter is about 5 mm, for example. The cylinder 20 includes an internal space and is constituted by, for example, a cylindrical side wall portion and end wall portions covering both respective end openings of the side wall portion. The piston 21 is accommodated in the internal space of the cylinder 20.
The piston 21 has, for example, a disc shape and forms a pair of pressure chambers 24 and 25 together with the cylinder 20. A packing 26 is provided at a side end of the piston 21. The packing 26 is made of resin, rubber, and the like and is interposed in a gap between the side end of the piston 21 and the side wall portion of the cylinder 20. With this, the packing 26 seals the gap while realizing a state where the piston 21 can move relative to the cylinder 20.
A rod 27 is, for example, a rod-shaped long member, and a base end of the rod 27 is coupled to the piston 21. The rod 27 passes through the internal space of the cylinder 20 and penetrates the end wall portion of the cylinder 20. The treating part 13 of the medical instrument 11 is connected to a tip end of the rod 27.
The first actuator 30 is connected to the pressure chamber 24 (in the present embodiment, a rod-side pressure chamber) that is one of the pair of pressure chambers 24 and 25 through a first passage 28. The rod-side pressure chamber 24 is a rod 27-side pressure chamber through which the rod 27 passes. The first actuator 30 supplies or discharges a liquid to or from the rod-side pressure chamber 24 through the first passage 28 to adjust a pressure of the liquid in the rod-side pressure chamber 24.
In the present embodiment, the first actuator 30 is a hydraulic cylinder. The first actuator 30 includes a first cylinder 31, a first piston 32, a first rod 33, a first linear motion mechanism 34, and a first motor 35. The first cylinder 31 is a hydraulic cylinder. A head-side pressure chamber (head-side first pressure chamber) 36 of the first cylinder 31 communicates with the rod-side pressure chamber 24 of the cylinder 20 through the first passage 28. The first rod 33 extends from the first piston 32 and is connected to the first motor 35 through the first linear motion mechanism 34. The first motor 35 is, for example, a servo motor that can rotate in both directions. A rotational movement of the first motor 35 is controlled by the controller 50. A first rotating speed sensor 37 configured to detect a rotating speed of the first motor 35 is provided at the first motor 35, and a detected position detected by the first rotating speed sensor 37 is output to the controller 50. The first linear motion mechanism 34 converts the rotational movement of the first motor 35 into a straight movement, and the straight movement is transmitted to the first piston 32 through the first rod 33.
The second actuator 40 is connected to the pressure chamber 25 (in the present embodiment, a head-side pressure chamber) that is the other of the pair of pressure chambers 24 and 25 through a second passage 29. The head-side pressure chamber 25 is a head-side pressure chamber through which the rod 27 does not pass. The second actuator 40 supplies or discharges the liquid to or from the head-side pressure chamber 25 through the second passage 29 to adjust the pressure of the liquid in the head-side pressure chamber 25.
In the present embodiment, the second actuator 40 is a hydraulic cylinder. The second actuator 40 includes a second cylinder 41, a second piston 42, a second rod 43, a second linear motion mechanism 44, and a second motor 45. The second cylinder 41 is a hydraulic cylinder. A head-side pressure chamber (head-side second pressure chamber) 46 of the second cylinder 41 communicates with the head-side pressure chamber 25 of the cylinder 20 through the second passage 29. The second rod 43 extends from the second piston 42 and is connected to the second motor 45 through the second linear motion mechanism 44. The second motor 45 is, for example, a servo motor that can rotate in both directions. A rotational movement of the second motor 45 is controlled by the controller 50. A second rotating speed sensor 47 configured to detect a rotating speed of the second motor 45 is provided at the second motor 45, and a detected position detected by the second rotating speed sensor 47 is output to the controller 50. The second linear motion mechanism 44 converts the rotational movement of the second motor 45 into a straight movement, and the straight movement is transmitted to the second piston 42 through the second rod 43.
The position detector 22 is a sensor configured to detect a position of the piston 21 relative to the cylinder 20. One example of the position detector 22 is a sensor utilizing light or magnetism. The position of the piston 21 is a position in a moving direction of the piston 21, for example, a position in a direction perpendicular to the piston 21 having the disc shape. Further, for example, the position of the piston 21 may be: a value obtained by integrating movement distances from an initial value; or a distance from a reference position of the cylinder 20 to the piston 21. For example, the position detector 22 is provided at the rod 27 and outputs the detected position to the controller 50.
The pressure detector 23 is a sensor configured to detect the pressure of the head-side pressure chamber 25 of the cylinder 20 and outputs the detected pressure to the controller 50. Examples of the pressure detector 23 include a strain gage and a sensor utilizing a piezoelectric effect. In the present embodiment, the pressure detector 23 is provided at the second passage 29. However, the pressure detector 23 may be provided at the head-side pressure chamber 25 or the head-side second pressure chamber 46 of the second cylinder 41.
The controller 50 includes a calculating portion (not shown) and a storage portion (not shown). The controller 50 is, for example, a robot controller including a computer, such as a microcontroller. It should be noted that the controller 50 may be constituted by a single controller which performs centralized control or a plurality of controllers which cooperate to perform distributed control.
Used as the storage portion is a ROM, a RAM, and the like, and the storage portion stores information, such as a basic program for the robot controller and various fixed data. Used as the calculating portion is a CPU or the like. The calculating portion reads and executes software, such as the basic program stored in the storage portion, to control the first and second actuators 30 and 40 of the actuator device 10.
The controller 50 includes a first control portion 51 and a second control portion 52. The first control portion 51 includes a position control portion 53, a first speed control portion 54, and a first inverter portion 55. The second control portion 52 includes a pressure control portion 56, a second speed control portion 57, and a second inverter portion 58. The first inverter portion 55 is connected to the first motor 35 through a first wire, and a first current sensor 59 is provided at the first wire. The second inverter portion 58 is connected to the second motor 45 through a second wire, and a second current sensor 60 is provided at the second wire.
For example, the first control portion 51 controls one of the first actuator 30 and the second actuator 40 (in the present embodiment, the first actuator 30) such that the position detected by the position detector 22 is made close to a target position. The second control portion 52 controls the other of the first actuator 30 and the second actuator 40 (in the present embodiment, the second actuator 40) such that the pressure detected by the pressure detector 23 is made close to a target pressure.
Next, an operation (control method) of the actuator device 10 will be explained with reference to FIG. 1. This operation is controlled by the controller 50. For example, by manipulation of the input device by the user, the target position is input to the first control portion 51, and the target pressure is input to the second control portion 52.
The target position is such a position of the piston 21 that the medical instrument 11 is arranged at an arrival position. The target pressure may be a pressure that changes depending on various conditions or may be a constant pressure that does not change. For example, the target pressure is such a pressure that the position of the piston 21 can be maintained so as not to be changed when external force is applied to the medical instrument 11 or when the direction of the medical instrument changes, and this changes the gravity of the medical instrument 11 acting on the piston 21. Further, the target pressure is such a pressure that the frictional force between the cylinder 20 and the piston 21 is made as small as possible relative to the thrust of the piston 21 in order to suppress a stick-slip phenomenon when the piston 21 moves. At this time, the target pressure is set in consideration of the durability of the cylinder 20 and the like.
The position control portion 53 of the first control portion 51 acquires the position (current position) of the piston 21 from the position detected by the position detector 22. Then, the position control portion 53 calculates a difference (positional difference) between the target position of the piston 21 and the current position of the piston 21 and calculates a target rotating speed of the first motor 35, the target rotating speed corresponding to the positional difference. For example, when the positional difference is large, the target rotating speed of the first motor 35 is set to be high in order to increase the rotating speed of the first motor 35. When the positional difference is zero, the target rotating speed of the first motor 35 is set to zero. With this, the rotating speed of the first motor 35 becomes zero, and the piston 21 is positioned at the target position.
The first speed control portion 54 acquires the rotating speed (current rotating speed) of the first motor 35 detected by the first rotating speed sensor 37. Then, the first speed control portion 54 calculates a difference (speed difference) between the current rotating speed of the first motor 35 and the target rotating speed of the first motor 35 and calculates a target current corresponding to the speed difference. It should be noted that a relation between the speed difference and the target current is determined in advance.
The first inverter portion 55 acquires the current (detected current) detected by the first current sensor 59 and calculates a difference (current difference) between the target current and the detected current. Then, the first inverter portion 55 controls the rotation of the first motor 35 such that the current difference is made small.
With this, the first motor 35 rotates, and this rotational movement is transmitted to the first piston 32 through the first linear motion mechanism 34. The first piston 32 moves relative to the first cylinder 31 in accordance with the positional difference. When the first piston 32 moves to the head side, the liquid is supplied from the head-side first pressure chamber 36 to the rod-side pressure chamber 24.
In contrast, when the first piston 32 moves toward the first rod 33, the liquid is discharged from the rod-side pressure chamber 24 to the head-side first pressure chamber 36. By the thrust corresponding to a differential pressure between the rod-side pressure chamber 24 and the head-side pressure chamber 25 by the supply or discharge of the liquid, the first piston 32 moves to the target position, and the medical instrument 11 connected to the first piston 32 is arranged at the arrival position.
On the other hand, the pressure control portion 56 of the second control portion 52 acquires the pressure (current pressure) of the rod-side pressure chamber 24 of the cylinder 20 from the pressure detected by the pressure detector 23. Then, the pressure control portion 56 calculates a difference (pressure difference) between the target pressure of the rod-side pressure chamber 24 and the current pressure of the rod-side pressure chamber 24 and calculates the target rotating speed of the second motor 45 in accordance with the pressure difference. A relation between the pressure difference and the target rotating speed of the second motor 45 is determined in advance. For example, as the pressure difference increases, the target rotating speed of the second motor 45 is set to increase in order to increase the rotating speed of the second motor 45. When the pressure difference is zero, the target rotating speed of the second motor 45 is set to zero. With this, the rotating speed of the second motor 45 becomes zero, and the pressure of the rod-side pressure chamber 24 is kept at the target pressure.
The second speed control portion 57 acquires the rotating speed (current rotating speed) of the second motor 45 detected by the second rotating speed sensor 47. Then, the second speed control portion 57 calculates a difference (speed difference) between the current rotating speed of the second motor 45 and the target rotating speed of the second motor 45 and calculates the target current corresponding to the speed difference. It should be noted that a relation between the speed difference and the target current is determined in advance.
The second inverter portion 58 acquires the current (detected current) detected by the second current sensor 60, calculates a difference (current difference) between the target current and the detected current, and controls the rotation of the second motor 45 such that the current difference is made small.
With this, the second motor 45 rotates, and this rotational movement is transmitted to the second piston 42 through the second linear motion mechanism 44. The second piston 42 moves relative to the second cylinder 41 in accordance with the pressure difference. With this, when the second piston 42 moves to the head side, the liquid is supplied from the head-side second pressure chamber 46 to the head-side pressure chamber 25. In contrast, when the second piston 42 moves toward the second rod 43, the liquid is discharged from the head-side pressure chamber 25 to the head-side second pressure chamber 46. By the supply or discharge of the liquid, the pressure of the head-side pressure chamber 25 is adjusted to the target pressure.
As above, the cylinder 20 is controlled by the first actuator 30 and the second actuator 40. With this, two variables that are the position of the piston 21 relative to the cylinder 20 and the pressure of the pressure chamber of the cylinder 20 can be controlled at the same time.
The position of the piston 21 relative to the cylinder 20 is controlled by one of the first actuator 30 and the second actuator 40, and the pressure of the pressure chamber of the cylinder 20 is controlled by the other of the first actuator 30 and the second actuator 40. With this, while moving the piston 21 to the target position, the pressure of the pressure chamber of the cylinder 20 can be adjusted to an arbitrary optimal pressure corresponding to various conditions.
Thrust F of the piston 21 is determined based on force F1 applied from the liquid of the rod-side pressure chamber 24, force F2 applied from the liquid of the head-side pressure chamber 25, and other force F3. The force F1 of the rod-side pressure chamber 24 is calculated by a product of the pressure acting on the piston 21 from the liquid of the rod-side pressure chamber 24 and the area of the piston 21 on which the liquid of the rod-side pressure chamber 24 acts. The force F2 of the head-side pressure chamber 25 is calculated by a product of the pressure acting on the piston 21 from the liquid of the head-side pressure chamber 25 and the area of the piston 21 on which the liquid of the head-side pressure chamber 25 acts. One example of the other force F3 is the frictional force between the piston 21 and the cylinder 20.
The thrust F of the piston 21 is represented by “F=|F1−F2|−F3.” When F1 and F2 are extremely larger than F and F3 (F, F3<<F1, F2), the position of the piston 21 can be determined with a high degree of accuracy.
When the pressure of the rod-side pressure chamber 24 is adjusted such that the frictional force between the cylinder 20 and the piston 21 becomes small relative to the thrust of the piston 21, the stick-slip phenomenon can be suppressed, and the piston 21 can be positioned with a high degree of accuracy.
Other Embodiments
In the above embodiment, a hydraulic cylinder is used as the cylinder 20. Instead, a pneumatic cylinder may be used as the cylinder 20. In this case, air or the like is used as an operating fluid in the pneumatic cylinder.
In the above embodiment, the first actuator 30 includes the first cylinder 31 and the like, and the second actuator 40 includes the second cylinder 41 and the like. However, the above embodiment is not limited to this as long as the first actuator 30 can adjust the pressure of the liquid of the rod-side pressure chamber 24 of the cylinder 20, and the second actuator 40 can adjust the pressure of the liquid of the head-side pressure chamber 25 of the cylinder 20.
In the above embodiment, hydraulic cylinders are used as the first cylinder 31 and the second cylinder 41. Instead, a pneumatic cylinder may be used as one or each of the first cylinder 31 and the second cylinder 41. In this case, air or the like is used as the operating fluid in the pneumatic cylinder.
In the above embodiment, the first actuator 30 is connected to the rod-side pressure chamber 24 of the cylinder 20, and the second actuator 40 is connected to the head-side pressure chamber 25 of the cylinder 20. However, the above embodiment is not limited to this. The first actuator 30 may be connected to the head-side pressure chamber 25 of the cylinder 20, and the second actuator 40 may be connected to the rod-side pressure chamber 24 of the cylinder 20.
In the above embodiment, the position of the piston 21 relative to the cylinder 20 is controlled by the first actuator 30, and the pressure of the head-side pressure chamber 25 of the cylinder 20 is controlled by the second actuator 40. However, the above embodiment is not limited to this. The position of the piston 21 relative to the cylinder 20 may be controlled by the second actuator 40, and the pressure of the head-side pressure chamber 25 of the cylinder 20 may be controlled by the first actuator 30. Further, the position control and the pressure control may be switched from one to the other during control. In this case, the pressure detector 23 is provided at the first passage 28, the rod-side pressure chamber 24, or the head-side first pressure chamber 36 and detects the pressure of the rod-side pressure chamber 24 of the cylinder 20.
In the above embodiment, the target current of the first motor 35 is calculated from the current rotating speed of the first motor 35, the current rotating speed being based on the detected value detected by the first rotating speed sensor 37. However, the above embodiment is not limited to this. The target current of the first motor 35 may be calculated from the movement speed of the piston 21.
In this case, for example, the first speed control portion 54 acquires the movement speed (current movement speed) of the piston 21, the movement speed being obtained by differentiating the detected position detected by the position detector 22. Then, the first speed control portion 54 calculates a difference (speed difference) between the current movement speed and the target rotating speed supplied from the position control portion 53 and calculates the target current corresponding to the speed difference. A relation between the speed difference and the target current is determined in advance.
In the above embodiment, the second control portion 52 includes the pressure control portion 56, the second speed control portion 57, and the second inverter portion 58. Then, the pressure control portion 56 calculates the target rotating speed of the second motor 45 in accordance with the pressure difference, and the second speed control portion 57 calculates the target current in accordance with the difference between the target rotating speed and the current rotating speed supplied from the second rotating speed sensor 47. Instead, the second control portion 52 may include the pressure control portion 56 and the second inverter portion 58. In this case, the pressure control portion 56 may calculate the target current of the second motor 45 in accordance with the pressure difference. It should be noted that a relation between the pressure difference and the target current is determined in advance.
In the above embodiment, the actuator device 10 may further include a correcting portion, and the correcting portion may be included in the controller 50. For example, when the target position and the target pressure are input from the input device, the correcting portion may correct the target position in accordance with conditions, such as a current position, a load condition, an individual difference, and ambient surroundings. With this, the piston 21 can be positioned at the target position with a higher degree of accuracy in accordance with the conditions.
In the above embodiment, the pressure detector 23 detects the pressure of the head-side pressure chamber 25 of the cylinder 20. However, the pressure detector 23 may detect the pressure of the rod-side pressure chamber 24 of the cylinder 20. In this case, the pressure detector 23 may be provided at the first passage 28, the rod-side pressure chamber 24, or the head-side first pressure chamber 36.
In the above embodiment, the first rotating speed sensor 37 is provided at the first motor 35, and the second rotating speed sensor 47 is provided at the second motor 45. However, a first position sensor may be provided at the first motor 35 instead of the first rotating speed sensor 37, and a second position sensor may be provided at the second motor 45 instead of the second rotating speed sensor 47. In this case, the first position sensor detects the position of a rotor of the first motor 35, stores a rotation amount of the first motor 35, and outputs the rotation amount to the controller 50. The second position sensor detects the position of a rotor of the second motor 45, stores a rotation amount of the second motor 45, and outputs the rotation amount to the controller 50. The first speed control portion 54 of the controller 50 calculates the rotating speed (current rotating speed) of the first motor 35 by differentiating the rotation amount of the first position sensor, and the second speed control portion 57 of the controller 50 calculates the rotating speed (current rotating speed) of the second motor 45 by differentiating the rotation amount of the second position sensor.
The above embodiments may be combined with one another as long as they do not exclude each other.
From the foregoing explanation, many modifications and other embodiments of the present invention are obvious to one skilled in the art. Therefore, the foregoing explanation should be interpreted only as an example and is provided for the purpose of teaching the best mode for carrying out the present invention to one skilled in the art. The structures and/or functional details may be substantially modified within the scope of the present invention.
INDUSTRIAL APPLICABILITY
The actuator device and the control method according to the present invention are useful as, for example, an actuator device and a control method, each of which can perform positioning with a high degree of accuracy.
REFERENCE SIGNS LIST
    • 10 actuator device
    • 12 medical instrument
    • 20 cylinder
    • 21 piston
    • 22 position detector
    • 23 pressure detector
    • 24 rod-side pressure chamber (pressure chamber)
    • 25 head-side pressure chamber (pressure chamber)
    • 27 rod
    • 30 first actuator
    • 40 second actuator
    • 50 controller

Claims (4)

The invention claimed is:
1. An actuator device comprising:
a cylinder including an internal space;
a piston accommodated in the internal space and forming a pair of pressure chambers together with the cylinder, the piston being configured to move relative to the cylinder;
a first actuator connected to one of the pair of pressure chambers and including a first fluid cylinder, a first electric motor, and a first linear motion mechanism;
a second actuator connected to the other of the pair of pressure chambers and including a second fluid cylinder, a second electric motor, and a second linear motion mechanism;
a position detector configured to detect a position of the piston relative to the cylinder;
a pressure detector configured to detect a pressure of any one of the pair of pressure chambers; and
a controller configured to control the first actuator and the second actuator, wherein:
the controller controls the first actuator such that the position detected by the position detector is made close to a target position;
the controller controls the second actuator such that the pressure detected by the pressure detector is made close to a target pressure;
when controlling the first actuator, the controller calculates a target rotating speed of the first electric motor based on the target position and the position of the piston detected by the position detector; and
the controller controls rotation of the first electric motor based on the target rotating speed and a current movement speed of the piston corresponding to the position of the piston detected by the position detector.
2. The actuator device according to claim 1, wherein the cylinder is (i) a hydraulic cylinder configured such that pressures of liquids of the pair of pressure chambers are controlled by the respective first and second actuators or (ii) a cylinder configured such that pressures of gases of the pair of pressure chambers are controlled by the respective first and second actuators.
3. The actuator device according to claim 1, further comprising a rod including: a tip end connected to a treating part of a medical instrument; and a base end coupled to the piston.
4. A method of controlling an actuator device,
the actuator device comprising:
a cylinder including an internal space;
a piston accommodated in the internal space and forming a pair of pressure chambers together with the cylinder, the piston being configured to move relative to the cylinder;
a first actuator connected to one of the pair of pressure chambers and including a first fluid cylinder, a first electric motor, and a first linear motion mechanism;
a second actuator connected to the other of the pair of pressure chambers and including a second fluid cylinder, a second electric motor, and a second linear motion mechanism;
a position detector configured to detect a position of the piston relative to the cylinder; and
a pressure detector configured to detect a pressure of any one of the pair of pressure chambers,
the method comprising:
controlling the first actuator such that the position detected by the position detector is made close to a target position;
controlling the second actuator such that the pressure detected by the pressure detector is made close to a target pressure;
when controlling the first actuator, calculating a target rotating speed of the first electric motor based on the target position and the position of the piston detected by the position detector; and
controlling rotation of the first electric motor based on the target rotating speed and a current movement speed of the piston corresponding to the position of the piston detected by the position detector.
US16/099,903 2016-05-11 2017-05-09 Actuator device and control method Active US10814499B2 (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2016095509A JP6511010B2 (en) 2016-05-11 2016-05-11 Actuator device and control method
JP2016-095509 2016-05-11
PCT/JP2017/017575 WO2017195786A1 (en) 2016-05-11 2017-05-09 Actuator device and control method

Publications (2)

Publication Number Publication Date
US20190143540A1 US20190143540A1 (en) 2019-05-16
US10814499B2 true US10814499B2 (en) 2020-10-27

Family

ID=60267881

Family Applications (1)

Application Number Title Priority Date Filing Date
US16/099,903 Active US10814499B2 (en) 2016-05-11 2017-05-09 Actuator device and control method

Country Status (4)

Country Link
US (1) US10814499B2 (en)
JP (1) JP6511010B2 (en)
TW (1) TWI640302B (en)
WO (1) WO2017195786A1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6839874B1 (en) * 2020-02-12 2021-03-10 リバーフィールド株式会社 Surgical robot
JP7401373B2 (en) 2020-03-26 2023-12-19 住友重機械工業株式会社 Control device

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5791231A (en) * 1993-05-17 1998-08-11 Endorobotics Corporation Surgical robotic system and hydraulic actuator therefor
JPH11270503A (en) 1998-03-23 1999-10-05 Toshiba Mach Co Ltd Fluid pressure device
JP2001214903A (en) * 2000-02-02 2001-08-10 Kayaba Ind Co Ltd Hydraulic drive unit
US20040182231A1 (en) 2003-03-20 2004-09-23 Smc Corporation High-speed driving method and system of pressure cylinder
JP2004263645A (en) 2003-03-03 2004-09-24 Opton Co Ltd Hydraulic device
JP2008298226A (en) 2007-06-01 2008-12-11 Yuken Kogyo Co Ltd Hydraulic driven device
JP2015100677A (en) 2013-11-28 2015-06-04 国立大学法人東京工業大学 Surgical robot

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3481277B2 (en) * 1993-11-05 2003-12-22 株式会社トキメック Electric-hydraulic transmission device
JPH10169602A (en) * 1996-12-11 1998-06-23 Opton Co Ltd Liquid pressure driving gear
JP2001090704A (en) * 1999-09-21 2001-04-03 Tokimec Inc Driving gear
JP2002089503A (en) * 2000-09-18 2002-03-27 Koganei Corp Actuator
JP5628134B2 (en) * 2011-11-07 2014-11-19 住友重機械工業株式会社 Hydraulic closed circuit system

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5791231A (en) * 1993-05-17 1998-08-11 Endorobotics Corporation Surgical robotic system and hydraulic actuator therefor
JPH11270503A (en) 1998-03-23 1999-10-05 Toshiba Mach Co Ltd Fluid pressure device
JP2001214903A (en) * 2000-02-02 2001-08-10 Kayaba Ind Co Ltd Hydraulic drive unit
JP2004263645A (en) 2003-03-03 2004-09-24 Opton Co Ltd Hydraulic device
US20050200195A1 (en) 2003-03-03 2005-09-15 Teruaki Yogo Hydraulic device
US20040182231A1 (en) 2003-03-20 2004-09-23 Smc Corporation High-speed driving method and system of pressure cylinder
JP2004286122A (en) 2003-03-20 2004-10-14 Smc Corp High-speed driving method for pressure cylinder and its system
JP2008298226A (en) 2007-06-01 2008-12-11 Yuken Kogyo Co Ltd Hydraulic driven device
JP2015100677A (en) 2013-11-28 2015-06-04 国立大学法人東京工業大学 Surgical robot

Also Published As

Publication number Publication date
TWI640302B (en) 2018-11-11
US20190143540A1 (en) 2019-05-16
JP2017203504A (en) 2017-11-16
TW201740887A (en) 2017-12-01
WO2017195786A1 (en) 2017-11-16
JP6511010B2 (en) 2019-05-08

Similar Documents

Publication Publication Date Title
Saravanakumar et al. A review on recent research trends in servo pneumatic positioning systems
JP6201126B2 (en) Master-slave system
US7445260B2 (en) Gripping type hand
WO2018123753A1 (en) Hydraulic forceps system
US8253367B2 (en) Control apparatus, control method, and control program for elastic actuator drive mechanism
US10603798B2 (en) Robot
US10814499B2 (en) Actuator device and control method
Gandarias et al. Open-loop position control in collaborative, modular variable-stiffness-link (VSL) robots
Oliveira et al. Design and experiments on an inflatable link robot with a built-in vision sensor
Krichel et al. Tracking control of a pneumatic muscle actuator using one servovalve
Saków et al. Self-sensing teleoperation system based on 1-dof pneumatic manipulator
JP3329443B2 (en) Parallel link type haptic input / output device
Saków et al. Sensorless control scheme for teleoperation with force-feedback, based on a hydraulic servo-mechanism, theory and experiment
WO2013136583A1 (en) Operation-control device for insertion apparatus
US10675047B2 (en) Forceps system
TWM461525U (en) Driving device of humanoid robotic arm
Iwai et al. Pneumatically driven surgical forceps displaying a magnified grasping torque
JP6632507B2 (en) Link mechanism control device, manipulator, and link mechanism control method
KR102243052B1 (en) Method for assisting at least one movement of a user and apparatus corresponding thereto
Liu et al. Impact of generic tendon routing on tension loss of tendon-driven continuum manipulators with planar deformation
Orekhov et al. Towards collaborative robots with sensory awareness: preliminary results using multi-modal sensing
Kelageri et al. Design, fabrication and control of an hydraulic elastomer actuator
US10801527B2 (en) Driving apparatus
Negi Design and Development of Mechatronic Systems for Micro/Nano Manipulation
Mintenbeck et al. EndoSnake—A Single-Arm-Multi-Port MIRS System with Flexible Instruments

Legal Events

Date Code Title Description
AS Assignment

Owner name: KAWASAKI JUKOGYO KABUSHIKI KAISHA, JAPAN

Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:TANAKA, HIDEKI;WATANABE, HIDEKI;OGATA, MARIKO;AND OTHERS;SIGNING DATES FROM 20181101 TO 20181105;REEL/FRAME:047454/0422

FEPP Fee payment procedure

Free format text: ENTITY STATUS SET TO UNDISCOUNTED (ORIGINAL EVENT CODE: BIG.); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

STPP Information on status: patent application and granting procedure in general

Free format text: DOCKETED NEW CASE - READY FOR EXAMINATION

STPP Information on status: patent application and granting procedure in general

Free format text: NON FINAL ACTION MAILED

STPP Information on status: patent application and granting procedure in general

Free format text: RESPONSE TO NON-FINAL OFFICE ACTION ENTERED AND FORWARDED TO EXAMINER

STPP Information on status: patent application and granting procedure in general

Free format text: FINAL REJECTION MAILED

STPP Information on status: patent application and granting procedure in general

Free format text: NOTICE OF ALLOWANCE MAILED -- APPLICATION RECEIVED IN OFFICE OF PUBLICATIONS

STCF Information on status: patent grant

Free format text: PATENTED CASE