三菱FX5U PLC在四轴自动码垛系统中的应用

1. 项目概述与设备选型

这个四轴自动堆垛码垛系统采用三菱FX5U PLC作为主控制器，搭配3台松下A6系列伺服电机和1台两相步进电机。整套系统主要用于自动化生产线上的物料堆叠作业，能够实现±0.1mm的重复定位精度，适用于包装、仓储等行业的标准化托盘堆垛场景。

选型时主要考虑以下因素：

• FX5U PLC内置4轴脉冲输出功能（Y0-Y3），正好满足4个运动轴的控制需求
• 松下A6伺服具备20bit高分辨率编码器，配合刚性可调功能，特别适合需要精确定位的码垛应用
• 步进电机用于负载较轻的辅助轴，降低整体成本
• 显控SK系列触摸屏支持与FX5U的直接Socket通信，响应时间<50ms

2. 电气系统搭建

2.1 伺服系统接线规范

以X轴伺服驱动器（松下MBDKT2510E）为例，关键接线要点：

1. 电源回路：

   • 主电源：L1/L2接AC220V（线径≥2.5mm²）
   • 控制电源：L11/L21接AC220V（独立供电）
   • 再生电阻：P/+ - D间连接100Ω/300W电阻

2. 信号回路：

   • 脉冲输入：PULS+（Pin44）接PLC Y0，PULS-（Pin45）接COM0
   • 方向信号：SIGN+（Pin46）接PLC Y2，SIGN-（Pin47）接COM0
   • 伺服ON：SON（Pin41）接PLC Y4
   • 报警输出：ALM（Pin12）接PLC X0

关键提示：脉冲信号线必须使用双绞屏蔽线（如BELDEN 8761），屏蔽层单端接地，长度不超过20米

2.2 PLC扩展模块配置

FX5U-32MT/ES主机搭配：

• FX5-16EX扩展模块：用于传感器信号采集
• FX5-4AD模拟量模块：预留用于压力检测
• FX5-CNV-BD通信板：实现与触摸屏的以太网通信

IO地址分配示例：

text复制X0-X7   - 伺服报警信号
X10-X17 - 光电传感器
Y0-Y3   - 脉冲输出
Y4-Y7   - 伺服使能

3. 运动控制程序设计

3.1 原点回归逻辑优化

标准ZRN指令存在低速段行程过长的问题，改进方案：

gxworks2复制LD M8002       // 上电初始化
MOV K5000 D8346 // 设置爬行速度500Hz
MOV K100 D8348  // 近点信号滤波时间100ms
ZRN Y0 K100000 X0 M0 // 高速回原点

改进后：

• 高速段频率提升至100kHz
• 爬行段缩短至5kHz
• 增加近点信号数字滤波

3.2 多轴联动插补控制

码垛典型动作采用直线插补：

gxworks2复制// 取料点坐标（单位：脉冲）
MOV K100000 D100  // X轴
MOV K80000 D101   // Y轴 
MOV K50000 D102   // Z轴

// 执行直线插补
DRV3A D100 D101 D102 K50000

关键参数说明：

• 插补精度由D8340设定（默认1个脉冲）
• 速度曲线采用S型加减速（参数D8342=K2）
• 各轴实际速度自动按比例分配

3.3 表格定位实现

建立位置参数表：

text复制D100-D199 - 托盘类型1位置数据
D200-D299 - 托盘类型2位置数据 

程序实现：

gxworks2复制LD X10        // 托盘类型选择
MOVP D100 D10 // X轴目标位置
MOVP D101 D11 // Y轴目标位置
DRVA D10 K30000 Y0 Y2 // X轴定位
DRVA D11 K30000 Y1 Y3 // Y轴定位

4. 安全保护机制设计

4.1 三级急停电路

1. 硬件级：安全继电器直接切断主电源
2. PLC级：急停信号触发所有轴立即停止

   gxworks2复制LD X20       // 急停按钮
   RST Y4       // 取消伺服使能
   ZRST Y0 Y3   // 停止所有脉冲输出
   

3. 软件级：运动过程中持续监测各轴位置偏差

   gxworks2复制LD >= D8349 K1000 // 位置偏差>1000脉冲
   SET M10          // 触发偏差报警
   

4.2 防碰撞检测

采用双传感器方案：

• 前导传感器（X5）：减速信号
• 极限传感器（X6）：紧急停止

程序逻辑：

gxworks2复制LD X5
MOV K10000 D8346 // 触发减速
LD X6
ZRST Y0 Y3       // 立即停止

5. 触摸屏人机界面

5.1 主监控画面设计要素

1. 状态显示区：

   • 各轴当前位置（实时读取D8340-D8343）
   • 伺服状态（ON/OFF/报警）
   • 生产计数（D1000）

2. 操作区：

   • 模式选择开关（M0）
   • 手动操作按钮（X10-X13）
   • 启动/停止按钮（M100-M101）

3. 报警历史：

   • 最近10条报警记录（D2000-D2009）

5.2 配方管理实现

1. 建立配方数据块：

   text复制D3000-D3009 - 配方1参数
   D3010-D3019 - 配方2参数
   

2. 触摸屏操作逻辑：

   • 选择配方编号（D3100）
   • 点击"加载"按钮（M200）
   • PLC执行数据转移：

     gxworks2复制LD M200
     MOV D3100 Z0
     BMOVP D3000Z0 D100 K10
     

6. 调试与优化

6.1 伺服参数整定

关键参数设置示例：

text复制Pn100=1      // 控制模式：位置控制
Pn101=1      // 电子齿轮分子
Pn102=1      // 电子齿轮分母  
Pn170=3000   // 位置环增益
Pn171=100    // 速度环增益

调试步骤：

1. 先设置基本参数（Pn100-Pn102）
2. 使用PANATERM进行刚性调整
3. 逐步提高增益直到出现振动后回调20%

6.2 运动曲线优化

加减速时间计算公式：

text复制加速时间(ms) = (目标速度 - 初始速度) / 加速度率

典型设置：

gxworks2复制MOV K100 D8342 // 加速度率100Hz/ms
MOV K50 D8344  // 初始速度50Hz
MOV K50000 D8346 // 目标速度50kHz

7. 典型问题排查

7.1 伺服电机抖动

排查流程：

1. 检查机械装配（联轴器、导轨）
2. 确认负载惯量比（Pn103<30）
3. 调整滤波器参数（Pn210-Pn212）
4. 检查接地电阻（<4Ω）

7.2 定位偏差过大

常见原因：

1. 电子齿轮比设置错误
   • 正确计算：电机转一圈脉冲数 = 编码器分辨率×电子齿轮比
2. 机械背隙超标
   • 补偿方法：设置反向间隙补偿量（D8345）
3. 负载突变
   • 解决方案：增加转矩限制（Pn40X）

8. 系统扩展建议

1. 增加视觉定位：

   • 通过RS485接入工业相机
   • 使用MODBUS协议传输坐标数据

2. 联网功能扩展：

   • 加装FX5-ENET模块
   • 实现远程监控和MES系统对接

3. 能量回馈改造：

   • 选用支持再生能量的伺服驱动器
   • 加装能量回馈单元

这套系统在实际项目中经过验证，单循环节拍时间可达6秒（标准托盘），定位重复精度±0.05mm。建议在首次使用时先进行空载试运行，逐步提高运行速度，同时注意定期检查机械部件的磨损情况。