一种手术机器人精度监测与补偿方法、系统及存储介质

摘要: 本发明属于手术机器人,更具体地,涉及一种手术机器人精度监测与补偿方法、系统及存储介质。背景技术:1、经皮穿刺介入手术已成为肿瘤活检、病灶消融等微创诊疗的核心手段...
一种手术机器人精度监测与补偿方法、系统及存储介质

本发明属于手术机器人,更具体地,涉及一种手术机器人精度监测与补偿方法、系统及存储介质。

背景技术:

1、经皮穿刺介入手术已成为肿瘤活检、病灶消融等微创诊疗的核心手段,现阶段主流穿刺手术机器人均依托ct设备完成术中影像引导。机器人开展穿刺作业的基础条件,是完成机器人坐标系与ct影像坐标系的注册配准,依靠固定转换矩阵实现术前穿刺规划路径向实际操作空间映射,配准精度直接决定病灶穿刺成功率与临床手术安全。

2、手术全程存在多种不可控因素持续破坏初始配准关系。术中人员无意触碰设备、机械臂往复运动产生振动,容易造成机器人底盘偏移;机械传动磨损、关节形变、设备突发故障,会直接改变机械臂末端空间位置。上述问题会让穿刺针逐步偏离预设目标点位,轻则造成穿刺取样失效、消融治疗达不到预期效果,重则误伤人体血管、脏器,引发出血、气胸等危重并发症,危及患者生命安全。因此,术中持续动态监测穿刺定位精度,是保障介入手术安全开展的关键需求。

3、现有相关专利所公开的精度校验方案,均采用术前工装定点校验模式,仅能在手术启动前完成一次性精度核查,存在难以弥补的应用短板。该类校验手段不具备术中实时监测能力,术前校验合格无法规避手术过程中逐步产生的位移与机械误差,术中出现的配准漂移无法及时被识别。同时传统方案仅能判定精度是否达标,不具备在线动态误差补偿能力,一旦检测到定位偏差,只能中断手术重新开展配准标定,大幅延长手术时长,增加医患受到ct辐射的总剂量,降低临床诊疗效率。

4、当前行业缺少能够贯穿穿刺全过程的一体化管控方案,无法同步实现实时误差检测、自动配准矩阵校正与分级风险处置。临床场景迫切需要一套可术中不间断运行的精度监测与补偿机制,能够持续校验穿刺末端实际位置与理论位置偏差,在误差轻微偏移时自动完成校正,误差超标时及时触发安全预警,从精度监测、动态补偿、风险防护多个维度解决现有技术缺陷,兼顾手术操作效率与患者诊疗安全。

技术实现思路

1、本发明旨在解决ct引导穿刺机器人术中底盘偏移、机械故障引发定位偏差,以及传统术前工装校验无法实时监测、不能动态补偿的问题,通过术中标记物对比理论与实际坐标构建系统误差,在线优化坐标变换矩阵实现精度补偿,并依据误差阈值执行分级安全策略,全程动态保障穿刺手术精度与患者安全。

2、针对现有技术的以上缺陷或改进需求,作为本发明的第一方面,本发明提供一种手术机器人精度监测与补偿方法,包括:

3、s1.在手术机器人的穿刺末端配置医学影像显影标记装置;获取针对目标对象的穿刺规划路径,以及所述手术机器人的机器人坐标系与医学影像设备的影像坐标系之间的初始空间变换矩阵;在手术执行过程中,根据所述穿刺规划路径、所述手术机器人的实时运动学状态以及所述初始空间变换矩阵,实时解算所述显影标记装置在所述影像坐标系下的理论位置;

4、s2.在所述手术机器人执行穿刺操作的过程中,通过所述医学影像设备实时获取包含所述显影标记装置的术中医学影像;对所述术中医学影像进行图像特征提取,确定所述显影标记装置的显影特征中心,并将所述显影特征中心在所述影像坐标系下的三维坐标作为所述显影标记装置的实际位置;

5、s3.将所述显影标记装置在所述影像坐标系下的所述实际位置与所述理论位置进行空间坐标比对,计算两者之间的位置偏差向量;基于所述位置偏差向量,构建表征所述手术机器人当前空间定位精度的系统误差;

6、s4.根据所述系统误差,对所述初始空间变换矩阵进行优化更新,生成校正空间变换矩阵,用于后续穿刺路径的实时在线精度补偿;同时,将所述系统误差与预设的误差阈值区间进行比对,根据比对结果动态执行对应的安全响应策略。

7、进一步地,所述s1中,实时解算所述显影标记装置在所述影像坐标系下的理论位置,具体包括:

