CN108433814B - 手术机器人系统及其手术器械 - Google Patents

手术机器人系统及其手术器械 Download PDF

Info

Publication number
CN108433814B
CN108433814B CN201810218810.2A CN201810218810A CN108433814B CN 108433814 B CN108433814 B CN 108433814B CN 201810218810 A CN201810218810 A CN 201810218810A CN 108433814 B CN108433814 B CN 108433814B
Authority
CN
China
Prior art keywords
surgical instrument
coordinate system
cannula
sensitive element
force
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
CN201810218810.2A
Other languages
English (en)
Other versions
CN108433814A (zh
Inventor
夏玉辉
何超
李涛
王家寅
师云雷
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.)
Shanghai Microport Medbot Group Co Ltd
Original Assignee
Microport Shanghai Medbot Co Ltd
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 Microport Shanghai Medbot Co Ltd filed Critical Microport Shanghai Medbot Co Ltd
Priority to CN201810218810.2A priority Critical patent/CN108433814B/zh
Publication of CN108433814A publication Critical patent/CN108433814A/zh
Priority to US16/981,514 priority patent/US20210186638A1/en
Priority to EP19766462.6A priority patent/EP3766449B1/en
Priority to PCT/CN2019/077059 priority patent/WO2019174496A1/zh
Priority to BR112020018780-1A priority patent/BR112020018780A2/pt
Priority to RU2020133833A priority patent/RU2751753C1/ru
Priority to JP2020549685A priority patent/JP2021517040A/ja
Application granted granted Critical
Publication of CN108433814B publication Critical patent/CN108433814B/zh
Priority to JP2023015112A priority patent/JP7455245B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • A61B34/37Master-slave robots
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • A61B34/35Surgical robots for telesurgery
    • 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
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/70Manipulators specially adapted for use in surgery
    • A61B34/76Manipulators having means for providing feel, e.g. force or tactile feedback
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/70Manipulators specially adapted for use in surgery
    • A61B34/77Manipulators with motion or force scaling
    • 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
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • A61B2034/301Surgical robots for introducing or steering flexible instruments inserted into the body, e.g. catheters or endoscopes
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • A61B2034/302Surgical robots specifically adapted for manipulations within body cavities, e.g. within abdominal or thoracic cavities
    • 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/06Measuring instruments not otherwise provided for
    • A61B2090/064Measuring instruments not otherwise provided for for measuring force, pressure or mechanical tension
    • A61B2090/065Measuring instruments not otherwise provided for for measuring force, pressure or mechanical tension for measuring contact or contact pressure
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B90/00Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges
    • A61B90/36Image-producing devices or illumination devices not otherwise provided for
    • A61B90/361Image-producing devices, e.g. surgical cameras

Landscapes

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

Abstract

本发明提供了一种手术机器人系统及其手术器械,有助于提升手术器械末端的接触力测量的精度和准确性。所述手术器械包括机械结构、套管和力传感器,所述机械结构包括器械杆和与器械杆末端连接的末端执行器;所述套管固定或可拆卸套接于器械杆的末端;所述力传感器包括敏感元件和与敏感元件连接的外围测量模块,所述敏感元件设置于套管上用于获取套管的变形信息;所述外围测量模块根据敏感元件获取的变形信息,获得敏感元件测量得到的应力,并根据述敏感元件测量得到的应力、敏感元件的位置以及敏感元件的敏感轴方向,获得套管受到的器械杆对其作用力的等效合力以及作用力的等效力矩,进而获得手术器械的末端执行器受到的接触力。

Description

