4. 梯形加减速算法：梯形曲线数学模型、加速/匀速/减速三段式、优缺点分析

各位工程师朋友，今天我们来聊聊梯形加减速算法。

说实话，这是我在实际项目中用得最多的加减速方式。为什么？因为它简单、可靠、容易调。你想想看，在印刷机械这种对实时性要求极高的场合，一个算法如果太复杂，反而容易出问题。

4.1 梯形曲线的数学模型

梯形加减速，说白了就是速度曲线像个梯形。我习惯把它分成三段：加速段、匀速段、减速段。

先看数学表达。假设我们设定：

  • 起始速度：Vstart
  • 目标速度：Vtarget
  • 加速度：Aacc
  • 减速度：Adec
  • 总位移：S

那么加速段时间 tacc = (Vtarget - Vstart) / Aacc

减速段时间 tdec = (Vtarget - Vend) / Adec

加速段位移 Sacc = Vstart * tacc + 0.5 * Aacc * tacc2

减速段位移 Sdec = Vtarget * tdec - 0.5 * Adec * tdec2

匀速段时间 tconst = (S - Sacc - Sdec) / Vtarget

核心要点：梯形曲线的关键就是这三个时间段的计算。只要算对了，运动控制就稳了。

4.2 加速/匀速/减速三段式详解

我刚开始做印刷机控制时，总觉得三段式太简单。后来才发现，简单的东西往往最可靠。

加速段：

速度从 Vstart 线性增加到 Vtarget。加速度恒定，所以速度曲线是一条直线。我在项目中遇到过一个问题：加速太猛，纸张会打滑。后来我学乖了，加速度一般控制在 0.5g 以内。

匀速段：

速度保持 Vtarget 不变。这是印刷质量最稳定的阶段。嗯，这里要注意：匀速段不能太短，否则印刷效果会受影响。我一般要求匀速段至少占总行程的 30%。

减速段：

速度从 Vtarget 线性降到 Vend。减速度通常和加速度一样，但也可以不同。我记得有一次调试，发现减速太慢会导致纸张堆积，后来把减速度调大了 20%，问题就解决了。

实战技巧：我个人习惯把加速和减速的斜率设成一样。这样代码写起来简单，调试也方便。除非有特殊要求，否则对称梯形曲线是最稳妥的选择。

4.3 优缺点分析

梯形加减速不是万能的，但它确实是最实用的。我们来客观分析一下。

优点 缺点
算法简单，计算量小 加速度突变，有冲击
容易理解和调试 高速时振动较大
实时性好，适合嵌入式 不适合精密定位
参数少，调参方便 加减速段效率不高

为什么会这样？说白了，梯形曲线在加速起点和终点有加速度突变。这个突变会产生冲击力。在印刷机上，冲击会导致套印不准。

避坑指南：我曾经在高速印刷机上用梯形加减速，结果 300m/min 时纸张断裂。后来发现是加速度突变导致的张力波动。从那以后，我建议在高速场合（>200m/min）慎用梯形加减速，或者配合张力控制使用。

4.4 代码实现示例

下面是我常用的梯形加减速计算代码。注意，这是简化版，实际项目中还要考虑边界条件。

// 梯形加减速参数计算
typedef struct {
    float v_start;    // 起始速度
    float v_target;   // 目标速度
    float v_end;      // 结束速度
    float acc;        // 加速度
    float dec;        // 减速度
    float total_dist; // 总位移
    float t_acc;      // 加速时间
    float t_const;    // 匀速时间
    float t_dec;      // 减速时间
    float s_acc;      // 加速位移
    float s_const;    // 匀速位移
    float s_dec;      // 减速位移
} TrapezoidProfile;

void CalcTrapezoidProfile(TrapezoidProfile *p) {
    // 计算加速时间和位移
    p->t_acc = (p->v_target - p->v_start) / p->acc;
    p->s_acc = p->v_start * p->t_acc + 0.5 * p->acc * p->t_acc * p->t_acc;
    
    // 计算减速时间和位移
    p->t_dec = (p->v_target - p->v_end) / p->dec;
    p->s_dec = p->v_target * p->t_dec - 0.5 * p->dec * p->t_dec * p->t_dec;
    
    // 计算匀速时间和位移
    p->s_const = p->total_dist - p->s_acc - p->s_dec;
    p->t_const = p->s_const / p->v_target;
}

注意：实际应用中，一定要检查 s_const 是否大于0。如果小于0，说明总位移不够，需要重新规划速度曲线。我一般会加一个判断，如果 s_const < 0，就降低目标速度。

4.5 梯形曲线知识体系图

下面我用一张图来总结梯形加减速的核心知识。这张图是我做培训时常用的，帮助大家快速建立整体认知。

梯形加减速算法知识体系 梯形加减速 数学模型 三段式结构 优缺点分析 速度公式：V(t) = V0 + A*t 位移公式：S(t) = V0*t + 0.5*A*t² 时间计算：t = (Vt - V0) / A 加速段：速度线性上升 匀速段：速度保持恒定 减速段：速度线性下降 优点：简单、可靠、易调 缺点：加速度突变有冲击 适用：中低速、非精密场合 梯形加减速：工业控制中最实用的加减速方案 适合80%的印刷机械运动控制场景

这张图把梯形加减速的核心内容都串起来了。你想想看，从数学模型到三段式结构，再到优缺点分析，是不是一目了然？

个人建议：刚开始做运动控制的朋友，先从梯形加减速入手。把基础打牢了，再去研究S形加减速、多项式加减速这些高级算法。我在带新人时，都是让他们先写一个梯形加减速的demo，跑通了再谈别的。

好了，梯形加减速就讲到这里。记住它的核心：简单、可靠、实用。在印刷机械上，80%的场景用梯形加减速就够了。剩下的20%，我们后面再聊。

公众号:蓝海资料掘金营，微信deep3321

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