机械臂轨迹规划：五次NUBUS算法实战解析

1. 机械臂轨迹规划的痛点与挑战

机械臂轨迹规划是工业自动化领域的老大难问题。从业者都知道，要让机械臂运动既丝滑又精准，就像要求一个200斤的壮汉跳芭蕾舞——既要力量又要优雅。在实际项目中，我们经常遇到几个典型问题：

首先是运动不平滑导致的振动问题。很多新手喜欢用简单的直线插补或圆弧插补，结果机械臂运行起来一顿一顿的，末端执行器抖得像帕金森患者。这不仅影响加工精度，长期还会加速机械部件磨损。

其次是过冲问题。当机械臂需要急停或改变方向时，如果加速度规划不当，就会出现明显的"刹不住车"现象。我见过最夸张的案例是一个6轴机械臂在高速运行时突然急停，结果末端偏移了将近5cm，直接把工件撞飞了。

第三个常见问题是速度不连续。很多传统规划算法只考虑位置连续，忽略了高阶导数（速度、加速度）的连续性。这就好比开车时油门和刹车都是突然踩到底，乘客不被甩晕才怪。

经验之谈：在实际项目中，轨迹不平滑导致的问题往往比精度不足更致命。一个0.1mm的静态误差可能可以接受，但0.01mm的振动就可能让精密装配功亏一篑。

2. 为什么选择五次非均匀B样条(NUBUS)

面对这些挑战，行业里试过各种解决方案。多项式插值容易产生龙格现象，贝塞尔曲线控制点太多，B样条就成了折中的优选。而在各种B样条中，五次非均匀B样条(Non-Uniform B-Spline, NUBUS)特别适合机械臂应用，原因有三：

2.1 高阶连续性保障

五次NUBUS能保证位置、速度、加速度、加加速度（jerk）甚至加加加速度（snap）的连续性。这相当于给机械臂的运动上了五重保险：

• C0连续：位置不会突变
• C1连续：速度连续变化
• C2连续：加速度平滑过渡
• C3连续：加加速度有限制
• C4连续：加加加速度受控

这种高阶连续性让机械臂的运动就像德芙巧克力广告一样——纵享丝滑。

2.2 局部控制特性

与多项式插值不同，NUBUS具有局部控制性。修改一个控制点只会影响局部曲线，不会像贝塞尔曲线那样"牵一发而动全身"。这个特性在实际调试中非常实用，比如当发现某段轨迹需要微调时，我们只需调整附近的几个控制点即可。

2.3 非均匀参数化优势

非均匀参数化允许我们在关键区域（如拐角处）设置更密集的节点，而在直线段使用稀疏节点。这就像老司机开车——直道踩