📚 课程目录第4章工具与工件坐标系标定

4. 工具与工件坐标系标定

在RobotStudio离线仿真工程中，坐标系是全部运动指令、轨迹规划和碰撞判断的几何基准。机器人本体出厂时只定义了法兰盘中心的工具坐标系原点（tool0），而实际作业中焊枪、吸盘、夹爪的作业点几乎不可能正好落在法兰中心。因此必须通过TCP（Tool Center Point，工具中心点）定义，把控制点从法兰中心平移到真实作业点；同时通过工件坐标系（Work Object）把编程基准从机器人基座转移到工件上。本节围绕这两类标定展开，并给出工具安装与姿态验证的完整方法。

一、TCP的定义与六维参数

TCP在ABB系统中由tooldata数据类型描述，包含两部分：平移量tframe.trans（x、y、z，单位mm）和姿态tframe.rot（四元数q1~q4）。平移量表示TCP相对于tool0的位置，姿态表示工具坐标系的X、Y、Z轴方向。此外还有tload（工具质量与重心）用于动力学计算。一个典型的焊枪TCP定义如下：

PERS tooldata tWeldGun := [TRUE,
    [[180, 0, 320], [1, 0, 0, 0]],
    [12, [120, 0, 200], [1, 0, 0, 0], 0, 0, 0]];
! trans = [180,0,320]：TCP在tool0的+X 180mm、+Z 320mm处
! rot = [1,0,0,0]：工具姿态与tool0一致（无旋转）
! tload：质量12kg，重心在[120,0,200]

定义TCP有四种常用方法：三点法（TCP在空间中固定，机器人以三种不同姿态触碰同一点）、六点法（三点定位置，再两点定姿态）、直接输入法（已知CAD尺寸时直接填写trans和rot）、外部基准法（用固定针尖或标定板）。离线仿真中最常用的是直接输入法，因为工具模型尺寸在CAD中已知；若需高精度，可在RobotStudio的“工具标定”功能中模拟三点法，通过虚拟触碰点反算TCP。

二、工件坐标系的创建

工件坐标系由wobjdata定义，包含uframe（用户坐标系，相对世界坐标）和oframe（对象坐标系，相对用户坐标）。通常把uframe设为工件安装基准，oframe设为工件上的编程原点。创建方式有三种：

三点法：定义原点、X轴方向点、Y轴方向点，Z轴由右手定则确定。适合工件表面有明确特征点的场合。
直接输入法：已知工件相对世界坐标的位姿，直接填写uframe的trans和rot。
从CAD模型拾取：在RobotStudio中选中工件模型的特征点，自动生成坐标系。

例如一个放置在台面上的工件，其左下角为编程原点，X轴沿工件长边，Z轴垂直向上，可定义：

PERS wobjdata wobj_Table := [FALSE, TRUE, "",
    [[600, 200, 750], [1, 0, 0, 0]],
    [[0, 0, 0], [1, 0, 0, 0]]];
! uframe：工件原点在世界坐标[600,200,750]，姿态与基座一致
! oframe：编程原点与uframe重合

三、工具安装与姿态验证

工具安装到法兰后，必须验证三件事：TCP位置是否正确、工具姿态是否符合工艺要求、是否存在碰撞风险。在RobotStudio中，可通过以下步骤验证：

在“建模”选项卡中导入工具模型，使用“安装”功能将其吸附到机器人法兰（tool0）。
在“机器人”菜单中打开“工具”对话框，新建工具并输入tooldata参数，或直接导入已有的.tdata文件。
激活该工具后，在示教器中手动移动机器人，观察TCP是否沿预期方向运动。例如让TCP沿工件表面直线移动，若轨迹偏离，说明trans或rot有误。
使用“碰撞检测”功能，让机器人以不同姿态接近工件，检查工具与工件、夹具是否干涉。
姿态验证：将工具Z轴对准工件法线方向，检查rot是否使工具轴线与法线重合。可用“测量”工具读取当前TCP的姿态角（欧拉角），与工艺要求对比。

在离线仿真中，建议先以直接输入法建立TCP，再用“三点法”虚拟标定进行复核。若两者偏差超过0.5mm，应检查CAD模型与实物尺寸是否一致。

四、标定结果的检查与常见问题

标定完成后，可通过以下指标判断是否合格：TCP重复定位误差应小于工艺允许值（如弧焊通常要求≤0.5mm）；工具姿态与工件法线的夹角偏差应小于1°；在极限姿态下工具与夹具的最小距离应大于安全间隙（如10mm）。常见问题包括：trans的Z值符号写反导致TCP在法兰另一侧；rot四元数未归一化导致姿态异常；wobj的uframe与oframe混淆导致编程点偏移。排查时，可先固定一个已知点，用不同姿态让TCP触碰，观察偏差方向，再反推是哪个参数出错。

最后需要强调：TCP和工件坐标系一旦确定，所有运动指令（如MoveL p10, v500, fine, tWeldGun\WObj:=wobj_Table）都会以它们为基准。若标定错误，即使轨迹点坐标完全正确，实际执行也会偏离。因此在离线仿真阶段，应把标定参数作为工程配置的一部分固化下来，并在仿真报告中记录TCP偏差和工件坐标系原点坐标，便于现场调试时快速比对。