INS-DVL integration is a common method for underwater navigation. However, inherent errors of sensors, especially in MEMS IMUs, lead to inaccuracies in estimating the position and attitude. In this paper, dynamic motion model of AUV is used to improve MEMS INS-DVL navigation. In this method, which is called model-aided or model-based navigation, the information of the kinetic model of the vehicle (obtained from Newton–Euler equations) is used to improve the navigation performance. Previous model-aided navigation studies about AUVs have been focused on the translational dynamic model of vehicles. As the best of our knowledge, this paper is the first one which suggests using a rotational motion model of AUVs to improve the navigation performance and at the same time, reports successful implementation of method through field-testing. The utilized dynamic model, describes the rotational motion of AUV in a 3DOF form. Information extracted from the rotational dynamic model and the outputs of gyroscopes, will be fused in a secondary Kalman filter. So, before the fusion with auxiliary sensors in the main Kalman filter, the gyroscopes outputs have been improved by the rotational motion model. Therefore, the overall output will be better than the outputs of gyroscopes by itself. The main Kalman filter is a perturbation-based Kalman filter which is employed for data fusion. This algorithm is implemented on real data collected from field-test. The results show that this inexpensive method which requires no additional equipment was truly effective in improving navigation performance. Using this model, the accuracy of navigation was improved 5 to 10 times.
MEMS-IMUs have an extensive application in multifarious studies, as well as industrial and commercial areas. It is crucial to diminish their intrinsic errors in a suitable calibration procedure. In this paper, a novel calibration procedure was proposed for Inertial Measurement Units (IMUs) on a turntable. A general nonlinear model of the IMU output including the effects of bias, scale factor, misalignment, and lever arm was derived. Transformed Unscented Kalman Filter (TUKF) was utilized to perform the estimation of error parameters for gyroscopes and accelerometers. The calibration maneuvers were applied using a tri-axis turntable to create input signals. In addition, assuming the sensors not placing in the center of the table makes angular acceleration become another variable which affects the estimation of the error parameters. Therefore, a suitable angular acceleration estimator was designed utilizing the angular velocity output. According to experimental results, applying the proposed method caused 66% and 63% increase in the accuracy of gyroscopes and accelerometers outputs, respectively, compared with the calibrated signals based on the least square method.
Underwater navigation is generally accomplished through the data fusion of INS (Inertial Navigation System) and auxiliary sensors such as DVL (Doppler Velocity Logger) sensor. However, because of the possibility of DVL outage, alternative low-cost solutions are attractive. Among these, one is using vehicle kinetic model information extracted by the Newton-Euler equation to improve INS performance, which is called model-aided navigation. In this paper, only the vehicle translational motion dynamics are used to replace DVL in underwater navigation in DVL outage. The vehicle 3D translational dynamics has been obtained by using general Newton-Euler equations. Integrating these dynamics leads to the calculation of velocities in the body reference frame. Similar to DVL measurements, the calculated velocities (called "Pseudo-DVL" in this paper) are fused with INS. In this paper, a Kalman filter is used for INS/Pseudo-DVL data fusion. Field test data collected by an equipped research AUV called SUT-III is used to evaluate the proposed approach experimentally. Also, a comparison between the integrated navigation of INS-DVL and INS-Pseudo-DVL is performed and the results are provided. The results reveal that despite having low-cost MEMS IMUs, INS/Pseudo-DVL has effectively corrected standalone INS estimation. Finally it is concluded that despite slight degradation of navigation performance, an expensive DVL sensor can be replaced by using the proposed method in DVL outage.
The inertial navigation system/Doppler velocity logger (INS/DVL) plays an important role in ocean navigation. Any DVL malfunction poses serious risks to navigation. A precise detection system is required to detect the initial moments of DVL signal malfunctions; moreover, with loss of DVL, a fault-tolerant scheme (FTS) is necessary for DVL signal reconstruction. In this paper, an evolutionary knowledge-based method, namely improved evolutionary TS-fuzzy (I-eTS), is adopted to build an artificial intelligence (AI)-based pseudo DVL to deal with long-term outage of DVL. By employing Gaussian process regression (GPR) models for fault detection, a new FTS is constructed. To verify the effectiveness of the new fault detection and fault tolerance system, navigation data is gathered by a test setup and algorithms are performed in the laboratory. In the tests, it is demonstrated that the proposed FTS leads to rapid detection of both gradual and abrupt faults, which leads to less interaction between fault detection and FTS.
30 May 2022 in IEEE Transactions on Instrumentation and Measurement
The navigation algorithms which use Inertial Measurement Unit (IMU), such as Inertial Navigation System (INS), always suffer from intrinsic accumulated errors. Bias in gyros induces a significant drift on navigation output especially when Micro-Electro-Mechanical Sensor (MEMS) type is used. This error has high and low frequency components. De-noising of the long-term error (the low frequency component) is more challenging due to undeterministic behavior and overlapping with carrier motion in the low frequency band. In this paper, a method for de-noising of long-term MEMS-based gyro is presented. In this approach, an auto-regressive model for the long-term error is developed which is being used as the process part of a Kalman filter. To separate the low-band motion dynamic from long-term error in the measurement part of the Kalman Filter, the last time epoch of gyro data is subtracted from the current time epoch (memory-based filter). Some static and dynamic experiments have been done for the algorithm evaluation. The static test shows the reduction of long-term error by 50%. Also, the method is invoked in INS/Doppler Velocity Log (DVL) integrated navigation system as a gyro pre-filter. The results show that drift and point-to-point final error in position are reduced between 4% to 70% by invoking the de-noising method for gyros.
Nowadays, Autonomous Underwater Vehicles (AUV) are used in environmental studies, ocean floor mapping, and measuring water properties. Navigation of these vehicles is one of the most challenging issues due to the unavailability of global positioning system (GPS) signal underwater. Inertial navigation is a method commonly used for underwater navigation. If a low-cost Inertial Measurement Unit (IMU) is used, navigation quality will decline rapidly due to sensor inherent error. Although using a Doppler Velocity Log (DVL) speedometer sensor helps limit this error to some extent, it does not yield acceptable accuracy in low-cost IMUs. Filtering the gyro based on the AUV rotational dynamics model can improve the quality of angular velocity measurements and increase the Inertial Navigation System (INS)-DVL navigation accuracy. The presence of uncertainty in the rotational model parameters reduces the navigation algorithm’s performance. In this paper, at first, a simplified rotational model of AUV is presented, and its parameters are identified utilizing data acquired in real experiments. Then a robust Kalman filter for gyro output is proposed to enhance the navigation algorithm performance in the presence of model parameter uncertainty. To evaluate the performance of the proposed method, non-robust and robust filtered gyro outputs are used in the INS-DVL algorithm, and the results are compared with each other. Two types of the robust Kalman filter, stationary and finite horizon, are invoked. According to the field tests, navigation error decreases by 50% using the stationary robust Kalman filter compared to the non-robust Kalman filter.