A novel GPS/DVL/MEMS-INS smartphone sensors integrated method to enhance autonomous navigation, guidance and control system of AUSVs based on ADSF Combined Filter

Abstract A reliable navigation, guidance and control system of Autonomous Unmanned Surface Vehicle (AUSV) is the major challenge for most researchers, especially when Global Positioning System (GPS) signal outages or its accuracy decreases in some places on the Earth’s surface. Our paper introduces a novel navigation, guidance and control system of AUSV as follows; the proposed navigation system of AUSV is based on integrated Micro Electric Mechanical System –Inertial Navigation System (MEMS-INS) smartphone sensors with GPS and Doppler Velocity Log (DVL) to correct AUSV navigation system errors. The guidance and control system of AUSV is based on Ultrasonic sensors, Raspberry Pi microcontroller, and digital compass sensor. The ultrasonic sensor is used to detect and avoid obstacles on the path of AUSV. The Raspberry Pi microcontroller and digital compass are used to guide AUSV in the required path. Since the GPS and DVL signals are used as the reference sources to correct errors of MEMS-INS system, the accuracy of GPS and DVL decreases due to a bad weather and due to associated noise of DVL measurement, which effects on a whole AUSV navigation system. To resolve this problem, the Adaptive Data Sharing Factor (ADSF) using Combined Filter (CF) is used as integrated method. According to proposed ADSF CF integrated method, the reference source (GPS or DVL) which has the beast accurate system will be used to correct the navigation errors. At same time the least accuracy system will detect and avoid. The efficiency of navigation, guidance and control system of AUSV based on proposed GPS/DVL/MEMS-INS ADFS CF integrated method is tested on surface reference trajectory with four obstacles located on the path of AUSV. During GPS outages, the AUSV was able to reach the target location to implement several tasks such as monitoring, exploring, tracking and returned back to base station depending on the stored path in its memory with high efficiency. Based on estimated results, the proposed navigation system could provide continuous navigation solution and reduce the navigation error to about 85.43% compared to GPS/DVL/MEMS CKF method and to about 68.14% compared to GPS/DVL/MEMS Constant DSF Combined filter.

[1]  Bernhard Hofmann-Wellenhof,et al.  GNSS - Global Navigation Satellite Systems: GPS, GLONASS, Galileo, and more , 2007 .

[2]  Fang Ye,et al.  Performance Enhancement of a USV INS/CNS/DVL Integration Navigation System Based on an Adaptive Information Sharing Factor Federated Filter , 2017, Sensors.

[3]  Wanli Li,et al.  A novel backtracking navigation scheme for Autonomous Underwater Vehicles , 2014 .

[4]  Aboelmagd Noureldin,et al.  Fundamentals of Inertial Navigation, Satellite-based Positioning and their Integration , 2012 .

[5]  Sri Shakthi.  Raspberry PI Based Underwater Vehicle for Monitoring Aquatic Ecosystem , 2015 .

[6]  Lin Zhao,et al.  A Novel Grid SINS/DVL Integrated Navigation Algorithm for Marine Application , 2018, Sensors.

[7]  T. Ura,et al.  Three dimensional synthetic and real aperture sonar technologies with Doppler velocity log and small fiber optic gyrocompass for autonomous underwater vehicle , 2012, 2012 Oceans.

[8]  Andysah Putera Utama Siahaan,et al.  Haversine method in looking for the nearest masjid , 2017 .

[9]  Tao Zhang,et al.  Coarse Alignment Technology on Moving Base for SINS Based on the Improved Quaternion Filter Algorithm , 2017, Sensors.

[10]  Xiaoji Niu,et al.  Low-end MEMS IMU can contribute in GPS/INS deep integration , 2014, 2014 IEEE/ION Position, Location and Navigation Symposium - PLANS 2014.

[11]  Tao Zhang,et al.  A new method of seamless land navigation for GPS/INS integrated system , 2012 .

[12]  Dong Wang,et al.  Online-SVR for vehicular position prediction during GPS outages using low-cost INS , 2015, 2015 IEEE 26th Annual International Symposium on Personal, Indoor, and Mobile Radio Communications (PIMRC).

[13]  P. Groves.  Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems , 2007 .

[14]  A. J. Henley,et al.  An integrated navigation system manager using federated Kalman filtering , 1991, Proceedings of the IEEE 1991 National Aerospace and Electronics Conference NAECON 1991.

[15]  Clinton D. Winant,et al.  Performance and Calibration of an Acoustic Doppler Current Profiler Towed below the Surface , 1995 .

[16]  Shubo Wang,et al.  A GNSS/INS Integrated Navigation Algorithm Based on Kalman Filter , 2018 .

[17]  Xiaosu Xu,et al.  A hybrid fusion algorithm for GPS/INS integration during GPS outages , 2017 .

[18]  Yueming Zhao.  GPS/IMU Integrated System for Land Vehicle Navigation based on MEMS , 2011 .

[19]  Kwok Hung Li,et al.  Real-time precision pedestrian navigation solution using Inertial Navigation System and Global Positioning System , 2015 .

[20]  A. Kluga,et al.  Adaptive Extended Kalman Filter for Aided Inertial Navigation System , 2012 .

[21]  Jacek Januszewski,et al.  Sources of Error in Satellite Navigation Positioning , 2017 .

[22]  Bilkis Jamal Ferdosi,et al.  Obstacle Avoiding Robot , 2017 .

[23]  Louis L. Whitcomb,et al.  Adaptive Identification on the Group of Rigid-Body Rotations and its Application to Underwater Vehicle Navigation , 2007, IEEE Trans. Robotics.

[24]  Aamir Iqbal Bhatti,et al.  Improved attitude determination by compensation of gyroscopic drift by use of accelerometers and magnetometers , 2019, Measurement.

[25]  David Velasco,et al.  Validation of a new generation DVL for underwater vehicle navigation , 2016, 2016 IEEE/OES Autonomous Underwater Vehicles (AUV).

[26]  Li Cong,et al.  Accuracy improvement of GPS/MEMS-INS integrated navigation system during GPS signal outage for land vehicle navigation , 2012 .

[27]  Itzik Klein,et al.  Inertial Navigation System/Doppler Velocity Log (INS/DVL) Fusion with Partial DVL Measurements , 2017, Sensors.

[28]  Won Sang Ra,et al.  Depth sensor and DVL-aided vertical channel damping loop design for underwater vehicles , 2015 .

[29]  Fuhong Wang,et al.  Error analysis and accuracy assessment of GPS absolute velocity determination without SA , 2008 .

[30]  Aboelmagd Noureldin,et al.  Performance Enhancement of MEMS-Based INS/GPS Integration for Low-Cost Navigation Applications , 2009, IEEE Transactions on Vehicular Technology.

[31]  Karim Salahshoor,et al.  Centralized and decentralized process and sensor fault monitoring using data fusion based on adaptive extended Kalman filter algorithm , 2008 .