1. 三菱FX5U伺服控制程序架构解析
这套基于ST+FB的伺服控制模板之所以能在六条生产线上稳定运行三年，核心在于其模块化架构设计。与传统的梯形图编程相比，结构化文本(ST)配合功能块(FB)的写法更接近高级语言编程思维，特别适合处理运动控制这类需要复杂逻辑的场景。
1.1 硬件与程序协同设计要点
在工业控制系统中，硬件配置必须与程序严格匹配。我们来看轴参数配置功能块的关键设计：
st复制FUNCTION_BLOCK AxisConfig
VAR_INPUT
iAxisNo: INT; //轴编号
iGearRatio: REAL; //减速比
END_VAR
VAR_OUTPUT
oAccTime: TIME; //加速时间
oDecTime: TIME; //减速时间
END_VAR
这个功能块的巧妙之处在于：
- 采用TIME类型直接输出加减速时间，省去了传统方法中需要手动转换时间单位的麻烦
- 减速比参数使用REAL类型而非INT，确保高精度传动系统也能准确计算
- 输入输出变量前缀明确（i表示输入，o表示输出），便于后续维护
实际应用中发现，减速比参数建议保留4位小数，特别是对于精密输送系统。曾经有个项目因为只保留2位小数，导致累计误差在8小时运行后达到3mm。
1.2 运动控制状态机设计精髓
运动控制的核心是状态管理，本模板采用有限状态机(FSM)模式：
st复制CASE stMotionState OF
10: //回原点
IF NOT AxisHome(bAxis1) THEN
AlarmCode := 1001;
stMotionState := 90;
ELSE
stMotionState := 20;
END_IF;
20: //等待启动信号
IF diStart THEN
stMotionState := 30;
END_IF;
30: //点位运动
AxisMove(bAxis1, 500.0, 200.0);
stMotionState := 40;
40: //运动中监控
IF AxisInPosition(bAxis1) THEN
stMotionState := 50;
ELSIF diEmergencyStop THEN
AxisStop(bAxis1);
stMotionState := 90;
END_IF;
状态机设计的几个关键技巧：
- 每个状态编号间隔10，为后续扩展留出空间
- 急停信号采用独立判断条件，确保最高优先级响应
- 运动到位检测与状态转换分离，提高可靠性
2. 核心功能模块实现细节
2.1 报警处理模块的工程实践
工业现场最怕的就是故障漏报，这个自锁式报警处理模块值得细看：
st复制FUNCTION_BLOCK AlarmHandler
VAR_INPUT
iErrorCode: INT;
iResetSignal: BOOL;
END_VAR
VAR
bErrorLatch: BOOL;
END_VAR
IF iErrorCode <> 0 THEN
bErrorLatch := TRUE;
END_IF;
IF iResetSignal THEN
bErrorLatch := FALSE;
END_IF;
实际应用中有几个优化点：
- 复位信号建议增加5ms延时滤波，避免触点抖动
- 重要报警可扩展为结构体，包含时间戳、报警等级等信息
- 在HMI上显示时，建议按未确认/已确认两种状态区分颜色
2.2 JOG功能的平滑控制算法
手动调试时的轴抖动问题，通过这个速度斜坡算法有效解决：
st复制//手动模式速度斜坡
IF bJogForward THEN
rTargetSpeed := LIMIT(rJogSpeed * 0.8, rCurrentSpeed + 10.0, rJogSpeed);
ELSIF bJogReverse THEN
rTargetSpeed := LIMIT(-rJogSpeed * 0.8, rCurrentSpeed - 10.0, -rJogSpeed);
ELSE
rTargetSpeed := 0.0;
END_IF;
参数设置经验：
- 10.0这个变化率需要根据伺服驱动器型号调整，三菱MR-J4系列建议5-15之间
- 0.8的系数适用于大部分工况，高精度场合可提高到0.9
- 实际项目中可增加加速度参数，实现S曲线加减速
3. 工程化应用技巧
3.1 工艺配方的智能封装
这个配方处理功能块展示了工业程序的复用艺术：
st复制FUNCTION_BLOCK RecipeHandler
VAR_INPUT
iRecipeNo: INT;
END_VAR
VAR
aPositionData: ARRAY[1..10] OF REAL;
END_VAR
CASE iRecipeNo OF
1:
aPositionData[1] := 150.0;
aPositionData[2] := 300.0;
2:
aPositionData[1] := 200.0;
aPositionData[2] := 450.0;
END_CASE;
工程实践中的改进建议：
- 配方数据最好存储在PLC的保持寄存器区
- 可增加配方版本校验功能，防止误用旧参数
- 复杂工艺建议采用结构体数组，提高可读性
3.2 变量命名规范的实战价值
这套命名规范看似简单，实则能大幅降低沟通成本：
| 前缀 | 数据类型 | 示例 | 说明 |
|---|---|---|---|
| di | BOOL | diStart | 数字量输入 |
| do | BOOL | doRun | 数字量输出 |
| b | BOOL | bAxisReady | 内部布尔量 |
| r | REAL | rTargetPos | 实型变量 |
| st | STRUCT | stAxisPara | 结构体变量 |
在大型项目中，建议补充以下规范：
- 全局变量增加g_前缀
- 临时变量使用t_前缀
- 常量全部大写，如MAX_SPEED
4. 现场调试避坑指南
4.1 参数配置常见错误
-
电子齿轮比计算错误：
- 正确公式：(电机编码器分辨率×机械减速比)/负载移动量每转
- 常见错误：单位不统一（mm/inch混用）
-
加减速时间设置不当：
- 建议先用驱动器参数的1/3作为初始值
- 带载测试时观察电流曲线，调整至无振动
-
原点回归参数：
- 近点信号有效宽度至少设为2倍PLC扫描周期
- 爬行速度建议设为额定速度的5-10%
4.2 典型故障处理流程
遇到电机啸叫时排查步骤：
- 检查动力线接地是否良好
- 确认刚性参数是否匹配（三菱伺服参数PB07）
- 查看实际负载率（MR Configurator软件）
- 检查机械传动部件是否有松动
位置偏差过大时的处理：
- 首先确认是否已执行原点复归
- 检查编码器线是否有干扰（双绞+屏蔽层接地）
- 测试单轴空载运行时的定位精度
- 核对机械传动比参数
5. 程序移植注意事项
5.1 硬件适配要点
-
I/O地址必须重新映射：
- 脉冲输出通道（Y0-Y3）
- 限位信号输入点
- 伺服准备好/报警信号
-
特殊模块配置：
- 高速计数模块的初始化
- 模拟量模块的通道使能
- 通信模块的站号设置
5.2 参数优化方法
-
惯量比测试：
- 通过JOG模式测试电机空载电流
- 逐步增加负载观察驱动器响应
-
增益调整步骤：
- 先调速度环增益（参数PA09）
- 再调位置环增益（参数PA11）
- 最后调整滤波器参数（PA15）
-
振动抑制技巧：
- 启用机械共振抑制功能（三菱PB24-PB27）
- 适当降低刚性等级（PA01）
这套模板最珍贵的不是代码本身，而是其中蕴含的工程思维。每次移植新项目时，建议先花2小时通读所有注释，特别是标红的重要警示。有次我忘记修改Y轴软限位参数，结果导致新设备的滑块直接撞上机械挡块——这些经验都是用真金白银换来的教训。