1. 先搞清楚小型PLC能做哪些运动控制——选型和场景边界做小型PLC运动控制这件事首先要解决的其实不是怎么写程序而是这台设备到底适不适合用小型PLC来做。我见过太多人拿着一台入门级PLC去跑三轴联动插补结果程序写到一半发现轴组功能根本不支持只能换方案重新来设备交付周期直接拉垮。反过来也见过有人用一台几十点的小PLC把两台伺服加三台步进调理得明明白白成本压得很低现场运行几年都没出过问题。所以先把这个边界聊透才知道后面的程序该怎么写。1.1 脉冲型运动控制和总线型运动控制到底差在哪小型PLC最常见的运动控制方式有两种脉冲控制和总线控制。脉冲控制就是PLC通过高速输出口给伺服驱动器或者步进驱动器发脉冲串一个脉冲对应电机转一个固定角度同时输出方向信号决定正反转。这种方式结构简单、调试直观、成本低几乎随便一台带高速计数和高速脉冲输出的中型PLC都能做。缺点是接线稍多、抗干扰能力取决于布线质量、诊断信息有限——驱动器报警了PLC只能通过IO点知道个大概具体是过载还是过流还得看驱动器面板。总线控制则是PLC和伺服驱动器通过现场总线通信常见的有EtherCAT、Modbus等。小型PLC里能跑EtherCAT的机型这几年也越来越多了。总线的优势是接线少、可以读取伺服内部参数当前位置、扭矩、报警代码、支持更复杂的运动规划但选型时要注意PLC固件是否支持对应的从站以及驱动器的固件版本是否匹配。选择哪种方式不只是技术问题更是项目定位问题。我倾向于这样判断点位控制为主、轴数不超过四轴、对节拍要求不苛刻且预算敏感的设备优先用脉冲型需要多轴同步、轨迹规划、在线修改位置或扭矩控制果断上总线型。下面是两者的差异对比对比项脉冲型总线型以EtherCAT为例接线量每轴6-8根线一根网线串起来调试工具万用表、示波器主站扫描即可读到轴状态可读取数据很少基本靠IO位置、速度、电流、报警码全部可读典型成本低高30%-50%左右适合场景三轴以内点位运动、简单凸轮多轴同步、插补、高速高精度1.2 哪些项目适合用小型PLC哪些项目直接劝退我做了几年自动化项目总结下来适合小型PLC的运动控制项目有这么几类第一类是两个到一个工位的点位搬运。比如某物流分拣项目里的一个移载模组X轴取料、Y轴放料两个动作周期大概三秒精度要求正负0.1毫米。这类设备我给用户配了一台带两路高速脉冲输出的紧凑型PLC加两台四百瓦伺服程序写起来轻松成本控制在几千块钱现场调试半天就通了。第二类是单轴往复、间歇送料、切料、点胶、焊锡这类设备。工艺动作是重复的不存在复杂的轨迹规划小型PLC完全能扛下来。第三类是小型转盘机、小型组装机。工位少动作简单但逻辑切换频繁——手动、回原点、自动、单周期、急停恢复这些都是PLC的老本行。反过来有几种项目我建议让用户换运动控制器或者专用控制系统一是三轴及以上的圆弧插补、螺旋插补。小型PLC就算声称支持插补很多也只是直线插补圆弧是用小线段逼近的精度和一性跟不上。二是电子凸轮、飞剪、追剪这种高速同步应用。这种需要主轴编码器同步对从站跟随精度要求极高小型PLC的扫描周期和中断能力容易成为瓶颈。三是高速视觉引导定位。相机给坐标、PLC要在一个扫描周期内计算并启动轴运动小型PLC的浮点运算能力和通信延迟往往会拖后腿——虽然能用但客户对节拍要求高的话建议上运动控制器。记住一个判断标准如果项目中存在两个轴以上的运动必须同时完成并且互相关联那就该认真考虑是不是超出了小型PLC的适用范畴。点位运动、顺序动作、单纯的速度控制这是小型PLC的地盘。2. 运动控制编程的底层逻辑点位、速度、回原点的实现方式选型确定之后真正进入编程前一定要把几个核心概念捋清楚。很多初学者上来就找指令手册看格式这个轴指令怎么填参数、那个指令是什么含义但没搞明白运动控制底层是在解决什么问题。结果程序写完要么动作顺序错乱要么定位精度差得离谱。在我看来小型PLC的运动控制程序无非是围绕三件事点位管理、速度规划、原点确认。把这三个问题用简单的逻辑表达清楚程序自然就站得住。2.1 一次手写回原点程序零散的时序变成标准功能块回原点这件事看起来很简单——找传感器碰到就停。但实际写起来要处理的情况很多电机停在原点传感器的左边还是右边、快速找还是慢速找、超程了怎么办、回原点中途被急停打断怎么办。我最早做一台三轴点胶设备时回原点程序是手写的思路是先让轴以较高速度往负方向跑直到撞上原点传感器的上升沿然后减速反向退出传感器再以极低速度重新进入并停在下降沿处这样原点位置精度可以控制在几个脉冲以内。这个差速找原点的思路几乎是用在大多数伺服和步进回原点的标准做法。用结构化文本ST实现时逻辑大致是// 回原点功能块核心流程伪代码 CASE step OF 0: // 等待启动指令 IF execute THEN step : 10; END_IF; 10: // 以快速开始找原点 MoveVelocity(axis : 1, velocity : 5000, direction : NEGATIVE); step : 20; 20: // 等待原点传感器信号 IF HomeSwitch THEN MoveStop(axis : 1); step : 30; END_IF; 30: // 反向慢速离开传感器 MoveVelocity(axis : 1, velocity : 200, direction : POSITIVE); step : 40; 40: // 等待传感器断开 IF NOT HomeSwitch THEN MoveStop(axis : 1); step : 50; END_IF; 50: // 再以极慢速重新进入 MoveVelocity(axis : 1, velocity : 50, direction : NEGATIVE); step : 60; 60: // 停在传感器下降沿 IF HomeSwitch THEN MoveStop(axis : 1); SetActualPosition(axis : 1, position : 0); Done : TRUE; step : 0; END_IF; END_CASE;这个流程的关键在于分成快找-慢退-极慢进三个阶段每个阶段的目的都是让最终停止点和传感器边沿的相对位置尽可能一致。实际操作中快找阶段的速度不能太高否则撞传感器时的振动会影响机械寿命退出阶段的速度又要大于伺服的最小可控速度避免爬行最后进入阶段的速度越低重复定位精度越好但太低了会导致效率下降。我给用户的建议是快速5000个脉冲每秒、慢速200、极慢50这是经过现场验证的一组参数。2.2 加减速与S曲线为什么电机一抖就不好使另一个经常被忽视的点是加减速设置。很多新手以为把目标速度和目标位置填进指令就行结果设备一运行电机嘎登一下窜出去到了位置又咣一下刹停机构振动大、噪音大还容易丢步。运动控制指令里通常有加速度和减速度两个参数甚至还有S曲线平滑时间。加速度决定了速度从零上升到目标速率的快慢减小加速度可以降低启停冲击但会拉长运动时间。带负载的时候尤其要注意电机加速太快力矩不够就会丢步或过载报警减速太快负载的惯性会把电机拉过位置产生过冲。这里有一个实际例子。某次我做一台小型三轴搬运设备Z轴带一个五公斤的夹具用步进电机驱动。最初加速度设成默认值运行时机身明显抖动定位精度也飘。我把加速度从默认值降到一半减速时间适当延长同时开启了S曲线平滑功能抖动问题立刻解决定位也稳定了。千万别小看这两个参数它们对机械寿命和产品良率的影响比想象中大得多。关于参数选值的参考思路加速度的初始值可以取伺服额定加速度的50%左右步进电机相应降低。需要快速节拍时优先保证加速阶段不丢步减速阶段留足余量。S曲线平滑时间在50到200毫秒之间比较常用太长会让节拍变慢太短则几乎没效果。2.3 绝对位置与相对位置程序里最容易被忽略的坐标系问题点位运动到底用绝对定位还是相对定位看似只是参数不同实际上是个逻辑设计问题。绝对定位需要PLC内部维护一个当前轴实际位置的坐标系每次运动指令都是以这个坐标系为基准相对定位则是每次以当前位置为原点移动一个固定增量。我用一个例子解释两者的区别某工位要求每次把工件从A点送到B点。如果A、B之间的间距是固定的用相对定位最直观——每次执行位置增量 5000个脉冲即可。但如果A点的位置会因为前道工序的误差而小幅波动而B点是固定的传感器中心位置那就必须用绝对定位否则误差会累计。实际项目中我通常这样分配回原点后建立绝对坐标系所有与机械固定位置相关的动作一律用绝对定位而送料、分度、切料这类只关心走多少距离的动作用相对定位。两者混用是常态但一定要在注释里写清楚每个动作是相对谁而言的否则半年后你自己看程序都会懵。3. 一个真实的编程示例两轴点位运动控制聊完底层逻辑来拆一个完整的示例。这个例子来自一台我参与的模拟项目——一台小型两轴点胶设备控制程序工艺动作简单却具备代表性回原点、移动到点胶位、执行点胶这里用延时代替、移动到待机位、循环。整个过程用状态机管理各轴互不牵连。3.1 工艺需求与IO清单设备需求是这样X轴负责定位Y轴负责前后移动胶头固定在Z向手动调节。手动模式下X、Y轴可以点动正反转。回原点模式下两个轴各自独立找原点全部就位后点亮就绪灯。自动模式下启动按钮触发工作循环X、Y移动到点胶位置→输出信号控制胶阀打开→延时500毫秒→胶阀关闭→回待机位→循环结束等待下一次触发。急停按下时所有轴立即停止报警灯点亮。对应IO分配如下编号信号方向说明I0.0启动按钮输入启动自动循环I0.1急停按钮输入急停常闭I0.2X轴原点传感器输入常开I0.3Y轴原点传感器输入常开Q0.0X轴脉冲输出高速输出Q0.1Y轴脉冲输出高速输出Q0.2X轴方向输出电平Q0.3Y轴方向输出电平Q0.4胶阀输出点胶控制Q0.5报警灯输出报警指示PLC的轴配置在硬件组态里完成主要是把脉冲输出口映射到物理输出点设定电子齿轮比和默认速度。以我的经验这里最容易漏的是勾选使能选项——很多PLC的轴功能默认是禁用的不勾选的话程序里怎么写指令都没反应。3.2 动作组状态机把手动、回原点、自动三种模式串起来PLC程序最忌讳的就是把所有逻辑堆在一大段梯形图里上千个触点互相嵌套出了问题根本没法查。我习惯的做法是用一个主状态机来调度状态含义说明0待机所有轴停止等待模式切换10回原点依次或并行执行两轴回原点20手动手动模式点动控制30自动自动模式执行循环40报警急停或故障锁定运行状态机写在ST程序块里用一个CASE语句包住每种状态对应一个子程序。这样无论出什么问题只要看到当前状态码就能立刻缩小排查范围。在回原点状态下两个轴的执行逻辑相似但独立可以在同一个周期内并行处理只要PLC支持多轴脉冲输出即可。这里要注意的是两个轴的脉冲输出不能共用一个高速输出通道否则会互相干扰。自动状态下的运动程序大概是这样的// 自动状态执行一次点胶循环 CASE auto_step OF 0: // 判断是否就绪 IF home_done AND NOT bAlarm THEN auto_step : 10; END_IF; 10: // 移动到点胶位置绝对定位 mc_move_absolute(axis : 1, position : 15000, velocity : 8000, done x_done); mc_move_absolute(axis : 2, position : 10000, velocity : 6000, done y_done); IF x_done AND y_done THEN auto_step : 20; END_IF; 20: // 打开胶阀延时 Q0_4 : TRUE; delay_500ms(IN TRUE, Q glue_done); IF glue_done THEN Q0_4 : FALSE; auto_step : 30; END_IF; 30: // 回待机位相对当前位置右移、后移固定量 mc_move_relative(axis : 1, distance : -5000, velocity : 10000, done x_back); mc_move_relative(axis : 2, distance : -3000, velocity : 8000, done y_back); IF x_back AND y_back THEN auto_step : 40; END_IF; 40: // 循环结束回待机 auto_step : 0; END_CASE;3.3 两个轴并行运动的协调合流还是分流这段程序里有个容易出错的地方两个轴同时发绝对定位指令我怎么知道两个都到位了才进入下一步答案是通过完成标志位。每个运动指令都有一个正在移动或完成的输出参数把它们串联起来做与判断即可。但要注意有些PLC的轴指令完成标志位只在目标到达的那一个扫描周期为TRUE如果没有及时锁存下个周期就丢了。我的处理方法是把完成标志位锁存到内部继电器里// 锁存轴移动完成信号 x_done_latch : x_done OR x_done_latch; // 出现一次即为TRUE // 当进入下一动作前清除锁存 x_done_latch : FALSE;这种置位-复位的锁存方式在任何PLC上都要用到是一个很基础也很核心的编程技巧。另外两个轴并行运动时虽然PLC的扫描周期在毫秒级但两个轴的脉冲输出是硬件层处理的不会因为PLC程序执行顺序而有先后偏差。这点和前面讲的总线型运动控制一样只要指令同时发出实际运动就是同步开始的。所以需要担心的是如何判断都到位而不是如何让它们同时启动。4. 编程之外的坑调试现场最常见的五个问题程序写完了不代表设备能跑。调试阶段才是真正消耗时间的地方。我总结了在现场踩过的几个坑每个都很典型给读者一个排查思路的参考。4.1 脉冲指令都发了电机就是不动——先查使能还是先查脉冲遇到电机不动很多人的第一反应是怀疑脉冲有没有发出来。但实测下来八成情况不是脉冲问题而是伺服没有使能。伺服驱动器需要一个使能信号通常是一个数字输入口接到PLC的输出点。这个信号没接通驱动器处于锁定或自由状态脉冲到了也不会转。所以检测顺序应该是先看驱动器的状态灯、面板显示的运行状态然后看PLC的轴使能输出点是否为TRUE最后才用示波器或高速计数器去确认脉冲信号是否存在。我在某次现场调试时折腾了半小时最后发现是PLC程序和硬件组态里使能输出点映射的不是同一个物理IO口——程序写的Q0.5硬件组态配的是Q0.6信号根本不在一条线上。这种低级错误在工程项目里真的不罕见。4.2 回原点位置每次都差一点差速找原点的陷阱差速找原点原理上很可靠但有一个细节经常出问题传感器信号抖动。原点传感器在机械振动下可能会发出多个上升沿信号或者上升沿本身有几十微秒的脉宽抖动导致每次停下来的位置偏差几个脉冲。解决思路有两个一是给传感器信号加滤波时间比如要求信号持续20毫秒以上才认为是有效信号但要注意这会降低响应速度二是回原点最后阶段使用Z相编码器零位信号做精定位不过小型PLC的普通脉冲型输入不一定能接入Z相只有带高速计数功能的输入口才能捕捉。如果精度要求不高像正负0.1毫米这种差速找原点配合低速进入就够用如果要求正负0.02毫米以内我就建议把最后精定位交给编码器Z相完成。4.3 手按急停后再启动逻辑怎么恢复急停是最容易被忽略逻辑细节的场景。急停一按所有轴立刻停止但程序里的状态可能还停在正在移动那一行。松开急停后如果不做处理直接按启动设备可能以意想不到的方式继续动作——这种是最危险的情况。我采取的做法是急停触发时把所有运动指令全部置为取消状态状态机强制回到待机并且要求操作人员先手动操作各轴离开可能的危险位置再重新回原点然后才允许进入自动模式。判断急停是否安全恢复的核心是自动模式绝不能从急停中断的位置继续自动执行。即使要恢复也必须先经过回原点或手动确认位置这一关。这是安全逻辑里的红线。4.4 干扰引起的脉冲丢失布线比换PLC更管用脉冲信号丢失是脉冲型运动控制的顽疾。电机明明按指令走到了位置但工件位置偏了或者伺服偶尔报错位置偏差过大。排查到最后十有八九是脉冲线缆受干扰。脉冲信号本质上是高频方波如果周围有变频器、接触器、继电器这类强干扰源又没有使用屏蔽双绞线信号很容易被吃掉几个脉冲。对策有三个方向脉冲线用屏蔽双绞线屏蔽层单端接地。信号线和动力线分开走线槽不要平行绑扎。必要时在PLC输出口和驱动器脉冲输入口之间加分路电阻或光耦隔离。有时候换一台更高端的PLC反而不如把线缆整理一遍管用。现场调试时我见过一个项目把脉冲线从变频器出线旁边移开50厘米故障率直接降为零。4.5 回零方向不一致同一台设备左找右找都能行但工艺要统一回原点方向是根据传感器安装位置和机械行程决定的。左右两个方向都可能碰到原点传感器但程序里必须固定一个方向否则原点位置是同一传感器的不同边沿偏差就大了。另外有的PLC支持回原点方向参数有的靠程序里方向信号的电平决定。务必写清楚注释这台设备的原点方向朝负方向因为限位开关装在负端。后面维护的人如果改成反方向整个坐标系就全反了。5. 让程序更耐用结构化管理与运动功能块的封装项目交付之后真正考验程序质量的不是第一次调试通没通而是半年后客户换了个操作工或者某个传感器坏了维护工程师能不能在最短时间内看懂并处理问题。这就逼着我们在编程时就要有结构化管理意识。5.1 功能块化把一个轴的逻辑封装成黑盒针对单轴运动我习惯把使能、回原点、点动、绝对定位、相对定位、停止、复位报警这些动作全部封装到一个自定义功能块里外部只需要调用接口// 自定义功能块AxisControl FUNCTION_BLOCK AxisControl VAR_INPUT enable : BOOL; mode : INT; // 0:停止 1:回原点 2:点动正 3:点动负 4:绝对定位 5:相对定位 target_pos : DINT; // 目标位置或距离 velocity : DINT; // 运行速度 acceleration : DINT; END_VAR这样做的直接好处是主程序不会堆满各种轴控制指令每个轴只占三五行逻辑可读性大大提高。而且如果换了不同型号的PLC只需要替换功能块内部的实现接口保持不变主程序几乎不用动。5.2 报警体系与运行监控让客户自己就能查出问题设备交付后客户最需要的是一个清晰的报警体系。我通常的做法是每个轴的原点传感器信号异常、驱动器报警输入触发、急停触发都生成独立报警码显示在人机界面上。报警码用两位数表示第一位代表轴号第二位代表问题类别。比如11号报警代表1号轴原点传感器异常21号代表2号轴急停触发。所有报警需要手动确认后才可复位但急停复位必须伴随时原点动作。这样设计的价值体现在一个场景客户打电话说设备停在半路不动了维护人员在远程看着报警码往往就能判断出是哪个传感器没感应到还是驱动器过热。这一步做得好售后成本能省一大半。5.3 注释与命名规范半年后你还会感谢自己最后一个建议也许最不起眼但非常重要命名和注释。我见过太多PLC程序里的变量名叫a1、a2、a3梯形图里几百个线圈互锁维护的人恨不得砸了控制柜。给变量起一个有意义的名称比如home_switch_x、glue_valve_cmd配合注释说明这条逻辑的作用成本极低回报极高。我自己的习惯是输入输出信号一律用信号名_方向_设备名格式比如SW_Home_X表示X轴原点传感器输入。内部继电器用动作名_用途比如Latch_MoveDone_X表示X轴移动完成锁存。每个功能块和状态机顶部都写一段注释说明整体逻辑和关键参数含义。程序是写给人看的顺便让设备动起来。这句话是我做自动化这几年最大的体会。调试现场时间紧迫但把程序写清楚永远不是浪费时间——它省下的是后面无数个说不清的偶发问题排查时间。我在实际项目里养成的习惯是程序写完先不急着下载自己从头到尾读一遍想象自己是半年后的维护工程师能不能看懂这段逻辑是干什么的。如果哪一段犹豫了三秒以上说明它不够清晰立刻改写。靠这个习惯我交付的PLC程序里现场维护反复找我的次数明显少了很多。
