一种用于血管介入手术机器人系统的时滞误差预测控制方法技术方案

一种用于血管介入手术机器人系统的时滞误差预测控制方法，利用系统辨识技术得到的系统的数学模型作为预测模型，在主端设备采集医生手部位移动作的同时，通过预测控制的方式，对时滞产生的误差进行预测，将预测的误差补偿至从端设备中，通过迭代优化使得输入的控制量为最优控制量，减小时滞以及机械因素所带来的误差，以达到补偿时滞带来的误差的目的，使医疗机器人系统的精准度以及实时性更好，在医疗机器人的领域具有较高的实用性和可研究价值；此方法简单易行，对于主从式的高精度医疗器械领域具有非常强的实用性和可推广性。

A time delay error predictive control method for vascular interventional surgery robot system

【技术实现步骤摘要】
一种用于血管介入手术机器人系统的时滞误差预测控制方法
本专利技术属于机器人技术、自动控制
，尤其是一种用于血管介入手术机器人系统的时滞误差预测控制方法，能够利用系统辨识技术得到血管介入手术机器人的数学模型，随后使用辨识得到的数学模型来进行控制。
技术介绍
随着远程医疗技术的快速发展，越来越多主从式的手术机器人系统投入使用。其中使用频率最高、发展最快的便是主从式血管介入手术机器人系统。主从式血管介入手术机器人系统的工作方式为：由医生操作主端设备，主端设备将采集医生手部的位移动作，然后将采集好的位移动作经过中央控制器处理传输至从端设备，从端设备根据中央处理器传输来的信号对医生的动作进行复现来完成手术。由于血管介入手术机器人为主从系统，存在明显的时滞问题。产生这种时滞的主要原因为控制逻辑本身存在问题，该系统的控制逻辑为：血管介入手术机器人系统运行的过程中，一定需要通过主端设备采集医生的动作，再将动作信息传输至从端设备，以驱动从端设备运行。因此，主端设备在采集医生动作的过程中的采样间隔会成为血管介入机器人系统的时滞。而这种时滞无法通过提高主端设备与从端设备的通讯速度而带来得到改善。为了解决这一问题，我们设计了一种时滞误差预测控制方法，通过状态空间模型预测时滞所带来的误差，将预测出的误差补偿至从端设备，通过这种方式来弥补时滞所带来的误差。
技术实现思路
本专利技术的目的在于提供一种用于血管介入手术机器人系统的时滞误差预测控制方法，它可以解决现有技术中的时滞问题，通过将预测时滞所带来的误差作为系统控制的补偿量，从而来达到提高血管介入手术机器人系统实时性和精准度的目的，该方法简单且容易实现。本专利技术采用的技术方案：一种用于血管介入手术机器人系统的时滞误差预测控制方法，其特征在于它包括以下步骤：(1)以血管介入手术机器人系统的主端设备的位移量为输入信号，以从端设备的位移量为输出信号，利用Matlab(Matrix&Laboratory，矩阵工厂/矩阵实验室)的系统辨识工具包，建立血管介入手术机器人系统的传递函数模型，模型如式(1)所示：其中，k和p为常系数，t为系统的时间滞后参数；(2)利用Matlab中的step函数得到血管介入手术机器人系统的阶跃响应H(l)，并建立如下的血管介入手术机器人系统的卷积模型：其中，y(k)为系统的当前时刻的输出，u(k-l)为系统上一时刻的输入；由于血管介入手术机器人系统的卷积模型可以表示当前时刻的输出与上一时刻的输入之间关系，故可将式(2)所示的卷积模型作为预测模型；(3)对时域控制量和时域预测量分别进行设置，其中，所述时域控制量是指输入控制量的时间长度；所述时域预测量是指利用步骤(2)中得到的预测模型对系统输出量进行预测的时间段，即对从端设备的位移进行预测的时间段；所述步骤(3)中的时域预测量与主端设备的采样间隔相同；由于预测的精度受预测时域长度的影响，过长的预测时间会导致预测结果的精度降低，过短的预测时间长度会导致预测次数过多将导致计算量过大给控制器带来负担，因此，选择预测时域与主端设备的采样时间相同。所述步骤(3)中的时域控制量指的是每个输入量输入系统的时间间隔，根据血管壁的厚度以及手术导管的安全推进速度，设置安全的控制时域值。(4)将实际测得的主端设备的位移作为当前时间段的输入代入如公式(2)所示的预测模型中，即可得到未来时刻的输出，达到对下一时刻输出量进行预测的目的；所述步骤(4)中利用预测模型得到未来时刻的输出具体是指：公式(2)中，u(k-l)为系统上一时刻的输入量，即：主端设备的位移，y(k)为下一个时刻的输出量，即：从端设备的位移，将实际测得的主端设备的位移作为当前时间段的输入代入u(k-l)，即可得到未来时刻的输出y(k)。所述步骤(4)中实际测得的主端设备的位移是使用NOVOTECHNIK公司生产的直线位移传感器测得。(5)由于测量设备测量输入量以及输出量的误差以及系统辨识技术本身的误差，将导致步骤(1)得到预测模型无法与真实的系统达到完全匹配的效果，使得预测出的从端设备的位移量与实际的从端设备的位移量是有误差的；因此，将步骤(4)中预测到的输出量与实际输出量进行做差，利用闭环反馈，则可得到预测输出量与实际输出量之间的误差；(6)利用步骤(5)中得到的预测输出量与实际输出量之间的误差结果对步骤(4)中产生的预测结果进行补偿，即：将步骤(5)中计算得到的预测误差与原有的输入量进行求和，则可得到新的输入量，将新的输入量作为血管介入手术机器人系统的输入到，即可实现闭环预测结果；此时，闭环的预测结果将比步骤(4)中通过预测模型得到的开环预测结果要更加准确；(7)步骤(6)中得到了更加准确的预测结果，但只依靠在预测模块中得到了较为精确的预测输出不足以使得血管介入手术机器人系统的整体性能指标更加优化，因此需要对血管介入手术机器人系统的整体性能指标进行优化，使血管介入手术机器人系统的整体性能指标为主端设备的位移与从端设备的位移保持一致；加入闭环反馈以及PID控制器使血管介入手术机器人的整体性能得到优化，将此时的输入量与输出量做差，即：将主端设备位移与从端设备位移求差，将这个误差作为输入量输入PID控制器，并将调整后的结果作为被控对象血管介入手术机器人系统的输入信号，最后经过PID控制器调整过后输出的结果即为经过预测反馈环以及输出反馈环的双闭环结构调整后的结果。本专利技术的工作原理：根据预测结果，针对血管介入手术机器人系统提出了整体系统的性能指标，即：从端设备的运动与主端设备的运动(即位移量)达到完全一致的效果，引入闭环反馈，将主端设备的位移量(系统输入)与从端设备的位移量(系统输出)做差得到主端设备与从端设备运动的误差，将测量的误差补偿至输入量中，并加入PID控制使误差量变得更小。其中的PID技术为一种技术，PID控制器是一个在工业控制应用中常见的反馈回路控制方法，由比例单元P、积分单元I和微分单元D组成。PID控制的基础是比例控制；积分控制可消除稳态误差，但可能增加超调；微分控制可加快大惯性系统响应速度以及减弱超调趋势。此外，利用了系统辨识技术求得较为精确的血管介入手术机器人系统的传递函数模型通过Matlab程序中的step函数得到阶跃响应，利用血管介入手术机器人系统的叠加性质建立卷积模型；利用卷积模型的特点预测未来时刻的输出；通过预测反馈环的方式让预测结果更加精准；最后利用反馈以及PID控制的方式使系统的输出更加准确。提高血管介入手术机器人系统的准确性和安全性。本专利技术优点和积极效果为：利用系统辨识技术得到的传递函数模型经过转化得到的卷积模型作为预测模型，在主端设备采集医生手部位移动作的同时，通过预测控制的方式，对时滞产生的误差进行预测，将预测的误差补偿至从端设备中，减小时滞以及机械因素所带来的误差，以达到补偿时滞带来的误差的目的，使医疗机器人系统的精准度以及实时性更好，在医疗机器人的领域具有较高的实用性和可研究价值。本文档来自技高网...

