轨迹跟踪的期望曲线是如何得到的？｜经纬恒润控制算法面经解析

60 秒回答模板

轨迹跟踪的期望曲线一般不是凭空给出的，而是从上层任务或路径规划结果生成。先根据地图、目标点、障碍物和车辆/机器人运动学约束得到一条几何路径，例如全局路径或局部避障路径；然后做平滑和曲率约束，保证路径连续、曲率和曲率变化率不超过执行能力；再进行速度规划和时间参数化，把几何路径变成带时间戳的参考轨迹，包含期望位置、航向、曲率、速度、加速度，必要时还有横摆角速度。生成时要考虑最大速度、加速度、转向角、转向角速度、制动距离、轮胎或履带约束、载荷和地面条件。控制器跟踪的是这个可执行参考，所以要验证期望曲线是否平滑、是否和坐标系一致、是否满足动力学约束，以及在仿真和实机中误差是否可收敛。

考点 生成链路

难度 真实面经题

回答目标 说明期望轨迹从规划路径到可跟踪时间序列的生成、约束和验证方法。

深入解析

来源是任务和规划

期望曲线通常来自全局规划、局部规划、人工示教、离线轨迹或任务脚本。它首先是一条满足目标点、地图约束和障碍物约束的几何路径，而不是控制器内部临时生成的一串随意点。

路径要做平滑处理

原始路径可能有折线、尖角和不连续曲率，控制器难以跟踪。需要用样条、曲线拟合、优化或插值方法平滑，并限制曲率、曲率变化率和与障碍物的安全距离。

再做时间参数化

几何路径只描述走哪里，轨迹还要描述什么时候到。速度规划会根据最大速度、加速度、曲率、制动距离和任务需求生成 v、a、yaw rate 等参考量，形成带时间戳的期望状态序列。

必须满足机器人约束

不同底盘约束不同。差速、阿克曼、履带、机械臂或工程车辆的最小转弯半径、侧向加速度、转向响应和载荷限制不同。期望曲线如果违反运动学或动力学约束，跟踪误差再调控制器也难以消除。

坐标系和采样也关键

参考轨迹要明确是在地图系、车体系还是局部规划系，时间戳、采样周期和插值方式要和控制周期匹配。坐标系错、采样太稀或延迟未补偿，都会造成看似控制问题的跟踪误差。

验证要看可跟踪性

生成后要用仿真和实机验证横向误差、航向误差、速度误差、控制饱和和舒适性。好的期望曲线不仅避开障碍，还要让控制器在边界条件下可稳定跟踪。

易错点

把期望曲线说成简单打点连接，没有考虑平滑、曲率和速度规划。
只讲规划算法名，不说明输出给控制器的参考状态有哪些。
忽略机器人运动学和执行器限制，生成不可跟踪轨迹。
不提坐标系、时间戳和采样周期，容易把参考问题误判为控制问题。
只验证避障成功，不验证控制误差、饱和和边界工况。

面试官追问

路径和轨迹有什么区别？

路径主要是几何空间中的点和方向，描述走哪里；轨迹带时间信息和速度加速度等状态，描述什么时候以什么状态走到那里。

为什么曲率连续很重要？

曲率不连续会要求转向或角速度瞬间变化，真实执行器做不到，会造成控制饱和、轨迹抖动和跟踪误差。

控制器跟不上期望曲线时怎么办？

先检查期望轨迹是否违反运动学/动力学约束，再看速度规划、采样延迟和坐标系，必要时降低速度、重新平滑或增加前馈和延迟补偿。