A Multi-beam Sonar-based Graph SLAM Method

doi:10.3969/j.issn.1000-1093.2020.07.016

Abstract

Abstract: Database-referenced navigation systems(DBRNSs) are commonly used in autonomous underwater vehicles as underwater auxiliary navigation systems to correct the cumulative errors of inertial navigation systems. However, the DBRNS cannot run if a high resolution database cannot be obtained. A multi-beam sonar-based graph simultaneous localization and mapping (SLAM) method is proposed. A mismatch detection module is added to the front end to reduce the negative impact caused by the false closed-loop detection results. In the proposed method, the local gray value coding algorithm is used for the closed-loop detection module in order to improve the detection accuracy. Simulations based on the actual seabed terrain base map show that, compared with the general graph SLAM method, the proposed method can achieve higher positioning accuracy. Key

Key words: autonomousunderwatervehicle, simultaneouslocalizationandmapping, multi-beamsonar, inertialnavigationsystem, mismatchdetection

CLC Number:

U674.91

DAI Tian， MIAO Lingjuan， SHAO Haijun. A Multi-beam Sonar-based Graph SLAM Method[J]. Acta Armamentarii, 2020, 41(7): 1384-1392.

References

［1］ PAULL L, SAEEDI S, SETO M, et al. AUV navigation and localization: a review［J］. IEEE Journal of Oceanic Engineering, 2014, 39(1): 131-149.
［2］ WTNN R B, HUVENNE V A I, BAS T P L, et al. Autonomous underwater vehicles (AUVs): their past, present and future contributions to the advancement of marine geoscience［J］. Marine Geology, 2014, 352(2): 451-468.
［3］ NEMRA A, AOUF N. Robust INS/GPS sensor fusion for UAV localization using SDRE nonlinear filtering［J］. IEEE Sensors Journal, 2010, 10(4): 789-798.
［4］ STUTTERS L, LIU H, TILTMAN C, et al. Navigation technologies for autonomous underwater vehicles［J］. IEEE Transactions on Systems, Man, and Cybernetics - Part C: Applications and Reviews, 2008, 38(4): 581-589.
［5］ BISHOP G C. Gravitational field maps and navigational errors ［unmanned underwater vehicles］［J］. IEEE Journal of Oceanic Engineering, 2002, 27(3): 726-737.
［6］ CANCIANI A, RAQUET J. Airborne magnetic anomaly navigation［J］. IEEE Transactions on Aerospace & Electronic Systems, 2017, 53(1): 67-80.
［7］ CLAUS B, BACHMAYER R. Terrain-aided navigation for an underwater glider［J］. Journal of Field Robotics, 2015, 32(7): 935-951.
［8］ DURRANT W H, BAILEY T. Simultaneous localization and mapping: part I［J］. IEEE Robotics & Automation Magazine, 2006, 13(2): 99-110.
［9］ SAEEDI S, TRENTINI M, SETO M, et al. Multiple-robot simultaneous localization and mapping: a review［J］. Journal of Field Robotics, 2016, 33(1): 3-46.

［10］刘忠泽, 陈慧岩, 崔星, 等. 无人平台越野环境下同步定位与地图创建［J］. 兵工学报, 2019, 40(12): 2399-2406.
LIU Z Z, CHEN H Y, CUI X, et al. Real-time lidar slam in off-road environment for UGV［J］. Acta Armamentarii, 2019, 40(12): 2399-2406. (in Chinese)
［11］ CADENA C, CARLONE L, CARRILLO H, et al. Past, present, and future of simultaneous localization and mapping: toward the robust-perception age［J］. IEEE Transactions on Robotics, 2016, 32(6): 1309-1332.
［12］ THRUN S, MONTEMERLO M. The graph SLAM algorithm with applications to large-scale mapping of urban structures［J］. International Journal of Robotics Research, 2006, 25(5):403-429.
［13］ PUENTE P D L, RODRIGUEZ L D. Feature based graph-SLAM in structured environments［J］. Autonomous Robots, 2014, 37(3): 243-260.
［14］ MA T, LI Y, WANG R P, et al. AUV robust bathymetric simultaneous localization and mapping［J］. Ocean Engineering, 2018, 166: 336-349.
［15］李强, 张钹. 一种基于图像灰度的快速匹配算法［J］. 软件学报, 2006, 17(2): 216-222.
LI Q, ZHANG B. A fast matching algorithm based on image gray value［J］. Journal of Software, 2006, 17(2): 216-222. (in Chinese)
［16］ DAI T, MIAO L J, GUO Y B. A real-time mismatch detection method for underwater database-referenced navigation［J］.Sensors, 2019, 19(2): 307.
［17］ DAI T, MIAO L J, SHAO H J, et al. Solving gravity anomaly matching problem under large initial errors in gravity aided navigation by using an affine transformation based artificial bee colony algorithm［J］. Frontiers in Neurorobotics, 2019, 13(19): 1-11.
［18］ GRISETTI G, KU M R, STACHNISS C, et al. A tutorial on graph-based SLAM［J］. IEEE Intelligent Transportation Systems Magazine, 2010, 2(4): 31-43.
［19］ HARRIS P T, WHITEWAY T. Global distribution of large submarine canyons: geomorphic differences between active and passive continental margins［J］. Marine Geology, 2011, 285(1/2/3/4): 69-86.

