一种呼吸随动控制方法技术

本申请提供的呼吸随动控制方法，包括：根据机器人的当前位姿转角

【技术实现步骤摘要】
一种呼吸随动控制方法、装置和控制器


[0001]本申请涉及机器人控制
，尤其涉及一种呼吸随动控制方法
、
装置和控制器
。

技术介绍

[0002]传统的肝脏
、
胸腔等部位的微波穿刺消融手术通常需要医师和患者同时暴露在放射环境中
。
为了避免医师遭受大规模的辐射环境影响，医师通常需要穿着极厚的金属铅制防护服
。
近年来，伴随着医疗机器人技术的发展，一些远程微波穿刺消融手术开始逐渐走进实际应用中
。
[0003]用于远程微波穿刺消融手术的机器人通常由机械臂挂载穿刺针来执行消融手术
。
但是由于手术过程中，机器人末端的穿刺针通常为刚性的，而治疗部位通常位于胸腔
、
肝脏等部位
。
这样，在肝脏
、
胸腔等部位的远程微波穿刺消融手术过程中，由于人体的呼吸运动
、
以及潜在的因麻醉
、
温度等因素导致的人体肌肉痉挛抽动现象，容易造成刚性的穿刺针附近的皮肤撕伤，使得患者造成二次伤害
。
[0004]因此，如何避免穿刺针与胸腔皮肤之间的相对运动对周围皮肤造成的二次伤害成为当前亟待解决的问题
。

技术实现思路

