EARTH SATELLITE ATTITUDE DATA FUSION SYSTEM AND METHOD THEREOF

Abstract

Provided are an earth satellite attitude data fusion system and method, applicable to an earth satellite space environment to estimate attitude data of a satellite. When the earth satellite attitude data fusion system of the present invention is used to perform the earth satellite attitude data fusion method, the first step is to perform a body rates/quaternion attitude data processing operation. Then, the next step is to perform an attitude/rates data fusion processing operation, wherein an attitude data fusion algorithm module receives a first IAE result data from a first EKF, and a second IAE result data from a second EKF, and performs an attitude/rates data fusion algorithm in a subsystem level to evaluate an attitude estimation IAE performance based on the first IAE result data, and the second IAE result data.

Claims

1. An earth satellite attitude data fusion method, applicable to an earth satellite space environment to estimate attitude data of a satellite, comprising the following steps: performing a body rates/quaternion attitude data processing operation: based on body rates data, first quaternion attitude data, and second quaternion attitude data to obtain first IAE result data and second IAE result data; and an attitude/rates data fusion processing operation, wherein an attitude/rates data fusion algorithm is performed in a subsystem level to evaluate an attitude estimation IAE performance based on the first IAE result data, and the second IAE result data.

2. The earth satellite attitude data fusion method as claimed in claim 1, wherein the body rates data is from a 3-axis gyro, the first quaternion attitude data is from a sensor of a first star tracker, and the second quaternion attitude data is from a sensor of a second tracker.

3. The earth satellite attitude data fusion method as claimed in claim 2, wherein a first EKF of a GS IAE performs an first algorithm based on the body rates data and the first quaternion attitude data to obtain the first IAE result data, and a second EKF of the GS IAE performs an second algorithm based on the body rates data and the second quaternion attitude data to obtain the second IAE result data.

4. An earth satellite attitude data fusion system, applicable to an earth satellite space environment to estimate attitude data of a satellite, comprising: a first EKF of a GS IAE; a second EKF of the GS IAE; a sensor of a first star tracker; a sensor of a second star tracker; a 3-axis gyro; and an attitude data fusion algorithm module, wherein the 3-axis gyro and the sensor of the first star tracker are connected to the first EKF, respectively, wherein the 3-axis gyro and the sensor of the second star tracker are connected to the second EKF, respectively, wherein the first EKF and the second EKF are connected to the attitude data fusion algorithm module, respectively, and wherein, the first EKF, the second EKF, the 3-axis gyro, the sensor of the first star tracker, and the sensor of the second star tracker are used to perform a body rates quaternion attitude data processing operation based on based on body rates data, first quaternion attitude data, and second quaternion attitude data to obtain first IAE result data and second IAE result data, and the attitude data fusion algorithm module performs an attitude/rates data fusion algorithm in a subsystem level to evaluate an attitude estimation IAE performance based on the first IAE result data, and the second IAE result data.

5. The earth satellite attitude data fusion method as claimed in claim 4, wherein the body rates data is from the 3-axis gyro, the first quaternion attitude data is from the sensor of the first star tracker, and the second quaternion attitude data is from the sensor of the second tracker.

6. The earth satellite attitude data fusion system as claimed in claim 5, wherein the first EKF of a GS IAE performs an first algorithm based on the body rates data and the first quaternion attitude data to obtain the first JAE result data, and the second EKF of the GS IAE performs an second algorithm based on the body rates data and the second quaternion attitude data to obtain the second IAE result data.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0023] The embodiments can be understood in more detail by reading the subsequent detailed description in conjunction with the examples and references made to the accompanying drawings, wherein:

[0024] FIG. 1 is a schematic view to illustrate the structure of the earth satellite attitude data fusion system according to the present invention;

[0025] FIG. 2 is a schematic view to illustrate the structure of the first EKF of the earth satellite attitude data fusion system according to the present invention;

[0026] FIG. 3 is a schematic view to illustrate the structure of the second EKF of the earth satellite attitude data fusion system according to the present invention;

[0027] FIG. 4 is a flowchart to illustrate the earth satellite attitude data fusion method performed by the earth satellite attitude data fusion system according to the present invention;

