4. 虚拟工作站工具坐标系标定与验证
六点法标定虚拟 TCP 的几何原理
工具坐标系（Tool Frame）的原点即 TCP（Tool Center Point），其姿态由 X/Y/Z 三轴方向确定。ROBOGUIDE 中六点法标定分两步：前三点确定 TCP 位置，后三点确定工具姿态。核心约束是——机器人以不同姿态使工具尖端对准同一空间参考点，此时各姿态下法兰中心到尖端的向量在基坐标系中必须收敛于同一点。
设第 i 个姿态下法兰中心在基坐标系中的位置为 P_i，工具坐标系相对法兰的偏移为 T（待求），则 TCP 位置 P_tcp = P_i + R_i · T，其中 R_i 为第 i 个姿态法兰的旋转矩阵。前三点联立即可解出 T 的三个分量。
ROBOGUIDE 中的标定操作流程
在虚拟示教器上依次完成以下操作。注意：ROBOGUIDE 的虚拟示教器界面与真实示教器一致，但所有运动均在虚拟环境中执行，不会碰撞真实设备。
- 进入
MENU → 6 SETUP → 3 Frames，选择Tool Frame，指定工具号（如 Tool 1）。 - 选择
Six Point标定方法，示教器提示依次记录六个点。 - 前三点：手动点动虚拟机器人，使工具尖端以三种不同姿态对准工作台上同一参考点（可用虚拟尖锥或标记点辅助），每对准一次按
SHIFT + RECORD记录。 - 后三点：保持尖端位置不变，分别绕工具 X、Y、Z 方向改变姿态，各记录一次。
- 按
ENTER完成计算，示教器显示标定结果（TCP 偏移量和姿态角）。
姿态选择技巧：前三点姿态差异越大（建议各轴角度差 ≥ 30°），位置解算越稳定。若三点几乎共线或姿态变化过小，旋转矩阵接近奇异，标定误差会显著放大。
验证标定精度
标定完成后必须验证。方法如下：
- 在虚拟工作台上选取一个固定参考点（如台面角落或专用尖锥），记录其在世界坐标系中的位置。
- 手动点动使工具尖端对准该参考点，记录当前各轴角度。
- 切换工具坐标系（如从 Tool 1 切到 Tool 0），观察工具尖端在虚拟环境中的位置偏移量。
- 若偏移量 ≤ 1 mm（ROBOGUIDE 虚拟环境典型精度），认为标定合格；若偏移明显，需重新标定。
标定误差来源分析
| 误差来源 | 表现 | 改善措施 |
|---|---|---|
| 前三点姿态差异不足 | TCP 位置解算不稳定，重复标定结果跳动大 | 增大姿态角差异，确保三点不共线 |
| 参考点对准偏差 | TCP 位置整体偏移，各姿态下尖端不重合 | 使用虚拟尖锥辅助对准，放大视图确认 |
| 后三点姿态变化过小 | 工具坐标系姿态角误差大，方向不准 | 绕各轴旋转 ≥ 45°，避免小角度微调 |
| 虚拟机器人关节间隙或模型误差 | 标定结果与理论值存在固定偏差 | 检查机器人模型参数，确认 DH 参数正确 |
注意：ROBOGUIDE 虚拟环境中的标定结果仅反映虚拟模型精度，不能直接用于真实机器人。若需迁移到实机，必须重新在真实机器人上执行六点法标定，并考虑真实关节间隙、工具加工误差和安装偏差。
标定结果记录表（示例）
| 项目 | 数值 | 说明 |
|---|---|---|
| 工具号 | Tool 1 | 虚拟工具坐标系编号 |
| TCP X 偏移 | 125.3 mm | 沿法兰 X 方向 |
| TCP Y 偏移 | -8.7 mm | 沿法兰 Y 方向 |
| TCP Z 偏移 | 210.5 mm | 沿法兰 Z 方向 |
| 姿态角 Rx | 0.0° | 绕 X 轴旋转 |
| 姿态角 Ry | 90.0° | 绕 Y 轴旋转 |
| 姿态角 Rz | 0.0° | 绕 Z 轴旋转 |
| 验证偏移量 | 0.6 mm | 切换工具坐标系后尖端偏移 |
上表为教学示例数据，实际标定结果取决于虚拟工作站中工具模型的几何参数和示教操作精度。