1. 项目背景与核心需求
三菱FX5U系列PLC在工业自动化领域占据重要地位,其与伺服系统的集成开发一直是设备控制的核心课题。这次分享的伺服机器人系统开发案例,源于某汽车零部件生产线上的直角坐标机器人改造项目。原系统采用继电器控制,存在定位精度低(±2mm)、换产调整耗时(平均45分钟/次)等问题。
项目核心指标要求:
- 重复定位精度≤±0.05mm
- 换产程序切换时间≤3分钟
- 支持6种不同规格产品的混线生产
- 设备综合效率(OEE)提升至85%以上
2. 系统架构设计
2.1 硬件配置方案
采用模块化设计思路,主要硬件组成:
- 控制单元:FX5U-32MT/ES(基本单元)
- 选择理由:32点晶体管输出满足6轴控制需求,内置以太网端口便于与HMI通信
- 运动控制模块:FX5-40SSC-S
- 关键特性:支持4轴同步控制,脉冲输出最高4MHz
- 伺服系统:MR-JE-200A系列伺服驱动器 + HG-KR73J伺服电机
- 参数亮点:23bit绝对值编码器,刚性设置范围1-50
- HMI:威纶通MT8102IE
- 通信配置:通过FX5U内置以太网口建立SLMP连接
2.2 网络拓扑结构
[威纶通HMI] ←以太网→ [FX5U PLC] ←SSCNETⅢ→ [伺服驱动器] ↑ [IO扩展模块]3. 关键实现技术
3.1 伺服参数整定
通过GX Works3进行伺服增益调整时,发现三个典型问题及解决方案:
机械振动问题
- 现象:Z轴在300mm/s速度运行时出现明显振动
- 解决步骤: a) 将机械刚性参数(PB21)从15调整为8 b) 提高速度环增益(PA10)至180% c) 添加NOTCH滤波器(PA15=1, PA16=50Hz)
定位超调问题
- 现象:X轴末端定位存在0.1mm超调
- 参数调整记录:
- 位置环增益(PA09)从35→25
- 前馈增益(PA12)从80%→65%
温度漂移补偿
- 对策:启用伺服驱动器的温度补偿功能(参数PD24=1)
- 效果:连续运行8小时位置偏差控制在±0.02mm内
3.2 PLC程序架构
采用结构化编程方法,主要功能块设计:
// 主程序结构 MAIN: CALL INIT_DEVICE // 设备初始化 CALL SAFETY_CHECK // 安全检测 CALL MANUAL_CTRL // 手动模式 CALL AUTO_CYCLE // 自动循环 CALL ALARM_HANDLE // 报警处理 // 运动控制功能块示例 FB_AXIS_CTRL: VAR_INPUT AxisNo : INT; TargetPos : REAL; END_VAR VAR // 运动控制逻辑 END_VAR4. 威纶通HMI开发要点
4.1 通信配置关键步骤
- 在EasyBuilder Pro中新建工程时,设备类型选择"MITSUBISHI FX5 Ethernet"
- 通信参数设置:
- IP地址:与PLC同一网段
- 端口号:4999(默认)
- 协议类型:SLMP
- 地址映射注意事项:
- 位元件:X/Y/M使用十进制地址(如M100)
- 字元件:D寄存器直接使用(如D100)
4.2 特色界面功能实现
配方管理系统:
- 使用HMI内部RW寄存器存储6组产品参数
- 通过"配方选择"按钮调用PLC的ZRST+BMOV指令切换参数
实时曲线监控:
- 配置方法: a) 创建数据日志元件 b) 设置采样周期为100ms c) 绑定D100-D106作为Y轴数据
5. 调试问题实录
5.1 典型故障排查表
| 故障现象 | 可能原因 | 检测方法 | 解决方案 |
|---|---|---|---|
| 伺服电机啸叫 | 刚性设置过高 | 观察JOG运行时电流波形 | 降低PA08参数值 |
| 原点复归失败 | 近点信号抖动 | 用示波器检测DOG信号 | 调整PLC输入滤波时间 |
| 以太网通信中断 | IP冲突 | ping测试网络连通性 | 修改HMI静态IP地址 |
5.2 运动控制异常处理
案例:Y轴在连续运行中出现位置累积误差
排查过程:
- 检查机械传动:联轴器无松动,导轨润滑正常
- 监测编码器反馈:发现每100次循环误差增加0.03mm
- 最终确认:伺服电子齿轮比计算存在舍入误差
- 原计算:(131072×10)/(5×π)=83453.27→取整83453
- 修正方案:改用分数形式CMX=1310720/CDV=15708
6. 系统优化技巧
提升运动平滑度:
- 在GX Works3中启用S型加减速(参数#2048=1)
- 设置合适的加减速时间(通常为移动时间的20-30%)
多轴同步控制:
- 使用FX5-40SSC-S的直线插补功能
- 示例程序:
MC_MoveLinear( AxisGroup:=1, Position:=500.0, Velocity:=300.0, Acceleration:=1000.0, Deceleration:=1000.0, CoordSystem:=0);
维护性设计:
- 在HMI添加"参数备份/恢复"功能
- 利用PLC的SD卡插槽实现程序自动备份
这个项目最终实现了0.03mm的重复定位精度,换产时间缩短至2分15秒。在伺服增益调整环节,建议准备激光干涉仪进行闭环验证。对于多品牌设备集成的情况,可以考虑采用OPC UA协议作为统一通信接口。