[0028] FIG. 5 is a schematic view to illustrate the structure and operation of the earth satellite attitude data fusion system according to an embodiment of the present invention;

[0029] FIG. 6 is a schematic view to illustrate the structure of the first EKF of the earth satellite attitude data fusion system according to an embodiment of the present invention in FIG. 5;

[0030] FIG. 7 is a schematic view to illustrate the structure of the second EKF of the earth satellite attitude data fusion system according to an embodiment of the present invention in FIG. 5;

[0031] FIG. 8 is a table to illustrate the comparison of the attitude estimation IAE performance between an embodiment of the earth satellite attitude data fusion system of the present invention and the prior art; and

[0032] FIG. 9 is a flowchart to illustrate the earth satellite attitude data fusion method performed by an embodiment of the earth satellite attitude data fusion system in FIG. 5 according to the present invention.

DETAILED DESCRIPTION OF THE DISCLOSED EMBODIMENTS

[0033] In the following detailed description, for purpose of explanation, numerous specific details are set forth in order to provide a thorough understanding of the disclosed embodiments. It will be apparent, however, that one or more embodiments may be practiced without these specific details. In other instances, well-known structures and devices are schematically shown in order to simplify the drawing.

[0034] FIG. 1 is a schematic view to illustrate the structure of the earth satellite attitude data fusion system according to the present invention. As shown in FIG. 1, an earth satellite attitude data fusion system 1 comprises at least: a first EKF 2 and a second EKF 3 of a GS IAE, a 3 axis gyro 4, a sensor of a first star tracker 5, a sensor of a second star tracker 6, and an attitude data fusion algorithm module 7, wherein the 3-axis gyro 4 and the sensor of the first star tracker 5 are connected to the first EKF 2, respectively, the 3-axis gyro 4 and the sensor of the second star tracker 6 are connected to the second EKF 3, respectively, the first EKF 2 and the second EKF 3 are connected to the attitude data fusion algorithm module 7, respectively.

[0035] The first EKF 2: the first EKF 2 of a GS IAE receives gyro attitude data from the 3 axis gyro 4, and first sensor attitude data from the sensor of the first star tracker, and performs an first algorithm based on the gyro attitude data and the first sensor attitude data to obtain first IAE (Inertial Attitude Estimate) result data and output it to an attitude data fusion algorithm module 7.

[0036] The second EKF 3: the second EKF 3 of the GS IAE receives the gyro attitude data from the 3 axis gyro 4, and second sensor attitude data from the sensor of the second star tracker, and performs an second algorithm based on the gyro attitude data and the second sensor attitude data to obtain second IAE (Inertial Attitude Estimate) result data and output it to the attitude data fusion algorithm module 7.

[0037] The attitude data fusion algorithm module 7: the attitude data fusion algorithm module 7 receives the first IAE result data and the second IAE result data, and performs an attitude/rates data fusion algorithm in a subsystem level to evaluate an attitude estimation IAE performance.

[0038] FIG. 2 is a schematic view to illustrate the structure of the first EKF of the earth satellite attitude data fusion system according to the present invention. As shown in the figure, the first EKF 2, comprising: an extended Kalman filter module 21, a quaternion propagation/corrections module 22, and a time-matched quaternion module 23, wherein the extended Kalman filter module 21, the quaternion propagation/corrections module 22, and the time-matched quaternion module 23 collaboratively proceed a quaternion spacecraft attitude data correction process in a feedback working mode according to gyro attitude data from the 3-axis gyro 4, and the first sensor attitude data from the sensor of the first star tracker 5.

[0039] The extended Kalman filter module 21 receives the first sensor attitude data form the sensor of the first star tracker 5, and previously last first sensor attitude data of the sensor of the first star tracker 5 from the time-matched quaternion module 23. The extended Kalman filter module 21 obtains bias correction data and attitude correction data, and provides them to the quaternion propagation/corrections module 22 according to the first sensor attitude data and the previously last first sensor attitude data.

[0040] The quaternion propagation/corrections module 22 receives the bias correction data and the attitude correction data form the extended Kalman filter module 21. According the gyro attitude data, the bias correction data and the attitude correction data, the quaternion propagation/corrections module 22 corrects quaternion attitude data, obtains the first IAE result data and provides that to the attitude data fusion algorithm module 7. The quaternion propagation/corrections module 22 provides corrected quaternion attitude data to the time-matched quaternion module 23.

