MoveJ 关节运动
MoveJ 用于点到点关节运动。SCL 入口是 robot.MoveJ。它接收目标 TCP 位姿和速度;TCP 在两点之间不保证走直线。
当前状态
当前现场入口只用于索引 0 的第一组 6 轴 DH 机器人。机器人、机械参数或 J1 到 J6 轴配置不完整时,调用失败。
当前入口
| 项 | 内容 |
|---|---|
| 签名 | int robot.MoveJ(int robot, double X, double Y, double Z, double Rx, double Ry, double Rz, double velocity) |
| 单位 | X/Y/Z 毫米;Rx/Ry/Rz 度;velocity 为工程速度上限 |
返回 0 | 关节空间规划已被接受 |
| 返回非零 | 未配关节轴或运动内核拒绝 |
| 完成查询 | robot.WaitDone(robot):1 完成,0 运动中,-2 不可用 |
| 停止 | robot.Stop(robot) 整组受控停止 |
完整合同见机器人多轴 API。
适用场景
运行前准备
- 在项目中登记机器人索引,并按 J1 到 Jn 的顺序绑定真实关节轴。
- 选择正确的运动学模型并填写机械参数;目标位姿不可达或逆解失败时,运动不会启动。
- 完成工具、基坐标和工件坐标配置,核对软限位、急停、安全门和驱动器状态。
- 先在 3D 仿真中检查 MoveJ 的实际关节路径。
仿真不是安全证明
仿真通过不替代真机碰撞检测、硬件急停和操作员审批。
非阻塞状态机示例
运动调用只提交或轮询命令,不应阻塞 PLC 扫描。robot.MoveJ 返回 0 只表示已接受,到位用 robot.WaitDone。
class JointTransfer
{
int Step = 0;
int Rc = 0;
void Execute()
{
switch (Step)
{
case 0:
Rc = robot.Power(0, true);
if (Rc == 0)
{
Step = 10;
}
break;
case 10:
Rc = robot.SetSpeed(0, 25.0);
if (Rc == 0)
{
Step = 20;
}
break;
case 20:
Rc = robot.MoveJ(0, 450.0, 0.0, 520.0, 180.0, 0.0, 180.0, 100.0);
if (Rc == 0)
{
Step = 30;
}
else
{
robot.Stop(0);
}
break;
case 30:
if (robot.WaitDone(0) == 1)
{
Step = 40;
}
break;
case 40:
// 到位后再执行夹爪或下一段工艺动作。
break;
}
}
}
连续扫描中的调用规则
robot.MoveJ是异步命令;不要用循环等待或阻塞式延时占住扫描周期。- 成功提交后进入独立步骤,用
robot.WaitDone(0)轮询。 - 同一目标执行期间保持参数不变,不要在每个扫描周期抖动目标或速度值。
- 运动异常应调用
robot.Stop(0),并触发项目定义的安全态、日志和报警。
当前不应写入的参数
robot.MoveJ 当前只接收上述八个参数,不提供混合半径、加速度、减速度、加加速度或缓冲模式参数。连续 Zone 和轨迹前瞻仍是 P4 推进。
与其他轨迹的边界
| 目标 | 当前教程入口 | 路径保证 |
|---|---|---|
| 快速到达目标位姿 | robot.MoveJ | 关节空间 PTP,TCP 路径不固定 |
| TCP 直线 | robot.MoveL | 笛卡尔直线 |
| 三点圆弧 | MC_MOVE_CIRCULAR | 经辅助点到终点的圆弧 |
| 样条、NURBS、电子凸轮、轨迹前瞻 | 无现场入口 | P4 推进 |
| CNC G-code | 无现场入口 | P5 预留 |
排查顺序
- 调用返回非零:先核对机器人索引、运动学注入和关节轴登记,不要反复重发命令。
- 目标不可达:检查工作空间、关节限位、工具/工件坐标和目标姿态。
- TCP 绕行或接近工装:这是关节空间轨迹的固有特性,改安全中间点或改用受约束的 MoveL/MoveC。
- 已提交但不结束:读取关节反馈、驱动器状态、报警和运行日志。
- 真机首次运行:使用低速度倍率,在可立即急停的受控条件下逐点验证。