4. 插补算法概述

在RTOS（实时操作系统）运动控制系统中，插补（Interpolation）是决定轨迹精度与运动平滑性的核心环节。插补算法的本质是在已知的路径起点与终点（或控制点序列）之间，按照一定的数学规则实时计算出中间点的坐标，并将这些坐标以周期性的脉冲或位置增量形式输出给伺服驱动器。对于嵌入式工程师而言，选择何种插补算法不仅影响加工表面的质量，还直接关系到CPU的负载率、内存占用以及实时性保障的难度。本章将从数学原理、工程实现、适用场景三个维度，系统剖析直线插补、圆弧插补、样条插补、B样条与NURBS的异同，并给出在RTOS环境下的选型建议。

上图从算法家族的角度梳理了五类插补方法的关系。直线与圆弧属于基础解析插补，其数学表达简单、计算量小，是绝大多数运动控制器的标配；样条插补（通常指三次样条）通过分段多项式拟合离散点，保证了位置与速度的连续；B样条与NURBS则属于参数化样条，引入了控制点、权因子与节点向量，为复杂曲面加工提供了统一的数学框架。下面我们逐一展开。

4.1 直线插补：从点对点到位移的离散化

4.1.1 核心原理

直线插补的任务是在起点P0(x0,y0)与终点P1(x1,y1)之间，按照插补周期Ts（例如1ms）计算出每个周期应输出的坐标增量。其数学基础是参数方程：

P(t) = P0 + t * (P1 - P0),  t ∈ [0, 1]

在RTOS实现中，通常不使用浮点参数t，而是采用数字积分法（DDA）或逐点比较法。DDA法将位移分解为X、Y轴的速度分量，每个插补周期累加一次，当累加器溢出时输出一个脉冲。例如，X轴位移量为ΔX=5000脉冲，Y轴为ΔY=3000脉冲，插补周期为1ms，则每个周期X轴累加5000/总周期数，Y轴累加3000/总周期数。

4.1.2 判断方法与操作流程

在工程中判断是否采用直线插补，主要看两点：轨迹是否为直线段，以及是否允许在拐角处停顿。操作流程如下：

1. 解析G代码（如G01），提取终点坐标与进给速度F。
2. 根据速度F与插补周期Ts计算单周期位移量ΔL = F * Ts。
3. 将ΔL分解为X、Y轴分量，并转换为各轴脉冲数。
4. 在RTOS定时器中断中，按周期输出脉冲或写入比较寄存器。

4.1.3 案例拆解：三轴点胶机的直线轨迹

某点胶设备要求以F=100mm/s的速度沿直线从(10,20)运动到(30,50)，脉冲当量为0.01mm/pulse，插补周期1ms。计算得ΔL=0.1mm/周期，对应10个脉冲。X轴位移20mm=2000脉冲，Y轴位移30mm=3000脉冲。总周期数=sqrt(2000²+3000²)/10≈360周期。每个周期X轴输出2000/360≈5.56脉冲，Y轴输出3000/360≈8.33脉冲。实际实现时，采用DDA累加器：X轴累加器每周期加556（放大100倍），溢出时输出5或6个脉冲，保证平均速度精确。该案例中，RTOS需要确保定时器中断的抖动小于5%，否则会出现轨迹偏移。

4.1.4 常见误区与总结

误区一：认为直线插补只能用于XY平面。实际上通过坐标变换可扩展到五轴联动。误区二：忽略加减速过程。若直接按目标速度输出，电机会失步。正确做法是采用梯形或S形加减速曲线，在每个插补周期动态计算当前速度。总结：直线插补是基础，但工程实现必须结合加减速与前瞻控制。

4.2 圆弧插补：圆心法与半径法的实时计算

4.2.1 核心原理

圆弧插补的数学描述为：给定起点、终点、圆心（或半径）及方向（顺/逆时针），计算圆弧上各插补点。常用方法有角度增量法和弦线逼近法。角度增量法将圆心角θ按插补周期等分，每个周期计算新的角度θi，然后通过三角函数求坐标。弦线逼近法则用直线段逼近圆弧，需保证弦高误差小于允许值（如0.001mm）。

4.2.2 判断方法与操作流程

判断圆弧插补的关键输入是G02/G03指令中的I、J、K（圆心相对起点偏移）或R（半径）。操作流程：

1. 由起点、终点、圆心计算半径R与起始角θs、终止角θe。
2. 根据进给速度F与插补周期Ts计算角速度ω = F / R。
3. 每个周期更新θi = θs + ω * i * Ts，计算坐标并输出。
4. 检查是否越过终止角，若越过则修正为终点坐标。

4.2.3 案例拆解：CNC铣削内轮廓圆弧

某CNC加工半径R=25mm的1/4圆弧，起点(25,0)，终点(0,25)，F=200mm/min≈3.33mm/s，Ts=2ms。角速度ω=3.33/25=0.133rad/s，每周期转角Δθ=0.000266rad。若采用角度增量法，需调用sin/cos函数，在ARM Cortex-M7上单次计算约需2μs，占插补周期2ms的0.1%，完全可接受。但若使用低端MCU（如Cortex-M0），sin/cos库函数可能耗时50μs，此时应改用查表法或CORDIC算法。实际测试中，采用查表法（1024点表）后，计算时间降至3μs，且精度满足0.01mm要求。