[0041] FIG. 3 is a schematic view to illustrate the structure of the second EKF of the earth satellite attitude data fusion system according to the present invention. As shown in the figure, the second EKF 3, comprising: an extended Kalman filter module 31, a quaternion propagation/corrections module 32, and a time-matched quaternion module 33, wherein the extended Kalman filter module 31, the quaternion propagation/corrections module 32, and the time-matched quaternion module 33 collaboratively proceed a quaternion spacecraft attitude data correction process in a feedback working mode according to gyro attitude data from the 3-axis gyro 4, and the second sensor attitude data from the sensor of the second star tracker 6.

[0042] The extended Kalman filter module 31 receives the second sensor attitude data form the sensor of the second star tracker 6, and previously last second sensor attitude data of the sensor of the second star tracker 6 from the time-matched quaternion module 33. The extended Kalman filter module 31 obtains bias correction data and attitude correction data, and provides them to the quaternion propagation/corrections module 32 according to the second sensor attitude data and the previously last second sensor attitude data.

[0043] The quaternion propagation/corrections module 32 receives the correction data and the attitude correction data form the extended Kalman filter module 31. According the gyro attitude data, the correction data and the attitude correction data from the extended Kalman filter module 31, the quaternion propagation/corrections module 32 corrects quaternion attitude data, obtains the second IAE result data and provides that to the attitude data fusion algorithm module 7. The quaternion propagation/corrections module 32 provides corrected quaternion attitude data to the time-matched quaternion module 33.

[0044] FIG. 4 is a flowchart to illustrate the earth satellite attitude data fusion method performed by the earth satellite attitude data fusion system according to the present invention.

[0045] As shown in FIG. 4, step 101 is to perform a body rates/quaternion attitude data processing operation, wherein the first EKF 2 receives the body rates data from the 3-axis gyro 4, and the first quaternion attitude data from the sensor of the first star tracker 5, and performs the first algorithm based on the body rates data and the first quaternion attitude data to obtain the first IAE result data and output it to the attitude data fusion algorithm module 7, and the body rates data is the gyro attitude data of the 3-axis gyro 4 and the first quaternion attitude data is the first sensor attitude data of the sensor of the first star tracker 5, and wherein the second EKF 3 receives the body rates data from the 3-axis gyro 4, and the second quaternion attitude data from the sensor of the second star tracker 6, and performs the second algorithm based on the body rates data and the second quaternion attitude data to obtain second IAE result data and output it to the attitude data fusion algorithm module 7, and the second quaternion attitude data is the second sensor attitude data of the sensor of the second star tracker 6. Then, proceed to step 102.

[0046] During step 101, the extended Kalman filter module 21, the quaternion propagation/corrections module 22, and the time-matched quaternion module 23 collaboratively proceed a quaternion spacecraft attitude data correction process in a feedback working mode according to gyro attitude data from the 3-axis gyro 4, and the first sensor attitude data from the sensor of the first star tracker 5.

[0047] The extended Kalman filter module 21 receives the first sensor attitude data form the sensor of the first star tracker 5, and previously last first sensor attitude data of the sensor of the first star tracker 5 from the time-matched quaternion module 23. The extended Kalman filter module 21 obtains bias correction data and attitude correction data, and provides them to the quaternion propagation/corrections module 22 according to the first sensor attitude data and the previously last first sensor attitude data.

[0048] The quaternion propagation/corrections module 22 receives the correction data and the attitude correction data form the extended Kalman filter module 21. According the gyro attitude data, the correction data and the attitude correction data, the quaternion propagation/corrections module 22 corrects quaternion attitude data, obtains the first IAE result data and provides that to the attitude data fusion algorithm module 7. The quaternion propagation/corrections module 22 provides corrected quaternion attitude data to the time-matched quaternion module 23.

[0049] Also, during step 101, the extended Kalman filter module 31, the quaternion propagation/corrections module 32, and the time-matched quaternion module 33 collaboratively proceed a quaternion spacecraft attitude data correction process in a feedback working mode according to gyro attitude data from the 3-axis gyro 4, and the second sensor attitude data from the sensor of the second star tracker 6.

