4. 贝塞尔曲线与B样条：从手绘到工程化的曲线之路
说到轨迹规划里的曲线表达，贝塞尔和B样条是绕不开的两个名字。我个人最早接触贝塞尔曲线，是在做机械臂的示教路径平滑时。那时候我天真地以为，给几个控制点就能生成一条完美路径——结果在奇异点附近直接飞车了。嗯，后来才明白，曲线工具用得好不好，关键看你怎么理解它的数学骨架。
4.1 贝塞尔曲线：直观但全局的曲线工具
贝塞尔曲线的核心思想很简单：用一组控制点来“牵引”一条曲线。你想想看，就像用磁铁吸引一根软铁丝，每个控制点都有一定的“拉力”，最终曲线就是这些力的平衡结果。
数学上，n次贝塞尔曲线定义为：
C(t) = Σᵢ₌₀ⁿ Bᵢₙ(t) · Pᵢ, t ∈ [0,1]
其中 Bᵢₙ(t) = C(n,i) · tⁱ · (1-t)ⁿ⁻ⁱ这里的Bᵢₙ(t)就是伯恩斯坦基函数。说白了，它决定了每个控制点在参数t处的权重。t从0走到1，曲线就从起点平滑过渡到终点。
关键特性：
- 端点插值：曲线一定经过首尾控制点
- 凸包性：整条曲线被包裹在控制点形成的凸多边形内
- 全局性：移动任何一个控制点，整条曲线都会变化——这是它的优点，也是它的痛点
我在项目中遇到过一个问题：用5阶贝塞尔曲线规划AGV的转弯路径，结果因为一个中间点微调，整个路径都变形了，导致车辆在直道上也出现了不必要的摆动。这就是全局性的代价。
4.2 德卡斯特里奥算法：几何直观的递推之美
计算贝塞尔曲线上的点，最优雅的方式就是德卡斯特里奥算法。它不依赖伯恩斯坦公式，而是用纯几何递推。
算法思路是这样的：
- 给定参数t，在每条控制点连线上按比例t取点
- 把这些新点再连线，再按t取点
- 重复直到只剩一个点——这个点就是曲线上的位置
代码实现非常简洁：
def de_casteljau(points, t):
"""德卡斯特里奥算法计算贝塞尔曲线上的点"""
pts = [np.array(p) for p in points]
while len(pts) > 1:
pts = [(1-t)*pts[i] + t*pts[i+1] for i in range(len(pts)-1)]
return pts[0]实用技巧：德卡斯特里奥算法不仅能算点，还能在递归过程中得到曲线的子分割。如果你想在t=0.3处把曲线切成两段，中间过程的那些点就是子曲线的控制多边形。我在做路径分段优化时经常用这个特性。
4.3 B样条曲线：局部控制的工程利器
贝塞尔曲线的全局性在工程中是个麻烦。你想想，如果我要优化一段路径的某个弯道，结果整条路都跟着变，这显然不合理。B样条曲线就是来解决这个问题的。
B样条的核心改进在于：引入了节点向量和局部支撑性。每个控制点只影响曲线的一段区域，而不是全局。
k次B样条曲线的数学形式：
C(t) = Σᵢ₌₀ⁿ Nᵢₖ(t) · Pᵢ
其中Nᵢₖ(t)是B样条基函数，由Cox-de Boor递推公式定义基函数的递推关系：
Nᵢ₀(t) = 1 if tᵢ ≤ t < tᵢ₊₁, else 0
Nᵢₖ(t) = (t-tᵢ)/(tᵢ₊ₖ-tᵢ) · Nᵢₖ₋₁(t)
+ (tᵢ₊ₖ₊₁-t)/(tᵢ₊ₖ₊₁-tᵢ₊₁) · Nᵢ₊₁ₖ₋₁(t)看着复杂？其实逻辑很简单：每个基函数只在局部节点区间内非零，其他地方都是0。这就实现了“牵一发而不动全身”。
| 特性 | 贝塞尔曲线 | B样条曲线 |
|---|---|---|
| 控制点影响范围 | 全局 | 局部（由节点向量决定） |
| 阶数与控制点关系 | 阶数 = 控制点数 - 1 | 阶数与控制点数独立 |
| 连续性 | Cⁿ（n为阶数） | Cᵏ⁻¹（k为次数） |
| 凸包性 | 整个控制多边形 | 局部凸包（每段只受附近点影响） |
| 工程适用性 | 简单场景、教学演示 | 复杂路径、实时调整 |
避坑指南：我曾经在一条高速移动平台的路径规划中，直接用均匀B样条（节点等距分布）。结果在控制点密集区域出现了不必要的波动。后来换成非均匀节点分布，在曲率变化大的地方加密节点，问题才解决。记住：节点向量的分布直接影响曲线形状，别偷懒用默认值。
4.4 NURBS曲线：统一圆锥曲线与自由曲面的终极方案
NURBS（非均匀有理B样条）是B样条的升级版。它引入了一个权重因子，让曲线不仅能表示自由曲面，还能精确表示圆弧、椭圆等圆锥曲线。
NURBS曲线的定义：
C(t) = Σᵢ₌₀ⁿ Nᵢₖ(t) · wᵢ · Pᵢ / Σⱼ₌₀ⁿ Nⱼₖ(t) · wⱼ这里的wᵢ就是权重。权重越大，曲线越“靠近”对应的控制点。当所有权重相等时，NURBS退化为标准B样条。
为什么需要NURBS？我给你举个例子。在机器人加工路径中，经常需要走圆弧轨迹。用B样条只能近似圆弧，而NURBS可以精确表示。这在精度要求高的场景下，差距就出来了。
NURBS的核心优势：
- 统一表示：自由曲线、圆锥曲线、曲面都用同一套数学框架
- 权重调节：通过修改权重实现形状的局部“拉扯”
- 工业标准：STEP、IGES等数据交换格式都基于NURBS
我个人习惯在路径规划中这样选型：如果路径简单且不需要实时调整，用贝塞尔就够了；如果需要局部修改且对连续性有要求，上B样条；如果涉及圆弧或需要精确几何表达，直接上NURBS。
4.5 知识体系总览
下面这张图帮你理清这几种曲线的关系和演进脉络：
从这张图你能看到，贝塞尔是基础，B样条解决了局部控制问题，NURBS又在B样条基础上加了权重维度。每一层演进都是为了解决工程中的实际问题。
选型建议：如果你刚开始做轨迹规划，我建议从B样条入手。它比贝塞尔灵活，又比NURBS简单。等你对节点向量和基函数有了手感，再上NURBS也不迟。我曾经带过一个团队，一上来就用NURBS做路径优化，结果大部分时间花在调权重上，反而忽略了路径本身的几何合理性。
嗯，这一章的内容就到这里。曲线工具是轨迹规划的“语言”，选对语言，后面的工作才能事半功倍。