3. 基于示教器的虚拟机器人手动点动调试
虚拟示教器点动调试:从单轴微调到软限位修正
在 ROBOGUIDE 虚拟工作站中,示教器点动(Jog)是验证机器人运动学配置、观察关节行程与奇异点行为的最直接手段。与真实示教器一致,虚拟示教器提供关节坐标系(JOINT)、世界/基坐标系(WORLD/BASE)、工具坐标系(TOOL)和用户坐标系(USER)四种点动模式。本节以六轴虚拟机器人为对象,通过手动点动各轴,观察关节运动范围、奇异点提示,并记录、修正超出软限位的点动操作。
点动前确认虚拟控制器处于 T1 手动模式,示教器使能开关(Deadman)保持按下状态;否则虚拟示教器会拒绝点动指令并提示 "Enable switch released"。
点动模式与坐标系选择
点动模式决定每个方向键对应的运动学解算方式,直接影响关节运动范围与奇异点出现的时机:
- JOINT(关节):每个方向键直接驱动单一关节轴,运动学解算最简单,不会触发奇异点,是检查各轴软限位与机械行程的首选模式。
- WORLD/BASE(世界/基坐标):沿笛卡尔 X/Y/Z 或绕 RX/RY/RZ 点动,需逆解算,接近腕部奇异点时会出现关节速度突变。
- TOOL(工具):沿工具坐标系轴向点动,常用于接近工件,但工具接近腕部奇异位形时同样会触发提示。
- USER(用户):沿用户自定义坐标系点动,需先建立用户坐标系(见后续案例)。
本节调试以 JOINT 模式为主,用于逐轴检查软限位;随后切换到 WORLD 模式,观察奇异点提示的触发条件。
点动调试流程与软限位修正
虚拟示教器点动调试的核心是"逐轴点动 → 观察关节角度 → 判断是否接近软限位 → 修正点动方向或范围"。以下流程图给出从进入点动模式到修正超限操作的完整判断路径:
关键参数与软限位判断
虚拟机器人各轴的软限位由虚拟控制器的运动配置决定,可在示教器的 Motion → Joint Limits 页面查看。以下为典型六轴虚拟机器人的软限位参考值(示例数据,实际以所用机型配置为准):
| 关节轴 | 软限位下限 | 软限位上限 | 点动方向键 | 接近限位提示 |
|---|---|---|---|---|
| J1 | -170° | +170° | ← / → | 角度余量 < 5° 时示教器黄色高亮 |
| J2 | -100° | +100° | ↑ / ↓ | 同上 |
| J3 | -70° | +80° | ↑ / ↓ | 同上 |
| J4 | -190° | +190° | ← / → | 同上 |
| J5 | -120° | +120° | ↑ / ↓ | 同上 |
| J6 | -360° | +360° | ← / → | 同上 |
当点动使某轴角度超出软限位时,虚拟示教器会拒绝继续点动并显示 "Joint limit exceeded" 提示。此时应反向点动退出限位区,或检查程序中的目标点是否超出该轴行程。切勿通过修改软限位参数来"绕过"限位,这会导致虚拟调试结果与真实机器人不一致。
奇异点提示的观察与记录
在 WORLD 或 TOOL 模式下点动时,当机器人接近腕部奇异点(J5 接近 0°)、肩部奇异点或肘部奇异点时,虚拟示教器会显示奇异点警告,同时关节速度可能突然增大。调试时应记录触发奇异点的位形,并在后续路径规划中避开该区域。以下为常见奇异点类型与观察要点:
- 腕部奇异:J5 接近 0°,J4 与 J6 轴线重合,逆解算出现无穷多解,表现为 J4/J6 角度突变。
- 肩部奇异:腕部中心位于 J1 轴线上,J1 角度不确定,表现为 J1 突然旋转。
- 肘部奇异:腕部中心位于 J2–J3 连杆平面内,J3 接近 0°,表现为 J3 速度突变。
点动调试记录表(可直接填写)
以下记录表用于在虚拟示教器点动调试过程中逐轴记录角度、限位余量与奇异点情况,便于后续修正程序目标点:
| 轴 | 起始角度 | 点动方向 | 终止角度 | 限位余量 | 是否触发限位 | 修正措施 |
|---|---|---|---|---|---|---|
| J1 | 0° | → | +165° | 5° | 接近 | 反向点动至 +150° |
| J2 | 0° | ↑ | +95° | 5° | 接近 | 反向点动至 +80° |
| J3 | 0° | ↓ | -65° | 5° | 接近 | 反向点动至 -50° |
| J4 | 0° | → | +185° | 5° | 接近 | 反向点动至 +170° |
| J5 | 0° | ↑ | +115° | 5° | 接近 | 反向点动至 +100° |
| J6 | 0° | → | +355° | 5° | 接近 | 反向点动至 +340° |
修正原则:当某轴点动至距软限位 5° 以内时,应停止继续点动,记录当前角度,并反向点动退出至少 10°,确保后续程序运行时有足够的安全余量。若程序目标点确实需要接近限位,应在虚拟环境中反复点动验证后再下发到真实控制器。
验证与结果判断
完成逐轴点动后,通过以下方式验证调试结果:
- 在 JOINT 模式下重新点动各轴,确认角度显示在软限位范围内,且无 "Joint limit exceeded" 提示。
- 切换到 WORLD 模式,沿 X/Y/Z 方向点动,观察是否出现奇异点警告;若出现,记录位形并调整路径。
- 在示教器 Motion → Joint Limits 页面核对各轴软限位参数,确认与虚拟控制器配置一致。
- 将点动调试记录表中的修正后角度与程序目标点对比,确保程序运行不会触发限位或奇异点。
通过以上步骤,可在虚拟环境中安全地完成机器人各轴的点动调试,提前发现软限位与奇异点问题,避免在真实机器人上发生碰撞或报警。