1. Introduction
With the introduction and promotion of the “all source navigation” concept, the navigation system is progressively evolving towards diversifying navigation sources, expanding compatibility, and adopting the plug-and-play approach. In routine operational conditions, a multi-source information fusion navigation system, equipped with a substantial number of redundant navigation observations, can deliver high-precision, highly reliable, and interference-resistant navigation services for the carrier. However, in practical applications, various factors such as adverse environmental conditions, human interference, and hardware aging can contribute to the potential failure of any navigation source. If these faults are not promptly detected, the entire navigation system may be compromised by erroneous data, resulting in a reduction in navigation accuracy. In severe cases, such failures can lead to overall breakdown of the navigation system [
1,
2]. Therefore, establishing an integrity-monitoring method for a multi-source information fusion navigation system is a crucial issue that requires resolution.
Integrity monitoring of navigation systems is crucial for ensuring confidence in positional information, encompassing the system’s ability to promptly alert users when navigation becomes unreliable [
3,
4]. Early integrity monitoring predominantly targets homogeneous and redundant navigation sources within the global navigation satellite system (GNSS), capable of detecting abnormalities in satellite measurements, receiver hardware, or signal distortions. A widely adopted method is receiver autonomous integrity monitoring (RAIM) [
5,
6,
7]. In recent years, numerous scholars have enhanced and innovated RAIM algorithms. For instance, in reference [
8], an integrity-monitoring algorithm is proposed, utilizing the innovation variance of the Kalman filter for fault detection (KF-RAIM). Reference [
9] achieved integrity monitoring based on carrier phase observation (CRAIM). Reference [
10] introduces an advanced RAIM algorithm (ARAIM) that ensures both horizontal and vertical integrity requirements. Addressing the issue of data delay, reference [
11] proposes a relative RAIM algorithm (RRAIM). Furthermore, to account for time variability, reference [
12] introduces a time-RAIM algorithm (TRAIM). However, these algorithms are all designed for homogeneous and redundantly equipped GNSS navigation sources. In contrast, non-redundant multi-sensor navigation sources, such as terrain-aided navigation (TAN), have relatively few associated integrity algorithms. For instance, references [
13,
14,
15] propose a terrain-data anomaly detection algorithm based on GPS and radar altimeters. This method involves horizontal consistency detection by estimating and extracting terrain heights, introducing positive and negative vertical deviations on the measured elevation, and stacking horizontal detection results layer by layer to form a spatial envelope. However, this approach heavily relies on the precise positional information provided by satellite navigation systems. The key challenge lies in monitoring terrain data and height-sensor anomalies in the event of a satellite navigation system failure and avoiding mismatches, which is crucial for ensuring the integrity of TAN.
Currently, the focus of integrity monitoring for multi-source information fusion navigation systems is primarily on GNSS/INS fusion navigation systems, with many algorithms still relying on GNSS integrity-monitoring methods. For instance, reference [
16] effectively detects slowly increasing errors in satellites by extrapolating and accumulating new information from multiple epochs of the GNSS/INS integrated navigation system. References [
17,
18,
19] employ the least-squares multiple solution separation method to detect faults in navigation sources. However, when constructing the least-squares separation solution in the location domain, the measurement error can be easily submerged, leading to low sensitivity in small-fault detection. References [
20,
21,
22] utilize federated filters to create multiple binary sub-filters and employ fuzzy logic and weighted residual eigenvalues for each sub-filter to achieve fault diagnosis. Although this method can detect and isolate faulty navigation sources, its primary goal is to enhance the system’s fault tolerance and it cannot calculate the system protection level. Additionally, as the number of fused navigation sources increases, the need to establish sub-filters also significantly increases. References [
23,
24,
25,
26] proposes a multi-sensor integrity-management model that accomplishes integrity management of multiple sensors by dynamically assigning each sensor to one of four modes: monitoring, validation, calibration, and reconstruction. Although the model has a relatively complete logical structure, as the number of sensors and simultaneously faulty sensors increases, the number of parallel sub-filters that need to be constructed significantly increases, resulting in an escalation of computational load.
In summary, research on integrity-monitoring methods for multi-source information fusion navigation systems is still in its early stages, and the detection of faults in navigation systems is currently limited to a single hierarchical structure of navigation sources or sensors. However, multi-source information fusion navigation systems feature a redundant configuration structure. The impact of sensor faults in a particular navigation source on the entire navigation system exhibits significant hierarchical transmission characteristics. Additionally, diverse types of information sources, varying dimensions of measurement matrices, and distinct characteristics of measurement noise in multi-source information fusion navigation systems present new challenges to integrity monitoring.
In this paper, we propose a two-level integrity method for multi-source information fusion navigation; the structure is shown in
Figure 1. This method can detect, isolate, and verify faulty navigation sources and faulty sensors at different levels, and dynamically adjust the fault hypotheses that need to be monitored to calculate the system protection level, so as to realize the integrity monitoring of multi-source information fusion navigation.
In detail, the contributions of this paper are as follows:
- (1)
A two-level integrity-monitoring structure is introduced. Utilizing the loosely coupled filtering model, the structure establishes integrity-monitoring models at both the system and sensor levels. It accomplishes fault detection, isolation, and verification from navigation sources to sensors in a systematic manner.
- (2)
For the navigation source TAN, based on its working principle, this paper designs search-mode and tracking-mode fault-detection models to achieve integrity monitoring for non-redundant navigation sources.
- (3)
The proposed integrity-monitoring method adopts the integrity risk dynamic allocation criterion, allowing the dynamic adjustment of monitored fault hypotheses based on the effective navigation sources in the system.
The remainder of this paper is structured as follows.
Section 1 introduces the current research status of navigation integrity monitoring.
Section 2 elaborates on the system-level integrity-monitoring method.
Section 3 focuses on the fault detection methods for two types of navigation sources at the sensor level.
Section 4 introduces the integrity risk allocation criteria and protection-level calculation.
Section 5 presents the simulation test results of the proposed method. Finally, concluding remarks and future research directions are provided in
Section 6.
2. System-Level Integrity-Monitoring Method
At system level, a loosely coupled filtering model is constructed for each navigation source. Therefore, it is necessary to design a fault-detection model to detect and isolate faulty navigation sources. Meanwhile, to ensure fault-detection capability, this paper presents the design of a navigation source recovery verification model to judge whether the isolated navigation source has returned to normal.
2.1. Navigation-Source Fault-Detection Model
Differing from the traditional multiple-solution separation method in the position domain [
27], we have designed a multiple residual separation method in the measurement domain.
Since three sets of inertial navigation systems are typically employed in airborne applications to ensure the reliability of inertial navigation, INS faults are not considered in this paper. Subsequently, the remaining navigation sources are ranked to form different combinations. Assuming that the number of simultaneous faulty navigation sources is one, the fusion navigation system INS/GPS/BDS/DVL/BA/TAN has the following five forms of combinations:
Combination 1 (Com1): INS/GPS/BDS/DVL/BA
Combination 2 (Com2): INS/GPS/BDS/DVL/TAN
Combination 3 (Com3): INS/GPS/BDS/BA/TAN
Combination 4 (Com4): INS/GPS/DVL/BA/TAN
Combination 5 (Com5): INS/BDS/DVL/BA/TAN
where
represents the position difference between navigation source and INS,
represents the velocity difference between the navigation source and INS,
represents the altitude difference between BA and INS.
The traditional extended Kalman filter (EKF) [
28] mainly comprises two components: state propagation and measurement update. The updated state estimation results from the combined influence of historical states and current measurements. This introduces the possibility of the integrity risk being related to past states. Furthermore, the Kalman filter gain acts as a time-varying matrix, exacerbating the correlation between the two. Therefore, it is essential to establish a direct mapping relationship between the final state and the input. Additionally, the measurement update formula in the classical EKF should be reconstructed into a least-squares form [
19], encompassing both system propagation and measurement, as illustrated below:
where
k is the time epoch,
is a 15-dimensional system state,
is the one-step state prediction obtained through the Kalman filter,
is the measurement matrix of the Kalman filter,
is the noise matrix with the corresponding covariance matrix
, as follows:
Using
as the weight matrix, the state estimation solution of Kalman filter weighted least-squares form is:
By setting the partial elements of the weight matrix
to zero (the navigation source in which combination
c is not contained), the separation residual
with covariance matrix
of combination
c is obtained as follows:
where
is the all-measurement vector,
is the separation solution,
is the weight matrix,
is the noise covariance matrix.
The fault detection statistic
of combination c is constructed from the Mahalanobis distance of the separation residual,
satisfies the chi-square distribution with
n degrees of freedom, and its corresponding threshold
is calculated as follows:
where
is the significance level, which is the probability of integrity risk assigned to the subsystem,
represents the chi-square probability distribution function,
n is the measurement dimension.
The faulty navigation source can be isolated based on the relationship between
and
under each combination. For the INS/GPS/BDS/DVL/BA/TAN navigation, the detection results under different fault cases are shown in
Table 1, where 1 represents
and 0 represents
.
2.2. Navigation-Source Fault-Detection Model
Previously faulty navigation sources that have returned to normal, such as isolated faulty sensors, can be reintegrated into the fusion positioning solution. However, before re-inclusion, recovery verification is necessary to prevent contaminating the fusion solution.
A least-squares form is constructed that includes measurement information provided by the KF main system state and isolated navigation sources, as follows:
where
is the untrusted measurement,
is the measurement noise variance matrix,
is the measurement matrix,
is the estimated state provided by the main filter,
is the state error covariance matrix.
This paper uses the w-detection method [
29] for verification. If there are multiple navigation source to be verified, parallel verification can be carried out. Therefore, the validation detection statistics and detection thresholds in the least-squares form are:
where
ei is the vector with the
i-th element (untrusted measurement) 1, and the remaining elements are 0,
Pzz is the measurement residual covariance matrix in the LS form, ∇
Si represents the critical outlier.
According to Formulas (15) and (16), real-time verification can be performed on isolated navigation sources. If the verification detection is less than the detection threshold five consecutive times, it is judged that the isolated navigation source has returned to normal.
6. Conclusions
In this paper, we propose a two-level integrity-monitoring method for multi-source information fusion navigation and report simulation tests conducted in an airborne environment. At the system level, the fault and verification model constructed by the loosely coupled Kalman filtered least-squares method can effectively detect and isolate faulty navigation sources. After passing the verification, the isolated sources can be re-incorporated into the fusion model. At the sensor level, suitable fault-detection models were constructed based on the redundancy of faulty navigation sources. Specifically, for the non-redundant navigation source TAN, different fault-detection methods were established according to its working mode to avoid mismatching. For the redundant navigation source GPS/BDS, the traditional method has been enhanced by optimizing the initial value of the fault-detection statistics using the expanded-dimension matrix. This optimization effectively reduces the detection delay caused by sub-filter adjustment. Finally, an integrity-risk dynamic allocation criterion was established to calculate the system-protection level for multi-source information fusion navigation. Simulation test results show that the method proposed in this paper can effectively detect, isolate, and verify faulty navigation sources and sensors. It issues integrity alarms in a timely manner without fault isolation, thereby improving the reliability of the navigation system.
Future works will focus on the following aspects: (1) in-depth investigation of integrity-monitoring methods under various fusion models; (2) further exploration of INS faults; (3) application of the proposed two-level integrity-monitoring structure in diverse scenarios. Additionally, the investigation of various fault-detection methods, such as machine learning, will be undertaken to enhance fault-detection performance.