一、轨迹规划基础：路径与轨迹在机器人运动控制中，路径（Path）与轨迹（Trajectory）有本质区别：路径仅描述空间几何（如直线、圆弧、样条曲线），不包含时间信息；轨迹则在路径上附加时间律，规定"何时到达何处"。轨迹规划按空间分两类：任务空间规划直接描述末端执行器的位姿-时间序列，适合喷涂、焊接等对末端路径精度要求高的场景，但需实时逆运动学解算，计算量较大；关节空间规划对各关节分别规划角度-时间曲线，无逆解负担，适合点到点运动（如搬运、码垛），但无法精确控制末端路径形状。工程中常混合使用：粗插补在任务空间生成waypoints，精插补在关节空间完成S形速度剖面生成。
二、S形七段速度曲线模型梯形速度曲线因加速度不连续会产生冲击（Jerk无限大），S形曲线通过约束加加速度Jerk为常数a_max/t_acc，实现加速度的连续变化。标准S形速度曲线由七个阶段组成：（1）加加速段——Jerk=+J_max，加速度从0线性增至A_max；（2）匀加速段——Jerk=0，加速度保持A_max；（3）减加速段——Jerk=-J_max，加速度从A_max线性降至0，速度达到V_max；（4）匀速段——加速度=0，速度维持V_max；（5）加减速段——Jerk=-J_max，加速度从0线性降至-A_max；（6）匀减速段——Jerk=0；（7）减减速段——Jerk=+J_max，加速度从-A_max线性回升至0，速度归零。Jerk约束值由机械传动链承受能力和电机转矩变化率共同决定，典型值为最大加速度的10~20倍/秒。当行程过短时V_max无法达到，曲线退化为四段或六段形式。
三、多项式插值平滑性对比关节空间轨迹常用多项式插值保证运动平滑性：三次样条插值保证位置和速度连续（C¹连续），节点处加速度可能跳变，适用于对冲击要求不高的场景；五次多项式插值可约束起止点的位置、速度、加速度共6个边界条件，保证C²连续（加速度无跳变），从根本上消除Jerk尖峰，是对运动平稳性要求严苛场景（如晶圆搬运、光学检测）的首选。B样条和NURBS曲线进一步支持高阶连续，但计算复杂度显著增加，通常仅在CNC五轴加工中采用。
四、多段轨迹Blend平滑过渡执行多段连续轨迹（如点焊任务中的多点快速移动）时，段间若直接停止再启动会导致频繁加减速和机械冲击。解决方案为Blend过渡：抛物线混合在前段减速与后段加速之间构造一段抛物线过渡区域，以恒定加速度连接两段，实现位置和速度连续但加速度非连续；Bezier曲线过渡以三次或五次Bezier曲线作为混合段，可保证曲率连续性，适合精密路径；Circle Blending在两直线段交点附近引入圆弧过渡，过渡半径R越大越平滑但会偏离原始路径，需在平滑性和路径精度之间权衡。Blend起止点由过渡时间和容许路径误差共同决定。
五、前瞻速度规划（Look-Ahead）当轨迹包含曲率突变（如直角转弯）时，必须提前减速以保证安全通过。前瞻规划的核心是双向速度扫描：正向扫描按最大加速度约束从起点推算每段最大可达速度，反向扫描从终点倒推保证能及时停止。每段的实际速度取正向与反向的交集——即min(正向可达速度, 反向约束速度)，从而在转弯处自动减速、直线段恢复高速，实现全局速度最优衔接。前瞻窗口长度一般取40~100段，配合环形缓冲区实现流式实时插补。
六、时间最优轨迹优化在给定运动学约束下最小化运动时间属于时间最优路径规划（TOPP）问题。在相平面（s, ds/dt）上，路径参数s沿弧长参数化，速度上限由关节力矩/速度/加速度约束共同投影为相平面中的可行区域边界。TOPP在可行域内搜索最大速度曲线——即沿边界"贴着走"——可在满足所有约束的前提下获得全局时间最优解，典型求解器采用数值积分法（前向+后向积分在切换点匹配），计算耗时约为路径段数的平方量级。该方法已在工业中用于注塑机械手取出周期优化，节拍缩短15~25%。
七、ROS MoveIt轨迹规划器对比ROS MoveIt提供了多种运动规划器插件：BiRRT（双向快速随机树）以概率完备性著称，在高维空间中搜索速度快，但路径非最优且存在随机抖动，适合粗规划；CHOMP（协变哈密顿优化）将轨迹视为高维曲线，以平滑性和避障为代价函数进行梯度优化，生成平滑无抖动轨迹；STOMP（随机轨迹优化）在初始轨迹附近采样多条扰动轨迹并加权平均，无需梯度信息即可处理任意代价函数（如关节限位、奇异点距离），特别适用于代价函数非光滑的场景。实践中推荐CHOMP+STOMP级联：先RRT生成初始解，CHOMP平滑优化，STOMP精调末端约束。
——全文约1150字 |
