一种微创手术机器人柔性丝传动手术器械高精度控制方法技术

一种微创手术机器人柔性丝传动手术器械高精度控制方法，涉及医疗机器人领域。为解决现有的微创手术机器人柔性丝传动手术器械控制方法控制精度有限，操作粗糙，使用不便的问题。采用简单便捷的方式进行手术器械的离线辨识，并且补偿准确度高。具体地说，本发明专利技术事先测量多把器械的滞回曲线，利用多项式拟合和极大似然估计得到该器械通用的滞回模型，再在实际使用之前用FCN网络对电机匀速往返运动时地电流数据进行辨识，准确地提取出回差大小以调整滞回模型的幅值，进而实现对手术器械的细腻控制。使用本发明专利技术时，只需要提前让致动电机匀速往返运动若干次即可，十分方便，且补偿细腻准确度高，使用方便。本发明专利技术适用于医疗机器人领域。域。域。

【技术实现步骤摘要】
一种微创手术机器人柔性丝传动手术器械高精度控制方法


[0001]本专利技术涉及医疗机器人领域，具体涉及一种微创手术机器人柔性丝传动手术器械高精度控制方法。

技术介绍

[0002]近年来，腔镜微创手术机器人的应用提高了手术效果，减轻了患者病痛。医生通过主操作手控制伸入患者腔体内的细长手术器械来实现各种手术操作。然而，由于紧凑设计，手术器械通常使用远距离致动柔性丝传动，进而导致致动端与输出端之间的运动存在迟滞现象，影响外科医生的精细操作。
[0003]目前业界主要通过“辨识
‑
补偿”的思路来解决该问题。补偿方面，有直接补偿和基于模型补偿两种方式。直接补偿一般通过在器械回差阶段前馈位置信号来实现，此方法简单但比较粗糙，位置控制细腻度较差。而基于模型补偿测试按照器械滞回模型或者动力学模型来补偿回差，准确度较高。而辨识方面，有在线辨识与离线辨识两种方式。在线辨识一般通过卡尔曼滤波或者支持向量分类等智能算法借助实际使用时采集到的电机编码器读数和电机电流来判断当前是否处于滞回状态，借此辨识结果指导补偿算法进行回差补偿。这种方式无需事先辨识，便于使用，但由于实际使用中的负载变化不可预知，该类方法的辨识准确度仍不能满足要求。而离线辨识主要通过对手术器械的运动或者动力学特性进行建模，在实际使用之前事先利用复杂的参考轨迹来辨识模型或者使用额外的三维位置测量仪器(比如NDI光学定位系统)测量模型，进而对辨识好的这一把器械进行前馈补偿。这种方式虽然辨识准确度较高，但需要对每一把器械提前进行辨识，使用不方便。此外，由于加工装配误差的影响，每一把器械滞回曲线的形状和幅值略有不同，如果在实际使用中只使用对某一把器械测量的模型来进行补偿，会产生较大的误差。
[0004]总之，现有的微创手术机器人柔性丝传动手术器械控制方法控制精度有限，操作粗糙，使用不便的问题。

技术实现思路

