4. 梯形速度规划原理
梯形速度规划（Trapezoidal Velocity Profile）是工业伺服运动控制中最基础、应用最广泛的速度规划算法。它将整个运动过程划分为匀加速段、匀速段和匀减速段三个区间，速度曲线呈梯形，因此得名。理解梯形速度规划的数学模型与参数计算，是掌握S曲线、多项式规划等高级算法的基础，也是工程调试中判断系统加减速能力、定位精度和冲击水平的第一把标尺。本节将深入剖析其数学本质、关键参数求解方法，并通过实际案例展示其应用边界与局限性。
上图展示了梯形速度规划的核心数学模型。整个运动过程被三个关键时间点 t₁、t₂、t₃ 划分为三个区间：加速段（0→t₁）、匀速段（t₁→t₂）、减速段（t₂→t₃）。加速段和减速段的加速度值相等（均为 a_max），这是梯形规划最常见的对称形式。实际工程中，若电机正反向驱动能力不同，也可采用非对称加减速，但基本原理一致。下面从数学建模开始逐步展开。
4.1 梯形速度规划的数学模型
梯形速度规划的数学本质是分段线性函数。设目标位移为 S，最大速度为 v_max，最大加速度为 a_max，则速度函数 v(t) 可表示为：
v(t) = a_max × t (0 ≤ t < t₁)
v(t) = v_max (t₁ ≤ t < t₂)
v(t) = v_max - a_max × (t - t₂) (t₂ ≤ t ≤ t₃)对应的位移函数 S(t) 为加速度的二次积分，在三个区间分别呈现抛物线、直线、抛物线的组合形态。加速段位移 S₁ = ½ × a_max × t₁²，匀速段位移 S₂ = v_max × (t₂ - t₁)，减速段位移 S₃ = v_max × (t₃ - t₂) - ½ × a_max × (t₃ - t₂)²。由于对称性，S₁ = S₃，且 t₁ = t₃ - t₂。
在实际运动控制系统中，梯形规划通常以周期中断（如1ms）为基准，将连续时间模型离散化。每个中断周期内，控制器根据当前所处的区间计算目标速度，并通过位置环或速度环进行跟踪。这种离散化实现方式简单高效，计算量极小，非常适合嵌入式环境。
4.2 关键参数计算与边界条件
梯形规划的核心参数计算围绕三个问题展开：给定位移 S 和最大速度 v_max、最大加速度 a_max，如何确定 t₁、t₂、t₃？系统能否达到 v_max？匀速段是否存在？
首先计算加速到 v_max 所需的时间 t_acc = v_max / a_max，对应的加速位移 S_acc = ½ × a_max × t_acc²。若 2 × S_acc ≥ S，说明位移不足以让系统达到最大速度，此时梯形退化为三角形速度规划（无匀速段）。反之，则存在匀速段。
| 参数 | 计算公式 | 物理意义 |
|---|---|---|
| 加速时间 t₁ | t₁ = v_max / a_max | 从零加速到最大速度所需时间 |
| 加速位移 S₁ | S₁ = ½ × a_max × t₁² | 加速段走过的距离 |
| 匀速时间 t₂ - t₁ | (S - 2×S₁) / v_max | 匀速段持续时间 |
| 总时间 t₃ | 2×t₁ + (S - 2×S₁)/v_max | 整个运动过程耗时 |
| 临界位移 S_crit | v_max² / a_max | 达到最大速度所需的最小位移 |
当 S < S_crit 时，实际最大速度 v_actual = √(a_max × S)，此时 t₁ = t₃ - t₂ = √(S / a_max)，总时间 t₃ = 2 × √(S / a_max)。这一边界条件的判断在工程中至关重要，否则会导致规划器输出超过系统能力的速度指令。
4.3 工程案例：定位平台的梯形规划参数整定
某自动化设备中的XY工作台，X轴采用伺服电机驱动滚珠丝杠，丝杠导程 P = 10mm，电机额定转速 n = 3000rpm，系统最大加速度受限于电机扭矩和机械刚性，设定 a_max = 5 m/s²。现要求工作台从原点移动 200mm，并尽可能缩短运动时间。
初始参数计算：电机最高线速度 v_max = n × P / 60 = 3000 × 0.01 / 60 = 0.5 m/s。临界位移 S_crit = v_max² / a_max = 0.25 / 5 = 0.05m = 50mm。由于目标位移 200mm > 50mm，系统可以进入匀速段。
规划参数求解：加速时间 t₁ = 0.5 / 5 = 0.1s，加速位移 S₁ = ½ × 5 × 0.1² = 0.025m = 25mm。匀速位移 S₂ = 200 - 2×25 = 150mm，匀速时间 = 0.15 / 0.5 = 0.3s。总时间 t₃ = 2×0.1 + 0.3 = 0.5s。
实际调试中的问题：按照上述参数运行后，发现工作台在加减速切换点存在明显振动，且定位后残余振动时间较长。通过伺服驱动器采集速度反馈曲线，发现实际速度在转折点处出现圆角而非理想尖角，说明机械系统存在弹性变形。进一步分析，加速度从 0 突变为 5 m/s² 时，加加速度（Jerk）为无穷大，激发了机械谐振频率约 35Hz 的模态。
优化措施：将梯形规划改为带有限加加速度的改进型规划，将加速度变化率限制在 200 m/s³。调整后加速时间延长至 0.125s，总时间增加至 0.55s，但振动幅度降低约 60%，定位稳定时间从 0.8s 缩短至 0.4s。虽然单次运动时间增加 10%，但综合节拍反而提升，因为减少了等待振动衰减的时间。
案例复盘：梯形规划在刚性较高、负载惯量比较小的场合表现良好。但当系统存在明显柔性或高速高精度要求时，必须考虑加加速度限制。本案例中，若直接采用S曲线规划（后续章节详述），可在不显著增加总时间的前提下进一步抑制振动。工程中应优先测量系统的频率响应，确定安全加速度变化率范围。
4.4 梯形规划的局限性分析与适用边界
梯形速度规划的主要局限性集中在三个方面：加速度突变、匀速段效率问题和参数耦合性。
- 加速度突变导致冲击：在 t=0、t₁、t₂、t₃ 四个时刻，加速度发生阶跃变化，理论上加加速度为无穷大。这会产生冲击力，激发机械谐振，影响定位精度和设备寿命。对于精密设备，这种冲击可能导致工件划伤或刀具磨损。
- 匀速段在短位移时消失：当目标位移小于临界位移 S_crit 时，速度曲线退化为三角形，系统始终处于加速或减速状态，无法达到最大速度。此时梯形规划的优势无法发挥，且由于加速度方向切换，同样存在冲击问题。
- 参数耦合与调试困难：v_max 和 a_max 的选取相互制约。增大 v_max 可缩短匀速段时间，但需要更长的加速距离；增大 a_max 可缩短加速时间，但会增加冲击。实际调试中，往往需要反复试凑，难以找到全局最优参数。
此外，梯形规划对系统参数变化敏感。当负载惯量变化时，实际加速度会偏离设定值，导致运动时间不准确。对于变负载工况，需要在线调整规划参数，而梯形规划缺乏自适应能力。
风险提示：在垂直轴应用中，梯形规划的匀速段可能因重力作用导致实际速度超调。务必在规划器中加入重力补偿项，或将加速度设定值减去重力加速度分量。否则，电机可能因速度超限触发过速报警，甚至发生坠轴事故。
4.5 梯形规划的改进方向与选型建议
针对上述局限性，工程实践中发展出多种改进方案。最直接的方法是引入加加速度限制，将梯形速度曲线中的尖角圆滑化，形成S曲线规划的雏形。另一种思路是采用非对称加减速，在加速段使用较大加速度以缩短时间，减速段使用较小加速度以减小冲击，适用于负载特性不对称的场合。
在选型建议上，梯形规划适用于以下场景：
- 点位运动且定位精度要求不高（如普通搬运、简单分度）；
- 系统刚性高、谐振频率远高于规划频率；
- 运动控制器的计算资源有限，无法承担复杂规划算法的实时计算；
- 对运动时间要求不极端，允许通过降低加速度来换取平稳性。
对于高速高精设备（如半导体设备、贴片机）、大惯量设备（如转台、重型机械臂）或对振动敏感的设备，建议直接采用S曲线或多项式规划。下表对比了梯形规划与后续章节将介绍的S曲线规划的关键差异：
| 对比维度 | 梯形规划 | S曲线规划 |
|---|---|---|
| 加加速度 | 无穷大（阶跃） | 有限值（连续） |
| 冲击水平 | 高 | 低 |
| 计算复杂度 | 低（分段线性） | 中（分段二次） |
| 相同参数下总时间 | 较短 | 略长（约5-10%） |
| 定位稳定性 | 较差（残余振动） | 较好 |
| 适用场景 | 低成本、低要求 | 高性能、高精度 |