机器人多轴
SCL 以 robot.* 命名空间操作多轴协调对象,区别于单轴 MC_*。robot.Arm(id) 取编译期 robotIdx 常量;MoveJ / MoveL / MoveC / Stop 编译为已有 ROBOT_* opcode,运行时经 AxisRuntimeMotionGateway.RobotMov 入队后立即返回,不阻塞扫描周期。
笛卡尔 / 关节规划需要 RuntimeHost 注入 IK 并 SetRobotAxes。未配关节轴返回非零,不伪装完成。仿真过关不等于真机安全。电子凸轮不在本组。
获取机器人句柄
ROBOT.ARM · 可执行
取机器人句柄(robotIdx 常量),供后续 robot.MoveJ / MoveL / MoveC / Stop / SetSpeed / WaitDone / Power / Reset / ReadPos 引用。
签名
arm := robot.Arm(0);
参数
idDINT- 机器人实例索引。
返回值
returnDINT- robotIdx 常量。运行时不构造对象。
行为
- 编译期把 id 压栈,配置期已注册的机器人实例按静态索引引用。
- id 若为变量,编译错误。
- 裸语句
robot.Arm(0);不赋值会诊断错误。
错误与限制
- 变量索引:编译错误。
- 裸语句丢弃句柄:编译错误。
示例
arm := robot.Arm(0);
机器人笛卡尔圆弧运动
ROBOT.MOVEC · 可执行
笛卡尔圆弧。编译 emit ROBOT_MOVC(单一目标,无 via 点)。网关 RobotMov(kind=Circular) 当前无 via,未配关节轴或不支持该路径时诚实降级,不伪装入队成功。
签名
rc := robot.MoveC(arm, x, y, z, rx, ry, rz, vel);
参数
armDINT- robot.Arm 返回的句柄。
XLREAL- 目标 X(mm)。
YLREAL- 目标 Y(mm)。
ZLREAL- 目标 Z(mm)。
RxLREAL- 目标 Rx(度)。
RyLREAL- 目标 Ry(度)。
RzLREAL- 目标 Rz(度)。
VelLREAL- 工程速度上限。
返回值
returnDINT- 立即返回 rc。当前网关无 via 的圆弧路径返回非零诚实降级,不假装已规划。
行为
- 异步非阻塞,不阻塞扫描周期。
- 单一 target,via 点扩展未进本 opcode。
- 不伪造运动已完成。
错误与限制
- 未配 IK / 关节轴,或圆弧路径未接通:非零 rc。
示例
rc := robot.MoveC(arm, 100.0, 0.0, 250.0, 180.0, 0.0, 0.0, 200.0);
机器人关节运动
ROBOT.MOVEJ · 可执行
关节空间 PTP。RobotMov(kind=Joint):IK 得终点关节,各关节同步七段 S 曲线,同时启停,不是笛卡尔直线。
签名
rc := robot.MoveJ(arm, x, y, z, rx, ry, rz, vel);
参数
armDINT- robot.Arm 返回的句柄。
XLREAL- 目标 X(mm)。
YLREAL- 目标 Y(mm)。
ZLREAL- 目标 Z(mm)。
RxLREAL- 目标 Rx(度)。
RyLREAL- 目标 Ry(度)。
RzLREAL- 目标 Rz(度)。
VelLREAL- 工程速度上限,受 SetSpeed 倍率缩放。
返回值
returnDINT- 0 或 Busy 表示规划已接受;未配关节轴或 IK 失败返回非零。
行为
- 异步非阻塞。
- 同目标重复调用幂等,返回当前 Done / Busy。
- 不伪造运动已完成。用
robot.WaitDone轮询。
错误与限制
- IK 失败(奇异 / 不可达):非零 rc。
示例
rc := robot.MoveJ(arm, 400.0, 0.0, 300.0, 180.0, 0.0, 0.0, 50.0);
机器人笛卡尔直线运动
ROBOT.MOVEL · 可执行
笛卡尔直线。RobotMov(kind=Linear) 走与 MC_MOVE_LINEAR 相同的托管直线闭环。
签名
rc := robot.MoveL(arm, x, y, z, rx, ry, rz, vel);
参数
armDINT- robot.Arm 返回的句柄。
XLREAL- 目标 X(mm)。
YLREAL- 目标 Y(mm)。
ZLREAL- 目标 Z(mm)。
RxLREAL- 目标 Rx(度)。
RyLREAL- 目标 Ry(度)。
RzLREAL- 目标 Rz(度)。
VelLREAL- 工程速度上限,受 SetSpeed 倍率缩放。
返回值
returnDINT- 规划已接受返回 Busy/0;未配关节轴或 IK 失败返回非零。
行为
- 异步非阻塞。
- 配了转接半径时新段从仍在前移的位姿接续,不把速度跳到 0。
- 不伪造运动已完成。
错误与限制
- 未注入 IK 或未配关节轴:非零 rc。
示例
rc := robot.MoveL(arm, 350.0, 50.0, 280.0, 180.0, 0.0, 0.0, 80.0);
机器人整组伺服使能
ROBOT.POWER · 可执行
整组关节轴使能或失能。对 _robotAxes[robotIdx] 循环 GroupEnable / GroupDisable,写 CiA-402 控制字。
签名
rc := robot.Power(arm, TRUE);
参数
armDINT- robot.Arm 返回的句柄。
EnableBOOL- TRUE=使能,FALSE=失能。
返回值
returnDINT- 0 表示整组命令侧已设置;-2 未配关节轴。
行为
- 作用在整组关节轴,不归一成单轴
MC_POWER。 - 周期层真下发从站。命令侧成功不等于从站已 Operation Enabled。
robot.Enable与Power同口径。
错误与限制
- 未配关节轴:-2。
示例
rc := robot.Power(arm, TRUE);
读机器人整组位姿
ROBOT.READPOS · 可执行
读整组关节反馈(TxPDO 真回填)并 FK 转笛卡尔位姿,写入结果寄存器。
签名
rc := robot.ReadPos(arm, dst);
参数
armDINT- robot.Arm 返回的句柄。
DstDINT- 结果寄存器基址。
返回值
returnDINT- 0 表示已写入寄存器;-2 未配关节轴。
行为
- 读反馈侧
ActualPosition,不用命令侧冒充。 - FK 失败不伪造笛卡尔零位。
错误与限制
- 未配关节轴:-2。
示例
rc := robot.ReadPos(arm, 100);
机器人整组故障复位
ROBOT.RESET · 可执行
整组关节轴写 CiA-402 FaultReset(bit7)并解除运动内核急停闩。
签名
rc := robot.Reset(arm);
参数
armDINT- robot.Arm 返回的句柄。
返回值
returnDINT- 0 表示整组复位命令已下发;-2 未配关节轴。
行为
- 整组从 Fault / EStop 恢复到可接受新运动。
- 命令侧成功不等于从站已退出 Fault。
- 不伪造整组复位成功。
错误与限制
- 未配关节轴:-2。
示例
rc := robot.Reset(arm);
设定机器人速度倍率
ROBOT.SETSPEED · 可执行
记录 per-robot 速度倍率。后续 MoveJ / MoveL 把 vel 乘 percent/100 再进 S 曲线。
签名
rc := robot.SetSpeed(arm, 50.0);
参数
armDINT- robot.Arm 返回的句柄。
PercentLREAL- 速度倍率百分比。
返回值
returnDINT- 0 表示倍率已记录。未配关节轴也允许记录,供将来真运动生效。
行为
- 只影响之后新启动的运动,不改正在跑的轨迹。
SetSpeedOverride与SetSpeed同口径。
错误与限制
- 未声明额外错误码。
示例
rc := robot.SetSpeed(arm, 50.0);
停止机器人运动队列
ROBOT.STOP · 可执行
受控停止。RobotMov(kind=Stop) → GroupStop。安全指令同步派发,不是 fire-and-forget。
签名
rc := robot.Stop(arm);
参数
armDINT- robot.Arm 返回的句柄。
返回值
returnDINT- 0 表示停止命令已下发;未配关节轴返回非零。
行为
- 命令侧冻结当前,不冲到终点。
- 不伪造停止已完成。用
WaitDone看是否静止。
错误与限制
- 未配关节轴:非零 rc。
示例
rc := robot.Stop(arm);
等待机器人运动完成
ROBOT.WAITDONE · 可执行
查询 per-robot Done。单扫描立即返回,不阻塞。不要用阻塞 Wait。
签名
done := robot.WaitDone(arm);
参数
armDINT- robot.Arm 返回的句柄。
返回值
returnDINT- 1=已完成或无在跑运动;0=运动中;-2=默认网关无此方法。
行为
- 读
_activeCartesian/_activeJointPtp的 Done,与 RobotMov 幂等轮询同源。 - 裸语句不取返回值会诊断提示。
错误与限制
- 默认网关无
RobotMotionDone:-2。
示例
IF robot.WaitDone(arm) = 1 THEN
rc := robot.MoveL(arm, 350.0, 50.0, 280.0, 180.0, 0.0, 0.0, 80.0);
END_IF;