基于无奇点根数的空间相对导航插值滤波算法.docxVIP

基于无奇点根数的空间相对导航插值滤波算法 轶1，2，3 ，张善从1，3李( 1． 中国科学院光电研究院基于无奇点根数的空间相对导航插值滤波算法 轶1，2，3 ，张善从1，3李( 1． 中国科学院光电研究院，北京 100094; 2． 中国科学院研究生院，北京 100049;3． 北京国科环宇空间技术有限公司，北京 100190)摘 要: 为了提高椭圆轨道航天器的相对导航精度，将基于 Stirling 公式的多项式插值滤波方法( DDF2) 引入导航算法，降低了传统的卡尔曼滤波方法中泰勒级数展开线性化造成的误差，有效提高了相对导航滤波精度; 算法 将无奇点根数引入系统状态方程作为状态变量，推导了相对无奇点根数到相对位置和相对速度的转换公式，避免 了开普勒轨道根数容易产生的奇异性问题。同传统的 C-W 方程相比，本方法无需假设航天器是正圆轨道，更加适用于考虑地球 J2 项摄动的情况。以星间相对距离和角度作为观测量，数值仿真比较了 UKF 算法和多项式插值滤波 方法的性能，仿真结果表明，采用同样的 sigma 点选取策略，且运算复杂度相当的条件下，本方法具有更高的精度和 稳定性。关键词: 无奇点根数; 相对轨道要素;相对自主导航; 多项式插值滤波; 编队飞行中图分类号:文献标识码:文章编号:1000-1328( 2012) 12-1727-09V448ADOI: 10． 3873 / j． issn． 1000-1328． 2012． 12． 003Interpolation Filtering for Relative Navigation in SpaceBased on Non-Singularity Orbit ElementsLI Yi1，2，3 ，ZHANG Shan-cong1，3( 1． Academy of Opto-Electronics，Chinese Academy of Science，Beijing 100094，China;2． Graduate University of Chinese Academy of Science，Beijing 100049，China;3． Beijing UCAS Space Technology Co． ，Ltd，Beijing 100190，China)Abstract: In order to improve the relative navigation accuracy of spacecrafts with elliptical orbit， the polynomialinterpolation based on Stirling formula is applied to decrease the model error caused by Taylor expansion linearization in traditional Kalman filter，thus improving relative navigation accuracy effectively． The non-singularity orbit elements are applied as the state variables in the state equation，the transform formulas between relative non-singularity orbit elements and relative position( velocity) between spacecrafts are also derived，so that the singular points are avoided in the Kepler ’s elements． Compared with the traditional C-W formula，the non-singularity formula is more suitable without any restriction of eccentricity． Taking the relative distance，azimuth and elevation between spacecrafts as measurement vectors，validity of UKF and polynomial interpolation is compared by using the same principal of sigma-point selecting method and approxi