[0005]有鉴于此，本申请提供一种呼吸随动控制方法
、
装置和控制器，用以实现呼吸随动，以避免穿刺针与胸腔皮肤之间的相对运动对周围皮肤造成的二次伤害
。
[0006]具体地，本申请是通过如下技术方案实现的：本申请第一方面提供一种呼吸随动控制方法，所述方法应用于控制器，所述控制器用于对机器人进行控制，所述机器人的机械臂的末端连接有多维力传感器，所述多维力传感器上设置有末端负载，所述末端负载包括夹持装置和夹持在所述夹持装置上的穿刺针；所述方法包括：根据所述机器人当前时刻在多个指定轴上的当前位姿转角
、
以及所述多维力传感器在当前时刻采集到的当前原始数据，确定所述穿刺针与所述穿刺针当前所作用的患者之间的多个力学量；其中，所述多个力学量包括所述患者在所述多个指定轴上受到的接触作用力和接触力矩；针对所述多个力学量中的每个力学量，根据所述每个力学量
、
以及所述末端对应于所述每个力学量的速度，确定所述每个力学量对应的第一导纳参数；为所述第一导纳参数选取修正系数，并采用所述修正系数对所述第一导纳参数进行修正；根据所述第一导纳参数
、
预设初始第一导纳参数和预设初始第二导纳参数，确定所述每个力学量对应的第二导纳参数；根据所述第一导纳参数
、
所述第二导纳参数
、
所述每个力学量
、
所述机械臂当前时
刻对应于所述每个力学量的当前运动学量
、
以及所述机械臂上一时刻对应于所述每个力学量的历史运动学量，确定所述机械臂下一时刻对应于所述每个力学量的运动学增量；根据所述机械臂当前时刻对应于所述多个力学量的多个当前运动学量和所述机械臂下一时刻对应于所述多个力学量的多个运动学增量控制所述机器人，以实现呼吸随动
。
[0007]本申请第二方面提供一种呼吸随动控制装置，所述装置应用于控制器，所述控制器用于对机器人进行控制，所述机器人的机械臂的末端连接有多维力传感器，所述多维力传感器上设置有末端负载，所述末端负载包括夹持装置和夹持在所述夹持装置上的穿刺针；所述装置包括确定模块
、
修正模块和控制模块：其中，所述确定模块，用于根据所述机器人当前时刻在多个指定轴上的当前位姿转角
、
以及所述多维力传感器在当前时刻采集到的当前原始数据，确定所述穿刺针与所述穿刺针当前所作用的患者之间的多个力学量；其中，所述多个力学量包括所述患者在所述多个指定轴上受到的接触作用力和接触力矩；所述确定模块，还用于针对所述多个力学量中的每个力学量，根据所述每个力学量
、
以及所述末端对应于所述每个力学量的速度，确定所述每个力学量对应的第一导纳参数；所述修正模块，用于为所述第一导纳参数选取修正系数，并采用所述修正系数对所述第一导纳参数进行修正；所述确定模块，还用于根据所述第一导纳参数
、
预设初始第一导纳参数和预设初始第二导纳参数，确定所述每个力学量对应的第二导纳参数；所述确定模块，还用于根据所述第一导纳参数
、
所述第二导纳参数
、
所述每个力学量
、
所述机械臂当前时刻对应于所述每个力学量的当前运动学量
、
以及所述机械臂上一时刻对应于所述每个力学量的历史运动学量，确定所述机械臂下一时刻对应于所述每个力学量的运动学增量；所述控制模块，用于根据所述机械臂当前时刻对应于所述多个力学量的多个当前运动学量和所述机械臂下一时刻对应于所述多个力学量的多个运动学增量控制所述机器人，以实现呼吸随动
。
[0008]本申请第三方面提供一种控制器，包括存储器
、
处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行所述程序时实现本申请第一方面提供的任一项所述方法的步骤
。
[0009]本申请第四方面提供一种计算机可读存储介质，其上存储有计算机程序，所述程序被处理器执行时实现本申请第一方面提供的任一项所述方法的步骤
。
[0010]本申请提供的呼吸随动控制方法
、
装置和控制器，应用于控制器，所述控制器用于对机器人进行控制，所述机器人的机械臂的末端连接有多维力传感器，所述多维力传感器上设置有末端负载，所述末端负载包括夹持装置和夹持在所述夹持装置上的穿刺针
。
本申请提供的呼吸随动控制方法
、
装置和控制器，通过根据所述机器人当前时刻在多个指定轴上的当前位姿转角
、
以及所述多维力传感器在当前时刻采集到的当前原始数据，确定所述穿刺针与所述穿刺针当前所作用的患者之间的多个力学量；其中，所述多个力学量包括所述患者在所述多个指定轴上受到的接触作用力和接触力矩，并针对所述多个力学量中的每
个力学量，根据所述每个力学量
、
以及所述末端对应于所述每个力学量的速度，确定所述每个力学量对应的第一导纳参数，进而为所述第一导纳参数选取修正系数，并采用所述修正系数对所述第一导纳参数进行修正，从而根据所述第一导纳参数
、
预设初始第一导纳参数和预设初始第二导纳参数，确定所述每个力学量对应的第二导纳参数，并根据所述第一导纳参数
、
所述第二导纳参数
、
所述每个力学量
、
所述机械臂当前时刻对应于所述每个力学量的当前运动学量
、
以及所述机械臂上一时刻对应于所述每个力学量的历史运动学量，确定所述机械臂下一时刻对应于所述每个力学量的运动学增量，最后根据所述机械臂当前时刻对应于所述多个力学量的多个当前运动学本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.
一种呼吸随动控制方法，其特征在于，所述呼吸随动控制方法应用于控制器，所述控制器用于对机器人进行控制，所述机器人的机械臂的末端连接有多维力传感器，所述多维力传感器上设置有末端负载，所述末端负载包括夹持装置和夹持在所述夹持装置上的穿刺针；所述方法包括：根据所述机器人当前时刻在多个指定轴上的当前位姿转角
、
以及所述多维力传感器在当前时刻采集到的当前原始数据，确定所述穿刺针与所述穿刺针当前所作用的患者之间的多个力学量；其中，所述多个力学量包括所述患者在所述多个指定轴上受到的接触作用力和接触力矩；针对所述多个力学量中的每个力学量，根据所述每个力学量
、
以及所述末端对应于所述每个力学量的速度，确定所述每个力学量对应的第一导纳参数；为所述第一导纳参数选取修正系数，并采用所述修正系数对所述第一导纳参数进行修正；根据所述第一导纳参数
、
预设初始第一导纳参数和预设初始第二导纳参数，确定所述每个力学量对应的第二导纳参数；根据所述第一导纳参数
、
所述第二导纳参数
、
所述每个力学量
、
所述机械臂当前时刻对应于所述每个力学量的当前运动学量
、
以及所述机械臂上一时刻对应于所述每个力学量的历史运动学量，确定所述机械臂下一时刻对应于所述每个力学量的运动学增量；根据所述机械臂当前时刻对应于所述多个力学量的多个当前运动学量和所述机械臂下一时刻对应于所述多个力学量的多个运动学增量控制所述机器人，以实现呼吸随动
。2.
根据权利要求1所述的方法，其特征在于，根据所述机器人当前时刻在多个指定轴上的当前位姿转角
、
以及所述多维力传感器在当前时刻采集到的当前原始数据，确定所述穿刺针与所述穿刺针当前所作用的患者之间的多个力学量，包括：根据所述当前位姿转角，确定所述机器人对应的机器人坐标系到所述多维力传感器对应的传感器坐标系的转换关系；根据所述转换关系
、
以及预先确定的所述末端负载在所述机器人坐标系下在所述多个指定轴上的第一重力分量，确定所述末端负载当前在所述传感器坐标系下在所述多个指定轴上的第二重力分量；根据所述当前原始数据
、
预先确定的所述多维力传感器的零力
、
以及所述第二重力分量，确定所述多个力学量
。3.
根据权利要求1所述的方法，其特征在于，所述根据所述每个力学量
、
以及所述末端对应于所述每个力学量的速度，确定所述每个力学量对应的第一导纳参数，包括：将所述每个力学量和所述速度输入到预设的模糊控制模型中，以由所述模糊控制模型根据所述每个力学量和所述速度，利用预设推理规则确定所述第一导纳参数
。4.
根据权利要求1所述的方法，其特征在于，根据所述第一导纳参数
、
所述第二导纳参数
、
所述每个力学量
、
所述机械臂当前时刻对应于所述每个力学量的当前运动学量
、
以及所述机械臂上一时刻对应于所述每个力学量的历史运动学量，确定所述机械臂下一时刻对应于所述每个力学量的运动学增量，包括：按照第一公式确定所述运动学增量；其中，所述第一公式为：
，其中，为所述运动学增量；为所述当前运动学量；为所述历史运动学量；为所述每个力学量；为所述上一时刻到所述当前时刻的时间差；为所述第一导纳参数；为所述第二导纳参数
。5.
根据权利要求1所述的方法，其特征在于，所述为所述第一导纳参数选取修正系数，包括：确定滑动窗口；其中，所述滑动窗口的开始时刻为所述当前时刻之后
、
所述多维力传感器采集到的原始数据中的所述每个力学量首次为零的时刻；所述滑动窗口的结束时刻为所述开始时刻之后
、
所述多维力传感器采集到的多个原始数据中的所述每个力学量历经一个峰值和一个谷值之后
、
所述多维力传感器采集到的原始数据中的所述每个力学量再...

【专利技术属性】
技术研发人员：陶永，韩栋明，王奕儒，万嘉昊，高赫，刘海涛，薛蛟，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：