1. 项目概述：四轴自动堆垛码垛设备控制系统
去年接手的一个自动化改造项目让我对三菱FX5U PLC的多轴控制能力有了全新认识。客户需要将传统人工堆垛工序改为自动化产线，要求实现四轴联动控制——三个松下A6系列伺服电机负责X/Y/Z三轴定位，一个雷赛步进电机控制旋转工装。这套系统最核心的挑战在于不同定位模式的灵活切换与协同控制。
FX5U作为三菱中型PLC的拳头产品，内置4轴200kHz高速脉冲输出，正好满足这个项目的硬件需求。实际调试中发现，其运动控制指令集比前代FX3U丰富得多，特别是表格定位和原点回归功能的优化，让复杂轨迹编程变得简单不少。整套系统包含PLC程序、显控SA系列触摸屏界面、以及完整的电气接线方案，从硬件配置到软件逻辑都值得详细拆解。
2. 硬件架构设计要点
2.1 核心器件选型依据
主控选择FX5U-32MT/ES主要基于三点考量：首先，其4轴独立脉冲输出（Y0-Y3）完美匹配四轴需求；其次，晶体管输出型可直接驱动伺服使能信号；最后，内置的Ethernet端口方便与HMI组态。三个松下A6BE系列伺服电机（400W）负责直线轴定位，选型时计算了负载惯量比：
code复制负载惯量J = m*(p/(2π))²
其中m=15kg（最大载重），p=10mm（丝杆导程）
计算结果J=0.038kg·m²
电机转子惯量Jm=0.0063kg·m²
惯量比J/Jm=6.03 < 推荐值30
步进电机选用雷赛DM542驱动器+57HS09电机组合，主要考虑旋转工装对精度要求较低（±0.5°），且运行速度不超过300rpm，步进系统完全够用还节省成本。
2.2 电气接线关键细节
伺服接线最易出错的是脉冲输入方式。FX5U的脉冲输出为差分信号（Y0+/Y0-），而松下A6伺服CN1端口支持三种接收模式。本项目采用集电极开路接法：
code复制PLC侧 伺服驱动器侧
Y0+ ---- PP48
Y0- ---- NP48
COM0 ---- SG48
重要提示：务必在伺服端PP/NP与SG之间并联2.2kΩ终端电阻，否则长距离传输时会出现脉冲丢失。实测发现，当电缆超过5米时，不加电阻的脉冲误差率可达3‰。
步进驱动器接线相对简单，但需注意：
- 脉冲信号线需双绞并加磁环
- 电机电源线（A+/A-、B+/B-）必须与信号线分槽走线
- 接地采用单点接地原则，所有屏蔽层在控制柜接地排汇接
3. 运动控制程序设计精要
3.1 原点回归方案优化
传统ZRN指令在码垛设备中存在两个痛点：一是遇到机械限位时可能产生撞击，二是零点信号受干扰会导致定位漂移。FX5U的DSZR指令通过双重检测机制解决这些问题：
structured复制DSZR D100 K500 Y0 Y10
// D100-脉冲速度 K500-近点信号触发后减速速度
// Y0-脉冲输出 Y10-原点信号输入
该指令工作流程分三个阶段：
- 高速搜索阶段：以D100速度运行，直到碰到近点信号（DOG）
- 低速爬行阶段：降速至K500继续运行
- 精确定位阶段：检测到原点信号（Y10）后立即停止
实测对比数据显示，DSZR的重复定位精度可达±0.02mm，而普通ZRN在连续运行100次后可能出现±0.1mm偏差。关键技巧是在伺服参数中设置"零点信号滤波时间"为2ms，可有效消除触点抖动影响。
3.2 多模式定位策略
手动调试采用DRVI相对定位，核心优势是参数可实时修改。例如X轴手动程序：
structured复制MOV K500 D200 // 默认脉冲数
MOV K1000 D201 // 默认频率
DRVI D200 D201 Y0 Y4 // Y4为方向信号
自动模式切换为DRVA绝对定位，配合变址寄存器实现坐标偏移：
structured复制MOVP K0 Z0 // 清零坐标索引
:LOOP
DRVA D300Z0 D400Z0 Y1 // D300-坐标表 D400-速度表
INC Z0 // 索引自增
CMP Z0 K20 // 完成20个点位?
表格定位在放料工序大显身手，通过FMOV批量写入定位数据：
structured复制FMOV D500 D600 K30 // 传输30个坐标数据
PLSY D600 D700 Y2 // 执行表格运动
经验之谈：表格定位前务必用DMOV指令预装数据，避免运行时修改导致位置异常。曾因这个细节导致整托盘物料偏移，损失惨重。
4. 安全防护与异常处理
4.1 三级报警系统设计
- 硬件级防护：
- 各轴限位开关串联急停回路
- 伺服报警信号直接切断使能
- 软件级检测：
structured复制LD X10 // 伺服报警输入 SET M100 // 触发报警标志 MOV K1 D500 // 记录故障轴号 CALL P100 // 急停子程序 - 过程监控：
- 脉冲计数器实时校验
- 运动超时判断（定时器T192-T195）
4.2 伺服使能控制要点
松下伺服的SON使能信号需要特别注意时序：
- 上电延迟200ms再触发SON
- 动作间隔超过5秒需重新使能
- 急停后必须复位报警再重新使能
典型控制逻辑：
structured复制LD M8000 // RUN监控
OUT T0 K200 // 上电延时
LD T0
OUT Y20 // 伺服使能
5. HMI交互设计技巧
显控SA系列触摸屏的三大实用功能：
- 单位自动换算：
structured复制// PLC程序 DIV D100 K100 D200 // 将脉冲数转换为毫米 // HMI直接显示D200寄存器 - 权限分级管理：
- 操作员级：仅手动操作界面
- 工程师级：参数设置+IO监控
- 管理员级：配方管理+用户管理
- 实时轨迹显示：
- 利用XY曲线元件
- 数据源绑定位置寄存器
6. 现场调试避坑指南
-
脉冲丢失问题排查：
- 用示波器测量脉冲波形
- 检查终端电阻阻值
- 缩短电缆长度或改用屏蔽双绞线
-
原点回归异常处理：
structured复制// 在DSZR指令后添加状态判断 LD M8029 // 指令完成标志 AND M8329 // 原点回归异常标志 OUT Y15 // 报警指示灯 -
伺服刚性调整口诀：
- 先调速度环增益（参数PA10）
- 再调位置环增益（PA09）
- 最后调整惯量比（PA11）
这套系统最终实现的技术指标：
- 定位精度：±0.05mm（伺服轴）/±0.2°（步进轴）
- 节拍时间：6秒/次（含取放料）
- 连续运行MTBF > 2000小时
调试过程中最深刻的体会是：运动控制程序必须预留足够的调试接口，比如通过HMI可实时修改脉冲当量、加速度等参数。曾经因为一个轴的脉冲当量设置错误，导致整夜排查机械传动问题，其实只是参数录入时小数点点错了一位。