一种全局混合地图创建方法
摘要:
本发明基于栅格地图、拓扑地图以及几何特征地图各自的优缺点,汲取各种地图模型的优点,提出了一种可同时服务于位姿估计以及无人车辆导航的全局混合地图模型。全局混合地图主要由子地图节点以及子地图节点间连通关系构成。子地图节点中的地图数据包括三维概率特征子地图、三维概率栅格子地图以及可通行区域。三维概率特征子地图以及三维概率栅格子地图采用基于顺序存储结构和树形结构的混合数据结构进行数据组织,以提高其数据更新的实时性,并通过概率滤波提高了子地图对于系统噪声的鲁棒性。三维概率特征子地图以及三维概率栅格子地图共同与点云匹配进行位姿估计。基于三维概率栅格子地图提取用于无人车辆导航的可通行区域。
0/0