三菱PLC与雅马哈机械手协同实现高速精密分拣

1. 项目背景与需求分析

在工业自动化领域，冲压件在线检测与分拣一直是个技术难点。这次我们接到的项目要求三菱FX5U PLC与雅马哈RCX340四轴机械手协同作业，实现金属冲压件的在线检测与收料。产线节拍要求极高——机械手必须在0.3秒内完成抓取判定，伺服定位精度需控制在±0.02mm以内。

这个项目的特殊之处在于需要整合多种技术：

• 多设备通讯（CC-Link IE Basic网络+232串口）
• 高速信号处理（15ms级响应）
• 精密运动控制（脉冲当量5μm）
• 双重检测机制（真空+激光测距）

2. 系统架构设计

2.1 硬件组网方案

整个系统采用分层式架构：

code复制[PLC主站] --CC-Link IE--> [机械手控制器]
       |--232串口--> [激光测距仪]
       |--脉冲输出--> [伺服驱动器]

关键硬件选型：

1. 三菱FX5U-32MT/ES：支持CC-Link IE Basic，内置4轴脉冲输出
2. 雅马哈RCX340控制器：带Ethernet/IP和CC-Link接口
3. 安川Σ-7伺服电机：17bit绝对值编码器（131072脉冲/转）

2.2 通讯协议配置

CC-Link IE Basic参数设置：

• 传输速率：1Gbps
• 站号分配：
  • PLC：主站（站号0）
  • 机械手：远程设备站（站号1）
  • HMI：远程设备站（站号2）

特别注意：机械手输入输出采用内存映射方式，需要预先在GX Works3中配置远程寄存器：

text复制X0-X1F -> U3\G0-G31
Y0-Y1F -> U3\G100-G131

3. 核心程序实现

3.1 机械手状态监控

PLC通过CC-Link实时读取机械手状态寄存器：

st复制MOV U3\G100 D200  //报警代码转存
CMP D200 K0       //非零判断
MPS
CALL P10          //报警处理子程序
MPP
OUT Y10           //复位信号

关键技巧：使用MOV指令而非直接读取，可减少CC-Link网络负载，实测响应时间从25ms降至15ms

3.2 伺服精确定位

采用绝对位置控制指令，需注意脉冲量计算：

st复制DDRVI K5000 K300000 Y0 Y4  //参数说明：
//K5000：脉冲当量（5000脉冲/mm）
//K300000：目标脉冲数（对应60mm行程）
//Y0：脉冲输出端口
//Y4：方向信号

调试发现的问题及解决：

1. 到位抖动：将加减速时间从200ms调整为300ms
2. 跟随延迟：在PLC中增加50ms周期的位置数据上传指令

3.3 双校验抓取逻辑

机械手程序段：

rob复制MOVJ VJ=50% PL=1   //快速接近
WAIT DI(10)=ON     //到位检测
IF M_OUT(3)=OFF JUMP *ERR //真空检测
TIMER T=0.5        //防抖延时
MOVL V=80          //精准下压

该方案将误抓率从3%降至0.1%，关键点：

• 真空检测阈值设定为-85kPa
• DI信号滤波时间与PLC侧保持同步（均设为20ms）

4. 辅助功能实现

4.1 激光测距数据解析

232通讯数据格式处理：

st复制STRCPY D100 K4 D200  //截取"DIST=12.34mm"中的"12.3"
ASC D200 D210        //ASCII转十六进制
FLT D210 D220        //转为浮点数
CMP D220 K5.0        //阈值判断

踩坑记录：机械手默认波特率38400，需与测距仪（9600）手动同步

4.2 HMI监控界面

使用GT Works3开发的关键功能：

1. 实时位置监控：绑定D8140（当前脉冲数）和机械手坐标
2. 趋势图显示：同时绘制理论位置与实际位置曲线
3. 维护提醒：真空发生器膜片寿命计数器（700万次预警）

5. 调试与优化

5.1 信号仿真验证

提前进行的离线测试：

1. 用GX Simulator3模拟PLC I/O信号
2. 通过AR码生成器验证机械手轨迹
3. 使用MODBUS Slave模拟器测试串口通讯

5.2 现场问题解决

遇到的典型问题及对策：

6. 维护经验分享

1. 易损件管理：

   • 真空发生器膜片：每700万次更换
   • 机械手导轨：每6个月润滑
   • 伺服电机编码器：年度校准

2. 参数备份策略：

   text复制/备份/
   ├── PLC参数.fx5u
   ├── 机械手参数.rcx
   └── 伺服参数.s7p
   

3. 故障快速诊断：

   • 先查CC-Link站号冲突
   • 再看缓冲寄存器映射
   • 最后验证脉冲当量设置

这套系统经过三个月连续运行，平均无故障时间达到1800小时。最大的收获是认识到工业通讯中"协议一致"比"速率匹配"更重要，下次类似项目会优先考虑Profinet等更开放的协议标准。