Journal of Applied Mathematics

Volume 2014, Article ID 825726, 8 pages

http://dx.doi.org/10.1155/2014/825726

## Research on Wavelet Singularity Detection Based Fault-Tolerant Federated Filtering Algorithm for INS/GPS/DVL Integrated Navigation System

^{1}Marine Navigation Research Institute, College of Automation, Harbin Engineering University, Harbin 150001, China^{2}LASSENA Laboratory, École de Technologie Supérieure, Université du Québec, Montreal, QC, Canada H3C 1K3

Received 4 April 2014; Revised 21 June 2014; Accepted 29 July 2014; Published 17 August 2014

Academic Editor: H. R. Karimi

Copyright © 2014 Jianhua Cheng 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.

#### Abstract

Soft faults in navigation sensors will lead to the degradation of the accuracy and reliability of integrated navigation system. To solve this problem, a wavelet analysis and signal singularities based soft fault detection method are given out. To find signal singularities and detect the faults, the modulus maxima values are calculated after the wavelet transform of original signal. By calculating the Lipschitz exponent using the modulus maxima value at the fault point, the fault types are distinguished. Then, a fault-tolerant federated filtering algorithm for the calibration of INS/GPS/DVL integrated navigation system is proposed. Simulations are conducted and results show that sensor soft faults can be detected accurately. By effectively isolating the fault and refactoring information, the accuracy and reliability of navigation system are improved.

#### 1. Introduction

Higher standards for the accuracy and reliability of navigation systems are required with the development of modern ship, aircraft, and land vehicle. Device redundancy and estimator based analytical redundancy are the two most effective methods of improving the accuracy and reliability of system [1].

Device redundancy appears to be a simple and efficient approach to improve the performance of navigation system [2]. Both system level and sensor level redundancy are considerable, and most of the system redundancies are in the form of integrated navigation system. And INS/GPS/DVL integrated navigation system is widely used in vehicles. Inertial navigation system (INS) has been usually selected as the core of integrated systems for its outstanding characters, such as high-accuracy, self-contained, and jam-proof. Meanwhile, global position system (GPS) and Doppler velocity log (DVL) commonly play the external auxiliary roles, because their navigation errors do not accumulate with time [3]. They also provide the position and velocity for the calibration and reset of INS. That means that the performance of GPS and DVL will affect the calibration accuracy of INS directly as well as the entire INS/GPS/DVL integrated navigation system. As for the entire calibration process for INS, it is necessary to guarantee the accuracy and reliability of external information [4]. Otherwise, the gyroscope drifts cannot be estimated and the error of external information will be introduced.

Estimator based analytical redundancy method is another effective solution [5, 6]. The estimated information predicted by using system mathematical model is introduced, then conduct data fusion by estimator (i.e., Kalman filter) so that almost all outputs of different kinds of sensors can be fully used. However, the fault of sensors might happen, which must be detected and processed. Kalman filter based fault detection methods are commonly used in integrated navigation system, especially detection method.

In detection method, faults are detected by comparing the assumptive mean and variance with those of constructed* n-*dimension Gaussian variables, which is easy to realize. However, this method insensitive and large-delay for the detection of soft faults, and the type of fault cannot be accurately determined. In the integrated system, there are two most common sensor faults: step error caused by clock jumping and power fluctuation in GPS; slope error caused by clock drift and the inaccuracy of rail parameter model [7].

To solve the problems above, a sensor fault detection method based on wavelet analysis and signal singularities is put forward, and a fault-tolerant federated filter for INS/GPS/DVL integrated navigation system is designed. In Section 2, signal fault detection method based on wavelet modulus maxima is introduced, and the relationships between signal singularity and modulus maxima are given out, and by searching modulus maxima the fault can be accurately positioned. In Section 3, fault type detection method based on the calculation of signal Lipschitz exponent is proposed. In Section 4, by utilizing the proposed fault detection method, a fault-tolerant federated filter for the calibration progress in INS/GPS/DVL integrated navigation system is designed. And in Section 5, simulations for fault-tolerant federated filter in calibration application are conducted. Finally, the conclusions are given in Section 6.

#### 2. Signal Singularity Detection Method Based on Wavelet Analysis

##### 2.1. Wavelet Transform and Modulus Maxima

Wavelet analysis is an efficient signal analysis tool and has been widely used in signal process [8, 9]. Wavelet transform appears to be extremely sensitive for the signal singularities, which makes it highly appropriate for the fault signal detection. In this transform, the original signal is processed by using wavelet as follows: where the is mother wavelet, is scale parameter, and is translation parameter.