第41卷第7期2020 年7月
兵工学报ACTA ARMAMENTARII
Vol.41No.7Jul.2020

[1]	ZHANG Jiawen， FANG Haolin， LI Jiawang. 3D Path Planning of Underactuated AUV Based on Complex Constraints [J]. Acta Armamentarii, 2022, 43(6): 1407-1414.
[2]	ZHANG Yu， WANG Peng， LIU Jiyuan， ZHONG Rongxing， WEI Linzhe， CHI Cheng. Motion Error Estimation Algorithm Based on DPC and INS for Synthetic Aperture Sonar [J]. Acta Armamentarii, 2021, 42(3): 588-597.
[3]	ZHENG Rong， XIN Chuanlong， TANG Zhong， SONG Tao. Review on the Platform Technology of Autonomous Deployment of AUV by USV [J]. Acta Armamentarii, 2020, 41(8): 1675-1687.
[4]	SHENG Liang， QIU Zhiming， YU Shaozhen， JIAO Junjie. A Novel Distance Regularized Hybrid Level Set Method for AUV Multi-destination Route Planning [J]. Acta Armamentarii, 2020, 41(4): 750-762.
[5]	SHEN Shibin, XIE Fei, ZHAO Jing, QIAN Weixing, KANG Guohua, LIU Xixiang. A Signal Demodulation Method for Ultra-tightly Coupled INS/GNSS Navigation System Based on Phase Control [J]. Acta Armamentarii, 2020, 41(3): 495-506.
[6]	HU Jie， YAN Yongjie， WANG Zihui. Vehicle Integrated Navigation Based on Velocity Constraint and Fuzzy Adaptive Filtering [J]. Acta Armamentarii, 2020, 41(2): 231-238.
[7]	CHANG Zhenjun, ZHANG Zhili, ZHOU Zhaofa, XU Zhihao, GUO Qi. Initial Alignment for Rotating SINS Based on On-line Compensation of Size Effect [J]. Acta Armamentarii, 2020, 41(10): 2016-2022.
[8]	WANG Qi, WANG Lixin, LIANG Shuhui, QIN Weiwei, SHEN Qiang. Selection of System Models for Continuous Self-calibration of Hybrid Inertial Navigation System Based on Observability Analysis [J]. Acta Armamentarii, 2020, 41(1): 56-67.
[9]	ZHU Bing, XU Jiangning, WU Miao, LI Jingshu, HE Hongyang, LI Feng. An Improved Optimal Alignment Method of Strapdown Inertial Navigation System Based on Reverse Navigation Algorithm [J]. Acta Armamentarii, 2019, 40(9): 1860-1870.
[10]	DONG Chunmei， REN Shunqing， CHEN Xijun， LI Wei. A System-level Calibration Method for Laser Gyro SINS [J]. Acta Armamentarii, 2019, 40(8): 1618-1626.
[11]	GUO Jingqian， ZHENG Rong， L Houquan. AUV Underwater Docking Collision Analysis and Guidance Structure Optimization Based on ADAMS Simulation [J]. Acta Armamentarii, 2019, 40(5): 1058-1067.
[12]	XU Haowei, LIAN Baowang, LIU Shangbo. Multi-source Integrated Navigation Algorithm for Iterated Maximum Posteriori Estimation Based on Sliding-window Factor Graph [J]. Acta Armamentarii, 2019, 40(4): 807-819.
[13]	WANG Jinqiang， WANG Cong， WEI Yingjie， ZHANG Chengju. Position Tracking Control of Autonomous Underwater Vehicles in the Disturbance of Unknown Ocean Currents [J]. Acta Armamentarii, 2019, 40(3): 583-591.
[14]	LI Qunsheng， ZHAO Yan， WANG Jinda. A Vision Aided MEMS-SINS/GPS Ultra-tight Coupled Navigation System Suitable for High Dynamic and Strong Interference Environment [J]. Acta Armamentarii, 2019, 40(11): 2241-2249.
[15]	XU Bo, LI Shengxin, JIN Kunming, WANG Lianzhao. A Cooperative Localization Method for AUVs Based on RBF Neural Network-assisted CKF [J]. Acta Armamentarii, 2019, 40(10): 2119-2128.