[0050] The extended Kalman filter module 31 receives the second sensor attitude data form the sensor of the second star tracker 6, and previously last second sensor attitude data of the sensor of the second star tracker 6 from the time-matched quaternion module 33. The extended Kalman filter module 31 obtains bias correction data and attitude correction data, and provides them to the quaternion propagation/corrections module 32 according to the second sensor attitude data and the previously last second sensor attitude data.

[0051] The quaternion propagation/corrections module 32 receives the correction data and the attitude correction data form the extended Kalman filter module 31. According the gyro attitude data, the correction data and the attitude correction data from the extended Kalman filter module 31, the quaternion propagation/corrections module 32 corrects quaternion attitude data, obtains the second IAE result data and provides that to the attitude data fusion algorithm module 7. The quaternion propagation/corrections module 32 provides corrected quaternion attitude data to the time-matched quaternion module 33.

[0052] Step 102 is to perform an attitude/rates data fusion processing operation, wherein the attitude data fusion algorithm module 7 receives the first IAE result data and the second IAE result data, and performs the attitude/rates data fusion algorithm in a subsystem level to evaluate an attitude estimation IAE performance.

[0053] FIG. 5 is a schematic view to illustrate the structure and operation of the earth satellite attitude data fusion system according to an embodiment of the present invention.

[0054] As shown in FIG. 5, an earth satellite attitude data fusion system 1, comprising at least: a first EKF 2 and a second EKF 3 of a GS IAE, a 3 axis gyro 4, a sensor of a first star tracker 5, a sensor of a second star tracker 6, and an attitude data fusion algorithm module 7, wherein the axis gyro 4 and the sensor of the first star tracker 5 are connected to the first EKF 2, respectively, the axis gyro 4 and the sensor of the second star tracker 6 are connected to the second EKF 3, respectively, the first EKF 2 and the second EKF 3 are connected to the attitude data fusion algorithm module 7, respectively.

[0055] As shown in the figure, in time t, the 3-axis gyro 4 receives the spacecraft body rates .sup.B(t) (the spacecraft rotation rates) from the spacecraft true dynamics system 8, wherein the spacecraft body rates .sup.B(t) are body rates in the spacecraft body frame coordinates B.

[0056] The 3-axis gyro 4 receives the spacecraft body rates .sup.B(t) and proceed that to output body rates {tilde over ()}.sup.B(t) , wherein the body rates {tilde over ()}.sup.B(t) is body rates (spacecraft rotation rates) of the 3-axis gyro in the spacecraft body frame coordinates B, the body rates {tilde over ()}.sup.B(t) is the gyro attitude data, and the 3-axis gyro 4 can output the body rates {tilde over ()}.sup.B(t) without proceeding or with proceeding misalignment bias corrections depending on practical situations.

[0057] The sensor of the first star tracker 5 receives quaternion attitude data Q.sub.ECI.sup.B(t) (time t) of the spacecraft from the spacecraft true dynamics system 8, wherein the quaternion attitude data Q.sub.ECI.sup.B(t) of the spacecraftare are quaternion attitude data converting from the ECI (Earth-Centered Inertial) frame coordinates to the spacecraft body frame coordinates B. According to the quaternion attitude data Q.sub.ECI.sup.B(t) of the spacecraftare, the sensor of the first star tracker 5 outputs previous quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t)(time (t)) of the sensor of the first star tracker 5 to the first EKF 2, wherein the previous quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t)(time (t)) are the quaternion attitude data converting from the ECI (Earth-Centered Inertial) frame coordinates to the sensor of the first star tracker 5, and is first sensor attitude data of the sensor of the first star tracker 5.

[0058] The first EKF 2: the first EKF 2 of a GS IAE receives body rates data {tilde over ()}.sup.B(t) (gyro attitude data) from the 3-axis gyro 4, and quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t)(time (t)) from the sensor of the first star tracker 5, wherein the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) is the first sensor attitude data of the sensor of the first star tracker. After receiving the body rates data {tilde over ()}.sup.B(t) (the gyro attitude data) and the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) (the first sensor attitude data), the first EKF 2 performs an first algorithm based on the gyro attitude data and the first sensor attitude data to obtain first IAE (Inertial Attitude Estimate) result data {circumflex over (Q)}.sub.ECI.sup.B1(t) , P.sub.1 (time t) and output it to an attitude data fusion algorithm module 7.

