Satellite attitude determination algorithm of model error robustness
-
摘要: 提出一种结合非线性预测滤波和二阶插值滤波实现基于星光/陀螺的高精度姿态确定的新算法.该算法用非线性预测滤波估计模型误差,再对补偿后的模型用高精度的二阶插值滤波来估计姿态参数.解决了在卫星实际运行中难以获得姿态确定系统的精确动力学模型,采用传统EKF(Extended Kalman Filter)将模型误差作为零均值白噪声处理,导致滤波精度降低甚至发散的问题.同时,二阶插值滤波将非线性模型按照二阶近似,无需计算函数偏导数,得到高精度的卫星姿态估计.仿真验证了该方法能有效地实时估计并补偿模型误差,提高了姿态估计的精度,且估计精度受滤波周期的影响不大,从而验证了算法的鲁棒性和有效性.Abstract: A new high-precision star sensor/gyro attitude determination algorithm based on nonlinear predictive filter (NPF) and second-order divided difference filter was presented. In this algorithm, model error was estimated by NPF, and the state was estimated via second-order divided difference filter by using compensated system model. While it is difficult to obtain the accurate dynamic model of attitude determination system, extended Kalman filter (EKF) treated uncertain model error as zero-mean white noise might cause low precision of state estimation even to divergence. The proposed method solved such problem. The nonlinear model was the second-order approximation while using second-order divided difference filter without calculating the partial derivatives of system model, and then attitude estimation with high precision was obtained. Simulation results show that the proposed method estimates and compensates the model error in real-time effectively and improves the estimation precision, also the filter period influences the precision slightly. The effectiveness and the robustness of the proposed method are proved.
-
Key words:
- nonlinear filtering /
- state estimation /
- error compensation /
- attitude control
-
[1] Nφrgaard M,Poulsen N K,Ravn O.New developments in state estimation for nonlinear system .Automatica,2000,36(11):1627-1638 [2] Gelb A.Applied optimal estimation .Cambridge,MA: MIT Press,1975:ch.6 [3] 李骥.非线性预测滤波及其在卫星姿态控制系统中的应用 .北京:北京航空航天大学自动化科学与电气工程学院,2006 Li Ji.Nonlinear predictive filter theory and its application to the attitude control system of satellites .Beijing:School of Automation Science and Electrical Engineering,Beijing University of Aeronautics and Astronautics,2006(in Chinese) [4] Lu P.Optimal predictive control of continuous nonlinear systems .INT J Control,1995,62(3):633-649 [5] Crassidis J L,Markley F L.Predictive filtering for nonlinear systems .Journal of Guidance Control and Dynamics,1997,20(3):566-572 [6] 郁丰,刘建业,熊智.预测滤波算法在微小卫星姿态确定中的应用 .宇航学报,2008,29(1):110-114 Yu Feng,Liu Jianye,Xiong Zhi.Application of predictive filter in satellite attitude determination[J].Journal of Astronautics,2008,29(1):110-114(in Chinese) [7] 冀红霞,杨静.基于非线性预测滤波的卫星姿态确定 .系统仿真学报,2010,22(S1):34-42 Ji Hongxia,Yang Jing.Satellite attitude determination based on nonlinear predictive filter .Journal of System Simulation,2010,22(S1):34-38(in Chinese) [8] 杨静,张洪钺,李骥.预测滤波在惯导非线性对准中的应用 .中国惯性技术学报,2003,11(6):44-52 Yang Jing,Zhang Hongyue,Li Ji.Application of the predictive filter on the nonlinear alignment of inertial navigation system[J].Journal of Chinese Inertial Technology,2003,11(6):44-52(in Chinese) [9] 宫晓琳,房建成.基于预测滤波的捷联惯导任意双位置对准方法 .北京航空航天大学学报,2008,34(5):533-536 Gong Xiaolin,Fang Jiancheng.Method of any two position alignment based on predictive filter for SINS .Journal of Beijing University of Aeronautics and Astronautics,2008,34(5):533-536(in Chinese) [10] 林玉荣,邓正隆.二阶插值非线性滤波在卫星姿态确定中的应用[J].哈尔滨工业大学学报,2006,38(3):343-347 Lin Yurong,Deng Zhenglong.Study of second-order nonlinear interpolation filtering for satellite attitude determination[J].Journal of Harbin Institute of Technology,2006,38(3):343-347(in Chinese) [11] 柴霖,袁建平,罗建军,等.非线性估计理论的最新进展[J].宇航学报,2005,26(3) 380-384 Chai Lin,Yuan Jianping,Luo Jianjun,et al.New developments in nonlinear systems estimation .Journal of Astronautic,2005,26(3):380-384(in Chinese)
点击查看大图
计量
- 文章访问数: 2559
- HTML全文浏览量: 47
- PDF下载量: 707
- 被引次数: 0