CODESYS ST语言实战：手把手教你用功能块（FB）封装EtherCAT电机控制逻辑

CODESYS ST语言实战：用功能块封装EtherCAT电机控制逻辑的工程化实践

在工业自动化项目中，电机控制是最基础也最频繁出现的需求之一。每当我们需要控制一个新的电机轴时，往往要重复编写类似的使能、点动、定位逻辑。这种重复不仅效率低下，更糟糕的是，分散在各处的控制代码会让项目后期维护变得异常困难——想象一下当需要修改所有电机的加速度参数时，你不得不逐个查找和更新几十处代码的场景。这正是功能块（Function Block）封装的价值所在。

1. 功能块封装的核心价值与设计原则

1.1 为什么需要封装电机控制逻辑

在原始示例中，我们看到了典型的电机控制代码结构：一系列MC_Power、MC_Jog等功能块分散在主程序中，通过状态变量控制执行流程。这种写法在小规模测试时或许可行，但在实际工程中会面临三大挑战：

• 可维护性差：参数分散在多个位置，修改时需要同步更新多处
• 复用成本高：为第二个电机重写相同逻辑时容易遗漏关键参数
• 状态管理混乱：各功能块间的状态转换缺乏统一管理

通过功能块封装，我们可以将这些分散的控制逻辑整合为一个完整的控制单元，就像电子工程师将分立元件集成为芯片一样。一个设计良好的电机控制功能块应该具备：

FUNCTION_BLOCK FB_MotionController VAR_INPUT // 配置参数 Axis: AXIS_REF; Config: ST_MotionConfig; // 控制命令 Command: ST_MotionCommand; END_VAR VAR_OUTPUT Status: ST_MotionStatus; Diagnostics: ST_MotionDiagnostics; END_VAR VAR // 内部状态机 State: E_MotionState; // 子功能块实例 fbPower: MC_Power; fbJog: MC_Jog; // ...其他功能块 END_VAR

1.2 功能块接口设计的最佳实践

优秀的接口设计应该遵循"高内聚、低耦合"原则。对于电机控制功能块，我们可以将参数分为三类：

运动控制参数配置示例：

TYPE ST_MotionConfig : STRUCT MaxVelocity: LREAL := 1000.0; // 最大速度 (单位/秒) MaxAcceleration: LREAL := 5000.0; // 最大加速度 DefaultJerk: LREAL := 10000.0; // 默认加加速度 HomingSpeed: LREAL := 200.0; // 回零速度 SoftLimitPositive: LREAL := 10000.0; // 正软限位 SoftLimitNegative: LREAL := -10000.0;// 负软限位 END_STRUCT END_TYPE

提示：将不常修改的参数封装到配置结构体中，可以大幅简化功能块调用时的参数传递，同时也便于集中管理参数范围校验。

2. 状态机设计与实现

2.1 电机控制的状态转换模型

电机控制本质上是一个状态机，不同状态之间有着严格的转换规则。设计状态机时需要考虑：

• 哪些状态是瞬态的（如"启动中"）
• 哪些状态是稳态的（如"已使能"）
• 错误状态如何影响状态转换

一个典型的电机控制状态机可能包含以下状态：

