一种基于远心不动点约束的手术机器人运动控制方法与流程

1.本发明属于自动控制技术领域。具体涉及一种基于远心不动点约束的手术机器人运动控制方法。


背景技术：

2.在微创手术中引入手术机器人能够为外科医生提供准确性和舒适性方面的重要支持，可以提高手术质量、缩短患者恢复时间。在机器人辅助微创手术中，手术机器人的机械臂搭载手术工具在通过患者体表的小切口进入体内后，手术工具的运动必须围绕该切口孔进行，不能在该切口处产生非轴线方向的平移，否则会对患者造成损伤。更具体地说，固定有手术工具的机器人连杆只能沿其轴线平移并以该切口孔作为支点进行旋转。该手术工具轴线上与切口重合的支点即所谓的远程运动中心(“rcm”)。到目前位置，微创手术机器人通常使用机械结构实现远心不动点rcm，即不动点是以特殊设计的机械结构来实现的。但是特殊设计的机械结构设计复杂，其精度性能、可操作性等存在不确定性，并且新的结构需要重新考虑其奇异位型防止造成机械结构的瞬间卡死或失灵。


技术实现要素：

3.针对上述技术问题，本发明提出一种基于远心不动点约束的手术机器人运动控制方法。本发明与已有技术的最大不同点是采用运动控制算法实现。由于采用运动控制算法实现远心不动点约束，避免了采用复杂的机械结构，也就解决了采用复杂机械结构实现远心不动点约束带来的种种问题。
4.本发明的实施例提供一种手术机器人，所述手术机器人包括工控机(1)、人机交互设备(2)和机械臂台车(3)；所述机械臂台车(3)包括7轴冗余机械臂(31)、末端执行器(32)和手术工具(33)；
5.其中，工控机(1)包括显示屏，所述显示屏配置为：将手术工具的视觉传感器获得的二维或三维图像进行展示，提供查看病灶部位的相关的影像；
6.人机交互设备(2)配置为：按照操作的动作，人机交互设备(2)产生其x、y和z轴相应的旋转变化角度和位移变化数值，即6维位姿的增量(α,β,γ,dx,dy,dz)。
7.根据本发明的一种实施方式，例如，7轴冗余机械臂(31)配置为：满足机器人运动学中的pieper准则，即机器人的三个相邻关节轴交于一点或三轴线平行，机器人存在封闭的逆解；
8.末端执行器(32)配置为：提供特定设计的夹具，作为手术工具的基座，末端执行器(32)接收控制信号，根据信号执行手术工具(33)的相应规定的动作；
9.手术工具(33)配置为：根据手术目的采用视觉传感器，电切装置等，完成特定的手术动作和功能。
10.本发明的实施例还提供一种基于远心不动点约束的手术机器人运动控制方法，所述方法采用如上所述的手术机器人实施，所述方法包括：手术工具位姿的标定；手术工具结
合手术目标位置初始位姿的校准；远心不动点约束方法；控制手术工具运动。
11.由于本发明采用运动控制算法实现远心不动点约束，避免了采用复杂的机械结构，避免了由于复杂机械结构带来的一系列问题，例如精度性能、可操作性等方面存在的不确定性、新的机械结构需要重新考虑其奇异位型防止造成机械结构的瞬间卡死或失灵等。此外，由于手术机器人不再依赖复杂的机械结构实现远心不动点约束，本发明也有成本方面的优势。
附图说明
12.图1是本发明实施例提供的一种手术机器人结构示意图。
13.图2是本发明实施例提供的一种基于远心不动点约束的手术机器人运动控制方法步骤(9)中坐标系变换关系图。
14.图3是本发明实施例提供的一种基于远心不动点约束的手术机器人运动控制方法步骤(10)中坐标系变换关系图。
15.图4是本发明实施例提供的一种基于远心不动点约束的手术机器人运动控制方法步骤(11)中坐标系变换关系图。
具体实施方式
16.为使本发明的目的、技术方案和优点更加清楚明白，以下结合具体实施例，并参照附图，对本发明进一步详细说明。但本领域技术人员知晓，本发明并不局限于附图和以下实施例。
17.在发明的描述中，需要说明的是，对于方位词，如术语“长度”、“宽度”、“上”、“下”、“远”、“近”等所指示的方位或位置关系是基于附图所示的方位或位置关系，仅是为了便于叙述本发明和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定方位构造和操作，不能理解为限制本发明的具体保护范围。此外，术语“第一”、“第二”仅用于描述目的，用以区别技术特征，不具有实质含义，不能理解为指示或暗示相对重要性或隐含指明技术特征的数量。
18.本发明实施例提供的基于远心不动点约束的手术机器人运动控制方法的基本原理是：利用运动变换顺序z,y,x轴，3个轴方向的运动都需要满足远心不动点rcm(remote center of motion)点的约束。
19.本发明的实施例提供一种手术机器人，所述手术机器人包括工控机1、人机交互设备2和机械臂台车3。所述机械臂台车3包括7轴冗余机械臂31、末端执行器32和手术工具33。
20.其中，工控机1包括显示屏，所述显示屏配置为：将手术工具的视觉传感器获得的图像(二维或三维)进行展示，提供查看病灶部位的相关的影像。
21.人机交互设备2配置为：按照操作的动作，人机交互设备2产生其x、y和z轴相应的旋转变化角度和位移变化数值，即6维位姿的增量(α,β,γ,dx,dy,dz)；
22.机械臂台车3包括7轴冗余机械臂31、末端执行器32和手术工具33。其中，7轴冗余机械臂31配置为：满足机器人运动学中的pieper准则，即机器人的三个相邻关节轴交于一点或三轴线平行，机器人存在封闭的逆解。
23.末端执行器32配置为：提供特定设计的夹具，作为手术工具的基座，末端执行器32
接收控制信号，根据信号执行手术工具33的相应规定的动作。
24.手术工具33配置为：根据手术目的采用视觉传感器，电切装置等，完成特定的手术动作和功能。
25.本发明的实施例还提供一种基于远心不动点约束的手术机器人运动控制方法，所述方法采用上述手术机器人实施。所述方法包括：
26.(1)标定末端执行器32和手术工具33在机器人坐标系中的位姿。首先将末端执行器32和手术工具33安装在手术机器人上，然后标定末端执行器32在手术机器人坐标系中的位姿，最后标定手术工具33在手术机器人坐标系中的位姿，通过标定末端执行器32和手术工具33的位姿，从而得到手术工具33前端中心点在手术机器人坐标下的位置
27.(2)手术目标位置和手术工具33结合处截面中心点初始位姿的校准。首先确认手术目标位置，迅速将末端执行器32安装上手术工具33，然后使用量尺(例如游标卡尺)在平行于手术工具33方向测量出手术目标位置相对于手术工具33末端的距离，采用在手术工具33上取6个点相应测量距离，最后计算算术平均值得到手术工具33在手术目标位置横截面中心点相对于手术工具末端的距离值。并将此值作为偏移量相对于点的转换进行远心中心点点的设置。
28.(3)本发明实施例提供的基于远心不动点约束的手术机器人控制方法可以描述为手术工具刚体在特定点远心不动点点的约束下运动，即旋转以点和沿手术工具径向的位移经过点作为手术机器人运动的几何约束。手术机器末端即手术工具的前端中心点的运动从当前位姿到目标位姿的变换矩阵表示为特殊欧式变换群其中为4
×
4的齐次变换矩阵，分别包含手术工具3
×
3矩阵的旋转分量r和3
×
1向量的位移分量t，其中，so(3)为三维旋转群，r4×4和r3为实数空间。
29.(4)通过人机交互设备2获取的六维运动增量(α,β,γ,dx,dy,dz)，分别表示为人机交互设备2沿其三个轴x、y和z的旋转角度变化量α,β,γ和位移变化量dx,dy,dz。
30.(5)由上一步获得的六维运动增量(α,β,γ,dx,dy,dz)，手术机器人末端即手术工具33前端中心点的运动依次分解为沿其前端中心点所在坐标系z、y和x轴的旋转和平移。手术工具33以远心不动点点条件下从当前位姿到目标位姿的齐次变换矩阵可以表示为表达式h
zyx
＝hz×hy
×hx
，其中齐次变换矩阵hz，hy，h
x
分别表示手术工具33前端点确认的坐标系以z、y和x轴进行的旋转和位移，表达式分别为：和其中手术工具33的3
×
3矩阵旋转分量r
z,γ
，r
y,β
和r
x,α
分别表示为沿手术工具的z、y和x轴旋转了γ,β和α角度，其表达式分别为
31.和
32.(6)而3
×
1向量位移分量ty
xyz
、tz
xyz
和tz
xyz
是在远心不动点点条件下分别表示为沿z、y和x轴运动时在三个轴相应平移距离的分量，其表达式分别为tz
xyz
＝[dz
x dz
y dzz]
t
、ty
xyz
＝[dy
x dy
y dyz]
t
和tx
xyz
＝[dx
x dx
y dxz]
t
。
[0033]
(7)按照手术机器人的运动方式，将手术机器人末端即手术工具33前端设置为后，手术机器人的运动将以此作为运动坐标系的原点。上一步从人机交互设备获得的运动增量将相对于此坐标系进行相对的旋转和位移。
[0034]
(8)从人机交互设备2获得的旋转和位移增量，根据手术机器人的运动和点的约束，进行几何关系的分解。根据手术机器人运动顺序分别沿z，y，x轴进行，将点的几何约束逐步进行分解。为和的距离，计算表达式为
[0035]
(9)沿着的z轴的运动，分为旋转和位移两部分，其中旋转部分关系式为沿着z轴旋转后如图2所示，坐标系由x-y-z变换为x
’‑y’‑
z’，由于和两点共线并且和x-y轴构成的平面垂直，两点之间x,y分量相同，z分量不同，因此在沿z轴旋转时，点的x,和y分量保持不变。径向位移部分|dz|,则对运动补偿tz
xyz
＝[0,0,-dz]
t
后，依然保持不变，且位于手术工具33径向方向上一点。
[0036]
(10)沿着的y轴的运动的同时需要受到点的约束，将手术机器人的运动分为旋转和位移两部分，其中旋转部分关系式为沿着y轴旋转后如图3所示，坐标系由x-y-z变换为x
’‑y’‑
z’，且y/y’轴重合，手术机器人末端的手术工具33沿点旋转带来了的位移，移动到了将分别投影在旋转前的坐标系x-y-z中，分解后在x方向产生了的位移分量，z轴方向产生了的位移分量，y轴方向仅旋转没有位移分量。为保持位置不变，则需要对点做运动位移补偿向量为经过对运动补偿后，点移动到点使得始终在手术工具上并且其x,y,z分量保持不变。
[0037]
(11)沿着的x轴的运动的同时需要受到点的约束，将手术机器人的运
动分为旋转和位移两部分，旋转部分关系式为沿着x轴旋转后如图4所示，坐标系由x-y-z变换为x
’‑y’‑
z’，手术机器人末端的手术工具33沿旋转带来了的位移，移动到了将分别投影在旋转前的坐标系中，分解后在y方向产生了的位移分量，z轴方向产生了的位移分量，x轴方向仅旋转没有位移分量。为保持位置不变，则需要对点做运动位移补偿向量为经过对运动补偿后，点移动到点使得始终在手术工具上并且其x,y,z分量保持不变。
[0038]
(12)经过上述步骤得到机器人手术工具33前端点从当前位姿到目标位姿的齐次变换矩阵h
zyx
后，采用机器人逆解的方法得到机械臂各关节的角度，从而控制机械臂末端的手术工具33进行远心不动点约束的运动。