[0005]本专利技术为解决现有的微创手术机器人柔性丝传动手术器械控制方法控制精度有限，操作粗糙，使用不便的问题，而提出一种微创手术机器人柔性丝传动手术器械高精度控制方法。
[0006]本专利技术的一种微创手术机器人柔性丝传动手术器械高精度控制方法，其具体步骤如下：
[0007]步骤一、微创手术机器人系统开始主从控制，在每个控制周期循环判断致动电机是否反向运动；
[0008]步骤二、致动电机反向运动后，判断反向运动后的电机转向，如果正向转动则令电机目标位置q
d
[0009]q
d
＝q
d
+ΔS1ꢀꢀꢀ
(1)
[0010]利用电机目标位置q
d
来补偿机械间隙回差；
[0011]如果反向转动则令电机目标位置q
d
[0012]q
d
＝q
d
‑
ΔS1ꢀꢀꢀ
(2)
[0013]利用电机目标位置q
d
来补偿机械间隙回差，式(1)和式(2)中ΔS1是该手术器械的机械间隙回差；
[0014]步骤三、使用该手术器械的柔性丝形变回差ΔS2和手术器械通用滞回模型f(x；μ
ω
)(3a)得到反归一化的电机补偿曲线：
[0015]f
denorm
(x
denorm
；μ
ω
)＝f(x/ΔS2；μ
ω
)
ꢀꢀꢀ
(3)
[0016]式(3)中x是滞回模型的自变量，μ
ω
是滞回模型的参数，x
denorm
是归一化后的自变量；
[0017]步骤四、在开始柔性丝形变回差补偿之前记录电机初始位置
[0018]步骤五、电机目标位置：
[0019][0020]通过令电机目标位置来补偿柔性丝形变回差；
[0021]步骤六、在每个控制周期循环判断柔性丝变形回差是否补偿结束，如果结束则通过令电机目标位置q
d
＝q
d
+f
denorm
(1)来固定补偿值；
[0022]步骤七、跳回步骤一，不断重复；
[0023]进一步的，所述的步骤二中的手术器械的机械间隙回差ΔS1的计算方法如下：
[0024]步骤二一、在主控控制开始之前，令致动电机以速度v匀速往返运动，幅值大小为A
m
，采样周期为T
s
，采集致动电机匀速往返运动时的电流数据；
[0025]步骤二二、从电流数据中截取长度为L的电流数据，并作为一维FCN神经网络的输入；
[0026]步骤二三、一维FCN神经网络利用长度为L的电流数据计算机械间隙周期大小C1；
[0027]步骤二四、计算手术器械的机械间隙回差
[0028]ΔS1＝C1·
T
s
·
v
ꢀꢀꢀ
(5)，
[0029]式中C1是步骤二三中的机械间隙周期大小，T
s
是步骤二一中的采样周期，v是步骤二一中的致动电机速度；
[0030]进一步的，所述的步骤三中的手术器械的柔性丝形变回差ΔS2的计算方案如下：在主控控制开始之前，令致动电机以速度v匀速往返运动，幅值大小为A
m
，采样周期为T
s
，采集致动电机匀速往返运动时的电流数据；从电流数据中截取长度为L的电流数据，并作为一维FCN神经网络的输入；一维FCN神经网络利用长度为L的电流数据计算柔性丝形变周期大小C2；计算手术器械的柔性丝形变回差
[0031]ΔS2＝C2·
T
s
·
v
ꢀꢀꢀ
(6)，
[0032]式中C2是步骤二三中的柔性丝形变周期大小，T
s
是步骤二一中的采样周期，v是步骤二一中的致动电机速度；
[0033]进一步的，所述的步骤三中的手术器械通用滞回模型f(x；μ
ω
)的计算方法中，M是大于等于5的整数，K是大于等于2的整数，具体流程如下：
[0034]步骤三一、使用三维光学定位设备采集M个手术器械的滞回曲线；
[0035]步骤三二、从滞回曲线中分别提取柔性丝形变过程的滞回曲线
[0036]qo
ut
＝ξ
i
(q
in
)(i∈{1,2,...,M})
ꢀꢀꢀ
(7)，
[0037]共M条，式(7)中q
out
是手术器械末端位置，q
in
是致动电机的位置；
[0038]步骤三三、使用线性缩放，将柔性丝形变过程的滞回曲线的横轴范围归一化到区间[0,1]，得到归一化的柔性丝形变过程的滞回曲线
[0039][0040]式中x是归一化滞回曲线的自变量，ξ
i
是步骤三二中的滞回曲线，q
in
是致本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种微创手术机器人柔性丝传动手术器械高精度控制方法，其特征在于：其具体步骤如下：步骤一、微创手术机器人系统开始主从控制，在每个控制周期循环判断致动电机是否反向运动；步骤二、致动电机反向运动后，判断反向运动后的电机转向，如果正向转动则令电机目标位置q
d
q
d
＝q
d
+ΔS1ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)利用电机目标位置q
d
来补偿机械间隙回差；如果反向转动则令电机目标位置q
d
q
d
＝q
d
‑
ΔS1ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(2)利用电机目标位置q
d
来补偿机械间隙回差，式(1)和式(2)中ΔS1是该手术器械的机械间隙回差；步骤三、使用该手术器械的柔性丝形变回差ΔS2和手术器械通用滞回模型f(x；μ
ω
)(3a)得到反归一化的电机补偿曲线：f
denorm
(x
denorm
；μ
ω
)＝f(x/ΔS2；μ
ω
)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(3)式(3)中x是滞回模型的自变量，μ
ω
是滞回模型的参数，x
denorm
是归一化后的自变量；步骤四、在开始柔性丝形变回差补偿之前记录电机初始位置步骤五、电机目标位置：通过令电机目标位置来补偿柔性丝形变回差；步骤六、在每个控制周期循环判断柔性丝变形回差是否补偿结束，如果结束则通过令电机目标位置q
d
＝q
d
+f
denorm
(1)来固定补偿值；步骤七、跳回步骤一，不断重复。2.根据权利要求1所述的一种微创手术机器人柔性丝传动手术器械高精度控制方法，其特征在于：所述的步骤二中的手术器械的机械间隙回差ΔS1的计算方法如下：步骤二一、在主控控制开始之前，令致动电机以速度v匀速往返运动，幅值大小为A
m
，采样周期为T
s
，采集致动电机匀速往返运动时的电流数据；步骤二二、从电流数据中截取长度为L的电流数据，并作为一维FCN神经网络的输入；步骤二三、一维FCN神经网络利用长度为L的电流数据计算机械间隙周期大小C1；步骤二四、计算手术器械的机械间隙回差ΔS1＝C1·
T
s
·
v
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(5)，式中C1是步骤二三中的机械间隙周期大小，T
s
是步骤二一中的采样周期，v是步骤二一中的致动电机速度。3.根据权利要求1所述的一种微创手术机器人柔性丝传动手术器械高精度控制方法，其特征在于：所述的步骤三中的手术器械的柔性丝形变回差ΔS2的计算方...

【专利技术属性】
技术研发人员：潘博，郭勇辰，付宜利，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：