4. 直线插补原理

直线插补是运动控制系统中应用最广泛、也是所有复杂轨迹插补算法的基础。无论是二维平面上的XY轴联动，还是三维空间中的五轴/六轴机器人末端直线运动，其核心目标都是让多个运动轴在时间上严格同步，使合成运动轨迹逼近一条理想直线。本章将从数学描述出发，深入剖析二维与三维直线插补的参数方程、速度规划策略以及工程实现步骤，帮助读者建立从理论到代码的完整知识链路。

4.1 直线插补的数学描述与参数方程

直线插补的本质是：在给定起点 P₀(x₀, y₀, z₀) 和终点 P₁(x₁, y₁, z₁) 后，通过一个归一化参数 λ（取值范围 [0, 1]）来描述从起点到终点的连续位置变化。这个参数 λ 通常与时间 t 相关联，但数学上先独立定义空间位置与 λ 的关系，再通过速度规划建立 λ(t) 的时间映射。

对于二维直线插补，参数方程为：

X(λ) = x₀ + λ·(x₁ - x₀) = x₀ + λ·ΔX
Y(λ) = y₀ + λ·(y₁ - y₀) = y₀ + λ·ΔY
其中 λ ∈ [0, 1]

对于三维直线插补，只需增加 Z 轴分量：

X(λ) = x₀ + λ·ΔX
Y(λ) = y₀ + λ·ΔY
Z(λ) = z₀ + λ·ΔZ
其中 ΔX = x₁-x₀, ΔY = y₁-y₀, ΔZ = z₁-z₀

这种参数化表示的核心优势在于：所有轴共享同一个参数 λ，从而天然保证了各轴运动的同步性。当 λ 从 0 均匀变化到 1 时，各轴按照各自的比例系数（ΔX、ΔY、ΔZ）同时运动，合成轨迹必然是一条空间直线。总位移长度 L 为：

L = √(ΔX² + ΔY² + ΔZ²)

在实际工程中，λ 通常被定义为 已走距离占总距离的比例，即 λ = s(t) / L，其中 s(t) 是 t 时刻已走过的弧长。这样，速度规划就转化为对 s(t) 的设计问题。

4.2 速度规划策略

速度规划决定了 λ(t) 的具体形式，直接影响运动平稳性和加工效率。最常用的速度规划方法包括梯形速度曲线和 S 型速度曲线。

4.2.1 梯形速度曲线

梯形速度曲线将运动过程分为三个阶段：匀加速段、匀速段、匀减速段。设最大速度为 v_max，加速度为 a，则各阶段的时间参数为：

加速时间 t₁ = v_max / a
减速时间 t₃ = v_max / a
匀速时间 t₂ = (L - v_max²/a) / v_max  （当 L > v_max²/a 时）
总时间 T = t₁ + t₂ + t₃

若总位移 L 较小，无法达到最大速度，则只有加速和减速段，形成三角形速度曲线。此时最大实际速度为：

v_peak = √(a·L)

梯形速度规划实现简单、计算量小，适用于大多数点位运动控制场景。但其加速度存在突变（从 0 瞬间到 a），在高速运动时会引起机械振动。

4.2.2 S 型速度曲线

S 型速度曲线对加速度进行连续变化处理，通常采用 7 段式：加加速、匀加速、减加速、匀速、加减速、匀减速、减减速。其加速度曲线为梯形，速度曲线为 S 形，能有效抑制机械冲击。

S 型曲线需要设定三个参数：最大速度 v_max、最大加速度 a_max、加加速度 j（jerk）。各段时间计算较为复杂，通常采用数值迭代或查表法实现。在高端 CNC 和机器人控制中，S 型曲线是标配。

4.3 实现步骤与代码框架

直线插补的软件实现通常遵循以下五个步骤。下面以 C 语言风格伪代码展示核心逻辑。

步骤一：输入解析与参数计算

// 输入：起点P0(x0,y0,z0)，终点P1(x1,y1,z1)，最大速度v_max，加速度a
// 输出：各轴增量、总长度、各阶段时间

dx = x1 - x0;
dy = y1 - y0;
dz = z1 - z0;
L = sqrt(dx*dx + dy*dy + dz*dz);

// 判断能否达到最大速度
if (v_max * v_max / a < L) {
    // 能达到最大速度，梯形曲线
    t_acc = v_max / a;
    t_dec = v_max / a;
    t_const = (L - v_max*t_acc) / v_max;
} else {
    // 达不到最大速度，三角形曲线
    v_peak = sqrt(a * L);
    t_acc = v_peak / a;
    t_dec = t_acc;
    t_const = 0;
}

