1. 项目概述
这个三菱FX5U机床控制程序是我去年为一个金属加工车间开发的，主要实现X/Y轴工作台的高精度定位控制。整套系统采用三菱J4-A系列伺服驱动器构建绝对位置系统，程序规模达到了27000多步，包含了从基础定位到生产管理的完整功能。
在实际生产中，这套系统需要处理20种不同的加工工序，每个工序都涉及两轴联动的直线插补运动。比如加工一个法兰盘时，X轴要配合Y轴完成圆周上的钻孔操作，这对运动的同步性和定位精度要求极高。我们通过三菱的绝对位置系统，将重复定位精度控制在±0.02mm以内，完全满足车间的加工需求。
2. 系统架构设计
2.1 硬件配置方案
核心硬件采用三菱FX5U-64MT/ES PLC作为主控制器，搭配两个J4-A系列750W伺服驱动器。之所以选择这个配置，主要基于以下几点考虑：
- FX5U内置的4轴脉冲输出功能可以直接驱动伺服系统，省去了额外的定位模块
- J4-A系列支持17位绝对编码器，分辨率达到131072脉冲/转
- 750W电机在1:10减速比下可提供70N·m的扭矩，足够驱动1.5吨的工作台
伺服电机与滚珠丝杠采用直连方式，丝杠导程选用10mm。这样计算得到：
- 电机每转脉冲数 = 131072
- 机械分辨率 = 10mm / 131072 ≈ 0.076μm
- 实际控制分辨率设置为0.001mm，通过电子齿轮比实现：
- 电子齿轮比 = (1000μm/mm × 10mm) / 131072 ≈ 0.0763
2.2 软件架构设计
程序采用分层设计思想，主要分为以下几个功能模块：
- 运动控制层：处理基础定位指令和插补运算
- 工序管理层：管理20组加工工序的调度执行
- 人机交互层：处理HMI操作和状态显示
- 设备通信层：与变频器、传感器等外设通信
- 生产统计层：记录产量、工时等生产数据
特别值得一提的是，我们使用了结构化编程方法：
- 算法参数用ST语言编写，便于数学运算
- 顺控逻辑用结构化梯形图，监控更直观
- 关键参数使用中文标签的结构体定义
3. 核心功能实现
3.1 定位控制实现
3.1.1 自动定位流程
自动模式下，系统按照预设的工序表顺序执行。每个工序包含以下参数：
- 目标位置(X/Y坐标)
- 运动速度
- 加速度/减速度
- 定位完成判断时间
核心定位指令采用DRVI相对定位命令，配合PLSV可变速度控制。例如一个典型的钻孔工序：
st复制// 快速定位到孔上方
DRVI K100000, K80000, D100, D101, Y0 // X轴移动100mm,Y轴80mm
// 慢速下钻
PLSV K20000, D8340 // X轴低速进给
// 钻孔完成回退
DRVI K-20000, K0, D100, D101, Y0
3.1.2 手动控制逻辑
手动模式实现了两种操作方式：
- 点动模式：每次按下按钮移动固定距离
- 连续模式：长按按钮持续移动
关键实现代码如下：
st复制IF 手动模式 AND 点动触发 THEN
// 点动移动
DRVI K预设距离, K0, D100, D101, Y0
ELSIF 手动模式 AND 长按信号 THEN
// 连续移动
PLSV K预设速度, D8340
END_IF;
提示：在调试手动速度时，建议先用低速测试（如10mm/s），确认方向正确后再逐步提高速度。
3.2 暂停/继续功能
这是车间特别要求的功能，允许在加工过程中暂停，之后从暂停点继续。实现原理是：
-
暂停时立即记录当前坐标：
st复制暂停坐标_X := D8340; // 读取X轴当前位置 暂停坐标_Y := D8341; // 读取Y轴当前位置 -
继续时先做原点校验：
st复制IF 原点校验完成 THEN DRVI 暂停坐标_X, 暂停坐标_Y, D100, D101, Y0 END_IF;
实际测试发现，直接恢复运动可能导致累积误差。我们的解决方案是：
- 暂停后先回退5mm
- 继续时先前进到暂停位置前5mm
- 最后精确定位到暂停位置
这样处理后的重复定位精度实测在±0.01mm以内。
4. 通信与报警系统
4.1 MODBUS通信实现
与A800变频器的通信采用MODBUS-RTU协议，使用FX5U内置的ADPRW指令。通信参数设置如下：
st复制ADPRW(
通道:=1, // 使用COM1口
从站:=2, // 变频器站号
功能码:=H06, // 写单个寄存器
地址:=H2000, // 变频器基准频率地址
写入值:=D100, // 频率设定值(0.01Hz单位)
超时:=T#5S, // 5秒超时
完成信号=>M200 // 通信完成标志
);
常见问题处理：
- 通信超时：检查接线和站号设置
- 数据错误：确认变频器参数地址是否正确
- 通信干扰：增加终端电阻，降低波特率
4.2 报警管理系统
报警系统采用位编码方式，将32种报警状态压缩到一个DWORD中。例如：
st复制VAR_GLOBAL
报警状态 : DWORD;
END_VAR
// 报警定义
报警状态.0 := 伺服准备信号=OFF; // bit0:伺服未准备
报警状态.1 := 气压<0.4MPa; // bit1:气压不足
报警状态.2 := 变频器故障; // bit2:变频器报警
...
在HMI上，我们做了一个报警解码界面，可以直观显示当前报警内容。维护时只需查看D505寄存器的十六进制值，就能快速定位问题。
5. 生产统计功能
5.1 产量统计实现
系统自动记录白班和夜班的产量数据，通过系统时钟自动切换班次：
st复制IF 系统时间.HOUR=8 AND 系统时间.MINUTE=0 THEN
当前班次 := 白班;
ELSIF 系统时间.HOUR=20 AND 系统时间.MINUTE=0 THEN
当前班次 := 夜班;
END_IF;
IF 产品完成 THEN
班次产量[当前班次] := 班次产量[当前班次] + 1;
总产量 := 总产量 + 1;
END_IF;
5.2 工时统计方法
每个工序的运行时间通过系统时钟记录：
st复制工序开始时间 := 系统时间;
...
工序结束时间 := 系统时间;
工序耗时 := 工序结束时间 - 工序开始时间;
我们还增加了一个人性化功能：连续运行超过8小时自动提示休息：
st复制IF 运行时间累计 > T#8H THEN
休息提示 := TRUE;
END_IF;
6. 调试与优化经验
6.1 伺服参数调试
J4-A伺服的关键参数设置：
- 位置环增益：通常设置在30-50rad/s
- 速度环增益：建议从默认值开始，逐步提高
- 加减速时间：根据负载惯量调整，一般0.2-0.5s
调试时遇到的一个典型问题：运动停止时有轻微抖动。解决方案是：
- 适当降低速度环增益
- 增加加减速时间
- 启用伺服的内置振动抑制功能
6.2 程序优化技巧
- 使用结构化编程，将重复功能封装成功能块
- 中文变量命名要统一规范，如"伺服_使能"、"气缸_前限"
- 重要参数设置范围检查，防止误操作
- 定期备份程序参数，特别是伺服参数
注意：在修改伺服参数前，务必记录原始值，以便出现问题时可以恢复。
7. 系统扩展与改进
目前系统已经稳定运行半年多，根据用户反馈我们计划增加以下功能：
- 远程监控接口：通过以太网实现手机端状态查看
- 刀具寿命管理：记录钻头使用次数，提前预警更换
- 能耗统计：监测设备用电情况，优化生产计划
这套控制系统虽然初期开发工作量较大，但结构化的设计使得后续维护和扩展非常方便。特别是在处理20组工序时，只需要在HMI上配置新的坐标参数即可，不需要修改PLC程序。