手术机器人系统及其手术器械
技术领域
本发明涉及医疗器械技术领域,特别涉及一种手术机器人系统及其手术器械。
背景技术
机器人辅助手术系统通常采用主从控制的方式实现,分为主端设备(医生端)和从端设备(病人端)两个部分。主端设备通常基于机械手臂、空间多维鼠标、摇杆等设计,可以在空间内实现多维运动。从端设备一般为多自由度机械手臂,其末端夹持有手术器械(如持针钳、电凝钳、电外科烧灼探针、组织夹持器、剪刀等)。手术时,由显示装置显示由内窥镜传出内脏3D图像,医生根据图像信息操作主端设备,从端则跟随主端运动,从而驱动手术器械完成诸如回缩组织、缝合、抓握血管、解剖、烧灼、凝固组织等一系列手术操作。
机器人辅助手术系统具有如下优点:
第一,微创伤,手术切口小,创伤小,故而,术后患者疼痛轻、恢复快、感染风险及输血概率降低;
第二,操作精细、稳定程度远胜于人手,如计算机辅助系统可消除生理震颤,三维手术视野可以清晰地看到微小的毛细血管,手术的安全性高。
然而,机器人辅助手术是一种远程操控模式,医生并没有直接的触觉感受,无法分辨组织韧度和触摸血管搏动,缺乏握力及压力的反馈,只有当设备与肌体产生严重的碰触时才会有力反馈作用,对于小的碰撞难以产生灵敏的力反馈效果。当手术器械前端触碰到肌体组织时,如若能够根据接触力的变化来调整从端设备的运动,并且给医生提供适当的力反馈警示,将可大大提高设备安全性。
传统的力反馈机制,多是在机器人每个关节处安放力矩传感器,由关节力矩来计算末端接触力矩。该方法的主要缺点在于:接触力是由计算得出的,并不随时能反映真实情况。而且肌体接触力很小,若要提高测量精度,便需要提高关节力矩传感器的分辨率,高分辨率的传感器对噪声非常敏感,信号容易失真,成本也十分昂贵。另外,手术器械多采用丝传动控制的方式,显然在丝上放置张力传感器十分困难。
专利US8491574B2公开了一种方案,通过在手术器械前端嵌入应变式敏感元件,克服了上述力测量方案的不足,实现了对外力的直接测量。然而,其仍然存在以下不足:
第一,一台手术不可避免采用多套手术器械,不同手术器械上传感器的测量一致性很难保证,即使对每把手术器械上传感器设置标定,但要精确记录所有器械的物理参数十分困难;
第二,温度、湿度、气压等因素对敏感元件物理特性产生影响,在不同的环境下,如患者体内和体外,敏感元件所表现的特性也不一样,故难以一致地描述手术器械的受力;
第三,手术器械本身是一种耗材,每把手术器械通常只能使用10次,但传感器本身是可以重复利用的,若将传感器与手术器械一同报废显然不经济。
发明内容
本发明的目的在于提供一种手术机器人系统及其手术器械,以解决现有技术中的手术器械末端接触力测量准确度低以及传感器报废率高等问题中的一个或多个。
为实现上述目的以及其它相关目的,本发明提供了一种手术器械,包括机械结构、套管和力传感器,所述机械机构包括器械杆以及与所述器械杆的末端连接的末端执行器;所述套管固定或可拆卸套接于所述器械杆的末端;所述力传感器包括敏感元件以及与所述敏感元件连接的外围测量模块,所述敏感元件设置于所述套管上,用于获取所述套管的变形信息;
所述外围测量模块根据所述敏感元件获取的变形信息,获得所述敏感元件测量得到的应力,并根据所述敏感元件测量得到的应力、所述敏感元件的位置以及所述敏感元件的敏感轴方向,获得所述套管受到的所述器械杆对其作用力的等效合力以及所述作用力的等效力矩,进而获得所述手术器械的末端执行器受到的接触力。
可选的,所述套管具有封闭的镂空结构,所述镂空结构包含多个柔顺结构,用于连接位于所述镂空结构上侧部分的套管和位于镂空结构下侧部分的套管;
所述敏感元件置于所述柔顺结构上,用于测量所述应力。
可选的,所述套管的弹性模量不大于所述器械杆的弹性模量。
可选的,所述柔顺结构包括内表面、外表面和侧面,所述敏感元件设置于所述柔顺结构的内表面、外表面或侧面上。
可选的,所述镂空结构设置于所述套管的轴向中部位置。
可选的,所述敏感元件的敏感轴被布置为平行于所述套管的轴向或垂直于所述套管的轴向。
可选的,所述套管通过粘结、过盈配合或插接方式与所述器械杆的末端固定套接。
可选的,所述套管通过螺纹连接、锁扣连接或卡扣连接方式与所述器械杆的末端可拆卸套接。
可选的,所述套管的一端与所述器械杆的末端平齐。
可选的,所述外围测量模块包括顺次连接的数据采集单元、信号调理单元和解算输出单元;所述数据采集单元用于获取所述敏感元件输出的信号,所述信号调理单元用于对所述敏感元件输出的信号进行调理,所述解算输出单元用于对经过调理的信号进行分析计算,以获得所述末端执行器受到的接触力。
可选的,所述敏感元件测量得到的应力大小为:
fi=g(εi)=k·εi+f(εi)i=1,2,L,n
其中,i表示第i个敏感元件,fi表示第i个敏感元件所测量得到的应力大小;εi表示在第i个敏感元件处的所述柔顺结构沿第i个敏感元件的敏感轴方向所产生的应变;g(·)表示应力大小与应变之间所存在的函数关系;k表示在第i个敏感元件位置处的所述柔顺结构沿第i个敏感元件的敏感轴方向的应力大小/应变系数;f(εi)表示应力大小与应变之间所存在的非线性补偿项。
可选的,所述接触力包括一空间等效合力Fq和一空间等效合力矩Mq
其中,所述外围测量模块在套管上建立套管坐标系{p},在手术器械末端建立手术器械坐标系{q},以及所述套管坐标系{p}在所述手术器械坐标系{q}下位置关系的描述和姿态关系的描述;
所述外围测量模块根据所述套管坐标系{p}在所述手术器械坐标系{q}下姿态关系的描述、所述敏感元件的敏感轴方向在所述套管坐标系{p}下的描述以及所述敏感元件测量得到的应力,获得所述敏感元件测量得到的应力在所述手术器械坐标系{q}下的描述,进而得到所述空间等效合力Fq
所述外围测量模块根据所述套管坐标系{p}在所述手术器械坐标系{q}下位置和姿态关系的描述、以及所述敏感元件的位置在所述套管坐标系{p}下的描述,获得所述敏感元件的位置在所述手术器械坐标系{q}下的描述;
所述外围测量模块根据所述敏感元件测量得到的应力在所述手术器械坐标系{q}下的描述,获得所述套管受到的力矩在所述手术器械坐标系{q}下的描述,进而得到所述空间等效合力矩Mq
可选的,所述敏感元件测量得到的应力在所述套管坐标系{p}下的描述为:
(fxi,fyi,fzi)T=fiei=fi·(exi,eyi,ezi)T i=1,2,...,n
其中,ei为单位向量,表示第i个敏感元件的敏感轴方向在套管坐标系{p}下的描述,fi表示第i个敏感元件所测量得到的应力大小,fxi,fyi,fzi分别表示应力fi在套管坐标系{p}各个坐标轴方向的分量大小,exi,eyi,ezi分别表示单位向量ei在套管坐标系{p}各个坐标轴方向的分量。
可选的,所述敏感元件测量得到的应力在所述手术器械坐标系{q}下的描述为:
fiqR(fiei)
其中,fi表示第i个敏感元件所测量得到的应力在手术器械坐标系{q}内的描述,qR表示所述套管坐标系{p}在所述手术器械坐标系{q}下姿态关系的描述;
所述空间等效合力Fq为:
其中,diag(·)表示以向量·中元素为对角元素的对角矩阵,nx,ny,nz表示沿x、y、z轴方向冗余力的个数。
可选的,所述敏感元件的位置在所述手术器械坐标系{q}下的描述为:
ri=rp+qRpri
其中,ri表示第i个敏感元件的位置在手术器械坐标系{q}下的描述,pri表示第i个敏感元件的位置在套管坐标系{p}下的描述,qR表示所述套管坐标系{p}在所述手术器械坐标系{q}下姿态关系的描述,rp表示所述套管坐标系{p}在手术器械坐标系{q}下位置关系的描述。
可选的,所述空间等效合力矩Mq为:
其中,nx',ny',nz'表示沿x、y、z轴方向冗余力矩的个数。
可选的,所述镂空结构包括四个柔顺结构,四个所述柔顺结构周向布置,所述力传感器包括四个敏感元件,每个柔顺结构的外表面布置一个所述敏感元件,四个所述敏感元件的敏感轴方向在所述套管坐标系{p}中的描述e1,e2,e3,e4,均为(1,0,0)T
四个所述敏感元件所测量得到的应力在所述手术器械坐标系{q}下的描述为:
其中,fx1、fx2、fx3、fx4分别表示第一至第四敏感元件各自在手术器械坐标系{q}的x轴方向上测量得到的应力大小;
所述空间等效合力Fq为:
Fq=(f1+f2+f3+f4)
可选的,所述套管坐标系{p}在手术器械坐标系{q}下姿态关系的描述qR为单位矩阵;
所述敏感元件的位置以所述敏感元件的中心位置计量,所述敏感元件的中心位置在手术器械坐标系{q}下的描述为:
其中,pr1,pr2,pr3,pr4为四个所述敏感元件的中心位置在套管坐标系{p}下的描述,rp表示所述套管坐标系{p}在手术器械坐标系{q}下位置关系的描述,x1、x2、x3、x4分别表示第一至第四敏感元件的中心位置在手术器械坐标系{q}之x轴上的坐标值;y1、y2、y3、y4分别表示第一至第四敏感元件的中心位置在手术器械坐标系{q}之y轴上的坐标值;z1、z2、z3、z4分别表示第一至第四敏感元件的中心位置在手术器械坐标系{q}之z轴上的坐标值,r1、r2、r3、r4分别表示第一至第四敏感元件的位置在手术器械坐标系{q}下的描述。
可选的,所述空间等效合力矩Mq
Mq=(r1×f1+r2×f2+r3×f3+r4×f4)
进一步,本发明还提供了一种手术机器人系统,包括从端设备;所述从端设备包括机械臂以及所述手术器械;所述机械臂的末端与所述手术器械可拆卸连接,并驱动所述手术器械围绕一不动点运动。
可选的,所述手术机器人系统还包括主端设备和控制单元,所述主端设备包括示力装置;所述控制单元与所述主端设备和所述从端设备通讯连接,所述控制单元从所述手术器械的所述敏感元件获取所述末端执行器受到的接触力,并传输至所述示力装置。
可选的,所述从端设备还包括:
内窥镜;以及
用于与所述内窥镜可拆卸连接的持镜臂;
所述外围测量模块建立套管坐标系{p}、手术器械坐标系{q}、内窥镜坐标系{e},以及所述手术器械坐标系{q}到所述内窥镜坐标系{e}下的旋转矩阵eR,并表示所述手术器械坐标系{q}到所述内窥镜坐标系{e}下的位置矢量er=(rx ry rz)T,进而得到所述末端执行器的接触力在所述内窥镜坐标系{e}下的描述:
其中,eF为内窥镜坐标系{e}下的合力;eM为内窥镜坐标系{e}下的合力矩;S(er)表示矢量er所对应的反对称矩阵;Fq为末端执行器的接触力的空间等效合力;Mq为末端执行器的接触力的空间等效合力矩;
综上所述,本发明提供的手术机器人系统及其手术器械具有如下优点:
第一,针对一台手术所采用的多套手术器械,不同手术器械上可以安装同一个套管来传递手术器械的变形,与将敏感元件直接安装于手术器械的末端相比,套管的设置可以避免不同手术器械上敏感元件测量一致性所带来的测量差异,由此提升测量精度和测量的准确性;
第二,利用套管与手术器械连接,可以避免敏感元件随手术器械一同报废;由于手术器械本身是一种耗材,但敏感元件却可以重复利用,若将敏感元件与手术器械一同报废,显然不经济,提高了使用成本。
在本发明的一个较佳实施例中,多个敏感元件以预定的方式排布在套管的柔顺结构上,且每个敏感元件在手术器械坐标系下具有一个预设的坐标值,根据预设的坐标值可以确定各个敏感元件在柔顺结构上的安装位置,从而实现手术器械末端接触力的一维或多维的测量,这样的测量方式,仅需调整各个敏感元件相对于手术器械坐标系的位置即可实现接触力一维至多维的测量,接触力的测量更为方便和简单。
附图说明
图1是本发明一实施例的手术机器人系统之从端设备的结构示意图;
图2是本发明一实施例的手术器械的机械结构示意图;
图3是本发明一实施例的手术器械执行手术操作的示意图;
图4a是本发明一手术器械实施例中的力传感器和套管的示意图;
图4b是本发明一手术器械实施例中的外围测量模块的结构框图;
图5a是本发明一手术器械实施例中的套管安装于器械杆上的示意图;
图5b是图5a所示的套管安装于器械杆上的局部放大示意图;
图6a是本发明一实施例的套管与器械杆相组装之前的示意图;
图6b是本发明另一实施例的套管与器械杆相组装之前的示意图;
图7a是本发明一实施例的手术器械一侧受力变形的示意图;
图7b是为本发明一实施例的手术器械末端受力分析及测量原理的示意图;
图8是本发明一实施例的三维力传感器测力原理分析示意图。
图中的附图标记说明如下:
手术台车-1,机械臂-2,手术器械-3,动力模组-301,器械杆-302,末端执行器-303,自转关节-304,俯仰关节-305,摆动关节-306、306’,内窥镜-4,成像系统-5,医生-6,主手-7,患者-8;
力传感器-400,套管-401,柔顺结构-4011,敏感元件-402,外围测量模块-403,数据采集单元-4031,信号调理单元-4032,解算输出单元-4033。
具体实施方式
为使本发明的目的、优点和特征更加清楚,以下结合附图1~8对本发明提出的手术机器人系统及其手术器械做进一步详细说明。需说明的是,附图均采用非常简化的形式且均使用非精准的比例,仅用以方便、明晰地辅助说明本发明实施例的目的。如说明书中所述,“末端”、“远端”指的是远离产品操作者的一端,“近端”指的是靠近产品操作者的一端。
图1是本发明一实施例的手术机器人系统之从端设备的结构示意图。如图1所示,所述从端设备包括手术台车1、机械臂2、手术器械3和内窥镜4。所述手术台车1作为整个所述从端设备的基座,支撑着全部的机械机构。优选,该手术台车1可在地面上移动,使所述从端设备能够靠近或远离患者8。
所述机械臂2安装于手术台车1上并具有多个自由度,可在一定的空间范围内运动。当所述手术台车1到达患者8附近时,通过对机械臂2的调整,使手术器械3到达手术的规划位置。所述手术器械3可拆卸地安装于机械臂2的末端,作为整个所述从端设备的执行机构,在所述机械臂2的驱动下围绕一不动点RCM(Remote Center of Motion)运动,所述手术器械3的末端执行器303进入患者体内病灶区,实现对病灶的处理。
所述内窥镜4安装于另一机械臂(此处机械臂又可称为持镜臂)的末端,并用于采集手术环境中的图像信息。该图像信息包括但不限于人体病患组织信息以及手术器械3的位姿信息。而且,所述内窥镜4安装在机械臂2上后与下述的主端设备通讯连接,以实时显示内窥镜4采集的手术环境中的图像信息。所述内窥镜4可以是立体式,也可以是非立体式,具体不限。
图2为本发明一实施例的手术器械的机械结构示意图。如图2所示,所述手术器械3的机械结构包括动力模组301、器械杆302、传动机构和末端执行器303。所述传动机构可以为丝传动,容纳于所述器械杆302中,并分别与动力模组301和末端执行器303连接。所述动力模组301位于器械杆302的近端,所述末端执行器303位于器械杆302的远端。
所述动力模组301为末端执行器303提供驱动力,驱动力通过所述传动机构将动力传递至末端执行器303,使得末端执行器303完成多维的空间运动,如旋转、开合等。所述末端执行器303实现对患者病灶区的具体手术操作,包括剪切、探伤、夹持等动作,因此,所述末端执行器303可以是剪刀、钳子、探针等器械。
如图1所示,所述手术机器人系统还包括主端设备,所述主端设备包括成像系统5和主手7(又称主操作手)。手术时,一方面所述内窥镜4的视野通过成像系统5展现,而医生6通过成像系统5即可实时观察手术过程中手术器械3的运动状态,另一方面医生6通过主手7操控手术器械3以完成多维的空间运动,诸如俯仰、摆动、自转以及开合等动作,进而完成整个手术过程。
图3为本发明一实施例的手术器械执行手术操作的示意图。如图3所示,医生6通过主手7操作一把或多把(相同或不同)手术器械3,配合完成如剪切、探伤、夹持等手术动作,进而完成整个手术过程。
显然,从主手7到手术器械3的控制是手术机器人系统主从控制的基础。然而,这种方式是一种远程操控模式,医生并不能直接感受到操作力的大小,不便于医生根据接触力的大小做出合理的动作。本发明提供了一种具有力反馈功能的手术器械,进而使医生6能够感知手术器械末端的受力。
图4a为本发明一手术器械实施例中力传感器和套管的示意图。如图4a所示,所述手术器械3除包括前述机械结构外,还包括套管401和力传感器400,所述力传感器400包括敏感元件402和外围测量模块403。所述套管401为一中空的圆柱体,其内径与手术器械3之器械杆302的外径相匹配。进一步,所述套管401具有封闭的镂空结构,所述镂空结构包含多个柔顺结构4011用于连接套管的上侧部分(即位于镂空结构上侧的套管部分)和套管的下侧部分(即位于镂空结构下侧的套管部分)。此时,外力通过柔顺结构4011从套管一端传向另一端,所以只要测量得到柔顺结构4011上传递的力即可测量得到外力的大小和方向。此种设计便于外力的测量,同时也降低了算法复杂性、提升了准确度。
在图8所示的优选实施例中,所述镂空结构沿所述套管401圆周方向延伸,其中的柔顺结构4011为四个,并以中心对称的方式成十字形布置。本发明对镂空结构以及柔顺结构4011的制备方法没有特别的限制。一个示范性制备方法为:所述套管401最初为一筒状结构,通过线切割、电火花等机加工方法去除多余材料,形成所述的镂空结构。此外,还可以将所述柔顺结构4011与两个套管子模块固定连接,形成一个完整的套管结构。因此,柔顺结构4011的材料可以与套管其余部分相同,也可以不相同。为了提高力测量的敏感性,所述柔顺结构4011选用弹性模量不大于所述器械杆302的弹性模量的材料,如橡胶,以能够较好地使敏感元件402感知手术器械所受到的外力。
所述柔顺结构4011包括内表面、外表面和侧面。所述敏感元件402可贴于套管401的柔顺结构4011的内表面、外表面或侧面上。优选,所述敏感元件402的敏感轴方向与所述套管401的轴向或周向一致。此时敏感元件402将感受柔顺结构4011所受到的力的大小,测得的力的方向与敏感元件402的敏感轴方向相同。所述敏感轴方向是指,所述敏感元件402对该轴线方向上的变形敏感,而对其它方向产生的变形不敏感。在本发明一些优选实施例中,所述敏感元件402的敏感轴平行于套管401的轴向。具体安装时,所述敏感元件402的敏感轴被布置为平行于套管401的轴向设置,以使其能够感知柔顺结构4011沿套管401轴向的应变。
根据应用条件与测量需求,所述敏感元件402可以选择诸如应变片、光纤等元器件。根据接触力的类型和传感器的可靠性,可以灵活选择敏感元件402的个数,并设计相应排布方式。根据连接方式及工艺难度,可灵活将敏感元件402布置于套管401的柔顺结构4011的内表面、外表面或侧面上。优选,将镂空结构亦即柔顺结构4011设置于套管401上应变相对较大的区域(较佳地设置在套管401轴向的中间部位)。优选设置多个敏感元件402于柔顺结构4011上,从而实现从一维或多维的接触力测量,如三维、六维的测量。更优选,每个柔顺结构4011上(如外表面)布置一个敏感元件402。
需要说明的是,在实际设计套管401结构时,应该考虑到其结构强度的影响。例如,理论上,所述镂空结构可以只包括一个柔顺结构4011,但这会严重影响套管401的结构强度,甚至不能很好的传递外力;或者柔顺结构4011发生较大的塑性变形,影响到测量精度。因此,推荐选用图8所示的实施例中采用的四个柔顺结构4011的布置,即在镂空结构的圆周上四均分布置以形成十字型结构。
所述外围测量模块403与敏感元件402通讯连接(例如电连接),以采集敏感元件402所获取的柔顺结构4011的变形信息(变形信息可以是电阻、电压等电信号),并根据该变形信息最终得到作用于手术器械末端的接触力。本实施例中,所述外围测量模块403可包括微处理器,该微处理器接收敏感元件402输出的电信号并进行解算,从而得到作用于手术器械末端的接触力。除了微处理器之外,还可以选择其他任一可编程计算单元,例如单片机、PLC控制器、FPGA等。可选,所述外围测量模块403固接于动力模组301上。
图4b为本发明一手术器械实施例中外围测量模块的结构框图。如图4b所示,所述外围测量模块403可包括依次连接的数据采集单元4031、信号调理单元4032和解算输出单元4033。所述外围测量模块403具体的工作过程为:首先由数据采集单元4031获取敏感元件402产生的电信号;之后,由信号调理单元4032对数据采集单元4031获取的电信号进行调理,调理的内容包括但不局限于电信号的放大、数字滤波、去除趋势项、剔除野值等;最后,由解算输出单元4033对经过信号调理单元4032调理后的电信号进行分析计算,从而解算出手术器械3末端的接触力并输出,该接触力可以是一维,亦可以是多维。
图5a为本发明一手术器械实施例中套管401安装于器械杆302上的示意图,图5b为图5a所示的套管401安装于器械杆302上的局部放大示意图。如图5a和图5b所示,所述力传感器400通过所述套管401套接于手术器械3之器械杆302的末端。所述套管401的安装位置越靠近末端执行器303,越能反映手术器械3末端的受力情况。优选,所述套管401与器械杆302的末端平齐,并通过过盈、插接、粘结等方式与器械杆302的末端固定套接,或者螺纹、锁扣、卡扣等可拆卸的套接方式,以便于组装和拆卸所述套管401。
图6a为本发明一实施例的套管401与器械杆302相组装之前的示意图。如图6a所示的实施例中,所述套管401选择性地与器械杆302过盈配合而实现固定套接,此时,所述敏感元件402不限于安装在柔顺结构4011的外表面上,亦可安装在柔顺结构4011的内表面上(如在柔顺结构4011的内表面上开设槽孔来放置敏感元件402)。显然,在此实施例中,所述套管401能够通过自身的弹性与器械杆302实现过盈配合而固连。
图6b为本发明另一实施例的套管401与器械杆302相组装之前的示意图。如图6b所示的实施例中,所述套管401选择性地与器械杆302螺纹配合而实现可拆卸套接,所述敏感元件402优选安装在柔顺结构4011的外表面上。具体的,所述套管401的内表面设置有内螺纹,所述器械杆302的外表面设置有与所述内螺纹配合的外螺纹。螺纹连接的好处在于,可以有效地消除套管401与器械杆302之间的间隙对于力测量准确性的影响。优选,采用螺纹连接的套管401一般选用碳纤维等硬度较高的材料,以确保连接的可靠性。
图7a为本发明一实施例的手术器械一侧受力变形的示意图。在本实施例中,所述手术器械3依次包括自转关节304,俯仰关节305和摆动关节306,以上三个关节可以驱动末端执行器303实现自转、俯仰转动和摆动运动。在本实施例中,所述末端执行器303包括两个开合片(例如所述末端执行器为剪刀),所以需要两个摆动关节(306,306’)分别控制一个开合片。如图7a所示,当所述末端执行器303接触到肌体组织时,所述末端执行器303会受到肌体组织的接触力F。显然,接触力F将由器械杆302传递至套管401上,并通过柔顺结构4011从套管401一端传向另一端。所述柔顺结构4011在接触力F的作用下将发生如图7a所示的变形,该部分变形被敏感元件402所感知。
图7b为本发明一实施例的手术器械末端受力分析及测量原理的示意图。如图7b所示,当所述手术器械3的末端与肌体组织接触后,将受到肌体组织的接触力F,接触力F可包括一个空间等效合力Fq和一个空间等效合力矩Mq,在合力Fq和合力矩Mq的作用下,使器械杆302连同套管401发生如图7a和图7b所示的变形。同时,所述手术器械3会受到套管401对其施加的反作用力(包括Fp和Mp),且空间等效合力Fq与Fp受力平衡,空间等效合力矩Mq与Mp平衡。通过对手术器械3施加于套管401的作用力的检测,可获得所述手术器械3受到的套管401对其施加的反作用力,并根据受力平衡和力矩平衡原理,可以获知所述手术器械3受到肌体组织的接触力F。
应当知晓,图7b示意的是手术器械末端的变形以及受力状况。其中,在手术器械3的末端设有手术器械坐标系{q},例如,所述手术器械坐标系{q}的坐标原点位于所标示的A点处,即器械杆302轴线与手术器械的俯仰关节305的旋转轴线交点,手术器械坐标系{q}的x轴垂直于所述俯仰关节305的旋转轴线,且在初始位置与器械杆302的轴线重合,y轴与手术器械的俯仰关节305的旋转轴线平行,z轴与以上两者垂直且符合右手定则。这里的“初始位置”,设定为手术器械3的末端执行器303处于伸直时的位置,即在器械杆302的轴线方向上,末端执行器303的远端离所述摆动关节最远时的位置。手术器械坐标系{q}的坐标原点即为等效合力Fq和等效合力矩Mq的作用点处。由于本实施例中所述敏感元件402在所述柔顺结构4011上的位置、朝向没有特别的限制,要确定敏感元件402的安装位置及朝向必需有一个参照,所以需要在套管401上建立套管坐标系{p},作为参照。例如,所述套管坐标系{p}在套管401的端面中心位置,其中x轴通过套管401的轴线,其它两个坐标轴沿径向且相互垂直。同理,套管坐标系{p}的坐标原点可作为套管所受合力(包括力和力矩)的作用点。套管坐标系{p}到手术器械坐标系{q}之间的旋转关系用qR表示,即为套管坐标系{p}在手术器械坐标系{q}下姿态关系的描述。而手术器械3对套管401的作用点异于手术器械的末端点,在本实施例中,所述手术器械3对套管401的合力作用点相对于手术器械坐标系{q}的位置关系用矢径rp描述,即套管坐标系{p}在手术器械坐标系{q}下位置关系的描述。旋转关系矩阵qR和位置矢量rp在装配时便可以确定,为已知量。为了计算简单,推荐在装配时通过一些工装,保证手术器械坐标系{q}和套管坐标系{p}的初始朝向相同,此时qR为单位矩阵。在本实施例中,依此建立坐标系。本领域技术人员应知道可以根据实际需要灵活选择手术器械坐标系{q}、套管坐标系{p}的位置和朝向。
当所述套管401受到器械杆302的作用力(包括-Fp和-Mp)后产生变形,所述柔顺结构4011上的敏感元件402则感知柔顺结构4011所产生的变形,且柔顺结构4011产生的变形与所述敏感元件402测量得到的应力大小将具有如下关系:
fi=g(εi)=k·εi+f(εi)i=1,2,L,n (1-1)
式(1-1)中:i表示第i个敏感元件,以n个敏感元件为例;fi表示第i个敏感元件所测量得到的应力大小;εi表示在第i个敏感元件处的柔顺结构4011沿第i个敏感元件的敏感轴方向所产生的应变;g(·)表示应力大小与应变之间所存在的函数关系;k表示在第i个敏感元件位置处的柔顺结构4011,沿第i个敏感元件的敏感轴方向的应力大小/应变系数,该弹性系数根据在第i个敏感元件位置处的所述柔顺结构4011的材料参数确定;f(εi)表示应力大小与应变之间所存在的非线性补偿项,该非线性项可以通过标定的方法获得。此处的标定的一个示范方法为:一是获取套管401在未受任何外力的作用时,该套管401上敏感元件402的信号输出,以确定各个敏感元件402是否存在零点漂移;二是获取套管401在受到外力作用时,其上敏感元件402所产生的应变与所施加的外力之间的变化关系,若该变化关系呈非线性,则在计算敏感元件402所测量得到的外力时,需要考虑上述非线性项;三是对于计算所得力的方向与实际施加力的方向也需要相应的对准。显然,这里“所述敏感元件402测量得到的应力大小”不应理解为所述敏感元件402直接测量得到的应力大小,而是指所述敏感元件402测量得到对应部分的套管(柔顺结构4011)产生的应变,然后根据上述式(1-1)获得所述敏感元件402对应部分的套管401(柔顺结构4011)受到的应力大小。
另外,所述套管401受到器械杆302的作用力还有方向和作用点位置两方面信息:方向即为第i个敏感元件的敏感轴方向在套管坐标系{p}的表示,作用点位置即为第i个敏感元件所固定的位置在套管坐标系{p}中的表示。所述敏感元件402测量得到的应力,亦即柔顺结构4011受到器械杆302的作用力在套管坐标系{p}下的表示为:
(fxi,fyi,fzi)T=fiei=fi·(exi,eyi,ezi)T (1-2)
式(1-2)中,ei为单位向量,表示第i个敏感元件的敏感轴方向(即敏感元件402敏感轴的安装朝向)在套管坐标系{p}下的表示,fi表示第i个敏感元件所测量得到的应力大小,fxi,fyi,fzi分别表示应力fi在套管坐标系{p}各个坐标轴方向的分量大小,exi,eyi,ezi分别表示ei在套管坐标系{p}各个坐标轴方向的分量,(·)T表示矩阵的转置。
进一步,所述套管401受到器械杆302的作用力的方向和作用点位置在手术器械坐标系{q}中的表示,如下所示:
fiqR(fiei) (1-3)
ri=rp+qRpri (1-4)
式(1-3)中,ei表示第i个敏感元件的安装朝向(即敏感轴方向)在套管坐标系{p}中的表示;fi表示第i个敏感元件所测量得到的应力在手术器械坐标系{q}内的表示;qR表示套管坐标系{p}在手术器械坐标系{q}下位置关系的表示;
式(1-4)中,pri表示第i个敏感元件的安装位置(即作用点位置)在套管坐标系{p}中的表示;ri表示第i个敏感元件的安装位置在手术器械坐标系{q}中的表示;rp表示套管坐标系{p}在手术器械坐标系{q}下位置关系的表示。
需要说明的是,为了保证套管401与手术器械的器械杆302安装的相对位置,即确定套管坐标系{p}与手术器械坐标系{q}的相对位置,可以在套管的端面或表面,以及手术器械的器械杆302的表面加工出一些凹槽或画出一些线,以用于安装时对准作用。
将每个敏感元件所测量得到的力合成到手术器械坐标系{q}中得到:
根据式(1-5)可知,手术器械末端的接触力的等效合力为等效合力矩为其中,diag(·)表示以向量·中元素为对角元素的对角矩阵;nx,ny,nz表示沿x、y、z方向冗余力的个数;nx',ny',nz'表示沿x、y、z方向冗余力矩的个数。
为了提高测精度和可靠性,工程上会采用一些冗余的测试方法,即指人为增加地重复测量部分。在本发明中,沿某方向的冗余力的个数可以理解为沿该方向,力在传递路径上被力传感器测量的次数;沿某方向冗余力矩的个数可以理解为沿该方向,力矩在传递路径上被力传感器测量的次数。为了进一步说明套管式力传感器的设计方法,测力算法,本文给出具体实施例来加以说明。
图8是本发明一实施例的三维力传感器测力原理分析示意图。图8中示意两个坐标系,分别为器械坐标系{q}和套管坐标系{p}。如上所述,所述手术器械坐标系{q}的原点设置在手术器械3的自转关节旋转轴线(亦即器械杆302的轴线)与俯仰关节的旋转轴线的交点处,所述手术器械坐标系{q}的x轴、y轴和z轴约定如下:所述手术器械坐标系{q}的x轴的方向取为垂直于所述俯仰关节305的旋转轴线,且在初始位置下与器械杆302的轴线方向相同,y轴与俯仰关节的旋转轴线平行,z轴满足右手定则。同上,这里的“初始位置”,设定为手术器械3的末端执行器处于完全伸直时的位置,即在器械杆302的轴线方向上,末端执行器的远端离所述摆动关节最远时的位置。如前文所述,套管坐标系{p}建立在套管401的端面上。从套管坐标系{p}到手术器械坐标系{q}的平移矢量记为rp,旋转矩阵记为qR,这两个量均取决于套管式力传感器初始安装位置,为已知量。为了算法上的简便,在安装时保证套管坐标系{p}与器械坐标系{q}朝向相同,则qR即为单位矩阵,下文也依此进行分析。而当手术器械前端转过一定角度后,该角度可以被动力模组301中的编码器测量得到,此时qR亦为已知量。
如图8所示,所述套管401包括一个镂空结构,所述镂空结构包括四个柔顺结构4011,且周向均匀布置;所述力传感器400包括四个敏感元件402,在下面计算中用下标1~4予以区分。在该实例中,四个敏感元件402分别固定安装于一个柔顺结构4011的外表面,且其敏感轴布置为平行于套管401的轴线方向。
上述四个敏感元件在安装时,各自的敏感轴各有一个朝向,在套管坐标系{p}中分别记为e1,e2,e3,e4。由于所述敏感元件402的安装方向与套管401的轴线方向相同,所以四个方向的向量均为(1,0,0)T。由此根据式(1-2)和(1-3)可以得到,四个敏感元件402感受的力在手术器械坐标系{q}下的表示记为
其中,fx1、fx2、fx3、fx4即分别表示第一至第四敏感元件各自在x轴方向上测量得到的应力大小。需要说明的是,因为敏感元件的敏感轴方向朝向x轴,所以不会感受到其它方向上的受力,故在y、z方向上的受力均为0。
同理,上述四个敏感元件402在套管坐标系{p}各有一个位置矢量,以pr1,pr2,pr3,pr4表示,由敏感元件402的具体安装位置确定,后文将会讲到具体如何确定安装位置。根据式(1-3)可以得到敏感元件402在手术器械坐标系{q}下的表示r1,r2,r3,r4,此位置矢量即为力的作用点,此处不在赘述具体公式。上述位置矢量的计算结果为
其中:x1、x2、x3、x4分别表示第一至第四敏感元件的中心在手术器械坐标系{q}之x轴上的坐标值;y1、y2、y3、y4分别表示第一至第四敏感元件的中心在手术器械坐标系{q}之y轴上的坐标值;z1、z2、z3、z4分别表示第一至第四敏感元件的中心在手术器械坐标系{q}之z轴上的坐标值。
根据式(1-5)下对沿某方向的冗余力的个数的定义,在本实施例中,x轴方向的力,沿x轴方向,在力的传导路径上只被测量一次,所以nx=1。同理,对沿某方向的冗余力矩的个数的定义,在本实施例中,ny'=1,nz'=1。结合式(1-5)、(1-6)和(1-7),可以得到手术器械末端所受的接触力为:
由上述式(1-8),可以得到手术器械末端沿手术器械坐标系{q}之x轴的力(轴向力),以及沿手术器械坐标系{q}之y轴与沿手术器械坐标系{q}之z轴的力矩,即
由式(1-9)可知,在力传感器400上布置四个敏感元件402,可实现一个、二个或三个方向上力的测量。具体来说,当z1、z2、z3、z4均取值为零时,沿手术器械坐标系之y轴的力矩.Mpy即为零;当y1、y2、y3、y4均取值为零时,沿手术器械坐标系之z轴的力矩Mpz即为零;当然,x1、x2、x3、x4的取值均为零且各自不相同。
本实施例中,可根据测量需要,预先在系统中获取各个敏感元件在手术器械坐标系{q}下的坐标值,并根据这些坐标值来确定各个敏感元件在套管上的安装位置,从而满足一维至多维力的测量。当仅需要测量一维的接触力时,可令各个敏感元件在y轴以及z轴上的坐标均为零;当需要测量多维的接触力时,可令各个敏感元件在y轴上的坐标不为零,或者在z轴上的坐标不为零,亦可y轴和z轴上的坐标均不为零,从而实现二维或三维力的测量。然后,根据安装需要设计套管结构,将镂空结构中不需要安装敏感元件的部分机加工去除形成柔顺结构4011,使得一个套管截面上的力通过柔顺结构4011传递。
上述实施例对力传感器的测量原理进行了详细说明,当然,本发明包括但不局限于上述实施中所列举的构型,任何在上述实施例提供的构型基础上进行变换的内容,均属于本发明所保护的范围。本领域技术人员可以根据上述实施例的内容举一反三。
此外,本实施例的力传感器不限于三维力的测量(即一维力和二维力矩),亦可以是二维力,甚至是六维力(即三维力和三维力矩)的测量,对于多维力的测量,所述敏感元件的数量至少不小于接触力的维数。在具体设计传感器时,首先需要确定测力的维数,如需要测量n维力,则至少需要n个相互独立的敏感元件;其次,可以先设定敏感元件的安装位置和朝向为未知数,推导出最终的测力计算公式(如式(1-10));根据测量力的方向确定敏感元件的安装方式,如需要测量x方向的力,则通过合理的布置敏感元件的位置(即确定了x、y、z坐标)和朝向(即确定了fx,fy,fz),保证该方向上的表达式不为0,即实现了该方向上力的测量;最后根据相互独立的敏感元件设计柔顺结构的方位,需保证的位置和朝向与敏感元件的位置和朝向相同。以上所述为基本要求,在工程实际中,为了提高结构强度及可靠性可以一个圆周上设计出如本文所述的镂空结构,由多个(>=2)敏感元件组合完成某方向上力的测量。
综上所述,本发明提供的力传感器用于装载于手术器械的末端以测量手术器械末端的接触力,且该力传感器具有一个能够与手术器械固接的套管,套管的设置具有如下优点:
第一,针对一台手术所采用的多套手术器械,不同手术器械上可以安装同一个套管来传递手术器械的变形,与将敏感元件直接安装于手术器械的末端相比,套管的设置可以避免不同手术器械上敏感元件测量一致性所带来的测量差异,由此提升测量精度和测量的准确性;
第二,利用套管与手术器械连接,可以避免敏感元件随手术器械一同报废;由于手术器械本身是一种耗材,但敏感元件却可以重复利用,若将敏感元件与手术器械一同报废,显然不经济,提高了使用成本。
在本发明的一个较佳实施例中,多个敏感元件以预定的方式排布在套管的柔顺结构上,且每个敏感元件在手术器械坐标系下具有一个预设的坐标值,根据预设的坐标值可以确定各个敏感元件在柔顺结构上的安装位置,从而实现手术器械末端接触力的一维或多维的测量,这样的测量方式,仅需调整各个敏感元件相对于手术器械坐标系的位置即可实现接触力一维至多维的测量,接触力的测量更为方便和简单。
此外,本发明还提供了一种手术机器人系统,包括从端设备,所述从端设备包括机械臂以及上述的手术器械,所述机械臂的末端与所述手术器械可拆卸连接,并驱动所述手术器械围绕一不动点运动。进一步,所述手术机器人系统还包括主端设备和控制单元,所述主端设备包括示力装置,所述控制单元与所述主端设备和所述从端设备通讯连接,所述控制单元从所述手术器械的敏感元件获取所述末端执行器受到的接触力,并传输至所述示力装置。
所述示力装置可以是成像系统5,以在成像系统5中显示手术器械3的受力信息。所述示力装置也可以是设有马达的主手7,所述主手7接受手术器械3的受力信息后,作用于医生手部,以使医生能直接感受到手术器械3的受力。
进一步,所述从端设备包括内窥镜以及用于与所述内窥镜可拆卸连接的持镜臂。为了便于医生在内窥镜视野下了解手术器械的受力状况,还需将上述测量得到的手术器械末端的接触力转换到内窥镜坐标系下进行描述,这样便可获得手术器械末端所受到的接触力在内窥镜视野下的受力状态(包括力eF和力矩eM),从而便于医生根据反馈回的接触力调整相关的手术操作。
将得到的手术器械3受到的等效合力Fq和等效合力矩Mq依据下式(1-10)转换至内窥镜坐标系{e}下,即得到手术器械3受到的接触力F在内窥镜坐标系{e}下的描述。
其中,eF为内窥镜坐标系{e}下的等效合力;eM为内窥镜坐标系{e}下的等效合力矩;eR表示从手术器械坐标系{q}到内窥镜坐标系{e}下的旋转矩阵(即表示手术器械末端相对于内窥镜下的姿态);er=(rx ry rz)T表示手术器械坐标系{q}到内窥镜坐标系{e}下的位置矢量(即手术器械末端点相对于内窥镜末端点的位置);(·)T表示矩阵的转置;S(er)表示矢量er所对应的反对称矩阵。其中:
本实施例中,内窥镜坐标系{e}的原点位于内窥镜视场的中心。具体的,内窥镜坐标系{e}的原点设在内窥镜4的末端点处,且内窥镜坐标系{e}具有x轴、y轴和z轴,其中,内窥镜坐标系{e}的x轴取其机械臂2上内窥镜4镜面的垂直方向,可选地,内窥镜坐标系{e}的x轴的正方向为内窥镜4的近端(即与机械臂2连接的部位)指向内窥镜末端点的方向。内窥镜坐标系{e}的y轴为垂直于x轴方向,类似地,z轴的方向根据需要设定,内窥镜坐标系{e}的z轴根据右手法则确定。进一步优选,对于立体内窥镜,内窥镜坐标系{e}的y轴取两个镜面的中心连线。此处,由于内窥镜坐标系{e}建立的技术为本领域技术人员习知的技术,故而,本领域技术人员在本申请公开的内容基础上,应当知晓如何在内窥镜末端点处建立内窥镜坐标系{e},与此同时也应当知晓如何在手术器械末端点处建立手术器械坐标系{q},还应当知晓如何通过变换描述这些坐标系间的相对位置和姿态关系,来获得手术器械坐标系{q}下的手术器械的受到的接触力F在内窥镜坐标系{e}下的描述。
上述描述仅是对本发明较佳实施例的描述,并非对本发明范围的任何限定,本发明领域的普通技术人员根据上述揭示内容做的任何变更、修饰,均属于权利要求书的保护范围。

