工具坐标系Z方向的单点标定

工具坐标系Z方向的单点标定

一、什么是单点标定

单点标定是工业机器人标定中最基础的操作之一。它的核心目的，是让机器人知道"工具尖端在哪里"——也就是确定工具坐标系相对于法兰盘坐标系的位置偏移。

Z方向单点标定，专门解决工具沿自身Z轴方向的长度问题。比如焊枪、喷枪、打磨头等工具，它们的有效工作点通常就在工具的中心轴延长线上，只需标定这一个维度即可。

二、什么情况下用单点标定

如果工具尖端明显偏离中心轴（如斜角焊枪），则需要三点标定或六点标定，本文不涉及。

三、标定前的准备工作

1. 硬件检查

确认 机器人处于自动或手动模式，急停未触发。

确认 工具已牢固安装，无松动。标定过程中工具位置若有变动，全部数据作废。

确认 已准备标定针或标定点。常见方案：

• 固定式标定针：安装在机器人工作区内的某处，针尖位置固定
• 移动式标定针：手持或夹具固定，灵活但需保证标定期间不动

确认 标定针针尖与工具尖端材质允许接触，且接触时不易变形或损坏。

2. 软件准备

记录 当前使用的工具号。多数机器人支持多个工具坐标系（如 TOOL_DATA[1] 到 TOOL_DATA[16]），避免覆盖其他在用数据。

备份 原有工具数据。若标定失败，可快速恢复。

清空 或 初始化 目标工具号的数据，防止旧数据干扰。

四、标定原理

单点标定的数学本质，是求解一个平移向量。

设：

• 法兰盘坐标系为 $\{F\}$
• 工具坐标系为 $\{T\}$
• 工具坐标系原点（即工具尖端）在法兰盘坐标系中的位置为 $\mathbf{p}_{FT} = [x, y, z]^T$

单点标定的假设是：工具尖端位于法兰盘Z轴的延长线上，即 $x = 0$, $y = 0$。只需确定 $z$ 值。

实际操作中，机器人以两种不同姿态，使工具尖端接触同一个空间点（标定针尖）。由于工具尖端在空间中的实际位置不变，可以建立方程求解。

设第一次姿态下，法兰盘位姿为 $\mathbf{T}_1$，工具尖端在基坐标系中的位置为：

$$\mathbf{p}_1 = \mathbf{T}_1 \cdot \mathbf{p}_{FT}$$

第二次姿态下，法兰盘位姿为 $\mathbf{T}_2$，工具尖端位置为：

$$\mathbf{p}_2 = \mathbf{T}_2 \cdot \mathbf{p}_{FT}$$

由于尖端接触同一点，$\mathbf{p}_1 = \mathbf{p}_2$，即：

$$\mathbf{T}_1 \cdot \mathbf{p}_{FT} = \mathbf{T}_2 \cdot \mathbf{p}_{FT}$$

展开后，利用旋转矩阵的正交性，可解出 $\mathbf{p}_{FT}$。在Z向单点简化模型下，最终计算公式为：

$$z = \frac{\Delta \mathbf{p}_{base} \cdot (\mathbf{R}_1 \mathbf{e}_z - \mathbf{R}_2 \mathbf{e}_z)}{|\mathbf{R}_1 \mathbf{e}_z - \mathbf{R}_2 \mathbf{e}_z|^2}$$

其中 $\mathbf{R}_1$, $\mathbf{R}_2$ 为两次姿态的旋转矩阵，$\mathbf{e}_z = [0, 0, 1]^T$ 为Z向单位向量，$\Delta \mathbf{p}_{base}$ 为两次法兰盘位置之差。

实际机器人系统内部自动完成上述计算，用户只需按流程操作。

五、具体操作步骤（以主流品牌为例）

以下流程覆盖KUKA、ABB、FANUC、YASKAWA等主流品牌的通用逻辑，具体界面名称可能略有差异。

阶段一：进入标定模式

打开 机器人示教器。