[0059] The sensor of the second star tracker 6 receives quaternion attitude data Q.sub.ECI.sup.B(t) (time t) of the spacecraft from the spacecraft true dynamics system 8, wherein the quaternion attitude data Q.sub.ECI.sup.B(t) of the spacecraftare are the quaternion attitude data converting from the ECI (Earth-Centered Inertial) frame coordinates to the spacecraft body frame coordinates B. According to the quaternion attitude data Q.sub.ECI.sup.B(t) of the spacecraftare, the sensor of the second star tracker 6 outputs previous time (t) quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) of the sensor of the second star tracker 6 to the second EKF 3, wherein the previous quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) (time (t)) is the quaternion attitude data converting from the ECI (Earth-Centered Inertial) frame coordinates to the sensor of the second star tracker 6, and is second sensor attitude data of the sensor of the second star tracker 6.

[0060] The second EKF 3: the second EKF 3 of a GS IAE receives body rates data {tilde over ()} .sup.B(t) gyro attitude data) from the 3-axis gyro 4, and quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) (time (t)) from the sensor of the second star tracker 6, wherein the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) is the second sensor attitude data of the sensor of the second star tracker 6. After receiving the body rates data {tilde over ()} .sup.B(t) (the gyro attitude data) and the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) (the second sensor attitude data), the second EKF 3 performs an second algorithm based on the gyro attitude data and the second sensor attitude data to obtain second IAE (Inertial Attitude Estimate) result data {circumflex over (Q)}.sub.ECI.sup.B2, P.sub.2 (time t) and output it to an attitude data fusion algorithm module 7.

[0061] Meanwhile, the P1 and P2 are time varying parameters, and, however, an algorithm can be performed by using stability of the P1 and P2 parameters.

[0062] The attitude data fusion algorithm module 7: the attitude data fusion algorithm module 7 receives the first IAE result data {circumflex over (Q)}.sub.ECI.sup.B1, P.sub.1 and the second IAE result data {circumflex over (Q)}.sub.ECI.sup.B2, P.sub.2, and performs an attitude/rates data fusion algorithm in a subsystem level to evaluate an attitude estimation IAE performance and outputs quaternion attitude data {circumflex over (Q)}.sub.ECI.sup.B(t) (time t).

[0063] FIG. 6 is a schematic view to illustrate the structure of the first EKF of the earth satellite attitude data fusion system according to an embodiment of the present invention in FIG. 5.

[0064] As shown in the figure, the first EKF 2, comprising: an extended Kalman filter module 21, a quaternion propagation/corrections module 22, and a time-matched quaternion module 23, wherein the extended Kalman filter module 21, the quaternion propagation/corrections module 22, and the time-matched quaternion module 23 collaboratively proceed a quaternion spacecraft attitude data correction process in a feedback working mode according to gyro attitude data .sup.B(t) from the 3-axis gyro 4, and the first sensor attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) (time (t)) from the sensor of the first star tracker 5.

[0065] The extended Kalman filter module 21 receives the first sensor attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) (time (t)) from the sensor of the first star tracker 5, and previously last first sensor attitude data QB1/ECI(t) (quaternion attitude data related to the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) (time (t)) of the sensor of the first star tracker 5) of the sensor of the first star tracker 5 from the time-matched quaternion module 23, wherein the previously last first sensor attitude data QB1/ECI(t) is quaternion attitude data (time (t)) converting from the ECI (Earth-Centered Inertial) frame coordinates to the spacecraft body frame coordinates B1(the sensor of the first star tracker 5). The extended Kalman filter module 21 obtains bias correction data b and attitude correction data q, and provides them to the quaternion propagation/corrections module 22, according to the first sensor attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) and the previously last first sensor attitude data QB1ECI(t).