4.2.4 常见误区与总结

误区一：忽略圆弧方向（G02/G03）导致过切。误区二：当圆弧半径很小而进给速度很高时，角速度过大，导致每个周期角度增量超过1°，弦高误差超标。此时应自动降低进给速度。总结：圆弧插补的关键是平衡计算精度与实时性，必要时采用混合逼近策略。

4.3 样条插补：三次样条与参数样条的连续性

4.3.1 核心原理

样条插补用于通过一系列离散型值点（如CAD/CAM生成的刀位点）构造平滑曲线。三次样条在每个区间[xi, xi+1]上定义一个三次多项式Si(x)，并满足：函数值连续、一阶导数连续、二阶导数连续（即C2连续）。其数学表达为：

Si(x) = ai + bi(x-xi) + ci(x-xi)² + di(x-xi)³

在RTOS中实现时，通常预先离线计算各段系数，插补周期内仅需代入当前参数t计算坐标，计算量远小于在线求解方程组。

4.3.2 判断方法与操作流程

判断是否使用样条插补：当轨迹点密集且要求速度连续时（如模具精加工），应选用样条。操作流程：

1. 读取CAM输出的刀位点序列（APT或G代码中的G06.2）。
2. 离线（或上电初始化时）计算各段三次多项式系数。
3. 根据当前进给速度计算参数t的增量Δt = F * Ts / 弧长。
4. 每个周期计算P(t)并输出。

4.3.3 案例拆解：五轴叶片加工样条拟合

某叶片加工路径包含120个离散点，若用直线插补连接，会产生明显折痕。采用三次样条拟合后，最大弓高误差从0.05mm降至0.008mm。但样条插补的代价是：离线计算120个点的三对角方程组耗时约15ms（在Cortex-A8上），且需要额外存储360个系数（每个点4个系数×3轴）。在RTOS中，这些计算放在初始化任务中完成，不占用实时插补周期。实际加工中，插补周期1ms，每个周期计算3次多项式（3轴），耗时约8μs，满足实时性要求。

4.3.4 常见误区与总结

误区一：将样条插补等同于B样条。实际上三次样条是插值（通过所有点），而B样条是逼近（不通过控制点）。误区二：忽略参数化方法。采用均匀参数化在曲率变化大时会产生速度波动，应采用弦长参数化。总结：样条插补适合离线规划、在线执行的场景，是连接离散点与连续运动的重要桥梁。

4.4 B样条与NURBS：统一建模与实时求值

4.4.1 核心原理

B样条曲线由控制点Pi、节点向量U和阶数k定义，其数学表达式为：

C(u) = Σ Ni,k(u) * Pi,  i=0..n

其中Ni,k(u)为k阶B样条基函数，由Cox-de Boor递推公式计算。B样条具有局部支撑性（修改一个控制点只影响附近曲线段）和凸包性。NURBS（非均匀有理B样条）在B样条基础上引入权因子wi，可精确表示圆锥曲线（如圆弧、椭圆）：

C(u) = Σ Ni,k(u) * wi * Pi / Σ Ni,k(u) * wi

4.4.2 判断方法与操作流程

在RTOS中实现NURBS插补，核心是实时计算参数u的增量。常用方法有泰勒展开法：根据进给速度与曲线导数计算du/dt。操作流程：

1. 解析NURBS定义（控制点、权因子、节点向量）。
2. 预计算基函数值或采用递推算法。
3. 每个插补周期：计算C(u)与C'(u)，根据F计算Δu。
4. 更新u = u + Δu，输出坐标。

4.4.3 案例拆解：高速模具加工中的NURBS实时插补

某高速铣床加工复杂型腔，CAM输出NURBS曲线（阶数3，控制点45个）。在RTOS（VxWorks）中，插补周期0.5ms。实测计算开销：Cox-de Boor递推计算基函数约需12μs，计算C(u)与C'(u)共需25μs，加上加减速处理共约40μs，占周期8%。若采用直接泰勒展开（一阶近似），在曲率半径小的地方速度误差达5%，需改用二阶泰勒展开，计算量增加至55μs，仍可接受。实际加工中，通过将NURBS插补任务优先级设为高于普通运动控制任务，确保了实时性。

4.4.4 常见误区与总结

误区一：认为NURBS一定优于B样条。实际上对于不需要精确圆锥曲线的场合，B样条计算量更小。误区二：忽略节点向量的影响。非均匀节点向量可更好地控制曲线形状，但也会增加计算复杂度。误区三：在低端MCU上强行实现NURBS，导致插补周期超时。总结：B样条与NURBS是现代运动控制的发展方向，但必须根据处理器算力与实时性要求合理选择。

综上所述，五种插补算法各有其数学基础与工程适用边界。直线与圆弧是基石，样条是桥梁，B样条与NURBS则是面向未来的高级工具。在RTOS环境下，插补算法的选择不仅要看轨迹精度，还要综合考虑CPU负载、内存占用、实时性保障难度以及后续维护成本。建议工程师在项目启动时，先根据加工对象确定所需的连续性等级（C0/C1/C2），再评估硬件算力，最后通过实测数据确定最终方案。