4. 工具与工件坐标系标定实战
在RobotStudio中做节拍分析，最先要保证的不是程序写得多快，而是机器人“知道自己在哪里、工具尖在哪里”。如果TCP（Tool Center Point，工具中心点）偏差2 mm，看似很小，但在高速圆弧或转角处，机器人会为了修正轨迹而反复加减速，节拍可能被拉长5%～15%。本节以一台IRB 1200-7/0.7六轴机器人为例，工具为一把长150 mm的焊枪，工件为一块400 mm×300 mm的铝板，完整走一遍三点法、六点法TCP标定、工件坐标系建立，以及标定精度对节拍影响的验证过程。
一、先明确坐标系约定
本节所有方向约定统一如下：机器人基坐标系为Base，X轴指向机器人正前方，Y轴指向左侧，Z轴竖直向上；工具坐标系Tool0默认在法兰中心，Z轴沿法兰法线向外。工具坐标系TCP的Z轴定义为工具作业方向（焊枪指向工件），X轴由右手定则确定。工件坐标系Workobject的X、Y轴位于工件上表面，Z轴垂直上表面向上。后续所有坐标值、偏移量、方向描述均以此为准，不再重复说明。
二、三点法TCP标定：快速建立工具尖位置
三点法适合工具尖为尖点、且工具姿态变化不大的场景，例如点焊枪、吸盘、简单夹爪。操作步骤如下：
- 在RobotStudio的“手动操纵”界面，将工具坐标系切换为tool0，选择“新建工具”，命名为tWeld。
- 在工件上固定一个尖点作为参考点，例如一块硬质合金顶针，位置保持不动。
- 手动操纵机器人，使焊枪尖以三个不同姿态接触同一参考点。三个姿态建议分别绕X、Y、Z轴各偏转约30°～45°，避免姿态过于接近导致解算病态。
- 每接触一次，在“工具坐标”对话框中点击“修改位置”，记录当前法兰位姿。
- 三点全部记录后，点击“确定”，RobotStudio自动解算TCP位置。
三点法只解算TCP的X、Y、Z位置，不解算姿态。示例中，三点法解算得到的TCP位置为（0，0，150.2）mm，即工具尖沿法兰Z轴向外150.2 mm。此时若直接用于轨迹编程，焊枪姿态仍由tool0决定，焊枪指向可能偏离工件法线，导致实际焊接角度错误。
三、六点法TCP标定：同时解算位置与姿态
六点法在三点法基础上增加三个姿态点，用于解算工具坐标系的姿态。六点法的六个点分为两组：前三点与三点法相同，用于确定TCP位置；后三点分别让工具绕TCP的X、Y、Z轴旋转，用于确定工具坐标系的姿态。具体操作：
- 前三点：与三点法一致，焊枪尖接触同一参考点，姿态分别为A、B、C。
- 第四点：保持焊枪尖仍接触参考点，将机器人绕工具X轴旋转约30°，记录位姿。
- 第五点：保持焊枪尖接触参考点，绕工具Y轴旋转约30°，记录位姿。
- 第六点：保持焊枪尖接触参考点，绕工具Z轴旋转约30°，记录位姿。
- 六点记录完成后，RobotStudio解算TCP位置与姿态，生成完整的工具坐标系tWeld。
示例中，六点法解算结果为：TCP位置（0，0，150.0）mm，工具Z轴与法兰Z轴夹角约2.3°，工具X轴与法兰X轴夹角约1.8°。与三点法相比，位置仅差0.2 mm，但姿态差异明显。若用三点法结果直接编程，焊枪实际指向会偏离工件法线约2°，在150 mm工具长度下，末端位置偏差约5.2 mm，足以造成焊缝偏移或节拍波动。
四、建立工件坐标系
工件坐标系用于把程序中的坐标从机器人基坐标系转换到工件表面，便于离线编程和批量复制。在RobotStudio中建立工件坐标系的常用方法是“三点法”：
- 在“工件坐标”面板新建Workobject，命名为wPlate。
- 选择“用户三点法”：第一点指定工件原点，建议选铝板左下角；第二点指定X轴正方向上的点，例如沿铝板长边向右400 mm处；第三点指定Y轴正方向上的点，例如沿铝板短边向上300 mm处。
- 三点记录后，RobotStudio自动生成工件坐标系，Z轴由右手定则确定，垂直铝板上表面向上。
示例中，wPlate原点在机器人基坐标系下的位置为（520，-180，85）mm，X轴沿铝板长边，Y轴沿短边，Z轴向上。建立后，所有轨迹点都可以用工件坐标表示，例如焊点P1为（50，50，0），P2为（350，50，0），P3为（350，250，0）。这样即使铝板位置微调，只需重新标定wPlate，程序无需逐点修改。
五、标定精度验证与节拍影响测试
标定完成后不能直接投入节拍分析，必须先验证精度。验证方法：在工件上选一个已知坐标的基准点，例如铝板上的一个定位孔，用示教器手动将焊枪尖对准该孔，读取当前TCP在wPlate下的坐标，与理论坐标比较。示例中，理论坐标为（200，150，0），实测为（200.3，149.8，0.1），偏差约0.36 mm，满足一般焊接要求（≤0.5 mm）。
接下来验证标定精度对节拍的影响。在RobotStudio中建立两条相同轨迹：轨迹A使用三点法TCP，轨迹B使用六点法TCP，其余参数（速度、转弯区、加速度）完全一致。轨迹为铝板上一条包含4个转角的折线，总长1200 mm。仿真结果示例：
| 项目 | 三点法TCP | 六点法TCP | 差异 |
|---|---|---|---|
| TCP位置偏差 | 0.2 mm | 0.05 mm | — |
| 姿态偏差 | 约2° | 约0.3° | — |
| 轨迹总时间 | 8.6 s | 7.9 s | 减少0.7 s（约8.1%） |
| 转角处速度波动 | 明显，多次降速 | 平稳 | — |
从示例数据可以看出，三点法虽然位置偏差只有0.2 mm，但姿态偏差导致焊枪在转角处需要不断修正方向，机器人反复加减速，节拍被拉长。六点法姿态准确，轨迹更平滑，节拍更短。这也说明：对于焊枪、切割头这类对姿态敏感的工具，必须使用六点法标定，不能只做三点法。
六、实操检查清单
- 参考点是否固定？建议用硬质合金顶针或V形槽，不要用手扶。
- 三点法三次姿态差异是否足够？建议绕不同轴各偏转30°以上。
- 六点法后三点是否保持TCP接触参考点？只旋转姿态，不移动位置。
- 工件坐标系三点是否共线？第二、三点不要选在同一直线上，否则无法确定平面。
- 标定后是否做精度验证？建议用定位孔或基准点复测，偏差≤0.5 mm。
- 是否对比过三点法与六点法的节拍差异？建议在RobotStudio中做一次对比仿真，记录轨迹时间。