Underwater Localization System Combining iUSBL with Dynamic SBL in ¡VAMOS! Trials

Emerging opportunities in the exploration of inland water bodies, such as underwater mining of flooded open pit mines, require accurate real-time positioning of multiple underwater assets. In the mining operation scenarios, operational requirements deny the application of standard acoustic positioning techniques, posing additional challenges to the localization problem. This paper presents a novel underwater localization solution, implemented for the ¡VAMOS! project, based on the combination of raw measurements from a short baseline (SBL) array and an inverted ultrashort baseline (iUSBL). An extended Kalman filter (EKF), fusing IMU raw measurements, pressure observations, SBL ranges, and USBL directional angles, estimates the localization of an underwater mining vehicle in 6DOF. Sensor bias and the speed of sound in the water are estimated indirectly by the filter. Moreover, in order to discard acoustic outliers, due to multipath reflections in such a confined and cluttered space, a data association layer and a dynamic SBL master selection heuristic were implemented. To demonstrate the advantage of this new technique, results obtained in the field, during the ¡VAMOS! underwater mining field trials, are presented and discussed.

[1]  S. Majumder.  Sensor fusion and map building for underwater navigation , 2000 .

[2]  M. Karimi,et al.  A comparison of DVL/INS fusion by UKF and EKF to localize an autonomous underwater vehicle , 2013, 2013 First RSI/ISM International Conference on Robotics and Mechatronics (ICRoM).

[3]  Nak Yong Ko,et al.  Fusing Range Measurements from Ultrasonic Beacons and a Laser Range Finder for Localization of a Mobile Robot , 2015, Sensors.

[4]  Erin M. Fischell,et al.  One-way travel-time inverted ultra-short baseline localization for low-cost autonomous underwater vehicles , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[5]  K. Vickery,et al.  Acoustic positioning systems. A practical overview of current systems , 1998, Proceedings of the 1998 Workshop on Autonomous Underwater Vehicles (Cat. No.98CH36290).

[6]  Manuela Herman,et al.  Aided Navigation Gps With High Rate Sensors , 2016 .

[7]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[8]  Wanli Li,et al.  A Novel Scheme for DVL-Aided SINS In-Motion Alignment Using UKF Techniques , 2013, Sensors.

[9]  A. Tomczak,et al.  Modern methods of underwater positioning applied in subsea mining , 2011 .

[10]  Robert Sutton,et al.  Review of multisensor data fusion techniques and their application to autonomous underwater vehicle navigation , 2002 .

[11]  Hugh Durrant-Whyte,et al.  Introduction to Estimation and the Kalman Filter , 2006 .

[12]  António J.M. Ferreira,et al.  Real-time GNSS precise positioning: RTKLIB for ROS , 2020 .

[13]  Thomas Hiller,et al.  Positioning Small AUVs for Deeper Water Surveys Using Inverted USBL , 2012 .

[14]  Yu Zhou,et al.  An efficient least-squares trilateration algorithm for mobile robot localization , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Bruno Matias,et al.  ίVAMOS! Underwater Mining Machine Navigation System , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[16]  Suranga Hettiarachchi,et al.  Trilateration Localization for Multi-robot Teams , 2008, ICINCO-RA.

[17]  Pere Ridao,et al.  Pose-based SLAM with probabilistic scan matching algorithm using a mechanical scanned imaging sonar , 2009, OCEANS 2009-EUROPE.