基于粒子滤波与图优化的海底地形同步定位与建图方法
Abstract:
本发明属于海底地形同步定位与建图技术领域,具体涉及一种基于粒子滤波与图优化的海底地形同步定位与建图方法。本发明设计了一种使用位姿图结构对粒子自身储存轨迹进行更新,并使用位姿图在每一时刻结束时生成此时刻输出地图的粒子滤波BSLAM算法。本发明只需要在每一时刻输入里程计数据和由多波束声获得的地形测深,在没有先验地形图的情况下实现AUV的同步定位与建图。本发明所提出的图优化混合粒子滤波BSLAM算法相较于基于子地图匹配的粒子滤波BSLAM算法,在大累积误差下仍能实时准确的提供定位与建图结果。
Patent Agency Ranking
0/0