For the two-satellite formation, the relative motion and attitude determination algorithm is a key component that affects the flight quality and mission efficiency. The relative status determination algorithm is proposed based on the Extended Kalman Filter (EKF) and the system state optimal estimate linearization. Aiming at the relative motion of the spacecraft formation navigation problem, the spacecraft relative kinematics and dynamics model are derived from the dual quaternion in the algorithm. Then taking advantage of EKF technique, combining with the dual quaternion integrated dynamic models, considering the navigation algorithm using the fusion measurement by the gyroscope and star sensors, the relative status determination algorithm is designed. At last the simulation is done to verify the feasibility of the algorithm. The simulation results show that the EKF algorithm has faster convergence speed and higher accuracy.
Dynamic Models of Satellite Relative Motion and their effects on Kalman Filter