Claims (22)

1.一种手术器械,包括机械结构、套管和力传感器,其特征在于,
所述机械结构包括器械杆以及与所述器械杆的末端连接的末端执行器;
所述套管固定或可拆卸套接于所述器械杆的末端;
所述力传感器包括敏感元件以及与所述敏感元件连接的外围测量模块,所述敏感元件设置于所述套管上,用于获取所述套管的变形信息;
所述外围测量模块根据所述敏感元件获取的变形信息,获得所述敏感元件测量得到的应力,并根据所述敏感元件测量得到的应力、所述敏感元件的位置以及所述敏感元件的敏感轴方向,获得所述套管受到的所述器械杆对其作用力的等效合力以及所述作用力的等效力矩,进而获得所述手术器械的末端执行器受到的接触力。
2.如权利要求1所述的手术器械,其特征在于,所述套管具有封闭的镂空结构,所述镂空结构包含多个柔顺结构,用于连接位于所述镂空结构上侧部分的套管和位于镂空结构下侧部分的套管;
所述敏感元件置于所述柔顺结构上,用于测量所述柔顺结构的应力。
3.如权利要求2所述的手术器械,其特征在于,所述柔顺结构的弹性模量不大于所述器械杆的弹性模量。
4.如权利要求2所述的手术器械,其特征在于,所述柔顺结构包括内表面、外表面和侧面,所述敏感元件设置于所述柔顺结构的内表面、外表面或侧面上。
5.如权利要求2所述的手术器械,其特征在于,所述镂空结构设置于所述套管的轴向中部位置。
6.如权利要求1所述的手术器械,其特征在于,所述敏感元件的敏感轴被布置为平行于所述套管的轴向或垂直于所述套管的轴向。
7.如权利要求1所述的手术器械,其特征在于,所述套管通过粘结、过盈配合或插接方式与所述器械杆的末端固定套接。
8.如权利要求1所述的手术器械,其特征在于,所述套管通过螺纹连接、锁扣连接或卡扣连接方式与所述器械杆的末端可拆卸套接。
9.如权利要求1所述的手术器械,其特征在于,所述套管的一端与所述器械杆的末端平齐。
10.如权利要求1所述的手术器械,其特征在于,所述外围测量模块包括依次连接的数据采集单元、信号调理单元和解算输出单元;所述数据采集单元用于获取所述敏感元件输出的信号,所述信号调理单元用于对所述敏感元件输出的信号进行调理,所述解算输出单元用于对经过调理的信号进行分析计算,以获得所述末端执行器受到的接触力。
11.如权利要求2所述的手术器械,其特征在于,所述敏感元件测量得到的应力大小为:
fi=g(εi)=k·εi+f(εi) i=1,2,…,n
其中,i表示第i个敏感元件,fi表示第i个敏感元件所测量得到的应力大小;εi表示在第i个敏感元件处的所述柔顺结构沿第i个敏感元件的敏感轴方向所产生的应变;g(εi)表示应力大小与应变之间所存在的函数关系;k表示在第i个敏感元件位置处的所述柔顺结构沿第i个敏感元件的敏感轴方向的应力大小/应变系数;f(εi)表示应力大小与应变之间所存在的非线性补偿项。
12.如权利要求11所述的手术器械,其特征在于,
所述接触力包括一空间等效合力Fq和一空间等效合力矩Mq
其中,所述外围测量模块在套管上建立套管坐标系{p},在手术器械末端建立手术器械坐标系{q},以及所述套管坐标系{p}在所述手术器械坐标系{q}下位置关系的描述和姿态关系的描述;
所述外围测量模块根据所述套管坐标系{p}在所述手术器械坐标系{q}下姿态关系的描述、所述敏感元件的敏感轴方向在所述套管坐标系{p}下的描述以及所述敏感元件测量得到的应力,获得所述敏感元件测量得到的应力在所述手术器械坐标系{q}下的描述,进而得到所述空间等效合力Fq
所述外围测量模块根据所述套管坐标系{p}在所述手术器械坐标系{q}下位置和姿态关系的描述、以及所述敏感元件的位置在所述套管坐标系{p}下的描述,获得所述敏感元件的位置在所述手术器械坐标系{q}下的描述;
所述外围测量模块根据所述敏感元件测量得到的应力在所述手术器械坐标系{q}下的描述,获得所述套管受到的力矩在所述手术器械坐标系{q}下的描述,进而得到所述空间等效合力矩Mq
13.如权利要求12所述的手术器械,其特征在于,
所述敏感元件测量得到的应力在所述套管坐标系{p}下的描述为:
(fxi,fyi,fzi)T=fiei=fi·(exi,eyi,ezi)T i=1,2,...,n
其中,ei为单位向量,表示第i个敏感元件的敏感轴方向在套管坐标系{p}下的描述,fi表示第i个敏感元件所测量得到的应力大小,fxi,fyi,fzi分别表示应力fi在套管坐标系{p}各个坐标轴方向的分量大小,exi,eyi,ezi分别表示单位向量ei在套管坐标系{p}各个坐标轴方向的分量。
14.如权利要求13所述的手术器械,其特征在于,
所述敏感元件测量得到的应力在所述手术器械坐标系{q}下的描述为:
fiqR(fiei)
其中,fi表示第i个敏感元件所测量得到的应力在手术器械坐标系{q}内的描述,qR表示所述套管坐标系{p}在所述手术器械坐标系{q}下姿态关系的描述;
所述空间等效合力Fq为:
其中,diag(·)表示以向量·中元素为对角元素的对角矩阵,nx,ny,nz表示沿x、y、z轴方向冗余力的个数。
15.如权利要求12或13所述的手术器械,其特征在于,
所述敏感元件的位置在所述手术器械坐标系{q}下的描述为:
ri=rp+qRpri
其中,ri表示第i个敏感元件的位置在手术器械坐标系{q}下的描述,pri表示第i个敏感元件的位置在套管坐标系{p}下的描述,qR表示所述套管坐标系{p}在所述手术器械坐标系{q}下姿态关系的描述,rp表示所述套管坐标系{p}在手术器械坐标系{q}下位置关系的描述。
16.如权利要求15所述的手术器械,其特征在于,
所述空间等效合力矩Mq为:
其中,nx',ny',nz'表示沿x、y、z轴方向冗余力矩的个数。
17.如权利要求13所述的手术器械,其特征在于,
所述镂空结构包括四个柔顺结构,四个所述柔顺结构周向布置,所述力传感器包括四个敏感元件,每个柔顺结构的外表面布置一个所述敏感元件,四个所述敏感元件的敏感轴方向在所述套管坐标系{p}中的描述e1,e2,e3,e4,均为(1,0,0)T
四个所述敏感元件所测量得到的应力在所述手术器械坐标系{q}下的描述为:
其中,fx1、fx2、fx3、fx4分别表示第一至第四敏感元件各自在手术器械坐标系{q}的x轴方向上测量得到的应力大小;
所述空间等效合力Fq为:
Fq=(f1+f2+f3+f4)。
18.如权利要求17所述的手术器械,其特征在于,
所述套管坐标系{p}在手术器械坐标系{q}下姿态关系的描述qR为单位矩阵;
所述敏感元件的位置以所述敏感元件的中心位置计量,所述敏感元件的中心位置在手术器械坐标系{q}下的描述为:
其中,pr1,pr2,pr3,pr4为四个所述敏感元件的中心位置在套管坐标系{p}下的描述,rp表示所述套管坐标系{p}在手术器械坐标系{q}下位置关系的描述,x1、x2、x3、x4分别表示第一至第四敏感元件的中心位置在手术器械坐标系{q}之x轴上的坐标值;y1、y2、y3、y4分别表示第一至第四敏感元件的中心位置在手术器械坐标系{q}之y轴上的坐标值;z1、z2、z3、z4分别表示第一至第四敏感元件的中心位置在手术器械坐标系{q}之z轴上的坐标值,r1、r2、r3、r4分别表示第一至第四敏感元件的位置在手术器械坐标系{q}下的描述。
19.如权利要求18所述的手术器械,其特征在于,
所述空间等效合力矩Mq
Mq=(r1×f1+r2×f2+r3×f3+r4×f4)。
20.一种手术机器人系统,其特征在于,包括从端设备;
所述从端设备包括:
机械臂;以及
如权利要求1~19中任一项所述的手术器械;
所述机械臂的末端与所述手术器械可拆卸连接,并驱动所述手术器械围绕一不动点运动。
21.如权利要求20所述的手术机器人系统,其特征在于,所述手术机器人系统还包括主端设备和控制单元;所述主端设备包括示力装置;
所述控制单元与所述主端设备和所述从端设备通讯连接,所述控制单元从所述手术器械的所述敏感元件获取所述末端执行器受到的接触力,并传输至所述示力装置。
22.如权利要求20或21所述的手术机器人系统,其特征在于,所述从端设备还包括:
内窥镜;以及
用于与所述内窥镜可拆卸连接的持镜臂;
所述外围测量模块建立套管坐标系{p}、手术器械坐标系{q}、内窥镜坐标系{e},以及所述手术器械坐标系{q}到所述内窥镜坐标系{e}下的旋转矩阵eR,并表示所述手术器械坐标系{q}到所述内窥镜坐标系{e}下的位置矢量er=(rx ry rz)T,进而得到所述末端执行器的接触力在所述内窥镜坐标系{e}下的描述:
其中,eF为内窥镜坐标系{e}下的合力;eM为内窥镜坐标系{e}下的合力矩;S(er)表示矢量er所对应的反对称矩阵;Fq为末端执行器的接触力的空间等效合力;Mq为末端执行器的接触力的空间等效合力矩;
CN201810218810.2A 2018-03-16 2018-03-16 手术机器人系统及其手术器械 Active CN108433814B (zh)

