一种基于状态参数融合的鹤管位置调节控制方法及系统与流程

摘要: 本发明涉及自动控制。更具体地,本发明涉及一种基于状态参数融合的鹤管位置调节控制方法及系统。背景技术:1、鹤管是流体装卸作业中连接固定输送管路与槽车、罐车等移动受...
一种基于状态参数融合的鹤管位置调节控制方法及系统与流程

本发明涉及自动控制。更具体地,本发明涉及一种基于状态参数融合的鹤管位置调节控制方法及系统。

背景技术:

1、鹤管是流体装卸作业中连接固定输送管路与槽车、罐车等移动受液设备的装卸设备。为适应车辆停靠位置和接口位置变化,自动化鹤管通常设置多个旋转运动轴和伸缩运动轴,由伺服驱动机构带动各运动轴完成展开、对接和位置调整,并依据目标位置和位置反馈进行闭环控制。

2、现有鹤管位置控制通常针对各运动轴设置机械限位、软件限位或位置指令限幅,以避免超过机械行程或现场允许运行范围。同时,为减小齿隙、连接间隙及换向过程中的位置响应滞后,可设置位置补偿或位置修正环节,并将补偿量叠加到位置指令中,位置限制与位置补偿分别执行。

3、然而,鹤管属于长悬臂、多关节运动设备,各运动轴可执行的位置范围不仅受固定机械行程限制,还会随伸缩状态、实际位置和运动速度变化。运动轴接近位置边界且仍朝边界方向运动时,即使尚未越界,也可能缺少减速空间;同时,换向后的补偿量还可能继续变化,使最终位置目标偏移,导致当前已经满足位置边界要求的目标在后续补偿继续叠加后仍可能超出鹤管当前能够执行的位置范围,使位置限制环节再次介入并反复截断或修正位置指令,造成运动轴在边界附近出现频繁减速、停顿或者反向调整,严重时还可能触发限位保护而中断当前位置调节过程。

技术实现思路

1、为解决上述鹤管边界附近位置限制与后续位置补偿连续作用不协调的技术问题,本发明在如下的多个方面中提供方案。

2、在第一方面中,本发明提供了一种基于状态参数融合的鹤管位置调节控制方法,包括:

3、获取各运动轴的运动轴实际位置、运动轴实际速度和原始业务目标位置,根据原始业务目标位置在连续控制周期之间的变化确定业务换向;

4、业务换向时确定本次位置补偿终值,使当前累计位置补偿量从零逐周期单调变化至本次位置补偿终值,并以当前累计位置补偿量和本次位置补偿终值中的最小值、最大值分别作为位置补偿作用区间的下边界和上边界;

5、根据伸缩运动轴的运动轴实际位置确定相应运动轴的负方向有效位置边界和正方向有效位置边界,并根据运动轴实际位置、运动轴实际速度、负方向有效位置边界和正方向有效位置边界形成最终位置目标允许范围;

6、根据最终位置目标允许范围和位置补偿作用区间确定补偿兼容名义位置域,使补偿兼容名义位置域内的名义位置叠加位置补偿作用区间内任一累计位置补偿量后形成的位置值均位于最终位置目标允许范围内;

7、在补偿兼容名义位置域非空时,将原始业务目标位置限制在补偿兼容名义位置域内形成受限名义位置目标,将当前累计位置补偿量叠加至受限名义位置目标形成最终伺服位置目标,并将最终伺服位置目标作为相应伺服驱动机构的位置目标输入。

8、优选地,所述根据原始业务目标位置在连续控制周期之间的变化确定业务换向,包括:

9、将运动轴实际位置、运动轴实际速度和原始业务目标位置均为有效数据的控制周期作为有效控制周期;控制任务启动后的首次有效控制周期,将当前原始业务目标位置保存为初始原始业务目标位置,不判定业务换向;

10、自下一连续有效控制周期开始,将当前原始业务目标位置与前一有效控制周期的原始业务目标位置进行比较,当前原始业务目标位置增大时确定业务运动方向为正方向,当前原始业务目标位置减小时确定业务运动方向为负方向,当前原始业务目标位置未发生变化时不形成新的业务运动方向,并保持最近一次已经形成的非零业务运动方向;

11、首次出现非零原始业务目标位置变化时,将对应的业务运动方向保存为初始业务运动方向;此后,当前形成的非零业务运动方向与最近一次保存的非零业务运动方向相反时,确定发生业务换向,并将当前形成的非零业务运动方向保存为新的业务运动方向。

12、优选地,所述业务换向时确定本次位置补偿终值,包括:

13、根据发生业务换向的运动轴和本次原始业务目标位置的变化方向,读取设备调试阶段针对相应业务换向情况预先保存的位置补偿总量,将读取的位置补偿总量作为本次位置补偿终值,其中,位置补偿总量为运动轴发生业务换向后,使驱动侧跨越换向空程并重新带动运动轴输出端沿换向后的方向产生位置变化所需累计施加的附加位置量。

14、优选地,所述业务换向时确定本次位置补偿终值,包括:

15、使待测运动轴沿一个方向低速运动,在运动轴输出位置连续变化后改变驱动方向,并记录改变驱动方向时的驱动侧位置;保持改变后的驱动方向继续运动,当运动轴输出位置首次沿改变后的方向产生超过位置反馈分辨率的位置变化时,再次记录驱动侧位置;

