1. 项目背景与核心需求
在工业自动化产线中,实现PLC与机械手的协同作业是提升生产效率的关键环节。这次我们要拆解的是一个典型的在线检测收料系统,采用三菱FX系列PLC作为主控制器,通过CC-Link总线与雅马哈YK-XG系列四轴机械手进行数据交互,同时整合了串口通信的视觉检测模块和高精度伺服定位系统。
这个方案最核心要解决三个问题:
- 如何实现PLC对机械手的实时坐标控制和状态监控
- 视觉检测结果如何通过串口反馈给PLC触发分拣动作
- 伺服定位系统如何与机械手运动实现毫米级同步
2. 系统架构设计
2.1 硬件配置清单
- 主控制器:三菱FX3U-64MT/ES-A
- 机械手:雅马哈YK-XG500(带CC-Link从站模块)
- 视觉系统:基恩士CV-X200(RS232接口)
- 伺服系统:三菱MR-JE-40A(4台)
- HMI:威纶通MT8102iE
2.2 通信拓扑设计
采用CC-Link作为主干网络,传输机械手控制指令和状态数据。视觉系统通过FX3U自带的RS232接口与PLC通信,伺服系统则通过脉冲+方向信号直接控制。这种混合通信架构既保证了机械手控制的实时性(CC-Link周期≤4ms),又降低了系统复杂度。
关键提示:雅马哈机械手的CC-Link从站模块需要单独配置站号,与PLC的CC-Link主站模块波特率必须一致(通常设为156kbps)
3. 核心程序实现
3.1 CC-Link通信配置
在GX Works2中需要完成三个关键设置:
- 网络参数配置:
plaintext复制[CC-Link参数]
站号设置:PLC=0,机械手=1
传输速度:156kbps
模式:远程网络Ver.2
- 软元件分配:
plaintext复制机械手控制区:RWr0-RWr15(PLC→机械手)
状态反馈区:RWw0-RWw15(机械手→PLC)
- 机械手原点设置程序:
st复制MOV K100 D100 // X轴原点偏移量
MOV K80 D101 // Y轴原点偏移量
TO K1 K4 D100 K2 // 写入机械手RWr0-RWr1
3.2 串口通信处理
视觉检测结果通过固定格式字符串传输,PLC需要做ASCII码转换:
st复制RS D200 K8 D300 K20 // 接收8字节存D200,发送20字节从D300
// 数据解析示例(收到"NG,12.5"):
MOV D200 D400 // 首字母判断
CMP K78 D400 // 'N'的ASCII码比较
= M10 // NG标志位
MOV D202 D500 // 提取数字部分
BCD D500 D501 // 转十进制
3.3 伺服同步控制
采用三菱PLSV指令实现速度控制,关键参数计算:
st复制// 脉冲当量计算:
// 伺服电机编码器分辨率:131072 pulse/rev
// 减速比:10:1
// 丝杠导程:5mm
// 脉冲当量 = 5/(131072×10) ≈ 0.381μm/pulse
PLSV K5000 Y0 Y10 // 以5000Hz脉冲频率启动
4. 关键问题解决方案
4.1 机械手抖动抑制
在高速运行时出现的末端抖动问题,通过两个措施解决:
- 加减速曲线优化:
plaintext复制ACCEL 3000 → 改为1500
DECEL 3000 → 改为2000
- 在PLC程序中增加滤波处理:
st复制MOV RWw0 D200 // 读取实际位置
FILT D200 D210 K5 // 5次移动平均滤波
4.2 视觉通信超时处理
增加通信看门狗机制:
st复制// 在每帧接收完成后复位计时器
LD M8000 // 运行监控
OUT T0 K50 // 500ms计时器
LD T0
SET M100 // 通信超时标志
5. 调试技巧实录
- CC-Link干扰排查:
- 使用双绞屏蔽线(DA-1A-SP规格)
- 终端电阻设为110Ω
- 通信异常时先检查LED状态:
- L RUN:常亮(正常)
- L ERR:闪烁表示站号冲突
- 机械手轨迹优化:
plaintext复制SPEED 80 → 先降速调试
MODE 1 → 切换为单步运行
- 伺服刚性调整:
plaintext复制Pn110=15 → 提高位置环增益
Pn210=30 → 提高速度环增益
6. 完整程序架构
6.1 主程序流程
-
初始化阶段
- CC-Link通信测试
- 伺服回原点
- 机械手校准
-
运行阶段
- 视觉触发检测
- 坐标计算
- 机械手路径规划
- 伺服同步运动
-
异常处理
- 硬件报警监控
- 软件保护逻辑
6.2 关键子程序
st复制CALL P100 // 通信初始化
CALL P200 // 坐标转换
CALL P300 // 速度规划
CALL P400 // 安全检测
实际项目中,我们通过这种架构实现了每分钟60次的分拣节拍,定位精度达到±0.1mm。特别是在处理异形零件时,通过视觉坐标补偿算法,将废品率从3%降低到0.2%以下。