Navigation Switching Strategy-Based SINS/GPS/ADS/DVL Fault-Tolerant Integrated Navigation System

Li, Weiqi; Zhang, Rui; Lei, Hongjie

doi:https://doi.org/10.1155/2021/9943370

Journal of Sensors

On this page

Abstract Introduction Conclusion Data Availability Conflicts of Interest References Copyright Related Articles

Special Issue

Modelling, Control, and Information Processing Technology in Gyroscopes

View this Special Issue

Research Article | Open Access

Volume 2021 | Article ID 9943370 | https://doi.org/10.1155/2021/9943370

Navigation Switching Strategy-Based SINS/GPS/ADS/DVL Fault-Tolerant Integrated Navigation System

Weiqi Li,^1,2Rui Zhang,¹and Hongjie Lei²

Academic Editor: Juntao Fei

Received18 Mar 2021

Revised09 Apr 2021

Accepted15 Apr 2021

Published03 Aug 2021

Abstract

Considering the conventional federated filtering-based fault-tolerant integrated navigation system is difficult to be implemented by serial data processing circuits, this paper presents navigation switching strategy-based SINS/GPS/ADS/DVL fault-tolerant integrated navigation system to guarantee the reliability of integrated navigation system under sensor faults. When sensor failure appears, SINS and fault-free sensors are selected successively to form an integrated navigation system, such that reliable navigation parameters can be obtained. The simulation tests are implemented to verify that the SINS/GPS/ADS/DVL integrated navigation system can provide reliable navigation parameters when ADS and DVL are disabled.

1. Introduction

At present, the navigation systems commonly used on aircraft include strapdown inertial navigation system (SINS), global satellite navigation system, and Doppler navigation system. Navigation technology mainly provides direction, position, speed, time, and other information for the motion carrier, which has been widely used in vehicle, ship, airliner, and other civil fields, and missile, aerospace, and other military fields, and is an important national information and strategic resource. In [1], the current space technology requires higher and higher reliability of navigation system. A single type of navigation system cannot meet the requirements of an engineering application. In this case, integrated navigation technology arises at the historic moment. In [2], an improved adaptive Kalman filter method for GPS signal misalignment is proposed, which solved the problem of serious discrepancy between the innovation covariance and the actual situation. In [3], a matrix weighted multisensor data fusion method with a two-level structure is adopted to realize INS/GNSS/CNS integrated navigation. However, in the centralized Kalman information fusion, the high-dimensional matrix operation is very complex, and once a navigation device fails, the whole system will be polluted and the filtering will be divergent [4].

Fault-tolerant design is an important way to improve the reliability of an integrated navigation system [5–9]. In [10], it pointed out the application of INS/USBL/DVL integrated navigation federated filtering in three information fusion algorithms for the positioning error accumulation and fault tolerance of the underwater submarine inertial navigation system. In [11], aiming at the requirements of cruise missile for high precision and autonomy of navigation system and its uniform flight characteristics, a strapdown inertial/celestial navigation/synthetic aperture radar integrated navigation system is designed for cruise missile. The radar integrated navigation system adopts nonlinear modeling for integrated navigation, and the nonlinear unscented Kalman filter method is used to filter each subfilter, which greatly enhances the system’s fault tolerance and real-time performance. In [12], a distributed federated Kalman filter is proposed to enhance the system’s fault isolation and recovery capabilities. In [13], an integrated navigation system based on SINS/GPS/DVL by using a Kalman filter is proposed, which reduced the calculation time and enhanced the fault-tolerant performance of the system. The decentralized estimation method and its application in the fault-tolerant integrated navigation system are studied in [14]. The theory of intelligent fault-tolerant integrated navigation system is researched in [15]. A scheme of fault-tolerant integrated navigation system based on multisensor information fusion is proposed in [16]. The optimal estimation of all parameters and fault-tolerant processing of the system state are carried out. In [17], a distributed optimal fusion method combining the volume rules of motion model error identification and prediction is proposed to solve the nonlinear integration problem of MIMU/GNSS/CNS systems. [18] proposed a robust fault-tolerant federated filter for SINS/GNSS/CNS/DVL integrated navigation. In [19], an actuator fault detection and reconstruction scheme based on fault classification applied to hexagonal rotor UAV is designed. In [20], a fault detection and isolation (FDI) scheme based on distributed interactive multimodel is proposed to solve the problem of fault detection and isolation (FDI) of navigation sensors composed of inertial devices and camera sensors in robot systems.