By (1), with the decrease of , the locality and resolution in time domain of wavelet function are improved, and resolution in frequency domain is reduced.

Assuming that wavelet and the sensor output signal are both real functions, scale parameter . The continuous wavelet transform for can be calculated as follows: where “” denotes the convolution operation and is the complex conjugate of .

As known from (3), under the determined scale , we could obtain the local maxima of when the derivative at . If any points within the neighbourhood of satisfy equation and any points within the left or right neighbourhood of satisfy equation , we call the point as the extremum of the wavelet transform modulus on the scale and as the modulus maxima for the wavelet transform for the original .

Due to the high-sampling ratio and nature discrete characters for the output signals of navigation systems, the continuous wavelet transform leads to extremely heavy calculation burden. It seems impossible to implement continuous wavelet transform in practical signal processing. Therefore, binary wavelet transform is selected in this paper, which can be seen as a compromise between continuous and discrete wavelet transforms. And let ; the binary wavelet can be expressed as

Accordingly, the binary wavelet transform is

Signal singularities, which are the most important local information of signals, can be inferred by searching the modulus maxima. By calculating the modulus maxima on different scales, the entire modulus maxima curve can be obtained, and then we can observe the local signal singularities. The relationships among the original signal and the modulus maxima are shown in Figure 1.

As shown in Figure 1, if the characteristics of signal changes, their corresponding wavelet modulus appears as maxima. This character can be utilized to detect and position the sensor faults.

##### 2.2. Fault Positioning Based on Modulus Maxima Searching

To detect the singularity of fault signal, we have to obtain the curves of modulus maxima. And ad hoc algorithm is commonly used in searching the points of modulus maxima [10].

The specific steps of the algorithm are shown as follows.(1)Choose Morlet wavelet basis and scale and process the sensor output signal by using binary discrete wavelet transform. The chosen scale should guarantee that the signal extrema are dominated on the largest scale and keep all the important singularities of signal. In order to make the output signal meet the requirement of real time for the integrated navigation system, is set.(2)Assuming that the largest amplitude of extrema is on the largest scale, the extrema whose amplitudes are smaller than should be eliminated, that is, because these extrema are mainly caused by noise.(3)For arbitrary extremum on scale , its neighbour points are and , and the manifold-points of are should be in the interval . Among the points have the same sign with in the interval , if satisfies , , is the manifold-point of . Otherwise, the point with the largest amplitude is the manifold point of . However, once the amplitude of the manifold point is twice that of , this point will be treated as the extrema of noise and have to be eliminated [11].(4)Repeat the process above until the scale is .(5)Eliminate the maximum points on scale , and use the extrema on scale . So far, the search for the modulus maxima on scales is completed.

Through the steps above, the modulus maxima on each scale can be obtained as well as the modulus maxima curve. According to the modulus maxima on fine scale, we can accurately position the singular points and the moments of sensor faults that occurred. However, only with these wavelet modulus maxima, we still could not identify the types of sensor faults.

#### 3. Fault Type Detection Based on Lipschitz Exponent

##### 3.1. Lipschitz Exponent Characteristics of Signal Faults

Singularity refers to the signal with discontinuous points or its derivative function is not continuous. Mathematically, signal singularity is described by Lipschitz exponent [12]. The type of sensor faults could be identified based on Lipschitz exponent.

The Lipschitz exponent of signal at is defined as follows. There are two constants , and a polynomial . When , inequation is established as

For any point , the polynomial is uniquely determined. If is order continuously differentiable at point and its neighborhood, the is equal to the Taylor expansion of at point . If function has uniform Lipschitz exponent in any neighborhood of point and , is order differentiable in this neighborhood of point . Therefore, a great Lipschitz exponent means better smoothness of signal and the smaller characterizes the singularities of .

As for the most typical sensor errors, the relationships between slope error, step error, random noise error, and Lipschitz exponents are given out.(1)Assuming that is a step signal, we have

According to (5), the Lipschitz exponent of step signal at point is 0.(2)Assuming that is a slope signal, we have

According to (5), the Lipschitz exponent of slope signal at point is 1.

However, the Lipschitz exponents related to random noise are usually less than 0, because Gaussian white noise is a random distribution whose singularities are almost everywhere. On this condition, the Lipschitz exponents are negative and could be denoted as .

