CN105232155B - 手术机器人调整*** - Google Patents
手术机器人调整*** Download PDFInfo
- Publication number
- CN105232155B CN105232155B CN201510567702.2A CN201510567702A CN105232155B CN 105232155 B CN105232155 B CN 105232155B CN 201510567702 A CN201510567702 A CN 201510567702A CN 105232155 B CN105232155 B CN 105232155B
- Authority
- CN
- China
- Prior art keywords
- arm
- target mirror
- coordinate system
- optics target
- mechanical arm
- 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
Links
Landscapes
- Manipulator (AREA)
Abstract
本发明提供了一种手术机器人调整***,通过在每个机械臂上均设置光学靶镜,利用光学跟踪仪测量光学靶镜的位置和欧拉角,计算模块根据上述测量值,计算获得光学靶镜之间的姿态映射关系,根据上述光学靶镜之间的姿态映射关系,以及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,计算出手术器械臂之间的姿态映射关系。手术机器人根据手术器械臂之间的姿态映射关系,对相应的手术器械臂进行位姿控制,提高了手术机器人的运动控制精度。
Description
技术领域
本发明涉及医疗器械技术领域,特别涉及一种手术机器人调整***。
背景技术
在二十世纪初产生了以腹腔镜为代表的微创伤外科手术,即医生通过细长的手术工具通过人体表面的微小切口深入到人体内部进行手术操作,但该种腹腔镜手术技术存在着工具自由度缺少、反向操作协调性差、缺乏立体视觉的缺陷。
基于上述腹腔镜手术技术存在的缺陷,计算机辅助手术***受到了国内外医生的青睐,其中尤其以微创伤外科手术机器人***最为突出。
在微创伤手术过程中,针对不同的手术部位和不同的手术操作,需要手术开始阶段通过调整手术机器人的操作位置,以使得医生能更加方便、顺利地完成手术操作。专利CN102579133A中描述的da Vinci手术***,请参考图1,如图1所示,手术机器人调整***总共有四条机械臂(图中标号分别为①、②、③、④),每条机械臂均包括调整臂2’(图中四条机械臂的调整臂标号为:2’-1、2’-2、2’-3、2’-4)与所述调整臂2’连接的主动臂3’(图中四条机械臂的主动臂标号为:3’-1、3’-2、3’-3、3’-4)、及与所述主动臂3’连接的手术器械臂4’(图中四条机械臂的手术器械臂标号为4’-1、4’-2、4’-3、4’-4),调整臂2’固定于底座,上用于在术前调整机械臂的整***置,主动臂用于进一步调整与之相连的手术器械臂的整***置,手术器械臂用于对患者5’进行微创伤手术,调整臂2’,主动臂3’,手术器械臂4’之间及其内部各构件之间通过关节连接。而微创伤外科手术机器人***中各个关节的精度影响和决定着整个机器人***的运动精度和工作性能。其中,手术机器人调整***的精度又对整个***的控制精度影响很大。在微创伤手术过程中,任何关节的不精确测量都会造成手术过程中病变组织切除乃至打结缝合等复杂操作的不准确性,影响整个手术的成功甚至是对病人造成额外的伤害。同时在微创伤手术中,手术器械都是通过一个较小的口子进入人体内部需要治疗的部位,因此手术部位空间狭小,需要精确控制手术器械之间位置,防止发生碰撞。
目前在国际上,美国、法国、德国、日本等都相继开展了微创伤外科手术机器人的研究,并产生一系列样机。但这些样机结构相似或者相同,手术机器人调整***通常采用关节传感器对机械臂的各个关节进行单独测量以实现对机械臂的定位,例如电位器、编码器等。该种测量方式虽然简单方便,但存在着以下缺点:1)由于机械臂的关节过多,每个关节均需要应用关节传感器,因此应用关节传感器数量较多,增加了成本;2)电位器、编码器的精度不高,多关节的串联计算会降低整条机械臂的定位精度,从而影响整个机器人的控制精度;3)电位器容易受外力的影响,导致测量精度不准确。因此,发明一种新的手术机器人调整***,对于提高手术机器人的控制精度有着非常重要的实际意义。
发明内容
本发明的目的在于提供一种手术机器人调整***,以解决使用现有技术中机械臂的每个关节均采用关节传感器实现对手术机器人机械臂的定位过程中,存在误差累计,导致整条机械臂的定位精度降低,从而影响整个机器人的控制精度的问题。
为解决上述技术问题,本发明提供一种手术机器人调整***包括:
底座及固定在所述底座上的至少一个机械臂,每个所述机械臂包括依次连接的调整臂、主动臂及手术器械臂,所述调整臂与所述底座相连,
光学跟踪***,所述光学跟踪***包括光学靶镜及光学跟踪仪,每个机械臂上均设置有所述光学靶镜,所述光学跟踪仪测量光学靶镜的位置和欧拉角;
计算模块,根据上述测量值,计算获得光学靶镜之间的姿态映射关系,并根据所述光学靶镜之间的姿态映射关系,及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,计算出手术器械臂之间的姿态映射关系。
可选的,在所述的手术机器人调整***中,所述光学靶镜设置于所述主动臂或所述调整臂上。
可选的,在所述的手术机器人调整***中,所述计算模块采用运动学方程计算每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系。
可选的,在所述的手术机器人调整***中,所述机械臂各个组成部分通过关节连接,所述运动学方程如下:
CnRX=Rz(nθ1)*Rz(nθ2)*Rz(nθ3)*...*Rz(nθm)
式中,n代表机械臂的序号,m代表机械臂的关节序号,CnRX代表n号机械臂的手术器械臂的坐标系在n号机械臂上的光学靶镜坐标系的姿态映射关系,Rz(nθm)代表n号机械臂的第m个关节的旋转算子,其中,n≥1,m≥1。
可选的,在所述的手术机器人调整***中,所述手术器械臂之间的姿态映射关系采用如下式子获得:
TmRTn=TmRKm*(CRKm)-1*CRKn*(TnRKn)-1
式中,TmRKm代表采用运动学方程获得第m个机械臂上的光学靶镜坐标系在第m个机械臂上的手术器械臂坐标系下的描述;CRKm代表第m个机械臂上的光学靶镜坐标系相对于光学跟踪仪坐标系的变化关系;CRKn代表第n个机械臂上的光学靶镜的坐标系相对于光学跟踪仪坐标系的变化关系;TnRKn代表采用运动学方程获得的第n个机械臂上的光学靶镜的坐标系在第n个机械臂上的手术器械臂的坐标系下的描述。
可选的,在所述的手术机器人调整***中,一个机械臂的所述手术器械臂为内窥镜臂,其余机械臂的所述手术器械臂为工具臂。
可选的,在所述的手术机器人调整***中,所述工具臂相对于内窥镜臂的姿态映射关系通过如下步骤获得:
将内窥镜臂所在的机械臂上的光学靶镜设定为基点光学靶镜,其余机械臂上的光学靶镜为其余光学靶镜;
利用光学跟踪仪测量光学靶镜的位置和欧拉角;
所述计算模块根据上述测量值,计算获得其余光学靶镜与所述基点光学靶镜之间的姿态映射关系,并根据上述其余光学靶镜与所述基点光学靶镜之间的姿态映射关系,以及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,计算获得工具臂的坐标系在内窥镜臂坐标系下的姿态映射关系。
可选的,在所述的手术机器人调整***中,所述工具臂的坐标系在内窥镜臂坐标系下的姿态映射关系采用如下式子获得:
ERT=ERM*(CRM)-1*CRK*(TRK)-1,
式中,TRK代表手术器械臂为工具臂时,采用运动学方程获得该工具臂所在的机械臂上的光学靶镜的坐标系在该工具臂坐标系下的描述;CRK代表该工具臂所在的机械臂上的光学靶镜的坐标系相对于光学跟踪仪坐标系的变化关系;CRM代表手术器械臂为内窥镜臂时,该内窥镜所在的机械臂上的光学靶镜的坐标系相对于光学跟踪仪坐标系的变化关系;ERM代表采用运动学方程获得的内窥镜臂所在的机械臂上的光学靶镜的坐标系在所述内窥镜臂的坐标系下的描述。
可选的,在所述的手术机器人调整***中,所述底座的数量为至少一个。
可选的,在所述的手术机器人调整***中,所述调整臂的自由度大于2,所述主动臂的自由度大于1。
在本发明所提供的手术机器人调整***中,光学跟踪***包括光学靶镜及光学跟踪仪,每个机械臂上均设置有光学靶镜,光学跟踪仪测量光学靶镜的位置和欧拉角,计算模块根据上述光学跟踪仪测量得到的测量值,计算获得光学靶镜之间的姿态映射关系,并根据上述计算得到的光学靶镜之间的姿态映射关系,及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,计算出手术器械臂之间的姿态映射关系。手术机器人根据手术器械臂之间的姿态映射关系,实现对相应的手术器械臂进行位姿控制,提高了手术机器人的运动控制精度及手术成功率,防止在手术过程中手术器械臂在视野之外处发生碰撞。与此同时,利用光学跟踪***得到手术机器人任意两条机械臂之间的位姿关系,无需在光学靶镜与底座之间的机械臂的关节上设置关节传感器,即可达到实时跟踪两个调整臂之间的相对位置和姿态的目的,避免多个关节的串联计算对整条机械臂的定位精度造成的影响,使得微创外科手术机器人任意两个机械臂或者多台病人端手术机器人之间能够实现精确地位姿控制。
附图说明
图1是现有的手术机器人调整***的结构示意图;
图2是本发明实施例一中光学靶镜设置于调整臂末端时,手术机器人调整***的结构示意图;
图2a是图2中标有笛卡尔坐标系的示意图;
图3是本发明实施例二中光学靶镜设置于主动臂上时,手术机器人调整***的结构示意图;
图3a是图3中标有笛卡尔坐标系的示意图;
图4是本发明实施例三中光学靶镜设置于主动臂和调整臂末端上时,手术机器人调整***的结构示意图。
图中,底座1’,1,1”,1”’;调整臂2’-1,2’-2,2’-3,2’-4,2-1,2-1’,2-1”,2-2;主动臂3’-1,3’-2,3’-3,3’-4,3-1,3-1’,3-1”,3-2;手术器械臂4’-1,4’-2,4’-3,4’-4,4-1,4-1’,4-1”,4-2;光学靶镜6-1,6-1’,6-1”,6-2;光学跟踪仪7。
具体实施方式
以下结合附图和具体实施例对本发明提出的手术机器人调整***作进一步详细说明。根据下面说明和权利要求书,本发明的优点和特征将更清楚。需说明的是,附图均采用非常简化的形式且均使用非精准的比例,仅用以方便、明晰地辅助说明本发明实施例的目的。
实施例一
请参考图2,图2为本发明实施例一中光学靶镜设置于调整臂末端时,手术机器人调整***的结构示意图。如图2所示,所述的手术机器人调整***包括:底座1及固定在所述底座1上的至少一个机械臂,每个所述机械臂包括依次连接的调整臂(图中标号为2-1、2-2)、主动臂(图中标号为3-1、3-2)及手术器械臂(图中标号为4-1、4-2),所述调整臂与所述底座1相连,相比现有技术的手术机器人调整***,本发明的手术机器人调整***还包括计算模块、光学跟踪***,所述光学跟踪***包括光学靶镜(图中标号为6-1、6-2)及光学跟踪仪7,每个机械臂上设置均有所述光学靶镜,所述光学跟踪仪7测量光学靶镜的位置和欧拉角,计算模块根据光学跟踪仪7测得的测量值,计算获得光学靶镜之间的姿态映射关系,并根据上述计算得到的光学靶镜之间的姿态映射关系,及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,进而计算出手术器械臂之间的姿态映射关系。手术机器人根据手术器械臂之间的姿态映射关系,实现对相应的手术器械臂进行位姿控制。
本实施例中,所述光学靶镜设置于所述调整臂上,优选的,光学靶镜设置于所述调整臂的末端。由于光学靶镜的设置,使得光学靶镜与底座1之间的机械臂的关节上无需采用关节传感器测量,即可达到实时跟踪两个调整臂之间的相对位置和姿态的目的,避免多个关节的串联计算误差的累积对整条机械臂的定位精度造成的影响,使得微创外科手术机器人任意两个机械臂或者多台病人端手术机器人之间能够实现精确地位姿控制。
进一步地,所述机械臂各个组成部分(即调整臂、主动臂及手术器械臂)通过关节连接,所述计算模块采用运动学方程计算每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系。其中,所述运动学方程如下:
CnRX=Rz(nθ1)*Rz(nθ2)*Rz(nθ3)...Rz(nθm)
式中,n代表机械臂的序号,m代表机械臂的关节序号,C代表当前机械臂上光学靶镜的坐标系,X代表当前机械臂上的手术器械臂的坐标系,CnRX代表n号机械臂的手术器械臂的坐标系在n号机械臂上的光学靶镜坐标系的姿态映射关系,Rz(nθm)代表n号机械臂的第m个关节的旋转算子,通过光学靶镜与手术器械臂之间机械臂上的关节传感器获得,其中,n≥1,m≥1。
其中,所述手术器械臂之间的姿态映射关系采用如下式子获得:
TmRTn=TmRKm*(CRKm)-1*CRKn*(TnRKn)-1
式中,TmRKm代表采用运动学方程获得第m个机械臂上的光学靶镜坐标系在第m个机械臂上的手术器械臂坐标系下的描述;CRKm代表第m个机械臂上的光学靶镜坐标系相对于光学跟踪仪坐标系的变化关系;CRKn代表第n个机械臂上的光学靶镜的坐标系相对于光学跟踪仪坐标系的变化关系;TnRKn代表采用运动学方程获得的第n个机械臂上的光学靶镜的坐标系在第n个机械臂上的手术器械臂的坐标系下的描述。
本实施例中,所述手术机器人调整***的一个机械臂的所述手术器械臂为内窥镜臂,其余机械臂的所述手术器械臂为工具臂,例如手术刀,剪刀,烧灼器(单极或双极电烙器械)等。手术器械臂之间的姿态映射关系通过如下步骤获得:
将手术器械臂为内窥镜臂的机械臂上的光学靶镜设定为基点光学靶镜,其余机械臂上的光学靶镜为其余光学靶镜;
利用光学跟踪仪测量光学靶镜的位置和欧拉角;
计算模块根据光学跟踪仪测量得到的测量值,计算获得光学靶镜之间的姿态映射关系,并根据上述光学靶镜之间的姿态映射关系,及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,计算获得工具臂的坐标系在内窥镜臂坐标系下的映射关系。
进一步地,所述工具臂的坐标系在内窥镜臂坐标系下的映射关系采用如下式子获得:
ERT=ERM*(CRM)-1*CRK*(TRK)-1,
式中,TRK代表手术器械臂为工具臂时,采用运动学方程获得该工具臂所在的机械臂上的光学靶镜的坐标系在该工具臂坐标系下的描述;CRK代表调整该工具臂所在的机械臂上调整臂姿态变化时,根据光学跟踪仪测量原理求出的该工具臂所在的机械臂上的光学靶镜的坐标系相对于光学跟踪仪坐标系的变化关系;CRM代表手术器械臂为内窥镜臂时,根据光学跟踪仪测量原理求出的该内窥镜所在的机械臂上的光学靶镜的坐标系相对于光学跟踪仪坐标系的变化关系;ERM代表采用运动学方程获得的内窥镜臂所在的机械臂上的光学靶镜的坐标系在所述内窥镜臂的坐标系下的描述;其中,{K}为工具臂所在的机械臂上的光学靶镜的坐标系,{T}为工具臂坐标系,{C}为光学跟踪仪坐标系,{M}为内窥镜所在的机械臂上的光学靶镜的坐标系,{E}为内窥镜臂的坐标系。
为了较好的理解本发明的手术机器人调整***的具体结构,下面将请结合图2所示的内容进行详细的阐述,本实施例中的手术机器人的调整***包括两个底座1,四条机械臂,计算模块,光学跟踪***,其中,每两条机械臂设置于一个底座1上,调整臂的自由度大于2,大于3,大于4,等于3,等于4,等于5;所述主动臂的自由度大于1,大于2,大于3,大于4,等于2,等于3,等于4,等于5。由于两个底座上的结构相同,下面以左侧底座1上的结构为例,进行具体说明,本实施例中每条机械臂包括三自由度的调整臂(图中标号为2-1、2-2),两自由度的主动臂(图中标号为3-1、3-2),手术器械臂及光学跟踪***,具体的,调整臂2-1、2-2的近端与一个底座1相连,另外两个调整臂2-1’、2-1”的近端与另一个底座1”相连,调整臂2-1的远端与主动臂3-1近端相连,调整臂2-2远端与主动臂3-2近端相连;所述光学跟踪***,包括置于调整臂2-1和调整臂2-2远端方向的光学测量仪7,以及四个光学靶镜,四个光学靶镜中设定设置于手术器械臂类型为内窥镜臂所指的机械臂上的光学靶镜为基点光学靶镜(即图中标号为6-2的光学靶镜),除光学靶镜6-2之外的其余光学靶镜(图中标号为6-1、6-1’、6-1”)置于调整臂(图中标号为2-1、2-1’、2-1”)与主动臂(图中标号为3-1、3-1’、3-1”)的连接处(即调整臂2-1、2-1’、2-1”的末端),基点光学靶镜置于调整臂2-2与主动臂3-2的连接处;通过计算模块(图中未标出)根据计算得到的光学靶镜之间的姿态映射关系及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,计算出所有手术器械臂之间的姿态映射关系。具体的,光学跟踪仪7测量所有光学靶镜的位置和欧拉角,即获得以光学跟踪仪7为坐标原点的坐标系中所有光学靶镜6-1、6-1’、6-1”、6-2的坐标值,计算模块根据上述坐标值,计算光学靶镜6-2(即基点光学靶镜)与其他光学靶镜6-1、6-1’、6-1”之间的姿态映射关系。根据机械臂上靶镜所处的位置与机械臂远端的手术器械臂之间的连接方式,(本实施例中为光学靶镜6-1、6-1’、6-1”所处的主动臂3-1、3-1’、3-1”,主动臂3-2末端与手术器械臂4-1、4-1’、4-1”和手术器械臂4-2的连接关系),以及运动学方程,计算模块计算得到手术器械臂与对应的机械臂上的光学靶镜之间的姿态映射关系,例如手术器械臂4-1对应光学靶镜6-1,手术器械臂4-2对应光学靶镜6-2之间的姿态映射关系。进一步,计算模块根据上述的姿态映射关系,经过计算得到光学靶镜6-2对应的手术器械臂4-2与其他手术器械臂(例如手术器械臂4-1、4-1’、4-1”)的姿态映射关系。
为了较好的理解如何基于本发明的手术机器人调整***获得手术器械臂之间的姿态映射关系的。具体请参考图2a,为图2所示调整***的标有笛卡尔坐标系的示意图;基于图2a所示的笛卡尔坐标系最终可以获得手术器械臂4-1远端坐标系{T}在手术器械臂4-2远端坐标系{E}下的姿态映射关系,这里记为ERT。
具体分析及计算获得ERT的过程如下,图2a中展示了手术机器人任意两条机械臂坐标系之间的转换关系。其中,连接在底座1上的两条调整臂(图中标号为2-1、2-2)的基座坐标系分别设定为{H}和{B},一光学测量仪设置在调整臂2-1和调整臂2-2的远端,三自由度调整臂2-1末端坐标系设定为{K},三自由度调整臂2-2末端坐标系设定为{M},手术器械臂4-1(本实施例中标号为4-1、4-1’、4-1”的手术器械臂的类型为工具臂)远端坐标系设定为{T},手术器械臂4-2(本实施例中标号为4-2的手术器械臂的类型为内窥镜臂)远端坐标系设定为{M}以及光学跟踪仪主机端坐标系设定为{C}。
基于上述已经建立的笛卡尔坐标系,本发明所述的调整***如下具体操作:
一、根据手术情况调整好机器人调整臂和光学跟踪仪的位置。
二、使用光学跟踪仪测量出手术器械臂4-1所在机械臂上安装的光学靶镜6-1相对于光学测量仪坐标系{C}的姿态,以及手术器械臂4-2所在机械臂上安装的光学靶镜6-1相对与光学测量仪坐标系{C}的姿态,并得到光学靶镜6-1坐标系{K}和光学靶镜6-2坐标系{M}的姿态映射变换关系。
三、在手术过程中为医生远程操作手术器械,因此医生需要了解手术器械臂4-1远端坐标系在手术器械臂4-2远端坐标系下的映射。其求解关系由光学靶镜6-1和光学靶镜6-2之间坐标系转换和运动学关系求解而得的坐标系转换关系组成。具体而言,由运动学方程求解出手术器械臂4-1远端坐标系{T}在光学靶镜6-1坐标系{K}下的映射、光学靶镜6-1坐标系{K}在光学靶镜6-2坐标系{M}下的映射和光学靶镜6-2(即基点光学靶镜)坐标系{M}在手术器械臂4-2(本实施例中标号为4-2的手术器械臂的类型为内窥镜臂)远端坐标系{E}下的映射之间的转换关系就能得到手术器械臂4-1远端坐标系在手术器械臂4-2坐标系下的映射。
具体映射转换关系求解如下:
1)由运动学方程可以得出调整臂2-1末端坐标系{K}(相当于该机械臂上的光学靶镜6-1的坐标系)在工具臂4-1远端坐标系{T}下的描述,记为TRK;
2)在调整调整臂2-1位姿变化时,调整臂2-1末端坐标系{K}相对于光学跟踪仪坐标系{C}的变化关系可以根据光学跟踪仪测量原理求出,记为CRK;
3)在调整调整臂2-2位姿变化时,调整臂2-2末端坐标系{M}(相当于该机械臂上的光学靶镜6-2的坐标系)相对于光学跟踪仪坐标系{C}的变化关系可以根据光学跟踪仪测量原理求出,记为CRM;
4)由运动学方程可以得出调整臂2-2末端坐标系{M}在内窥镜臂4-2远端坐标系{E}下的描述,记为ERM。
最后通过坐标系转换关系可得,所求得的手术器械臂4-1远端坐标系{T}在内窥镜臂4-2远端坐标系{E}的旋转变换ERT为:
ERT=ERM*(CRM)-1*CRK*(TRK)-1
在一些实施例中,所述的运动学方程表达式如下:
CnRX=Rz(nθ1)*Rz(nθ2)*Rz(nθ3)...Rz(nθm)
式中,n代表机械臂的序号,m代表机械臂的关节序号,C代表当前机械臂上光学靶镜的坐标系,X代表当前机械臂上的手术器械臂的坐标系,CnRX代表n号机械臂的手术器械臂的坐标系在n号机械臂上的光学靶镜坐标系的姿态映射关系,Rz(nθm)代表n号机械臂的第m个关节的旋转算子,其中,n≥1,m≥1。
传统的调整方法为通过机械臂上的关节传感器得到手术器械臂4-1远端坐标系{T}在机械臂坐标系{H}下的映射,内窥镜臂4-2远端坐标系{E}在机械臂坐标系{B}下的映射,并根据已知的机械臂坐标系{H}与机械臂坐标系{B}的映射,最终得到手术器械臂4-1远端坐标系{T}在内窥镜臂4-2远端坐标系{E}的映射。显然,结合图2a的手术机器人调整臂坐标系之间的映射关系,本发明明显减少了三个坐标系的映射转换,即调整臂2-1远端坐标系{K}在其基座坐标系{H}下的映射、调整臂2-1基座坐标系{H}在调整臂2-2基座坐标系{B}下的映射、以及调整臂2-2基座坐标系{B}在调整臂2-2远端坐标系{M}下的映射,在一定程度上减少了计算量,从而提高了手术机器人的响应频率;此外,由于光学靶镜与底座1之间的机械臂的关节上无需设置关节传感器,也就是光学靶镜相当于替换了光学靶镜与底座1之间的机械臂的关节上的关节传感器,完成实时跟踪两个调整臂之间的相对位置和姿态的目的,降低了计算时由于多个关节的串联计算,关节传感器存在的测量误差的累积对整条机械臂的定位精度的造成的影响,特别对于自由度较大的串联机械臂,从而能够使微创外科手术机器人任意两个机械臂或者多台病人端手术机器人之间能够实现精确地位姿控制。
实施例二
请参考图3,其为本发明实施例二中光学靶镜设置于主动臂上时,手术机器人调整***的结构示意图。结合图3和图2对比分析可知,图3与图2的区别在于四个光学靶镜在机械臂上设置的具***置,图2中四个光学靶镜均设置于调整臂的末端,而图3中四个光学靶镜均设置于主动臂上,因此采用图3所示的手术机器人调整***时所需的传感器的数量会有所减少,降低了物力的消耗,降低了成本,并提高了机械臂的定位精度。具体的,如图3所示,光学靶镜6-2设置在主动臂3-2第一节点与第二节点之间的臂上,光学靶镜6-1设置在主动臂3-1的第一节点与第二节点之间的臂上,对于光学靶镜具体设置在主动臂上的哪个位置上,这里不做限定,只要四个光学靶镜均设置于主动臂上即可。由于光学靶镜的设置在主动臂上,使得光学靶镜与底座1之间的机械臂的关节上无需采用关节传感器测量,即可达到实时跟踪两个调整臂之间的相对位置和姿态的目的,避免了采用现有方式时,在光学靶镜与底座1之间的机械臂的每个关节上均需要设置关节传感器测量定位是,多个关节的串联计算会导致误差的累积会,最终对整条机械臂的定位精度造成的影响,使得微创外科手术机器人任意两个机械臂或者多台病人端手术机器人之间能够实现精确地位姿控制。
为了较好的理解如何基于本发明的手术机器人调整***计算获得手术器械臂之间的姿态映射关系的。具体请参考图3a,其是图3所示的调整***的标有笛卡尔坐标系的示意图;基于图3a所示的笛卡尔坐标系最终可以获得手术器械臂4-1远端坐标系{T}在手术器械臂4-2远端坐标系{E}下的姿态映射关系,这里记为ERT。根据图2a中的笛卡尔坐标系建立的原则,将光学跟踪仪的光学靶镜6-1、光学靶镜6-2分别设置在主动调整臂3-1、主动调整臂3-2上,其坐标系表示分别表示为坐标系{K}和坐标系{M};其余坐标系表示形式和图2a中表述一致,具体分析及计算获得ERT的过程请参考实施例一中相应的内容,由于原理相同,这里就不再做过多的赘述。
实施例三
请参考图4,其为本发明实施例三中光学靶镜设置于主动臂和调整臂末端上时,手术机器人调整***的结构示意图。相比实施例一及实施例二所阐述的结构的区别在于,光学靶镜6-1至于主动臂3-1的第一节点与第二节点之间的臂上,而光学靶镜6-2至于主动臂3-2和调整臂2-2的连接处,另一光学靶镜至于主动臂和调整臂的连接处。相当于将图2及图3中光学靶镜在机械臂上的位置的融合,即光学靶镜既有设置于调整臂上的,又有设置于主动臂上的。另外,手术机器人调整***的底座的数量及每个底座上设置的机械臂的数量与实施例一与二有所不同,图4所示的结构图中,手术机器人调整***的底座(图中标号为1,1”,1”’)为3个,每个底座上设置有一条机械臂。由此可见,本发明的手术机器人调整***的底座的数量为至少一个,每个底座上设置的机械臂条数可以为一条或多条,这里不对底座的数量及机械臂的条数做过多的限定,只要满足医生手术的需求,相应的设计底座及机械臂的数量即可。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。
本发明对光学跟踪仪的选择没有特别的限制,可以为现有技术中任一种。一般而言,光学跟踪仪都可以测量光学靶镜的位置和欧拉角。在一些实施例中,计算模块,根据光学跟踪仪测得的测量值,欧拉角坐标系的定义(具体由光学跟踪仪厂家提供),求出光学靶镜与光学跟踪仪之间的姿态映射关系,进一步求出光学靶镜之间的姿态映射关系。
综上,在本发明所提供的手术机器人调整***中,包括计算模块及光学跟踪***,光学跟踪***包括光学靶镜及光学跟踪仪,每个机械臂上均设置有光学靶镜,光学跟踪仪测量光学靶镜的位置和欧拉角,,计算模块根据上述测量值,计算获得光学靶镜之间的姿态映射关系,并根据计算得到的光学靶镜之间的姿态映射关系,以及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,计算出手术器械臂之间的姿态映射关系。手术机器人根据手术器械臂之间的姿态映射关系,实现对相应的手术器械臂进行位姿控制,提高了手术机器人的运动控制精度及手术成功率,防止在手术过程中手术器械臂在视野之外发生碰撞。与此同时,利用光学跟踪***得到手术机器人任意两条机械臂之间的位姿关系,无需在光学靶镜与底座之间的机械臂的关节上设置关节传感器,即可达到实时跟踪两个调整臂之间的相对位置和姿态的目的,避免多个关节的串联计算会对整条机械臂的定位精度造成的影响,使得微创外科手术机器人任意两个机械臂或者多台病人端手术机器人之间能够实现精确地位姿控制。
上述描述仅是对本发明较佳实施例的描述,并非对本发明范围的任何限定,本发明领域的普通技术人员根据上述揭示内容做的任何变更、修饰,均属于权利要求书的保护范围。
Claims (9)
1.一种手术机器人调整***,包括底座及固定在所述底座上的至少一个机械臂,每个所述机械臂包括依次连接的调整臂、主动臂及手术器械臂,所述调整臂与所述底座相连,其特征在于,还包括:
光学跟踪***,所述光学跟踪***包括光学靶镜及光学跟踪仪,每个机械臂上均设置有所述光学靶镜,所述光学靶镜设置于所述主动臂或所述调整臂上,所述光学跟踪仪测量光学靶镜的位置和欧拉角;
计算模块,根据所述光学靶镜的位置和欧拉角,计算获得光学靶镜之间的姿态映射关系,并根据所述光学靶镜之间的姿态映射关系,及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,计算出手术器械臂之间的姿态映射关系。
2.如权利要求1所述的手术机器人调整***,其特征在于,所述计算模块采用运动学方程计算每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系。
3.如权利要求2所述的手术机器人调整***,其特征在于,所述机械臂各个组成部分通过关节连接,所述运动学方程如下:
CnRX=Rz(nθ1)*Rz(nθ2)*Rz(nθ3)*...*Rz(nθm)
式中,n代表机械臂的序号,m代表机械臂的关节序号,CnRX代表n号机械臂的手术器械臂的坐标系在n号机械臂上的光学靶镜坐标系的姿态映射关系,Rz(nθm)代表n号机械臂的第m个关节的旋转算子,其中,n≥1,m≥1。
4.如权利要求3所述的手术机器人调整***,其特征在于,所述手术器械臂之间的姿态映射关系采用如下式子获得:
TmRTn=TmRKm*(CRKm)-1*CRKn*(TnRKn)-1
式中,TmRKm代表采用运动学方程获得第m个机械臂上的光学靶镜坐标系在第m个机械臂上的手术器械臂坐标系下的描述;CRKm代表第m个机械臂上的光学靶镜坐标系相对于光学跟踪仪坐标系的变化关系;CRKn代表第n个机械臂上的光学靶镜的坐标系相对于光学跟踪仪坐标系的变化关系;TnRKn代表采用运动学方程获得的第n个机械臂上的光学靶镜的坐标系在第n个机械臂上的手术器械臂的坐标系下的描述。
5.如权利要求3所述的手术机器人调整***,其特征在于,一个机械臂的所述手术器械臂为内窥镜臂,其余机械臂的所述手术器械臂为工具臂。
6.如权利要求5所述的手术机器人调整***,其特征在于,所述工具臂相对于内窥镜臂的姿态映射关系通过如下步骤获得:
将内窥镜臂所在的机械臂上的光学靶镜设定为基点光学靶镜,其余机械臂上的光学靶镜为其余光学靶镜;
利用光学跟踪仪测量光学靶镜的位置和欧拉角;
所述计算模块根据上述测量值,计算获得其余光学靶镜与所述基点光学靶镜之间的姿态映射关系,并根据上述其余光学靶镜与所述基点光学靶镜之间的姿态映射关系,以及每个机械臂的手术器械臂与该机械臂上的光学靶镜之间的姿态映射关系,计算获得工具臂的坐标系在内窥镜臂坐标系下的姿态映射关系。
7.如权利要求6所述的手术机器人调整***,其特征在于,所述工具臂的坐标系在内窥镜臂坐标系下的姿态映射关系采用如下式子获得:
ERT=ERM*(CRM)-1*CRK*(TRK)-1,
式中,TRK代表手术器械臂为工具臂时,采用运动学方程获得该工具臂所在的机械臂上的光学靶镜的坐标系在该工具臂坐标系下的描述;CRK代表该工具臂所在的机械臂上的光学靶镜的坐标系相对于光学跟踪仪坐标系的变化关系;CRM代表手术器械臂为内窥镜臂时,该内窥镜所在的机械臂上的光学靶镜的坐标系相对于光学跟踪仪坐标系的变化关系;ERM代表采用运动学方程获得的内窥镜臂所在的机械臂上的光学靶镜的坐标系在所述内窥镜臂的坐标系下的描述。
8.如权利要求1所述的手术机器人调整***,其特征在于,所述底座的数量为至少一个。
9.如权利要求1所述的手术机器人调整***,其特征在于,所述调整臂的自由度大于2,所述主动臂的自由度大于1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510567702.2A CN105232155B (zh) | 2015-09-08 | 2015-09-08 | 手术机器人调整*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510567702.2A CN105232155B (zh) | 2015-09-08 | 2015-09-08 | 手术机器人调整*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105232155A CN105232155A (zh) | 2016-01-13 |
CN105232155B true CN105232155B (zh) | 2018-11-09 |
Family
ID=55030176
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510567702.2A Active CN105232155B (zh) | 2015-09-08 | 2015-09-08 | 手术机器人调整*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105232155B (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105963017B (zh) * | 2016-04-12 | 2018-08-24 | 浙江大学 | 一种空间多自由度手术辅助手臂机构 |
KR102604919B1 (ko) * | 2016-07-14 | 2023-11-23 | 인튜어티브 서지컬 오퍼레이션즈 인코포레이티드 | 컴퓨터 보조 원격조작 시스템에서의 2차 기구 제어 |
CN111973280B (zh) * | 2017-12-27 | 2022-02-22 | 上海微创医疗机器人(集团)股份有限公司 | 手术机器人终端 |
CN108420538B (zh) | 2018-04-27 | 2020-08-25 | 微创(上海)医疗机器人有限公司 | 手术机器人*** |
CN109288591B (zh) * | 2018-12-07 | 2021-12-03 | 上海微创医疗机器人(集团)股份有限公司 | 手术机器人*** |
CN110464472B (zh) * | 2019-09-10 | 2020-12-01 | 深圳市精锋医疗科技有限公司 | 手术机器人及其末端器械的控制方法、控制装置 |
CN111839614B (zh) * | 2019-09-10 | 2021-05-11 | 深圳市精锋医疗科技有限公司 | 手术机器人及其机械臂的控制方法、控制装置 |
CA3173684A1 (en) * | 2020-08-19 | 2022-02-24 | Kai Xu | Robot system and control method |
CN112043396B (zh) * | 2020-10-08 | 2022-03-04 | 深圳市精锋医疗科技股份有限公司 | 手术机器人及其图形化控制装置、图形化显示方法 |
CN112264996B (zh) * | 2020-10-16 | 2022-06-14 | 中冶赛迪上海工程技术有限公司 | 一种抓钢机定位控制方法及*** |
CN114376734B (zh) * | 2020-10-19 | 2024-01-16 | 上海微创医疗机器人(集团)股份有限公司 | 一种手术机器人*** |
CN112245011B (zh) * | 2020-10-23 | 2022-02-01 | 上海微创医疗机器人(集团)股份有限公司 | 手术机器人***、调整方法、存储介质及终端 |
CN112472297B (zh) * | 2020-11-26 | 2022-03-29 | 上海微创医疗机器人(集团)股份有限公司 | 位姿监测***、方法、手术机器人***和存储介质 |
CN113331948B (zh) * | 2021-05-28 | 2022-12-09 | 浙江德尚韵兴医疗科技有限公司 | 一种介入手术机器人***、标定装置及标定方法 |
CN113876431B (zh) * | 2021-10-29 | 2022-09-09 | 中国人民解放军总医院第五医学中心 | 一种手术病床的跟踪测量机械臂装置 |
CN114129266B (zh) * | 2021-11-11 | 2024-05-14 | 深圳市精锋医疗科技股份有限公司 | 保持rc点不变的方法、机械臂、设备、机器人和介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1650813A (zh) * | 2005-02-06 | 2005-08-10 | 天津市华志计算机应用有限公司 | 外科手术导航***基于光学定位的机器人手术定位方法 |
CN102363301A (zh) * | 2011-10-19 | 2012-02-29 | 浙江工业大学 | 机器人拟人手指自适应指尖力跟踪控制方法 |
CN102608969A (zh) * | 2012-03-02 | 2012-07-25 | 北京理工大学 | 基于红外光学定位的串联型机器人手眼配准控制方法 |
CN103705307A (zh) * | 2013-12-10 | 2014-04-09 | 中国科学院深圳先进技术研究院 | 手术导航***及医疗机器人 |
CN104570731A (zh) * | 2014-12-04 | 2015-04-29 | 重庆邮电大学 | 一种基于Kinect的无标定人机交互控制***及方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8126114B2 (en) * | 2008-09-12 | 2012-02-28 | Accuray Incorporated | Seven or more degrees of freedom robotic manipulator having at least one redundant joint |
-
2015
- 2015-09-08 CN CN201510567702.2A patent/CN105232155B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1650813A (zh) * | 2005-02-06 | 2005-08-10 | 天津市华志计算机应用有限公司 | 外科手术导航***基于光学定位的机器人手术定位方法 |
CN102363301A (zh) * | 2011-10-19 | 2012-02-29 | 浙江工业大学 | 机器人拟人手指自适应指尖力跟踪控制方法 |
CN102608969A (zh) * | 2012-03-02 | 2012-07-25 | 北京理工大学 | 基于红外光学定位的串联型机器人手眼配准控制方法 |
CN103705307A (zh) * | 2013-12-10 | 2014-04-09 | 中国科学院深圳先进技术研究院 | 手术导航***及医疗机器人 |
CN104570731A (zh) * | 2014-12-04 | 2015-04-29 | 重庆邮电大学 | 一种基于Kinect的无标定人机交互控制***及方法 |
Non-Patent Citations (1)
Title |
---|
串联机器人轨迹规划研究及其控制***涉及;俞晓慧;《中国优秀硕士学位论文全文 信息科技辑》;20150715;第2015年卷(第07期);第二章第2.1-2.4节 * |
Also Published As
Publication number | Publication date |
---|---|
CN105232155A (zh) | 2016-01-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105232155B (zh) | 手术机器人调整*** | |
Bedell et al. | Design optimization of concentric tube robots based on task and anatomical constraints | |
CN107374727B (zh) | 一种微创外科手术机器人简化运动学模型的建模方法 | |
Ganji et al. | Catheter kinematics for intracardiac navigation | |
RU2741469C1 (ru) | Роботизированная хирургическая система | |
Vandini et al. | Vision-based motion control of a flexible robot for surgical applications | |
Kim et al. | Experimental evaluation of contact-less hand tracking systems for tele-operation of surgical tasks | |
CN114391953A (zh) | 一种骨科导航定位*** | |
CN105904457A (zh) | 一种基于位置***及数据手套的异构型冗余机械臂控制方法 | |
US20240016559A1 (en) | Control method for location and orientation of surgical robot end, and control method for surgical robot | |
CN112957125B (zh) | 一种腔镜手术机器人的手术臂初始位姿规划方法及装置 | |
Wang et al. | Development of a novel 4-DOF flexible endoscopic robot using cable-driven multisegment continuum mechanisms | |
Trejos et al. | Port placement for endoscopic cardiac surgery based on robot dexterity optimization | |
Kim et al. | Image-based force estimation of deformable tissue using depth map for single-port surgical robot | |
CN117323019A (zh) | 一种用于泌尿系穿刺手术的三操作臂机器人*** | |
CN110900608B (zh) | 基于最优测量构型选择的机器人运动学标定方法 | |
CN105997249A (zh) | 一种可实现空间三维定位和二维定向的五自由度混联机构 | |
Azimian et al. | Preoperative planning of robotics-assisted minimally invasive coronary artery bypass grafting | |
Duan et al. | Mechanical design and kinematic analysis of a medical robot assisted maxillofacial surgery | |
Dusarlapudi et al. | Design and prototyping of an accelerometer based parallel manipulator for endoscope position control | |
Zhang et al. | Eye-in-hand uncalibrated visual servoing of concentric tube robot | |
Sun et al. | Development of a Novel Hand-eye Coordination Algorithm for Robot Assisted Minimally Invasive Surgery | |
Li et al. | Development of a 7-DoF Haptic Operator Interface Based on Redundantly Actuated Parallel Mechanism | |
Yang et al. | Dynamic modeling and analysis of laparoscope arm for Minimally Invasive Surgical Robot | |
Song et al. | Development of the dexterous manipulator and the force sensor for minimally invasive surgery |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into 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, area B, building 1, 1601 Zhangdong Road, China (Shanghai) pilot Free Trade Zone, 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. |