运动控制
运动控制用于在项目配置完成后编排单轴和机器人动作。首次建项目时先完成轴登记、机器人参数、坐标系和安全条件,再编写 SCL 或 LAD。完整签名、参数和限制以 API 页为准。
当前平台
DarraRT 当前公开产品只有 Windows 硬实时版。IDE 装在工程师电脑,现场工控机运行 Service 与硬实时内核;运动命令经 DarraLink 18821 下发。
当前能力
| 能力 | 当前状态 | 说明 |
|---|---|---|
| 单轴使能、回零、定位、速度、点动、停止、复位和反馈读取 | 已提供 | 轴必须已登记;反馈来自真实映像,不可用时返回 NaN |
第一组 6 轴 DH 机器人 robot.MoveJ / robot.MoveL | 已提供 | 现场机器人索引为 0,关节轴按 J1 到 J6 配置 |
轴组直线 MC_MOVE_LINEAR、三点圆弧 MC_MOVE_CIRCULAR | 已提供 | 当前现场轴组为 0;圆弧必须有辅助点 |
| 示教点、路径节点、点动和 3D 预览 | 已提供 | 用于编程和离线检查 |
| 6R / 7R / SCARA / Delta / 龙门 / Stewart / 五轴 / 协作 / 高冗余 / 通用 DH 求解器 | 已落地 | 见 运动学;求解可用不等于该构型已接入现场 SCL |
| 多机器人场景 | 提供离线预览 | 当前不承诺多机器人在线执行或同步组 |
| 数字孪生 | 以只读监视为主 | 虚拟模型不能绕过安全门驱动真机 |
| 样条、电子凸轮、电子齿轮、轨迹前瞻、连续拐角恒速 | P4 推进 | 不应写入生产程序 |
| 真机零力拖动、预测碰撞和自动绕障 | 规划中 | 界面或离线算法不代表现场可用 |
| CNC G-code 编辑器 / RS-274D / 刀补 / 子程序 / 宏变量 | P5 预留 | 未交付,不能作为运动编程入口 |
当前 SCL 入口
现场程序只使用下表中的入口。参数单位:位置毫米,姿态度,速度为工程上限。
机器人多轴
| 入口 | 参数 | 返回值 |
|---|---|---|
robot.Arm(id) | 编译期常量索引 | 返回该索引,供后续调用引用 |
robot.Power(robot, enable) | 索引、使能 | 0 成功;-2 未配关节轴 |
robot.Reset(robot) | 索引 | 0 成功;-2 未配关节轴 |
robot.SetSpeed(robot, percent) | 索引、倍率 0..150 | 0 已记录;只影响后续新运动 |
robot.MoveJ(robot, X, Y, Z, Rx, Ry, Rz, velocity) | 目标 TCP、速度 | 0 关节 PTP 已接受;非零拒绝 |
robot.MoveL(robot, X, Y, Z, Rx, Ry, Rz, velocity) | 目标 TCP、速度 | 0 直线已接受;非零拒绝 |
robot.WaitDone(robot) | 索引 | 1 完成或无在跑运动;0 运动中;-2 不可用 |
robot.Stop(robot) | 索引 | 0 停止已下发 |
robot.ReadPos(robot, register) | 索引、常量寄存器基址 | 0 成功;写入关节反馈和 FK 位姿 |
robot.MoveC 只有单目标形式,不能表达辅助点,不作为生产圆弧入口。圆弧使用 MC_MOVE_CIRCULAR。
单轴与轴组
| 入口 | 用途 | 关键限制 |
|---|---|---|
MC_POWER / MC_HOME | 使能、回零 | 轴必须已登记 |
MC_MOVE_ABS / MC_MOVE_REL | 绝对 / 相对定位 | 相对定位必须先有真实 MC_READ_POS |
MC_MOVE_VEL / MC_JOG | 速度模式、点动 | 连续运动,需独立 MC_STOP |
MC_STOP | 受控停止 | MC_HALT 映射同一停止语义,不是可恢复暂停 |
MC_RESET / MC_SET_POS | 故障复位、软位置 | 复位不替代安全确认;设位置不产生运动 |
MC_READ_POS / MC_READ_VEL / MC_READ_STS | 读反馈 | 不可用返回 NaN,不伪造零 |
MC_MOVE_LINEAR | 轴组直线 | groupId, X, Y, Z, Rx, Ry, Rz, velocity, acceleration |
MC_MOVE_CIRCULAR | 三点圆弧 | 途经点 + 终点共 12 个数,再加速度和加速度 |
凸轮、齿轮、相位、力矩、探针等 SCL 名称即使能编译,当前也是诚实降级,见 单轴运动控制。
完整合同:
推荐流程
- 添加机器人,选择与实物一致的运动学和机械参数。
- 按 J1 到 Jn 绑定关节轴,确认实际位置、速度和状态反馈有效。
- 标定工具坐标系和工件坐标系。
- 以低速点动记录 Home、接近点、工作点和撤回点。
- 用 MoveJ 处理安全空行程,用 MoveL 或三点圆弧处理受约束路径。
- 在 3D 视口检查可达性、奇异位形和几何碰撞。
- 真机首次运行时保持安全回路有效,并从低速度倍率开始逐段确认。
仿真不是安全证明
离线仿真通过不代表真机安全。真机仍需经过运行时安全门、硬件急停、现场风险评估和操作员确认。
SCL 入门示例
运动调用非阻塞。提交后用完成状态进入下一步,不能在 PLC 扫描中循环等待。下面使用机器人索引 0。
class PickApproach
{
int Step = 0;
int Result = 0;
bool GripClosed = false;
string StateText = "待机";
void Execute()
{
switch (Step)
{
case 0:
Result = robot.Power(0, true);
if (Result == 0)
{
StateText = "已使能";
Step = 10;
}
break;
case 10:
Result = robot.SetSpeed(0, 25.0);
if (Result == 0)
{
Step = 20;
}
break;
case 20:
Result = robot.MoveJ(0, 450.0, 0.0, 520.0, 180.0, 0.0, 180.0, 100.0);
if (Result == 0)
{
Step = 30;
}
break;
case 30:
if (robot.WaitDone(0) == 1)
{
Step = 40;
}
break;
case 40:
Result = robot.MoveL(0, 450.0, 0.0, 420.0, 180.0, 0.0, 180.0, 30.0);
if (Result == 0)
{
Step = 50;
}
break;
case 50:
if (robot.WaitDone(0) == 1)
{
GripClosed = true;
StateText = "到达取料位";
Step = 60;
}
break;
}
}
}
Result == 0 只表示命令已被接受,不等于机械到位。到位必须用 robot.WaitDone 或真实反馈判断。项目中的单位、限位和速度上限以机器人配置为准。
选用哪种运动
| 目标 | 入口 | 注意事项 |
|---|---|---|
| 快速移动到目标位姿 | robot.MoveJ | TCP 中间路径不受几何约束 |
| TCP 直线接近或撤回 | robot.MoveL | 整条直线都必须可达 |
| 轴组直线 | MC_MOVE_LINEAR | 需轴组、运动学和有序关节轴 |
| 三点圆弧 | MC_MOVE_CIRCULAR | 起点、辅助点和终点不能共线 |
| 单轴定位 | MC_MOVE_ABS / MC_MOVE_REL | 相对定位要求真实当前位置反馈 |
| 单轴点动 | MC_JOG | 必须有独立停止条件 |
| 自由曲线 / G-code | 无当前现场入口 | 样条为 P4;CNC 为 P5 预留 |