基于PLC的自动化小车分级脉冲触发式复合定位控制方法

在智能立体仓储与自动化产线中，轨道式RGV与轮式转运小车承担着物料在货位、输送机、升降机及上下料工位之间的自动转运任务，其重复定位精度与运行平稳性直接决定了产线稼动率与设备对接安全性。当前工业现场主流的定位控制方案可分为三类，但均存在难以调和的性能缺陷。

第一类为外部编码（码带、磁栅、激光等）配合变频器驱动的方案[2]。此类方案依靠外部全局坐标进行停车判断，但变频器V/F开环或简易矢量控制的速度闭环带宽低，电机响应存在机械滞后，加减速过渡差，无法实现多级精细修正，稳定停车误差通常为3～5mm，仅适用于低精度仓储转运场景，无法满足精密制造产线的要求[3]。

第二类为纯伺服内置编码器闭环定位方案。伺服系统动态响应快、速度曲线平滑，但其位置反馈仅来源于电机轴端编码器，无法感知车轮与轨道接触面间的空转与打滑。当小车重载、加减速度较大或轨道磨损导致摩擦系数下降时，电机脉冲换算的理论位移与车体实际物理位移之间将产生持续差值。该误差随行走距离线性累积，长期连续运行后漂移量最高可达10 mm，重复定位一致性很差[4]。

第三类为惯性测量单元（IMU）辅助伺服的融合方案。该方案通过加速度与角速度的二次积分推算车体瞬时运动状态，能在一定程度上优化动态调速性能，但惯性积分存在零点漂移，且缺乏全局绝对位置基准，无法对长距离行走的累积漂移进行彻底清零。同时，IMU传感模块、专用信号采集单元及高性能运动控制器的引入大幅增加了电控硬件成本，难以在中小型自动化项目中批量落地[5]。

现有三类方案始终无法在高精度、高动态响应与低成本三者之间取得平衡。针对这一工程难题，本文提出一种以通用PLC为控制核心，融合外部码带全局位置基准与伺服动态执行的分级脉冲触发式复合定位控制方法。该方法将外部码带的绝对位置作为唯一基准，伺服驱动仅负责动态运动执行，通过多级递减距离阈值触发单次脉冲式目标位置修正，以外部码带实时清零车轮打滑带来的伺服累积漂移误差，在保证运行平滑性的同时实现毫米级重复定位精度。

本文设计的定位控制系统采用“控制器核心层—位置检测层—伺服执行层”的分层架构，控制核心PLC实时融合外部码带绝对位置与伺服内置编码器数值，通过分级补偿算法，利用位置检测层，外部码带周期性地清零伺服端因车轮打滑而产生的累积漂移误差，伺服执行层仅作为动态运动的执行单元。

图1 自动化小车实物图

该系统选用市售通用电控硬件，系统由PLC与伺服控制器、读码器与伺服电机组成，如图1所示。其中，控制器核心层采用西门子通用小型PLC，负责运行定位算法、处理外部码带位置数据并向伺服驱动发送目标位置指令。位置检测层由条码带与倍加福读码器构成，提供全局绝对位置基准，是系统真实物理位移的唯一依据。伺服执行层采用汇川伺服控制器与伺服电机，接收PLC下发的位置指令，依靠自身速度与位置闭环实现快速、平滑的加减速，执行小车轨道行走动作。

在完成系统分层架构定义后，核心问题在于建立外部码带物理坐标与伺服电机内部脉冲之间高精度、高稳定性的数学映射关系。由于二者分属不同的物理量纲，且车轮直径、减速比、轨道摩擦系数等现场因素均会影响位移传递关系，因此必须在系统初始化阶段进行精确的比例标定。本章提出一种简便且可靠的线性映射模型，通过人工移动标准距离来标定比例系数K，从而将任意目标工位的码带坐标快速换算为伺服驱动器可执行的脉冲指令。