In addition, new technologies such as artificial intelligence, neural network, and computer vision have been used in multi-information fusion technology to improve the intelligence and visualization of navigation system. In the design of a federated filter, information distribution coefficient is a key factor, which directly affects the performance of federated filter. The influence of the information distribution coefficient on the system under the condition of subsystem failure is studied in [21] and proposed a method for robust information distribution based on the probability of each subsystem failure. In [22], the accuracy of the local filter is improved by estimating the Frobenius norm of the mean square error matrix and adaptively adjusting the information distribution coefficient. In order to improve the estimation quality, in [23], an ordered weighted average (OWA) operator integrated multi-rate Kalman filter is designed. A method of residual life prediction based on distributed neural network is proposed in [24]. The method has higher accuracy than centralized neural network. SAPD, a data-driven algorithm, is introduced into the anomaly detection and output reconstruction of the redundant inertial measurement unit (RIMU), which improves the detection accuracy of small faults [25]. Application of ensemble learning to industrial gas turbine fault detection and isolation strategy in [26].

In practical engineering applications, considering that serial data processing circuits are difficult to implement the abovementioned federated filtering and system reliability cannot be guaranteed under the centralized Kalman filtering, an integrated fault-tolerant system based on navigation switching strategy is proposed in this paper, such that the reliability of SINS/GPS/ADS/DVL integrated navigation system is improved.

The paper is organized as follows. The navigation switching strategy of the SINS/GPS/DVL/ADS integrated navigation system is designed in Section 2. The Kalman filter equation and Kalman filter are given in Section 3. Simulations are conducted to verify the superiority of the proposed approach in Section 4. Conclusions are drawn in Section 5.

Considering the advantages of SINS, such as high navigation accuracy, full navigation parameters, strong autonomy, and strong anti-interference ability, it is used as the main equipment in navigation.

The integrated fault-tolerant model based on navigation switching strategy is shown in Figure 1. The system has four working modes, which are SINS/GPS/ADS/DVL integrated navigation system, SINS/GPS integrated navigation system, SINS/ADS integrated navigation system, and SINS/DVL integrated navigation system, respectively. When the system works normally, the four modes automatically switch to each other, and the main working mode of the system is the working mode of the SINS/GPS/ADS/DVL integrated navigation system. The working conditions and data accuracy of the three sensors are used as the switching criterion. When all the sensors are working properly, the SINS/GPS/ADS/DVL integrated navigation system is working. When the error data provided by GPS due to fault or the number of observable satellites (less than 4) cannot work, it is switched to SINS/ADS integrated navigation mode. When the error data provided by ADS due to fault, it is switched to SINS/DVL integrated navigation mode. The specific steps are as follows:

Step 1. Determine whether the GPS can receive more than 4 satellites (including 4) and whether ADS and DVL signals can be received normally. If all the signals are received, select SINS/GPS/ADS/DVL integrated navigation working mode. Otherwise, compare the difference between GPS, ADS, and DVL and inertial navigation measurement sequence.

Step 2. If GPS can work normally and the difference between GPS and inertial navigation measurement sequence is minimum, SINS/GPS combination mode is selected. If the number of GPS observable satellites is less than 4 or the difference between GPS and INS measurement sequence is too large, the SINS/GPS filtering is abandoned.

Step 3. If the ADS sensors work normally, the self-checking and fault detection system module shows that they work normally and the difference between ADS and INS measurement sequence is minimal, the SINS/ADS combination mode is selected; otherwise, the SINS/DVL combination mode is switched.

Step 4. Continue to judge the working status of GPS, ADS, and DVL in real-time and compare the difference between GPS, ADS, and DVL and INS measurement sequence in real-time.

3.1. State Equation of SINS/GPS, SINS/ADS, and SINS/DVL

