跳到主要内容

机器人多轴

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
  • 输入
  • 必填
  • 约束 必须是编译期常量整数,与 PLCopen AXIS_REF 静态绑定同口径。
机器人实例索引。

返回值​

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
  • 输入
  • 必填
  • 约束 常量整数,operand 静态绑定。
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
  • 输入
  • 必填
  • 约束 编译期常量,0..4095。关节 n 写 dst..dst+n-1,笛卡尔 6 维写 dst+n..dst+n+5。
结果寄存器基址。

返回值​

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
  • 输入
  • 必填
  • 约束 0..150。
速度倍率百分比。

返回值​

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;