跳到主要内容

运动控制教程

本文说明从轴配置到安全试运行的学习顺序,并区分可用、开发中和规划中的能力。完整参数、返回值和限制以 API 参考为准。

当前平台

DarraRT 当前公开产品只有 Windows 硬实时版,没有 Linux 产品或版本。IDE 安装在工程师电脑,现场工控机运行 Service、HMI 与 Windows 硬实时内核;运动命令通过固定的 DarraLink 18821 主通道下发到现场 Service。

离线仿真通过不代表真机安全。真机仍依赖碰撞检测、急停、安全门、STO 和操作员审批。运动控制也不是 SIL / PL 认证安全功能。

1. 先确认能力状态​

状态含义本教程中的使用原则
可用已有执行路径;仍需满足各 API 的前置条件和限制可以配置、监视并受控试运行
开发中执行链或实机验证尚未完成只用于方案评估,不用于生产验收
规划中仅保留产品方向不创建生产依赖,不承诺交付日期

1.1 可用​

  • 标准轴的注册、使能、失能、回零、点动、绝对或相对定位、速度模式、受控停止、复位,以及位置、速度和状态反馈读取。
  • 轴组直线与圆弧轨迹、已配置运动学下的多轴同步。
  • 6R、7R、SCARA、Delta、Gantry、Stewart、五轴、协作单臂/双臂和通用 DH 数值解等运动学。
  • 机器人关节、直线和圆弧运动,以及整组使能、停止、复位、速度倍率、完成状态和位姿反馈。
  • 标准 PID、PI、PD 和带前馈控制。

“可用”不等于任意硬件接线后即可安全运行。每个轴仍需具备有效的轴配置、驱动器状态、命令与反馈映射、单位换算、限位和安全回路。

1.2 开发中​

  • 样条插补、电子凸轮、轨迹前瞻和拐角平滑的完整交付链。
  • PID 自整定与模糊 PID。
  • 部分齿轮、相位、力矩和探针能力的完整执行链。
  • 机器人后置代码生成(RAPID / KRL / TP)。

P4 条目不得用界面存在、类型已声明或页面已生成来替代运行证据。OEM 适配(ABB / KUKA / Fanuc / Yaskawa)以当前 API 页和实机验证为准,不能按“已全部通过”验收。

1.3 规划中​

CNC G-code 编辑器、RS-274D 解析、刀具半径补偿、M98/M99 子程序和宏变量均为 P5 预留。当前运动控制教程不把这些能力包装成可执行方案,也不使用基础插补组合冒充完整 CNC 执行链。CNC 不属于 PLC 逻辑编辑器。

2. 运行路径​

工程师在 IDE 中配置轴并编写 SCL 或 LAD
│
│ DarraLink 18821
▼
现场 Runtime 执行 PLC 与运动命令
│
▼
Windows 实时 I/O 与 EtherCAT 驱动器
├─ 接收目标位置、速度和控制字
└─ 返回实际位置、速度、状态字和报警

程序负责运动流程,现场 Runtime 维护命令和状态,实时 I/O 周期交换驱动器数据。在线状态只以现场反馈为准。不要用 CFC 或 IEC 61499 事件图描述当前运动交付路径。

3. 标准轴入门流程​

3.1 配置与校验​

  1. 在项目中创建标准轴并绑定实际 EtherCAT 从站与轴号。
  2. 核对驱动器工作模式、编码器分辨率、丝杠螺距或旋转单位、减速比和方向。
  3. 配置正负软限位、回零方式、速度、加速度、减速度与跃度上限。
  4. 确认命令侧目标值和反馈侧实际值来自同一标准轴映像,不能用模拟反馈冒充现场反馈。
  5. 在使能前确认急停、安全门、硬限位和驱动器报警均处于可恢复状态。

3.2 第一次受控试运行​

  1. 先读取状态字、实际位置和实际速度,确认站号与反馈方向正确。
  2. 在机械安全区域内使能单轴;使能失败时先处理安全回路或驱动器报警。
  3. 以低速度执行点动,核对正负方向和限位输入。
  4. 按项目配置执行回零,确认回零完成后的位置基准。
  5. 先执行短距离单轴定位,再逐步提高速度和加速度。
  6. 每一步都通过监视、趋势、日志和报警核对命令值、反馈值、状态和跟随误差。

PLC 调试不使用断点或单步。运动异常时应停止 PLC、使输出进入安全态,并根据日志和报警处理根因。

4. 机器人多轴入门流程​

  1. 为每个关节轴完成标准轴注册、反馈映射、限位与零位配置。
  2. 选择对应运动学并填写机械参数;通用机构使用经验证的 DH 参数。
  3. 配置工具中心点、基坐标系和工件坐标系,先在离线仿真中检查可达性、奇异位形与碰撞。
  4. 在低速度倍率下完成整组使能和关节运动,再验证笛卡尔直线与圆弧轨迹。
  5. 读取整组关节反馈和计算位姿,确认反馈不是命令值回显。
  6. 真机运行继续依赖运行时碰撞检测、操作员审批、急停与安全门。

5. API 参考入口​

以下两个分类页是当前运动控制 API 的权威入口。每个分类页继续链接到完整条目;本文不再复制符号清单、参数表或“速查表”。

如 API 页面与教程描述存在差异,以 API 页面当前列出的签名、错误和限制为准。

6. 继续学习​

  • DB 系统 — 用项目数据块管理运动参数与状态。
  • 在线监控 — 查看现场变量和运行状态。
  • 在线趋势 — 观察位置、速度、跟随误差与周期数据。
  • 在线报警 — 处理驱动器、限位与安全相关报警。
  • 性能优化 — 核对扫描周期、资源 Profile 和实时性证据。
  • 功能安全边界 — 运动控制与独立安全回路的职责。