信捷XC系列标准程序,多段连续绝对定位控制,包含轴点动,回零,多段连续定位控制,整个项目结构清晰,注释完整,只要弄明白这个程序,就可以非常了解整个项目的程序如何去编写,从哪里开始下手
最近在调试一套基于信捷XC3-24T-E PLC的物料分拣设备,偶然发现官方提供的标准程序框架居然藏着不少实用技巧。今天就拆解它的多段定位控制逻辑,手把手看看工业现场的程序到底怎么玩。
先看全局结构
程序包里最显眼的就是那个叫"AXIS_CONTROL"的功能块,这玩意儿简直就是运动控制的瑞士军刀。里面封装了轴使能、点动、回零、定位三大基础功能,最骚的是它把不同操作模式揉进了同一个状态机里。咱们直接上硬菜:
// 轴控制主逻辑 IF NOT bAxisEnable THEN Axis_Status := DISABLED; MC_Power(FALSE); // 关闭驱动器使能 ELSE CASE Axis_Status OF DISABLED: IF Start_JogForward THEN Axis_Status := JOG_FORWARD; ELSIF Start_Home THEN Axis_Status := HOMING; END_IF; JOG_FORWARD: MC_MoveVelocity(Axis, 100.0, 200.0); // 速度100mm/s,加速度200mm/s² IF Stop_Jog THEN Axis_Status := DISABLED; END_IF; HOMING: MC_Home(Axis, HomingMode:=3); // 模式3:负向逼近原点 IF Home_Done THEN Axis_Status := READY; END_IF; END_CASE; END_IF;这个状态机设计妙在哪儿?它把操作互锁做在了状态转换里,比如回零过程中如果突然断电重启,轴会自动回到DISABLED状态防止误动作。注意看HomingMode参数,官方用了模式3这种主动回零方式,比普通找Z相信号更可靠,特别适合有机械限位的场景。
多段定位的数组玩法
连续定位功能里最亮眼的是位置数组的轮询机制,程序里用了个指针变量当索引,每次触发新位置时自动跳转。来看关键代码:
// 位置序列定义 PositionArray : ARRAY[1..5] OF LREAL := [200.0, 450.0, 780.0, 1200.0, 0.0]; CurrentIndex : INT := 1; // 定位执行 IF Start_MultiMove AND (Axis_Status = READY) THEN WHILE CurrentIndex <= 5 DO MC_MoveAbsolute(Axis, PositionArray[CurrentIndex], 150.0, 300.0); CurrentIndex := CurrentIndex + 1; WAIT UNTIL MotionDone OR NOT bAxisEnable; // 关键等待点 IF NOT bAxisEnable THEN EXIT; END_IF; END_WHILE; CurrentIndex := 1; // 复位索引 END_IF;这个循环结构有几个小心机:1. 用WHILE代替FOR循环方便中途跳出;2. MotionDone信号和急停信号做了并联判断;3. 执行完自动复位索引。实际调试时要注意WAIT语句的位置,放循环内部才能实现真正的连续运动,放外面就成顺序执行了。
点动功能的防抖处理
你以为点动就是简单发脉冲?看看人家怎么防抖的:
// 点动信号处理 JogForward_Trig := Start_JogForward AND NOT Last_JogForward; Last_JogForward := Start_JogForward; // 点动执行 IF JogForward_Trig THEN IF Axis_Status = JOG_FORWARD THEN MC_Stop(Axis); // 先停再动防抖动 END_IF; MC_MoveVelocity(Axis, 80.0, 150.0); END_IF;这里用了边沿触发+先停后启的双保险。遇到过现场操作员疯狂连按按钮导致轴抽搐吗?这种处理能有效避免。不过注意急停恢复后的状态需要手动复位,程序里在使能信号里埋了复位逻辑。
整个项目最值得借鉴的是异常处理机制。比如在回零超时、定位偏差过大这些关键节点都埋了报警代码,而且错误代码不是简单数字,是用结构体打包的:
TYPE ErrorCode : STRUCT OverCurrent : BOOL; OverTravel : BOOL; HomingTimeout : BOOL; PositionError : BOOL; END_STRUCT; END_TYPE这种结构体报警比用整数位操作直观多了,在线监控时一眼就能看出是哪个环节出问题。调试时记得在触摸屏上把这些BOOL量做成带颜色的状态指示灯,维护人员查故障能省一半时间。
最后说个坑:官方程序里的绝对定位用的是MC_MoveAbsolute指令,但在设备重启后如果没有先回零,直接调这个会报错。解决方法是在上电初始化时加个位置预设:
IF FirstScan THEN Axis.ActPos := 0.0; // 假设初始位置为0 END_IF;当然这属于临时方案,正规做法还是要在自动流程开始前强制回零。完整程序里还藏着很多类似的实战技巧,建议用仿真器单步跑一遍状态转换,比看手册管用十倍。