4、梯形速度规划：梯形加减速曲线原理，加速、匀速、减速阶段的时间与位移计算

梯形速度规划（Trapezoidal Velocity Profile）是运动控制领域最基础、应用最广泛的点对点（PTP）加减速策略。它将整个运动过程划分为匀加速、匀速、匀减速三个阶段，速度曲线呈梯形，因此得名。与指数加减速或S型加减速相比，梯形规划具有计算简单、参数直观、易于工程实现的优点，尤其适用于对运动平稳性要求不苛刻、但对响应速度和计算开销敏感的场景，如3D打印机的直线轴运动、简易数控机床的快速定位、以及部分工业机器人的关节点到点运动。本章将深入剖析梯形速度规划的核心原理，并给出加速、匀速、减速各阶段时间与位移的完整计算公式及工程实现要点。

上图展示了梯形速度规划中速度随时间变化的完整关系。横轴为时间，纵轴为速度，曲线由三段直线构成：从零加速至最大速度 \(v_{max}\) 的匀加速段、以 \(v_{max}\) 恒速运行的匀速段、以及从 \(v_{max}\) 减速至零的匀减速段。图中阴影部分面积分别对应各阶段的位移，这是理解梯形规划计算的核心几何视角。下面我们将从原理、计算、案例和误区四个维度展开详细讲解。

4.1 梯形速度规划的核心原理

梯形速度规划的本质是：在满足系统加速度限制和速度限制的前提下，以最短时间完成给定的位移。其数学基础是运动学中的匀变速直线运动公式。设系统最大加速度为 \(a_{max}\)，最大速度为 \(v_{max}\)，总位移为 \(S\)，则规划的核心任务就是确定三个关键时间点：加速结束时间 \(t_1\)、匀速结束时间 \(t_2\)、总运动时间 \(t_3\)。

在加速阶段，速度从0线性增加至 \(v_{max}\)，加速度恒定为 \(a_{max}\)。根据匀变速运动公式，加速时间 \(t_1 = v_{max} / a_{max}\)，加速阶段位移 \(S_1 = \frac{1}{2} a_{max} t_1^2 = \frac{v_{max}^2}{2 a_{max}}\)。减速阶段与加速阶段对称，若减速加速度大小也为 \(a_{max}\)，则 \(t_3 = t_1\)，\(S_3 = S_1\)。匀速阶段的时间 \(t_2\) 则由剩余位移决定：\(t_2 = (S - S_1 - S_3) / v_{max}\)。

这里有一个关键前提：总位移 \(S\) 必须足够大，使得 \(S \ge S_1 + S_3\)。如果位移过小，系统无法加速到 \(v_{max}\) 就需要开始减速，此时梯形退化为三角形速度规划，即只有加速和减速两个阶段，最大实际速度 \(v_{peak} < v_{max}\)。这是工程中常见的边界情况，必须单独处理。

4.2 三阶段时间与位移的完整计算流程

在实际工程应用中，梯形速度规划的计算需要遵循严格的判断逻辑，不能直接套用公式。以下是标准化的五步计算流程：

1. 参数初始化：明确系统约束——最大速度 \(v_{max}\)（由电机额定转速、传动比决定）、最大加速度 \(a_{max}\)（由电机最大转矩、负载惯量、机构刚度决定）、目标位移 \(S\)（由点位指令给出）。
2. 计算临界位移：计算完成一次完整加速和减速所需的最小位移 \(S_{crit} = v_{max}^2 / a_{max}\)。这是判断梯形是否成立的分界线。
3. 判断规划类型：若 \(S \ge S_{crit}\)，采用标准梯形规划；若 \(S < S_{crit}\)，采用三角形规划，此时实际峰值速度 \(v_{peak} = \sqrt{a_{max} \cdot S}\)。
4. 计算各阶段时间：对于梯形，按4.1节公式计算；对于三角形，加速时间 \(t_1 = v_{peak} / a_{max}\)，减速时间 \(t_3 = t_1\)，匀速时间 \(t_2 = 0\)。
5. 验证与输出：检查总时间 \(t_3\) 是否满足节拍要求，检查各阶段位移之和是否等于总位移 \(S\)（误差应小于一个脉冲当量）。

参数	梯形规划（S ≥ S_crit）	三角形规划（S < S_crit）
峰值速度	\(v_{max}\)	\(v_{peak} = \sqrt{a_{max} \cdot S}\)
加速时间 t₁	\(v_{max} / a_{max}\)	\(v_{peak} / a_{max}\)
匀速时间 t₂	\((S - v_{max}^2/a_{max}) / v_{max}\)	0
减速时间 t₃	\(v_{max} / a_{max}\)	\(v_{peak} / a_{max}\)
总时间 t_total	\(v_{max}/a_{max} + S/v_{max}\)	\(2\sqrt{S/a_{max}}\)