Priority Applications (8)

Application Number Priority Date Filing Date Title
CN201810218810.2A CN108433814B (zh) 2018-03-16 2018-03-16 手术机器人系统及其手术器械
BR112020018780-1A BR112020018780A2 (pt) 2018-03-16 2019-03-05 sistema de robô cirúrgico e instrumento ciúrgico do mesmo
EP19766462.6A EP3766449B1 (en) 2018-03-16 2019-03-05 Surgical robot system and surgical instrument thereof
PCT/CN2019/077059 WO2019174496A1 (zh) 2018-03-16 2019-03-05 手术机器人系统及其手术器械
US16/981,514 US20210186638A1 (en) 2018-03-16 2019-03-05 Surgical robot system and surgical instrument thereof
RU2020133833A RU2751753C1 (ru) 2018-03-16 2019-03-05 Роботизированная хирургическая система и ее хирургический инструмент
JP2020549685A JP2021517040A (ja) 2018-03-16 2019-03-05 手術ロボットシステム及びその手術器具
JP2023015112A JP7455245B2 (ja) 2018-03-16 2023-02-03 手術ロボットシステム及びその手術器具

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810218810.2A CN108433814B (zh) 2018-03-16 2018-03-16 手术机器人系统及其手术器械

Publications (2)

Publication Number Publication Date
CN108433814A CN108433814A (zh) 2018-08-24
CN108433814B true CN108433814B (zh) 2019-12-24

