介入手术机器人的路径执行方法、系统及可读存储介质与流程
本说明书涉及机器人,特别涉及一种介入手术机器人的路径规划方法、系统、装置及可读存储介质。
背景技术:
1、介入手术是现代外科手术中较为普通的技术,特别是在微创外科领域。例如,刺针手术在影像和其他传感的引导下,刺入软组织病灶靶点,完成防止药物、活检、局部麻醉、放射和消融治疗等操作。介入手术广泛应用于前列腺、肺、肝、肾和脊柱等器官组织的诊疗。
2、传统介入手术中存在需要多次扫描验证、手术时间长、对医生技术水平要求高、重复性差等弊端,而且还存在医生直接暴露于射线和操作空间受限等诸多问题。通过介入手术机器人携带的末端执行器可以辅助或代替医生执行介入手术。然而,由于介入手术通常需要在多个介入位置执行介入操作,且操作后可能会有在患者身体上留下医疗器械(如穿刺针)。因此,有必要设计一种介入手术机器人的路径规划方法及系统来辅助定位,以提高介入手术机器人辅助或执行介入手术的成功率。
技术实现思路
1、本说明书实施例之一提供一种介入手术机器人的路径规划方法。所述介入手术机器人包括机械臂和连接于所述机械臂末端的末端执行器。所述方法包括:获取手术计划信息中的多个穿刺位置;确定多个沿第一直线方向延伸的路径规划子区域,多个所述路径规划子区域全覆盖所述多个穿刺位置,且每个所述路径规划子区域覆盖所述多个穿刺位置中的至少部分;基于所述路径规划子区域规划所述末端执行器的移动路径。
2、在一些实施例中,所述基于所述路径规划子区域规划所述末端执行器的移动路径,包括:基于所述路径规划子区域确定所述多个穿刺位置的排序结果;至少基于所述排序结果规划所述末端执行器的移动路径。
3、在一些实施例中,所述基于所述路径规划子区域确定所述多个穿刺位置的排序结果,包括:沿预设朝向为所述路径规划子区域排序,所述预设朝向平行于水平面且垂直于所述第一直线方向;以及为每个所述路径规划子区域覆盖的穿刺位置排序。
4、在一些实施例中,所述末端执行器包括末端夹持器,所述末端夹持器用于夹持穿刺针;所述基于所述路径规划子区域确定所述多个穿刺位置的排序结果,还包括:确定所述末端夹持器在所述多个穿刺位置的开口朝向;基于所述开口朝向确定所述预设朝向。
5、在一些实施例中,所述为每个所述路径规划子区域覆盖的穿刺位置排序,包括:在每个所述路径规划子区域中,沿所述第一直线方向的同一朝向对多个穿刺位置排序。
6、在一些实施例中,所述末端执行器包括末端夹持器,所述末端夹持器用于夹持穿刺针;所述为每个所述路径规划子区域覆盖的穿刺位置排序,包括:确定所述末端夹持器在所述多个穿刺位置的开口朝向;基于所述开口朝向确定所述路径规划子区域覆盖的穿刺位置排序。
7、在一些实施例中,所述至少基于所述排序结果规划所述末端执行器的移动路径,包括:获取碰撞模型;基于所述碰撞模型和所述排序结果规划所述末端执行器的移动路径。
8、在一些实施例中,所述移动路径包括一个或多个子路径,所述基于所述碰撞模型和所述排序结果规划所述末端执行器的移动路径,包括:依次规划所述排序结果中每一组相邻穿刺位置之间的子路径。
9、在一些实施例中,所述依次规划所述排序结果中每一组相邻穿刺位置之间的子路径,包括:对于每一组相邻穿刺位置,基于所述相邻穿刺位置中的前穿刺位置规划避让点,基于所述前穿刺位置和所述避让点规划移位路径段,所述移位路径段为所述前穿刺位置和所述避让点之间的路径段;将所述相邻穿刺位置中的前穿刺位置对应的手术器械模型添加至所述碰撞模型以更新所述碰撞模型;基于更新后的碰撞模型规划所述避让点与所述相邻穿刺位置中的后穿刺位置之间的避让路径段,所述避让路径段和所述移位路径段组成所述子路径。
10、在一些实施例中,所述子路径包括执行子路径,所述避让点包括执行避让点,所述移位路径段包括执行移位路径段,所述避让路径段包括执行避让路径段,所述执行子路径由所述执行移位路径段和所述执行避让路径段组成,所述方法还包括:当规划所述执行移位路径段失败时,获取所述末端执行器的第一校正位置;基于所述第一校正位置和所述执行避让点规划执行移位路径段,或者,基于所述第一校正位置重新规划执行避让点,并基于所述第一校正位置和所述执行避让点规划执行移位路径段,或者,将所述第一校正位置确定为重新规划的所述执行避让点;和/或,当规划所述执行避让路径段失败时,获取所述末端执行器的第二校正位置;基于所述第二校正位置和所述相邻穿刺位置中的后穿刺位置规划执行避让路径段。
11、在一些实施例中,所述方法还包括:获取外部安全点;所述至少基于所述排序结果规划所述末端执行器的移动路径,还包括:基于所述碰撞模型规划所述末端执行器的初始位置到所述外部安全点的第一移动子路径;以及基于所述碰撞模型规划所述外部安全点到所述排序结果中的首个穿刺位置之间的第二移动子路径。
12、在一些实施例中,所述方法还包括:基于所述路径规划子区域相对于所述机械臂基座的位置确定所述预设朝向。
13、在一些实施例中,所述移动路径包括执行路径。所述基于所述路径规划子区域规划所述末端执行器的移动路径,包括:将被穿刺对象移至医学影像装置的孔径外;在所述医学影像装置的孔径外规划并执行所述执行路径。
14、本说明书实施例之一提供一种介入手术机器人的路径规划系统,所述介入手术机器人包括机械臂和连接于所述机械臂末端的末端执行器。所述系统包括:计划获取模块,被配置为获取手术计划信息中的多个穿刺位置;第一确定模块,被配置为确定多个沿第一直线方向延伸的路径规划子区域,多个所述路径规划子区域全覆盖所述多个穿刺位置,且每个所述路径规划子区域覆盖所述多个穿刺位置中的至少部分;路径规划模块,被配置为至少基于所述路径规划子区域规划所述末端执行器的移动路径。
15、在一些实施例中,所述系统还包括第二确定模块,被配置为基于所述路径规划子区域确定所述多个穿刺位置的排序结果;所述路径规划模块被进一步配置为至少基于所述排序结果规划所述末端执行器的移动路径。
16、本说明书实施例之一提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现上述任一实施例所述的路径规划方法的步骤。
17、本说明书实施例之一提供一种介入手术机器人的路径规划装置,所述路径规划装置包括介入手术机器人和处理器;所述介入手术机器人包括机械臂和连接于所述机械臂末端的末端执行器;所述处理器被配置为执行:获取手术计划信息中的多个穿刺位置;确定多个沿第一直线方向延伸的路径规划子区域,多个所述路径规划子区域全覆盖所述多个穿刺位置,且每个所述路径规划子区域覆盖所述多个穿刺位置中的至少部分;基于所述路径规划子区域规划所述末端执行器的移动路径。
18、本说明书实施例之一提供另一种介入手术机器人的路径规划方法,所述介入手术机器人包括机械臂和连接于所述机械臂末端的末端执行器,所述方法包括:获取手术计划信息中的多个穿刺位置;确定多个所述穿刺位置的排序结果;获取碰撞模型;基于所述碰撞模型和所述排序结果规划所述末端执行器的移动路径。
19、本说明书实施例之一提供一种介入手术机器人的路径执行方法,所述方法包括:获取手术计划信息中的多个穿刺位置;确定多个沿第一直线方向延伸的路径规划子区域,多个所述路径规划子区域全覆盖所述多个穿刺位置,且每个所述路径规划子区域覆盖所述多个穿刺位置中的至少部分;基于所述路径规划子区域规划所述末端执行器的移动路径,所述移动路径包括执行路径;控制所述介入手术机器人执行所述执行路径。
20、本说明书实施例中之一提供一种介入手术机器人的路径执行系统,所述系统包括:计划获取模块,被配置为获取手术计划信息中的多个穿刺位置;第一确定模块,被配置为确定多个沿第一直线方向延伸的路径规划子区域,多个所述路径规划子区域全覆盖所述多个穿刺位置,且每个所述路径规划子区域覆盖所述多个穿刺位置中的至少部分;路径规划模块,被配置为基于所述路径规划子区域规划所述末端执行器的移动路径,所述移动路径包括执行路径;路径执行模块,被配置为控制所述介入手术机器人执行所述执行路径。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com