📚 课程目录第3章梯形速度曲线原理

3、梯形速度曲线原理：三段式结构与运动学方程推导

梯形速度曲线（Trapezoidal Velocity Profile）是运动控制领域最基础、应用最广泛的加减速策略。它将整个运动过程划分为加速、匀速、减速三个阶段，速度随时间的变化呈梯形，因此得名。理解其三段式结构以及各阶段的运动学方程，是后续学习S曲线、Jerk控制、时间最优规划等高级主题的基石。本节将深入剖析梯形速度曲线的数学本质，推导位移、速度、加速度的解析关系，并讨论其工程适用边界。

3.1 核心原理：为什么需要三段式速度规划

在伺服电机或步进电机的点位运动（Point-to-Point Motion）中，如果直接以最大速度启动或停止，电机会承受无限大的加速度（即冲击力），导致机械振动、失步、过冲甚至损坏传动机构。梯形速度曲线通过引入恒定的加速度和恒定的减速度，将速度变化过程平滑化，从而限制动态力矩需求。

其核心思想是：在启动阶段以最大允许加速度线性提升速度至目标值；中间阶段保持匀速以高效完成大部分位移；接近目标位置时以最大减速度线性降低速度至零。这种策略在“时间最优”和“机械冲击”之间取得了工程上最实用的平衡。

从控制角度看，梯形曲线属于开环前馈的典型应用——控制器根据预设的运动学参数（最大速度、最大加速度）实时计算期望位置，并作为位置环的指令输入。由于加速度恒定，速度曲线为直线，位移曲线为抛物线拼接，数学表达简洁，计算量小，非常适合嵌入式实时系统。

  关键参数定义：梯形曲线由四个基本参数唯一确定——最大速度 v_max、最大加速度 a_max、最大减速度 d_max（通常取 a_max）、总位移 S。实际规划时，还需根据 S 的大小判断是否能够达到 v_max，这引出了“三角曲线”与“梯形曲线”的临界条件。

3.2 运动学方程推导：从物理约束到数学表达

设运动总时间为 T，加速段时间为 t₁，匀速段时间为 t₂ - t₁，减速段时间为 T - t₂。为简化推导，假设初速度和末速度均为零，且加减速对称（a_max = d_max）。

3.2.1 加速段（0 ≤ t ≤ t₁）

加速度恒定为 a_max，初速度为零。由匀加速运动公式：

v(t) = ∫₀ᵗ a_max dτ = a_max · t
s(t) = ∫₀ᵗ v(τ) dτ = ½ · a_max · t²

当 t = t₁ 时，速度达到 v_max，因此：

t₁ = v_max / a_max
s₁ = ½ · a_max · t₁² = v_max² / (2 · a_max)

s₁ 即为加速段所走的距离，也是后续判断能否达到最大速度的关键量。

3.2.2 匀速段（t₁ ≤ t ≤ t₂）

加速度为零，速度保持 v_max。位移为线性增长：

v(t) = v_max
s(t) = s₁ + v_max · (t - t₁)

匀速段时间长度取决于剩余位移。若总位移为 S，减速段位移为 s₃（与 s₁ 对称相等），则：

s₂ = S - s₁ - s₃ = S - 2 · s₁
t₂ - t₁ = s₂ / v_max = (S - v_max² / a_max) / v_max

3.2.3 减速段（t₂ ≤ t ≤ T）

加速度为 -a_max，初速度为 v_max。以 t₂ 为起点重新计时：

v(t) = v_max - a_max · (t - t₂)
s(t) = s₂ + v_max · (t - t₂) - ½ · a_max · (t - t₂)²

当速度降为零时，运动结束，此时：

T - t₂ = v_max / a_max = t₁
s₃ = v_max² / (2 · a_max) = s₁

3.2.4 临界条件与三角曲线

若总位移 S 较小，使得 S < 2·s₁，则无法达到 v_max。此时实际最大速度 v_peak 需重新计算：

v_peak = √(a_max · S)   （对称加减速时）
t₁ = t₃ = √(S / a_max)
匀速段时间为零，曲线退化为三角形。

工程实现中，必须先判断 S 与 2·s₁ 的关系，再决定采用梯形还是三角规划。

阶段	时间范围	速度 v(t)	位移 s(t)	关键特征
加速段	0 ~ t₁	a_max · t	½ · a_max · t²	加速度恒定，速度线性上升
匀速段	t₁ ~ t₂	v_max	s₁ + v_max·(t-t₁)	加速度为零，位移线性增长
减速段	t₂ ~ T	v_max - a_max·(t-t₂)	s₂ + v_max·(t-t₂) - ½·a_max·(t-t₂)²	减速度恒定，速度线性下降至零

