一种静配机器人的流量分液精度智能补偿方法与流程
本发明涉及静配机器人分液控制,特别涉及一种静配机器人的流量分液精度智能补偿方法。
背景技术:
1、静配机器人用于医院静脉用药调配中心,实现自动化药液抽吸与分液装配。在自动化分液过程中,利用蠕动泵挤压输液软管提供动力,通过控制分液泵的运转转速与旋转圈数实现设定剂量的药液输出。
2、在连续配制不同药液的过程中,实际输出剂量受到药液黏度变化、输液软管材料弹性恢复力衰减、针头局部流动阻力以及分液泵机械磨损等多种动态因素的影响。现有静配机器人采用开环累加控制或事后称重补偿方式。开环累加控制基于固定的出厂标定参数执行控制,无法应对药液黏度变化与管路老化;事后称重补偿方式在当前分液周期结束后,通过称重传感器获取最终质量误差,并直接将该误差用于调整下一分液周期的泵转速或运行时间。此类方式无法区分误差是由药液黏度变化引起还是由管路弹性储能引起,且事后称重补偿属于滞后调节,无法消除当前分液周期内部已经发生的停泵拖尾滴漏,导致分液终点控制精度较低。因此,如何在线辨识流路动态参数,预测尚未发生的拖尾体积,并协同控制分液泵与截止机构,是突破静配机器人高精度分液瓶颈的难点。
技术实现思路
1、本技术的目的旨在至少能解决上述的技术缺陷之一,特别是现有技术中静配机器人分液控制方法无法在线辨识流路物理动态参数,难以区分药液黏度与管路弹性形变对分液误差的影响,且无法预测停泵后由管路弹性储能释放和流体惯性产生的末端拖尾滴漏,导致分液终点控制精度低、连续运行稳定性差的技术缺陷。
2、第一方面,本技术提供一种静配机器人的流量分液精度智能补偿方法,所述方法包括以下步骤:
3、步骤s1,采集流量分液数据和历史可信参数基准,控制分液泵启动,连续采集压强信号与流量信号;
4、步骤s2,计算分液泵的脉动周期,采用滑动窗口均值滤波器对压强信号与流量信号进行相位同步滤波,基于脉动周期对滤波后的流量信号进行时间积分计算当前累计输出体积,并根据滑动窗口内流量变化率绝对值均值判定更新模式;
5、步骤s3,基于不同的更新模式计算对应参数,将所述对应参数输入流路动态灰色数学模型重构预测流量响应曲线与预测压强响应曲线,通过综合评价值选择最优辨识参数集,基于当前累计输出体积的数值,冻结根据所述最优辨识参数集耦合得到的本周期实际控制参数集的数值;
6、步骤s4,基于本周期实际控制参数集规划分液泵的减速轨迹,实时计算减速阶段剩余预计输出体积和预测拖尾体积总量,结合剩余目标体积执行双事件触发控制策略控制分液泵减速和执行截止动作,并在分液完成后更新历史可信参数基准及执行三级安全退化处理。
7、作为一种可选的实施方式,所述步骤s1具体包括:
8、所述流量分液数据包括处方目标分液体积、截止执行单元闭合动作延时和分液泵驱动排量映射系数;
9、所述历史可信参数基准包括从存储器中读取历史等效流阻参数基准、历史等效柔顺参数基准与历史等效惯性参数基准;
10、控制器向分液泵输出驱动电压指令信号启动分液泵,以固定采样周期连续采集压强信号和流量信号。
11、作为一种可选的实施方式,所述步骤s2的具体逻辑包括:
12、将六十秒除以分液泵设定转速与挤压滚轮数量的乘积,计算得到脉动周期;
13、将每个采样时刻采集到的流量信号数值与采样周期相乘,并进行连续累加,计算得到当前累计输出体积;
14、将滑动窗口的时间宽度设定为脉动周期,计算相位同步滤波后的压强信号和流量信号的算术平均值,计算流量信号对时间的一阶导数得到流量变化率,计算滑动窗口内流量变化率的绝对值均值;
15、当流量变化率的绝对值均值不小于激励判断阈值时,激活全动态更新模式;
16、当流量变化率的绝对值均值小于激励判断阈值时,激活稳态更新模式。
17、作为一种可选的实施方式,所述步骤s3中,基于不同的更新模式计算对应参数,具体包括:
18、在全动态更新模式下,计算流量上升阶段的稳态流量均值,以稳态流量均值为基准划定多个在流量区间上相互重叠的候选数据采集窗口,对每一个候选数据采集窗口内的数据,基于流路动态灰色数学模型构造带无量纲归一化残差的约束最小二乘目标算式,设置约束条件为等效流阻参数与等效柔顺参数严格大于零、等效惯性参数不小于零,求解得到各个候选数据采集窗口对应的候选参数集;
19、在稳态更新模式下,将稳态滑动窗口内的平均有效驱动压差除以平均流量,求解得到等效流阻参数,并保持等效柔顺参数与等效惯性参数等于历史可信参数基准。
20、作为一种可选的实施方式,所述步骤s3中,选择最优辨识参数集的处理逻辑包括:
21、将各候选参数集代入流路动态灰色数学模型,重构计算得到预测流量响应曲线与预测压强响应曲线;
22、对预测流量曲线与实测流量曲线的归一化均方误差、预测压强曲线与实测压强曲线的归一化均方误差、候选参数集相对于历史可信参数基准的相对欧氏距离以及物理界限惩罚项进行加权求和,计算得到各候选数据采集窗口的综合评价值;
23、比较各候选数据采集窗口对应的综合评价值的大小,选取使综合评价值最小的候选数据采集窗口,将该候选数据采集窗口解出的候选参数集确定为最优辨识参数集。
24、作为一种可选的实施方式,所述步骤s3还包括:
25、基于置信度融合系数对所述最优辨识参数集与历史可信参数基准进行加权求和,计算得到本周期实际控制参数集;
26、将处方目标分液体积减去当前累计输出体积计算得到剩余目标体积,当剩余目标体积降低至预设比例界限时,锁定并维持本周期实际控制参数集的数值不变,在后续减速与截止过程中禁止更新。
27、作为一种可选的实施方式,所述步骤s4中,基于本周期实际控制参数集规划分液泵的减速轨迹,具体包括:
28、根据处方设定的目标体积流量、分液泵驱动排量映射系数、本周期实际控制参数集中的等效流阻参数和等效惯性参数,计算得到减速驱动电压指令,对其进行修正后发至分液泵驱动器,驱动分液泵逐步降低转速,计算实测瞬时流量与减速过程的时间常数的乘积,得到减速阶段剩余预计输出体积;
29、在每个采样周期将管路弹性形变储能释放预计输出体积、流体与机械惯性预计输出体积、闭合动作延时预计输出体积与末端残余容积段固定体积相加,计算得到预测拖尾体积总量;
30、其中,将等效柔顺参数乘以压力检测单元处的测量压强与外部环境参考压强及零点偏置压强的差值,计算得到管路弹性形变储能释放预计输出体积;
31、将等效惯性参数乘以当前流量信号并除以等效流阻参数,计算得到流体与机械惯性预计输出体积;
32、将当前流量信号乘以截止执行单元闭合动作延时,计算得到闭合动作延时预计输出体积。
33、作为一种可选的实施方式,所述步骤s4中,双事件触发控制策略的逻辑包括:
34、当剩余目标体积降至减速阶段预计输出体积、管路弹性形变储能释放预计输出体积、闭合动作延时预计输出体积、末端残余容积段固定体积与第一安全余量体积五者之和时,触发第一控制事件,控制器控制分液泵按减速轨迹减速运转;
35、当剩余目标体积降至预测拖尾体积总量与第二安全余量体积之和,且压强信号不大于截止安全压强上限时,触发第二控制事件,控制器向截止执行单元发送闭合指令,驱动截止执行单元截断流路,并在截止执行单元闭合完成后控制分液泵停止运转。
36、作为一种可选的实施方式,所述步骤s4中,更新历史可信参数基准的逻辑包括:
37、分液完成后,控制器提取当前分液周期内实测流量信号经离散时间积分得到的实际输出总体积,计算实际输出总体积与处方目标分液体积差值的绝对值,当该差值的绝对值不大于预设允许误差界限时,利用历史更新学习率,对更新前的历史可信参数基准与本周期实际控制参数集进行加权平均计算,输出更新后的历史可信参数基准。
38、作为一种可选的实施方式,所述步骤s4中,执行三级安全退化处理具体包括在步骤s3解出最优辨识参数集及其最小综合评价值后、进入关断控制逻辑前执行判定:
39、当该综合评价值不大于第一模型判定界限时,判定模型处于一级自适应模式,直接采用本周期实际控制参数集进行控制;
40、当综合评价值大于第一模型判定界限且不大于第二模型判定界限时,判定模型处于二级加权融合退化模式,控制器降低置信度融合系数的数值,加大历史可信参数基准的比重;
41、当综合评价值大于第二模型判定界限,或者最优辨识参数集中存在超出物理可行安全范围的参数时,判定模型处于三级模型失效安全模式,控制器停止参数更新,直接令本周期实际控制参数集等于历史可信参数基准执行分液控制,并输出报警提示信号。
42、从以上技术方案可以看出,本技术实施例具有以下优点:本发明构建了包括等效流阻、等效柔顺参数和等效惯性参数的集中参数灰箱数学模型,能够在分液启动与稳态阶段在线解耦求解出表征药液黏度的流阻特性、表征软管形变的柔顺特性以及表征运动惯性的惯性特性。相较于传统黑箱算法或事后称重补偿方式,从物理机制层面明确了分液误差来源,避免了因混淆流阻与柔顺度导致的控制过冲与系统自激振荡。
43、本发明通过结合分液泵转速与滚轮数量生成周期脉动抑制窗口,划定多个重叠的候选数据采集窗口,采用带物理约束的最小二乘目标算式求解,并将求解参数代入模型重构预测响应,通过多目标综合评价值择优选取最优参数。该机制克服了传统依赖固定单一特征点判定易受噪声干扰的缺陷,提升了参数辨识的稳定性。
44、本发明提出了基于管路弹性形变储能、流体惯性、执行器动作延时及末端残余容积的预测拖尾体积总量与减速阶段体积的实时计算逻辑。修正了触发时序逻辑,使得减速判定界限严格大于截止判定界限,在分液末期通过剩余体积事件双重依次触发分液泵减速与独立截止执行单元机械截止,并在高压状态下实施安全约束,使得系统在达到目标剂量之前提前实施硬件截断,消除了停泵后管路弹性回弹导致的末端拖尾滴漏,提升了分液终点控制精度。
45、本发明引入置信度低通融合与关断预测区参数冻结机制,防止了关断阶段因参数自适应波动导致的控制抖动;同时设计了基于模型重构误差的三级安全退化机制与基于绝对误差值的历史参数更新机制,在传感器异常或流路剧烈堵塞时自动退化至安全控制模式并报警,保障了系统连续运行的安全可靠性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com