轨迹平滑度量化指标：从直觉到数学

做轨迹规划的人，最怕什么？

怕机器人跑起来像喝了二两白酒——忽快忽慢，拐弯还带个哆嗦。这种抖动，肉眼能看出来，但光靠看是不够的。你得有数据，有指标，能量化。

这一章，我们就来聊聊四个核心的平滑度量化指标。我个人习惯把它们分成两组：时域指标和频域指标。加加速度和曲率变化率看的是时间上的变化，弦误差看的是空间上的偏差，而傅里叶频谱分析，则是从频域角度给你另一双眼睛。

2.1 加加速度（Jerk）——抖动的"加速度"

大家都知道加速度是速度的变化率。那加加速度是什么？说白了，就是加速度的变化率。

数学上很简单：

Jerk = da/dt = d²v/dt² = d³p/dt³

单位是 m/s³ 或 mm/s³。数值越大，说明加速度变化越剧烈，机器人受到的冲击就越强。

为什么加加速度重要？

• 机械冲击：高加加速度意味着关节电机扭矩突变，齿轮、皮带会承受冲击载荷。我在项目中遇到过一台六轴机器人，运行轨迹的加加速度峰值超过 5000 mm/s³，结果用了不到三个月，减速器就出现了明显的齿隙。
• 振动激励：加加速度的突变会激发机械结构的固有频率。你想想看，一个突然的"抖"，就像敲了一下音叉，结构会自己振起来。
• 轨迹跟踪误差：伺服系统对加速度变化有响应延迟。加加速度越大，实际轨迹与规划轨迹的偏差就越大。

2.2 曲率变化率——路径弯曲的"加速度"

加加速度看的是时间域，曲率变化率看的是空间域。

曲率 κ 描述路径在某一点的弯曲程度。曲率变化率 dκ/ds，就是曲率沿路径长度的变化率。单位是 1/m²。

为什么曲率变化率重要？

• 路径上曲率突变的地方，机器人必须急转弯。急转弯意味着离心力突变，轨迹就容易"甩出去"。
• 曲率变化率过大，会导致刀具或末端执行器在加工表面留下"刀痕"——这在曲面加工中是致命的。

我记得有一次做五轴联动加工轨迹优化，客户反馈加工出来的曲面有肉眼可见的条纹。我一看数据，曲率变化率峰值高达 0.8 1/m²。后来通过 B 样条曲线重构，把曲率变化率压到 0.1 1/m² 以下，条纹就消失了。

指标	关注维度	典型阈值（工业机器人）	典型阈值（高精度加工）
加加速度	时间域	< 2000 mm/s³	< 500 mm/s³
曲率变化率	空间域	< 0.5 1/m²	< 0.1 1/m²

2.3 弦误差——路径与指令的"距离"

弦误差，也叫轮廓误差。它衡量的是实际轨迹与理想轨迹之间的最大垂直距离。

为什么会有弦误差？因为控制器是离散的。它每隔一个控制周期（比如 1ms）下发一个位置指令，两个指令点之间，机器人走的是直线。如果理想路径是曲线，那这条直线就会"切掉"曲线的一部分，产生误差。

弦误差的计算：

ε = ρ - √(ρ² - (L/2)²)

其中 ρ 是曲率半径，L 是插补步长。曲率越大、步长越长，弦误差就越大。

我个人的习惯是：在直线段允许较大的弦误差（比如 0.1mm），在圆弧段收紧到 0.01mm。这样既保证了精度，又不会让控制器"累死"。

2.4 傅里叶频谱分析——从频域看抖动

前面三个指标都是在时域或空间域看问题。但有些抖动，时域里看不清楚。比如，一个 10Hz 的周期性抖动，叠加在轨迹上，你从位置曲线上可能只能看到一条"毛茸茸"的线。

这时候，傅里叶变换就派上用场了。

把轨迹信号（比如速度、加速度、力矩）从时域变换到频域，你就能看到：

• 哪些频率成分占主导？
• 这些频率是否接近机械结构的固有频率？
• 抖动是随机噪声还是周期性振动？

具体做法：

1. 采集一段轨迹的速度或加速度数据。
2. 做 FFT（快速傅里叶变换）。
3. 看频谱图。如果某个频率的幅值明显高于其他频率，那就是抖动的"元凶"。

2.5 知识体系总览

下面这张图，把四个指标的关系和适用场景梳理清楚了。你可以把它当作一个快速参考。

2.6 四个指标怎么选？

你可能会问：这么多指标，我到底该用哪个？

我的建议是：不要单选，要组合。

• 日常调试：先看加加速度和曲率变化率。这两个指标计算简单，能快速反映轨迹的"粗暴程度"。
• 精度敏感场景：加上弦误差。比如焊接、涂胶、铣削，弦误差直接决定产品质量。
• 抖动排查：上傅里叶频谱。当抖动原因不明时，频谱能帮你定位频率源。