【技术保护点】
1.一种用于血管介入手术机器人系统的时滞误差预测控制方法，其特征在于它包括以下步骤：/n(1)以血管介入手术机器人系统的主端设备的位移量为输入信号，以从端设备的位移量为输出信号，利用Matlab的系统辨识工具包，建立血管介入手术机器人系统的传递函数模型，模型如式(1)所示：/n

【技术特征摘要】
1.一种用于血管介入手术机器人系统的时滞误差预测控制方法，其特征在于它包括以下步骤：
(1)以血管介入手术机器人系统的主端设备的位移量为输入信号，以从端设备的位移量为输出信号，利用Matlab的系统辨识工具包，建立血管介入手术机器人系统的传递函数模型，模型如式(1)所示：



其中，k和p为常系数，t为系统的时间滞后参数；
(2)利用Matlab中的step函数得到血管介入手术机器人系统的阶跃响应H(l)，并建立如下的血管介入手术机器人系统的卷积模型：



其中，y(k)为系统的当前时刻的输出，u(k-l)为系统上一时刻的输入；
式(2)所示的卷积模型即为预测模型；
(3)对时域控制量和时域预测量分别进行设置，其中，所述时域控制量是指输入控制量的时间长度；所述时域预测量是指利用步骤(2)中得到的预测模型对系统输出量进行预测的时间段，即对从端设备的位移进行预测的时间段；
(4)将实际测得的主端设备的位移作为当前时间段的输入代入如式(2)所示的预测模型中，即可得到未来时刻的输出，达到对下一时刻输出量进行预测的目的；
(5)将步骤(4)中预测到的输出量与实际输出量进行做差，利用闭环反馈，则可得到预测输出量与实际输出量之间的误差；
(6)利用步骤(5)中得到的预测输出量与实际输出量之间的误差结果对步骤(4)中产生的预测结果进行补偿，即：将步骤(5)中计算得到的预测误差与原有的输入量进行求和，则可得到新的输入量，将新的输入...

【专利技术属性】
技术研发人员：郭健，郭书祥，杨帅，
申请(专利权)人：天津理工大学，
类型：发明
国别省市：天津;12