摘要
提出了一种用于探测器在巡航段的自主光学导航方案,该方案利用光学导航相机以及星敏感器,通过测量星光信息以及天体边缘的信息,得出了探测器的相对位置。在此基础上针对导航系统状态方程和观测方程的非线性问题,提出了SR-UPF(Square-Root Unscented Particle Filter)算法,该方法将平方根UKF滤波和粒子滤波有机结合起来,可更好地提高自主导航系统的准确度和可靠性。通过数学仿真表明改进的算法与原UPF算法相比,收敛速度更快,滤波精度更高。
An autonomous optical navigation scheme for cruise phase was proposed using the star light data and body edge data which was measured by star sensor and optical navigation camera. And the relative position for probes was acquired from the star light data and body edge data. Aiming at the non-linearity of state equation and observation equation and a process of SR-UPF (Square-Root Unscented Particle Filter, SR-UPF) was proposed based on these work. The real time orbit for probes was determined by using these. The arithmetic integrated square-root UKF (Unscented Kalman Filter, UKF) and PF to improve the precise and reliability of the autonomous optical navigation system. Simulation result shows that the improved UPF algorithm is not only more accurate but also has higher rate of convergence compared with the UPF.
出处
《系统仿真学报》
CAS
CSCD
北大核心
2008年第18期4971-4974,4981,共5页
Journal of System Simulation
基金
National High Technology Research and Development Program of China (2005AA735080-2)