4. 地图与定位

在NOA匝道与高速场景规划工程中,地图与定位不是两个独立模块,而是共同构成“车辆在哪里、前方是什么、应该怎么走”的空间认知底座。高精地图提供厘米级几何与车道拓扑,语义地图把道路要素抽象为可推理的标签,车道级定位把自车精确绑定到某条车道,全局路径负责从起点到终点的宏观路线,局部路径则负责在当前车道与匝道口附近生成可执行的轨迹。四者关系可以概括为:高精地图是骨架,语义地图是标签,车道级定位是锚点,全局路径是目标,局部路径是动作。

核心理解:没有车道级定位,高精地图只是一张静态图纸;没有语义地图,规划器无法理解“匝道分流”“应急车道”“导流线”等驾驶含义;没有全局与局部路径的分层,NOA就无法在高速与匝道之间平滑切换。

一、高精地图与语义地图:几何底座与驾驶语义

高精地图通常包含车道中心线、车道边线、道路边界、曲率、坡度、限速、匝道连接关系等几何与拓扑信息,精度可达分米甚至厘米级。它解决的是“路长什么样”的问题。语义地图则在高精地图基础上叠加驾驶语义,例如车道类型(主路、匝道、加速车道、减速车道)、交通标志、地面箭头、导流区、可行驶区域、汇入汇出关系等。它解决的是“这条路意味着什么”的问题。

在NOA场景中,语义地图尤其关键。例如车辆接近高速出口时,语义地图会标记“前方2km右侧匝道”“当前车道可驶出”“相邻车道为实线不可变道”等语义,规划器据此提前决策。高精地图提供几何位置,语义地图提供决策依据,两者缺一不可。

二、车道级定位:把自车锚定到车道拓扑

车道级定位的目标不是简单输出经纬度,而是输出“自车位于哪条车道、距车道中心线横向偏差多少、航向角与车道夹角多少、前方拓扑连接关系如何”。常用手段包括GNSS+RTK、IMU、轮速计、视觉车道线检测、激光雷达点云匹配与高精地图匹配。多源融合后,定位结果通常以map_frame下的位姿和车道ID表达。

定位输出示例:
frame_id: map
lane_id: R2_L1
s: 128.4 m        # 沿车道纵向距离
lateral_offset: -0.18 m
heading_error: 1.2 deg
confidence: 0.96
next_lanes: [R2_L2, RAMP_R1]

其中s和lateral_offset是规划器最关心的参数:纵向距离决定何时开始减速或变道,横向偏差决定横向控制修正量。若定位跳变或车道ID误匹配,NOA可能把主路误判为匝道,导致错误减速或退出。

三、全局路径与局部路径:宏观导航与微观轨迹

全局路径由导航模块生成,通常基于路网图搜索得到从起点到终点的车道级序列,例如“主路G2→出口匝道R1→收费站→城市道路”。它回答“走哪条路”。局部路径由规划模块在全局路径约束下,结合当前车道、障碍物、交通流和车辆动力学,生成未来数秒内的可行驶轨迹。它回答“当前怎么走”。

两者关系是分层约束:全局路径给出目标车道序列和关键节点(如匝道口、分流点),局部路径必须在全局路径的拓扑框架内生成。若局部路径偏离全局路径,规划器需要判断是临时避障还是路线错误,并决定是否重新规划或请求导航更新。

NOA地图与定位分层关系图 高精地图(几何底座) 车道中心线 · 车道边线 · 曲率 · 坡度 · 限速 · 匝道连接拓扑 输出:map_frame 下的道路几何与车道级拓扑关系 语义地图(驾驶含义) 车道类型 · 导流区 · 地面箭头 · 交通标志 · 汇入汇出关系 · 可行驶区域 输出:供规划器推理的语义标签与约束条件 车道级定位(自车锚点) GNSS+RTK · IMU · 轮速计 · 视觉车道线 · 激光点云匹配 · 地图匹配 输出:lane_id · s · lateral_offset · heading_error · confidence 全局路径(宏观导航) 路网图搜索 → 车道级序列 例:G2主路 → 出口匝道R1 → 收费站 回答:走哪条路? 局部路径(微观轨迹) 当前车道 + 障碍物 + 交通流 + 动力学 生成未来数秒可行驶轨迹 回答:当前怎么走? 拓扑约束 定位反馈

四、案例:高速出口匝道场景中的协同

假设车辆以120km/h行驶在G2高速主路,导航全局路径指示“前方2km右转驶入R1匝道”。此时:

  • 高精地图给出主路与匝道的几何连接,包括分流点坐标、匝道曲率与限速。
  • 语义地图标记“当前车道可驶出”“右侧车道为减速车道”“分流区导流线不可跨越”。
  • 车道级定位输出自车位于主路R2_L1,距分流点纵向距离约1800m,横向偏差0.1m。
  • 全局路径要求车辆在分流点前进入R1匝道。
  • 局部路径据此生成“保持当前车道→在1.2km处开始向右变道→进入减速车道→沿匝道曲率减速至40km/h”的轨迹。

若定位模块误将自车匹配到相邻车道,局部路径可能生成错误的变道时机;若语义地图缺失“导流线不可跨越”标签,规划器可能生成穿越导流区的危险轨迹。因此,地图与定位的精度和一致性直接决定NOA匝道通过率。

五、常见误区与复盘要点

误区 表现 复盘要点
只依赖GNSS定位 隧道或城市峡谷中车道ID跳变 必须融合视觉车道线与地图匹配,输出置信度
高精地图与语义地图不同步 几何上存在匝道,语义上未标记可驶出 建立地图版本一致性校验,语义层随几何层更新
全局路径与局部路径解耦 局部轨迹偏离全局路线却未触发重规划 设置拓扑偏离监控,超过阈值请求导航更新
忽略横向偏差累积 长弯道中自车逐渐偏离车道中心 局部路径需持续跟踪lateral_offset并闭环修正
工程建议:在NOA匝道场景中,建议将车道级定位的confidence低于0.8时降级为“车道保持+人工确认”,避免因定位不确定导致错误变道。同时,全局路径应提前至少2km给出匝道预告,局部路径在分流点前500m完成目标车道选择。

总结来看,高精地图与语义地图构成静态认知层,车道级定位构成动态锚定层,全局路径与局部路径构成规划决策层。四层之间通过车道ID、纵向距离、横向偏差和拓扑连接关系紧密耦合。只有理解并打通这四层关系,NOA才能在高速与匝道场景中实现安全、平滑、可解释的自动驾驶行为。