眼科手术机器人、控制方法、装置、设备及介质与流程
本公开涉及手术机器人,具体涉及一种眼科手术机器人、控制方法、装置、设备及介质。
背景技术:
1、相关技术中,在向手术对象的眼球中递送药物时,眼科手术机器人可以控制机械臂夹持针头深入眼球内部,其中针尖与视网膜的距离通常较短,为毫米甚至微米量级。在眼科手术机器人的使用环境中,存在医护人员走动、推车移动等情况,如果外部人员或物体意外触碰、撞击到眼科手术机器人,则可能会在瞬间导致眼科手术机器人产生震颤,这种震颤会沿着机械臂传导至处于眼球内部的针尖,从而导致针尖产生震颤。由于视网膜组织极为脆弱,产生震颤的针尖极易划伤手术对象眼球中的视网膜。
2、为了避免出现上述状况,在相关技术中,可以周期性读取机械臂各个关节电机的编码器数据,当外部人员或物体意外触碰、撞击到眼科手术机器人时,机械臂会受到外力阻碍,此时基于编码器数据可以确定关节电机的实际位置与理论位置之间产生误差,当该误差超出预设阈值时,可以向关节电机发送停止输出扭矩或制动抱死的指令,以避免针尖产生震颤。或者,可以在机械臂外壳或设备周边布置接近传感器,如电容式传感器、红外或超声波雷达,当根据接近传感器的距离检测数据确定外部人员或物体靠近机械臂,且二者的距离小于安全阈值时,可以向关节电机发送停止输出扭矩或制动抱死的指令,以避免即将发生的刚性碰撞,从而避免针尖产生震颤。
3、然而,在上述第一种方案中,由于必须等到外部撞击力已传递至机械臂且已对关节电机的位置造成改变之后,该外部撞击才能被检测到,因此在关节电机停止输出扭矩或制动抱死之前,可能已经引发针尖震颤,因此该方案无法有效避免出现针尖震颤。在上述第二种方案中,考虑到当眼科手术机器人附近有重物跌落时会产生机械波,该机械波可以沿地面传播至手术机器人,进而沿机械臂传播至针尖从而引发针尖震颤,由于接近传感器只能检测到宏观物体的靠近,此类机械波无法被接近传感器检测到,因此该方案无法避免因沿地面传播的机械波而导致的针尖震颤。
4、综上所述,如何有效避免因眼科手术机器人出现针尖震颤而导致手术对象眼球中的视网膜受到伤害的状况,成为本领域技术人员亟需解决的技术问题。
技术实现思路
1、为了解决相关技术中的问题,本公开实施例提供一种眼科手术机器人、控制方法、装置、设备及介质。
2、第一方面,本公开实施例中提供了一种眼科手术机器人,所述眼科手术机器人包括多个支撑部、机箱、与每个支撑部对应的支撑imu、承重柱、底部imu、安装部imu、机械臂以及震颤检测器。
3、其中,所述多个支撑部中每个支撑部的一端连接所述机箱的底面,另一端用于接触地面,且所述每个支撑部上安装有对应的支撑imu。所述承重柱的底部与所述机箱除底面以外的任一面连接,且所述承重柱的底部安装有所述底部imu。所述承重柱的安装部与所述机械臂连接,且所述承重柱的安装部安装有所述安装部imu。所述震颤检测器设置于所述机箱中,且所述震颤检测器分别与所述多个支撑imu、所述底部imu以及所述安装部imu通信连接。
4、所述震颤检测器,被配置为:
5、获取所述多个支撑imu、所述底部imu以及所述安装部imu中每个imu在当前周期检测到的加速度、角速度。
6、根据所述每个imu在上一周期的重力基线估计值、所述每个imu在当前周期检测到的加速度、角速度,获取每个imu在当前周期的重力基线估计值,其中所述每个imu的重力基线估计值包括重力在所述每个imu的局部坐标系中每个坐标轴上的投影分量的估计值。
7、根据所述每个imu在当前周期的重力基线估计值以及在当前周期检测到的加速度,获取所述每个imu在当前周期的震颤加速度分量,并基于所述每个imu在当前周期的震颤加速度分量获取当前周期的全局冲击幅值,其中所述每个imu的震颤加速度分量用于指示外部物理冲击导致在所述每个imu的安装位置产生的加速度,所述全局冲击幅值用于指示外部物理冲击对所述机械臂产生的冲击强度。
8、若所述当前周期的全局冲击幅值满足预设的冲击触发条件,则控制所述机械臂带动被所述机械臂夹持的手术针的针尖沿当前周期的进针方向的反方向撤离,其中撤离轨迹与当前周期之前的进针轨迹重合。
9、在本公开的一种实施方式中,所述根据所述每个imu在上一周期的重力基线估计值、所述每个imu在当前周期的加速度、角速度,获取每个imu在当前周期的重力基线估计值,包括:
10、根据计算当前周期所述每个imu的角速度幅值,其中、以及分别为所述每个imu在当前周期分别绕所述每个imu的局部坐标系中x轴、y轴、z轴旋转的角速度分量。
11、根据计算当前周期的滤波系数,其中为预设的滤波系数的上限值,为预设的滤波系数的下限值,预设的自适应增益系数,e为自然常数。
12、根据计算当前周期的重力基线估计值,其中为上一周期的重力基线估计值,为所述每个imu在当前周期检测到的加速度。
13、所述根据所述每个imu在当前周期的重力基线估计值以及在当前周期检测到的加速度,获取所述每个imu在当前周期的震颤加速度分量,包括:
14、根据计算所述每个imu在当前周期的震颤加速度分量。
15、在本公开的一种实施方式中,所述基于所述每个imu在当前周期的震颤加速度分量获取当前周期的全局冲击幅值,包括:
16、根据计算所述每个imu在当前周期的冲击幅值,其中、、分别为所述每个imu在当前周期的震颤加速度分量中在所述每个imu的局部坐标系中x轴、y轴、z轴方向上的加速度分量,所述冲击幅值用于指示外部物理冲击在所述每个imu的安装位置处产生的冲击强度。
17、根据计算当前周期的全局冲击幅值,其中为预设的加权系数,为所述眼科手术机器人中imu的个数,为当前周期所述眼科手术机器人中第个imu的冲击幅值,为当前周期所述眼科手术机器人中全部imu的冲击幅值中的最大值,为当前周期所述眼科手术机器人中imu的冲击幅值之和。
18、在本公开的一种实施方式中,所述若所述当前周期的全局冲击幅值满足预设的冲击触发条件,则控制所述机械臂的末端带动针尖沿当前周期的进针方向的反方向撤离,包括:
19、根据计算当前周期的冲击幅值斜率,其中为上一周期的全局冲击幅值,为当前周期与上一周期之间的时间差。
20、若连续个周期的全局冲击幅值以及所述眼科手术机器人中至少两个imu在当前周期的冲击幅值均大于或等于预设的第一冲击幅值阈值,且当前周期的冲击幅值斜率大于或等于预设的冲击幅值斜率阈值,则控制所述机械臂的末端带动针尖沿当前周期的进针方向的反方向撤离,其中所述连续个周期包括当前周期,。
21、或,若当前周期的全局冲击幅值大于或等于预设的第二冲击幅值阈值,则控制所述机械臂的末端带动针尖沿当前周期的进针方向的反方向撤离,其中所述第二冲击幅值阈值大于所述第一冲击幅值阈值。
22、在本公开的一种实施方式中,所述震颤检测器,还被配置为:
23、若连续至少两个周期的全局冲击幅值小于所述第一冲击幅值阈值且大于或等于第三冲击幅值阈值,则锁存当前周期所述机械臂各关节编码器的角度值,其中所述连续至少两个周期包括当前周期,所述第三冲击幅值阈值小于所述第一冲击幅值阈值。
24、根据锁存的所述机械臂各关节编码器的角度值,通过正运动学计算所述针尖的中心点的实时位姿,并根据所述实时位姿获取当前周期的进针方向。
25、在本公开的一种实施方式中,所述震颤检测器包括现场可编程门阵列fpga芯片,所述fpga芯片的可编程逻辑pl端通过光耦隔离的硬线输入输出io接口直接与所述机械臂的伺服驱动器的不可屏蔽中断nmi引脚连接。
26、所述fpga芯片,具体被配置为:
27、在控制所述机械臂的末端带动针尖沿当前周期的进针方向的反方向撤离之前,通过所述硬线io向所述机械臂的伺服驱动器发送nmi信号,使所述伺服驱动器响应于所述nmi信号,冻结上位机下发的运动指令。
28、第二方面,本公开实施例中提供了一种眼科手术机器人的控制方法,所述眼科手术机器人包括多个支撑部、机箱、与每个支撑部对应的支撑imu、承重柱、底部imu、安装部imu、机械臂以及震颤检测器。
29、其中,所述多个支撑部中每个支撑部的一端连接所述机箱的底面,另一端用于接触地面,且所述每个支撑部上安装有对应的支撑imu。所述承重柱的底部与所述机箱除底面以外的任一面连接,且所述承重柱的底部安装有所述底部imu。所述承重柱的安装部与所述机械臂连接,且所述承重柱的安装部安装有所述安装部imu。所述震颤检测器设置于所述机箱中,且所述震颤检测器分别与所述多个支撑imu、所述底部imu以及所述安装部imu通信连接。
30、所述控制方法包括:
31、控制所述震颤检测器,获取所述多个支撑imu、所述底部imu以及所述安装部imu中每个imu在当前周期检测到的加速度、角速度。
32、控制所述震颤检测器,根据所述每个imu在上一周期的重力基线估计值、所述每个imu在当前周期检测到的加速度、角速度,获取每个imu在当前周期的重力基线估计值,其中所述每个imu的重力基线估计值包括重力在所述每个imu的局部坐标系中每个坐标轴上的投影分量的估计值。
33、控制所述震颤检测器,根据所述每个imu在当前周期的重力基线估计值以及在当前周期检测到的加速度,获取所述每个imu在当前周期的震颤加速度分量,并基于所述每个imu在当前周期的震颤加速度分量获取当前周期的全局冲击幅值,其中所述每个imu的震颤加速度分量用于指示外部物理冲击导致在所述每个imu的安装位置产生的加速度,所述全局冲击幅值用于指示外部物理冲击对所述机械臂产生的冲击强度。
34、控制所述震颤检测器,若所述当前周期的全局冲击幅值满足预设的冲击触发条件,则控制所述机械臂带动被所述机械臂夹持的手术针的针尖沿当前周期的进针方向的反方向撤离,其中撤离轨迹与当前周期之前的进针轨迹重合。
35、在本公开的一种实施方式中,所述根据所述每个imu在上一周期的重力基线估计值、所述每个imu在当前周期的加速度、角速度,获取每个imu在当前周期的重力基线估计值,包括:
36、根据计算当前周期所述每个imu的角速度幅值,其中、以及分别为所述每个imu在当前周期分别绕所述每个imu的局部坐标系中x轴、y轴、z轴旋转的角速度分量。
37、根据计算当前周期的滤波系数,其中为预设的滤波系数的上限值,为预设的滤波系数的下限值,预设的自适应增益系数,e为自然常数。
38、根据计算当前周期的重力基线估计值,其中为上一周期的重力基线估计值,为所述每个imu在当前周期检测到的加速度。
39、所述根据所述每个imu在当前周期的重力基线估计值以及在当前周期检测到的加速度,获取所述每个imu在当前周期的震颤加速度分量,包括:
40、根据计算所述每个imu在当前周期的震颤加速度分量。
41、在本公开的一种实施方式中,所述基于所述每个imu在当前周期的震颤加速度分量获取当前周期的全局冲击幅值,包括:
42、根据计算所述每个imu在当前周期的冲击幅值,其中、、分别为所述每个imu在当前周期的震颤加速度分量中在所述每个imu的局部坐标系中x轴、y轴、z轴方向上的加速度分量,所述冲击幅值用于指示外部物理冲击在所述每个imu的安装位置处产生的冲击强度。
43、根据计算当前周期的全局冲击幅值,其中为预设的加权系数,为所述眼科手术机器人中imu的个数,为当前周期所述眼科手术机器人中第个imu的冲击幅值,为当前周期所述眼科手术机器人中全部imu的冲击幅值中的最大值,为当前周期所述眼科手术机器人中imu的冲击幅值之和。
44、在本公开的一种实施方式中,所述若所述当前周期的全局冲击幅值满足预设的冲击触发条件,则控制所述机械臂的末端带动针尖沿当前周期的进针方向的反方向撤离,包括:
45、根据计算当前周期的冲击幅值斜率,其中为上一周期的全局冲击幅值,为当前周期与上一周期之间的时间差。
46、若连续个周期的全局冲击幅值以及所述眼科手术机器人中至少两个imu在当前周期的冲击幅值均大于或等于预设的第一冲击幅值阈值,且当前周期的冲击幅值斜率大于或等于预设的冲击幅值斜率阈值,则控制所述机械臂的末端带动针尖沿当前周期的进针方向的反方向撤离,其中所述连续个周期包括当前周期,。
47、或,若当前周期的全局冲击幅值大于或等于预设的第二冲击幅值阈值,则控制所述机械臂的末端带动针尖沿当前周期的进针方向的反方向撤离,其中所述第二冲击幅值阈值大于所述第一冲击幅值阈值。
48、在本公开的一种实施方式中,所述控制方法还包括:
49、控制所述震颤检测器,若连续至少两个周期的全局冲击幅值小于所述第一冲击幅值阈值且大于或等于第三冲击幅值阈值,则锁存当前周期所述机械臂各关节编码器的角度值,其中所述连续至少两个周期包括当前周期,所述第三冲击幅值阈值小于所述第一冲击幅值阈值。
50、控制所述震颤检测器,根据锁存的所述机械臂各关节编码器的角度值,通过正运动学计算所述针尖的中心点的实时位姿,并根据所述实时位姿获取当前周期的进针方向。
51、在本公开的一种实施方式中,所述震颤检测器包括现场可编程门阵列fpga芯片,所述fpga芯片的可编程逻辑pl端通过光耦隔离的硬线输入输出io接口直接与所述机械臂的伺服驱动器的不可屏蔽中断nmi引脚连接。
52、所述控制方法还包括:
53、控制所述fpga芯片,在控制所述机械臂的末端带动针尖沿当前周期的进针方向的反方向撤离之前,通过所述硬线io向所述机械臂的伺服驱动器发送nmi信号,使所述伺服驱动器响应于所述nmi信号,冻结上位机下发的运动指令。
54、第三方面,本公开实施例中提供了一种眼科手术机器人的控制装置,所述眼科手术机器人包括多个支撑部、机箱、与每个支撑部对应的支撑imu、承重柱、底部imu、安装部imu、机械臂以及震颤检测器。
55、其中,所述多个支撑部中每个支撑部的一端连接所述机箱的底面,另一端用于接触地面,且所述每个支撑部上安装有对应的支撑imu。所述承重柱的底部与所述机箱除底面以外的任一面连接,且所述承重柱的底部安装有所述底部imu。所述承重柱的安装部与所述机械臂连接,且所述承重柱的安装部安装有所述安装部imu。所述震颤检测器设置于所述机箱中,且所述震颤检测器分别与所述多个支撑imu、所述底部imu以及所述安装部imu通信连接。
56、所述控制装置,包括:
57、惯性数据获取模块,被配置为控制所述震颤检测器获取所述多个支撑imu、所述底部imu以及所述安装部imu中每个imu在当前周期检测到的加速度、角速度。
58、重力基线估计模块,被配置为控制所述震颤检测器根据所述每个imu在上一周期的重力基线估计值、所述每个imu在当前周期检测到的加速度、角速度,获取每个imu在当前周期的重力基线估计值,其中所述每个imu的重力基线估计值包括重力在所述每个imu的局部坐标系中每个坐标轴上的投影分量的估计值。
59、全局冲击幅值获取模块,被配置为控制所述震颤检测器根据所述每个imu在当前周期的重力基线估计值以及在当前周期检测到的加速度,获取所述每个imu在当前周期的震颤加速度分量,并基于所述每个imu在当前周期的震颤加速度分量获取当前周期的全局冲击幅值,其中所述每个imu的震颤加速度分量用于指示外部物理冲击导致在所述每个imu的安装位置产生的加速度,所述全局冲击幅值用于指示外部物理冲击对所述机械臂产生的冲击强度。
60、针尖撤离模块,被配置为控制所述震颤检测器,在所述当前周期的全局冲击幅值满足预设的冲击触发条件时,控制所述机械臂带动被所述机械臂夹持的手术针的针尖沿当前周期的进针方向的反方向撤离,其中撤离轨迹与当前周期之前的进针轨迹重合。
61、第四方面,本公开实施例提供了一种电子设备,包括存储器和处理器,其中,所述存储器用于存储一条或多条计算机指令,其中,所述一条或多条计算机指令被所述处理器执行以实现如第二方面中任一项所述的方法。
62、第五方面,本公开实施例中提供了一种计算机可读存储介质,其上存储有计算机指令,该计算机指令被处理器执行时实现如第二方面中任一项所述的方法。
63、根据本公开实施例提供的技术方案,在眼科手术机器人中的机箱各支撑部、承重柱底部及其与机械臂连接的安装部分别设置imu,这些位置处于沿地面传播的机械波由机箱向机械臂传导路径上,因此震颤检测器获取imu上传的能够反映该机械波到达imu安装处的加速度、角速度的时刻,早于机械波到达被机械臂夹持的手术针的针尖的时刻,从而为后续处理预留了充裕的响应时间。震颤检测器依据每个imu上一周期的重力基线估计值和当前周期的角速度幅值自适应调整滤波系数,进而更新当前周期的重力基线估计值,该重力基线估计值可以反映因眼科手术机器人姿态变化引起的重力方向改变,从当前加速度中剔除重力分量,可以获得仅由机械波产生的震颤加速度分量,避免了将机身正常转动或静态重力误判为危险冲击。在此基础上,震颤检测器通过计算每个imu的冲击幅值,再融合为全局冲击幅值,该全局冲击幅值可以反映机械波对机械臂的真实冲击强度,避免因单一imu受局部干扰或失效而导致误触发针尖撤离。当全局冲击幅值满足预设触发条件时,震颤检测器判定当前机械波对机械臂的冲击的危险性较大,因此通过控制机械臂带动针尖沿当前进针方向的反方向撤离,从而在机械波带来的冲击尚未传至针尖时主动沿原进针轨迹退出,既避免了急停后针尖随机械臂震动而产生横向摆动划伤手术对象眼球中的视网膜,又杜绝了针尖撤离路径偏离原进针轴线所带来的风险。综上所述,本公开提供的眼科手术机器人可以在沿地面传播的机械波抵达针尖之前完成检测并执行针尖撤离,从而可以有效避免因眼科手术机器人出现针尖震颤而导致手术对象眼球中的视网膜受到伤害的状况,提高了眼科手术机器人的可靠性。
64、应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本公开。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com