Earth satellite attitude data fusion system and method thereof
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.
1. 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 (Extended Kalman Filter) of a GS IAE (Gyro-Stellar Inertial Attitude Estimate);
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,
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 (Inertial Attitude Estimate) 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,
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,
wherein the first EKF of a GS IAE performs a first algorithm based on the body rates data and the first quaternion attitude data, proceeds a quaternion spacecraft attitude data correction process in a feedback working mode according to the body rates data, and first sensor attitude data from the sensor of the first star tracker, and outputs the first IAE result data to the attitude data fusion algorithm module, and
wherein the second EKF of the GS IAE performs a second algorithm based on the body rates data and the second quaternion attitude data, proceeds a quaternion spacecraft attitude data correction process in a feedback working mode according to the body rates data, and second sensor attitude data from the sensor of the second star tracker, and outputs the second IAE result data to the attitude data fusion algorithm module.
2. The earth satellite attitude data fusion system as claimed in claim 1 , wherein the first EKF comprises an extended Kalman filter module, a quaternion propagation/corrections module, and a time-matched quaternion module, and wherein the extended Kalman filter module, the quaternion propagation/corrections module, and the time-matched quaternion module collaboratively proceed the quaternion spacecraft attitude data correction process in the feedback working mode.
3. The earth satellite attitude data fusion system as claimed in claim 1 , wherein the second EKF comprises an extended Kalman filter module, a quaternion propagation/corrections module, and a time-matched quaternion module, and wherein the extended Kalman filter module, the quaternion propagation/corrections module, and the time-matched quaternion module collaboratively proceed the quaternion spacecraft attitude data correction process in the feedback working mode.