3、插补算法原理：直线插补、圆弧插补、样条插补的数学基础与实现逻辑
插补（Interpolation）是运动控制系统的核心计算任务，其本质是在已知的起点与终点之间，按照某种数学规则实时计算出中间点的坐标，并将这些坐标转换为各伺服轴的位置指令。在多轴联动场景中，插补算法的质量直接决定了工件的轮廓精度、表面粗糙度以及机床的动态性能。本章将深入剖析直线插补、圆弧插补与样条插补的数学原理，并结合工程实现逻辑，帮助学员建立从公式推导到代码落地的完整知识链路。
上图展示了三类插补算法的整体知识框架。直线插补与圆弧插补属于基本插补，广泛应用于二维轮廓加工；样条插补则面向复杂自由曲面，是现代五轴联动高速加工的核心技术。下面分别展开其数学推导与实现细节。
3.1 直线插补：从偏差判别到脉冲分配
3.1.1 核心原理：逐点比较法
逐点比较法是最经典的直线插补算法，其核心思想是：刀具每走一步，将当前位置与理想直线进行比较，根据偏差符号决定下一步的进给方向。设直线起点为原点 (0,0)，终点为 (Xe, Ye)，当前点为 (Xi, Yi)，定义偏差函数：
F = X_i * Y_e - Y_i * X_e当 F = 0 时，点在直线上；F > 0 时，点在直线上方；F < 0 时，点在直线下方。根据偏差符号，沿 X 或 Y 方向进给一步，并更新偏差值。为避免每次乘法运算，采用递推公式：
若 F >= 0，则 X 方向进给：F_new = F - Y_e
若 F < 0，则 Y 方向进给：F_new = F + X_e这种递推方式仅需加减法运算，非常适合 FPGA 或低端 MCU 的实时计算。总步数为 |Xe| + |Ye|，当步数计数器归零时插补结束。
3.1.2 判断方法与象限处理
实际加工中直线可能位于任意象限，需根据终点坐标符号确定进给方向。下表总结了四个象限的进给规则：
| 象限 | 终点坐标符号 | F≥0 进给方向 | F<0 进给方向 |
|---|---|---|---|
| 第一象限 | Xe>0, Ye>0 | +X | +Y |
| 第二象限 | Xe<0, Ye>0 | -X | +Y |
| 第三象限 | Xe<0, Ye<0 | -X | -Y |
| 第四象限 | Xe>0, Ye<0 | +X | -Y |
实现时，可将终点坐标取值，统一按第一象限计算，再根据实际象限映射到对应的物理轴方向。这种“坐标变换+象限映射”的方法可显著简化代码逻辑。
3.1.3 案例拆解：两轴直线插补的脉冲输出
假设某激光切割设备需要从 (0,0) 移动到 (300, 200) 单位（脉冲当量 0.01mm），进给速度 F=500mm/min。采用逐点比较法，总步数 N=500。关键实现步骤如下：
- 初始化：F=0，计数器 N=500，Xe=300，Ye=200。
- 循环判断：每产生一个插补周期（例如 1ms），判断 F 符号，输出对应轴的脉冲信号。
- 偏差更新：按递推公式更新 F 值，计数器减 1。
- 速度匹配：通过定时器中断频率控制插补周期，实现进给速度调节。
实际测试中，该算法在 50MHz 主频的 MCU 上，单步计算耗时约 2μs，完全满足 1ms 插补周期的实时性要求。但需注意，逐点比较法的合成速度存在波动，在低速时尤为明显，需配合速度平滑算法。
3.2 圆弧插补：角度分割与弦线逼近
3.2.1 核心原理：角度参数化
圆弧插补的数学基础是将圆弧表示为角度 θ 的函数。设圆心为 (Xc, Yc)，半径为 R，起点角度 θs，终点角度 θe，则任意时刻的坐标：
X = X_c + R * cos(θ)
Y = Y_c + R * sin(θ)工程实现中，通常采用“弦线逼近”策略：将圆弧按角度步长 Δθ 分割为若干微小直线段，每段用直线插补执行。角度步长由弓高误差（弦线与圆弧的最大距离）决定：
Δθ = 2 * arccos(1 - h/R)其中 h 为允许的弓高误差。例如，R=50mm，h=0.001mm 时，Δθ≈0.018 弧度，需分割约 350 段。
3.2.2 实现逻辑：DDA 法与递推计算
为避免实时计算三角函数，可采用数字微分分析器（DDA）法。其核心是利用三角函数的和角公式进行递推：
X_{n+1} = X_n * cos(Δθ) - Y_n * sin(Δθ)
Y_{n+1} = X_n * sin(Δθ) + Y_n * cos(Δθ)预先计算 cos(Δθ) 和 sin(Δθ) 为常量，每次插补仅需 4 次乘法和 2 次加法。但递推计算会累积误差，需定期用理论坐标校正。另一种更稳健的方法是“角度累加+查表”：将 0~90° 的余弦值制成查找表，通过角度累加器查询近似值，再根据象限进行符号变换。
3.2.3 实战场景：过象限误差补偿
圆弧加工中最常见的质量问题是在 X 轴或 Y 轴过象限（即角度经过 0°、90°、180°、270°）时出现轮廓凸起或凹陷。原因在于：过象限时某一轴的速度接近零，伺服系统的跟随误差增大。某数控铣床加工 R80mm 内圆弧时，在 90° 位置出现 0.03mm 的凸起。排查过程如下：
- 现象确认：用圆度仪检测，发现 90° 和 270° 位置有明显凸起，其他位置误差小于 0.008mm。
- 原因分析：检查伺服参数，发现 Y 轴在过象限时速度过零，位置环增益不足导致跟随滞后。
- 解决方案：在插补算法中增加“过象限速度前瞻”，提前 5 个插补周期将 Y 轴速度降至 10%，过象限后再恢复；同时将 Y 轴位置环增益从 30/s 提高至 45/s。
- 结果对比：补偿后圆度误差降至 0.012mm，满足 IT6 级精度要求。
3.3 样条插补：自由曲线的实时逼近
3.3.1 核心原理：B样条与NURBS
样条插补用于加工复杂自由曲面，其数学基础是 B 样条基函数。一条 k 次 B 样条曲线定义为：
P(u) = Σ_{i=0}^{n} N_{i,k}(u) * P_i其中 P_i 为控制点，Ni,k(u) 为 k 次 B 样条基函数，由节点矢量 U = [u0, u1, ..., un+k+1] 递推定义。NURBS（非均匀有理 B 样条）在此基础上引入权重因子，可精确表示圆锥曲线。
工程实现中，插补器需在每个周期完成两项任务：参数密化（根据进给速度计算参数 u 的增量）和坐标计算（根据 u 值计算曲线上的坐标）。参数密化通常采用二阶泰勒展开：
u_{i+1} = u_i + V*T / |dP/du| + (V*T)^2 * (d²P/du²) / (2*|dP/du|³)其中 V 为进给速度，T 为插补周期。该公式考虑了曲线曲率对进给速度的影响，避免在曲率大处超速。
3.3.2 实现逻辑：实时性与精度平衡
样条插补的计算量远大于直线和圆弧，需在实时性与精度之间权衡。常用策略包括：
- 离线预处理：将 NURBS 曲线离散为密集的微小直线段（如每 0.01mm 一段），生成刀位文件，运行时仅执行直线插补。
- 在线计算：使用 de Boor 算法递推计算基函数，配合查表法加速。在 1ms 插补周期内，可完成 3 次 B 样条约 200 个控制点的计算。
- 混合方案：粗插补（每 10ms 计算一次样条坐标）与精插补（每 1ms 在粗插补点间线性插值）结合，兼顾精度与实时性。
3.3.3 案例拆解：五轴叶片加工中的样条插补
某航空发动机叶片加工中心，原采用 CAM 生成的直线段刀轨（段长 0.05mm），加工后表面存在明显接刀痕。改用 NURBS 插补后，刀轨文件从 120MB 压缩至 8MB，表面粗糙度从 Ra1.6μm 提升至 Ra0.8μm。实施要点：
- 数据转换：将 CAM 输出的刀位点云拟合为 3 次 NURBS 曲线，控制点数量约 500 个，权重因子设为 1。
- 速度规划：根据叶片曲率分布，设定最大进给速度 3000mm/min，在叶尖（曲率大）处自动降速至 800mm/min。
- 实时计算：采用 de Boor 算法，在 1ms 周期内完成坐标计算，CPU 占用率约 35%。
- 效果验证：加工时间缩短 22%，表面质量满足航标 HB 7752 要求。