8、根据所述手术机器人的各关节实时角度值和预先标定的正运动学模型,计算穿刺针在所述机器人坐标系下的针尖三维坐标;所述穿刺针设置于所述穿刺末端;

9、根据所述空间偏移向量,将所述穿刺针三维坐标转换为所述显影标记球球心在所述机器人坐标系下的标记球三维坐标;

10、利用所述初始空间变换矩阵,将所述标记球三维坐标映射至所述影像坐标系,得到所述理论位置。

11、进一步地,所述s2中,对所述术中医学影像进行图像特征提取,确定所述显影标记装置的显影特征中心,具体包括:

12、对所述术中医学影像进行自适应阈值分割,提取高ct值区域作为候选显影区域;

13、对所述候选显影区域进行连通域分析,根据预设的体积范围约束和球形度约束,滤除非标记球干扰区域,得到目标候选区域;

14、提取所述目标候选区域的表面体素点集,采用最小二乘球面拟合算法对所述表面体素点集进行球心拟合,将拟合得到的球心坐标作为所述显影特征中心的三维坐标。

15、进一步地,所述自适应阈值分割,具体包括:

16、根据所述理论位置,在所述术中医学影像中构建以所述理论位置为中心的三维局部感兴趣区域;在所述三维局部感兴趣区域内,计算每个体素的ct值与三维灰度梯度幅值,并构建ct值-梯度幅值二维联合直方图;在所述二维联合直方图中,识别对应于所述显影标记装置核心区域的第一高ct值-低梯度聚类中心,以及对应于部分容积效应边缘区域的第二中等ct值-高梯度聚类中心;

17、基于所述第一高ct值-低梯度聚类中心的ct值均值与预设的衰减系数,计算确定高阈值;基于所述第二中等ct值-高梯度聚类中心的ct值均值,计算确定低阈值;采用所述高阈值在所述三维局部感兴趣区域内提取核心种子区域,并采用所述低阈值结合区域生长算法从所述核心种子区域向外扩展,将满足所述低阈值且与所述核心种子区域空间连通的体素纳入分割结果,得到所述高ct值区域。

18、进一步地,所述滤除非标记球干扰区域,得到目标候选区域,具体包括:

19、对所述候选显影区域中的各个三维连通域,分别计算其实际体素体积和三维凸包体积,将所述实际体素体积与所述三维凸包体积的比值定义为形态凸度;对各个所述三维连通域执行三维欧氏距离变换,获取每个连通域内部体素到其表面体素的最大欧氏距离值,将所述最大欧氏距离值的两倍定义为内接球等效直径,并计算对应的内接球等效体积;

20、构建包含所述体积范围约束、所述球形度约束以及抗伪影约束的多级级联过滤条件;依次应用所述多级级联过滤条件对各个所述三维连通域进行判定,将同时满足所有过滤条件的所述三维连通域保留为所述目标候选区域。

21、进一步地,所述多级级联过滤条件具体包括:

22、所述体积范围约束为:所述实际体素体积处于预设的标记球理论体积的容差区间内;

23、所述抗伪影约束为:所述形态凸度大于预设的凸度阈值,以滤除因金属放射状伪影拉扯变形或与其他高密度组织粘连而产生的非凸形连通域;

24、所述球形度约束为:所述内接球等效体积与所述实际体素体积的比值大于预设的球体充实度阈值,以滤除内部存在空洞或形态扁平的骨骼干扰区域。

25、进一步地,所述s3中,基于所述位置偏差向量,构建表征所述手术机器人当前空间定位精度的系统误差,具体包括:

26、在所述手术机器人沿所述穿刺规划路径运动的过程中,在至少三个不同的空间位姿下分别获取所述显影标记装置的所述实际位置与所述理论位置,得到至少三个位置偏差向量;

27、将所述至少三个位置偏差向量分解为平移误差分量和旋转误差分量,其中:

28、所述平移误差分量为所述至少三个位置偏差向量的均值向量;

29、所述旋转误差分量为通过奇异值分解法对所述至少三个位置偏差向量构成的偏差矩阵进行分解后得到的旋转偏差角;

30、将所述平移误差分量和所述旋转误差分量组合构成六自由度系统误差向量,作为所述系统误差。

31、进一步地,所述s4中,根据所述系统误差,对所述初始空间变换矩阵进行优化更新,生成校正空间变换矩阵,具体包括:

32、以所述初始空间变换矩阵作为待优化变量,构建以所述至少三个空间位姿下的理论位置与实际位置之间的总偏差平方和最小化为目标的目标函数;

33、采用最小二乘法或levenberg-marquardt算法对所述目标函数进行迭代求解,得到优化后的空间变换矩阵;

