一、插补算法概述

1.1 什么是插补算法

插补算法，说白了就是「算中间点」的算法。

你给数控系统一个起点和一个终点，比如从 (0,0) 走到 (100,100)。系统不能「嗖」一下跳过去，它得一步一步走。每一步走多少？方向怎么偏？速度怎么控？这些计算，就是插补干的活。

我刚开始接触这个领域时，觉得插补不就是画直线吗？后来在调试一台五轴机床时才发现，插补算不好，加工出来的零件表面全是刀纹，客户直接退货。嗯，从那以后我再也不敢小看插补了。

举个例子：你要在 XY 平面上走一条 45° 斜线，从 (0,0) 到 (10,10)。

• 如果步长是 1，插补会算出：(1,1)、(2,2)、(3,3)……直到 (10,10)
• 如果步长是 0.5，插补会算出：(0.5,0.5)、(1.0,1.0)、(1.5,1.5)……

你想想看，步长越小，轨迹越平滑，但计算量也越大。这就是插补算法里最经典的「精度 vs 速度」矛盾。

1.2 插补算法在数控系统/机器人中的核心地位

插补算法有多重要？我直接说结论：没有插补，数控系统和机器人就是一堆废铁。

为什么？因为电机只能接受「位置指令」或「速度指令」。你给电机一个目标位置，它自己会转过去。但问题是——你怎么告诉它「走一条圆弧」？

电机听不懂圆弧。它只懂「转多少圈」。所以你必须把圆弧拆成无数个微小的直线段，每个直线段对应一个位置指令。这个拆解过程，就是插补。

插补算法在系统中的位置，可以用下面这张图来理解：

从这张图可以看得很清楚：插补算法处于整个运动控制链的最核心位置。它上面连接用户的路径指令，下面驱动速度规划和伺服执行。插补算不好，后面再怎么优化都是白搭。

1.3 插补算法的分类

插补算法分两大类：基准脉冲插补和数据采样插补。这两者的区别，我习惯用一个比喻来解释：

• 基准脉冲插补：就像你走路，一步一个脚印。每走一步，发一个脉冲。
• 数据采样插补：就像你开车，先规划好整条路线，然后每隔一段距离报一次位置。

下面这张表把两者的核心差异列清楚了：

对比项	基准脉冲插补	数据采样插补
基本原理	每个插补周期输出一个脉冲	每个插补周期输出一个坐标增量
输出形式	脉冲序列（步进电机）	位置增量（伺服电机）
精度	受脉冲当量限制	受采样周期和计算精度限制
速度范围	低速（受脉冲频率限制）	高速（可达到很高速度）
典型应用	老旧数控系统、3D打印机	现代数控系统、工业机器人
代表算法	逐点比较法、数字积分法	时间分割法、扩展DDA法

1.3.1 基准脉冲插补

基准脉冲插补是最早出现的插补方式。它的思路很直接：每个插补周期算一次，算出来该往哪个轴走一步，就发一个脉冲。

我举个例子，逐点比较法做直线插补：

// 逐点比较法直线插补（第一象限）
// 起点 (0,0)，终点 (xe,ye)
int x = 0, y = 0;
int F = 0;  // 偏差值

while (x < xe || y < ye) {
    if (F >= 0) {
        // 向+X方向走一步
        x++;
        F -= ye;
    } else {
        // 向+Y方向走一步
        y++;
        F += xe;
    }
    // 输出脉冲到电机
    output_pulse(x, y);
}

这段代码看着简单，但实际项目里坑不少。我曾经在一个老式雕刻机项目里用过逐点比较法，结果发现一个问题：当终点坐标很大时，脉冲频率会变得非常高，步进电机根本跟不上。后来我加了个速度控制逻辑，才把问题解决。

1.3.2 数据采样插补

数据采样插补是现代数控系统的主流方案。它的思路是：每个固定时间间隔（比如 1ms）算一次，算出在这段时间内各轴应该走多少距离，然后把这个增量发给伺服驱动器。

我习惯把数据采样插补分成两步：

1. 粗插补：在路径上按时间采样，得到一系列离散点
2. 精插补：在相邻采样点之间，用微小直线段逼近

举个例子，时间分割法做直线插补：

// 时间分割法直线插补
// 起点 (xs,ys)，终点 (xe,ye)，速度 v，插补周期 T

double dx = xe - xs;
double dy = ye - ys;
double L = sqrt(dx*dx + dy*dy);  // 总路径长度
double step = v * T;             // 每个周期的步长
int n = (int)(L / step);         // 总步数

for (int i = 0; i < n; i++) {
    double t = (double)i / n;
    double xi = xs + dx * t;
    double yi = ys + dy * t;
    // 输出位置增量到伺服
    output_increment(xi, yi);
}

1.3.3 两类插补的对比总结

为了让你更直观地理解两者的区别，我画了张对比图：

看到这张图，你应该能明白：基准脉冲插补是「脉冲级」的，数据采样插补是「位置级」的。两者没有绝对的好坏，关键看应用场景。

我个人习惯这样选型：

• 如果系统用的是步进电机，或者对成本敏感，选基准脉冲插补
• 如果系统用的是伺服电机，或者对速度和精度要求高，选数据采样插补
• 如果两者混用（比如一些混合系统），那就需要做插补转换，这个后面章节会讲