步骤二：插补周期内的位置计算

// 每个插补周期（如1ms）调用一次
// 输入：当前时间t，各阶段时间
// 输出：当前各轴位置

double lambda;
if (t < t_acc) {
    // 加速段：s = 0.5*a*t²
    double s = 0.5 * a * t * t;
    lambda = s / L;
} else if (t < t_acc + t_const) {
    // 匀速段：s = v_max*(t - t_acc/2)
    double s = v_max * (t - t_acc/2);
    lambda = s / L;
} else if (t < T) {
    // 减速段：s = L - 0.5*a*(T-t)²
    double t_remain = T - t;
    double s = L - 0.5 * a * t_remain * t_remain;
    lambda = s / L;
} else {
    lambda = 1.0;
}

// 计算各轴位置
x_cur = x0 + lambda * dx;
y_cur = y0 + lambda * dy;
z_cur = z0 + lambda * dz;

步骤三：脉冲输出与方向控制

对于步进电机系统，需要将各轴位置增量转换为脉冲频率和方向信号。通常采用 DDA（数字微分分析）算法或 Bresenham 直线算法来分配各轴脉冲。核心思想是：每个插补周期内，根据各轴位移比例分配脉冲数，保证各轴同步。

// 每个插补周期内各轴脉冲数
int pulse_x = (int)(lambda * dx / pulse_per_mm);
int pulse_y = (int)(lambda * dy / pulse_per_mm);
int pulse_z = (int)(lambda * dz / pulse_per_mm);

// 方向判断
dir_x = (dx > 0) ? 1 : -1;
dir_y = (dy > 0) ? 1 : -1;
dir_z = (dz > 0) ? 1 : -1;

4.4 案例拆解：三轴运动平台的直线插补实现

下面通过一个完整的工程案例，展示直线插补从参数设定到实际运动的全过程。

场景：某三轴点胶平台，需要从点 A(10, 20, 5) 直线运动到点 B(50, 80, 25)，单位 mm。最大速度 v_max = 100 mm/s，加速度 a = 500 mm/s²，插补周期 T_s = 1ms。

第一步：参数计算

ΔX = 50-10 = 40 mm
ΔY = 80-20 = 60 mm
ΔZ = 25-5  = 20 mm
L = √(40² + 60² + 20²) = √(1600+3600+400) = √5600 ≈ 74.83 mm

验证能否达到最大速度：
v_max²/a = 100²/500 = 20 mm < L=74.83 mm → 能达到最大速度

加速时间 t_acc = 100/500 = 0.2 s
匀速时间 t_const = (74.83 - 100×0.2)/100 = (74.83-20)/100 = 0.5483 s
总时间 T = 0.2 + 0.5483 + 0.2 = 0.9483 s

第二步：插补点计算（部分）

第三步：验证轨迹直线度

在任意时刻，各轴位置应满足直线方程。以 t=500ms 为例：

理论位置：X = 10 + 0.5345×40 = 31.38 ✓
          Y = 20 + 0.5345×60 = 52.07 ✓
          Z = 5 + 0.5345×20 = 15.69 ✓

验证比例关系：(X-10)/40 = (Y-20)/60 = (Z-5)/20 = 0.5345 ✓

第四步：实际运行效果

在 1ms 插补周期下，共产生 949 个插补点。每个周期内计算各轴位置并输出脉冲。实测轨迹最大偏差 < 0.01mm，满足点胶精度要求。整个运动过程平稳，无冲击。

4.5 总结与工程要点

直线插补虽然数学形式简单，但在工程实现中需要关注以下要点：

• 参数方程的统一性：所有轴共享 λ 参数，保证同步性；各轴增量比例恒定，保证轨迹为直线。
• 速度规划的选择：根据应用场景选择梯形或 S 型曲线；高速高精场景优先 S 型，低成本场景可用梯形。
• 插补周期与精度：插补周期越短，轨迹越平滑，但 CPU 负载越高；需在精度与实时性之间平衡。
• 误差处理：浮点运算误差、脉冲量化误差、机械间隙误差都需要在系统设计中考虑。
• 前瞻控制：在多段连续直线插补时，段间速度衔接需要前瞻算法，避免每段都从零加速。

直线插补是所有运动控制算法的基础。掌握了二维和三维直线插补的原理与实现，后续的圆弧插补、样条插补以及多轴联动控制都将在此基础上扩展。建议读者在理解本章内容后，动手编写一个简单的直线插补仿真程序，观察不同速度规划参数对轨迹和速度曲线的影响，这将极大加深对插补原理的理解。