工业机器人标定实战：从几何误差到动态轨迹补偿

引言：一台机器人的精度可以差到多少

四年前我在一家汽车零部件厂调试焊接机器人，发现焊枪始终偏离目标焊缝约2mm。现场工程师告诉我"机器人精度就这样"。但我测了另一台同型号的机器人，误差只有0.3mm。问题出在哪？答案是标定。

工业机器人的重复定位精度通常很高（±0.05mm甚至更好），但绝对定位精度却可能很差（±2~5mm）。这种精度体现在很多场景下会出问题：铣削加工需要绝对轨迹精度、离线编程依赖绝对位置精度、协作任务需要多个机器人精确定位。

一、几何误差的来源

工业机器人由多个关节和连杆组成，理论运动学模型是精确的D-H参数。但实际制造和装配过程中，每个连杆的长度、关节的零位偏置、轴线的平行度都存在微小偏差。

具体来说，几何误差主要包括：

1.1 连杆长度误差

每个连杆的制造公差，最常出现在大臂和小臂上。一台六轴机器人的大臂理论长度是500mm，实际可能是500.12mm。这个看似微小的0.12mm，会在末端工具位置放大数倍。假设小臂同样是500mm，两个误差叠加，末端位置偏差可能达到0.5mm以上。

1.2 关节零位偏置

这是最常见的标定问题。机器人的每个关节都有一个"零位"——即编码器读数为0时对应的物理位置。实际装配中，这个零位不可能百分之百精确。一个0.01°的零位偏置，末端偏移量大约是R×tan(0.01/57.3)。如果R（距离末端最近的关节到末端的距离）是1000mm，偏移量约0.17mm。

1.3 轴线偏差

理论上相邻关节的轴线应该是平行或垂直的，但实际装配中总存在微小偏差。这种偏差在机器人姿态变化时表现得尤为明显。

二、标定的工程流程

工业机器人标定通常分为四个步骤：建模、测量、辨识、补偿。

2.1 运动学建模

建立机器人的运动学模型，通常使用修正的D-H参数或旋量理论。最常用的是MDH（Modified Denavit-Hartenberg）模型，表示为：

关节变换矩阵 = Rot(z, θ_i) × Trans(z, d_i) × Trans(x, a_i) × Rot(x, α_i)

其中θ_i是关节角、d_i是关节偏移、a_i是连杆长度、α_i是连杆扭转。

标定的目标就是找出这些参数的实际值（而不是设计值）。如果机器人的安装面不水平，还可能需要额外的基座标定参数。

2.2 高精度测量

标定的精度取决于测量设备的精度。常用的设备包括：

- 激光跟踪仪（Leica AT960/FARO Vantage）：精度±15μm+6μm/m，适合大型机器人整体标定

- 经纬仪系统：精度高但操作复杂，适合小范围标定

- 球杆仪（Ballbar）：测量半径变化，可以快速检测机器人方位误差，但只能获得单一方向的误差信息

- 立体视觉系统：通过相机拍摄靶标来定位，精度一般但成本低、速度快

测量点的选取非常重要。一般建议选取工作空间内分布均匀的50~100个点，包括机器人不同姿态的构型。如果只测末端位置而不测姿态，标定效果会大打折扣。

2.3 参数辨识

参数辨识的目标是最小化理论位置与实际测量位置之间的误差。常用最小二乘法或扩展卡尔曼滤波。

设机器人的运动学方程为：P = f(θ, Φ)，其中θ是关节角，Φ是待辨识的运动学参数。目标是找到Φ使得Σ||P_measured - f(θ, Φ)||²最小。

这个优化问题通常用Levenberg-Marquardt算法求解。需要注意，不是所有参数都可辨识的——某些参数之间存在耦合关系。例如，关节1的零位偏置和基座安装角之间存在冗余。工程上需要先进行可辨识性分析，剔除冗余参数。

2.4 误差补偿

辨识出实际参数后，有两种补偿方式：

- 直接修改控制器参数：把标定后参数写入机器人控制器，后续逆运动学计算使用实际参数。这是最彻底的方式，但需要机器人厂家开放参数修改权限。

- 外部补偿：在机器人外部增加一个补偿矩阵，对目标位置进行预处理。这种方式不依赖控制器，但补偿效果受限于补偿模型的精度。

三、温度补偿：机器人也会热胀冷缩

机器人在工作过程中，电机和减速器会产生大量热量，导致结构件热胀冷缩。一台连续工作的机器人，减速器温度可以从25℃升至60℃，连杆长度会变化0.03~0.1mm。这个变化看起来很小，但对高精度铣削加工来说已经不能忽略。

温度补偿通常采用经验模型。在减速器、大臂、小臂上安装温度传感器，标定出温度变化与末端位置偏移的关系：ΔP = k × (T - T₀)。系数k需要通过实验获取。典型的做法是在机器人工作8小时后（热平衡状态）重新标定一次，与冷态标定结果对比，建立温度漂移模型。

四、实战案例：焊接机器人标定全过程

项目背景：某汽车零部件厂的6台FANUC M-20iA焊接机器人，用于焊接变速箱壳体。离线编程程序在仿真环境运行完美，但部署到实际产线上后，焊缝始终偏移1.8~2.5mm。每次换产需要人工示教修正，耗时6~8小时。

标定步骤：

第一步：安装激光跟踪仪，建立全局坐标系。在机器人法兰盘上安装靶球座。

第二步：设定30个不同姿态的测量点，涵盖末端工作空间的8个方位。每个姿态下记录关节角度和末端实际位置。

第三步：使用Levenberg-Marquardt算法辨识参数，发现关节2零位偏置0.03°，连杆2长度误差0.21mm，这两个是主要误差源。

第四步：将标定参数写入控制器，重新测量验证。末端位置误差从2.0mm降低到0.35mm。

第五步：在机器人底座加装温度传感器（Pt100），在运行4小时后监测到温度上升，通过补偿模型自动修正末端位置。

标定后效果：离线编程程序的焊缝偏移从2mm降至0.3mm以内，换产时间从6~8小时缩短到30分钟。

结语

工业机器人标定不是一次性的工作。随着使用时间增加，机械磨损会导致参数漂移。建议每3~6个月重新标定一次，或者在更换减速器、电机等关键部件后进行标定。

对于预算有限的工厂，虽然没有激光跟踪仪，但也可以利用较简单的方法：标准球+探针测量、或者送第三方专用服务。一台六轴机器人的完整标定服务约5000~15000元，相比机器人本身的价格，标定投资是值得的。