包含预测与滤波的间接手术机器人远程控制方法技术

本发明专利技术涉及一种包含预测与滤波的间接手术机器人远程控制方法，其解决微创手术机器人远程手术过程中，数据传输过程存在数据包乱序、延迟的技术问题，主控制器通过主从运动映射算法将主手动作指令转换为从手的关节运动信息，主控制器将从手的关节运动信息经互联网发送至从手；从手的从端控制器对接收到的关节运动信息数据进行校验、滤波、运动解算，然后控制从手各个关节的电机工作；从手各个关节上的传感器采集的信号直接反馈到从手的从端控制器。本发明专利技术广泛用于微创手术机器人。本发明专利技术广泛用于微创手术机器人。本发明专利技术广泛用于微创手术机器人。

【技术实现步骤摘要】
包含预测与滤波的间接手术机器人远程控制方法


[0001]本专利技术涉及内窥镜微创手术机器人
，具体而言，涉及一种包含预测与滤波的间接手术机器人远程控制方法。

技术介绍

[0002]微创手术是指利用腹腔镜、胸腔镜等现代医疗器械及相关设备进行的手术。与传统的开放手术相比，微创手术具有创口小、疼痛轻、术中出血量少、术后恢复快、感染风险低等优势，因此在外科手术领域得到了广泛的认可与应用。但是现有的手术机器人也有它的局限性，就是医生无法操控手术机器人对病人进行异地手术。
[0003]随着现代网络技术的发展，手术机器人远程操控技术的引入可以有效解决这些问题。手术机器人远程操控技术的出现弥补机器人操控距离上的问题，主要表现在保持手术机器人运动精度高，可对病灶区域进行精准定位操作；具有良好的稳定性，消除医生手部抖动，防止出现误操作；手眼协调一致性，降低操作难度，提升了手术安全性；消除了医生长时间站立的疲劳感，等基础上还具有医生可对病人异地手术的优点。
[0004]参考授权公告号为CN109091237B，名称为微创手术器械辅助系统的中国专利技术专利以及授权公告号为CN109091238B、名称为分体式微创手术器械辅助系统的中国专利技术专利，以及授权公告号为CN210872029U、名称为医生操作台的技术专利，以及申请公布号为CN112370168A、名称为微创手术机器人系统的专利技术专利申请，微创手术器机器人被设计为在内窥镜下，由医生在手术室内操作，控制手术器械做手术的设备系统。医生坐在医生操作台前，通过观看3D影像显示器，操作医生机械臂，医生可如同平常手术般，利用患者机械臂精准的控制手术器械执行各种手术动作。
[0005]现有微创手术机器人系统，医生通过手持多自由度的机械式运动输入装置来输出动作指令，通过主从运动映射算法，可以将采集到的动作之指令转换为机械臂的关节运动信息，从机械臂跟随主机械臂的运动。现有技术的主从映射算法可以参考公开号为CN112716608A，名称为用于微创手术机器人的主从跟踪控制方法的专利技术专利申请。
[0006]目前，异地远程手术是微创手术机器人的一种应用，远程手术融合了机器人技术、通讯技术、远程控制技术、空间映射算法以及容错性分析等关键技术。医生根据手术需求操作主机械臂；主机械臂的各关节传感器的信号经实时采集并处理后输出，经过主端通讯控制器将数据包进行封装后，经由专用互联网发送至从机械臂，从机械臂的从端控制器对接收到的数据包进行校验、滤波后发送到从机械臂的运动控制器，在运动控制器中进行运动解算，最终从机械臂的各个关节所期望的位置输入到各个电机的驱动器，进而控制从机械臂完成医生期望的动作。
[0007]互联网不仅有着复杂的物理线路，同时也存在复杂的协议族、校验机制以及网络安全机制。网络延时主要取决于传输距离和数据传输所经过的物理链路，包括经过路由器个数和路由处理时间。固定传输节点的传输路线和路由线路通常是一定的，但由于网络存在共享和竞争性，路由处理时间和处理任务是变化的，且不同时刻数据包在路由上的等待
时间和处理时间也是随机变化的，因此会产生数据包乱序、延迟等问题。因此，为满足手术操作稳定性、精确性的严苛要求，如何解决数据包乱序、延迟问题是本领域技术人员亟待解决的技术问题。

技术实现思路