在系统上电初始化阶段，建立外部码带物理坐标与伺服电机编码器脉冲之间的线性映射关系，这是所有定位与偏差补偿计算的数学基础。

标定过程中，控制小车移动一段已知标准距离，记录移动前后的外部码带坐标差值ΔXext与伺服编码器脉冲差值ΔXserv，外部码带坐标与伺服编码脉冲比例对应系数K为：

计算所得系数K存入PLC掉电保持寄存器，设备断电重启后无需重复标定。

在实际定位任务中，PLC接收目标工位的外部码带坐标Xext_tar，并实时读取当前位置Xext_now，计算物理距离偏差ΔX：

将该物理偏差换算为伺服脉冲偏差ΔXserv：

进而得到伺服目标绝对脉冲坐标Xserv_tar：

式中，Xserv_now为伺服当前的实时编码器脉冲值。该线性模型构成了全部定位算法的基础。

值得指出的是，伺服驱动器虽工作于绝对定位模式，但完全不需要物理零点。所有绝对位置基准均由外部码带提供，伺服仅执行相对位移，省去了原点回归工序，显著简化了现场调试与维护工作。

比例标定模型解决了坐标换算问题，然而在实际长距离运行中，车轮打滑、轨道不平整以及负载变化等因素仍会导致伺服脉冲计数与车体实际位移之间产生时变偏差。若仅依靠初始标定系数进行一次性定位，则累积误差将随行程增大而显著恶化。为此，本章提出一种分级脉冲触发式补偿控制策略，在车体接近目标点的过程中，通过多级递减的距离阈值激活多次、独立的脉冲式修正，既保持全程运行的高速平稳性，又确保末端定位精度不受长期漂移的影响。该策略从根本上区别于传统连续闭环调节方式。

1.控制策略总体设计

定位控制流程如图2所示，在远距离区间内保持高速平稳运行，当靠近目标点时，依据多级递减的距离阈值，逐级加密补偿频次。每一级阈值仅触发一次脉冲式位置修正，严格禁止控制器在每个扫描周期内持续刷新伺服目标位置指令，从而从算法层面消除了近距离速度波动与车体前后振荡的诱因。

图2 自动化小车定位控制方法步骤示意图

整个控制过程可划分为初始化标定、任务接收与距离计算、初次目标位置下发以及分级脉冲补偿等阶段。

2.多级递减阈值单次脉冲补偿算法

本小节给出补偿算法的具体执行逻辑和数学描述。在进入分级补偿阶段后，PLC需实时监测剩余距离，并根据预设的阈值序列决定何时触发修正。关键在于，每次修正仅写入一次新的伺服目标脉冲，随后即释放控制权，让伺服驱动器自行完成调速与定位，从而避免频繁干预导致的振荡。下面详细阐述阈值设定原则、触发条件以及每次补偿的定量计算过程，确保算法在工程上可复现、可调参。

自动化小车行走过程中，PLC持续计算车体与目标点的剩余距离绝对值|ΔX|。系统中预设一组递减的距离阈值{θ1，θ1，...θN}，且满足θ1>θ1>...>θN。当|ΔX|首次小于θi时，立即执行一次位置补偿，其数学过程如下：

(1) 读取此刻外部码带真实位置Xext_now，重新计算剩余物理距离:

(2) 读取当前伺服编码器脉冲Xserv_now，计算新的伺服目标脉冲坐标:

(3) 以单次脉冲触发形式，将更新后的Xserv_tar写入伺服驱动模块，完成一次位置修正。

完成本次修正后，伺服驱动沿新的目标位置继续平稳运行，控制器不再干预位置指令，直到剩余距离进入下一级更小的阈值区间，才再次触发下一次补偿。阈值差值逐级缩小，使得越靠近目标工位，补偿触发密度越高，修正幅度也越细微。

