在实际工业自动化项目中单轴运动控制是基础但更复杂的加工轨迹如切割、焊接、涂胶或 CNC 加工往往需要多个轴协同运动形成平滑的直线或圆弧路径。这正是轴组Axis Group和插补Interpolation技术要解决的核心问题。CODESYS 作为功能强大的 IEC 61131-3 编程平台其 SoftMotion 模块提供了完善的轴组和插补功能允许开发者使用 ST 语言等高级语言在 PLC 层面实现复杂的多轴协调运动。本文将聚焦于 CODESYS 轴组功能中的直线插补和圆弧插补实战。如果你已经掌握了单轴的点位、速度控制并希望将控制能力扩展到二维甚至三维空间实现精确的轨迹规划那么这篇文章正是为你准备的。我们将从轴组的基本概念讲起逐步完成一个包含直线和圆弧插补的完整项目涵盖轴组配置、插补指令调用、参数设置、运行监控以及常见问题排查的全过程。通过本文你将能够独立在 CODESYS 环境中搭建并调试一个可运行的轴组插补程序。1. 理解 CODESYS 轴组与插补的核心机制在深入代码之前必须理解轴组和插补在 CODESYS 中的工作方式这决定了后续配置和编程的逻辑。1.1 轴组从独立个体到协同整体单轴控制时每个轴如伺服电机是独立的执行单元有自己的位置、速度、加速度设定。而轴组Axis Group则将多个物理轴或虚拟轴逻辑上捆绑在一起作为一个整体进行运动规划。例如一个 XY 工作台X 轴和 Y 轴被组合成一个“XY 平面轴组”。控制器不再单独规划每个轴的运动曲线而是规划这个轴组末端Tool Center Point, TCP在空间中的轨迹。在 CODESYS SoftMotion 中轴组有明确的维度概念。一个二维2D轴组包含两个轴通常映射到笛卡尔坐标系的 X 和 Y 轴。轴组的运动指令如直线、圆弧是基于这个坐标系下达的。创建轴组时需要指定组内轴的顺序这个顺序决定了坐标轴的映射关系至关重要。1.2 插补轨迹生成的数学引擎插补是运动控制的核心算法其任务是根据给定的路径类型直线、圆弧等和参数起点、终点、圆心等在运动周期内实时计算出组内每一个轴在每个时刻应该到达的位置指令并发送给各自的驱动器。直线插补 (Linear Interpolation)控制轴组末端从当前位置或指定起点沿直线运动到目标位置。在二维平面中X 轴和 Y 轴必须严格按照线性关系协同运动以合成一条直线。圆弧插补 (Circular Interpolation)控制轴组末端沿一段圆弧运动。这需要更复杂的计算通常需要指定圆心坐标或半径以及旋转方向顺时针/逆时针。CODESYS 的插补功能封装在MC_MoveLinear和MC_MoveCircular等标准功能块FB中。开发者无需关心底层算法只需正确设置路径参数即可。但理解其背后的坐标系和参数定义是避免运动异常的关键。1.3 工作流程与数据流一个典型的轴组插补工作流程如下轴配置与使能为每个物理轴配置驱动接口如 EtherCAT、参数并单独使能。创建与耦合轴组在 SoftMotion 配置中创建轴组并将已使能的物理轴按顺序耦合Couple到轴组的各个维度上。轴组使能使用MC_GroupEnable功能块使能整个轴组。只有轴组使能后才能接受插补指令。执行插补运动使用MC_MoveLinear或MC_MoveCircular功能块向轴组下达运动指令。监控与同步通过功能块输出参数如Busy,Done,Error监控运动状态并可利用MC_Sync等功能块实现多段轨迹间的精确衔接。2. 环境准备与项目配置在开始编程前需要搭建正确的 CODESYS 开发环境并完成必要的软硬件配置。2.1 软件环境与组件安装CODESYS Development System建议使用较新版本如 V3.5 SP18 或更高以确保 SoftMotion 功能的完整性和稳定性。SoftMotion 组件这是实现高级运动控制的核心。在创建新项目时务必在“项目”-“设备”中为你的PLC设备添加“SoftMotion”组件。通常需要添加“SoftMotion Basic”或“SoftMotion CNC”相关库。驱动支持包根据你使用的实际硬件如汇川伺服、倍福驱动器等需要安装对应的设备描述文件GSD/EtherCAT和驱动库以便在 CODESYS 中正确识别和配置从站设备。2.2 创建一个新的运动控制项目启动 CODESYS创建一个新项目。选择正确的设备类型例如“CODESYS Control Win V3”用于仿真“CODESYS Control RTE V3”用于实时系统或具体的硬件PLC如“倍福 CX…”。在设备树中右键点击设备选择“添加设备”。在“运动控制”分类下添加“SoftMotion”下的“轴组控制器SM3_Controller”和“轴SM3_Axis”等必要组件。具体名称可能因版本略有差异。添加完成后设备树中会出现相应的运动控制对象。2.3 配置物理轴与虚拟轴组配置物理轴以汇川伺服为例在“设备”树中根据你的网络如 EtherCAT添加主站和对应的伺服驱动器从站。在驱动器从站下添加一个“轴”对象。将其与驱动器的 PDO过程数据对象映射关联通常包括控制字ControlWord、状态字StatusWord、目标位置TargetPosition、实际位置ActualPosition等。配置轴的基本参数如单位换算例如1 个用户单位 0.001 mm、软限位、回零方式等。创建并配置轴组在“SoftMotion”控制器下添加一个“轴组Kinematics”对象。选择类型例如“2D 笛卡尔”用于 XY 平面运动。双击轴组进入配置。在“轴分配”选项卡将之前配置好的物理轴如 Axis_1, Axis_2分别拖拽到“轴组轴”的“轴 1”、“轴 2”位置。这完成了轴的耦合。配置轴组的坐标系、动态参数如轴组的最大速度、加速度、加加速度。这些参数将成为插补运动的默认限制。注意物理轴的使能和轴组的使能是两个独立步骤。必须先使能所有物理轴才能成功使能轴组。3. 使用 ST 语言编写轴组插补程序理论配置完成后我们进入核心的编程部分。我们将在一个 POU程序组织单元中用 ST 语言编写控制逻辑。3.1 变量声明与功能块实例化首先在 POU 的 VAR 区声明必要的功能块实例和变量。VAR // 轴使能功能块 fbAxisEnable1: MC_Power; fbAxisEnable2: MC_Power; // 轴组使能功能块 fbGroupEnable: MC_GroupEnable; // 插补运动功能块 fbMoveLinear1: MC_MoveLinear; fbMoveCircular: MC_MoveCircular; fbMoveLinear2: MC_MoveLinear; // 同步功能块用于衔接多段运动 fbSync: MC_Sync; // 控制变量 bEnableAll: BOOL : FALSE; // 总使能信号 bStartPath: BOOL : FALSE; // 启动路径信号 bAbort: BOOL : FALSE; // 急停/中止信号 // 轴组参考链接到配置的轴组对象 refMyGroup: AXIS_GROUP_REF : MyProject.MyDevice.SM3_Controller.Kinematics_1; // 运动参数 fTargetX: LREAL : 100.0; // 目标位置 X (用户单位) fTargetY: LREAL : 50.0; // 目标位置 Y fCenterX: LREAL : 50.0; // 圆弧圆心 X fCenterY: LREAL : 0.0; // 圆弧圆心 Y fVelocity: LREAL : 20.0; // 运动速度 fAccel: LREAL : 100.0; // 加速度 fDecel: LREAL : 100.0; // 减速度 // 状态变量 stGroupState: MC_GroupState; // 用于读取轴组状态 END_VAR3.2 实现轴与轴组的使能序列使能必须遵循严格的顺序通常在主循环中持续执行。// 1. 使能物理轴1 fbAxisEnable1( Axis: MyProject.MyDevice.SM3_Controller.Axis_1, // 链接到配置的轴1对象 Enable: bEnableAll, Enable_Positive: TRUE, Enable_Negative: TRUE, Override: 1.0 ); // 2. 使能物理轴2 fbAxisEnable2( Axis: MyProject.MyDevice.SM3_Controller.Axis_2, // 链接到配置的轴2对象 Enable: bEnableAll, Enable_Positive: TRUE, Enable_Negative: TRUE, Override: 1.0 ); // 3. 使能轴组 (前提是组内所有物理轴已使能) fbGroupEnable( Group: refMyGroup, Enable: bEnableAll AND fbAxisEnable1.Status AND fbAxisEnable2.Status, GroupID: 1 ); // 读取轴组状态用于监控 stGroupState(Group: refMyGroup);关键解释MC_Power功能块的Status输出为 TRUE 时表示该物理轴已就绪。MC_GroupEnable的Enable输入端我们加入了fbAxisEnable1.Status AND fbAxisEnable2.Status条件确保仅在所有物理轴就绪后才尝试使能轴组。这是一种安全的编程实践。MC_GroupState功能块可以实时读取轴组的使能状态、错误信息等。3.3 编写直线插补运动程序假设我们规划一条从原点 (0,0) 到点 (100, 50) 的直线。// 直线插补段1从原点移动到(100, 50) fbMoveLinear1( Group: refMyGroup, Execute: bStartPath AND NOT fbMoveLinear1.Busy, // 上升沿触发且上次运动已完成 PathChoice: 0, // 使用内置路径缓冲区 Velocity: fVelocity, Acceleration: fAccel, Deceleration: fDecel, CoordSystem: 0, // 0 表示笛卡尔坐标系 EndPositionX: fTargetX, // 终点 X 坐标 EndPositionY: fTargetY, // 终点 Y 坐标 BufferMode: 0 // 0: 中止当前运动并立即执行1: 混合/缓冲 );参数详解Execute使用上升沿触发。NOT fbMoveLinear1.Busy确保不会重复触发正在进行的运动。PathChoice通常设为 0使用系统路径。CoordSystem0 代表笛卡尔坐标。对于 2D 轴组这就是 X-Y 平面。EndPositionX/Y运动终点在轴组坐标系中的绝对坐标。BufferMode这是关键参数。0 (mcAborting)新指令会中止当前正在执行的运动立即开始。会导致运动不连续。1 (mcBuffered)新指令被放入缓冲区在当前运动完成后自动开始。这是实现连续多段轨迹如连续直线-圆弧-直线必须设置的模式。3.4 编写圆弧插补运动程序在完成直线运动后我们希望从 (100, 50) 点开始绕圆心 (50, 0) 顺时针画一个 180 度的圆弧到达 (0, -50) 点。这里需要用到MC_Sync来同步两段运动。// 同步点等待直线运动完成并准备圆弧参数 fbSync( Group: refMyGroup, Execute: fbMoveLinear1.Done, // 当直线运动完成时触发 SyncPosition: TRUE // 等待轴组完全到达上一指令的终点 ); // 圆弧插补段以(50,0)为圆心顺时针画半圆 fbMoveCircular( Group: refMyGroup, Execute: fbSync.Done, // 同步完成后触发圆弧指令 PathChoice: 0, Velocity: fVelocity, Acceleration: fAccel, Deceleration: fDecel, CoordSystem: 0, CircMode: 0, // 0: 通过圆心和终点定义圆弧 CenterX: fCenterX, // 圆心 X 坐标 CenterY: fCenterY, // 圆心 Y 坐标 EndPositionX: 0.0, // 圆弧终点 X (0, -50) EndPositionY: -50.0, Direction: 1, // 1: 顺时针 (mcDirectionCW) BufferMode: 1 // 使用缓冲模式与同步点配合实现平滑过渡 );参数详解CircMode定义圆弧的方式。0 (mcCenter)表示通过“圆心坐标 终点坐标”来定义圆弧。另一种常用模式是2 (mcRadius)通过“半径 终点坐标 旋转角度”来定义。Direction1表示顺时针方向Clockwise。0表示逆时针Counterclockwise。方向的判定依赖于坐标系。BufferMode此处必须设置为1 (mcBuffered)这样圆弧指令会在MC_Sync确认同步点到达后被“缓冲”并顺序执行实现从直线到圆弧的光滑过渡没有停顿。3.5 编写后续直线运动并形成闭环最后我们从圆弧终点 (0, -50) 再画一条直线回到原点 (0,0)形成一个闭合路径。// 同步点等待圆弧运动完成 fbSync2( Group: refMyGroup, Execute: fbMoveCircular.Done, SyncPosition: TRUE ); // 直线插补段2从(0,-50)回到原点(0,0) fbMoveLinear2( Group: refMyGroup, Execute: fbSync2.Done, PathChoice: 0, Velocity: fVelocity, Acceleration: fAccel, Deceleration: fDecel, CoordSystem: 0, EndPositionX: 0.0, EndPositionY: 0.0, BufferMode: 1 );4. 运行验证与轨迹监控程序编写完成后需要进行编译、下载、在线调试和轨迹验证。4.1 编译与下载点击 CODESYS 工具栏的“编译”按钮确保无语法错误。将 PLC 置于“运行”模式。如果是仿真环境如 CODESYS Control Win V3直接启动仿真即可。下载程序到 PLC。4.2 在线调试与变量监控在 CODESYS 中登录到 PLC。打开“在线”视图监控关键变量将bEnableAll置为 TRUE。观察fbAxisEnable1.Status,fbAxisEnable2.Status和fbGroupEnable.Status是否依次变为 TRUE。如果fbGroupEnable.Error为 TRUE需检查fbGroupEnable.ErrorID。监控轴组状态stGroupState.IsGroupEnabled应为 TRUE。将bStartPath置为 TRUE一个上升沿。观察fbMoveLinear1.Busy和fbMoveLinear1.Done的状态变化。通过“示波器”或“视图”功能添加MyGroup.ActualPosition.X和MyGroup.ActualPosition.Y进行监控可以看到 X, Y 轴的实际位置曲线。观察运动是否按预期进行直线 - 同步 - 圆弧 - 同步 - 直线。4.3 使用可视化工具观察轨迹CODESYS 提供了强大的可视化工具可以直观看到轴组末端的运动轨迹。在项目中添加一个“可视化”文件.visu。从工具箱中拖入一个“SoftMotion 路径显示”控件。配置该控件的“Group”属性链接到你的轴组对象refMyGroup。在线运行后启动可视化。当程序执行插补运动时该控件会实时绘制出 TCP 点在 XY 平面上的运动轨迹。你应该能看到一个由两条直线和一个半圆组成的“D”形轨迹。4.4 预期结果与验证点功能验证使能顺序正确轴组能成功使能。运动验证触发bStartPath后轴组末端能连续、平滑地走完“直线-圆弧-直线”三段路径最终回到原点中间无明显停顿或跳跃。状态验证各功能块的Busy,Done,CommandAborted等状态信号变化符合逻辑。轨迹验证在可视化工具中观察到的轨迹与程序设定的坐标点吻合。5. 常见问题排查与调试技巧在实际调试中你可能会遇到各种问题。下面是一个常见问题排查表。问题现象可能原因检查与排查步骤解决方案轴组使能失败(fbGroupEnable.Error TRUE)1. 组内物理轴未使能。2. 轴组动态参数配置错误如速度极限为0。3. 轴耦合错误轴顺序不对。1. 检查所有MC_Power功能块的Status输出。2. 检查轴组配置中的最大速度、加速度是否合理。3. 检查轴组配置中“轴分配”的顺序。1. 确保所有物理轴先成功使能。2. 设置合理的轴组动态参数。3. 确认物理轴与轴组维度的映射关系正确。插补指令不执行(Execute触发后Busy不变)1. 轴组未使能。2. 上一个运动指令未完成且BufferMode0。3.Execute信号不是上升沿或持续时间太短。1. 检查fbGroupEnable.Status和stGroupState.IsGroupEnabled。2. 检查上一个运动功能块的Busy状态。3. 使用边沿检测确保Execute是上升沿。1. 确保轴组已使能。2. 对于连续路径使用BufferMode1并配合MC_Sync。3. 使用R_TRIG功能块生成上升沿。运动轨迹不是直线或圆弧1. 坐标值单位不统一。2. 物理轴的正方向定义不一致。3. 圆弧参数圆心、终点、方向计算错误。1. 确认所有坐标起点、终点、圆心使用相同的用户单位。2. 分别单动每个轴确认其正方向移动与坐标系正方向一致。3. 在纸上画出坐标系标出起点、终点、圆心验证参数。1. 统一使用毫米、微米等作为用户单位。2. 在轴配置中调整“正方向”或通过程序取反。3. 仔细计算或通过 CAD 软件获取准确的几何参数。多段运动间有停顿BufferMode未设置为1 (mcBuffered)且未使用MC_Sync或使用不当。检查每段插补指令的BufferMode参数。检查MC_Sync的Execute条件是否由前一段运动的Done触发。对于需要连续运行的路径所有中间段的BufferMode必须设为1并使用MC_Sync衔接。最后一段可设为0。运动过程中报错停止1. 超过软限位。2. 跟随误差过大。3. 驱动器报警。1. 查看轴组或轴的错误代码 (ErrorID)。2. 检查轴配置中的软限位值。3. 检查驱动器状态字和实际位置与目标位置的偏差。1. 适当放宽软限位或检查程序坐标是否超程。2. 调整伺服增益或降低轴组的运动速度/加速度。3. 排查驱动器本身的报警原因。调试技巧分步调试先让轴组走单段直线成功后再加入圆弧最后组合成连续路径。使用 Trace 功能CODESYS 的 Trace跟踪功能可以高速记录位置、速度、误差等曲线是分析动态性能的利器。简化问题如果复杂轨迹出错尝试用极简单的坐标如从 (0,0) 到 (10,0) 的直线测试排除参数计算错误。查看日志CODESYS 运行时和 SoftMotion 组件通常会生成详细的日志信息在消息窗口或日志文件中查找错误描述。6. 最佳实践与扩展方向掌握了基础直线和圆弧插补后以下实践和建议可以帮助你将此技术应用到更复杂的实际项目中。6.1 轴组插补编程最佳实践严格的使能序列管理使用状态机或明确的顺序逻辑来控制“物理轴使能 - 轴组使能 - 运动指令执行”的流程。急停或故障后应有完整的重启序列。参数化与配方管理不要将目标坐标、速度等参数硬编码在程序中。将它们定义为全局变量或结构体甚至存储在外部文件或数据库中便于工艺调整和配方调用。错误处理与恢复每个运动功能块都必须检查其Error和ErrorID输出。发生错误时应能安全停止所有轴使用MC_Stop或MC_Halt功能块并记录错误信息提供明确的复位或恢复路径。使用状态机管理复杂路径对于包含数十甚至上百段插补的复杂轨迹如 CNC G 代码应设计一个状态机来管理当前段、下一段、跳转、循环等逻辑而不是简单罗列功能块。动态参数调整根据工艺要求可能需要在运动过程中动态修改速度倍率 (Override)。可以通过MC_MoveLinear的Velocity输入或专门的MC_SetOverride功能块实现。6.2 从学习环境到生产环境的考量安全与互锁生产程序中必须加入安全逻辑如光栅、急停按钮、门开关等安全信号的硬线或安全 PLC 互锁。运动使能必须与这些安全条件绑定。性能优化对于高动态运动需要优化 PLC 任务周期。插补计算通常在快速任务中执行。确保 PLC 性能足够且 EtherCAT 等现场总线的通讯周期设置合理。诊断与监控除了基本状态生产系统需要监控跟随误差、扭矩、温度等关键参数并设置报警阈值。利用 CODESYS 的 WebVisu 或 HMI 开发监控界面。持久化与备份重要的机器参数如各轴零点偏移、螺距误差补偿值应在断电后能保持。确保相关变量存储在保持型存储区并有备份和恢复机制。版本与文档对运动控制程序进行严格的版本管理并对所有的坐标点、速度参数、特殊逻辑添加清晰的注释。6.3 扩展学习方向三维空间插补本文基于 2D 轴组。CODESYS 同样支持 3D 轴组原理类似但增加了 Z 轴并可能涉及更复杂的空间圆弧螺旋线插补。CNC 功能CODESYS SoftMotion CNC 库支持直接解释执行标准的 G 代码如 G00, G01, G02, G03这对于实现 CNC 机床或激光切割机控制是更高级的解决方案。电子凸轮与同步除了插补轴组还支持电子凸轮Cam和齿轮同步Gearing功能用于实现主轴与从轴间非线性的位置关系在包装、印刷机械中应用广泛。机器人运动学对于六轴机器人等复杂机构CODESYS 提供了机器人运动学库可以进行正逆运动学解算将笛卡尔空间的位置姿态转换为各个关节轴的角度指令。通过本文的直线和圆弧插补实战你已经掌握了 CODESYS 多轴协调运动的基础。关键在于理解轴组作为一个整体进行规划的概念并熟练运用MC_MoveLinear、MC_MoveCircular和MC_Sync这几个核心功能块。在实际项目中从简单的二维图形开始验证逐步增加路径复杂度和工艺逻辑同时将安全、诊断和可维护性贯穿始终是构建稳定可靠运动控制系统的有效路径。
CODESYS轴组直线与圆弧插补实战：多轴协同运动控制
在实际工业自动化项目中单轴运动控制是基础但更复杂的加工轨迹如切割、焊接、涂胶或 CNC 加工往往需要多个轴协同运动形成平滑的直线或圆弧路径。这正是轴组Axis Group和插补Interpolation技术要解决的核心问题。CODESYS 作为功能强大的 IEC 61131-3 编程平台其 SoftMotion 模块提供了完善的轴组和插补功能允许开发者使用 ST 语言等高级语言在 PLC 层面实现复杂的多轴协调运动。本文将聚焦于 CODESYS 轴组功能中的直线插补和圆弧插补实战。如果你已经掌握了单轴的点位、速度控制并希望将控制能力扩展到二维甚至三维空间实现精确的轨迹规划那么这篇文章正是为你准备的。我们将从轴组的基本概念讲起逐步完成一个包含直线和圆弧插补的完整项目涵盖轴组配置、插补指令调用、参数设置、运行监控以及常见问题排查的全过程。通过本文你将能够独立在 CODESYS 环境中搭建并调试一个可运行的轴组插补程序。1. 理解 CODESYS 轴组与插补的核心机制在深入代码之前必须理解轴组和插补在 CODESYS 中的工作方式这决定了后续配置和编程的逻辑。1.1 轴组从独立个体到协同整体单轴控制时每个轴如伺服电机是独立的执行单元有自己的位置、速度、加速度设定。而轴组Axis Group则将多个物理轴或虚拟轴逻辑上捆绑在一起作为一个整体进行运动规划。例如一个 XY 工作台X 轴和 Y 轴被组合成一个“XY 平面轴组”。控制器不再单独规划每个轴的运动曲线而是规划这个轴组末端Tool Center Point, TCP在空间中的轨迹。在 CODESYS SoftMotion 中轴组有明确的维度概念。一个二维2D轴组包含两个轴通常映射到笛卡尔坐标系的 X 和 Y 轴。轴组的运动指令如直线、圆弧是基于这个坐标系下达的。创建轴组时需要指定组内轴的顺序这个顺序决定了坐标轴的映射关系至关重要。1.2 插补轨迹生成的数学引擎插补是运动控制的核心算法其任务是根据给定的路径类型直线、圆弧等和参数起点、终点、圆心等在运动周期内实时计算出组内每一个轴在每个时刻应该到达的位置指令并发送给各自的驱动器。直线插补 (Linear Interpolation)控制轴组末端从当前位置或指定起点沿直线运动到目标位置。在二维平面中X 轴和 Y 轴必须严格按照线性关系协同运动以合成一条直线。圆弧插补 (Circular Interpolation)控制轴组末端沿一段圆弧运动。这需要更复杂的计算通常需要指定圆心坐标或半径以及旋转方向顺时针/逆时针。CODESYS 的插补功能封装在MC_MoveLinear和MC_MoveCircular等标准功能块FB中。开发者无需关心底层算法只需正确设置路径参数即可。但理解其背后的坐标系和参数定义是避免运动异常的关键。1.3 工作流程与数据流一个典型的轴组插补工作流程如下轴配置与使能为每个物理轴配置驱动接口如 EtherCAT、参数并单独使能。创建与耦合轴组在 SoftMotion 配置中创建轴组并将已使能的物理轴按顺序耦合Couple到轴组的各个维度上。轴组使能使用MC_GroupEnable功能块使能整个轴组。只有轴组使能后才能接受插补指令。执行插补运动使用MC_MoveLinear或MC_MoveCircular功能块向轴组下达运动指令。监控与同步通过功能块输出参数如Busy,Done,Error监控运动状态并可利用MC_Sync等功能块实现多段轨迹间的精确衔接。2. 环境准备与项目配置在开始编程前需要搭建正确的 CODESYS 开发环境并完成必要的软硬件配置。2.1 软件环境与组件安装CODESYS Development System建议使用较新版本如 V3.5 SP18 或更高以确保 SoftMotion 功能的完整性和稳定性。SoftMotion 组件这是实现高级运动控制的核心。在创建新项目时务必在“项目”-“设备”中为你的PLC设备添加“SoftMotion”组件。通常需要添加“SoftMotion Basic”或“SoftMotion CNC”相关库。驱动支持包根据你使用的实际硬件如汇川伺服、倍福驱动器等需要安装对应的设备描述文件GSD/EtherCAT和驱动库以便在 CODESYS 中正确识别和配置从站设备。2.2 创建一个新的运动控制项目启动 CODESYS创建一个新项目。选择正确的设备类型例如“CODESYS Control Win V3”用于仿真“CODESYS Control RTE V3”用于实时系统或具体的硬件PLC如“倍福 CX…”。在设备树中右键点击设备选择“添加设备”。在“运动控制”分类下添加“SoftMotion”下的“轴组控制器SM3_Controller”和“轴SM3_Axis”等必要组件。具体名称可能因版本略有差异。添加完成后设备树中会出现相应的运动控制对象。2.3 配置物理轴与虚拟轴组配置物理轴以汇川伺服为例在“设备”树中根据你的网络如 EtherCAT添加主站和对应的伺服驱动器从站。在驱动器从站下添加一个“轴”对象。将其与驱动器的 PDO过程数据对象映射关联通常包括控制字ControlWord、状态字StatusWord、目标位置TargetPosition、实际位置ActualPosition等。配置轴的基本参数如单位换算例如1 个用户单位 0.001 mm、软限位、回零方式等。创建并配置轴组在“SoftMotion”控制器下添加一个“轴组Kinematics”对象。选择类型例如“2D 笛卡尔”用于 XY 平面运动。双击轴组进入配置。在“轴分配”选项卡将之前配置好的物理轴如 Axis_1, Axis_2分别拖拽到“轴组轴”的“轴 1”、“轴 2”位置。这完成了轴的耦合。配置轴组的坐标系、动态参数如轴组的最大速度、加速度、加加速度。这些参数将成为插补运动的默认限制。注意物理轴的使能和轴组的使能是两个独立步骤。必须先使能所有物理轴才能成功使能轴组。3. 使用 ST 语言编写轴组插补程序理论配置完成后我们进入核心的编程部分。我们将在一个 POU程序组织单元中用 ST 语言编写控制逻辑。3.1 变量声明与功能块实例化首先在 POU 的 VAR 区声明必要的功能块实例和变量。VAR // 轴使能功能块 fbAxisEnable1: MC_Power; fbAxisEnable2: MC_Power; // 轴组使能功能块 fbGroupEnable: MC_GroupEnable; // 插补运动功能块 fbMoveLinear1: MC_MoveLinear; fbMoveCircular: MC_MoveCircular; fbMoveLinear2: MC_MoveLinear; // 同步功能块用于衔接多段运动 fbSync: MC_Sync; // 控制变量 bEnableAll: BOOL : FALSE; // 总使能信号 bStartPath: BOOL : FALSE; // 启动路径信号 bAbort: BOOL : FALSE; // 急停/中止信号 // 轴组参考链接到配置的轴组对象 refMyGroup: AXIS_GROUP_REF : MyProject.MyDevice.SM3_Controller.Kinematics_1; // 运动参数 fTargetX: LREAL : 100.0; // 目标位置 X (用户单位) fTargetY: LREAL : 50.0; // 目标位置 Y fCenterX: LREAL : 50.0; // 圆弧圆心 X fCenterY: LREAL : 0.0; // 圆弧圆心 Y fVelocity: LREAL : 20.0; // 运动速度 fAccel: LREAL : 100.0; // 加速度 fDecel: LREAL : 100.0; // 减速度 // 状态变量 stGroupState: MC_GroupState; // 用于读取轴组状态 END_VAR3.2 实现轴与轴组的使能序列使能必须遵循严格的顺序通常在主循环中持续执行。// 1. 使能物理轴1 fbAxisEnable1( Axis: MyProject.MyDevice.SM3_Controller.Axis_1, // 链接到配置的轴1对象 Enable: bEnableAll, Enable_Positive: TRUE, Enable_Negative: TRUE, Override: 1.0 ); // 2. 使能物理轴2 fbAxisEnable2( Axis: MyProject.MyDevice.SM3_Controller.Axis_2, // 链接到配置的轴2对象 Enable: bEnableAll, Enable_Positive: TRUE, Enable_Negative: TRUE, Override: 1.0 ); // 3. 使能轴组 (前提是组内所有物理轴已使能) fbGroupEnable( Group: refMyGroup, Enable: bEnableAll AND fbAxisEnable1.Status AND fbAxisEnable2.Status, GroupID: 1 ); // 读取轴组状态用于监控 stGroupState(Group: refMyGroup);关键解释MC_Power功能块的Status输出为 TRUE 时表示该物理轴已就绪。MC_GroupEnable的Enable输入端我们加入了fbAxisEnable1.Status AND fbAxisEnable2.Status条件确保仅在所有物理轴就绪后才尝试使能轴组。这是一种安全的编程实践。MC_GroupState功能块可以实时读取轴组的使能状态、错误信息等。3.3 编写直线插补运动程序假设我们规划一条从原点 (0,0) 到点 (100, 50) 的直线。// 直线插补段1从原点移动到(100, 50) fbMoveLinear1( Group: refMyGroup, Execute: bStartPath AND NOT fbMoveLinear1.Busy, // 上升沿触发且上次运动已完成 PathChoice: 0, // 使用内置路径缓冲区 Velocity: fVelocity, Acceleration: fAccel, Deceleration: fDecel, CoordSystem: 0, // 0 表示笛卡尔坐标系 EndPositionX: fTargetX, // 终点 X 坐标 EndPositionY: fTargetY, // 终点 Y 坐标 BufferMode: 0 // 0: 中止当前运动并立即执行1: 混合/缓冲 );参数详解Execute使用上升沿触发。NOT fbMoveLinear1.Busy确保不会重复触发正在进行的运动。PathChoice通常设为 0使用系统路径。CoordSystem0 代表笛卡尔坐标。对于 2D 轴组这就是 X-Y 平面。EndPositionX/Y运动终点在轴组坐标系中的绝对坐标。BufferMode这是关键参数。0 (mcAborting)新指令会中止当前正在执行的运动立即开始。会导致运动不连续。1 (mcBuffered)新指令被放入缓冲区在当前运动完成后自动开始。这是实现连续多段轨迹如连续直线-圆弧-直线必须设置的模式。3.4 编写圆弧插补运动程序在完成直线运动后我们希望从 (100, 50) 点开始绕圆心 (50, 0) 顺时针画一个 180 度的圆弧到达 (0, -50) 点。这里需要用到MC_Sync来同步两段运动。// 同步点等待直线运动完成并准备圆弧参数 fbSync( Group: refMyGroup, Execute: fbMoveLinear1.Done, // 当直线运动完成时触发 SyncPosition: TRUE // 等待轴组完全到达上一指令的终点 ); // 圆弧插补段以(50,0)为圆心顺时针画半圆 fbMoveCircular( Group: refMyGroup, Execute: fbSync.Done, // 同步完成后触发圆弧指令 PathChoice: 0, Velocity: fVelocity, Acceleration: fAccel, Deceleration: fDecel, CoordSystem: 0, CircMode: 0, // 0: 通过圆心和终点定义圆弧 CenterX: fCenterX, // 圆心 X 坐标 CenterY: fCenterY, // 圆心 Y 坐标 EndPositionX: 0.0, // 圆弧终点 X (0, -50) EndPositionY: -50.0, Direction: 1, // 1: 顺时针 (mcDirectionCW) BufferMode: 1 // 使用缓冲模式与同步点配合实现平滑过渡 );参数详解CircMode定义圆弧的方式。0 (mcCenter)表示通过“圆心坐标 终点坐标”来定义圆弧。另一种常用模式是2 (mcRadius)通过“半径 终点坐标 旋转角度”来定义。Direction1表示顺时针方向Clockwise。0表示逆时针Counterclockwise。方向的判定依赖于坐标系。BufferMode此处必须设置为1 (mcBuffered)这样圆弧指令会在MC_Sync确认同步点到达后被“缓冲”并顺序执行实现从直线到圆弧的光滑过渡没有停顿。3.5 编写后续直线运动并形成闭环最后我们从圆弧终点 (0, -50) 再画一条直线回到原点 (0,0)形成一个闭合路径。// 同步点等待圆弧运动完成 fbSync2( Group: refMyGroup, Execute: fbMoveCircular.Done, SyncPosition: TRUE ); // 直线插补段2从(0,-50)回到原点(0,0) fbMoveLinear2( Group: refMyGroup, Execute: fbSync2.Done, PathChoice: 0, Velocity: fVelocity, Acceleration: fAccel, Deceleration: fDecel, CoordSystem: 0, EndPositionX: 0.0, EndPositionY: 0.0, BufferMode: 1 );4. 运行验证与轨迹监控程序编写完成后需要进行编译、下载、在线调试和轨迹验证。4.1 编译与下载点击 CODESYS 工具栏的“编译”按钮确保无语法错误。将 PLC 置于“运行”模式。如果是仿真环境如 CODESYS Control Win V3直接启动仿真即可。下载程序到 PLC。4.2 在线调试与变量监控在 CODESYS 中登录到 PLC。打开“在线”视图监控关键变量将bEnableAll置为 TRUE。观察fbAxisEnable1.Status,fbAxisEnable2.Status和fbGroupEnable.Status是否依次变为 TRUE。如果fbGroupEnable.Error为 TRUE需检查fbGroupEnable.ErrorID。监控轴组状态stGroupState.IsGroupEnabled应为 TRUE。将bStartPath置为 TRUE一个上升沿。观察fbMoveLinear1.Busy和fbMoveLinear1.Done的状态变化。通过“示波器”或“视图”功能添加MyGroup.ActualPosition.X和MyGroup.ActualPosition.Y进行监控可以看到 X, Y 轴的实际位置曲线。观察运动是否按预期进行直线 - 同步 - 圆弧 - 同步 - 直线。4.3 使用可视化工具观察轨迹CODESYS 提供了强大的可视化工具可以直观看到轴组末端的运动轨迹。在项目中添加一个“可视化”文件.visu。从工具箱中拖入一个“SoftMotion 路径显示”控件。配置该控件的“Group”属性链接到你的轴组对象refMyGroup。在线运行后启动可视化。当程序执行插补运动时该控件会实时绘制出 TCP 点在 XY 平面上的运动轨迹。你应该能看到一个由两条直线和一个半圆组成的“D”形轨迹。4.4 预期结果与验证点功能验证使能顺序正确轴组能成功使能。运动验证触发bStartPath后轴组末端能连续、平滑地走完“直线-圆弧-直线”三段路径最终回到原点中间无明显停顿或跳跃。状态验证各功能块的Busy,Done,CommandAborted等状态信号变化符合逻辑。轨迹验证在可视化工具中观察到的轨迹与程序设定的坐标点吻合。5. 常见问题排查与调试技巧在实际调试中你可能会遇到各种问题。下面是一个常见问题排查表。问题现象可能原因检查与排查步骤解决方案轴组使能失败(fbGroupEnable.Error TRUE)1. 组内物理轴未使能。2. 轴组动态参数配置错误如速度极限为0。3. 轴耦合错误轴顺序不对。1. 检查所有MC_Power功能块的Status输出。2. 检查轴组配置中的最大速度、加速度是否合理。3. 检查轴组配置中“轴分配”的顺序。1. 确保所有物理轴先成功使能。2. 设置合理的轴组动态参数。3. 确认物理轴与轴组维度的映射关系正确。插补指令不执行(Execute触发后Busy不变)1. 轴组未使能。2. 上一个运动指令未完成且BufferMode0。3.Execute信号不是上升沿或持续时间太短。1. 检查fbGroupEnable.Status和stGroupState.IsGroupEnabled。2. 检查上一个运动功能块的Busy状态。3. 使用边沿检测确保Execute是上升沿。1. 确保轴组已使能。2. 对于连续路径使用BufferMode1并配合MC_Sync。3. 使用R_TRIG功能块生成上升沿。运动轨迹不是直线或圆弧1. 坐标值单位不统一。2. 物理轴的正方向定义不一致。3. 圆弧参数圆心、终点、方向计算错误。1. 确认所有坐标起点、终点、圆心使用相同的用户单位。2. 分别单动每个轴确认其正方向移动与坐标系正方向一致。3. 在纸上画出坐标系标出起点、终点、圆心验证参数。1. 统一使用毫米、微米等作为用户单位。2. 在轴配置中调整“正方向”或通过程序取反。3. 仔细计算或通过 CAD 软件获取准确的几何参数。多段运动间有停顿BufferMode未设置为1 (mcBuffered)且未使用MC_Sync或使用不当。检查每段插补指令的BufferMode参数。检查MC_Sync的Execute条件是否由前一段运动的Done触发。对于需要连续运行的路径所有中间段的BufferMode必须设为1并使用MC_Sync衔接。最后一段可设为0。运动过程中报错停止1. 超过软限位。2. 跟随误差过大。3. 驱动器报警。1. 查看轴组或轴的错误代码 (ErrorID)。2. 检查轴配置中的软限位值。3. 检查驱动器状态字和实际位置与目标位置的偏差。1. 适当放宽软限位或检查程序坐标是否超程。2. 调整伺服增益或降低轴组的运动速度/加速度。3. 排查驱动器本身的报警原因。调试技巧分步调试先让轴组走单段直线成功后再加入圆弧最后组合成连续路径。使用 Trace 功能CODESYS 的 Trace跟踪功能可以高速记录位置、速度、误差等曲线是分析动态性能的利器。简化问题如果复杂轨迹出错尝试用极简单的坐标如从 (0,0) 到 (10,0) 的直线测试排除参数计算错误。查看日志CODESYS 运行时和 SoftMotion 组件通常会生成详细的日志信息在消息窗口或日志文件中查找错误描述。6. 最佳实践与扩展方向掌握了基础直线和圆弧插补后以下实践和建议可以帮助你将此技术应用到更复杂的实际项目中。6.1 轴组插补编程最佳实践严格的使能序列管理使用状态机或明确的顺序逻辑来控制“物理轴使能 - 轴组使能 - 运动指令执行”的流程。急停或故障后应有完整的重启序列。参数化与配方管理不要将目标坐标、速度等参数硬编码在程序中。将它们定义为全局变量或结构体甚至存储在外部文件或数据库中便于工艺调整和配方调用。错误处理与恢复每个运动功能块都必须检查其Error和ErrorID输出。发生错误时应能安全停止所有轴使用MC_Stop或MC_Halt功能块并记录错误信息提供明确的复位或恢复路径。使用状态机管理复杂路径对于包含数十甚至上百段插补的复杂轨迹如 CNC G 代码应设计一个状态机来管理当前段、下一段、跳转、循环等逻辑而不是简单罗列功能块。动态参数调整根据工艺要求可能需要在运动过程中动态修改速度倍率 (Override)。可以通过MC_MoveLinear的Velocity输入或专门的MC_SetOverride功能块实现。6.2 从学习环境到生产环境的考量安全与互锁生产程序中必须加入安全逻辑如光栅、急停按钮、门开关等安全信号的硬线或安全 PLC 互锁。运动使能必须与这些安全条件绑定。性能优化对于高动态运动需要优化 PLC 任务周期。插补计算通常在快速任务中执行。确保 PLC 性能足够且 EtherCAT 等现场总线的通讯周期设置合理。诊断与监控除了基本状态生产系统需要监控跟随误差、扭矩、温度等关键参数并设置报警阈值。利用 CODESYS 的 WebVisu 或 HMI 开发监控界面。持久化与备份重要的机器参数如各轴零点偏移、螺距误差补偿值应在断电后能保持。确保相关变量存储在保持型存储区并有备份和恢复机制。版本与文档对运动控制程序进行严格的版本管理并对所有的坐标点、速度参数、特殊逻辑添加清晰的注释。6.3 扩展学习方向三维空间插补本文基于 2D 轴组。CODESYS 同样支持 3D 轴组原理类似但增加了 Z 轴并可能涉及更复杂的空间圆弧螺旋线插补。CNC 功能CODESYS SoftMotion CNC 库支持直接解释执行标准的 G 代码如 G00, G01, G02, G03这对于实现 CNC 机床或激光切割机控制是更高级的解决方案。电子凸轮与同步除了插补轴组还支持电子凸轮Cam和齿轮同步Gearing功能用于实现主轴与从轴间非线性的位置关系在包装、印刷机械中应用广泛。机器人运动学对于六轴机器人等复杂机构CODESYS 提供了机器人运动学库可以进行正逆运动学解算将笛卡尔空间的位置姿态转换为各个关节轴的角度指令。通过本文的直线和圆弧插补实战你已经掌握了 CODESYS 多轴协调运动的基础。关键在于理解轴组作为一个整体进行规划的概念并熟练运用MC_MoveLinear、MC_MoveCircular和MC_Sync这几个核心功能块。在实际项目中从简单的二维图形开始验证逐步增加路径复杂度和工艺逻辑同时将安全、诊断和可维护性贯穿始终是构建稳定可靠运动控制系统的有效路径。