梯形速度曲线：原理、公式推导、加速-匀速-减速三段式规划

梯形速度曲线（Trapezoidal Velocity Profile）是点位运动控制中最基础、应用最广泛的加减速规划算法。它将整个运动过程划分为加速段、匀速段和减速段三个区间，速度随时间的变化呈梯形轮廓，因此得名。与直接以恒定速度运行或采用阶跃速度指令的方式相比，梯形速度曲线通过引入有限的加速度和减速度，显著降低了机械冲击和电机电流尖峰，是伺服系统、步进电机和工业机器人点位运动的标准配置。本章将系统讲解其数学模型、参数推导、三段式规划方法以及工程实现中的关键细节。

核心原理：从物理约束到运动规划

梯形速度曲线的本质是在满足运动学约束（最大速度、最大加速度/减速度）的前提下，寻找一条从起点到终点的时间最优速度轨迹。其物理基础是牛顿运动学方程：在匀加速阶段，速度线性增加；在匀速阶段，速度保持恒定；在匀减速阶段，速度线性减小至零。这种规划方式将连续运动分解为三个特征明确的阶段，使得每个阶段的运动学参数（位置、速度、加速度）都可以用解析式精确表达。

从控制角度看，梯形速度曲线具有三个重要特性：有限加速度避免了速度阶跃带来的无限冲击力；速度连续性保证了位置曲线的二阶可导，使得伺服系统能够平滑跟踪；时间最优性在给定约束下，梯形曲线是到达目标位置的最短时间方案。这些特性使其成为工业运动控制中最可靠的基准算法。

加速段 (0 ≤ t ≤ t₁):
  v(t) = a_max · t
  s(t) = ½ · a_max · t²

匀速段 (t₁ ≤ t ≤ t₂):
  v(t) = v_max
  s(t) = v_max · (t - t₁) + s₁

减速段 (t₂ ≤ t ≤ t₃):
  v(t) = v_max - d_max · (t - t₂)
  s(t) = v_max·(t-t₂) - ½·d_max·(t-t₂)² + s₂

三段式规划方法：参数计算与边界条件

实际规划时，需要根据给定的总位移 S、最大速度 v_max、最大加速度 a_max 和最大减速度 d_max 来确定三个阶段的持续时间。规划流程分为以下步骤：

1. 计算理论加速/减速时间：t_acc = v_max / a_max，t_dec = v_max / d_max
2. 计算理论加速/减速位移：S_acc = ½·v_max·t_acc，S_dec = ½·v_max·t_dec
3. 判断是否存在匀速段：若 S_acc + S_dec ≥ S，则无法达到 v_max，需要降低目标速度；否则存在匀速段。
4. 计算匀速段时间：t_const = (S - S_acc - S_dec) / v_max
5. 生成完整轨迹：按时间顺序拼接三段位置、速度、加速度序列。

案例拆解：步进电机点位运动规划实战

以某三轴平台X轴为例，要求从原点运动到 100mm 处，系统约束为：v_max = 200 mm/s，a_max = 1000 mm/s²，d_max = 1500 mm/s²。我们按照上述流程进行完整规划。

第一步：计算理论加减速参数

t_acc = 200 / 1000 = 0.2 s
t_dec = 200 / 1500 ≈ 0.133 s
S_acc = 0.5 × 200 × 0.2 = 20 mm
S_dec = 0.5 × 200 × 0.133 ≈ 13.3 mm
S_acc + S_dec = 33.3 mm < 100 mm → 存在匀速段

第二步：计算匀速段时间

t_const = (100 - 33.3) / 200 = 0.3335 s

第三步：生成完整轨迹，关键时间节点为：t₁=0.2s，t₂=0.5335s，t₃=0.6668s。在加速段，每毫秒位置增量按二次曲线增长；匀速段按恒定速度 200mm/s 递增；减速段按递减速度逼近目标。

结果验证：总位移 = 20 + 200×0.3335 + 13.3 = 100.0mm，精确到达目标。实际运行中，伺服周期为 1ms，规划器需在每个周期输出目标位置，驱动器通过位置环跟踪。

常见误区与调优策略

梯形速度曲线虽然简单，但在实际应用中存在几个典型误区：

• 误区一：忽略减速度与加速度的差异。许多系统（如垂直轴）由于重力影响，实际减速度能力低于加速度，若按对称规划会导致减速段超调。应分别设定 a_max 和 d_max。
• 误区二：未考虑伺服滞后。梯形曲线在拐点处加速度突变，实际伺服系统存在跟踪延迟，导致轮廓误差。对于高精度场景，需引入S型曲线或低通滤波。
• 误区三：短距离运动时强行达到 v_max。当目标位移很小时，应自动降低目标速度，否则规划器会输出不合理的负匀速段时间。

总结与复盘

梯形速度曲线作为点位运动控制的基础算法，其核心价值在于用最少的参数（v_max、a_max、d_max）实现了满足物理约束的时间最优规划。掌握其原理和推导过程，是理解更高级S型曲线、Jerk受限规划的前提。实际工程中，建议按照"先判断可达性、再计算时间参数、最后生成轨迹"的流程实施，并针对具体机械特性调整加减速参数。对于大多数点位运动场景，梯形曲线配合适当的滤波处理，即可获得满意的运动性能。