一种手术机器人位姿控制方法、手术机器人及存储介质与流程
本发明属于手术机器人,涉及一种手术机器人位姿控制方法、手术机器人及存储介质。
背景技术:
1、现有手术机器人控制方案中,对于串联机构主手的运动控制,通常从基座开始到输入端(手柄)通过各关节编码器读数,基于预设坐标系对输入端的姿态进行求解。该方案根据主手坐标系定义,得到输入端的空间姿态描述为依次绕d1轴(z轴)、d2轴(x轴)及d3轴(y轴)进行旋转(转序依次为z轴、x轴、y轴),如图1a所示。
2、然而,在实际人机交互过程中,操作者手持手柄对串联机构进行控制。受人体手部生理结构及运动习惯的限制,操作者对手柄的实际操作运动并不符合上述固定的坐标旋转顺序;具体而言,如图1b所示,人体手部的自然运动更符合依次绕y轴、z轴及x轴的复合旋转过程,其中y轴与人体小臂相平行,z轴与竖直方向相平行,x轴符合右手定则(即人体手部的自然运动更符合先绕小臂旋转,后绕腕关节偏摆,再绕腕关节俯仰的顺序)。
3、由于人体手部自然运动的旋转顺序不同会导致最终姿态描述存在差异,即同一空间姿态在不同欧拉角旋转序列下对应不同的参数表达。因此,若直接采用基于预设坐标系获得的“绕z轴—绕x轴—绕y轴”顺序计算得到的姿态参数,无法准确反映操作者手部的真实运动过程,从而影响人机交互的一致性与控制精度。
技术实现思路
1、有鉴于此,本发明的目的在于提供一种手术机器人位姿控制方法、手术机器人及存储介质,以解决目前手术机器人控制技术中,操作者的手部运动与手术器械之间的运动映射不直观、控制精度不足的问题。
2、为达到上述目的,本发明第一方面提供了一种手术机器人位姿控制方法,其包括:
3、获取预设坐标系下手术机器人主手构型的第一姿态参数,所述第一姿态参数为预设坐标系中按照第一欧拉角旋转顺序表示的欧拉角参数,所述第一欧拉角旋转顺序为基于主手构型依次从基座到输入端获得的欧拉角;
4、将第一姿态参数转换为第二姿态参数,所述第二姿态参数为预设坐标系中按照第二欧拉角旋转顺序表示的欧拉角参数;所述第二欧拉角旋转顺序为依次绕操作者小臂旋转、腕关节偏摆、腕关节俯仰的欧拉角旋转顺序;
5、基于第二姿态参数生成姿态控制指令控制手术机器人的手术器械运动。
6、进一步的,所述预设坐标系的y轴与操作者小臂平行,z轴与竖直方向平行,x轴由y轴和z轴按照右手定则确定;
7、所述第一欧拉角旋转顺序为依次绕z轴、x轴和y轴的旋转顺序;
8、所述第二欧拉角旋转顺序为依次绕y轴、z轴和x轴的旋转顺序。
9、进一步的,所述将第一姿态参数转换为第二姿态参数包括:
10、获取第一欧拉角旋转顺序表示的欧拉角参数c、a、b;
11、根据姿态矩阵变换将第一欧拉角旋转顺序表示的欧拉角c、a、b转换为第二欧拉角旋转顺序表示的欧拉角参数、、;所述姿态矩阵表示为:
12、
13、式中,、、为基本旋转矩阵。
14、进一步的,基于第二姿态参数生成控制指令控制手术机器人的手术器械运动包括:
15、获取第二欧拉角旋转顺序下的绕y轴的旋转欧拉角,并生成手术器械自转控制指令控制手术器械自转;
16、获取第二欧拉角旋转顺序下的绕z轴的旋转欧拉角,并生成手术器械偏摆控制指令控制手术器械钳头偏摆的角度大小。
17、进一步的,该方法还包括以下步骤:
18、获取第二欧拉角旋转顺序下,操作者各次使用离合产生的姿态参数差值,并基于操作者各次使用离合产生的姿态参数差值获得姿态参数累计差值;
19、基于所述姿态参数累计差值生成姿态控制指令,以控制手术机器人的手术器械钳头偏摆的方向。
20、进一步的,基于所述姿态参数累计差值生成姿态控制指令包括:
21、若姿态参数累计差值大于等于-90°且小于等于90°,则生成控制器械钳头正向偏摆的控制指令;
22、若姿态参数累计差值大于90°且小于270°,则生成控制器械钳头负向偏摆的控制指令。
23、其中,获取第二欧拉角旋转顺序下,操作者各次使用离合产生的姿态参数差值包括:
24、响应当次离合接入信号,获取当次离合接入时的第一欧拉角旋转顺序下的第一姿态参数;
25、将当次离合接入时的第一欧拉角旋转顺序下的第一姿态参数转换为第二欧拉角旋转顺序下的第二姿态参数;
26、响应当次离合断开信号,获取当次离合断开时的第一欧拉角旋转顺序下的第一姿态参数;
27、将当次离合断开时的第一欧拉角旋转顺序下的第一姿态参数转换为第二欧拉角旋转顺序下的第二姿态参数;
28、计算当次离合接入时第二欧拉角旋转顺序下的第二姿态参数中绕y轴旋转欧拉角与,当次离合断开时的第二欧拉角旋转顺序下的第二姿态参数中绕y轴旋转欧拉角的差值,得到操作者当次使用离合产生的姿态参数差值。
29、进一步的,在控制手术机器人手术器械钳头偏摆方向的基础上,该方法还包括以下步骤:
30、获取上一次离合断开时的第一欧拉角旋转顺序下的第一姿态参数;
31、将上一次离合断开时的第一欧拉角旋转顺序下的第一姿态参数转换为第二欧拉角旋转顺序下的第二姿态参数;
32、获取当前时刻的第一欧拉角旋转顺序下的第一姿态参数;
33、将当前时刻的第一欧拉角旋转顺序下的第一姿态参数转换为第二欧拉角旋转顺序下的第二姿态参数;
34、计算当前时刻的第二欧拉角旋转顺序下的第二姿态参数中绕z轴旋转欧拉角,与上一次离合断开时第二欧拉角旋转顺序下的第二姿态参数中绕z轴旋转欧拉角的差值,得到绕z轴旋转欧拉角差值;
35、基于所述绕z轴旋转欧拉角差值生成姿态控制指令,以控制手术机器人的手术器械钳头偏摆的角度大小。
36、进一步的,基于第二姿态参数生成控制指令控制手术机器人的手术器械运动包括:
37、获取第二欧拉角旋转顺序下的绕y轴的旋转欧拉角,并生成手术器械自转控制指令控制手术器械自转;
38、获取第二欧拉角旋转顺序下的绕y轴、z轴和x轴的旋转欧拉角,并生成手术器械偏摆控制指令控制手术器械钳头偏摆的角度大小。
39、进一步的,所述获取第二欧拉角旋转顺序下的y轴、z轴和x轴的旋转欧拉角,并生成手术器械偏摆控制指令包括:
40、基于第二欧拉角旋转顺序下绕y轴的旋转欧拉角分别计算绕z轴和绕x轴的旋转欧拉角权重;
41、基于所述权重将第二欧拉角旋转顺序下绕z轴和绕x轴的旋转欧拉角加权融合生成手术器械偏摆控制指令。
42、其中,第二欧拉角旋转顺序下绕z轴的旋转欧拉角的权重计算式为,第二欧拉角旋转顺序下绕x轴的旋转欧拉角的权重计算式为,为第二欧拉角旋转顺序下绕y轴的旋转欧拉角。
43、进一步的,该方法还包括:
44、获取手术机器人主手的平移运动参数;
45、基于第一姿态参数和平移运动参数生成位置控制指令,控制手术机器人的手术器械运动。
46、进一步的,所述方法还包括:
47、获取姿态影响缩放参数,姿态影响缩放参数为第一姿态参数(主手中手柄在空间内转动量,即坐标系的坐标轴上转动量)对手术器械钳头运动量影响的权重;
48、基于第一姿态参数和平移运动参数生成位置控制指令,控制手术机器人的手术器械运动包括:基于姿态影响缩放参数、平移运动参数和第一姿态参数生成位置控制指令,控制手术机器人的手术器械运动。
49、进一步的,基于姿态影响缩放参数、平移运动参数和第一姿态参数生成位置控制指令,控制手术机器人的手术器械运动包括:基于姿态影响缩放参数、平移运动参数和第一姿态参数中绕x轴旋转欧拉角、绕z轴旋转欧拉角生成位置控制指令,控制手术机器人的手术器械运动。
50、第二方面,本发明提供了一种手术机器人,其包括主手和与主手连接的控制器,其中控制器配置为用于执行第一方面所述的方法,以控制主手和/或手术器械。
51、第三方面,本发明提供了一种计算机可读存储介质,该计算机可读存储介质存储有计算机程序,该计算机程序被处理器执行时实现第一方面所述的方法。
52、本发明的有益效果在于:
53、(1)通过将第一姿态参数转换为第二姿态参数,实现将基于主手构型依次从基座到输入端获得的欧拉角转换为依次绕操作者小臂旋转、腕关节偏摆、腕关节俯仰的欧拉角,以控制控制手术机器人的手术器械运动,使系统控制的姿态描述更符合人体手部自然复合旋转过程,改善主手操作与手术器械响应的一致性和直观性,提高姿态控制精度。
54、(2)将转换后的绕y轴转动对应手术器械自转,并将绕z轴、绕x轴的转动角加权融合后对应钳头偏摆角度,使手术器械各运动自由度随手部姿态合理联动,减少主手姿态变化引起的动作耦合和映射偏差,提升不同姿态下器械运动的连贯性与适应性。
55、(3)记录各次离合接入和断开时的姿态参数差值并进行累计,在重新建立映射后补偿离合操作造成的姿态变化,使操作者感知的手部偏转方向与钳头实际偏摆方向保持协调,避免离合复位前后偏摆方向反转,提高连续操作的稳定性和安全性。
56、(4)结合主手各机构运动参数求取基于主手构型的位置参数,并根据位置参数和姿态参数形成控制指令,使器械同时跟随主手的位置和姿态变化;通过协调位置映射与姿态映射,可改善器械末端运动的可控性,为精细化手术操作提供支持。
57、本发明的其他优点、目标和特征在某种程度上将在随后的说明书中进行阐述,并且在某种程度上,基于对下文的考察研究对本领域技术人员而言将是显而易见的,或者可以从本发明的实践中得到教导。本发明的目标和其他优点可以通过下面的说明书来实现和获得。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com