4、参数计算:给定距离、最大速度、加速度、减速度,计算加速时间、匀速时间、减速时间及总时间
梯形速度曲线(Trapezoidal Velocity Profile)是运动控制领域最基础、应用最广泛的加减速策略之一。无论是数控机床的进给轴、SCARA机器人的关节,还是半导体设备中的直线电机,其点对点运动大多采用梯形速度曲线。本章的核心任务,是在已知运动距离 \( S \)、最大速度 \( V_{max} \)、加速度 \( A_{acc} \) 和减速度 \( A_{dec} \) 的前提下,精确计算出加速时间 \( t_{acc} \)、匀速时间 \( t_{cruise} \)、减速时间 \( t_{dec} \) 以及总运动时间 \( t_{total} \)。这不仅是运动控制算法的基础,更是后续进行轨迹规划、伺服参数整定和节拍优化的前提。
上图展示了梯形速度曲线的完整几何形态。横轴为时间,纵轴为速度,曲线下的面积即为运动距离 \( S \)。整个运动过程被划分为三个区间:加速区(0 到 \( t_1 \))、匀速区(\( t_1 \) 到 \( t_2 \))和减速区(\( t_2 \) 到 \( t_3 \))。本章将围绕这一几何模型,系统推导各时间参数的计算方法,并讨论实际工程中常见的边界情况。
4.1 核心原理:从几何关系推导时间参数
梯形速度曲线的本质是速度对时间的积分等于位移。在加速阶段,速度从 0 线性增加到 \( V_{max} \),斜率为加速度 \( A_{acc} \);在匀速阶段,速度保持 \( V_{max} \) 不变;在减速阶段,速度从 \( V_{max} \) 线性下降到 0,斜率为减速度 \( A_{dec} \)(通常取负值)。根据运动学基本公式,我们可以直接写出各阶段的时间表达式:
- 加速时间:\( t_{acc} = \frac{V_{max}}{A_{acc}} \)
- 减速时间:\( t_{dec} = \frac{V_{max}}{A_{dec}} \)
- 加速距离:\( S_{acc} = \frac{1}{2} A_{acc} t_{acc}^2 = \frac{V_{max}^2}{2 A_{acc}} \)
- 减速距离:\( S_{dec} = \frac{1}{2} A_{dec} t_{dec}^2 = \frac{V_{max}^2}{2 A_{dec}} \)
这里需要特别强调的是,加速度和减速度在数值上可能不同。例如,某些设备为了减小停止时的冲击,会将减速度设置得比加速度小;而另一些设备为了快速定位,会采用对称的加减速参数。因此,在计算时必须分别对待 \( A_{acc} \) 和 \( A_{dec} \),不能想当然地认为两者相等。
匀速距离 \( S_{cruise} \) 则是总距离减去加速距离和减速距离:
\( S_{cruise} = S - S_{acc} - S_{dec} \)
一旦求得匀速距离,匀速时间即可通过 \( t_{cruise} = \frac{S_{cruise}}{V_{max}} \) 计算。总时间则为三段之和:
\( t_{total} = t_{acc} + t_{cruise} + t_{dec} \)
工程经验:在实际编写运动控制程序时,建议将加速度和减速度作为独立参数配置,而不是共用一个值。这不仅能适应不同的机械特性(如重力影响、摩擦差异),还能在调试阶段分别调整加减速的平顺性。例如,垂直轴在上升和下降时,由于重力方向不同,加减速参数往往需要差异化设置。
4.2 判断方法:是否存在匀速段的临界条件
上述公式成立的前提是:总距离 \( S \) 足够大,使得加速和减速过程都能达到最大速度 \( V_{max} \)。但在实际应用中,经常遇到短距离运动的情况——距离太短,速度还没来得及上升到 \( V_{max} \) 就已经需要减速了。此时梯形曲线退化为三角形曲线,不存在匀速段。
判断是否存在匀速段的临界条件是:比较总距离 \( S \) 与“临界距离” \( S_{critical} \) 的大小。临界距离定义为:从静止加速到 \( V_{max} \) 再立即减速到静止所需的最小距离,即:
\( S_{critical} = \frac{V_{max}^2}{2 A_{acc}} + \frac{V_{max}^2}{2 A_{dec}} \)
判断逻辑如下:
- 若 \( S \geq S_{critical} \),则存在匀速段,按 4.1 节公式计算。
- 若 \( S < S_{critical} \),则不存在匀速段,实际最大速度 \( V_{peak} < V_{max} \),需要重新计算。
对于无匀速段的情况,实际峰值速度 \( V_{peak} \) 需要联立方程求解。设加速时间为 \( t_{acc}' \),减速时间为 \( t_{dec}' \),则有:
\( V_{peak} = A_{acc} \cdot t_{acc}' = A_{dec} \cdot t_{dec}' \)
\( S = \frac{1}{2} V_{peak} (t_{acc}' + t_{dec}') \)
联立可得:
\( V_{peak} = \sqrt{\frac{2 S A_{acc} A_{dec}}{A_{acc} + A_{dec}}} \)
求得 \( V_{peak} \) 后,再分别计算 \( t_{acc}' = \frac{V_{peak}}{A_{acc}} \) 和 \( t_{dec}' = \frac{V_{peak}}{A_{dec}} \),总时间即为两者之和。
| 条件 | 曲线形态 | 计算策略 |
|---|---|---|
| S ≥ S_critical | 完整梯形(有匀速段) | 直接使用 V_max 计算三段时间 |
| S < S_critical | 三角形(无匀速段) | 先求 V_peak,再计算加减速时间 |
风险提示:在无匀速段的情况下,如果仍然强行使用 \( V_{max} \) 计算,会导致理论运动距离大于实际给定距离,造成轨迹规划错误。轻则定位不准,重则引发机械碰撞。因此,在编写运动控制程序时,必须加入临界距离判断分支。
4.3 案例拆解:双轴龙门平台的参数计算实战
下面通过一个完整的工程案例,演示参数计算的全过程。某双轴龙门平台用于 PCB 钻孔,X 轴行程 400mm,要求从原点运动到 300mm 处。已知伺服电机的额定转速对应的最大线速度为 \( V_{max} = 500 \text{ mm/s} \),系统允许的加速度 \( A_{acc} = 2000 \text{ mm/s}^2 \),减速度 \( A_{dec} = 1500 \text{ mm/s}^2 \)(考虑到停止时工件定位稳定性,减速度设置较小)。
第一步:计算临界距离
\( S_{critical} = \frac{500^2}{2 \times 2000} + \frac{500^2}{2 \times 1500} = 62.5 + 83.3 = 145.8 \text{ mm} \)
由于 \( S = 300 \text{ mm} > 145.8 \text{ mm} \),存在匀速段,按完整梯形计算。
第二步:计算加速和减速时间
\( t_{acc} = \frac{500}{2000} = 0.25 \text{ s} \)
\( t_{dec} = \frac{500}{1500} = 0.333 \text{ s} \)
第三步:计算匀速距离和时间
\( S_{acc} = \frac{1}{2} \times 500 \times 0.25 = 62.5 \text{ mm} \)
\( S_{dec} = \frac{1}{2} \times 500 \times 0.333 = 83.3 \text{ mm} \)
\( S_{cruise} = 300 - 62.5 - 83.3 = 154.2 \text{ mm} \)
\( t_{cruise} = \frac{154.2}{500} = 0.308 \text{ s} \)
第四步:计算总时间
\( t_{total} = 0.25 + 0.308 + 0.333 = 0.891 \text{ s} \)
实际调试中,我们还需要考虑伺服系统的响应延迟和定位建立时间。通常会在理论总时间基础上增加 5%~10% 的余量,用于整定稳定和到位确认。因此,实际节拍预估约为 0.94~0.98 秒。
复盘经验:该案例中减速度小于加速度,导致减速距离大于加速距离。这在视觉上表现为减速段更“平缓”,有利于减小停止时的过冲。但代价是总时间略有增加。如果设备对节拍要求极高,可以尝试将减速度提高到与加速度一致,此时总时间可缩短至约 0.85 秒,但需要评估机械冲击是否在允许范围内。
4.4 常见误区与总结复盘
在参数计算过程中,工程师容易陷入以下几个误区,需要特别警惕:
- 误区一:默认加减速度相等。很多初学者习惯将 \( A_{acc} \) 和 \( A_{dec} \) 设为相同值,这在水平无负载变化的场景下可行,但在垂直轴、有摩擦力变化或负载波动的场景中,会导致实际轨迹偏离预期。正确做法是分别测量或估算两个方向的动态特性。
- 误区二:忽略单位换算。速度单位可能是 mm/s、m/min 或 r/min(旋转轴),加速度单位可能是 mm/s²、g 或 rev/s²。计算前必须统一单位,否则结果会相差千倍。建议全部转换为 mm 和 s 的基本单位。
- 误区三:未考虑伺服系统的加减速能力限制。电机和驱动器的实际输出力矩有限,当负载惯量较大时,实际能达到的加速度可能远小于设定值。此时需要结合惯量匹配计算实际可达加速度,而不是直接使用理论值。
- 误区四:忽略 S 曲线过渡。梯形速度曲线在加减速切换点存在加速度突变( jerk 无穷大),这会引起机械振动。对于高精度设备,通常需要将梯形曲线修改为 S 曲线(如 S 形速度规划),此时时间计算会更加复杂,但本章的梯形计算可以作为 S 曲线规划的初步估算基础。
总结本章的核心要点:梯形速度曲线的时间计算本质上是几何面积求解问题。先判断是否存在匀速段,再分别计算加速、匀速、减速时间。工程应用中,务必注意加减速度的差异化设置、单位统一和伺服能力校验。掌握这些基础计算,后续学习 S 曲线规划、前瞻控制和路径平滑时才能得心应手。
| 参数 | 符号 | 计算公式 | 单位 |
|---|---|---|---|
| 加速时间 | t_acc | V_max / A_acc | s |
| 减速时间 | t_dec | V_max / A_dec | s |
| 加速距离 | S_acc | V_max² / (2·A_acc) | mm |
| 减速距离 | S_dec | V_max² / (2·A_dec) | mm |
| 匀速时间 | t_cruise | (S - S_acc - S_dec) / V_max | s |
| 总时间 | t_total | t_acc + t_cruise + t_dec | s |