单轴运动控制
本页说明当前 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,失败为 NaN | CiA-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_LINEAR | groupId, X, Y, Z, Rx, Ry, Rz, velocity, acceleration | 0 已接受;未配关节轴或 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,也不表示机械已执行该功能。
仿真不是安全证明
单轴命令被接受,只说明软件侧已下发意图。真机仍需急停、安全门、硬限位和操作员确认。
排查顺序
- 使能失败:检查轴登记、CiA-402 状态、急停、安全门、硬限位和驱动器报警。
- 定位不动:检查调用结果、目标单位、速度上限和命令侧是否被急停闩拒绝。
- 相对定位失败:先确认
MC_READ_POS返回真实值,而不是 NaN。 - 反馈恒为零:核对实际位置/速度/状态字映射,不能用命令值回显冒充反馈。
- 高级功能看起来“成功”:对照诚实降级表,不要把返回
0当成凸轮、齿轮或力矩已工作。 - 运动异常:受控停止,进入项目安全态,并查看报警、趋势和运行日志。
API 参考
如果 API 页没有对应条目,就不能凭旧名称推断它已经交付。