一种穿刺手术机器人柔顺控制系统技术方案

本发明专利技术涉及一种穿刺手术机器人柔顺控制系统，包括：基于微分控制器的PD控制模块，用于抑制测量噪声以及跟踪原始信号；阻抗控制位置模型建立模块，用于建立机器人控制循环的动态运动模型；力反馈控制模块，跟随操作者实现零力跟随控制即机械臂关节所受外力合力为0。本发明专利技术通过基于微分控制器的而改进的PD控制模块来实现对人体模型的实时跟踪效果，不仅能很好地对测量噪声进行抑制，还能够无超调的跟踪原始信号，实用性强，效率高，并且通过阻抗控制位置模型建立模块，使用内部位置控制器来实现跟踪理想阻抗模型的位置，降低了算法复杂度，提高了实时性。

A compliance control system of robot for puncture operation

【技术实现步骤摘要】
一种穿刺手术机器人柔顺控制系统
本专利技术涉及穿刺手术机器人领域，特别涉及一种穿刺手术机器人柔顺控制系统。
技术介绍
柔顺控制(随动控制)指机器人能够对外界环境有顺从的能力，大范围柔顺控制指其在所能迗到的所有构型下都能够实现柔顺运动。手术操纵者通过视觉确定机器人末端执行器所在的位置，和大脑中所期望的目标点进行比较并得到相应的位置偏差，然后使用手臂对机器人末端执行器施加力的作用，通过机器人腕部安装的力传感器得到外部的作用力，并反馈到控制器，使机器人能够实时跟随操纵者的意志进行运动。现在手术过程中，手术精密度要求越来越高，常规的肉眼手术已经不能满足高难度手术了，因此，急需一种工作精度高、工作稳定且效率高的穿刺手术机器人柔顺控制系统装置。
技术实现思路
本专利技术要解决的问题在于提供一种工作精度高、工作稳定且效率高的一种穿刺手术机器人柔顺控制系统。为解决上述问题，本专利技术提供一种穿刺手术机器人柔顺控制系统装置，包括：基于微分控制器的PD控制模块，用于抑制测量噪声以及跟踪原始信号；阻抗控制位置模型建立模块，用于建立机器人控制循环的动态运动模型；力反馈控制模块，跟随操作者实现零力跟随控制即机械臂关节所受外力合力为0。本专利技术的有益效果是，通过基于微分控制器的而改进的PD控制模块来实现对人体模型的实时跟踪效果，不仅能很好地对测量噪声进行抑制，还能够无超调的跟踪原始信号，实用性强，效率高，并且通过阻抗控制位置模型建立模块，使用内部位置控制器来实现跟踪理想阻抗模型的位置，降低了算法复杂度，提高了实时性。进一步的，所述基于微分控制器的PD控制模块具体包括：微分跟踪器的离散模型单元，用于建立机器人行程轨迹的运动数学关系；逆运动学数学关系建立单元，用于将目标位置进行求解从而得出各个机器人的关节的控制量。进一步的，所述阻抗控制位置模型建立模块具体包括：位置控制模块单元，用于将具体空间位置通过逆运动学反解到关节空间中；卡尔曼滤波器单元，用于对使用中产生的噪声进行抑制。进一步的，所述位置控制模块单元还具体包括：重力补偿算法单元，用于滤除末端执行器所造成的影响；力衰减修正单元，用于控制偏差通过死区衰减后输入力控制器，从而得到修正值。进一步的，所述力反馈控制模块包括力数字矩阵计算单元，用于将外部力通过计算反馈给控制器进行控制移动。附图说明为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图1是本专利技术一种穿刺手术机器人柔顺控制系统的柔顺控制的应用示意图；图2是本专利技术一种穿刺手术机器人柔顺控制系统的基于微分跟踪器的PD控制原理框图；图3是本专利技术一种穿刺手术机器人柔顺控制系统的大范围柔顺控制原理图；图4是本专利技术一种穿刺手术机器人柔顺控制系统的位置跟踪曲线及其受力图；图5是本专利技术一种穿刺手术机器人柔顺控制系统的柔顺控制接触力曲线图。具体实施方式下面结合具体实施例，对本专利技术的内容做进一步的详细说明：本专利技术要解决的问题在于提供一种工作精度高、工作稳定且效率高的一种穿刺手术机器人柔顺控制系统。如图1所示，为解决上述问题，本专利技术提供一种穿刺手术机器人柔顺控制系统装置，包括：基于微分控制器的PD控制模块，用于抑制测量噪声以及跟踪原始信号；阻抗控制位置模型建立模块，用于建立机器人控制循环的动态运动模型；力反馈控制模块，跟随操作者实现零力跟随控制即机械臂关节所受外力合力为0。本专利技术的有益效果是，通过基于微分控制器的而改进的PD控制模块来实现对人体模型的实时跟踪效果，不仅能很好地对测量噪声进行抑制，还能够无超调的跟踪原始信号，实用性强，效率高，并且通过阻抗控制位置模型建立模块，使用内部位置控制器来实现跟踪理想阻抗模型的位置，降低了算法复杂度，提高了实时性。进一步的，所述基于微分控制器的PD控制模块具体包括：微分跟踪器的离散模型单元，用于建立机器人行程轨迹的运动数学关系；逆运动学数学关系建立单元，用于将目标位置进行求解从而得出各个机器人的关节的控制量。如图2，图3所示，在实际操作中，微分跟踪器的离散模型单元的模型如下：其中u(k)是在k时刻的控制变量；X1是输入信号的跟踪信号；X2为跟踪信号的近似微分信号；T是米样时间；h是滤波系数；r是速度系数；fst函数形式如下:其中:δ＝rh,δ0＝δh；Y＝x0-u+hx2；操纵者根据作业现场的情况判断出机器人所期望的目标点，并对机器人末端执行器施加力的作用，通过六维力传感器得到外部的作用力fs，将该信号通过死区衰减后输入微分跟踪器(TD)，对力信号进行处理，得到力信号的跟踪信号和力信号的近似微分信号，分别输入给PD控制器中的P项和D项，并输出位置修正值X，和当前位置进行比较后得到笛卡尔空间目标位姿，最后对目标位姿进行逆运动学求解后将各关节的控制量输入机器人位置控制内环完成一个控制循环。进一步的，所述阻抗控制位置模型建立模块具体包括:位置控制模块单元，用于将具体空间位置通过逆运动学反解到关节空间中；卡尔曼滤波器单元，用于对使用中产生的噪声进行抑制。进一步的，所述位置控制模块单元还具体包括：重力补偿算法单元，用于滤除末端执行器所造成的影响；力衰减修正单元，用于控制偏差通过死区衰减后输入力控制器，从而得到修正值。在实际操作中，阻抗控制位置模型建立模块如下：Fh＝Md(Xd-Xc)+Bd(Xd-Xc)+Kd(Xd-Xc)；Xc表示当前位置，Xd表示期望位置，Md表示机器人的虚拟惯性矩阵，Bd表示机器人的虚拟阻尼矩阵，Kd表示机器人的虚拟刚度矩阵，模型中的Md，Kd为机器人的阻抗特性系数，都为对角阵。Md虚拟惯性矩阵对冲击力较强，速度变换较大的运动过程有较大影响；Bd虚拟阻尼矩阵对外界干扰以及位置变化较快的运动有较大的影响；虚拟刚度矩阵对低速运动或静止状态附近的运动影响较大。机器人所需位置可以在拉普拉斯域中表示为：△X(S)＝Fh(s)/Mds2+BdS+Kd＝Fh(s)H(s)；△X(S)是△X的拉普拉斯变换，Fh(s)是Fh和s的拉普拉斯变换。通过上述分析,机器人关节空间的柔顺位置控制器为:通过使用向后差分的方法得到速度与加速度的表达式：△X(k)＝a0△F(k)+a1△x(k-1)+a2△x(k-2)；其中：如图4所示，经过此方式，在工作中，在本文档来自技高网...

