一种多传感器融合语义增强增量式自动驾驶建图方法及系统
本发明公开一种多传感器融合语义增强增量式自动驾驶建图方法及系统,包括:获取多传感器同步数据并进行多模态语义融合,生成语义点云并提取路标;执行语义加权前端里程计,根据语义标签属性对配准残差赋权,获得位姿和关键帧;构建包含语义路标观测、几何先验和共视约束因子的统一因子图进行后端优化;采用增量平滑求解器优化,输出全局轨迹和地图要素;新路标与历史路标比对,执行语义级变化检测;基于检测结果对受影响区域局部重优化,以增量补丁融合至已有地图,输出多层高精地图。本发明将语义嵌入SLAM全链路,实现厘米级精度并支持准实时更新。