4、梯形速度规划：梯形加减速的数学模型、时间参数计算、位移公式推导

梯形速度规划（Trapezoidal Velocity Profile）是运动控制领域最基础、应用最广泛的点对点（PTP）加减速策略。其核心思想是将整个运动过程划分为匀加速段、匀速段和匀减速段三个阶段，速度曲线呈梯形，加速度曲线呈矩形。相比直接以恒定速度运行或采用阶跃速度指令，梯形规划能显著抑制机械冲击，同时算法简单、计算量小，非常适合嵌入式控制器实时计算。本节将系统推导梯形规划的数学模型，给出时间参数与位移的完整计算公式，并结合工程案例说明参数整定方法。

4.1 梯形速度规划的数学模型

梯形速度规划将运动过程分为三个阶段，设总位移为 \(S\)，最大速度为 \(v_{max}\)，最大加速度为 \(a_{max}\)，最大减速度通常与加速度相同（也可独立设置）。三个阶段的运动学方程如下：

• 匀加速段（0 ≤ t ≤ t₁）：速度从 0 线性增加至 \(v_{max}\)，加速度恒定为 \(a_{max}\)。速度方程 \(v(t) = a_{max} \cdot t\)，位移方程 \(s(t) = \frac{1}{2} a_{max} t^2\)。
• 匀速段（t₁ ≤ t ≤ t₂）：速度保持 \(v_{max}\) 不变，加速度为 0。位移方程 \(s(t) = s_1 + v_{max} \cdot (t - t_1)\)，其中 \(s_1\) 为加速段结束时的位移。
• 匀减速段（t₂ ≤ t ≤ t₃）：速度从 \(v_{max}\) 线性减小至 0，加速度恒定为 \(-a_{max}\)。速度方程 \(v(t) = v_{max} - a_{max} \cdot (t - t_2)\)，位移方程 \(s(t) = s_2 + v_{max}(t - t_2) - \frac{1}{2} a_{max}(t - t_2)^2\)。

由于加速段和减速段对称（假设加减速能力相同），加速时间 \(t_{acc} = t_1\)，减速时间 \(t_{dec} = t_3 - t_2\)，且 \(t_{acc} = t_{dec} = \frac{v_{max}}{a_{max}}\)。这一对称性大大简化了计算。

4.2 时间参数计算

时间参数计算是梯形规划的核心任务。给定目标位移 \(S\)、最大速度 \(v_{max}\)、最大加速度 \(a_{max}\)，需要确定三个关键时间点：\(t_1\)（加速结束时刻）、\(t_2\)（匀速结束时刻）、\(t_3\)（总运动时间）。

第一步：判断是否达到最大速度

若位移足够大，运动过程包含完整的加速-匀速-减速三段；若位移较小，可能无法达到 \(v_{max}\)，此时梯形退化为三角形（只有加速和减速）。临界位移为：

S_critical = v_max² / a_max

当 \(S \geq S_{critical}\) 时，采用完整梯形；否则采用三角形规划。

第二步：完整梯形的时间计算

1. 加速时间：\(t_1 = \frac{v_{max}}{a_{max}}\)
2. 减速时间：\(t_{dec} = \frac{v_{max}}{a_{max}}\)（与加速时间相同）
3. 加速段位移：\(S_{acc} = \frac{1}{2} v_{max} t_1 = \frac{v_{max}^2}{2 a_{max}}\)
4. 减速段位移：\(S_{dec} = S_{acc}\)
5. 匀速段位移：\(S_{cruise} = S - S_{acc} - S_{dec}\)
6. 匀速时间：\(t_{cruise} = \frac{S_{cruise}}{v_{max}}\)
7. 总时间：\(t_3 = 2 t_1 + t_{cruise}\)

第三步：三角形规划的时间计算

当 \(S < S_{critical}\) 时，实际最大速度 \(v_{peak} = \sqrt{a_{max} \cdot S}\)，加速时间 \(t_1 = \frac{v_{peak}}{a_{max}}\)，总时间 \(t_3 = 2 t_1\)。此时没有匀速段。

参数	完整梯形（S ≥ v_max²/a_max）	三角形（S < v_max²/a_max）
加速时间 t₁	v_max / a_max	√(S / a_max)
匀速时间 t_cruise	(S - v_max²/a_max) / v_max	0
总时间 t₃	v_max/a_max + S/v_max	2√(S / a_max)
实际峰值速度	v_max	√(a_max · S)