这种“距离阈值触发+单次脉冲赋值”的机制，与持续刷新伺服给定位置的传统全闭环控制有本质区别。在两段补偿区间之间，伺服的目标位置保持恒定，其速度环与位置环在恒定指令下可保证运动轨迹平滑、无速度突变；同时，依靠外部码带基准的分级修正，又能持续消除长距离行走中车轮打滑带来的累积误差，从而在动态平稳性与末端毫米级定位精度之间取得了统一。

1.硬件与参数设置

为验证所提方法的有效性，以某化纤企业多台丝包转运RGV为对象进行了现场应用，如图3所示。相关硬件配置如下：轨道总长80m，铝质轨道；行走驱动采用汇川伺服电机及伺服控制器；位置检测采用条码带与倍加福读码器；控制核心为西门子PLC，搭配西门子HMI人机界面。系统初始化标定得到比例系数K=159.5，自动运行速度设定为10000LU/min，加速度80%，减速度60%。

图3 实际应用场景

依据现场轨道与负载工况，通过HMI预设四级递减距离阈值：200mm、50mm、10mm、3mm。各级阈值差值逐级显著缩小，补偿触发密度依次提高。小车定位控制的实际应用流程如图4所示。

图4 自动化小车的定位控制实际应用流程图

2.实验结果与分析

系统投入连续生产运行后，进行了一个月的重复定位精度测试，停车误差保持在±1mm。图5为自动化小车的速度曲线，实验结果表明，采用四级分级脉冲补偿策略后，伺服电机全程保持平滑加减速，行走速度曲线在各级补偿节点处仅出现微小、单次的调整，区间内速度无明显波动，车体无抖动，更未观察到近距离往返窜动现象。

图5 速度曲线

在重复定位精度方面，每次停车后PLC持续校验外部码带坐标，若偏差超出±1mm，则自动触发微小补位脉冲直至达标。经统计，在80m轨道上往复运行的数千次对接作业中，最终停车误差均稳定控制在±1mm以内，完全满足了化纤丝包高精度自动化对接的工艺要求。

上述结果充分证明，该方法能够有效补偿车轮打滑造成的位移漂移，同时规避了持续刷新伺服目标位置所引发的振荡问题，在较低硬件成本下实现了高精度与高平稳性的统一。

本文所构建的定位控制方法在硬件选型与载体类型上具备良好的通用性与可迁移性，可针对不同应用场景进行灵活适配。对于控制单元，PLC可替换为单片机或嵌入式工控机，分级补偿算法与比例标定模型完全复用，仅需调整底层通信与位置输出驱动程序；对于外部定位设备，轨道码带可更换为磁栅尺或激光测距传感器，对应修改外部位置读取程序即可；对于执行设备，伺服行走机构可与多轴运动控制器配合，方案不仅适用于轨道式RGV，同样适配地面重载轮式转运台车。在定位精度方面，对于锂电、精密电子等超高精度产线，可增设五级或六级距离补偿阈值，进一步压缩停车误差区间。

这些替代与拓展方案均在统一的“外部全局基准+伺服动态执行+分级脉冲补偿”架构下实现，无需改变核心算法逻辑，体现了较强的工程实用性与推广价值。

针对自动化小车定位控制中传统方案难以同时满足高精度、高平稳性与低成本需求的突出问题，本文设计并实现了一种基于通用PLC的分级脉冲触发式复合定位控制方法。该方法以外部码带为全局绝对位置基准，通过线性比例标定模型融合伺服编码信息，并采用多级递减距离阈值触发的单次脉冲补偿策略，在清除车轮打滑累积漂移的同时，从根源上避免了持续刷新伺服指令导致的车体振荡。现场应用结果表明，该方法可在80m轨道上实现±1mm的重复定位精度，运行全程速度平滑无抖动，且全部采用标准工业硬件，成本可控。该方案在架构与算法层面具备良好的通用性，可灵活适配多种控制单元、外部传感器及小车载体，为智能仓储与精密产线中的自动化物料转运提供了一种兼顾性能与成本的有效解决途径。