[0066] The quaternion propagation/corrections module 22 receives the bias correction data a and the attitude correction data q from the extended Kalman filter module 21. According the gyro attitude data {tilde over ()}.sup.B(t), the bias correction data a and the attitude correction data q, the quaternion propagation/corrections module 22 corrects quaternion attitude data, obtains the first IAE result data {circumflex over (Q)}.sub.ECI.sup.B1(t) , P.sub.1 and provides it to the attitude data fusion algorithm module 7. The quaternion propagation/corrections module 22 provides corrected quaternion attitude data QB1/ECI(t) to the time-matched quaternion module 23, wherein first sensor attitude data QB1/ECI(t) of the sensor of the first star tracker 5 is quaternion attitude data related to the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) of the sensor of the first star tracker 5.

[0067] FIG. 7 is a schematic view to illustrate the structure of the second EKF of the earth satellite attitude data fusion system according to an embodiment of the present invention in FIG. 5.

[0068] As shown in the figure, the second EKF 3 comprising: an extended Kalman filter module 31, a quaternion propagation/corrections module 32, and a time-matched quaternion module 33, wherein the extended Kalman filter module 31, the quaternion propagation/corrections module 32, and the time-matched quaternion module 33 collaboratively proceed a quaternion spacecraft attitude data correction process in a feedback working mode according to gyro attitude data {tilde over ()}.sup.B(t) from the 3-axis gyro 4, and the second sensor attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) (time (t)) from the sensor of the second star tracker 6.

[0069] The extended Kalman filter module 31 receives the second sensor attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) (time (t)) from the sensor of the second star tracker 6, and previously last second sensor attitude data QB2/ECI(t) (quaternion attitude data related to the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) (time (t)) of the sensor of the second star tracker 6) of the sensor of the second star tracker 6 from the time-matched quaternion module 33, wherein the previously last second sensor attitude data QB2/ECI(t) is quaternion attitude data (time (t)) converting from the ECI (Earth-Centered Inertial) frame coordinates to the spacecraft body frame coordinates B2 (the sensor of the second star tracker 6). The extended Kalman filter module 31 obtains bias correction data a and attitude correction data q, and provides them to the quaternion propagation/corrections module 32, according to the second sensor attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) and the previously last second sensor attitude data QB2/ECI(t).

[0070] The quaternion propagation/corrections module 32 receives the bias correction data a and the attitude correction data q from the extended Kalman filter module 31. According the gyro attitude data {tilde over ()}.sup.B(t) , the bias correction data b and the attitude correction data q, the quaternion propagation/corrections module 32 corrects quaternion attitude data, obtains the second IAE result data {circumflex over (Q)}.sub.ECI.sup.B2(t) , P.sub.2 and provides it to the attitude data fusion algorithm module 7. The quaternion propagation/corrections module 32 provides corrected quaternion attitude data QB2/ECI(t) to the time-matched quaternion module 33, wherein second sensor attitude data QB2/ECI(t) of the sensor of the second star tracker 6 is quaternion attitude data related to the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) of the sensor of the second star tracker 6.

[0071] FIG. 8 is a table to illustrate the comparison of the attitude estimation IAE performance between an embodiment of the earth satellite attitude data fusion system of the present invention and the prior art.

[0072] Hence, the one sigma attitude error can be approximated by:

[00001]${}_{}=\sqrt{p_{11}}\sqrt{{\mathrm{rq}}_{11}}=\sqrt{r\left(\frac{1}{\sqrt{3}}\right).Math.{}_{\mathrm{arw}}}=3^{-\frac{1}{4}}.Math.\sqrt{r.Math..Math.{}_{\mathrm{arw}}}=\left(0.76\right).Math.{\stackrel{\_}{}}_{},$

wherein .sub.is the one sigma attitude error with one MEMS gyro array.

[0073] One sigma attitude errors in each axis using one IAE Approach will be reduced by a factor of 1/3.sup.1/4(0.76) (in general will be by a factor of 1/N.sup.1/4 for N MEMS gyro arrays) as compared to 1/3.sup.1/2(0.577) when one uses multiple IAEs Approach.

[0074] In FIG. 8, the present invention describes the Matlab models built to validate the IAE performance with two different approaches and assess their performance sensitivities to MEMS gyro angle random walks and misalignments among MEMS gyro arrays. As shown in FIG. 8, the table illustrates the IAE performance of different GS IAE configurations (TBU).

