1. 自动驾驶规划系统的层次化架构解析
在自动驾驶技术发展过程中,路径规划(Route Planning)与运动规划(Motion Planning)的层次化协同架构已成为行业标准范式。这种架构设计源于对人类驾驶行为的深刻观察和工程实践中的必然选择。
1.1 人类驾驶行为的启发
当人类驾驶员使用导航系统时,其决策过程自然地分为两个层次:
- 宏观层面:选择从起点到终点的整体路线,考虑因素包括距离、时间、交通状况和个人偏好(如避开收费路段)。这个过程通常是离线或准离线的,输出结果为一系列道路片段组成的"路线指南"。
- 微观层面:在实际驾驶过程中,根据实时路况(如信号灯、障碍物、道路曲率等),将宏观路线指令转化为具体的油门、刹车和转向操作。这是一个连续的在线控制过程。
自动驾驶系统借鉴了这一分层认知结构,但面临着将抽象的"路线指南"转化为精确控制信号的巨大挑战。这主要体现在三个维度的差异上:
- 表征维度:路线由语义级道路段构成,而车辆需要几何级连续轨迹
- 信息维度:路线规划基于静态先验地图,运动规划必须融合动态实时感知
- 时间维度:路线规划考虑分钟到小时的代价优化,运动规划必须在毫秒到秒内完成决策
1.2 自动驾驶规划系统的四层经典模型
在自动驾驶发展历程中,最经典且广泛采用的规划架构是四层分解模型:
-
路径规划层(Route Planning)
- 工作频率:0.1-1 Hz
- 核心功能:基于路网拓扑的全局路径搜索
- 输出:参考路径和语义导航指令
-
行为决策层(Behavioral Planning)
- 工作频率:约10 Hz
- 核心功能:战术级驾驶行为决策
- 输出:行为指令(如变道、让行等)
-
轨迹规划层(Trajectory Planning)
- 工作频率:20-50 Hz
- 核心功能:生成满足约束的连续轨迹
- 输出:位置、速度、加速度的时间序列
-
反馈控制层(Feedback Control)
- 工作频率:100-500 Hz
- 核心功能:精确跟踪规划轨迹
- 输出:执行器控制命令
这种分层架构并非简单的功能拆分,而是在不同表征空间、约束条件和优化目标之间建立高效的映射与协调机制。各层专注于解决特定范畴的问题,通过明确定义的接口进行信息交换,共同完成从起点到终点的安全、舒适导航。
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 路径规划:全局最优路径的搜索艺术
2.1 路径规划的核心要素
路径规划是在道路网络拓扑图上寻找满足一系列代价约束的最优路径序列的过程。其核心要素包括:
输入数据:
- 导航地图或高精地图的道路级连接关系
- 起点(车辆当前位置在路网上的投影)
- 终点(用户设定的目的地)
- 代价函数(距离、时间、能耗、道路偏好等)
- 动态交通信息(如实时拥堵、事故封闭等)
输出结果:
- 参考路径(Reference Path):由道路段标识符或车道级路径点组成的序列
- 导航指令(Navigation Maneuver):语义化的动作序列(如直行、左转、右转等)
典型算法:
- Dijkstra算法:经典的图搜索算法,保证找到最短路径
- A*算法:引入启发式函数的改进版本,效率更高
- 分层路网搜索(Contraction Hierarchies):预处理路网,加速查询
- 基于交通规则的代价修正:考虑实时交通状况的动态调整
2.2 路径规划的技术挑战与解决方案
在实际工程实现中,路径规划面临诸多挑战:
挑战一:大规模路网的高效搜索
- 全国级路网可能包含数百万个节点,传统算法难以满足实时性要求
- 解决方案:采用分层路网和预处理技术,将搜索时间从秒级降至毫秒级
挑战二:动态交通信息的融合
- 交通状况瞬息万变,静态路径可能很快失效
- 解决方案:建立增量更新机制,仅对受影响部分重新计算
挑战三:多目标优化
- 用户可能同时关注时间、距离、舒适度等多个指标
- 解决方案:采用帕累托最优前沿或加权求和法平衡不同目标
挑战四:特殊场景处理
- 施工区域、临时管制等特殊情况需要特殊处理
- 解决方案:建立规则引擎,对特定场景应用专门策略
2.3 参考路径的表达方式演进
参考路径作为路径规划的输出,其表达方式直接影响运动规划的效果。业界经历了多种表达方式的演进:
-
道路段序列(早期方案)
- 格式:{road_id, lane_id, start_s, end_s}序列
- 优点:数据量极小
- 缺点:运动规划需额外查询几何信息
-
离散路径点串(主流方案)
- 格式:(x,y,z,θ,κ,s,v_limit,lane_type)序列
- 优点:直接提供几何信息
- 缺点:需要权衡密度与数据量
-
参数化曲线(学术倾向)
- 格式:多项式或样条曲线
- 优点:几何连续性保证
- 缺点:复杂路口难以表达
-
车道级参考线+拓扑(高精地图方案)
- 格式:车道级引导指令
- 优点:灵活性高
- 缺点:依赖高精地图
在实际系统中,百度Apollo采用的ReferenceLine类是一个典型实现,它通过样条插值生成稠密参考线(约0.1米间距),同时包含曲率、航向等丰富信息,为运动规划提供了良好基础。
3. 运动规划:从宏观路径到微观执行的转化器
3.1 运动规划的双层结构
运动规划通常可进一步分为行为决策和轨迹规划两个子层:
行为决策层(Behavioral Planning)
- 职责:在参考路径引导下,根据实时交通场景做出战术级决策
- 输入:参考路径、感知障碍物、预测轨迹、交通信号状态
- 输出:行为指令(如"沿当前车道行驶"、"向左变道"等)
- 典型算法:有限状态机(FSM)、决策树、蒙特卡洛树搜索(MCTS)等
轨迹规划层(Trajectory Planning)
- 职责:将行为指令转化为满足各种约束的连续轨迹
- 输入:行为指令、参考路径、障碍物预测、自车状态
- 输出:时空轨迹(位置、航向、速度、加速度序列)
- 典型算法:基于采样(RRT、PRM)、曲线插值、数值优化等
3.2 运动规划的核心挑战
运动规划面临的核心挑战可归纳为"多约束下的实时优化"问题:
动力学约束
- 车辆不能瞬时改变运动状态
- 解决方案:建立车辆动力学模型,将加速度、加加速度等纳入优化
运动学约束
- 转向角度有限制,不能无限大
- 解决方案:考虑最小转弯半径等限制条件
几何约束
- 轨迹必须避开所有障碍物
- 解决方案:构建可行驶区域,在安全空间内搜索
舒适性约束
- 乘客体验至关重要
- 解决方案:优化加加速度(jerk),保证运动平滑
实时性约束
- 规划周期通常为50-100ms
- 解决方案:算法优化和并行计算
3.3 典型运动规划算法比较
| 算法类型 | 代表算法 | 优点 | 缺点 | 适用场景 |
|---|---|---|---|---|
| 基于采样 | RRT, PRM | 高维空间有效,概率完备 | 解的质量不稳定 | 复杂障碍环境 |
| 曲线插值 | 多项式, 贝塞尔 | 计算高效,平滑性好 | 难以处理复杂约束 | 高速公路等简单场景 |
| 数值优化 | MPC, OSQP | 可处理复杂约束,解的质量高 | 计算量大,可能陷入局部最优 | 需要精确控制的场景 |
| 基于学习 | 神经网络 | 可学习复杂策略 | 可解释性差,验证困难 | 端到端系统 |
在实际系统中,工业级解决方案往往采用混合策略,如Apollo的EM Planner结合了基于规则和优化的方法,在保证实时性的同时获得高质量轨迹。
4. 层次化协同的接口设计与实践
4.1 路径规划与运动规划的接口设计
层次化架构的核心在于明确定义各层之间的接口。路径规划与运动规划之间的主要接口包括:
参考路径
- 传递形式:离散点序列或参数化曲线
- 关键属性:位置、方向、曲率、速度建议
- 更新频率:通常1-10Hz
导航指令
- 类型:车道保持、变道、路口转向等
- 附加信息:触发位置、执行区域
- 作用:引导行为决策
引导区域与目标区域
- 路口内虚拟车道
- 停止线位置
- 目标车道区域
4.2 典型协同问题与解决方案
问题一:局部避障与全局路径的冲突
- 现象:为避让障碍物偏离参考路径后,系统可能强制返回原路径导致摆动
- 解决方案:建立短期许可机制,允许合理偏离;长期偏离触发重规划
问题二:信息损失导致的次优决策
- 现象:路径规划未考虑某些局部信息(如临时施工)
- 解决方案:建立反馈通道,运动规划可请求重规划
问题三:动态环境下的时效性问题
- 现象:全局路径可能因环境变化而失效
- 解决方案:建立增量更新机制,仅更新变化部分
4.3 工业级系统实现案例
百度Apollo的实现
- Routing模块:基于拓扑路网搜索
- ReferenceLine提供者:路径平滑与去噪
- 规划器:状态机驱动行为决策,优化生成轨迹
- 亮点:参考线与规划解耦,支持算法独立演进
Autoware的实现
- lane_navigation:基于Lanelet2地图的全局规划
- behavior_selector:行为决策
- obstacle_avoidance:避障轨迹生成
- 特点:模块清晰,适合研究但依赖高精地图
Waymo/Cruise的先进实践
- 意图驱动:导航路径以意图指令形式传递
- 统一优化:减少对显式参考路径的依赖
- 趋势:行为决策与轨迹规划边界模糊化
5. 层次化架构的挑战与未来趋势
5.1 当前面临的主要挑战
复杂城市环境下的实时重规划
- 路口拓扑复杂,搜索空间大
- 解决方案:云端协同计算,优化路网索引
交互博弈与全局路径耦合
- 当前架构中全局路径是静态的
- 前沿方案:将博弈状态反馈至路径规划代价函数
端到端学习的冲击
- 特斯拉等公司探索端到端方案
- 挑战:可解释性、安全验证困难
- 融合趋势:端到端+分层引导的混合架构
5.2 未来发展方向
更智能的协同机制
- 从单向命令到双向协商
- 路径规划作为动态导航员持续参与
- 运动规划具备自主权并能触发全局调整
增强的实时性
- 更高效的重规划算法
- 边缘计算辅助
- 增量式更新优化
多模态融合
- 结合V2X信息
- 融合众包数据
- 动态代价函数调整
在自动驾驶技术的发展道路上,路径规划与运动规划的层次化协同架构仍将持续演进。解耦是为了更好地耦合,当各层次能够高效传递决策意图并在动态环境下快速协调时,自动驾驶系统才能真正实现从A到B的安全、舒适导航。