Select the state variable of SINS aswhere , , , , , , , , and are SINS attitude error, speed error, and position error, respectively; , , and are gyro bias; , , and are first-order Markov processes. , , and are the constant drift of the accelerometer.

Based on the error equation of SINS, there existswhere is the system noise, is the state matrix, the nonzeros of is presented asand

Select the GPS state variable aswhere , , and are the speed error; , , and are position error.

Based on the error equation of GPS, there existswhere , is the system noise and .

Select the state variable of ADS aswhere are the speed error; is the height error.

Based on the error equation of ADS, there existswhere , is the system noise and .

Select the state variable of DVL aswhere , , and are the speed measurement errors caused by terrain changes.

Based on the error equation of DVL, there existswhere , is the system noise and .

The state equation of the SINS/GPS integrated navigation subsystem is obtained aswhere

The state equation of the SINS/ADS integrated navigation subsystem is obtained aswhere

The state equation of the SINS/DVL integrated navigation subsystem is obtained aswhere

3.2. Measurement Equation of SINS/GPS, SINS/ADS, and SINS/DVL

The SINS/GPS integrated navigation subsystem makes the difference between the speed and position information output by the GPS navigator and the SINS speed and position information to obtain the measurement equation aswhere , , and are the noise.

The SINS/ADS integrated navigation subsystem makes the difference between the speed and altitude information output by ADS and the SINS speed and altitude information to obtain the measurement equation aswhere, andare the measurement noise.

The SINS/DVL integrated navigation subsystem makes the difference between the speed information output by DVL and the speed information of SINS and obtains the measurement equation aswhere, and are the measurement noise.

3.3. Kalman Filter

Discretizing the state equations (11)–(15) and the measurement equations (17)–(21), the Kalman filter equation of each integrated navigation system can be obtained aswhere is the state vector at time , is the measurement vector at time , is the measurement matrix at time , is the system measurement noise matrix at time , is the state vector at time , is the noise matrix at time , is the noise distribution matrix at time , is the state one-step transition matrix, and are white Gaussian noises with , , andwith the sampling period .

The Kalman filter is designed as

4. Simulation

In this section, simulations are presented to verify that the reliability of SINS/GPS/ADS/DVL fault-tolerant integrated navigation system can be guaranteed under in the presence of sensor faults.

4.1. Fault Scenarios

The flight data comes from the cooperative project with the AVIC Chengdu Aircraft Design and Research Institute. For the gyroscopes of SINS, the constant drift is , and the random drift is . For the accelerometers of SINS, the constant drift is , and the random drift is . For GPS, the velocity measurement error is , and the position measurement error is . For ADS, the velocity measurement error is , and the height measurement error is . For DVL, the velocity measurement error is . The flight process of the aircraft is divided into three stages: climb, steady flight, and descent. In each stage, faults are imposed on the altitude data of the sensors, respectively. The fault type and size of sensors are presented in Table 1.

4.2. Simulation Results

The simulations are presented in Figures 2–5. From Figures 2–4, the attitudes, velocities, and position measurement of the integrated navigation system can track the expected navigation parameters, where pitch angle tracking is with much errors due to the original data is with measurement error. Since the slow varying faults increase over time, the error is very small at the beginning, and the switching system will not switch at this time. Because there is a certain error between the height data output by ADS and the real data itself, the switching is carried out when the error increases to a larger error than that of the SINS/GPS navigation system. As shown in Figure 4, in the steady flight phase, the GPS altitude data is slowly changed from the 1080s to 1692s. At about 1693s, the GPS altitude data error is greater than the ADS altitude data error. At this time, switch to select the SINS/ADS integrated navigation system. As for the hard fault in 3000 s ~3120 s, SINS/GPS integrated navigation system is selected. In a word, the expected navigation reliability of the SINS/GPS/ADS/DVL integrated navigation system is ensured using the proposed navigation switching strategy.

5. Conclusion

In this paper, a navigation switching strategy-based SINS/GPS/ADS/DVL fault-tolerant integrated navigation system is designed to guarantee navigation reliability. Considering the soft faults and the hard faults, simulations are presented to verify that expected navigation reliability can be obtained using the proposed navigation switching strategy.

