3. 梯形速度规划：原理与数学模型、加速-匀速-减速三段式结构、适用场景与局限性
梯形速度规划，这个名字很形象。你想想看，把速度随时间的变化画出来，就是一个梯形——先斜着上去，再平着走一段，最后斜着下来。这是运动控制里最基础、最常用的速度曲线，没有之一。
我刚开始做运动控制那会儿，第一个接触的就是它。为什么？因为简单、直观、好调。但后来踩的坑多了，才发现它也有不少脾气。今天咱们就把它的底裤扒干净。
3.1 核心原理与数学模型
说白了，梯形速度规划就是把整个运动过程切成三段：
- 加速段：以恒定加速度
a从初速度v₀加速到目标速度v_max - 匀速段：以
v_max匀速运行 - 减速段：以恒定减速度
-a从v_max减速到v_end
数学上，每一段的速度和位移都可以用简单的公式表达。我习惯把核心公式记在脑子里，现场调试时随手就能算：
// 加速段 (0 ≤ t ≤ t₁)
v(t) = v₀ + a·t
s(t) = v₀·t + ½·a·t²
// 匀速段 (t₁ ≤ t ≤ t₂)
v(t) = v_max
s(t) = s₁ + v_max·(t - t₁)
// 减速段 (t₂ ≤ t ≤ t₃)
v(t) = v_max - a·(t - t₂)
s(t) = s₂ + v_max·(t - t₂) - ½·a·(t - t₂)²这里有个关键点：加速和减速的加速度大小通常取相同值，这样曲线对称，计算简单。但实际项目中，如果负载特性不一样，也可以分别设置 a_acc 和 a_dec。我曾经在一个重载龙门架上就这么干过——上升和下降的加速度差了将近一倍。
核心参数关系：
加速时间 t₁ = (v_max - v₀) / a
减速时间 t₃ - t₂ = (v_max - v_end) / a
匀速时间 t₂ - t₁ = (总位移 - 加速位移 - 减速位移) / v_max
如果匀速时间 ≤ 0，说明根本跑不到目标速度——这就是后面要讲的「三角型」情况。
3.2 三段式结构详解
咱们把三段拆开来看，每一段都有它的脾气。
3.2.1 加速段
加速段决定了系统的「爆发力」。加速度越大，到达目标速度越快，但冲击也越大。我见过不少工程师为了赶节拍，把加速度设得特别高，结果机器抖得像筛子一样。
这里有个经验值：加速度一般取电机额定转矩对应加速度的 60%~80%，留点余量给负载波动和机械磨损。
3.2.2 匀速段
匀速段是效率最高的阶段。电机在恒速下运行，电流平稳，发热小。但要注意：如果总位移太短，匀速段可能根本不存在。
我记得有一次调试一个点胶平台，客户要求 50mm 行程内跑到 500mm/s。我算了一下，加速到 500mm/s 需要 100mm 的加速距离——这还没开始减速就已经超行程了。最后只能把目标速度降到 300mm/s，才勉强跑出匀速段。
3.2.3 减速段
减速段最容易出问题。很多人只关心加速，忽略了减速。实际上，减速段的加速度如果设置不当，轻则过冲，重则撞机。
我建议减速段留一个「安全系数」：实际减速度取理论值的 80%。这样即使负载变化或者摩擦力波动，也能稳稳停住。
我的调试习惯：先单独测试减速段。让电机从最高速直接减速到零，观察实际停止位置和理论位置的偏差。如果偏差超过 1 个脉冲当量，就说明减速参数需要调整。
3.3 适用场景与局限性
梯形速度规划不是万能的。咱们得知道它适合什么、不适合什么。
| 场景 | 适用性 | 说明 |
|---|---|---|
| 点位运动（Point-to-Point） | ✅ 非常适合 | 起点到终点，中间不关心路径形状 |
| 传送带/输送线 | ✅ 非常适合 | 长距离匀速，加减速段占比小 |
| 高精度轮廓加工 | ❌ 不适合 | 加速度突变导致轮廓误差 |
| 高速轻载机械手 | ⚠️ 勉强可用 | 需要配合 S 型曲线平滑 |
| 重载/大惯量系统 | ⚠️ 需谨慎 | 加速度突变可能损坏机械 |
梯形规划最大的问题是什么？加速度在拐点处突变。从加速段切换到匀速段的那一刻，加速度从 a 瞬间变成 0。这个突变会产生一个冲击力，叫做「加加速度」（Jerk）。
数学上，加加速度是加速度对时间的导数。梯形规划的加加速度在拐点处是无穷大——当然实际中不可能无穷大，但确实会产生明显的振动。
我曾经踩过的坑：在一个半导体封装设备上，我用梯形规划驱动一个 20kg 的 XY 平台。速度 800mm/s，加速度 5m/s²。结果每次加减速切换时，平台都会「咯噔」一下，导致焊线位置偏移了 0.02mm。后来换成 S 型曲线才解决。
所以，如果你的设备对振动敏感（比如光学检测、精密装配），梯形规划要慎用。
3.4 梯形规划的变体：三角型规划
当总位移太短，加速到目标速度之前就必须开始减速时，梯形就变成了三角形。这种情况在实际项目中非常常见。
三角型规划没有匀速段，只有加速和减速。它的数学模型更简单：
// 最大可达速度 v_peak
v_peak = sqrt(v₀² + a·s_total) // 假设 v₀ = v_end
// 加速时间 = 减速时间
t_acc = t_dec = (v_peak - v₀) / a
// 总时间
t_total = 2 · t_acc注意：三角型规划的实际峰值速度 v_peak 一定小于设定的 v_max。如果你发现电机永远跑不到设定速度，八成就是进入了三角型模式。
判断方法：计算理论加速距离 s_acc = v_max² / (2·a)。如果 s_acc × 2 ≥ 总位移，那么就是三角型规划。
3.5 梯形规划的知识体系
下面这张图把梯形速度规划的核心逻辑串起来了。我建议你把它存下来，调试时对照着看。
3.6 实际调试中的注意事项
最后，分享几个我在现场总结出来的经验：
- 加速度不要超过电机额定转矩的 80%。留点余量给负载波动和电压波动。
- 减速段单独测试。让电机从最高速直接减速到零，观察停止精度。
- 注意三角型规划。如果电机永远跑不到设定速度，检查是否进入了三角型模式。
- 梯形规划不适合振动敏感设备。如果设备有精密光学或测量功能，考虑 S 型曲线。
- 加减速时间不要小于伺服驱动器的电流环响应时间。一般建议加减速时间 > 10ms。
一个小技巧：如果你不确定梯形规划是否合适，先跑一个空载测试。把加速度设到目标值的 50%，观察电机电流波形。如果电流在加减速切换点出现明显尖峰，说明冲击太大，需要平滑处理。
梯形速度规划就像一把螺丝刀——简单、可靠、够用。但你不能拿它去拧六角螺栓。知道它的边界，才能用好它。