[发明专利]高精度蠕动泵控制方法

说明书

本发明公开了一种高精度蠕动泵控制方法，涉及自动化控制领域，通过对采集到的角速度值进行补偿，能够有效的克服偶然因数引起的波动干扰，为后续的数据处理提供了准确的角速度采集单元值。然后通过计算角速度值补偿参数对采集到的角速度值进行补偿，由于传统的蠕动泵控制系统采集到的角速度值偏差大且动态响应性差，对角速度变化的趋势缺乏考虑，因此必须对角速度值进行补偿，采用本技术方案获取的角速度值补偿参数及补偿方式，能够动态的根据采集到的角速度值及角速度变化趋势对采集到的角速度值进行补偿，从而能够准确预判角速度调节量，提高了蠕动泵控制的准确性及稳定性。

技术领域

本发明涉及自动化控制领域，特别是涉及一种高精度蠕动泵控制方法。

背景技术

蠕动泵由于其无污染、精度高、密封性好等优点，被广泛应用于血液净化设备中。常规的蠕动泵控制系统仅能对蠕动泵运转一周的累计速度进行调节，不能实现蠕动泵角速度的调节。

传统的蠕动泵受结构限制，泵在运转到不同角度时，所受的阻力不一致，导致其转速不是很稳定，所以泵在运作时会产生一个脉冲流，使管路内的压力变化较大，使蠕动泵产生的脉冲流，同时出现回流现象，影响泵管内压力和流量的稳定性，容易超出血液净化设备的报警线，同时影响病人治疗的舒适性。现有的蠕动泵控制系统根据采集到的蠕动泵转速叠加预设的控制信号量进行控制，而基本上并未对采集的数据进行处理，导致蠕动泵的控制存在延迟高、响应慢、适应能力差和稳定性不高的缺点，近年来在实际的测量和控制中，如何保证蠕动泵实时的精准控制是急待解决的问题。

发明内容

有鉴于现有技术的上述缺陷，本发明所要解决的技术问题是提供一种能够对蠕动泵的角速度进行精准调节的控制方法。

为实现上述目的，本发明提供了一种高精度蠕动泵控制方法，采用蠕动泵控制系统进行控制，所述蠕动泵控制系统包括控制电路、电机驱动电路、位置传感器和角速度传感器；所述控制电路的输出端连接所述电机驱动电路的输入端；所述控制电路的第一输入端连接位置传感器的信号输出端；所述控制电路的第二输入端连接角速度传感器的信号输出端；按以下步骤进行：

步骤一、所述控制电路输出一个固定的控制信号量给所述电机驱动电路控制所述蠕动泵转动；所述位置传感器记录所述蠕动泵泵轴的圆周位置并将数据传给所述控制电路，所述角速度传感器测出所述蠕动泵泵轴在各圆周位置上对应的角速度值并将数据传给所述控制电路,从而得出所述蠕动泵泵轴各圆周位置的目标角速度值；完成后执行下一个步骤；

步骤二、所述控制电路输出控制信号量给所述电机驱动电路控制所述蠕动泵转动；所述控制电路通过所述位置传感器和角速度传感器采集所述蠕动泵泵轴各圆周位置的实际角速度值；完成后执行下一个步骤；

步骤三、所述控制电路对采集到的蠕动泵泵轴各圆周位置的实际角速度值进行补偿；完成后执行下一个步骤；

步骤四、所述控制电路根据补偿后的蠕动泵泵轴各圆周位置的实际角速度值，控制所述蠕动泵转动，直到所述蠕动泵的泵轴各圆周位置均达到步骤一得到的目标角速度值；

步骤三中所述控制电路对采集到的蠕动泵泵轴各圆周位置的实际角速度值进行补偿按以下步骤执行：

S1、设定采集到的泵轴各圆周位置的实际角速度值为Q_t，所述t为正整数；

S2、获取有效角速度值数列；

设定有效判断值为P_a，设定判断阈值为R；计算P_a＝Q_a-Q_a-1得到P_a；判断是否P_a≥R，当P_a≥R时，将Q_a删除；当P_a＜R时，将Q_a存入有效角速度值数列中；2≤a≤t且a为整数；所述R＞0；设定所述有效角速度值数列为{M_b}，所述b为正整数；