跳到主要内容

单轴运动控制

本页说明当前 SCL 单轴入口的使用顺序。完整签名、参数、返回值和限制见单轴运动 API。

当前平台

DarraRT 当前公开产品只有 Windows 硬实时版。运动状态必须以真实轴反馈为准。

已接通的基础入口​

用途当前 SCL 名称返回值关键限制
使能/失能MC_POWER(axis, enable)0 命令侧已设置轴必须已登记
回零MC_HOME(axis)0 回零序列已接受使用项目配置的回零序列
绝对定位MC_MOVE_ABS(axis, position, velocity)0 轨迹已接受七段 S 曲线推进目标位置
相对定位MC_MOVE_REL(axis, distance, velocity)0 轨迹已接受必须先有真实 MC_READ_POS
速度模式MC_MOVE_VEL(axis, velocity)0 速度模式已建立连续运动,需独立停止
点动MC_JOG(axis, direction, velocity)0 点动已接受direction >= 0 正向,< 0 反向
受控停止MC_STOP(axis)0 停止已下发MC_HALT 映射同一停止语义
故障复位MC_RESET(axis)0 复位命令已下发仍需确认驱动器与安全回路
读位置MC_READ_POS(axis)LREAL,失败为 NaN读反馈侧,不用命令值冒充
读速度MC_READ_VEL(axis)LREAL,失败为 NaN同上
读状态字MC_READ_STS(axis)LREAL,失败为 NaNCiA-402 0x6041
设置软件位置MC_SET_POS(axis, position)0 命令侧已写入不产生运动

当前入口返回数值结果,没有可持续读取的 .Execute、.Busy、.Done 或 .ErrorID 字段。定位命令只提交一次,再用真实反馈判断到位。

单轴定位状态机​

class AxisPositioning
{
int Step = 0;
int Rc = 0;
double ActualPos = 0.0;

void Execute()
{
switch (Step)
{
case 0:
Rc = MC_POWER(1, true);
if (Rc == 0)
Step = 10;
break;

case 10:
Rc = MC_HOME(1);
if (Rc == 0)
Step = 15;
break;

case 15:
ActualPos = MC_READ_POS(1);
if (ActualPos >= -0.1 && ActualPos <= 0.1)
Step = 20;
break;

case 20:
Rc = MC_MOVE_ABS(1, 100.0, 25.0);
if (Rc == 0)
Step = 30;
break;

case 30:
ActualPos = MC_READ_POS(1);
// 无效数值与任何数值比较都为 false,因此不会误判到位。
if (ActualPos >= 99.9 && ActualPos <= 100.1)
Step = 40;
break;

case 40:
// 到位后进入下一道工艺步骤;只有停止条件触发时才调用 MC_STOP。
break;
}
}
}

示例中的轴号、单位、容差、速度和回零方式必须按实际轴配置确定。Rc == 0 表示命令已接受,不等于机械已经到位。

轴组直线与圆弧​

当前轴组 0 可使用:

入口签名要点返回值
MC_MOVE_LINEARgroupId, X, Y, Z, Rx, Ry, Rz, velocity, acceleration0 已接受;未配关节轴或 IK 失败返回非零
MC_MOVE_CIRCULAR途经点 6 个数 + 终点 6 个数 + 速度 + 加速度0 已接受;未配关节轴或不支持 IK 返回非零

第一组 6 轴机器人也可使用 robot.MoveJ 和 robot.MoveL。详细说明见:

名称存在但诚实降级(不要写入生产)​

下列 SCL 名称可以出现在程序里,但当前无可用后端。返回值是降级哨兵,不表示功能已接通:

名称当前行为生产含义
MC_CAM_TABLE / MC_CAM_OUT无凸轮方法,返回 -2 或 0电子凸轮为 P4 推进
MC_GEAR_IN / MC_GEAR_OUT无齿轮方法,返回 -2 或 0电子齿轮为 P4 推进
MC_PHASING_ABS / MC_PHASING_REL无后端,返回 0相位控制未交付
MC_TORQUE_CONTROL无力矩方法,返回 0不伪装力矩模式
MC_TOUCH_PROBE无硬件触发面,返回 NaN探针未交付
MC_ABORT_TRIGGER无探针后端,返回 0同上
MC_DIGITAL_CAM_SWITCH无位置数据面,返回 0不伪造开关状态
MC_MOVE_ADD退化为普通定位不是叠加运动

样条和 NURBS 没有当前 SCL 入口,见样条运动。轨迹前瞻与拐角平滑为 P4 推进。CNC G-code 为 P5 预留。

返回值使用原则​

  • 命令类入口:0 表示已接受或动作仍在进行;完成语义以对应 API 为准。
  • 位置、速度或状态读取失败时返回 NaN,程序不能把它替换为零。
  • 相对运动前必须先确认真实位置反馈有效。
  • MC_HALT 当前与 MC_STOP 使用相同停止语义,不表示可恢复暂停。
  • 诚实降级入口即使返回 0,也不表示机械已执行该功能。
仿真不是安全证明

单轴命令被接受,只说明软件侧已下发意图。真机仍需急停、安全门、硬限位和操作员确认。

排查顺序​

  1. 使能失败:检查轴登记、CiA-402 状态、急停、安全门、硬限位和驱动器报警。
  2. 定位不动:检查调用结果、目标单位、速度上限和命令侧是否被急停闩拒绝。
  3. 相对定位失败:先确认 MC_READ_POS 返回真实值,而不是 NaN。
  4. 反馈恒为零:核对实际位置/速度/状态字映射,不能用命令值回显冒充反馈。
  5. 高级功能看起来“成功”:对照诚实降级表,不要把返回 0 当成凸轮、齿轮或力矩已工作。
  6. 运动异常:受控停止,进入项目安全态,并查看报警、趋势和运行日志。

API 参考​

如果 API 页没有对应条目,就不能凭旧名称推断它已经交付。

相关文档​