##### 3.2. Calculation of Signal Lipschitz Exponent

By analyzing the relationship between the modulus maxima and signal singularity, it is found that the attenuation of could be controlled by its local maxima. Therefore, according to the relationship between wavelet modulus maxima and signal Lipschitz exponent, the calculation of signal Lipschitz exponent can be realized [13].

Assuming that the compactly supported set of wavelet function is and when , all the modulus maxima points which converge to the point are located in the conical surface, which is denoted as , as shown in Figure 2.

Assuming the signal and its modulus maximum values distribute within a conical surface. That is where is a constant.

Calculating the logarithm for both sides of (9) and using binary wavelet transform, it can be obtained that

Equation (10) shows that the Lipschitz exponent value at point of depends on the attenuation of under fine scales. And when , we get the following conclusions.(a)If Lipschitz exponent , the modulus maxima is proportional to the scale.(b)If Lipschitz exponent , the modulus maxima is inversely proportional to the scale.(c)If Lipschitz exponent , the modulus maxima is uncorrelated with the scale.

And for the next scale , we have

Assuming that the equalities hold up in both (10) and (11), the formula for the calculation of the Lipschitz exponents is as follows:

Through the steps above, calculate the modulus maxima on every scale and draw the modulus maxima curve. According to the modulus maxima on fine scale, we can find the singular point position, namely, the moment of fault occurrence.

Select the modulus maxima point on every scale calculated in step (6) and the logarithm of decomposition scale as ordinate and abscissa, respectively. The slope of curve is estimated by linear least squares, and Lipschitz exponent can be obtained by subtracting 0.5 from the curve slope. According to the Lipschitz exponent, we can distinguish the fault type, and the fault information is provided for fault detection and isolation module to dispose of the sensors with faults.

#### 4. Design for Fault-Tolerant Filtering Scheme

To maintain the high accuracy of INS/GPS/DVL integrated navigation system for long term operation, comprehensive calibration is one of the key technologies [14]. External information of INS such as position provided by GPS is introduced to estimate the gyroscope drifts and reset the navigation information. Usually, this progress might last for hours. Moreover, during the entire calibration phase, the accuracy of external information must be maintained at a stable level. However, the GPS signals appear to be easily influenced by dynamic environment or human disturbances.

In order to guarantee the accuracy and reliability of INS/GPS/DVL integrated navigation system, a fault detection method based fault-tolerant filtering scheme for the calibration phase is presented. In this scheme, decentralized filter is adopted; the fault detection method mentioned above is used to process the outputs of the two subintegrated systems INS/GPS and INS/DVL. And the diagram of this fault-tolerant filtering algorithm is given in Figure 3.

As shown in Figure 3, position measurement* Z*_{IG} is the position difference between GPS and INS outputs, and velocity measurement* Z*_{ID} is the velocity difference between DVL and INS outputs. Then,* Z*_{IG }and* Z*_{ID }are processed through the fault detection method based on binary wavelet transform and Lipschitz exponent. Once faults are detected, the faults can be quickly and accurately positioned and then the type of fault would be obtained. Consequently, the fault sensor would be isolated, and the corresponding output would be reconstructed to form measurement information* Z*_{IG }and* Z*_{ID} which are sent to subfilters. That means that the integrated navigation system exhibits better fault-tolerant ability. With more precise external navigation information, the integrated system could normally output precise navigation information and even sensor soft fault occurs.

##### 4.1. State and Measurement Equations for Subfilter

Considering that the outputs from the sensors are different, we use indirect method to estimate the navigation parameters. The state vector of INS is selected as where , are the position errors of INS; , are the velocity errors of INS; , and are attitude errors of INS; , and are the gyro constant drifts; , and are the gyro random drifts.

The state vector of GPS is selected as where , are the position error of GPS.

Position integrated mode is used for INS/GPS subfilter, so the state equation and measurement equation are given by where is INS state transition matrix in [15]; , are the system noise matrixes for INS and GPS, respectively; is measurement noise matrix; and is state transition matrix for INS/GPS measurement equation. Consider where , and are system white noises of INS and , are system white noise of GPS. Consider

Using first order Markov process to complete the approximate fitting, GPS state transition matrix can be expressed as follows: where and are the correlation times.

Velocity matching method is used in INS/DVL subfilter, and the state equation and measurement equation are given by where is state vector of DVL velocity estimation error, , are velocity error, and is scale error. is DVL state transition matrix: where , and are Markov correlation time, is system noise matrix, , are driven white noise, and is measure noise matrix. Consider

