4. 轨迹规划基本概念

在工业机器人控制系统中，轨迹规划是连接任务描述与伺服执行的核心桥梁。工程师常将“路径”与“轨迹”混用，但在运动控制领域，二者有严格区分：路径描述空间几何关系，轨迹则附加了时间属性。本章围绕六个核心概念展开——路径、轨迹、插补、插值、控制周期、速度与加速度约束，厘清它们之间的逻辑层级与工程实现方法，为后续关节空间规划、笛卡尔空间规划及动力学约束优化奠定基础。

4.1 路径与轨迹：空间几何与时间律的分离

核心原理：路径（Path）是机器人末端或关节在空间中经过的几何点集合，仅描述位置与姿态变化，不包含时间信息。例如，从A点经B点到C点的直线段或圆弧段，属于纯几何描述。轨迹（Trajectory）则是在路径基础上附加时间标度，即每个路径点对应一个到达时刻，并由此推导出速度、加速度等运动学参数。轨迹规划的本质是解决“何时到达何处”的问题。

判断方法：工程中区分路径与轨迹，可观察数据是否包含时间戳或速度信息。若仅有位置序列（如P0、P1、P2），则为路径；若包含t0、t1、t2及对应的速度v0、v1、v2，则为轨迹。在机器人控制器中，路径通常由示教器或离线编程软件生成，轨迹则由运动规划器实时计算。

4.2 插补与插值：离散化与连续化的双向操作

核心原理：插补（Interpolation）是轨迹规划的核心执行环节，指在已知路径点之间，按照控制周期Ts（如1ms、4ms、8ms）计算出中间点位置的过程。插补器每周期输出一组关节角度或笛卡尔坐标，供伺服驱动器跟踪。插值（Fitting）则更偏向数学拟合，即用多项式、样条函数等连续函数逼近离散点列，用于生成平滑的路径曲线或速度曲线。

操作流程：典型插补流程为：① 读取轨迹规划器输出的目标位置与速度；② 根据当前周期计数计算归一化时间s = t/T_total；③ 调用插补函数（线性、圆弧、样条）计算当前周期位置；④ 输出到伺服接口。插值则常用于离线阶段，例如用三次样条拟合示教点，生成连续路径后再进行在线插补。

// 线性插补伪代码（周期Ts=4ms）
for (int i = 0; i < total_steps; i++) {
    double s = (double)i / total_steps;  // 归一化时间
    q_current = q_start + (q_end - q_start) * s;
    send_to_servo(q_current);
    sleep(Ts);
}

4.3 控制周期与实时性约束

核心原理：控制周期Ts是机器人控制器向伺服驱动器发送指令的时间间隔，决定了轨迹跟踪的精度与平滑度。典型工业机器人位置环周期为1ms~8ms，速度环周期为0.5ms~2ms，电流环周期为0.05ms~0.2ms。插补器必须在每个Ts内完成一次位置计算，因此算法复杂度受严格实时性约束。

判断方法：选择控制周期需考虑：① 机械谐振频率（周期应小于谐振周期的1/10）；② 伺服驱动器通信延迟（EtherCAT通常为1ms）；③ 控制器CPU负载率（建议低于70%）。若周期过长，轨迹跟踪误差增大；过短则CPU负担过重。

4.4 速度与加速度约束：从电机极限到机构安全

核心原理：速度与加速度约束是轨迹规划的安全边界，来源于三个层面：① 电机额定转速与最大扭矩；② 减速器承受能力；③ 末端负载与机构刚性。加速度约束直接决定启停阶段的冲击力，而加加速度（Jerk）约束则影响振动水平。轨迹规划器必须在满足所有约束的前提下，寻找时间最优或能量最优的运动曲线。

操作流程：约束设置流程为：① 查阅电机手册获取额定转速n_max与峰值扭矩T_peak；② 计算关节最大角速度ω_max = n_max / 减速比；③ 根据负载惯量J_load计算最大角加速度α_max = T_peak / (J_motor + J_load)；④ 根据工艺要求（如避免液体晃动）设置Jerk上限。规划器在生成梯形速度曲线或S曲线时，需逐段校验这些约束。

// 梯形速度规划约束校验
double v_max = min(v_motor_limit, v_mechanism_limit);
double a_max = min(a_torque_limit, a_process_limit);
double t_acc = v_max / a_max;  // 加速时间
double t_total = t_acc + (total_dist - v_max*t_acc) / v_max + t_acc;

4.5 案例拆解：六轴机器人圆弧轨迹规划的参数整定

案例背景：某汽车零部件产线使用六轴机器人进行圆弧焊缝焊接，要求末端沿半径R=200mm的圆弧匀速运动，焊接速度v=15mm/s，起止点夹角90°。初始调试时出现焊缝宽度不均、飞溅增多等问题。

初始现象与目标：焊缝宽度波动±0.5mm，超出工艺要求±0.2mm。目标是将速度波动控制在±2%以内，加速度峰值不超过0.5g。

关键输入数据：机器人控制器周期Ts=4ms，关节2最大速度120°/s，最大加速度300°/s²，末端负载8kg。圆弧路径由示教器三点确定（起点、中点、终点）。

分析判断过程：① 检查插补器输出，发现圆弧插补采用等角度步进，导致线速度在关节极限位置波动达±8%；② 检查速度规划，发现梯形速度曲线在圆弧入口处加速度突变，引起振动；③ 检查约束设置，加速度限制未生效（控制器参数被误设为0）。

实际操作步骤：① 将圆弧插补改为等弧长步进，每周期计算弧长增量Δs = v × Ts；② 采用S曲线速度规划，加速时间设为0.3s，Jerk限制为500mm/s³；③ 在控制器参数中正确启用加速度限制，设定a_max=0.4g；④ 重新示教圆弧路径，确保三点共圆误差小于0.1mm。

结果对比：调整后，焊缝宽度波动降至±0.15mm，速度波动±1.5%，加速度峰值0.38g，满足工艺要求。焊接飞溅减少约30%。

风险与代价：等弧长插补增加了计算量（约15%CPU负载），S曲线规划使单次焊接节拍增加0.2s。但整体良品率从92%提升至98.5%，综合效益显著。

复盘经验：圆弧轨迹规划必须同时关注插补方式（等弧长 vs 等角度）与速度规划（梯形 vs S曲线）。工程中建议优先使用等弧长插补，并在速度规划中预留加速度裕量（通常取理论值的80%）。

4.6 总结与常见误区复盘

核心要点回顾：路径是几何描述，轨迹是时间描述；插补是实时离散化，插值是离线拟合；控制周期决定跟踪精度；速度与加速度约束是安全底线。六个概念构成完整的轨迹规划知识框架，缺一不可。