Family

ID=63195601

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810218810.2A Active CN108433814B (zh) 2018-03-16 2018-03-16 手术机器人系统及其手术器械

Country Status (7)

Country Link
US (1) US20210186638A1 (zh)
EP (1) EP3766449B1 (zh)
JP (2) JP2021517040A (zh)
CN (1) CN108433814B (zh)
BR (1) BR112020018780A2 (zh)
RU (1) RU2751753C1 (zh)
WO (1) WO2019174496A1 (zh)

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108433814B (zh) * 2018-03-16 2019-12-24 微创(上海)医疗机器人有限公司 手术机器人系统及其手术器械
WO2021147268A1 (zh) * 2020-01-23 2021-07-29 诺创智能医疗科技(杭州)有限公司 手术机械臂及手术机器人
CN111202561B (zh) * 2020-03-01 2020-11-03 首都医科大学宣武医院 一种具有感受功能的手术机器人操作杆
CN111991087B (zh) * 2020-09-10 2022-02-11 苏州大学 一种微创手术机器人及其末端执行器
CN112386211B (zh) * 2020-11-16 2021-07-09 清华大学 柔性内窥镜装置
CN112603546A (zh) * 2020-12-24 2021-04-06 哈尔滨思哲睿智能医疗设备有限公司 一种基于腹腔镜手术机器人的远程手术系统及控制方法
CN115624356A (zh) * 2021-02-10 2023-01-20 诺创智能医疗科技(杭州)有限公司 手术器械控制方法、装置和电子装置
CN113967072B (zh) * 2021-10-21 2022-12-09 哈尔滨工业大学 一种适用于杆状医疗器械的三维力检测夹持机构
CN113940712B (zh) * 2021-12-21 2022-03-15 极限人工智能有限公司 手术控制系统及方法
CN115153846A (zh) * 2022-06-09 2022-10-11 瑞龙诺赋(上海)医疗科技有限公司 一种手术机器人及手术机器人器械末端受力计算方法
CN116327372A (zh) * 2023-04-10 2023-06-27 极限人工智能有限公司 一种具有触力反馈的手术器械、方法及手术机器人

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102274077A (zh) * 2011-05-09 2011-12-14 无锡佑仁科技有限公司 微创血管介入手术机器人
CN106041926A (zh) * 2016-06-12 2016-10-26 哈尔滨工程大学 一种基于卡尔曼滤波器的工业机械臂力/位置混合控制方法
CN106625653A (zh) * 2016-05-23 2017-05-10 北京卫星环境工程研究所 基于力反馈的工业机器人辅助装配柔性对接方法
CN107009363A (zh) * 2017-06-09 2017-08-04 微创(上海)医疗机器人有限公司 医疗机器人及其控制方法
CN107028663A (zh) * 2017-04-18 2017-08-11 中国科学院重庆绿色智能技术研究院 一种新型主从式手术机器人控制方法
CN107049492A (zh) * 2017-05-26 2017-08-18 微创(上海)医疗机器人有限公司 手术机器人系统及手术器械位置的显示方法