##### 4.2. INS/GPS/DVL Global Filter

To make the integrated filter realizable for computer calculation, it is necessary to discretize the state equation and measurement equation mentioned above and then we have

Assuming that the local estimates are unrelated, the global estimate can be expressed as

Local estimates ( from the subfilters and their covariance matrix ( are sent to master filter, and the obtained results would integrate with master filter estimates to get the global optimal estimates. Besides, global estimate and its covariance matrix , which are amplified to be , are feed back to sub filters, and estimates of subfilter are reset as

#### 5. Simulation

##### 5.1. Simulation for Fault Positioning

Compared with the detection step error, slope error is more difficult to be detected. Consequently, the slope error is selected to be researched to verify the efficience of the proposed fault detection method.(1)Simulation conditions: During 100~200 sampling points, the slope error is added to the sensor signal.(2)Simulation results:

As a comparison, the fault detection method based on Gaussian wavelet transform is applied to faults detection; its fault detection result is shown in Figure 4.

It is obvious that there is a time delay for the fault detection algorithm based on Gaussian wavelet transform in Figure 4. And the sensor faults cannot be efficiently detected until the soft faults accumulate to a certain degree.

And the simulation result of the proposed fault detection method based on binary wavelet transform and modulus maxima is shown in Figure 5.

As known from Figure 5, the proposed fault detection method can efficiently detect the slope error of sensor fault and exhibits excellent accuracy for the fault positioning and sensational resolution in time domain. However, with the increase of the scale, multiple extrema appear in the signal which are caused by noise, and some of extrema would attenuate sharply or even disappear. However, those extrema which have appeared in all scales would not attenuate. And they are corresponding to the real singularities of signal.

##### 5.2. Simulation for Fault Type Detection

The step fault and slope fault are selected to analyze the fault type detection performance of the proposed fault detection method.

During 100~200 sampling points, the constant error (to form the step fault) and slope error are added in the sensor signals, respectively. The logarithm of modulus maxima is calculated at , as shown in Figure 6.

In Figure 6, the logarithm curves of modulus maxima exhibit obvious attenuation ratio at . In order to identify the fault type, the attenuate ratio for logarithm curves of modulus maxima with respect to the scales at should be obtained. By using linear least square method, the slope of curve on each scale of the curve can be estimated, and the Lipschitz exponent can be obtained by subtracting 0.5 from the slope. As for the two kinds of faults, the scopes of modulus maxima curves and Lipschitz exponents at are shown in Table 1.

According to Table 1, the measured Lipschitz exponents with respect to step fault and slope fault approximate to their ideal values, respectively. By calculating the Lipschitz exponent of signal, the fault type can be detected.

In conclusion, by searching wavelet modulus maxima on different scales, the fault detection method based on modulus maxima can accurately position fault points and distinguish the fault type through Lipschitz exponent which is calculated by the attenuation of wavelet modulus maxima.

##### 5.3. Simulation for Fault-Tolerant Filter

(1)Assuming that initial latitude is and initial longitude is , gyro constant drift is ; heading angel is and east velocity and north velocity are 5 kn; simulation time is 5.5 h.(2)INS/DVL/GPS integrated system is applied to calibration. After 4-hour system work, inertial system is calibrated by the gyro drift estimated and system error information.(3)Two conditions are involved in the calibration simulation: (a) GPS without any fault; (b) GPS with slope fault.

For the two conditions, the drift estimated results for east and azimuth gyroscopes are given in Figure 7.

It is obvious from Figure 7 that on the no-faults condition the gyro drifts and position information can be well estimated, especially since the estimation error for east gyro drift is less than 10%. On the other hand, when slope fault occurs, we cannot obtain the position measurement, and the gyro drift estimation performance decreases, especially since the estimate accuracy of the azimuth gyro drift is seriously restricted by limited available information. Through the detection and isolation of slope faults in INS/GPS subintegrated system, such a single system fault will have no effect on the output of SINS/DVL system but slightly decrease for the position estimation comparing with the situation without GPS faults.

#### 6. Conclusion

This current work has presented a sensor fault detection method based on binary wavelet transform, modulus maxima, and Lipschitz exponent. In this method, after binary wavelet transform of original signal, sensor faults can be accurately positioned by searching modulus maxima, and the type of fault can be obtained by calculation of the Lipschitz exponents. To guarantee the performance during calibration phase for INS navigation errors, a developed fault-tolerant federated filter for INS/GPS/DVL integrated navigation system is proposed. Simulation shows that even when GPS slope faults occur, INS/GPS/DVL system could keep on providing reliable position information only with a slight drop of positioning accuracy.

#### Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

#### Acknowledgments

The authors would like to thank all the editors and anonymous reviewers for improving this paper. Funding for this work was provided by the National Nature Science Foundation of China under Grants no. 61374007 and 61104036 and the Fundamental Research Funds for the Central Universities under the Grant of HEUCFX41309.

#### References

- J. Bokor and Z. Szabó, “Fault detection and isolation in nonlinear systems,”
*Annual Reviews in Control*, vol. 33, no. 2, pp. 113–123, 2009. View at Publisher · View at Google Scholar · View at Scopus - M. Jafari and J. Roshanian, “Optimal redundant sensor configuration for accuracy and reliability increasing in space inertial navigation systems,”
*Journal of Navigation*, vol. 66, no. 2, pp. 199–208, 2013. View at Publisher · View at Google Scholar · View at Scopus - G. T. Schmidt, “INS/GPS technology trends,”
*Advances in Navigation Sensors and Integration Technology Technical Report*, Massachusetts Institute of Technology, Lexington, Mass, USA, 2010. View at Google Scholar - U. I. Bhatti, W. Y. Ochieng, and S. Feng, “Integrity of an integrated GPS/INS system in the presence of slowly growing errors. Part II. Analysis,”
*GPS Solutions*, vol. 11, no. 3, pp. 183–192, 2007. View at Publisher · View at Google Scholar · View at Scopus - A. Korff, C. Kellermann, M. Mueller, S. C. Kunze, K. Schmieder, and K. Radermacher, “Using analytical redundancy to increase safety of a synergistic manually guided instrument for craniotomy,” in
*Proceedings of the 34th Annual International Conference of the IEEE Engineering in Medicine and Biology Society*, pp. 912–915, September 2012. View at Publisher · View at Google Scholar · View at Scopus - M. Carminati, G. Ferrari, R. Grassetti, and M. Sampietro, “Real-time data fusion and MEMS sensors fault detection in an aircraft emergency attitude unit based on kalman filtering,”
*IEEE Sensors Journal*, vol. 12, no. 10, pp. 2984–2992, 2012. View at Publisher · View at Google Scholar · View at Scopus - M. I. Cao and P. Y. Cui, “Information fusion technology of INS/GPS navigation system based on wavelet fault detection,”
*Journal of Astronautics*, vol. 30, no. 5, pp. 1885–1887, 2009. View at Publisher · View at Google Scholar · View at Scopus - A. Phinyomark, C. Limsakul, and P. Phukpattaranont, “Application of wavelet analysis in EMG feature extraction for pattern classification,”
*Measurement Science Review*, vol. 11, no. 2, pp. 45–52, 2011. View at Publisher · View at Google Scholar · View at Scopus - J. A. Fairley, G. Georgoulas, O. L. Smart et al., “Wavelet analysis for detection of phasic electromyographic activity in sleep: influence of mother wavelet and dimensionality reduction,”
*Computers in Biology and Medicine*, vol. 48, pp. 77–84, 2014. View at Google Scholar - J. Cheng and M. Li, “Research of fault detection algorithm based on wavelet analysis in integrated navigation system,”
*Journal of Astronautics*, vol. 33, no. 4, pp. 419–425, 2012. View at Publisher · View at Google Scholar · View at Scopus - Y. Liu, Y. Li, and J. T. Xu, “Application of a multi-algorithm fusion real time filter in FOGs,”
*Acta Photonica Sinica*, vol. 39, no. 6, pp. 1116–1119, 2010. View at Publisher · View at Google Scholar - Y. K Sun,
*Wavelet Analysis and Its Application*, China Machine Press, 2004. - S. Mallat and S. F Zhong, “Characterization of signals from multi-scale edges,”
*IEEE Transactions on Pattern Analysis and Machine Intelligence*, vol. 14, no. 7, pp. 710–713, 1992. View at Google Scholar - P. D. Groves,
*Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems*, Artech House, London, UK, 2013. - Y. N. Wang, X. Deng, and W. Zhao, “Application of fuzzy adaptive Kalman filter based on weighted matrix in integrated navigation system,”
*Journal of Chinese Inertial Technology*, vol. 16, no. 3, pp. 334–338, 2008. View at Google Scholar