跳到主要内容

运动控制

运动控制用于在项目配置完成后编排单轴和机器人动作。首次建项目时先完成轴登记、机器人参数、坐标系和安全条件,再编写 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..1500 已记录;只影响后续新运动
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 名称即使能编译,当前也是诚实降级,见 单轴运动控制。

完整合同:

推荐流程​

  1. 添加机器人,选择与实物一致的运动学和机械参数。
  2. 按 J1 到 Jn 绑定关节轴,确认实际位置、速度和状态反馈有效。
  3. 标定工具坐标系和工件坐标系。
  4. 以低速点动记录 Home、接近点、工作点和撤回点。
  5. 用 MoveJ 处理安全空行程,用 MoveL 或三点圆弧处理受约束路径。
  6. 在 3D 视口检查可达性、奇异位形和几何碰撞。
  7. 真机首次运行时保持安全回路有效,并从低速度倍率开始逐段确认。
仿真不是安全证明

离线仿真通过不代表真机安全。真机仍需经过运行时安全门、硬件急停、现场风险评估和操作员确认。

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.MoveJTCP 中间路径不受几何约束
TCP 直线接近或撤回robot.MoveL整条直线都必须可达
轴组直线MC_MOVE_LINEAR需轴组、运动学和有序关节轴
三点圆弧MC_MOVE_CIRCULAR起点、辅助点和终点不能共线
单轴定位MC_MOVE_ABS / MC_MOVE_REL相对定位要求真实当前位置反馈
单轴点动MC_JOG必须有独立停止条件
自由曲线 / G-code无当前现场入口样条为 P4;CNC 为 P5 预留

继续阅读​