Family Cites Families (26)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8182469B2 (en) * 1997-11-21 2012-05-22 Intuitive Surgical Operations, Inc. Surgical accessory clamp and method
US9155544B2 (en) * 2002-03-20 2015-10-13 P Tech, Llc Robotic systems and methods
JP3727937B2 (ja) * 2003-09-30 2005-12-21 株式会社東芝 力覚検出装置及びマニピュレータ
US8945095B2 (en) * 2005-03-30 2015-02-03 Intuitive Surgical Operations, Inc. Force and torque sensing for surgical instruments
US8496647B2 (en) * 2007-12-18 2013-07-30 Intuitive Surgical Operations, Inc. Ribbed force sensor
US7752920B2 (en) * 2005-12-30 2010-07-13 Intuitive Surgical Operations, Inc. Modular force sensor
EP1965717B1 (en) * 2005-12-30 2012-05-16 Intuitive Surgical Operations, Inc. Surgical instrument with modular force sensor
US8567265B2 (en) * 2006-06-09 2013-10-29 Endosense, SA Triaxial fiber optic force sensing catheter
GB0620944D0 (en) * 2006-10-20 2006-11-29 Insensys Ltd Curvature measurement moving relative to pipe
EP1915963A1 (en) * 2006-10-25 2008-04-30 The European Atomic Energy Community (EURATOM), represented by the European Commission Force estimation for a minimally invasive robotic surgery system
US9895813B2 (en) * 2008-03-31 2018-02-20 Intuitive Surgical Operations, Inc. Force and torque sensing in a surgical robot setup arm
EP2127604A1 (en) * 2008-05-30 2009-12-02 Nederlandse Organisatie voor toegepast- natuurwetenschappelijk onderzoek TNO An instrument for minimally invasive surgery
US8491574B2 (en) 2009-03-30 2013-07-23 Intuitive Surgical Operations, Inc. Polarization and temperature insensitive surgical instrument force transducer
US8649847B1 (en) * 2009-05-04 2014-02-11 Intelligent Fiber Optic Systems, Inc. Steerable shape sensing biopsy needle and catheter
US8887595B2 (en) * 2009-12-22 2014-11-18 Intuitive Surgical Operations, Inc. Instrument wrist with cycloidal surfaces
CN102151179B (zh) * 2011-05-13 2012-07-04 南开大学 用于微创外科手术机器人的三维力传感器
KR101839444B1 (ko) * 2011-10-31 2018-04-27 삼성전자 주식회사 힘 측정 장치 및 상기 힘 측정 장치를 포함하는 로봇 팔
RU122326U1 (ru) * 2012-01-18 2012-11-27 Олег Владимирович Галимов Роботическая система для проведения эндовидеохирургических операций
CN104244808B (zh) * 2012-04-04 2017-08-04 布鲁塞尔大学 光学力传感器
CN104764552B (zh) 2015-04-09 2017-09-26 上海交通大学 一种用于手术操作力感知的力敏传感器
JP6864011B2 (ja) * 2016-02-02 2021-04-21 インテュイティブ サージカル オペレーションズ, インコーポレイテッド ファラデーケージに歪みゲージを使用する器具力センサ
CN106264719B (zh) * 2016-07-29 2019-07-23 上海微创电生理医疗科技股份有限公司 电生理导管
CN106618736B (zh) * 2016-12-16 2019-03-08 微创(上海)医疗机器人有限公司 具有双自由度的机械臂和手术机器人
JP6935814B2 (ja) * 2017-03-10 2021-09-15 ソニーグループ株式会社 手術用システム、外科手術システム、外科手術用器具、並びに外力検知システム
CN108042162B (zh) * 2017-12-21 2020-06-16 微创(上海)医疗机器人有限公司 手术机器人系统及其手术器械
CN108433814B (zh) * 2018-03-16 2019-12-24 微创(上海)医疗机器人有限公司 手术机器人系统及其手术器械

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102274077A (zh) * 2011-05-09 2011-12-14 无锡佑仁科技有限公司 微创血管介入手术机器人
CN106625653A (zh) * 2016-05-23 2017-05-10 北京卫星环境工程研究所 基于力反馈的工业机器人辅助装配柔性对接方法
CN106041926A (zh) * 2016-06-12 2016-10-26 哈尔滨工程大学 一种基于卡尔曼滤波器的工业机械臂力/位置混合控制方法
CN107028663A (zh) * 2017-04-18 2017-08-11 中国科学院重庆绿色智能技术研究院 一种新型主从式手术机器人控制方法
CN107049492A (zh) * 2017-05-26 2017-08-18 微创(上海)医疗机器人有限公司 手术机器人系统及手术器械位置的显示方法
CN107009363A (zh) * 2017-06-09 2017-08-04 微创(上海)医疗机器人有限公司 医疗机器人及其控制方法

