4、高阶多项式曲线（上）：3次多项式、5次多项式、7次多项式的构造方法与边界条件

各位工程师，咱们今天聊点硬核的——高阶多项式曲线。

说实话，我刚入行那会儿，觉得电子凸轮嘛，不就是把几个关键点连起来？后来被现场设备狠狠教育了一顿。有一次做高速贴片机，用最简单的3次多项式，结果末端振动大得离谱，贴片头差点把元件甩飞出去。从那以后，我才真正开始研究多项式曲线的边界条件到底该怎么配。

好，咱们一步步来。

4.1 为什么需要高阶多项式？

低阶曲线（比如梯形、修正梯形）在大多数场合够用。但当你遇到以下场景时，就必须上高阶了：

• 速度/加速度连续：设备对冲击敏感，比如晶圆搬运、精密装配
• 末端抖动抑制：高阶曲线能平滑加加速度（Jerk），减少机械共振
• 多段拼接：需要曲线在连接点处不仅位置连续，速度、加速度甚至加加速度都连续

说白了，低阶曲线是“能用”，高阶曲线是“好用”。但代价是什么？计算量大了，参数多了，调起来也更费脑子。

4.2 3次多项式：最基础的平滑曲线

3次多项式，也叫三次样条。它的通用形式是：

s(t) = a0 + a1*t + a2*t^2 + a3*t^3

这里有4个未知系数，所以需要4个边界条件。最常见的设定是：

• 起点位置 s(0) = 0
• 终点位置 s(T) = 1
• 起点速度 v(0) = 0
• 终点速度 v(T) = 0

解出来就是标准的“S型速度曲线”。

我在做一台包装机时，用3次多项式做飞剪控制。切薄纸没问题，一切厚纸板就崩刃。后来一查，加速度突变太大，机械冲击直接把刀片震裂了。嗯，这就是3次多项式的天花板。

4.3 5次多项式：加速度也连续了

5次多项式长这样：

s(t) = a0 + a1*t + a2*t^2 + a3*t^3 + a4*t^4 + a5*t^5

6个系数，需要6个边界条件。除了位置和速度，我们还能约束加速度：

• 起点位置 s(0) = 0
• 终点位置 s(T) = 1
• 起点速度 v(0) = 0
• 终点速度 v(T) = 0
• 起点加速度 a(0) = 0
• 终点加速度 a(T) = 0

解这个方程组，你会得到一条加速度连续、起点终点加速度为零的曲线。这就是工业上最常用的“5次S曲线”。

你想想看，加速度连续意味着什么？意味着加加速度（Jerk）是有限的。机械系统最怕的就是加加速度无穷大——那等于在给设备“砸榔头”。

4.4 7次多项式：追求极致平滑

7次多项式是：

s(t) = a0 + a1*t + a2*t^2 + a3*t^3 + a4*t^4 + a5*t^5 + a6*t^6 + a7*t^7

8个系数，8个边界条件。除了位置、速度、加速度，我们还能约束加加速度（Jerk）：

• 起点位置 s(0) = 0
• 终点位置 s(T) = 1
• 起点速度 v(0) = 0
• 终点速度 v(T) = 0
• 起点加速度 a(0) = 0
• 终点加速度 a(T) = 0
• 起点加加速度 j(0) = 0
• 终点加加速度 j(T) = 0

7次多项式能保证加加速度连续。这意味着什么？意味着加速度的变化率也是平滑的。对于高速高精度设备，这能显著减少残余振动。

4.5 三种多项式的对比

咱们用一张表来对比一下：

特性	3次多项式	5次多项式	7次多项式
系数个数	4	6	8
位置连续	✓	✓	✓
速度连续	✓	✓	✓
加速度连续	✗（端点突变）	✓	✓
加加速度连续	✗	✗	✓
计算复杂度	低	中	高
适用场景	低速、低精度	通用工业	高速高精度

4.6 边界条件的数学构造

咱们以5次多项式为例，看看具体怎么解系数。

设归一化时间 u = t/T，u ∈ [0, 1]。那么：

s(u) = a0 + a1*u + a2*u^2 + a3*u^3 + a4*u^4 + a5*u^5

边界条件：
s(0) = 0,  s(1) = 1
v(0) = 0,  v(1) = 0
a(0) = 0,  a(1) = 0

对s(u)求导得到速度和加速度表达式，代入边界条件，解线性方程组：

a0 = 0
a1 = 0
a2 = 0
a3 = 10
a4 = -15
a5 = 6

所以标准的5次多项式曲线是：

s(u) = 10*u^3 - 15*u^4 + 6*u^5

这个公式你可以在很多运动控制库中看到。它就是“最小加加速度”曲线的一种特例。

4.7 知识体系总览

下面这张图帮你理清三种多项式的关系和选择逻辑：

4.8 实际应用中的选择建议

说了这么多理论，到底怎么选？我个人的经验是：

1. 先试5次多项式：它覆盖了80%的工业场景。计算量适中，效果也够好。
2. 如果振动超标，上7次：但前提是你的控制器算力够，而且机械系统的固有频率确实能被加加速度平滑抑制。
3. 3次多项式只用在低速场合：比如一些简单的搬运、分拣，对冲击不敏感的地方。
4. 别忘了边界条件：同样的多项式，不同的边界条件会得到完全不同的曲线。我见过有人把5次多项式的加速度边界设成非零，结果曲线形状大变，设备直接报警。