海底地形匹配高效质点滤波导航方法

作者:马腾; 丁硕硕; 范佳佳; 李晔
来源:数字海洋与水下攻防, 2021, 4(06): 439-445.
DOI:10.19838/j.issn.2096-5753.2021.06.002

摘要

海底地形匹配导航技术可实现自主水下机器人(Autonomous Underwater Vehicle,AUV)长时间的水下精确导航。质点滤波器(Point-Mass Filter,PMF)是实现AUV精确海底地形匹配导航的重要方法,但质点权重计算过程中需要寻找空间分布不规则的实测地形数据点与网格化先验地形图数据点间空间对应关系,造成大量计算消耗,严重影响了地形匹配导航算法实时性能。提出一种海底地形匹配高效质点滤波导航方法,通过构建伪输入高斯过程(Sparse Pseudo-input Gaussian Processes,SPGPs)模型,实现实测海底地形数据高效、精确网格化插值过程,并根据SPGPs方法提供的插值置信度实现网格化概率地图构建;搭建质点滤波器算法框架,提出适用于概率地图的质点权重计算过程,通过考虑网格化地图不同节点插值置信程度差别,提高地形匹配导航精度。于青岛中沙礁展开海上数据获取试验,并利用海试数据完成算法回放式仿真验证。试验结果证明,所提出网格化插值方法可实现高精度、高效地形深度插值过程,所提出海底地形匹配高效质点滤波导航方法可为AUV在线提供精确导航结果,且实时导航圆概率误差小于3 m。