5、S形速度曲线：7段式S曲线原理、加加速度约束、时间计算

好，咱们今天聊聊S形速度曲线。说实话，梯形速度曲线虽然简单，但在实际工业现场，尤其是高精度定位场景下，它那个加速度突变的问题，真的让人头疼。我记得有一次调试一台高速贴片机，用梯形曲线，每次加减速切换时，机器都会抖一下，贴片精度死活上不去。后来换成S形曲线，问题一下子就解决了。

说白了，S形曲线就是让加速度也平滑变化，而不是瞬间跳变。这样对机械结构的冲击小得多，定位也更稳。

5.1 7段式S曲线的基本原理

标准的7段式S曲线，名字里带个“7”，是因为它把整个运动过程分成了7个阶段。你想想看，从静止加速到匀速，再从匀速减速到停止，中间还要考虑加加速度的变化，7段其实刚刚好。

这7段分别是：

  1. 加加速段：加速度从0开始，以恒定加加速度J增加，直到达到最大加速度A_max。
  2. 匀加速段：加速度保持为A_max，速度线性增加。
  3. 减加速段：加速度从A_max以恒定加速度-J减小到0，速度增加变缓。
  4. 匀速段：加速度为0，速度保持最大值V_max。
  5. 加减速段：加速度从0以恒定加加速度-J减小到-A_max，速度开始下降。
  6. 匀减速段：加速度保持为-A_max，速度线性下降。
  7. 减减速段：加速度从-A_max以恒定加加速度J增加到0，速度缓慢降到0。

嗯，这里要注意，并不是每次运动都会完整经历这7段。如果位移很短，可能连最大速度都达不到，那就只有加加速、减加速、加减速、减减速这4段，甚至更少。我在项目中遇到过这种情况，当时按7段去算时间，结果发现算出来的总时间比实际需要的长，后来才意识到是速度没跑到最大值。

5.2 加加速度约束

加加速度J，英文叫Jerk，是S形曲线的灵魂。它描述的是加速度的变化率，单位是m/s³。为什么要有这个约束？

我打个比方，你开车时如果一脚油门踩到底，推背感很强，这就是加速度大。但如果你的脚从静止状态瞬间踩到底，那就是加加速度无穷大，车会猛地一窜。工业机器人也是一样，加加速度太大，电机电流会剧烈波动，齿轮箱会发出异响，末端执行器会抖动。

加加速度约束通常由以下几个因素决定：

  • 电机驱动器性能：驱动器响应越快，能支持的Jerk越大。
  • 机械结构刚度：结构越软，Jerk就要越小，否则容易引起共振。
  • 负载特性：负载越重，Jerk越小，防止惯性冲击。
  • 工艺要求：比如涂胶、焊接等对轨迹平滑度要求高的场景，Jerk要设得很小。

核心要点：加加速度J是S形曲线区别于梯形曲线的关键。没有Jerk约束，加速度就会突变，运动就不平滑。

5.3 时间计算

时间计算是S形曲线里最麻烦的部分。我刚开始做的时候，也是对着公式推导了半天。其实核心思路很简单：根据给定的位移S、最大速度V_max、最大加速度A_max、加加速度J，算出每一段的时间。

咱们先假设一个完整的7段情况。设各段时间分别为T1到T7。由于对称性，加速段和减速段的时间是对称的：

  • T1 = T3 = T5 = T7 = A_max / J
  • T2 = (V_max / A_max) - (A_max / J)
  • T4 = (S - S_acc - S_dec) / V_max

其中S_acc是加速段的总位移，S_dec是减速段的总位移。如果算出来T2或T4是负数，说明实际运动达不到最大速度或最大加速度，需要重新调整。

我习惯用下面这个流程来判断：

  1. 先假设能达到V_max和A_max，算出T1、T2、T3。
  2. 如果T2 < 0，说明达不到V_max，需要降速处理。
  3. 再算T4，如果T4 < 0，说明位移太短，连匀速段都没有。
  4. 如果T1 < 0，说明连A_max都达不到，只能用三角形S曲线。

这里我贴一段伪代码，帮你理解计算逻辑：

// 输入：位移S，最大速度Vmax，最大加速度Amax，加加速度J
// 输出：各段时间T1~T7

// 1. 计算加加速段时间
T1 = Amax / J;

// 2. 计算匀加速段时间（假设能达到Vmax）
T2 = (Vmax / Amax) - (Amax / J);

if (T2 < 0) {
    // 达不到Vmax，重新计算
    T2 = 0;
    V_actual = Amax * sqrt(Amax / J);  // 实际能达到的最大速度
    // 重新调整T1
    T1 = sqrt(V_actual / J);
}

// 3. 计算匀速段时间
S_acc = J * T1^3 + 0.5 * J * T1^2 * T2 + 0.5 * Amax * T2^2;
S_dec = S_acc;  // 对称
T4 = (S - S_acc - S_dec) / V_actual;

if (T4 < 0) {
    // 位移太短，没有匀速段
    T4 = 0;
    // 需要重新计算整个曲线
}

个人经验：实际工程中，我建议把Jerk设得比驱动器极限值小20%左右。为什么呢？因为理论计算是理想情况，实际电机响应有延迟，留点余量能避免加速度超调。我曾经吃过这个亏，Jerk设得太极限，结果电机在加减速切换时出现了震荡。

5.4 实际应用中的避坑指南

最后，我总结几个实际项目中容易踩的坑：

  • 坑一：忽略系统延迟。你算出来的时间，实际跑起来可能会偏长或偏短。因为控制器有计算延迟、通信延迟。我建议在计算出的总时间上乘以1.05~1.1的安全系数。
  • 坑二：Jerk设得太大。有些工程师觉得Jerk越大越好，这样加减速快。但Jerk太大，机械振动会很明显。尤其是多轴联动时，各轴的Jerk不匹配，轨迹会跑偏。
  • 坑三：时间计算不考虑浮点精度。嵌入式系统里浮点运算有误差，尤其是开方运算。我建议用定点数或者查表法来优化，避免累积误差。
  • 坑四：对称性假设不成立。有些场景下，加速和减速的Jerk不一样，比如上升时负载重，下降时负载轻。这时候就不能简单对称了，需要分别计算。

特别注意：S形曲线虽然平滑，但计算量比梯形曲线大得多。如果你的控制器算力有限，比如用低端MCU，建议把Jerk约束做成离线计算，或者用查表法。否则实时计算可能会拖慢控制周期。

好了，关于7段式S曲线的基本原理、加加速度约束和时间计算，就聊到这里。下一节我会讲如何用代码实现这个曲线，以及怎么在实时系统中高效运行。到时候我会分享一个我实际用过的优化技巧，保证让你眼前一亮。

← 上一章 📖 返回目录 下一章 →