4.3 位移公式推导与验证

位移公式的推导基于速度-时间曲线下的面积。对于完整梯形，总位移等于三个梯形/矩形面积之和：

S = S_acc + S_cruise + S_dec
  = (1/2)·v_max·t₁ + v_max·t_cruise + (1/2)·v_max·t_dec
  = v_max·(t₁ + t_cruise)   （因为 t₁ = t_dec）
  = v_max·(t₃ - t₁)

将 \(t_1 = v_{max}/a_{max}\) 代入，得到位移-时间关系：

S = v_max·t₃ - v_max²/a_max

这一公式在工程中非常实用：已知目标位移和最大速度，可以直接反推所需总时间；或者已知允许时间，反推所需最大速度。

对于三角形规划，位移公式简化为：

S = v_peak·t₃ / 2 = (1/2)·a_max·t₃²

验证方法：将 \(t_3 = 2\sqrt{S/a_{max}}\) 代入，可得 \(S = (1/2) \cdot a_{max} \cdot (4S/a_{max}) = 2S\)，等式成立，证明推导正确。

4.4 案例拆解：伺服电机点位运动参数整定

场景：某自动化设备使用伺服电机驱动丝杠滑台，要求从原点移动到 200mm 处。已知电机额定转速对应最大线速度 \(v_{max} = 500 mm/s\)，驱动器允许的最大加速度 \(a_{max} = 2000 mm/s²\)。需要计算运动时间并验证是否满足节拍要求（总时间 ≤ 0.6s）。

第一步：判断梯形类型

S_critical = v_max² / a_max = 500² / 2000 = 125 mm
由于 S = 200mm > 125mm，采用完整梯形规划。

第二步：计算时间参数

加速时间 t₁ = 500 / 2000 = 0.25s
加速位移 S_acc = 0.5 × 500 × 0.25 = 62.5mm
匀速位移 S_cruise = 200 - 62.5 - 62.5 = 75mm
匀速时间 t_cruise = 75 / 500 = 0.15s
总时间 t₃ = 2 × 0.25 + 0.15 = 0.65s

第三步：结果分析与调整

计算总时间 0.65s 超出节拍要求 0.6s。此时有两种调整方案：

• 方案A：提高最大速度。将 \(v_{max}\) 提升至 550 mm/s，重新计算：\(t_1 = 550/2000 = 0.275s\)，\(S_{acc} = 0.5×550×0.275 = 75.6mm\)，\(S_{cruise} = 200 - 151.2 = 48.8mm\)，\(t_{cruise} = 48.8/550 = 0.089s\)，总时间 \(t_3 = 2×0.275 + 0.089 = 0.639s\)。仍略超，继续提高至 600 mm/s 可得 \(t_3 = 0.583s\)，满足要求。
• 方案B：增大加速度。将 \(a_{max}\) 提升至 3000 mm/s²，\(t_1 = 500/3000 = 0.167s\)，\(S_{acc} = 41.7mm\)，\(S_{cruise} = 116.6mm\)，\(t_{cruise} = 0.233s\)，总时间 \(t_3 = 0.567s\)，满足要求。

第四步：风险与代价分析

方案A提高速度会增加电机负载和运动冲击，需检查电机扭矩是否足够；方案B增大加速度会显著增加机械振动和噪声，需确认设备刚性。实际选择时，应优先调整加速度（因为加速度对节拍的影响更直接），但需结合机械结构刚度综合评估。

4.5 梯形规划的局限性与改进方向

梯形规划虽然简单高效，但其加速度在启动、切换和停止瞬间存在阶跃突变，产生无限大的加加速度（Jerk），导致机械冲击和振动。对于高速高精设备，这种冲击可能引起共振、降低定位精度。改进方案包括：

• S型速度规划：对加速度进行斜坡化处理，使加加速度有限，速度曲线呈 S 形，冲击显著减小。
• 修正梯形规划：在梯形拐角处加入圆弧过渡，用正弦或多项式曲线平滑加速度突变。
• 自适应规划：根据负载变化实时调整加减速参数，在保证效率的同时控制振动。

尽管如此，梯形规划仍是绝大多数运动控制系统的默认选择，尤其适用于对节拍要求高、机械刚性好的场景。理解其数学模型是掌握更复杂规划算法的基础。