Attitude Estimation for Satellite Fault Tolerant System Using Federated Unscented Kalman Filter

  • cc icon
  • ABSTRACT

    We propose a spacecraft attitude estimation algorithm using a federated unscented Kalman filter. For nonlinear spacecraftsystems, the unscented Kalman filter provides better performance than the extended Kalman filter. Also, the decentralizedscheme in the federated configuration makes a robust system because a sensor fault can be easily detected and isolated by thefault detection and isolation algorithm through a sensitivity factor. Using the proposed algorithm, the spacecraft can continuouslyperform a given mission despite navigation sensor faults. Numerical simulation is performed to verify the performance of theproposed attitude estimation algorithm.


  • KEYWORD

    Spacecraft , Fault tolerant , Federated unscented Kalman filter

  • 1. Introduction

    Satellite images are used for many applications such as reconnaissance and geographic information systems. Therefore, design and operation requirements of satellite systems have become more severe, and greater system reliability during operation is required. Satellite attitude control systems, including sensors and actuators, are critical subsystems, and any fault can result in serious problems. Therefore, various attitude estimation algorithms using multiple sensors are being actively studied for potential applications in satellite fault-tolerant systems (Ali et al., 2005; Edelmayer et al., 2007; Karlgaard et al., 2008; Kerr, 1987; Xu, 2009).

    Satellites use various attitude sensors including gyroscopes, sun sensors, star sensors, and magnetometers. There are several satellite attitude estimation algorithms including Kalman filter, extended Kalman filter (EKF), unscented Kalman filter (UKF), and particle filters (Crassidis et al., 2007). EKF has been widely used to estimate the states of satellite systems. However, the nonlinearities of a satellite system are approximated by first-order Taylor series expansions that can provide poor estimates when the system has severe nonlinearities (Karlgaard et al., 2008). Recently, studies on UKF have been performed to capture the posterior mean and covariance to the third order. It is now known that the UKF can provide better results than the EKF (Ali et al., 2005).

    For a multi-sensor system, there are two different filter schemes for the measured sensor data process: the centralized Kalman filter (CKF) and the decentralized Kalman filter (DKF) (Kim et al., 2003). In the CKF, all measured sensor data are processed at the center site, and therefore information loss can be minimized. However, this approach causes severe computational problems when the filter is overloaded with data, and the CKF could provide unreliable results. In the DKF, the local estimators of each sensor can generate global optimal or suboptimal state estimates according to the data fusion criterion. This scheme has advantages in the sense that (i) much more data can be treated because of the parallel structure, and (ii) a fault can be easily detected and isolated due to the decentralized scheme.

    In this study, a decentralized Kalman filter scheme in federated configuration was adopted for satellite attitude estimation. A federated UKF can be effectively employed to detect and isolate a sensor fault (Ali et al., 2005; Edelmayer et al., 2007). Using a fault detection and isolation (FDI) algorithm, accurate attitude information can be provided despite the sensor fault, and therefore the satellite can perform its mission continuously. Generally, two FDI algorithms are used to detect and identify faults: (i) monitoring the measurement residual, and (ii) using a sensitivity factor (Ilyas et al., 2008). We used a sensitivity factor to detect and identify sensor faults. To verify the performance of the proposed algorithm, numerical simulations were performed for a satellite with a gyroscope and a star tracker as the attitude sensor. The numerical simulation shows that the proposed federated UKF with FDI algorithm detected and isolated the sensor faults effectively, and therefore provided accurate and robust attitude estimation results when the attitude sensor had a fault.

    This paper is organized as follows. In Section 2, attitude kinematics and sensor modeling are described. The attitude estimation algorithms using UKF and federated UKF, and the FDI algorithm, are derived in Section 3. Numerical simulation and analysis to verify the proposed algorithm are shown in Section 4. Finally, conclusions are presented in Section 5.

    2. Attitude Kinematics and Sensor Modeling

       2.1 Quaternion Kinematics

    In this study, a quaternion was used to describe the attitude dynamics of a satellite. A primary advantage of the quaternion is redundancy and a nonsingular attitude description (Schaub et al., 2003). The quaternion is a fourdimensional vector defined as

    image

    where

    image
    image

    where e^ is the unit Euler axis and (특수문자) is the rotation angle. The quaternion satisfies the constraint qT q=q12+q22+q32+q42 = 1. The direction cosine matrix can be written in terms of the quaternion as

    image

    where I3×3 is a 3×3 identity matrix and

    image

    Also, is the cross-product matrix defined by

    image

    The kinematic differential equation for the quaternion is given by

    image

    where ω is the three-dimensional (3-D) angular rate vector, and

    image

    The composition of the quaternion is defined by

    image

    The inverse quaternion is defined by

    image

    Note that q (특수문자) q?1 = [0 0 0 1]T, which is defined as the identity quaternion.

       2.2 Gyroscope Sensor Model

    A gyroscope is a general sensor that measures the angular velocity of a satellite. The gyroscope system can be expressed mathematically by Frarrenkopf's model (Karlgaard et al., 2008). In this model, angular velocity is represented as the true angular velocity with an additive bias and Gaussian white-noise. The bias dynamics are considered to be driven by a Gaussian white-noise process. Also, in this model, it is assumed that the bias term can be regarded as the net effect of several systematic error sources such as scale factor errors, non-orthogonality, and misalignment. The gyroscope model is represented as

    image
    image

    where ω is the measured angular velocity, ω is the true angular velocity, β is the drift, and ηv and ηu are independent zero-mean Gaussian white-noise processes with

    image
    image

    where E[ ] denotes expectation and δ(t-τ) is the Dirac delta function.

       2.3 Star Tracker Model

    It is known that the rate information from gyroscope measurements should be integrated to estimate the satellite attitude, and this measurement causes the estimates to drift from the true value. For this reason, it is necessary to use additional sensors, such as a star tracker, for drift error compensation. A star tracker is an optical device in an attitude control system that has the capability to recognize a star pattern and provide the attitude of a spacecraft (Jayaraman et al., 2006). The output of a star tracker is an estimated quaternion that relates the orientation of the body to the inertial frame. Quaternion estimates are assumed to be unbiased, but they have added random measurement noise. A star tracker model can be represented as (Karlgaard et al., 2008)

    image

    where qs is a star tracker output vector that is a continuously measured quaternion vector, q is the quaternion representing the true orientation, and δ qs is an independent zero-mean Gaussian white-noise process of the measurement noise quaternion vector with

    image

    3. Attitude Estimation Algorithm

       3.1 Unscented Kalman Filter

    For an n-state nonlinear system, the UKF algorithm can be summarized as follows (Simon, 2006):

    image

    where xk is the state vector, yk is the observation vector, wk is the state noise process vector, and vk is the measurement noise vector. It is assumed that the noise vectors are uncorrelated white Gaussian processes. The UKF was initialized as follows:

    image

    First, a time update was performed to propagate the state estimate and covariance from one measurement time to the next. To propagate from time step (k-1) to k, a set of sigma points was chosen using the current best guesses of the mean and covariance as follows:

    image

    For the state propagation step, the a priori state x^k- and error covariance Pk? were estimated using the propagated sigma point vectors as follows:

    image
    image

    Thus, the measurement update was performed and is briefly summarized as follows. First, we selected the sigma points with appropriate changes using the current best guess of the mean and covariance. Thus,

    image

    The predicted observation vector y^k and its predicted measurement and cross-covariance between x^k- and yk were obtained as

    image
    image

    Finally, the measurement update of the state estimate was performed using the normal Kalman filter equations as follows:

    image
    image
    image

       3.2 Federated Unscented Kalman Filter

    Federated filtering consists of two parts: local filters and the master filter. The local filters are parallel processed and independent of each other, and their estimated results are fused in the master filter. In each local filter, a local estimate is obtained using the measurements of local sensors. The master filter uses the estimates of the local filters to update the global state estimate in a fusion process, and this result is used for the initialization of local filters. This scheme has several features, one of which is the capability of fault detection and isolation of the local sensor during the process. The master filter is not affected by a local sensor failure (Ali et al., 2005; Edelmayer et al., 2007). The structure of the federated filter is shown in Fig. 1, and the filtering algorithm in each local filter is a UKF, as described in the previous section.

    The master filter is processed at the same rate as the local filter. If all local estimates are uncorrelated, the global estimate from the master filter is given by

    image
    image

    where x^i and Pi are the local estimate and the covariance of the i-th local filter, and PM-1 is called the information matrix. Note that the global estimate is the sum of the local estimates and a linear-weighted combination with weighting matrices Pi-1(i=1,2,...,N) and PM-1.

       3.3 Fault Detection and Isolation Algorithm

    A federated UKF can provide accurate and robust state estimation values without interrupting the mission because the FDI algorithm is employed in a fault-tolerant configuration. Fault detection usually requires continuous careful monitoring of the measured output data. In a normal case, the output data follow known patterns of evolution with limited random disturbance and measurement noise. However, the measured output data change their nominal evolution pattern when sensor failures occur. General fault detection algorithms are based on considering these differences between the evolution patterns and the measured output data (Ilyas et al., 2008). In this study, the sensitivity factor was used for the FDI as follows:

    image

    When Si is smaller than a threshold value, then the i-th sensor is considered to be working well, x^M and therefore its output can be used to calculate the global estimates and PM. However, if Si is larger than a threshold value, then the i-th sensor could be having some problems. In this case, global estimates should be obtained without using the output of the i-th sensor. The threshold value can be selected based on a Chi-square distribution and optimized in the experiment for the particular application.

    4. Numerical Simulation

    In this section, we describe numerical simulations used to verify the performance of the proposed attitude estimation algorithm based on the federated UKF. For the satellite attitude estimation, two types of attitude sensors were used: a gyroscope and a star tracker. The integrated system can provide accurate estimates for a satellite system with sensor uncertainties such as sensor drift, scale factor errors, and shutting off the power. Two simulation cases were considered: (i) no sensor fault, and (ii) a star tracker with a fault.

    Consider a sensor failure of star tracker A. Figure 2 shows the measured angular velocity history, and Fig. 3 shows the quaternion history when star tracker A has a problem at 100 seconds. Figures 4 and 5 illustrate the local estimates and global estimate without and with the FDI algorithm, respectively. Figures 6 and 7 show the attitude error histories without and with FDI algorithm, respectively, and Fig. 8 shows the fault detection using the FDI algorithm. In this simulation, the fault detection logic was modeled as summarized in Table 1.

    The results show that the errors of the global estimate without the FDI algorithm increased after the occurrence of the star tracker failure. This is because the global estimate was calculated using not only healthy sensor measurements, but also the faulty measurement. However, even though one of the star trackers had a fault, the errors of the global estimate remained small when the FDI algorithm was used. Figure 8 also shows that the star tracker failure was detected and isolated immediately after the sensor failure occurred at 100 seconds, which led to many smaller errors of the global estimate compared to the results without the FDI algorithm.

    Table 2 summarizes the performance of the proposed algorithm. As shown in Table 2, the performance of the federated UKF with FDI algorithm significantly improved in case 2. We note that the total error of the global estimate using the federated UKF with the FDI algorithm was much smaller than the result without the FDI algorithm. Thus, we conclude that the proposed federated UKF with the FDI algorithm provided an accurate and robust global estimate for satellite attitude estimation even though the attitude sensor had a fault.

    5. Conclusions

    In this study, a federated UKF with an FDI algorithm was proposed for satellite attitude determination. The UKF gives accurate estimates for nonlinear systems, and the federated UKF makes the system robust and stable. Since the FDI algorithm can help to detect and isolate sensor failure immediately, the global estimate is not affected by a faulty local estimate. Therefore, the error of the global estimate using the federated UKF and FDI algorithm is smaller than that using only the federated UKF. Numerical simulation results show that the proposed algorithm has efficient and accurate performance for satellite attitude determination when attitude sensors have a fault. The proposed algorithm can be applied to satellite systems, ground mobile robots, and aerial robot systems.

  • 1. Ali J, Fang J 2005 Multisensor data synthesis using federated form of unscented Kalman filtering [IEEE International Conference on Industrial Technology (ICIT 2005)] P.524-529 google doi
  • 2. Crassidis J. L, Landis Markley F, Cheng Y 2007 Survey of nonlinear attitude estimation methods [Journal of Guidance Control and Dynamics] Vol.30 P.12-28 google doi
  • 3. Edelmayer A, Miranda M 2007 Federated filtering for fault tolerant estimation and sensor redundancy management in coupled dynamics distributed systems [Mediterranean Conference on Control and Automation] google doi
  • 4. Ilyas M, Lim J, Lee J. G, Park C. G 2008 Federated unscented kalman filter design for multiple satellites formation flying in LEO [International Conference on Control Automation and Systems (ICCAS 2008)] P.453-458 google doi
  • 5. Jayaraman P, Fischer J, Moorhouse A, Lauer M 2006 Star tracker operational usage in different phases of the mars express mission [SpaceOps 2006 Conference] google
  • 6. Karlgaard C. D, Schaub H 2008 Adaptive huberbased filtering using projection statistics: application to spacecraft attitude estimation [AIAA Guidance Navigation and Control Conference and Exhibit] google
  • 7. Kerr T 1987 Decentralized filtering and redundancy management for multisensor navigation [IEEE Transactions on Aerospace and Electronic Systems] Vol.AES-23 P.83-119 google doi
  • 8. Kim Y. S, Hong K. S 2003 Decentralized information filter in federated form [SICE Annual Conference] P.2176-2181 google
  • 9. Schaub H, Junkins J. L 2003 Analytical mechanics of space systems google
  • 10. Simon D 2006 Optimal State Estimation: Kalman H [infinity] and Nonlinear Approaches google
  • 11. Xu Y Nonlinear robust stochastic control for unmanned aerial vehicles [Journal of Guidance Control and Dynamics] Vol.32 P.1308-1319 google doi
  • [Fig. 1.] Structure of the federated filter.
    Structure of the federated filter.
  • [Table 1.] Fault detection logic
    Fault detection logic
  • [Fig. 2.] Angular velocity history.
    Angular velocity history.
  • [Fig. 3.] Quaternion history.
    Quaternion history.
  • [Fig. 4.] Estimates without FDI algorithm.
    Estimates without FDI algorithm.
  • [Fig. 5.] Estimates with FDI algorithm.
    Estimates with FDI algorithm.
  • [Fig. 6.] Error history without FDI algorithm.
    Error history without FDI algorithm.
  • [Fig. 7.] Error history with FDI algorithm.
    Error history with FDI algorithm.
  • [Fig. 8.] Fault detection using FDI algorithm.
    Fault detection using FDI algorithm.
  • [Table 2.] Performance comparision
    Performance comparision