[0008]本专利技术就是为了解决微创手术机器人远程手术过程中，数据传输过程存在数据包乱序、延迟的技术问题，提供了一种采用专用网络并通过延时补偿和滤波来解决数据传输波动，确保机器人运行的稳定性和精确性的包含预测与滤波的间接手术机器人远程控制方法。
[0009]本专利技术公开的包含预测与滤波的间接手术机器人远程控制方法，包括以下步骤：
[0010]主控制器通过主从运动映射算法将主手动作指令转换为从手的关节运动信息，主控制器将从手的关节运动信息经互联网发送至从手；
[0011]从手的从端控制器对接收到的关节运动信息数据进行校验、滤波、运动解算，然后控制从手各个关节的电机工作；
[0012]从手各个关节上的传感器采集的信号直接反馈到从手的从端控制器，控制系统的闭环传递函数为：
[0013][0014]上式中，延时e
‑
τcas
表示互联网传输过程中的延迟，Y(s)表示输出响应，R(s)表示输入指令，C(s)是从端控制器对指令内部相应时间；G(s)表示控对象传递函数；G
m
(s)是预测滤波函数，预测滤波函数用于基于当前网络状态针对控制指令设定缓存。
[0015]本专利技术的有益效果是，消除信号远程传输过程中数据包的乱序、延迟，有利于确保机器人运行的稳定性和精确性。
[0016]本专利技术进一步的特征和方面，将在以下参考附图的具体实施方式的描述中，得以清楚地记载。
附图说明
[0017]图1是本专利技术远程控制方法流程图；
[0018]图2是现有技术远程数据传输原理图；
[0019]图3是图2所示远程数据传输的闭环传递函数；
[0020]图4是本专利技术间接远程控制方法的原理图；
[0021]图5是本专利技术间接远程控制方法的闭环传递函数；
[0022]图6是未经过预测滤波的主从跟踪实验得出的曲线图；
[0023]图7是经过预测滤波的主从跟踪实验得出的曲线图；
[0024]图8是用Socket套字节完成通信协议原理图；
[0025]图9是远程控制流程图。
具体实施方式
[0026]微创手术机器人系统的运动学计算分为主手运动学计算和从手运动学计算。主手运动学计算涉及到正向运动学，即对于主机械臂，已知连杆几何参数和关节变量，求主机械臂末端相对于参考坐标系的位置和姿态；从手运动学计算涉及到逆向运动学，即已知从机械臂连杆的几何参数，给定从机械臂末端相对于参考坐标系的期望位置和姿态，求从机械臂到达预期姿态的关节变化量。
[0027]参考图2，目前常规的数据远程传输过程中，主端通讯控制器发出的控制信号和从机械臂中传感器反馈的信号都是通过网络传输，并且传输的网络没有限制，而且可以是两个相互独立的网络分别对两种信号进行传输。参考图3，传感器节点信息反馈采用事件驱动，执行器与控制器C1(s)基于事件驱动，D(s)为阶跃干扰信号，τ
ca
代表控制器
‑
执行器延时，τ
sc
代表与传感器
‑
控制器延时，网络控制系统闭环传递函数为：
[0028][0029]闭环特征方程为：
[0030][0031]该系统特征方程中存在延时指数项，导致相位滞后，调节时间增加，超调量增加，影响系统稳定性与控制性能，甚至造成系统故障。
[0032]由于网络延时具有时变特点，机器人主操作手位姿数据在网络传输过程中会产生数据包的丢失、滞后或乱序。
[0033]为消除网络传输的影响，本专利技术公开了包含预测与滤波的间接手术机器人远程控制方法。如图4所示，间接控制结构的远程端是一个独立的闭环控本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种包含预测与滤波的间接手术机器人远程控制方法，其特征在于，包括以下步骤：主控制器通过主从运动映射算法将主手动作指令转换为从手的关节运动信息，主控制器将从手的关节运动信息经互联网发送至从手；从手的从端控制器对接收到的关节运动信息数据进行校验、滤波、运动解算，然后控制从手各个关节的电机工作；从手各个关节上的传感器采集的信号直接反馈到从手的从端控制器，...

【专利技术属性】
技术研发人员：王炳强，李晓阳，徐栋，
申请(专利权)人：山东威高手术机器人有限公司，
类型：发明
国别省市：