Data Availability

No data used to support the study.

Conflicts of Interest

The authors declare that they have no conflicts of interest.

References

K. K. Geng and N. A. Chulin, “Applications of multi-height sensors data fusion and fault-tolerant Kalman filter in integrated navigation system of UAV,” Procedia Computer Science, vol. 103, no. 8, pp. 231–238, 2017.
View at: Publisher Site | Google Scholar
F. Q. Hu, T. Lu, and Y. P. Bao, “Application of improved adaptive Kalman filter in SINS/GPS integrated navigation,” Computer Engineering and Applications, vol. 54, no. 5, pp. 253–257, 2018.
View at: Google Scholar
G. Hu, S. Gao, Y. Zhong, B. Gao, and A. Subic, “Matrix weighted multisensor data fusion for INS/GNSS/CNS integration,” Proceedings of the Institution of Mechanical Engineers, Part G: Journal of Aerospace Engineering, vol. 230, no. 6, pp. 1011–1026, 2016.
View at: Publisher Site | Google Scholar
S. Q. Yu, X. H. Zhang, F. Guo, X. Li, L. Pan, and F. J. Ma, “Recent advances in precision approach based on GNSS,” Acta Aeronautica ET Astronautica Sinica, vol. 40, no. 3, pp. 16–37, 2019.
View at: Google Scholar
W. X. Yan and D. H. Liu, “Development of fault-tolerant technology in integrated navigation system,” GNSS World of China, vol. 4, no. 5, pp. 56–60, 2015.
View at: Google Scholar
Y. Zhao, Z. Xiong, S. W. Tian, J. Y. Liu, and Y. C. Cui, “INS/SAR adaptive Kalman filtering algorithm based on credibility evaluation of SAR image matching results,” Acta Aeronautica ET Astronautica Sinica, vol. 40, no. 8, pp. 216–227, 2019.
View at: Google Scholar
X. J. Niu, Y. L. Ban, T. S. Zhang, and J. N. Liu, “Research progress and prospects of GNSS/INS deep integration,” Acta Aeronautica ET Astronautica Sinica, vol. 37, no. 10, pp. 2895–2908, 2016.
View at: Google Scholar
Z. Xiong, H. Shao, B. Hua, and Z. Fang, “An improved fault tolerant federated filter with fault isolation,” Hangkong Xuebao/Acta Aeronautica et Astronautica Sinica, vol. 36, no. 3, pp. 929–938, 2015.
View at: Google Scholar
M. Kordestani, M. Saif, M. Orchard, R. Razavi-Far, and K. Khorasani, “Failure prognosis and applications—a survey of recent literature,” IEEE Transactions on Reliability, vol. 70, no. 2, pp. 728–748, 2021.
View at: Publisher Site | Google Scholar
B. Xu, R. Hao, and C. Wang, “Inertial navigation/ultra-short baseline/Doppler velocity measurement information fusion and fault tolerant verification of underwater submarine,” Optics and Precision Engineering, vol. 25, no. 9, pp. 2508–2515, 2017.
View at: Google Scholar
Q. S. Li, Y. Zhao, H. Lu, and J. Y. Xu, “Strapdown inertial navigation/celestial navigation/synthetic aperture radar integrated navigation system,” Chinese Journal of Scientific Instrument, vol. 38, no. 11, pp. 2667–2774, 2017.
View at: Google Scholar
N. A. Carlson, “Federated square root filter for decentralized parallel processors,” IEEE transactions on military electronics, vol. 26, no. 3, pp. 517–525, 1990.
View at: Publisher Site | Google Scholar
M. Ushaq and J. Fang, “An improved and efficient algorithm for SINS/GPS/Doppler integrated navigation systems,” Applied Mechanics and Materials, vol. 245, no. 4, pp. 323–329, 2012.
View at: Publisher Site | Google Scholar
H. G. Zhang, “Decentralized estimation method and its application in integrated navigation system,” Journal of Beijing University of Aeronautics and Astronautics, vol. 17, no. 7, pp. 525–528, 1991.
View at: Google Scholar
H. L. Cheng, Theoretical Research on Intelligent Fault Tolerant Integrated Navigation System, [Ph.D.], Beijing University of Aeronautics and Astronautics, 1994.
Y. Zha, “Design and verification of all day high precision fault tolerant integrated navigation system for ships,” Computer Measurement and Control, vol. 25, no. 11, pp. 280–283, 2017.
View at: Google Scholar
B. Gao, G. Hu, Y. Zhong, and X. Zhu, “Cubature rule-based distributed optimal fusion with identification and prediction of kinematic model error for integrated UAV navigation,” Aerospace Science and Technology, vol. 109, article 106447, 2021.
View at: Publisher Site | Google Scholar
H. Xiong, R. Bian, Y. Li, Z. du, and Z. Mai, “Fault-tolerant GNSS/SINS/DVL/CNS integrated navigation and positioning mechanism based on adaptive information sharing factors,” IEEE Systems Journal, vol. 14, no. 3, pp. 3744–3754, 2020.
View at: Publisher Site | Google Scholar
R. Wang, C. Zhao, Y. Bai, W. Du, and J. Wang, “An actuator fault detection and reconstruction scheme for hex-rotor unmanned aerial vehicle,” IEEE Access, vol. 7, pp. 93937–93951, 2019.
View at: Publisher Site | Google Scholar
N. Sadeghzadeh-Nokhodberiz and J. Poshtan, “Distributed interacting multiple filters for fault diagnosis of navigation sensors in a robotic system,” IEEE Transactions on Systems, Man, and Cybernetics: Systems, vol. 47, no. 7, pp. 1383–1393, 2017.
View at: Publisher Site | Google Scholar
K. Qiu, X. Wu, Z. Zhang et al., “Research on fault-tolerant information distribution method of federated filter,” Control and Decision, vol. 21, no. 3, pp. 343–360, 2006.
View at: Google Scholar
V. A. Tupyse, “Federated Kalman filtering information of relation equations in augmented state space,” Journal of Guidance Control and Dynamics, vol. 23, no. 3, pp. 391–398, 2000.
View at: Google Scholar
M. Kordestani, M. Dehghani, B. Moshiri, and M. Saif, “A new fusion estimation method for multi-rate multi-sensor systems with missing measurements,” IEEE Access, vol. 8, pp. 47522–47532, 2020.
View at: Publisher Site | Google Scholar
M. Kordestani, M. F. Samadi, and M. Saif, “A new hybrid fault prognosis method for MFS systems based on distributed neural networks and recursive Bayesian algorithm,” IEEE Systems Journal, vol. 14, no. 4, pp. 5407–5416, 2020.
View at: Publisher Site | Google Scholar
X. Hu, X. Zhang, X. Peng, and D. Yang, “A novel algorithm for the fault diagnosis of a redundant inertial measurement unit,” IEEE Access, vol. 8, pp. 46081–46091, 2020.
View at: Publisher Site | Google Scholar
M. Mousavi, M. Moradi, A. Chaibakhsh, M. Kordestani, and M. Saif, “Ensemble-based fault detection and isolation of an industrial gas turbine,” in IEEE International Conference on Systems, Man, and Cybernetics, Toronto, ON, Canada, 2020.
View at: Google Scholar

Copyright

Copyright © 2021 Weiqi Li et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

PDF Download Citation

Download other formats

Order printed copies

Views

414

Downloads

640

Citations

Journal of Sensors

Modelling, Control, and Information Processing Technology in Gyroscopes

Navigation Switching Strategy-Based SINS/GPS/ADS/DVL Fault-Tolerant Integrated Navigation System

Abstract

1. Introduction

2. Navigation Switching Strategy of SINS/GPS/ADS/DVL Fault-Tolerant Integrated Navigation System

3. Integrated Navigation System

3.1. State Equation of SINS/GPS, SINS/ADS, and SINS/DVL

3.2. Measurement Equation of SINS/GPS, SINS/ADS, and SINS/DVL

3.3. Kalman Filter

4. Simulation

4.1. Fault Scenarios

4.2. Simulation Results

5. Conclusion

Data Availability

Conflicts of Interest

References

Copyright