基于分布式因子图的USV-AUV异构编队全局一致性测深SLAM方法

Distributed Factor Graph-Based Global Consistency Bathymetric SLAM for USV-AUV Heterogeneous Formation

  • 摘要: 目的为解决水下异构编队中自主水下航行器定位误差累积的技术难题,研究一种基于分布式因子图的USV-AUV协同测深同步定位与建图方法。方法利用超短基线水声定位技术建立USV与AUV间的实时位姿关联,通过USV对多AUV子地图实施全局优化,构建跨平台时空约束模型以消除多平台数据异步误差;针对水声信道带宽受限的瓶颈,提出莫顿编码优化的八叉树压缩算法,实现子地图数据的高效无损压缩,将单帧测深子地图数据量从MB级降至KB级;针对稀疏地形特征下的地图匹配难题,设计融合全局最优粗匹配、广义迭代精匹配及成对一致性检验的三级匹配机制,以降低匹配误差。结果以1艘USV与3艘AUV组成的异构编队为实验平台,在复杂水域环境中开展对比实验,结果表明:相比传统基于扩展卡尔曼滤波的协同SLAM方法,所提方法使AUV绝对定位精度提升22%,建图全局一致性提高16.05%,数据传输效率提升60%以上。结论该研究为水下异构编队的高精度协同探测提供了可靠的技术支撑,表明分布式因子图与数据压缩、地形匹配相结合可有效提升深海测绘的定位与建图性能。

     

    Abstract: Objectives To reduce the accumulated positioning error of autonomous underwater vehicles in underwater heterogeneous formations, a USV-AUV cooperative bathymetric simultaneous localization and mapping method based on a distributed factor graph is proposed. Methods Real-time pose constraints between the USV and multiple AUVs are established using ultra-short baseline acoustic positioning. The SINS/DVL odometry constraints, USBL positioning constraints and terrain-matching loop constraints are represented in a factor graph to achieve global optimization of AUV poses and bathymetric submaps. To reduce the data transmission load over low-bandwidth underwater acoustic channels, a Morton-code optimized octree and arithmetic coding method is adopted for lossless compression of bathymetric submaps. A three-stage terrain matching strategy combining globally optimal coarse registration, generalized iterative closest point fine registration and pairwise consistency maximization is further designed to suppress false loop closures. Results Simulation results with one USV and three AUVs show that, compared with the EKF-based cooperative SLAM method, the proposed method improves AUV positioning accuracy by 22%, increases global mapping consistency by 16.05%, and reduces the single-frame bathymetric submap data size from the MB level to the KB level.Conclusions The proposed method can improve the positioning and mapping accuracy of USV-AUV heterogeneous formations while reducing underwater acoustic communication load, providing a feasible technical route for cooperative bathymetric mapping.

     

/

返回文章
返回