16、将两次记录的驱动侧位置之差换算为相应运动轴输出端的位置差,并按照改变后的运动方向对所述位置差赋予正负号,将所得带符号位置量作为对应业务换向情况的位置补偿总量并保存;

17、业务换向时,根据发生业务换向的运动轴和本次原始业务目标位置的变化方向,读取对应业务换向情况保存的位置补偿总量,并将读取的位置补偿总量作为本次位置补偿终值。

18、优选地,所述根据伸缩运动轴的运动轴实际位置确定相应运动轴的负方向有效位置边界和正方向有效位置边界,包括:

19、在伸缩运动轴的允许运行范围内设置多个标定伸缩位置,在每个标定伸缩位置下分别确定相应运动轴的机械允许位置范围和现场空间允许位置范围,取机械允许位置范围的下边界和现场空间允许位置范围的下边界中的最大值作为对应标定伸缩位置的负方向有效位置边界,取机械允许位置范围的上边界和现场空间允许位置范围的上边界中的最小值作为对应标定伸缩位置的正方向有效位置边界,并保存各标定伸缩位置与负方向有效位置边界、正方向有效位置边界之间的对应关系;

20、伸缩运动轴的运动轴实际位置与某一标定伸缩位置相同时,采用该标定伸缩位置对应的负方向有效位置边界和正方向有效位置边界;伸缩运动轴的运动轴实际位置处于两个相邻标定伸缩位置之间时,根据伸缩运动轴的运动轴实际位置在两个相邻标定伸缩位置之间所处的比例,对两个相邻标定伸缩位置对应的负方向有效位置边界分别进行线性插值,并对两个相邻标定伸缩位置对应的正方向有效位置边界分别进行线性插值,得到当前控制周期的负方向有效位置边界和正方向有效位置边界。

21、优选地,所述根据运动轴实际位置、运动轴实际速度、负方向有效位置边界和正方向有效位置边界形成最终位置目标允许范围,包括:

22、将正方向有效位置边界与运动轴实际位置之差作为正方向剩余位置余量,将运动轴实际位置与负方向有效位置边界之差作为负方向剩余位置余量;

23、根据运动轴实际速度和相应运动方向预先确定的减速度幅值形成对应方向的减速预留位置余量,所述减速预留位置余量包括从当前状态采集至下一控制周期重新形成位置目标期间运动轴按照当前实际速度继续运动对应的位置量,以及将当前实际速度降低至零所需的位置量;

24、分别从正方向剩余位置余量和负方向剩余位置余量中扣除对应方向的减速预留位置余量,扣除后的结果大于零时将该结果作为相应方向的可用位置余量,扣除后的结果小于或者等于零时将相应方向的可用位置余量设为零;

25、以运动轴实际位置为基准,向负方向延伸负方向可用位置余量形成最终位置目标允许范围的下边界,向正方向延伸正方向可用位置余量形成最终位置目标允许范围的上边界。

26、优选地,所述根据最终位置目标允许范围和位置补偿作用区间确定补偿兼容名义位置域,包括:

27、以最终位置目标允许范围的下边界减去位置补偿作用区间的下边界所得的位置值作为补偿兼容名义位置域的下边界,以最终位置目标允许范围的上边界减去位置补偿作用区间的上边界所得的位置值作为补偿兼容名义位置域的上边界。

28、优选地,还包括:

29、当补偿兼容名义位置域的下边界大于补偿兼容名义位置域的上边界时,确定补偿兼容名义位置域为空,终止本次位置补偿,将本次位置补偿终值和当前累计位置补偿量均设为零,将位置补偿作用区间重置为零值区间,并以当前运动轴实际位置作为当前控制周期的最终伺服位置目标;在下一次业务换向发生以前,不重新建立被终止的本次位置补偿。

30、第二方面,本发明提供一种基于状态参数融合的鹤管位置调节控制系统,包括处理器和存储器,所述存储器存储有计算机程序指令,当所述计算机程序指令被所述处理器执行时实现上述一种基于状态参数融合的鹤管位置调节控制方法。

31、通过采用上述技术方案,将上述的一种基于状态参数融合的鹤管位置调节控制方法生成计算机程序,并存储于存储器中,以被处理器加载并执行,从而根据存储器及处理器制作终端设备,方便使用。

32、本发明的有益效果在于:本发明通过将当前累计位置补偿量至本次位置补偿终值之间的后续位置补偿作用纳入当前位置调节,并结合运动轴实际位置、运动轴实际速度以及伸缩运动轴的运动轴实际位置形成最终位置目标允许范围,在此基础上确定补偿兼容名义位置域,使原始业务目标位置先按照当前能够执行的位置条件形成受限名义位置目标,再叠加当前累计位置补偿量形成最终伺服位置目标,从而在位置补偿继续变化的过程中提前为后续位置补偿保留必要的位置空间,避免当前满足位置限制的位置目标在后续补偿继续作用后再次超出可执行范围,减少边界附近位置指令被反复限制、运动轴频繁减速、停顿或者反向调整的情况,提高了鹤管位置调节过程的连续性、稳定性和可控性。