34、将所述优化后的空间变换矩阵与所述初始空间变换矩阵的差值矩阵的范数与预设的收敛阈值进行比较:

35、当所述范数小于所述收敛阈值时,将所述优化后的空间变换矩阵作为所述校正空间变换矩阵;

36、当所述范数不小于所述收敛阈值时,以所述优化后的空间变换矩阵作为新的初始空间变换矩阵,重新执行所述迭代求解,直至满足收敛条件或达到预设的最大迭代次数。

37、作为本发明的第二方面,还提供一种手术机器人精度监测与补偿系统,包括:

38、理论位置实时解算单元,用于在手术机器人的穿刺末端配置医学影像显影标记装置;获取针对目标对象的穿刺规划路径,以及所述手术机器人的机器人坐标系与医学影像设备的影像坐标系之间的初始空间变换矩阵;在手术执行过程中,根据所述穿刺规划路径、所述手术机器人的实时运动学状态以及所述初始空间变换矩阵,实时解算所述显影标记装置在所述影像坐标系下的理论位置;

39、实际位置影像提取单元,用于在所述手术机器人执行穿刺操作的过程中,通过所述医学影像设备实时获取包含所述显影标记装置的术中医学影像;对所述术中医学影像进行图像特征提取,确定所述显影标记装置的显影特征中心,并将所述显影特征中心在所述影像坐标系下的三维坐标作为所述显影标记装置的实际位置;

40、空间位置偏差计算单元,用于将所述显影标记装置在所述影像坐标系下的所述实际位置与所述理论位置进行空间坐标比对,计算两者之间的位置偏差向量;基于所述位置偏差向量,构建表征所述手术机器人当前空间定位精度的系统误差;

41、矩阵校正与误差补偿单元,用于根据所述系统误差,对所述初始空间变换矩阵进行优化更新,生成校正空间变换矩阵,用于后续穿刺路径的实时在线精度补偿;同时,将所述系统误差与预设的误差阈值区间进行比对,根据比对结果动态执行对应的安全响应策略。

42、作为本发明的第三方面,还提供一种计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行任一项所述的一种手术机器人精度监测与补偿方法。

43、总体而言,通过本发明所构思的以上技术方案与现有技术相比,能够取得下列有益效果:

44、1.本发明的手术机器人精度监测与补偿方法,通过在穿刺末端设置显影标记装置,依托穿刺规划路径、机器人实时运动学状态与初始空间变换矩阵持续解算标记装置在影像坐标系下的理论位置。该操作以机器人自身运动参数与预先标定的坐标映射关系为基础,输出稳定统一的理论位置基准,为后续影像定位与误差计算提供可靠参照,避免无先验约束下影像全域检索带来的计算冗余与误识别问题,仅围绕理论位置对应的空间范围开展后续影像处理,有效缩减影像数据处理范围,降低人体高密度组织、造影剂等无关结构对标记物识别造成的干扰,全程依托机器人实时运动数据同步输出理论坐标,实现与机器人穿刺动作同步的数据输出,保障整套监测流程与手术操作时序保持一致。

45、2.本发明的手术机器人精度监测与补偿方法,通过术中实时采集包含显影标记装置的医学影像并完成图像特征提取,确定标记装置显影特征中心作为实际位置。该步骤依托影像设备同步获取术中实时影像,依靠图像特征处理流程分离标记装置区域并拟合得到真实三维坐标,还原标记装置在影像空间内的实际物理点位,能够客观反映机器人末端受底盘位移、机械形变等因素影响后的真实空间状态,所得实际位置数据与前序输出的理论位置处于同一影像坐标系内,保证两组坐标数据具备直接比对计算的基础,完整采集手术穿刺全程不同阶段的标记物真实坐标,持续为误差量化提供真实可靠的影像实测数据支撑。

46、3.本发明的手术机器人精度监测与补偿方法,通过比对实际位置与理论位置计算位置偏差向量并构建系统误差,依据系统误差优化初始空间变换矩阵完成在线补偿,同时结合误差阈值执行对应安全响应策略。该流程基于多组空间位姿下的偏差数据构建包含平移与旋转分量的系统误差,完整还原机器人整体空间定位畸变情况,迭代优化坐标变换矩阵可持续修正机器人与影像设备间的配准偏差,对后续穿刺路径同步完成精度补偿,无需中断手术重新标定,依据误差区间划分不同处置方式,误差正常时持续执行穿刺操作,偏移较小时自动校正配准关系,误差超标时触发安全联锁暂停设备运动,同步兼顾术中动态精度修正与手术操作安全管控。