2、运动控制基础：位置、速度、加速度、加加速度（Jerk）的定义与关系，以及运动曲线的基本类型（梯形、S型、多项式等）
运动控制系统的本质，是对“物体如何从A点到达B点”这一过程进行精确的数学描述与物理执行。无论是数控机床的刀具进给、机器人的关节旋转，还是半导体设备中晶圆台的精密定位，其底层逻辑都围绕四个核心物理量展开：位置（Position）、速度（Velocity）、加速度（Acceleration）和加加速度（Jerk）。这四个量构成了运动曲线的数学骨架，也直接决定了设备的加工质量、振动水平与节拍效率。本章将深入剖析这四个量的定义、微分/积分关系，并系统对比梯形、S型、多项式等典型运动曲线的特性与适用场景，为后续章节的平滑过渡算法打下坚实的理论基础。
2.1 核心原理：运动四要素的数学本质与物理意义
在运动控制中，位置 \( p(t) \) 是描述物体在空间中的坐标随时间变化的函数。速度 \( v(t) \) 是位置对时间的一阶导数，表示位置变化的快慢；加速度 \( a(t) \) 是速度对时间的一阶导数（位置对时间的二阶导数），表示速度变化的快慢；加加速度 \( j(t) \) 是加速度对时间的一阶导数（位置对时间的三阶导数），表示加速度变化的快慢。这四个量构成了一个完整的微分链：\( p \xrightarrow{d/dt} v \xrightarrow{d/dt} a \xrightarrow{d/dt} j \)。反之，从加加速度开始逐次积分，可以依次还原出加速度、速度和位置。
从物理意义上看，位置对应设备的最终定位精度；速度决定了生产节拍（即单位时间内的加工数量）；加速度与电机输出力矩直接相关，\( F = m \cdot a \)，过大的加速度会导致电机过载或机构打滑；而加加速度则反映了惯性力的变化率，是机械振动和冲击的主要来源。例如，当加加速度为无穷大时（如梯形曲线），意味着加速度瞬间跳变，这会在机械结构中激起高频共振，导致加工表面出现振纹或使减速机寿命缩短。
在实际工程中，我们通常以“规划周期”（如1ms或125μs）为单位，离散化地计算每个周期内的位置指令。控制器输出的位置指令序列经过伺服驱动器的位置环、速度环和电流环处理后，最终转化为电机的电磁力矩。因此，运动曲线的平滑程度不仅影响跟踪误差，还直接影响电流环的波动幅度和功率器件的发热。
2.2 判断方法：如何根据应用需求选择运动曲线类型
选择运动曲线类型时，需要综合考虑设备类型、负载特性、精度要求和节拍需求。以下是工程中常用的判断流程：
- 评估机械刚度与固有频率：如果设备结构刚性高、固有频率远离控制带宽（如重型机床），可以容忍较高的Jerk；如果结构轻巧、固有频率低（如晶圆搬运机械手），必须严格限制Jerk。
- 确定最大速度与加速度：根据电机额定转速和最大力矩，计算出 \( v_{max} \) 和 \( a_{max} \)。这两个参数是曲线规划的硬约束。
- 检查加减速距离是否足够：如果行程较短，无法达到最大速度，则曲线退化为三角形速度曲线；如果行程足够，则采用梯形或S型曲线。
- 根据工艺要求选择曲线阶次：普通物料搬运（如码垛）可采用梯形曲线；精密加工（如激光切割）建议采用S型曲线；超精密定位（如光刻机工件台）则需要5次或7次多项式曲线。
| 曲线类型 | Jerk特性 | 加速度连续性 | 典型应用场景 | 实现复杂度 |
|---|---|---|---|---|
| 梯形速度曲线 | 无穷大（阶跃） | 不连续（跳变） | 低成本步进电机、简单点位运动 | 低 |
| S型速度曲线（3段） | 有限常数 | 连续（线性变化） | 通用伺服系统、机器人关节 | 中 |
| 多项式曲线（5次） | 线性变化 | 连续且一阶可导 | 半导体设备、高精度定位 | 较高 |
| 多项式曲线（7次） | 二次变化 | 连续且二阶可导 | 光刻机、天文望远镜驱动 | 高 |
2.3 案例拆解：梯形曲线与S型曲线在点焊机器人上的对比
某汽车焊装车间的点焊机器人需要完成一次典型的“平移-点焊-平移”动作，单次移动距离为500mm，要求定位时间尽可能短，同时焊点位置精度为±0.1mm。初始方案采用梯形速度曲线，参数设置为：\( v_{max} = 1.0 m/s \)，\( a_{max} = 5 m/s^2 \)。计算可得加速时间 \( t_{acc} = v_{max}/a_{max} = 0.2s \)，加速距离 \( s_{acc} = 0.5 \cdot a_{max} \cdot t_{acc}^2 = 0.1m \)。由于总行程0.5m大于两倍加速距离0.2m，因此存在匀速段，匀速时间 \( t_{vel} = (0.5 - 0.2)/1.0 = 0.3s \)，总运动时间 \( T = 0.2 + 0.3 + 0.2 = 0.7s \)。
然而，在实际调试中发现，当机器人末端执行器在加减速切换瞬间（即加速度从0跳变到5 m/s²，再跳变回0），焊枪电极头出现明显的抖动，导致焊点位置偏差达到±0.35mm，超出工艺要求。同时，机器人底座振动传感器记录到12Hz左右的残余振荡，持续约0.4s，严重影响了后续点焊的节拍。
随后，工程师将运动曲线改为S型速度曲线，设定 \( j_{max} = 50 m/s^3 \)。此时加速度从0线性增加到5 m/s²需要0.1s，加速度曲线变为三角形。重新计算运动时间：加速阶段分为加加速段（0.1s）和减加速段（0.1s），加速距离为 \( 0.5 \cdot j_{max} \cdot t_{acc}^2 \cdot t_{acc} = 0.5 \cdot 50 \cdot 0.1^3 = 0.025m \) 加上匀速段等，总运动时间增加到0.85s。虽然节拍变慢了约21%，但焊点位置误差降低到±0.08mm，振动幅值下降了70%，残余振荡时间缩短至0.1s以内。
2.4 常见误区与总结复盘
误区一：认为梯形曲线“最快”就一定是“最优”。 梯形曲线在数学上确实实现了时间最优（在给定 \( v_{max} \) 和 \( a_{max} \) 约束下），但忽略了Jerk无穷大带来的机械冲击。实际系统中，这种冲击会转化为振动，导致定位稳定时间延长，反而降低了有效节拍。
误区二：盲目追求高阶多项式曲线。 5次或7次多项式虽然能实现极高的平滑度，但计算量大，且对系统参数（如负载惯量变化）敏感。如果伺服系统的速度环带宽不足，高阶曲线的优势无法发挥，反而可能引起跟踪滞后。
误区三：忽略速度、加速度、Jerk的单位换算。 在工程中，位置常用mm或度，速度常用mm/s或°/s，加速度常用mm/s²或°/s²，Jerk常用mm/s³或°/s³。在编写规划算法时，务必统一单位，否则会出现数量级错误。