[发明专利]一种基于模糊PID控制器的主从同步控制方法及装置

说明书

本发明实施例提供一种基于模糊PID控制器的主从同步控制方法及装置，其中，方法包括：在系统开始工作前，检测系统的主端与从端之间的交互指令在通信网络中的传输时延等级。基于指令传输时延等级，确定与系统当前的传输函数相匹配的P、I、D参数初值；确定机器人主端与从端位移之间，以及角度之间的偏差和偏差变化率，并将偏差和偏差变化率作为输入变量；发送P、I、D参数初值和输入变量至模糊PID控制器，以使模糊PID控制器在设定P、I、D参数初值后，对输入变量进行处理，得到用于控制机器人从端的清晰控制量；按照清晰控制量控制从端运动。通过本方案可以提高采用遥操作的血管介入手术机器人系统主从运动一致性。

技术领域

本发明涉及医疗技术领域，特别是涉及一种基于模糊PID控制器的主从同步控制方法及装置。

背景技术

血管介入手术是利用现代高科技手段进行的一种微创性治疗，通常是在遥操作的主从式控制方式下，操作者即医生通过血管介入手术机器人系统包括的机器人主端的操作装置，操控该系统所包括的机器人从端的执行装置，以将介入导丝/导管插入到特定分支血管的病灶位置，而后对体内病态进行特定的介入治疗。这种特定介入治疗可应用于冠状动脉球囊扩张/支架植入、经皮冠脉血管成形和心房震颤/心动过速的心脏射频消融等适应症。血管介入手术因具有手术创伤小、患者痛苦少、术后恢复快、医生与患者的辐射损伤低等优势，成为了临床医学新的发展趋势。

在血管介入手术过程中，血管介入手术机器人系统需要实现手术器械跟随医生手部以相同的趋势运动,使得医生能够手眼协调操作，因此对主从同步控制的一致性的要求很高。

但是，由于现有血管介入手术机器人系统采用遥操作的主从式控制方式，其通信网络的时延所带来的不稳定性影响系统的稳定性，导致现有血管介入手术机器人系统主从运动一致性的控制并不理想。

发明内容

本发明实施例的目的在于提供一种基于模糊PID控制器的主从同步控制方法及装置，以提高采用遥操作的血管介入手术机器人系统主从运动一致性。具体技术方案如下：

第一方面，本发明实施例提供一种基于模糊PID控制器的主从同步控制方法，应用于采用遥操作的血管介入手术机器人系统的控制器，所述系统包括机器人主端、通信网络、机器人从端、模糊PID控制器和控制器；所述方法包括：

检测血管介入手术机器人系统的机器人主端与机器人从端之间的交互指令在通信网络中的传输时延等级；

基于所述传输时延等级，确定与所述系统当前的传输函数相匹配的P、I、D参数初值；其中，所述P、I、D参数为所述系统的模糊PID控制器的参数；

确定所述机器人主端与所述机器人从端位移之间的偏差和偏差变化率，以及角度之间的偏差和偏差变化率，并将所确定的偏差和偏差变化率作为输入变量；

发送所述P、I、D参数初值和所述输入变量至所述机器人从端的模糊PID控制器，以使所述模糊PID控制器在设定所述P、I、D参数初值后，按照预先建立的模糊调节规则，对所述输入变量进行模糊推理，得到位移和角度的输出模糊控制量；并对所述位移和角度的输出模糊控制量进行反模糊化，得到用于控制所述机器人从端位移和角度的清晰控制量；

按照所述清晰控制量，控制所述机器人从端运动。

可选的，所述基于所述传输时延等级，确定与所述系统当前的传输函数相匹配的P、I、D参数初值，包括：

从预先建立的PID初始参数匹配库，查找与所述传输时延等级对应的P、I、D参数初值,作为与所述系统当前的传输函数相匹配的P、I、D参数初值；

其中，所述PID初始参数匹配库记载有各传输时延等级与模糊PID控制器的P、I、D参数初值的对应关系，任一传输时延等级对应的P、I、D参数初值为与该传输时延等级下所述系统的传输函数相匹配的参数初值。