[0075] Two simulation cases are performed to evaluate the attitude estimation performance. The spacecraft attitude & body rates motion generated by the 6-DOF nonlinear, high-fidelity Micro-sat simulator. The Micro-Sat's dynamics is well considered in this simulation scenario. The spacecraft is orientated to sun pointing (SUP Mode) when it exits the eclipse zone and switched to geocentric attitude pointing (GAP mode) when it enters the eclipse zone.

[0076] The spacecraft's attitude measurements are provided by the star tracker model, and rate measurements are provided by two gyro models.

[0077] The simulation parameters are given below:

[0078] star tracker model: accuracy: 12 arcsecond, 1 sigma; 5 arcsecond @ across-boresight; 55 arcsecond @ boresight,1 sigma.

[0079] gyro model: ARW: 0.7 deg/hr (TBC), bias: 5 deg/hr (TBC); and gyro misalignment angle (x, y, z) : (0.5, 0.2, 0.4) degree.

[0080] As for case 1, the standard configuration in the prior performs a GS (Gyro-Stellar) IAE (Inertial Attitude Estimate) algorithm to process satellite attitude data from star sensor and body rates from two gyros to evaluate the attitude estimation IAE performance.

[0081] As for case 2, according to the present invention, the earth satellite attitude data fusion system and method can really get better attitude estimation IAE performance.

[0082] As shown in the FIG. 8, no matter the star sensor time delay is 0 or 0.25 sec, the earth satellite attitude data fusion system and method of the present invention not only can use data fusion algorithm to optimize the GS IAE results, but also can co-operate time-matching method to get the GS IAE results without effecting by the time-delay effect according to the star sensor data.

[0083] FIG. 9 is a flowchart to illustrate the earth satellite attitude data fusion method performed by an embodiment of the earth satellite attitude data fusion system in FIG. 5 according to the present invention.

[0084] As shown in FIG. 9, step 201 is to perform a body rates/quaternion attitude data processing operation, wherein after receiving the body rates data {tilde over ()}.sup.B(t) (the gyro attitude data) and the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) (the first sensor attitude data), the first EKF 2 performs an first algorithm based on the gyro attitude data

[0085] {tilde over ()}.sup.B(t) and the first sensor attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) to obtain first IAE (Inertial Attitude Estimate) result data {tilde over (Q)}.sub.ECI.sup.ST1(t) , P.sub.1 (time t) and output it to an attitude data fusion algorithm module 7, wherein the previous quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) (time (t)) are the quaternion attitude data converting from the ECI (Earth-Centered Inertial) frame coordinates to the sensor of the first star tracker 5, and is first sensor attitude data of the sensor of the first star tracker 5, wherein after receiving the body rates data {tilde over ()}.sup.B(t) (the gyro attitude data) and the quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST2(t) (the second sensor attitude data), the second EKF 3 performs an second algorithm based on the gyro attitude data and the second sensor attitude data to obtain second IAE (Inertial Attitude Estimate) result data {circumflex over (Q)}.sub.ECI.sup.B2, P.sub.2 (time t) and output it to an attitude data fusion algorithm module 7, and wherein the previous quaternion attitude data {tilde over (Q)}.sub.ECI.sup.ST1(t) (time (t)) is the quaternion attitude data converting from the ECI (Earth-Centered Inertial) frame coordinates to the sensor of the second star tracker 6, and is second sensor attitude data of the sensor of the second star tracker 6. Then, proceed to step 202.

[0086] Step 202 is to perform an attitude/rates data fusion processing operation, wherein the attitude data fusion algorithm module 7 receives the first IAE result data {circumflex over (Q)}.sub.ECI.sup.B1, P.sub.1 and the second IAE result data {circumflex over (Q)}.sub.ECI.sup.B2, P.sub.2 , and performs the attitude/rates data fusion algorithm in a subsystem level to evaluate an attitude estimation IAE performance.

[0087] It will be apparent to those skilled in the art that various modifications and variations can be made to the disclosed embodiments. It is intended that the specification and examples be considered as exemplary only, with a true scope of the disclosure being indicated by the following claims and their equivalents.