上表对比了两种规划模式的计算差异。值得注意的是，三角形规划的总时间公式 \(2\sqrt{S/a_{max}}\) 在 \(S = S_{crit}\) 时与梯形规划公式计算结果一致，这验证了两种模式在临界点处的连续性。

4.3 案例拆解：三轴机械臂的点位运动规划

我们以一个具体的工业场景来演示梯形速度规划的完整应用。假设某三轴机械臂的关节2需要从当前位置运动到目标位置，已知条件如下：

• 目标位移：\(S = 0.5 \, \text{m}\)（沿关节弧线等效位移）
• 最大速度：\(v_{max} = 0.8 \, \text{m/s}\)（由电机额定转速和减速比确定）
• 最大加速度：\(a_{max} = 2.0 \, \text{m/s}^2\)（由电机峰值转矩和负载惯量校核得出）

第一步：计算临界位移。\(S_{crit} = v_{max}^2 / a_{max} = 0.8^2 / 2.0 = 0.32 \, \text{m}\)。由于 \(S = 0.5 > 0.32\)，采用标准梯形规划。

第二步：计算加速阶段。加速时间 \(t_1 = 0.8 / 2.0 = 0.4 \, \text{s}\)，加速位移 \(S_1 = 0.5 \times 2.0 \times 0.4^2 = 0.16 \, \text{m}\)。减速阶段与加速阶段对称，\(t_3 = 0.4 \, \text{s}\)，\(S_3 = 0.16 \, \text{m}\)。

第三步：计算匀速阶段。剩余位移 \(S_2 = 0.5 - 0.16 - 0.16 = 0.18 \, \text{m}\)，匀速时间 \(t_2 = 0.18 / 0.8 = 0.225 \, \text{s}\)。

第四步：总时间与验证。总时间 \(t_{total} = 0.4 + 0.225 + 0.4 = 1.025 \, \text{s}\)。验证位移：\(0.16 + 0.18 + 0.16 = 0.5 \, \text{m}\)，完全吻合。

在实际控制器中，还需要将时间离散化为插补周期。假设插补周期 \(T_s = 1 \, \text{ms}\)，则加速阶段需要400个插补周期，匀速阶段225个，减速阶段400个。每个周期的速度指令按线性递增/递减计算，位置指令通过累加速度乘以周期得到。这里有一个工程细节：由于插补周期的离散化，实际总时间会略有延长，通常需要将最后一个周期的剩余位移单独处理，避免累积误差。

4.4 常见误区与设计复盘

梯形速度规划虽然简单，但在实际应用中仍存在不少容易忽视的问题，以下是高频误区及对应的规避策略：

• 误区一：忽略临界位移判断。直接套用梯形公式计算短距离运动，导致匀速时间为负值。规避方法：在规划前必须执行 \(S \ge S_{crit}\) 判断，否则自动切换为三角形规划。
• 误区二：加减速参数设置不一致。有些工程师为了追求快速启动，设置了很大的加速加速度，但减速加速度沿用默认值，导致实际减速距离超出预期，最终定位超程。规避方法：明确区分 \(a_{acc}\) 和 \(a_{dec}\)，并在计算中分别使用。
• 误区三：未考虑速度前馈和跟随误差。梯形规划在加速和减速切换点存在加速度突变（ jerk 无穷大），这会引起机械振动。对于高精度应用，应改用S型速度规划。规避方法：评估系统对振动的敏感度，必要时升级规划算法。
• 误区四：离散化处理不当。在数字控制器中，如果直接使用连续时间公式计算每个周期的速度，而不考虑插补周期的取整，会导致最终位置偏差。规避方法：采用累加器方式计算位置，并在运动结束时强制将位置修正为目标值。

从设计复盘的角度看，梯形规划最适合的应用场景是：运动行程较大、加减速段占比小、对轮廓精度要求不高的点位运动。例如，PCB钻床的快速换位、自动送料机构的步进运动等。对于需要平滑轨迹的场合，如数控机床的轮廓加工，梯形规划的速度突变会导致加工痕迹，此时应选择S型规划或更高阶的平滑算法。此外，梯形规划还有一个变体——非对称梯形规划，即加速和减速采用不同的加速度值，这在垂直轴（重力影响）或负载变化的场景中非常实用。