关键点规划
关键点规划用于在示教前确定机器人应经过哪些位置。取放、焊接、装配和上下料程序都应先规划安全层级,再记录点位。
四类点位
| 类型 | 作用 | 建议 |
|---|---|---|
| Home | 程序起点、维护位或稳定姿态 | 远离关节限位、奇异位形和工装 |
| 安全过渡点 | 在不同工作区之间绕开障碍 | 使用 MoveJ,但必须检查完整关节路径 |
| 接近点 | 工作点前的安全逼近位 | 与工作点保持相同或相近姿态 |
| 工作点 | 取料、放料、焊接或装配位置 | 使用正确的工具和工件坐标系 |
没有适用于所有机器人的固定 Home 关节角。Home 必须根据具体机械结构、安装方向、负载和工装验证,不能照抄通用角度。
分层进入和退出
推荐顺序是:
- Home 到安全过渡点:MoveJ。
- 安全过渡点到接近点:MoveJ。
- 接近点到工作点:MoveL。
- 工作点到撤回点:MoveL。
- 撤回点到安全过渡点:MoveJ。
不要从远处直接 MoveJ 到工作点。MoveJ 只保证终点位姿,TCP 和连杆的中间路径可能接近工装。
对应现场入口:
| 步骤 | 入口 | 完成条件 |
|---|---|---|
| 空行程 | robot.MoveJ(0, X, Y, Z, Rx, Ry, Rz, velocity) | robot.WaitDone(0) == 1 |
| 直线接近 / 撤回 | robot.MoveL(...) | 同上 |
| 需要圆弧 | MC_MOVE_CIRCULAR(...) | 同上 |
| 禁止运动 | robot.Stop(0) | 命令已下发不等于已静止,还需看反馈 |
姿态按度传入。点位库若以弧度保存,生成调用前必须换算。
当前 SCL 示例
下面示例使用数值位姿和当前八参数机器人入口。完整工艺应再加入真实到位、夹爪反馈、超时、报警和安全条件。
class SafeApproach
{
int Step = 0;
int Result = 0;
bool WorkAllowed = true;
string Phase = "准备";
void Execute()
{
if (!WorkAllowed)
{
robot.Stop(0);
Phase = "禁止运动";
return;
}
switch (Step)
{
case 0:
Result = robot.MoveJ(0, 450.0, 0.0, 560.0, 180.0, 0.0, 180.0, 100.0);
if (Result == 0)
{
Step = 10;
}
break;
case 10:
if (robot.WaitDone(0) == 1)
{
Step = 20;
}
break;
case 20:
Result = robot.MoveL(0, 450.0, 0.0, 420.0, 180.0, 0.0, 180.0, 30.0);
if (Result == 0)
{
Phase = "直线接近";
Step = 30;
}
break;
case 30:
if (robot.WaitDone(0) == 1)
{
Phase = "到达工作点";
Step = 40;
}
break;
}
}
}
规划检查
- 关节限位:每个点和相邻点之间的关节路径都应保留裕量。
- 奇异位形:MoveL 和圆弧的中间采样点也要检查,不能只看终点。
- 工具长度:换工具后重新核对全部接近点和撤回点。
- 工件坐标系:工作点应随工件坐标系移动,安全过渡点通常更适合世界或基坐标参考。
- 工艺方向:焊枪、胶嘴和夹爪的姿态必须沿工艺要求验证。
- 安全距离:距离由现场风险评估确定,文档不提供固定通用值。
当前能力边界
路径节点可保存速度和混合半径,但连续 Zone、多段前瞻、自动避障和最短路径优化仍是 P4 推进。当前生产程序应按状态机逐段提交并确认完成。
视觉动态目标必须先经过范围、姿态、可达性和安全条件检查,不能把相机结果直接下发为运动目标。
CNC 刀路、G-code 子程序不是本页的点位层级,属于 P5 预留。
仿真不是安全证明
关键点在离线视图中可达,不代表真机安全。真机仍需外部安全回路、硬件急停和操作员确认。