TYPE E_MotionState : ( State_Disabled, // 未使能 State_Enabling, // 使能中 State_Ready, // 就绪 State_Homing, // 回零中 State_Jogging, // 点动运行 State_Moving, // 定位运动中 State_Error // 错误状态 ); END_TYPE

2.2 状态机的CODESYS实现

在ST语言中，我们可以使用CASE语句实现状态机逻辑。关键是要处理好状态转换的条件判断和状态迁移：

METHOD INTERNAL UpdateStateMachine : BOOL VAR_INPUT NewCommand: E_MotionCommand; END_VAR VAR TransitionAllowed: BOOL; BEGIN CASE State OF State_Disabled: IF NewCommand = CMD_Enable THEN State := State_Enabling; fbPower(Enable := TRUE); END_IF State_Enabling: IF fbPower.Status THEN State := State_Ready; ELSIF fbPower.Error THEN State := State_Error; END_IF State_Ready: CASE NewCommand OF CMD_Disable: State := State_Disabled; fbPower(Enable := FALSE); CMD_Home: State := State_Homing; fbHome(Execute := TRUE); // 其他命令处理... END_CASE // 其他状态处理... END_CASE; RETURN TRUE; END_METHOD

注意：状态机实现时应特别注意错误恢复路径。良好的设计应该为每个可能出错的操作提供明确的错误处理流程，而不是简单地跳转到错误状态。

3. 功能块的完整实现与优化

3.1 功能块的主体结构

将前述设计组合起来，我们可以构建完整的电机控制功能块。以下是功能块的主体框架：

FUNCTION_BLOCK FB_MotionController IMPLEMENTS IMotionControl VAR_INPUT // 轴配置（通常只在初始化时设置） Axis: AXIS_REF; Config: ST_MotionConfig; // 实时控制命令 Command: E_MotionCommand; MoveParam: ST_MoveParameters; END_VAR VAR_OUTPUT Status: ST_MotionStatus; Diagnostics: ST_MotionDiagnostics; END_VAR VAR // 状态管理 InternalState: E_MotionState; // 子功能块实例 fbPower: MC_Power; fbJog: MC_Jog; fbMoveAbs: MC_MoveAbsolute; // ...其他功能块 // 内部标记 FirstCycle: BOOL := TRUE; END_VAR

3.2 功能块的执行逻辑

功能块的核心执行逻辑通常放在一个主方法中，该方法在每个PLC周期被调用：

METHOD PUBLIC Execute : BOOL VAR_INPUT CycleTime: TIME := T#1MS; // 默认1ms周期 END_VAR BEGIN // 初始化检查 IF FirstCycle THEN InitFunctionBlock(); FirstCycle := FALSE; END_IF; // 更新子功能块 UpdateSubFunctionBlocks(); // 处理状态转换 UpdateStateMachine(); // 收集状态信息 UpdateStatusInformation(); RETURN TRUE; END_METHOD

初始化方法的典型实现：

METHOD PRIVATE InitFunctionBlock : BOOL BEGIN // 验证轴引用有效性 IF NOT __ISVALIDREF(Axis) THEN Diagnostics.LastError := ERR_INVALID_AXIS_REF; InternalState := E_MotionState.State_Error; RETURN FALSE; END_IF; // 初始化子功能块 fbPower.Axis := Axis; fbJog.Axis := Axis; // ...其他初始化 // 应用配置参数 fbJog.Velocity := Config.MaxVelocity; fbJog.Acceleration := Config.MaxAcceleration; // ...其他参数应用 RETURN TRUE; END_METHOD

4. 高级应用与项目实践

4.1 多轴同步控制实现

封装好的功能块可以轻松扩展到多轴控制场景。以下是实现两轴同步移动的示例：

PROGRAM MAIN VAR // 轴实例 AxisX: AXIS_REF; AxisY: AXIS_REF; // 控制器实例 ControllerX: FB_MotionController; ControllerY: FB_MotionController; // 同步控制变量 SyncMove: BOOL := FALSE; SyncDone: BOOL; END_VAR // 初始化 ControllerX( Axis := AxisX, Config := (MaxVelocity := 500.0, MaxAcceleration := 3000.0) ); ControllerY( Axis := AxisY, Config := (MaxVelocity := 500.0, MaxAcceleration := 3000.0) ); // 同步移动控制 IF SyncMove THEN ControllerX.Command := CMD_MoveAbsolute; ControllerX.MoveParam.Position := 100.0; ControllerY.Command := CMD_MoveAbsolute; ControllerY.MoveParam.Position := 50.0; SyncDone := ControllerX.Status.Ready AND ControllerY.Status.Ready; END_IF

4.2 功能块的测试与验证

为确保功能块的可靠性，建议建立系统的测试方案：

1. 单元测试：针对每个状态转换和边界条件

   • 测试从禁用状态到使能状态的转换
   • 测试运动过程中的急停响应
   • 验证软限位的触发条件

2. 集成测试：与其他系统组件配合测试

   • 测试与HMI的接口兼容性
   • 验证与安全控制器的交互
   • 检查长时间运行的稳定性

3. 性能测试：评估实时性要求

   • 测量最坏情况下的执行时间
   • 验证高负载下的响应能力
   • 检查内存使用情况

测试案例表示例：

在实际项目中，我们曾遇到一个有趣的案例：当功能块同时收到停止命令和位置更新时，由于状态机设计缺陷，导致电机未能立即停止。这个教训让我们在状态机设计中加入了明确的命令优先级处理逻辑。现在，紧急停止命令会中断任何正在进行的运动，确保安全响应。