3.3 判断方法与规划流程：从需求到参数

实际工程中，用户通常给定总位移 S、最大速度 v_max 和 最大加速度 a_max（或由电机力矩和负载惯量计算得出）。规划流程如下：

计算加速段位移：s₁ = v_max² / (2·a_max)。
判断是否达到最大速度：若 S ≥ 2·s₁，则采用梯形曲线；否则采用三角曲线。
梯形曲线参数计算：t₁ = v_max / a_max；匀速段位移 s₂ = S - 2·s₁；匀速段时间 t₂ - t₁ = s₂ / v_max；总时间 T = 2·t₁ + (t₂ - t₁)。
三角曲线参数计算：实际峰值速度 v_peak = √(a_max·S)；加速时间 t₁ = v_peak / a_max；总时间 T = 2·t₁。
生成位置指令序列：在每个控制周期（如 1ms），根据当前时间 t 代入对应阶段的 s(t) 公式，计算期望位置并输出给位置环。

工程经验：当 S 略大于 2·s₁ 时，匀速段时间很短（可能只有几十毫秒）。此时梯形曲线与三角曲线差别不大，但梯形曲线在匀速段起点和终点存在加速度突变（从 a_max 跳变到 0），会引入柔性冲击。若系统对振动敏感，建议直接使用三角曲线或S曲线。

3.4 案例拆解：伺服电机点位运动规划实战

背景与约束：某自动化设备使用伺服电机驱动丝杠滑台，要求将负载从原点移动到 200mm 处。电机额定转速对应最大线速度 v_max = 500 mm/s，驱动器允许的最大加速度 a_max = 2000 mm/s²（受限于电机力矩和负载惯量）。控制器周期为 1ms。

初始现象：若直接以 500mm/s 恒速运行，到达目标位置时急停，设备产生明显振动，丝杠发出异响，定位精度超差 ±0.15mm。

分析判断：首先计算加速段位移：s₁ = 500² / (2×2000) = 62.5mm。2·s₁ = 125mm < 200mm，因此可以采用梯形曲线。

参数计算：

t₁ = 500 / 2000 = 0.25s
匀速段位移 s₂ = 200 - 125 = 75mm
匀速段时间 = 75 / 500 = 0.15s
总时间 T = 0.25 + 0.15 + 0.25 = 0.65s

实施步骤：在控制器中编写梯形规划器，每个周期计算期望位置。例如 t = 0.1s 时，处于加速段，期望位置 = ½ × 2000 × 0.1² = 10mm；t = 0.4s 时，处于匀速段，期望位置 = 62.5 + 500 × (0.4 - 0.25) = 137.5mm。

结果对比：采用梯形曲线后，最大加速度被限制在 2000mm/s²，电机力矩峰值降低约 40%，设备振动明显减小，定位精度提升至 ±0.03mm。总运动时间从恒速急停的 0.4s 延长至 0.65s，但机械寿命和稳定性显著改善。

风险与代价：梯形曲线在 t₁ 和 t₂ 时刻加速度存在阶跃突变（从 2000 突变为 0），会产生残余振动。若后续发现高速轻载场景下仍有微小振荡，可考虑将加减速段改为S曲线（后续章节详述）。

常见误区：① 忽略 S 与 2·s₁ 的判断，直接套用梯形公式，导致匀速段位移为负值；② 将 a_max 设置为驱动器极限值，未留安全余量，导致实际跟踪误差过大；③ 加减速不对称（a_max ≠ d_max）时，仍使用对称公式计算，造成终点速度不为零。

3.5 总结复盘：梯形曲线的适用边界与优化方向

梯形速度曲线是运动控制的第一课，其价值在于用最简单的数学模型解决了“速度突变”这一核心矛盾。它适用于对振动要求不苛刻、负载惯量相对稳定、点位运动速度不高的场景，如3D打印机、简易机械臂、传送带定位等。

然而，其固有的加速度不连续问题（Jerk 无穷大）限制了它在高速高精设备中的应用。当设备运行速度超过 1m/s 或负载惯量比大于 10:1 时，梯形曲线引起的机械共振可能成为瓶颈。此时应升级为S曲线（加加速度受限）或更高阶多项式规划。

从工程实践角度，掌握梯形曲线不仅是学会两个公式，更重要的是建立“先判断、后规划、再验证”的思维习惯。建议读者在仿真环境中（如Python/Matlab）实现本节推导，对比不同 S、v_max、a_max 组合下的位移-速度-加速度曲线，直观感受参数对运动品质的影响。