Also Published As

Publication number Publication date
EP3766449A4 (en) 2021-05-19
EP3766449A1 (en) 2021-01-20
WO2019174496A1 (zh) 2019-09-19
CN108433814A (zh) 2018-08-24
JP7455245B2 (ja) 2024-03-25
RU2751753C1 (ru) 2021-07-16
BR112020018780A2 (pt) 2020-10-13
US20210186638A1 (en) 2021-06-24
EP3766449B1 (en) 2023-05-24
JP2023052883A (ja) 2023-04-12
JP2021517040A (ja) 2021-07-15

Similar Documents

Publication Publication Date Title
CN108433814B (zh) 手术机器人系统及其手术器械
JP5700584B2 (ja) 手術器具のための力およびトルクセンサー
CN107961078B (zh) 手术机器人系统及其手术器械
US9549781B2 (en) Multi-force sensing surgical instrument and method of use for robotic surgical systems
EP3685787B1 (en) Surgical robot system
KR101615539B1 (ko) 수술 로봇 셋업 암에서의 힘과 토크의 감지
Fontanelli et al. A novel force sensing integrated into the trocar for minimally invasive robotic surgery
CN108210078B (zh) 手术机器人系统
JP7127128B2 (ja) 手術ロボットシステム及びその手術器具
Fontanelli et al. An external force sensing system for minimally invasive robotic surgery
WO2009094670A1 (en) Systems and methods for force sensing in a robot
Noh et al. Optical force and torque sensor for flexible robotic manipulators
Wang et al. FBG sensors monitoring force and deformation of the traction instrument in pelvic fracture reduction surgery
US20110137330A1 (en) Surgical intervention device comprising an instrument likely to deform
Althoefer et al. Force sensing in medical robotics

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
CP03 Change of name, title or address
CP03 Change of name, title or address

Address after: Room 101, block B, building 1, No. 1601, Zhangdong Road, China (Shanghai) pilot Free Trade Zone, Pudong New Area, Shanghai, 201203

Patentee after: Shanghai minimally invasive medical robot (Group) Co.,Ltd.

Address before: 201203, 501, Newton Road, Zhangjiang hi tech park, Shanghai, Pudong New Area

Patentee before: Microport (Shanghai) Medbot Co.,Ltd.