MoveL 直线运动
MoveL 让 TCP 的位置沿起点到终点直线变化,姿态在起终点之间插值。当前现场机器人入口是 robot.MoveL。
当前状态
当前入口只用于索引 0 的第一组 6 轴 DH 机器人。机械参数、J1 到 J6 轴或真实反馈不完整时,调用失败。
当前入口
| 项 | 机器人入口 | 轴组入口 |
|---|---|---|
| 名称 | robot.MoveL | MC_MOVE_LINEAR |
| 签名 | robot, X, Y, Z, Rx, Ry, Rz, velocity | groupId, X, Y, Z, Rx, Ry, Rz, velocity, acceleration |
| 单位 | 位置毫米,姿态度 | 同左,另加加速度 |
返回 0 | 笛卡尔直线规划已接受 | 同左 |
| 返回非零 | 未配关节轴或 IK 失败 | 同左 |
| 完成查询 | robot.WaitDone(robot) | 现场轴组 0 可用同一完成查询 |
什么时候使用 MoveL
机器人入口示例
下面的 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 推进。
需要连续焊接或涂胶时:
- 在离线仿真中验证每段可达性、奇异点和姿态变化。
- 核对当前公开参数和限制。
- 如果工艺要求拐角恒速且不能停顿,当前能力不能满足,不能用延时或提前切换 IO 冒充轨迹前瞻。
IO 与工艺动作
工艺 IO 应在真实到位后切换。当前运动调用不提供距离触发或力监控参数;夹爪、焊机和力传感器应通过项目 IO、独立状态机、报警和安全条件处理。
仿真不是安全证明
MoveL 只保证 TCP 几何路径,不自动保证整机无碰撞。离线预览通过后,真机仍需低速度倍率、硬件急停和操作员确认。
排查顺序
- 返回非零:检查轴组、运动学和关节轴登记,不要把失败当作已接收。
- 中途不可达或姿态跳变:检查整条直线上的逆解、关节限位和奇异位形,而不只检查终点。
- 反馈不变化:核对标准轴实际位置、实际速度和状态字来自真实驱动器反馈。
- 多段之间停顿:当前按段完成后再启动下一段;完整前瞻仍是 P4。
- 工艺动作时序不对:把 IO 触发放入独立状态机,并以真实位姿作为条件。
安全检查
- 初次运行使用低速度倍率,保持急停和安全门有效。
- PLC 调试使用监视、趋势、日志和报警,不使用断点或单步。
- CNC 直线插补(G01)的独立 G-code 执行链是 P5 预留,不能用本页 MoveL 冒充完整 CNC。