跳到主要内容

MoveL 直线运动

MoveL 让 TCP 的位置沿起点到终点直线变化,姿态在起终点之间插值。当前现场机器人入口是 robot.MoveL。

当前状态

当前入口只用于索引 0 的第一组 6 轴 DH 机器人。机械参数、J1 到 J6 轴或真实反馈不完整时,调用失败。

当前入口​

项机器人入口轴组入口
名称robot.MoveLMC_MOVE_LINEAR
签名robot, X, Y, Z, Rx, Ry, Rz, velocitygroupId, X, Y, Z, Rx, Ry, Rz, velocity, acceleration
单位位置毫米,姿态度同左,另加加速度
返回 0笛卡尔直线规划已接受同左
返回非零未配关节轴或 IK 失败同左
完成查询robot.WaitDone(robot)现场轴组 0 可用同一完成查询

完整合同见机器人多轴 API 和单轴运动 API。

什么时候使用 MoveL​

  • 接近或离开工件、插装、焊接直线段、涂胶直线段。
  • TCP 中间路径必须受控,不能接受 MoveJ 的关节空间绕行。
  • 只关心快速到达终点时优先 MoveJ;需要经过辅助点的圆弧时使用 MoveC。

机器人入口示例​

下面的 SCL 状态机先用 MoveJ 到达安全接近位,再用 MoveL 直线下降。命令异步执行,使用 robot.WaitDone 轮询,不在 PLC 扫描中阻塞等待。

class LinearApproach
{
int Step = 0;
int Rc = 0;

void Execute()
{
switch (Step)
{
case 0:
Rc = robot.MoveJ(0, 420.0, 0.0, 520.0, 180.0, 0.0, 180.0, 100.0);
if (Rc == 0)
{
Step = 10;
}
break;

case 10:
if (robot.WaitDone(0) == 1)
{
Step = 20;
}
break;

case 20:
Rc = robot.MoveL(0, 420.0, 0.0, 420.0, 180.0, 0.0, 180.0, 30.0);
if (Rc == 0)
{
Step = 30;
}
else
{
robot.Stop(0);
}
break;

case 30:
if (robot.WaitDone(0) == 1)
{
Step = 40;
}
break;

case 40:
// 确认到位后,再通过项目 IO 映射执行夹爪动作。
break;
}
}
}

轴组入口​

需要显式轴组和加速度时,使用九参数形式:

Rc = MC_MOVE_LINEAR(
0,
420.0, 0.0, 420.0, 180.0, 0.0, 180.0,
30.0, 200.0
);

参数顺序是 groupId, X, Y, Z, Rx, Ry, Rz, velocity, acceleration。当前现场只使用轴组 0 的第一组 6 轴机器人。Rc == 0 表示轨迹已接受。

当前轨迹语义​

  • 位置沿笛卡尔直线变化,姿态在起点和终点之间插值。
  • robot.MoveL 只公开目标位姿和速度,不提供混合半径、工具号、工件坐标、距离触发或力监控参数。
  • MC_MOVE_LINEAR 增加轴组和加速度参数,返回值仍需按当前 API 说明检查。

多段路径与前瞻边界​

当前应按“提交一段、确认完成、再提交下一段”的状态机编排。多段前瞻、连续拐角速度规划和无停顿混合仍是 P4 推进。

需要连续焊接或涂胶时:

  1. 在离线仿真中验证每段可达性、奇异点和姿态变化。
  2. 核对当前公开参数和限制。
  3. 如果工艺要求拐角恒速且不能停顿,当前能力不能满足,不能用延时或提前切换 IO 冒充轨迹前瞻。

IO 与工艺动作​

工艺 IO 应在真实到位后切换。当前运动调用不提供距离触发或力监控参数;夹爪、焊机和力传感器应通过项目 IO、独立状态机、报警和安全条件处理。

仿真不是安全证明

MoveL 只保证 TCP 几何路径,不自动保证整机无碰撞。离线预览通过后,真机仍需低速度倍率、硬件急停和操作员确认。

排查顺序​

  1. 返回非零:检查轴组、运动学和关节轴登记,不要把失败当作已接收。
  2. 中途不可达或姿态跳变:检查整条直线上的逆解、关节限位和奇异位形,而不只检查终点。
  3. 反馈不变化:核对标准轴实际位置、实际速度和状态字来自真实驱动器反馈。
  4. 多段之间停顿:当前按段完成后再启动下一段;完整前瞻仍是 P4。
  5. 工艺动作时序不对:把 IO 触发放入独立状态机,并以真实位姿作为条件。

安全检查​

  • 初次运行使用低速度倍率,保持急停和安全门有效。
  • PLC 调试使用监视、趋势、日志和报警,不使用断点或单步。
  • CNC 直线插补(G01)的独立 G-code 执行链是 P5 预留,不能用本页 MoveL 冒充完整 CNC。

相关文档​