切换 到手动模式（T1或手动低速）。

进入 程序/设置菜单，找到"工具标定"、"TCP标定"或类似选项。

选择 目标工具号（如 TOOL 1）。

选择 标定方法为"单点法"或"Z方向单点"。

阶段二：记录第一个姿态

移动 机器人，使工具尖端对准标定针尖。建议速度设为低速（如10%），防止碰撞。

调整 姿态，使工具Z轴大致竖直向下（或朝向标定针的方向）。此时法兰盘姿态任意，但建议保持关节处于较舒展的状态，避免奇异点。

缓慢 靠近标定针，直至工具尖端与针尖轻触。接触力度以针尖无明显弯曲、机器人未触发碰撞报警为准。

按下 示教器上的"记录"或"位置1"按钮，保存当前法兰盘位姿。

移开 机器人，远离标定针，准备换姿态。

阶段三：记录第二个姿态

旋转 机器人法兰盘，改变姿态。关键要求：工具Z轴方向必须有明显变化。

理想情况：两次姿态的工具Z轴夹角在90°至180°之间。若夹角太小（如同方向靠近），计算误差会急剧增大。

具体操作：

• 方案A：保持工具尖端大致指向标定针，绕法兰盘Z轴旋转约180°
• 方案B：大幅倾斜工具角度，从侧面再次接触标定针

再次移动 机器人，使工具尖端对准同一标定针尖。

缓慢 靠近并轻触，确认接触点与第一次相同。

按下 "记录"或"位置2"按钮，保存第二个法兰盘位姿。

阶段四：计算与验证

点击 "计算"或"完成"按钮。系统自动根据两次位姿求解Z向长度。

查看 计算结果。典型界面会显示：

• X = 0.000 或接近零的小数（单点法强制为零或极小值）
• Y = 0.000 或接近零
• Z = [计算值]，单位通常为毫米

判断 结果合理性：

• 符号检查：若工具尖端在法兰盘外侧（远离机器人本体），Z应为正值；若在内侧，为负值
• 量级检查：与工具实际长度对比，误差应在±5mm以内。若偏差过大，检查是否接触了错误的点，或两次姿态差异不足

保存 数据到目标工具号。

阶段五：精度验证

进入 手动模式，选择刚标定的工具坐标系作为当前工具。

切换 坐标系为"工具坐标系"（非世界/基坐标系/关节坐标系）。

握住 示教器使能键，准备测试。

执行 关键验证动作：

若绕Z旋转时尖端明显画圆，说明XY方向存在未标定的偏移，单点法不适用，需改用三点或六点标定。

六、常见问题与处理

七、高级技巧

1. 提高重复精度的方法

使用 自动接触检测替代人工目视。部分机器人支持：

• 电阻寻位：工具与标定针构成回路，接触瞬间自动停止
• 力控接触：监测扭矩突变判定接触

执行 多次标定取平均。记录3-5组不同姿态组合的计算结果，剔除异常值后平均。

2. 外部TCP场景的特殊处理

当工件固定、机器人手持工具工作时，工具坐标系的Z向定义可能相反。

确认 工艺要求的Z正方向：是指向工件表面（压入），还是背离工件（提起）。

在 标定前调整机器人基坐标系或工具定义，确保Z向符号与工艺逻辑一致。

3. 长工具的补偿

对于超长工具（如2米以上打磨杆），单点标定的杠杆误差会被放大。

建议 增加一个中间验证点：在工具杆中部某已知位置做标记，标定后检查该标记的实际位置是否与理论值一致。

必要时 使用激光跟踪仪等外部测量设备做最终校准。

八、不同品牌操作速查

九、标定后的必要工作

在 程序中调用新工具号前，添加 工具负载数据。Z向长度只解决位置问题，质量、重心、惯性矩需单独设置，否则高速运动可能报警或损伤机械。

记录 标定日期、工具编号、操作人员。建立标定档案，便于追溯。

定期复核 关键工具。建议每季度或每次更换工具后重新标定。