前阵子做完一台三菱FX5U四轴自动码垛设备程序里同时挂着松下伺服和步进电机从原点回归、定位动作到报警处理全放进同一套PLC逻辑。客户的产线工位很挤原本靠两个人弯腰搬箱上托盘节拍一快就容易漏放错放最后改用这套四轴直角坐标码垛机让四个脉冲轴自己完成取箱、抬升、转运、下放的循环。搞过码垛机的同行应该都有同感码垛听上去就是“来回搬箱子”可真做起来原点回归、垛型计算、轴间互锁、伺服报警处理每一块都能让调试人员在现场熬夜。这篇文章不聊虚的把我经手这套设备时的轴系设计、FX5U配置参数、程序组织思路和现场踩坑记录整理出来给正在做类似自动化改造项目的电气工程师做一个参考。1. 先看四轴怎么搭码垛机轴系设计与伺服、步进的混搭逻辑1.1 四根轴在码垛机上各干什么标题里的“四轴控制”很容易让人联想到四轴机械臂实际上这类设备绝大多数是直角坐标机器人也就是四路独立的运动轴分别叫X轴、Y轴、Z轴和R轴每一路都是PLC发脉冲给驱动器驱动器再带电机。在这台设备里轴系是这样划分的X轴水平横移轴负责把箱子从取料位运到托盘上方Y轴升降轴负责把箱子从低处的输送线抬起来以及放到垛顶上Z轴夹爪伸缩轴负责把夹爪或吸盘伸进箱子两侧完成抓取R轴旋转轴负责箱子在层与层之间转90°实现交错堆叠增加垛型稳定性。X、Y两轴的行程最长、负载最大是设备的主体。Z轴行程短只做“伸进去、缩回来”这个动作。R轴的动作更简单基本就是一次抓取或放置前旋转到指定角度。选型时客户最初询问过机械臂方案但考虑现场空间狭窄、设备上方还有输送管道机械臂的回转半径容易干涉同时预算也卡得比较紧。最后确定用直角坐标结构控制上直接用PLC内置定位功能驱动。成本省下来一大截维护也直观。1.2 我没有全部用伺服负载和成本才是分界线很多第一次接触这类设备的工程师习惯把四个轴全部配成伺服认为“伺服响应快、精度高”实际上没有必要成本也会明显抬高。我这台设备的最终配置是X轴和Y轴用松下伺服Z轴和R轴用步进电机并且跑了一个多月下来生产节奏稳定。为什么这样选核心判断依据是“负载端惯量”和“失步后果”。先看一张粗略对照表对比项松下伺服步进电机控制方式闭环编码器实时反馈开环丢步时控制系统不知道过载表现驱动器报过载或追随误差过大可能直接丢步位置跑偏低速平稳性好低速无共振区有共振区间速度要做避开处理垂直轴刹车可选配带电磁抱闸电机普通步进不带抱闸需另加机械结构成本高低调试复杂度参数较多需要调电子齿轮比设好细分和电流基本能跑X轴和Y轴是主要运动轴X轴要带着整个立柱来回移动Y轴要带着夹具和箱子上下反复启停。这两个轴的负载大、启停频繁一旦步进电机出现高速丢步整垛产品就可能错位甚至倒塌。更重要的是Y轴是垂直轴普通步进电机无力控制“断电锁死”或“急停保持”安全问题很麻烦。所以Y轴选择带电磁抱闸的松下伺服X轴选择伺服是因为它能提供足够的过载能力在突然卡住或加速过快时不会像步进那样“硬憋”驱动器会直接报警提示操作人员。Z轴和R轴属于轻载轴。Z轴只是推动夹具前后移动几十毫米负载十几公斤步进电机完全能胜任。R轴旋转的箱体重量虽然有一定变化但末端定位精度要求只有±0.5度常规细分步进很轻松就达到没必要为此上伺服。1.3 垂直轴防坠设计的两个细节只要设备里有垂直运动轴就必须认真处理防坠。这不是省成本的地方。我在这台设备里做了两个关键细节第一个是Y轴电机必须带电磁抱闸并且抱闸不能只靠伺服驱动器“断电自动抱”来实现。很多伺服驱动器的抱闸输出只是一个报警或使能状态的输出信号需要外部再串一个DC24V继电器给电机抱闸供电。接线时要特别注意续流二极管的方向否则继电器断开瞬间的感应电压会打坏驱动器输出点。第二个是程序里必须编排“松闸和运动”的时序。Y轴启动时要先给伺服使能等抱闸继电器吸合松开制动器延时几十毫秒再发定位脉冲避免电机还在较劲的时候就强行带着没松开的抱闸跑。到位停止时要确认定位完成标志已经置位、脉冲输出已经停止了再让抱闸断电抱住。急停情况下不能省这一步先停脉冲再断开伺服使能然后才允许抱闸动作。2. FX5U四路定位输出的配置重点选型、脉冲速度与接线2.1 FX5U到底够不够四轴三菱FX5U系列的小型PLC里晶体管输出型CPU本体自带四路高速脉冲输出频率可以到200kHz不需要额外加定位模块直接通过内部定位指令控制四个轴。这是这次选FX5U的最大原因四个轴的需求被CPU一本满足配电柜空间和模块成本都能压下来。但选型时要注意FX5U细分下来有很多型号不是每一台都适合。核心要求是“晶体管输出”也就是型号末尾带MT的那类。继电器输出型只能做低频开关量的通断没法输出高速脉冲。除此之外还要看输入输出点数是否够用。写程序之前我先拉了一遍IO清单输入点X轴正负限位、Y轴正负限位、Z轴前后限位、R轴原点、各轴近点DOG、急停、安全门、伺服ALM、步进ALM、真空压力开关、夹爪到位、来料检测大约20个点输出点四个轴的脉冲和方向共占8个点实际上如果用脉冲加方向方式每个轴需要两个晶体管输出点有一些FX5U型号是脉冲点和方向点需要自己规划更占输出资源。我当时用的是“脉冲方向”模式同时考虑到伺服使能、抱闸、电磁阀、三色灯等输出点规划到16个以上。建议直接从FX5U-32MT起步IO点富余程序调试和后期加安全联锁都方便。2.2 把“每转脉冲数”先算明白硬件选型只是第一步真正让初学者在现场懵掉的是脉冲频率和电子齿轮比。很多工程师一上来就问“FX5U不是能发200kHz吗为什么实际跑不到设计速度”大概率是机械传动参数没对齐。拿这台设备X轴来说当初机械给的丝杠导程是20mm意思是电机转一圈工作台移动20mm。设计目标是600mm/s的移动速度换算成电机转速就是每秒30转约1800r/min。松下伺服驱动器默认的电子齿轮比如果按“电机每转10000个脉冲”去理解我们在PLC端需要的脉冲频率就是电机转一圈需要的脉冲数10000 × 每秒转数30 300kHz这一下就超出了FX5U的200kHz上限。问题不是PLC不够用是机械设计和伺服参数没匹配。后来我把伺服驱动器的指令脉冲分频倍率调整让电机每转一圈只需要5000个脉冲。这样PLC侧只需要发5000 × 30 150kHz轻松落在200kHz之内。换算到负载端每个脉冲对应的移动距离是20mm / 5000 0.004mm。码垛定位精度要求±1mm已经绰绰有余。这台设备里Y轴也按这个思路算了一遍同时加了一个2比1的行星减速机使得电机侧的惯量匹配更宽裕即使速度目标不变需要PLC输出的脉冲频率也更低整个系统余量更足。步进电机轴的计算思路类似只是不用电子齿轮比而是用驱动器上的细分拨码。比如两相步进电机原始步距角是1.8度也就是电机每转一圈需要200个脉冲驱动器细分设置成8倍后每转一圈需要1600个脉冲。如果Z轴丝杠导程也是20mm那么每个脉冲对应0.0125mm实际使用足够了。细分调高对低速平稳性有好处但细分过高会拉高PLC的脉冲频率同样要折算一遍。调试前把四个轴的“每个脉冲对应的移动量”做成一张参数表打印出来贴进配电柜门。后期排查单位换算问题会节省大量时间。2.3 高速脉冲接线最容易踩的坑四路高速脉冲的接线看起来简单实际在现场出问题最多的就是这一块。FX5U的晶体管输出通常有漏型和源型之分而松下伺服的脉冲输入端、步进驱动器的脉冲输入端也要区分共阳、共阴。接线前必须把两侧的接口定义看完整确定是NPN还是PNP、是光耦输入还是差分输入。这台设备首轮接线我把伺服驱动器上的脉冲端子当成普通24V输入来接结果脉冲信号始终进不去伺服电机只动了一个很小的角度就不再响应。后来检查驱动器手册发现它的高速输入需要5V差分信号不能用PLC的24V漏型输出直接怼过去。于是改成正向脉冲加方向输出的光耦形式把24V经过限流电阻接到共阳端PLC的输出点按低电平有效的方式接入问题才解决。接线另一处高压线是“干扰”。步进电机动力线和脉冲