三菱FX5U PLC四轴码垛系统设计与伺服控制优化

1. 项目背景与设备概述

这套四轴自动堆垛码垛系统是我去年为一家包装企业设计的解决方案，核心控制器采用三菱FX5U-64MT/ES PLC，搭配3台松下A6系列伺服电机和1台雷赛DM542步进驱动器。设备主要用于纸箱的自动化堆叠，设计节拍达到每分钟12次，定位精度±0.5mm。

选择FX5U主要看中其内置的4轴脉冲输出功能（Y0-Y3），最高支持4MHz脉冲频率。相比之前用过的FX3U，FX5U的轴控指令执行效率提升约30%，特别是表格定位功能对码垛这种多位置点的应用非常友好。三个伺服轴分别控制X/Y/Z三个直线模组，步进电机负责旋转托盘，构成完整的四自由度系统。

2. 硬件配置详解

2.1 核心器件选型

PLC模块：

• 主单元：FX5U-64MT/ES（32点输入/32点晶体管输出）
• 扩展模块：FX5-4AD（4通道模拟量输入，用于压力传感器）
• 配套附件：FX5-CNV-BD（RS485通信板，用于HMI连接）

伺服系统：

• 电机型号：松下MINAS A6系列400W电机（X/Y轴）、750W电机（Z轴）
• 驱动器型号：MADDT1205（X/Y轴）、MADDT1507（Z轴）
• 编码器分辨率：17bit（131072脉冲/转）

步进系统：

• 电机：雷赛57HS09（NEMA23规格，1.8°步距角）
• 驱动器：DM542（2相，最大4.2A电流）

2.2 电气接线要点

伺服驱动器的CN1端口接线需特别注意：

code复制PLC脉冲+ → PP48（集电极开路需接2KΩ上拉电阻）
PLC脉冲- → NP48
PLC方向+ → SIGN+ 
PLC方向- → SIGN-
伺服报警输出 → X10-X12（PLC输入点）
伺服使能信号 → Y14-Y16（PLC输出点）

步进驱动器接线相对简单，但要注意：

• 脉冲信号线必须使用双绞屏蔽线（我用的BELDEN 8761）
• 驱动器端要加RC吸收电路（100Ω+0.1μF）
• 电机电源线要远离信号线至少10cm

3. 软件程序设计

3.1 轴控指令应用解析

原点回归程序：

st复制DSZR K5000 K1000 Y0 Y4

• K5000：DOG搜索速度（Hz）
• K1000：爬行速度（Hz）
• Y0：脉冲输出点
• Y4：方向信号点

与普通ZRN指令相比，DSZR的优势在于：

1. 自动检测DOG开关的前后沿
2. 支持零点信号(Z相)的硬件捕获
3. 遇机械限位会自动减速停止

手动模式程序：

st复制MOV K500 D100       // 设置点动脉冲量
DRVI K1000 D100 Y0  // 相对定位指令

调试时通过HMI修改D100值即可调整移动距离，实际项目中我还加了加速度控制：

st复制PLSV K50000 Y0 Y4   // 速度控制模式

3.2 自动运行逻辑

取料阶段（绝对定位）：

st复制DRVA D200 D300 Y1   // D200=目标位置，D300=速度

配合变址寄存器实现坐标偏移：

st复制MOVP K0 Z0          // 清零物料计数器
:LOOP
DRVA D200Z0 D300 Y1 // 使用变址寻址
INC Z0              // 计数器递增
CMP Z0 K10          // 完成10次？

放料阶段（表格定位）：

st复制FMOV D500 D600 K20  // 批量传输坐标数据
PLSY D600 D700 Y2   // 表格定位执行

表格数据存储结构示例：

code复制D600：控制字（H0001=相对定位）
D601：脉冲量（50000）
D602：速度（100000Hz） 
D603：加速度（5000Hz/ms）

4. 安全防护设计

4.1 硬件保护措施

• 各轴极限位采用常闭触点串联接入急停回路
• 伺服电机抱闸信号与使能信号互锁
• 脉冲输出线路上加装光电隔离器（TLP281-4）

4.2 软件保护逻辑

伺服异常处理程序：

st复制LD X10              // 伺服报警输入
SET M100            // 故障标志位
MOV K1 D500         // 记录故障轴号
CALL P100           // 急停子程序

急停子程序包含：

1. 立即停止所有轴运动（ZRN指令强制终止）
2. 关闭所有伺服使能信号
3. 激活报警指示灯和蜂鸣器
4. 保存当前坐标到断电保持寄存器

5. HMI界面开发

使用显控SK-070AE触摸屏，关键界面设计要点：

手动操作界面：

• 各轴独立控制面板
• 实时位置显示（脉冲数/mm单位自动换算）
• 点动速度三级可调（50%/100%/150%）

参数设置界面：

• 双层密码保护（操作员/工程师）
• 坐标示教功能（记录当前位置到指定寄存器）
• 速度曲线可视化调整

报警历史界面：

• 按时间排序的故障记录
• 支持故障代码查询（内置帮助文档）
• 累计运行时间统计

6. 调试经验分享

6.1 伺服参数优化

1. 刚性调整：从P5-04开始逐步提高，直到电机出现轻微振荡后回调2级
2. 速度环增益：P5-05设为刚性值的1/3
3. 位置环增益：P5-07设为刚性值的1/5

6.2 常见问题处理

问题1：伺服电机启动时抖动

• 检查：机械装配是否过紧
• 调整：P5-08（速度环积分时间）增加20%

问题2：定位完成后有轻微偏移

• 检查：联轴器是否有间隙
• 调整：P5-10（位置环前馈增益）设为85%

问题3：步进电机丢步

• 检查：驱动器电流设置是否正确
• 调整：增加加减速时间（PLC侧DDRVI指令的加速参数）

7. 系统扩展建议

1. 视觉引导：可增加500万像素工业相机，通过RS485通信发送坐标补偿值
2. 能耗监控：加装WTB3E电力监测模块，统计各轴能耗数据
3. 远程维护：通过FX5-ENET适配器接入工厂MES系统

实际运行数据显示，这套系统比客户原有设备效率提升40%，故障率降低60%。最让我满意的是定位精度稳定性——连续72小时运行测试中，重复定位误差始终保持在±0.3mm以内。