CN110087575B - 液压钳子系统 - Google Patents
液压钳子系统 Download PDFInfo
- Publication number
- CN110087575B CN110087575B CN201780080837.3A CN201780080837A CN110087575B CN 110087575 B CN110087575 B CN 110087575B CN 201780080837 A CN201780080837 A CN 201780080837A CN 110087575 B CN110087575 B CN 110087575B
- Authority
- CN
- China
- Prior art keywords
- piston
- pressure
- working fluid
- estimated
- pressure chamber
- 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.)
- Expired - Fee Related
Links
- 239000012530 fluid Substances 0.000 claims abstract description 38
- 238000006073 displacement reaction Methods 0.000 claims description 10
- 238000009795 derivation Methods 0.000 claims description 2
- 238000003780 insertion Methods 0.000 description 13
- 230000037431 insertion Effects 0.000 description 13
- 239000011159 matrix material Substances 0.000 description 8
- 238000010586 diagram Methods 0.000 description 3
- 238000010899 nucleation Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000000149 penetrating effect Effects 0.000 description 2
- FAPWRFPIFSIZLT-UHFFFAOYSA-M Sodium chloride Chemical compound [Na+].[Cl-] FAPWRFPIFSIZLT-UHFFFAOYSA-M 0.000 description 1
- 210000000078 claw Anatomy 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 239000011347 resin Substances 0.000 description 1
- 229920005989 resin Polymers 0.000 description 1
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B15/00—Fluid-actuated devices for displacing a member from one position to another; Gearing associated therewith
- F15B15/02—Mechanical layout characterised by the means for converting the movement of the fluid-actuated element into movement of the finally-operated member
- F15B15/04—Mechanical layout characterised by the means for converting the movement of the fluid-actuated element into movement of the finally-operated member with oscillating cylinder
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B7/00—Systems in which the movement produced is definitely related to the output of a volumetric pump; Telemotors
- F15B7/06—Details
- F15B7/08—Input units; Master units
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/28—Surgical forceps
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/28—Surgical forceps
- A61B17/29—Forceps for use in minimally invasive surgery
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
- A61B34/35—Surgical robots for telesurgery
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
- A61B34/37—Master-slave robots
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J15/00—Gripping heads and other end effectors
- B25J15/02—Gripping heads and other end effectors servo-actuated
- B25J15/0206—Gripping heads and other end effectors servo-actuated comprising articulated grippers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/14—Programme-controlled manipulators characterised by positioning means for manipulator elements fluid
- B25J9/144—Linear actuators
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B15/00—Fluid-actuated devices for displacing a member from one position to another; Gearing associated therewith
- F15B15/20—Other details, e.g. assembly with regulating devices
- F15B15/28—Means for indicating the position, e.g. end of stroke
- F15B15/2815—Position sensing, i.e. means for continuous measurement of position, e.g. LVDT
- F15B15/2838—Position sensing, i.e. means for continuous measurement of position, e.g. LVDT with out using position sensors, e.g. by volume flow measurement or pump speed
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B2017/00535—Surgical instruments, devices or methods, e.g. tourniquets pneumatically or hydraulically operated
- A61B2017/00539—Surgical instruments, devices or methods, e.g. tourniquets pneumatically or hydraulically operated hydraulically
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/20—Fluid pressure source, e.g. accumulator or variable axial piston pump
- F15B2211/205—Systems with pumps
- F15B2211/20507—Type of prime mover
- F15B2211/20515—Electric motor
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/60—Circuit components or control therefor
- F15B2211/63—Electronic controllers
- F15B2211/6303—Electronic controllers using input signals
- F15B2211/633—Electronic controllers using input signals representing a state of the prime mover, e.g. torque or rotational speed
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/60—Circuit components or control therefor
- F15B2211/665—Methods of control using electronic components
- F15B2211/6651—Control of the prime mover, e.g. control of the output torque or rotational speed
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/70—Output members, e.g. hydraulic motors or cylinders or control therefor
- F15B2211/705—Output members, e.g. hydraulic motors or cylinders or control therefor characterised by the type of output members or actuators
- F15B2211/7051—Linear output members
- F15B2211/7052—Single-acting output members
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/70—Output members, e.g. hydraulic motors or cylinders or control therefor
- F15B2211/765—Control of position or angle of the output member
- F15B2211/7653—Control of position or angle of the output member at distinct positions, e.g. at the end position
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2215/00—Fluid-actuated devices for displacing a member from one position to another
- F15B2215/30—Constructional details thereof
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Surgery (AREA)
- Life Sciences & Earth Sciences (AREA)
- Robotics (AREA)
- Biomedical Technology (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)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Fluid Mechanics (AREA)
- General Engineering & Computer Science (AREA)
- Ophthalmology & Optometry (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Manipulator (AREA)
- Surgical Instruments (AREA)
- Actuator (AREA)
Abstract
液压钳子系统具备:机器人钳子,包括:夹钳、与夹钳连结的第一活塞、与第一活塞共同形成充满工作液的第一压力室的第一缸、与第二活塞共同形成充满工作液的第二压力室的第二缸、连通第一压力室和第二压力室的连通路、及通过直动机构驱动第二活塞的马达;基于对第一活塞的指令位置来控制马达的控制装置;以及用于检测第二活塞的位置的位置传感器;控制装置包括:基于用位置传感器检测的第二活塞的位置来导出第一活塞的推定位置的观测器;以及基于第一活塞的推定位置与指令位置的偏差来导出马达的目标旋转速度的位置控制部。
Description
技术领域
本发明涉及包括利用液压进行夹钳开闭的机器人钳子在内的液压钳子系统。
背景技术
一直以来,手术支援机器人中,使用通过导线的拉伸及拉回来进行夹钳开闭的导线驱动式机器人钳子。近年,也提出代替导线驱动式机器人钳子而利用空气压进行夹钳开闭的机器人钳子。例如,专利文献1的图9中记载有用于这样的机器人钳子的空气压执行器。图4中示出该空气压执行器100。
具体而言,空气压执行器100中,缸140内容纳有活塞130,该活塞130通过杆120与夹钳110连结。在缸140设置有检测活塞130的移动量的位移传感器150。位移传感器150用于外力F的计算。
现有技术文献:
专利文献:
专利文献1:日本特开2013-220273公报。
发明内容
发明要解决的问题:
而在图4所示的空气压执行器100中,位移传感器150还可为了控制夹钳(gripper)110的开闭而用作检测活塞130的位置的位置传感器。但由于机器人钳子的梢端部非常细,所以将这样的位置传感器(位移传感器150)设置于机器人钳子的梢端部较为困难。
因此,本发明目的在于不在机器人钳子的梢端部设置位置传感器即能控制夹钳的开闭。
解决问题的手段:
为了解决前述问题,本发明提供一种液压钳子系统,具备:机器人钳子,包括:夹钳、与所述夹钳连结的第一活塞、容纳所述第一活塞并与所述第一活塞共同形成充满工作液的第一压力室的第一缸、第二活塞、容纳所述第二活塞并与所述第二活塞共同形成充满所述工作液的第二压力室的第二缸、连通所述第一压力室和所述第二压力室的连通路、及通过直动机构来驱动所述第二活塞的马达;用于检测所述第二活塞的位置的位置传感器;以及基于对所述第一活塞的指令位置来控制所述马达的控制装置;所述控制装置包括:基于利用所述位置传感器检测的所述第二活塞的位置来导出所述第一活塞的推定位置的观测器;以及基于所述第一活塞的推定位置与所述指令位置的偏差来导出所述马达的目标旋转速度的位置控制部。
根据上述结构,使用非压缩性的工作液,从而与夹钳连结的第一活塞,换言之处于机器人钳子梢端侧的第一活塞的移动量几乎不受外力影响而与第二活塞的移动量成比例。而且,第二活塞通过直动机构由马达驱动。因而,若控制装置基于对第一活塞的指令位置来控制马达,则能控制夹钳的开闭。此外,控制装置包括基于第二活塞的位置来导出第一活塞的推定位置的观测器,该第一活塞的推定位置与指令位置进行比较,从而无需设置检测第一活塞的位置的位置传感器。即,无需在机器人钳子的梢端部设置位置传感器即能控制夹钳的开闭。
例如也可以是,所述位置传感器是检测所述马达的旋转位移量,将该旋转位移量转换为所述第二活塞的位置的旋转编码器。
也可以是,上述的液压钳子系统还具备检测所述工作液的压力的压力传感器;所述观测器基于由所述压力传感器检测的所述工作液的压力及用所述位置传感器检测的所述第二活塞的位置来导出所述第一活塞的推定位置。根据该结构,相比于仅基于第二活塞的位置来导出第一活塞的推定位置的情况,能提高第一活塞的位置的推定精度。
例如也可以是,所述观测器导出所述第二活塞的推定位置及所述工作液的推定压力,基于由所述压力传感器检测的所述工作液的压力与所述工作液的推定压力的偏差、及用所述位置传感器检测的所述第二活塞的位置与所述第二活塞的推定位置的偏差来算出推定误差,将算出的推定误差反馈至所述第一活塞的推定位置的导出。
发明效果:
根据本发明,无需在机器人钳子的梢端设置位置传感器即能控制夹钳的开闭。
附图说明
图1是根据本发明的一实施形态的液压钳子系统的概略结构图;
图2是观测器的框线图;
图3是表示状态变量的矩阵;
图4是用于机器人钳子的以往的空气压执行器的概略结构图。
具体实施方式
图1示出根据本发明的一实施形态的液压钳子系统1。该液压钳子系统1包括机器人钳子2和控制装置7。
例如,液压钳子系统1用于手术支援机器人时,医生用主动侧装置来远程操作安装在从动侧装置上的机器人钳子2。这种情况下,控制装置7可以装载于主动侧装置,也可以装载于从动侧装置。或者控制装置7也可以组装在机器人钳子2的后述的驱动单元21中。
机器人钳子2利用工作液20的液压进行夹钳24的开闭。工作液20未特别限定,例如为生理盐水、油等。
具体而言,机器人钳子2包括驱动单元21、从驱动单元21延伸并插入患者体内的插入轴22、和设置于插入轴22的梢端的由一对爪25构成的夹钳24。另,虽省略图示,但也可以是驱动单元21中组装有使插入轴22在其轴向滑动的机构及使插入轴22绕其中心轴旋转的机构。此外也可以是,插入轴22的梢端部可揺动地构成,使其梢端部揺动的机构组装于驱动单元21。
本实施形态中,插入轴22为直线状延伸的高刚性的管。但插入轴22也可以是柔软的管。
插入轴22的梢端部内配置有第一缸31。本实施形态中,第一缸31的中心轴与插入轴22的中心轴一致。第一缸31具有管状部、从夹钳24侧闭塞管状部内部的前壁、从夹钳24相反侧闭塞管状部内部的后壁。
第一缸31内容纳有第一活塞32。第一活塞32与第一缸31的后壁之间形成有第一压力室3A,第一活塞32与第一缸31的前壁之间形成有背压室3B。第一压力室3A内充满工作液20,背压室3B内对大气中开放。本实施形态中,背压室3B内配置有对第一活塞32施力的弹簧34。
第一活塞32通过贯通第一缸31前壁的杆33经由连杆机构23与夹钳24连结。连杆机构23将杆33的直线运动转换为夹钳24的开闭运动。
驱动单元21内配置有通过连通路26与第一缸31连接的第二缸41。本实施形态中,第二缸41的轴向与插入轴22的轴向平行。但第二缸41的轴向未特别限定。第二缸41具有管状部、从插入轴22侧闭塞管状部内部的前壁、从插入轴22相反侧闭塞管状部内部的后壁。
第二缸41内容纳有第二活塞42。第二活塞42与第二缸41的前壁之间形成有第二压力室4A,第二活塞42与第二缸41的后壁之间形成有背压室4B。第二压力室4A内充满工作液20,背压室4B内对大气中开放。
上述的连通路26在插入轴22内延伸,连通第一压力室3A和第二压力室4A。该连通路26内也充满工作液20。例如,连通路26由金属制的管或树脂制的柔软的软管构成。
第二活塞42通过贯通第二缸41后壁的杆43与直动机构51连结。直动机构51也与马达52的输出轴53连结。直动机构51将马达52的输出轴53的旋转运动转换为杆43的直线运动。即,马达52经由直动机构51及杆43来驱动第二活塞42。马达52例如为伺服马达。
若第二活塞42因马达52向一方向的旋转而前进,则工作液20从第二压力室4A向第一压力室3A供给且第一活塞32对抗弹簧34的施加力地前进。另一方面,若第二活塞42因马达52的逆向旋转而后退,则第一活塞32因弹簧34的施加力而后退且工作液20从第一压力室3A向第二压力室4A排出。即,第二缸41、第二活塞42、直动机构51及马达52构成对第一压力室3A的工作液给排机构。
例如从上述的主动侧装置向控制装置7输入对第一活塞32的指令位置tx1。但也可以是,向控制装置7输入对夹钳24的开度指令,控制装置7包括根据该开度指令算出对第一活塞32的指令位置tx1的指令位置算出部。
控制装置7基于对第一活塞32的指令位置tx1来控制马达52。控制装置7例如由ROM、RAM等存储器和CPU构成,储存于ROM的程序由CPU执行。具体而言,控制装置7包括位置控制部71、速度控制部72、逆变(inverter)部73、微分部75及观测器8。控制装置7可以是单一的设备,也可以分为多个设备。
本实施形态中,控制装置7与压力传感器61及位置传感器62电气连接。压力传感器61检测工作液20的压力P,位置传感器62用于第二活塞42的位置x2的检测。
本实施形态中,位置传感器62为设置在马达52上的旋转编码器,检测马达52的旋转位移量,将该旋转位移量转换为第二活塞42的位置x2。但位置传感器62也可以是设置于直动机构51的线性编码器,还可以设置于第二缸41并直接检测第二活塞42的位置x2。
观测器8基于由压力传感器61检测的工作液20的压力P及用位置传感器62检测的第二活塞42的位置x2来导出第一活塞32的推定位置ex1。另,观测器8的功能于后详细说明。
位置控制部71基于第一活塞32的推定位置ex1与对第一活塞32的指令位置tx1的偏差Δx1(=tx1-ex1)来导出马达52的目标旋转速度Vt。偏差Δx1与目标旋转速度Vt的关系被预先设定。
微分部75对用位置传感器62检测的第二活塞42的位置x2进行微分从而算出马达52的当前旋转速度V。速度控制部72基于马达52的目标旋转速度Vt与当前旋转速度V的偏差ΔV(=Vt-V)来导出马达52的目标电流Ct。偏差ΔV与目标电流Ct的关系被预先设定。
逆变部73与马达52间的电力线上设置有电流传感器74。逆变部73以电流传感器74所检测的电流Cn与目标电流Ct的偏差变小的形式向马达52供给电流。
接着参照图2对观测器8的功能进行详细说明。观测器8使对第二活塞42施加力F时的第二活塞42及第一活塞32的移动量模型化,可由以下的状态方程式1及输出方程式2示出。另,以下将按照牛顿符号(Newton's notation)应标记于变量上方的点记号标记于变量的右方。
X・=AX+BF・・・(1)
Y=CX・・・(2)
X・、X、Y:图3所示的矩阵所表示的状态变量
x1:第一活塞的位置
x2:第二活塞的位置
P:工作液的压力
F:施加于第二活塞的力
A、B:表示状态方程式1中的系数的矩阵
C:表示输出方程式2中的系数的矩阵
矩阵A、B根据与第一活塞32相关的状态方程式及与第二活塞42相关的状态方程式等求出。
更详细而言,观测器8首先利用矩阵A、B来求推定状态变量eX・,接着对其进行积分从而算出推定状态变量X・。即,观测器8不仅导出第一活塞32的推定位置ex1,还导出第二活塞42的推定位置ex2及工作液20的推定压力eP。导出的第一活塞32的推定位置ex1如上所述与对第一活塞32的指令位置tx1进行比较。
此外,观测器8利用矩阵C选出第二活塞42的推定位置ex2及工作液20的推定压力eP,使它们与用位置传感器62检测的第二活塞42的位置x2及由压力传感器61检测的工作液20的压力P进行比较。然后观测器8基于第二活塞42的检测位置x2与推定位置ex2的偏差Δx2(=x2-ex2)、和工作液20的检测压力P与推定压力eP的偏差ΔP(=P-eP),利用矩阵K算出状态变量X・全部要素的推定误差。其后,观测器8将算出的推定误差反馈至推定状态变量eX・的运算。换言之,推定误差反馈至第一活塞32的推定位置ex1的导出。
如以上说明,本实施形态的液压钳子系统1中,使用非压缩性的工作液20,所以与夹钳24连结的第一活塞32,换言之处于机器人钳子2梢端侧的第一活塞32的移动量几乎不受外力影响而与第二活塞42的移动量成比例。而且,第二活塞42通过直动机构51由马达52驱动。因而,若控制装置7基于对第一活塞32的指令位置tx1来控制马达52,则能控制夹钳24的开闭。此外,控制装置7包括基于第二活塞42的位置x2来导出第一活塞32的推定位置ex1的观测器8,比较该第一活塞32的推定位置ex1和指令位置tx1,所以无需设置检测第一活塞32的位置的位置传感器。即,无需在机器人钳子2的梢端部设置位置传感器即能控制夹钳24的开闭。
(变形例)
本发明不限于上述实施形态,可在不脱离本发明的主旨的范围内进行种种变形。
例如也可以不设置压力传感器61,观测器8仅基于用位置传感器62检测的第二活塞42的位置x2来导出第一活塞32的推定位置ex1。但若如前述实施形态那样基于用位置传感器62检测的第二活塞42的位置x2及由压力传感器61检测的工作液20的压力P来导出第一活塞32的推定位置ex1,则相比于仅基于第二活塞42的位置x2来导出第一活塞32的推定位置ex1的情况,能提高第一活塞32的位置的推定精度。
所述实施形态中,第一活塞32因弹簧34的施加力而后退。但也可以再设置一个包括第二缸41、第二活塞42、直动机构51及马达52的工作液给排机构,且再一个的工作液给排机构的第二压力室4A与第一缸31的前壁和第一活塞32间的背压室3B连接,从而第一活塞32因向背压室3B供给的工作液的液压而后退。或者也可以在第一活塞32上固定导线的一端,第一活塞32因导线(wire)的拉伸而后退。
又,也可以对观测器8另行设置能根据第一活塞32和/或第二活塞42的状态、负荷条件、机器人钳子2的个体差、周边环境等来进行修正的单元。
符号说明:
1 液压钳子系统 ;
2 机器人钳子 ;
20 工作液 ;
24 夹钳 ;
26 连通路 ;
31 第一缸 ;
32 第一活塞 ;
3A 第一压力室 ;
41 第二缸 ;
42 第二活塞 ;
4A 第二压力室 ;
51 直动机构 ;
52 马达 ;
61 压力传感器 ;
62 位置传感器 ;
7 控制装置 ;
8 观测器。
Claims (4)
1.一种液压钳子系统,其特征在于,具备:
机器人钳子,包括:夹钳、与所述夹钳连结的第一活塞、容纳所述第一活塞并与所述第一活塞共同形成充满工作液的第一压力室的第一缸、第二活塞、容纳所述第二活塞并与所述第二活塞共同形成充满所述工作液的第二压力室的第二缸、连通所述第一压力室和所述第二压力室的连通路、及通过直动机构来驱动所述第二活塞的马达;
用于检测所述第二活塞的位置的位置传感器;以及
基于对所述第一活塞的指令位置来控制所述马达的控制装置;
所述控制装置包括:
基于利用所述位置传感器检测的所述第二活塞的位置来导出所述第一活塞的推定位置的观测器;以及
基于所述第一活塞的推定位置与所述指令位置的偏差来导出所述马达的目标旋转速度的位置控制部。
2.根据权利要求1所述的液压钳子系统,其特征在于,
所述位置传感器是检测所述马达的旋转位移量,将该旋转位移量转换为所述第二活塞的位置的旋转编码器。
3.根据权利要求1或2所述的液压钳子系统,其特征在于,
还具备检测所述工作液的压力的压力传感器;
所述观测器基于由所述压力传感器检测的所述工作液的压力及用所述位置传感器检测的所述第二活塞的位置来导出所述第一活塞的推定位置。
4.根据权利要求3所述的液压钳子系统,其特征在于,
所述观测器导出所述第二活塞的推定位置及所述工作液的推定压力,基于由所述压力传感器检测的所述工作液的压力与所述工作液的推定压力的偏差、及用所述位置传感器检测的所述第二活塞的位置与所述第二活塞的推定位置的偏差来算出推定误差,将算出的推定误差反馈至所述第一活塞的推定位置的导出。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016252568A JP6550368B2 (ja) | 2016-12-27 | 2016-12-27 | 液圧鉗子システム |
JP2016-252568 | 2016-12-27 | ||
PCT/JP2017/045657 WO2018123753A1 (ja) | 2016-12-27 | 2017-12-20 | 液圧鉗子システム |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110087575A CN110087575A (zh) | 2019-08-02 |
CN110087575B true CN110087575B (zh) | 2021-12-28 |
Family
ID=62707483
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201780080837.3A Expired - Fee Related CN110087575B (zh) | 2016-12-27 | 2017-12-20 | 液压钳子系统 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11053960B2 (zh) |
EP (1) | EP3563790B1 (zh) |
JP (1) | JP6550368B2 (zh) |
CN (1) | CN110087575B (zh) |
WO (1) | WO2018123753A1 (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GR1008783B (el) | 2015-06-17 | 2016-06-09 | Γιαννης Χρηστου Στεφανιδης | Ενδαγγειακος καθετηρας στηριξης με κινουμενο μπαλονι |
EP3503955B1 (en) | 2016-08-23 | 2024-03-27 | Shuttle Catheters PC | Endovascular remotely steerable guidewire catheter |
JP6577936B2 (ja) * | 2016-12-27 | 2019-09-18 | 川崎重工業株式会社 | 液圧鉗子システム |
US11071441B2 (en) * | 2018-04-20 | 2021-07-27 | Verb Surgical Inc. | Surgical robotic tool multi-motor actuator and controller |
JP2020141862A (ja) | 2019-03-06 | 2020-09-10 | 川崎重工業株式会社 | 液圧医療機器および手術支援ロボット |
CN110477999B (zh) * | 2019-08-29 | 2021-07-02 | 湖南瀚德微创医疗科技有限公司 | 一种输出恒定夹持力的手术夹钳 |
JP6839874B1 (ja) * | 2020-02-12 | 2021-03-10 | リバーフィールド株式会社 | 手術用ロボット |
CN111096774B (zh) * | 2020-02-25 | 2020-08-14 | 青岛大学附属医院 | 一种微创外科组织夹钳 |
JP2021191382A (ja) * | 2020-06-05 | 2021-12-16 | 国立大学法人 岡山大学 | 穿刺針把持装置及びこの穿刺針把持装置を備えた穿刺ロボット |
GR1010101B (el) * | 2020-12-18 | 2021-10-11 | Ιωαννης Χρηστου Στεφανιδης | Καθετηρας |
GR1010093B (el) * | 2020-12-18 | 2021-09-30 | Ιωαννης Χρηστου Στεφανιδης | Καθετηρας |
EP4340769A1 (en) * | 2021-05-19 | 2024-03-27 | Covidien LP | Actuation assemblies for surgical instruments such as for use in robotic surgical systems |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5431645A (en) * | 1990-05-10 | 1995-07-11 | Symbiosis Corporation | Remotely activated endoscopic tools such as endoscopic biopsy forceps |
US5791231A (en) * | 1993-05-17 | 1998-08-11 | Endorobotics Corporation | Surgical robotic system and hydraulic actuator therefor |
JP2002525168A (ja) * | 1998-09-30 | 2002-08-13 | インプラ・インコーポレーテッド | 埋込み可能なステントの導入機構 |
US20100241137A1 (en) * | 2000-07-20 | 2010-09-23 | Mark Doyle | Hand-actuated articulating surgical tool |
RU2334451C2 (ru) * | 2002-09-30 | 2008-09-27 | Страйкер Ги Лтд | Эндоскопический инструмент с поршневым приводом |
CA2860487C (en) * | 2006-06-14 | 2019-03-26 | Macdonald, Dettwiler And Associates Inc. | Serially jointed manipulator arm |
DE102007022122B4 (de) * | 2007-05-11 | 2019-07-11 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Greifvorrichtung für eine Chirurgie-Roboter-Anordnung |
CA2787491A1 (en) | 2010-01-26 | 2011-08-04 | Carefusion 2200, Inc. | Powered signal controlled hand actuated articulating device and method of use |
CN201614281U (zh) * | 2010-03-31 | 2010-10-27 | 苏州通锦精密工业有限公司 | 液体加注机的加注量反馈检测装置 |
US8652031B2 (en) * | 2011-12-29 | 2014-02-18 | St. Jude Medical, Atrial Fibrillation Division, Inc. | Remote guidance system for medical devices for use in environments having electromagnetic interference |
JP2013220273A (ja) | 2012-04-18 | 2013-10-28 | Tokyo Institute Of Technology | 外力算出方法 |
-
2016
- 2016-12-27 JP JP2016252568A patent/JP6550368B2/ja active Active
-
2017
- 2017-12-20 CN CN201780080837.3A patent/CN110087575B/zh not_active Expired - Fee Related
- 2017-12-20 EP EP17886085.4A patent/EP3563790B1/en active Active
- 2017-12-20 US US16/474,428 patent/US11053960B2/en active Active
- 2017-12-20 WO PCT/JP2017/045657 patent/WO2018123753A1/ja unknown
Also Published As
Publication number | Publication date |
---|---|
US20190345959A1 (en) | 2019-11-14 |
CN110087575A (zh) | 2019-08-02 |
JP6550368B2 (ja) | 2019-07-24 |
WO2018123753A1 (ja) | 2018-07-05 |
EP3563790B1 (en) | 2024-02-28 |
JP2018102633A (ja) | 2018-07-05 |
EP3563790A1 (en) | 2019-11-06 |
EP3563790A4 (en) | 2020-08-12 |
US11053960B2 (en) | 2021-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110087575B (zh) | 液压钳子系统 | |
CN110072485B (zh) | 液压钳子系统 | |
JP4601727B2 (ja) | 内視鏡処置用ロボットシステム | |
JP6510631B2 (ja) | 軟性マニピュレータ制御装置および医療用マニピュレータシステム | |
WO2014030363A1 (ja) | 外力推定装置及び鉗子システム | |
US11478306B2 (en) | Shape acquiring method and controlling method for medical manipulator | |
US20180049831A1 (en) | Medical manipulator system | |
US10660660B2 (en) | Detector-equipped treatment tool | |
CN111936078B (zh) | 臂装置、控制方法以及程序 | |
US20230034550A1 (en) | End effector, device for controlling a robot end effector and medical telemanipulation system | |
US10814499B2 (en) | Actuator device and control method | |
US10675047B2 (en) | Forceps system | |
CN114554998A (zh) | 手术机器人系统、外力推定装置以及程序 | |
JP6532531B2 (ja) | 医療用マニピュレータ制御装置 | |
KR20150041346A (ko) | 다관절 매니퓰레이터 제어 방법 및 제어 시스템 | |
KR102541988B1 (ko) | 액추에이터 장치 및 이의 제어방법 | |
JP2018065197A (ja) | リンク機構の制御装置、マニピュレータ、及びリンク機構の制御方法 | |
WO2021039917A1 (ja) | 車両の電動倍力装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20211228 |
|
CF01 | Termination of patent right due to non-payment of annual fee |