【技术保护点】
1.一种穿刺手术机器人柔顺控制系统，其特征在于，包括：/n基于微分控制器的PD控制模块，用于抑制测量噪声以及跟踪原始信号；/n阻抗控制位置模型建立模块，用于建立机器人控制循环的动态运动模型；/n力反馈控制模块，跟随操作者实现零力跟随控制即机械臂关节所受外力合力为0。/n

【技术特征摘要】
1.一种穿刺手术机器人柔顺控制系统，其特征在于，包括：
基于微分控制器的PD控制模块，用于抑制测量噪声以及跟踪原始信号；
阻抗控制位置模型建立模块，用于建立机器人控制循环的动态运动模型；
力反馈控制模块，跟随操作者实现零力跟随控制即机械臂关节所受外力合力为0。


2.根据权利要求1所述的穿刺手术机器人柔顺控制系统，其特征在于，所述基于微分控制器的PD控制模块具体包括：
微分跟踪器的离散模型单元，用于建立机器人行程轨迹的运动数学关系；
逆运动学数学关系建立单元，用于将目标位置进行求解从而得出各个机器人的关节的控制量。


3.根据权利要求1所述的穿刺手术机器...

【专利技术属性】
技术研发人员：韩玥，牛福永，乔飞，李振晓，
申请(专利权)人：苏州新医智越机器人科技有限公司，
类型：发明
国别省市：江苏;32