A nonlinear filtering algorithm with online model error estimation and compensation is proposed for a nonlinear system with uncertain model errors and disturbances. The model error is estimated by minimizing the variance of the predictive output residual based on the nonlinear predictive filter (NPF) principle, and then the system state is estimated by the extended Kalman filter (EKF) principle based on the compensated model. Detailed propagation formula of the state estimation error and its variance matrix are derived. Simulation results show the effectiveness of the proposed algorithm on a satellite attitude determination system with uncertain model errors. The simulation shows the robustness of the proposed algorithm for both the initial state error and uncertain model error, and the increasing filtering period may decrease the estimation accuracy. Compared with EKF and NPF, the proposed nonlinear filtering algorithm has the advantage of both improved estimation accuracy and faster convergence.
YANG Jing, JI Hongxia, WEI Mingkun
. Error Analysis and Application of a Nonlinear Filter[J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2011
, 32(8)
: 1469
-1477
.
DOI: CNKI:11-1929/V.20110419.1701.001
[1] Kalman R E. A new approach to linear filtering and prediction problems[J]. Journal of Basic Engineering(ASME), 1960, 82 Series D: 35-45.
[2] 秦永元, 张洪钺, 汪叔华. 卡尔曼滤波与组合导航原理[M]. 西安: 西北工业大学出版社, 1998: 1-33, 175-188, 190-191. Qin Yongyuan, Zhang Hongyue, Wang Shuhua. Kalman filter and integrated navigation principle[M]. Xi'an: Northwestern Polytechnical University Press, 1998: 1-33, 175-188, 190-191. (in Chinese)
[3] Nφrgaard M, Poulsen N K, Ravn O. New developments in state estimation for nonlinear system[J]. Automatica, 2000, 36(11): 1627-1638.
[4] Lu P. Optimal predictive control of continuous systems[J]. Journal of Guidance, Control, and Dynamics, 1994, 17(3): 553-560.
[5] Lu P. Optimal predictive control of continuous nonlinear systems[J]. International Journal of Control, 1995, 62(3): 633-649.
[6] Crassidis J L. Efficient and optimal attitude determination using model-error control synthesis[J]. Journal of Guidance, Control, and Dynamics, 1999, 22(2): 193-201.
[7] Crassidis J L, Markley F L. Predictive filtering for nonlinear systems[J]. Journal of Guidance, Control, and Dynamics, 1997, 20(3): 566-572.
[8] Lin Y R, Deng Z L. Model-error based predictive filter for satellite attitude determination[J]. Journal of Aeronautics, 2001, 22(1): 79-88.
[9] Anton D R. Nonlinear state-estimation for space craft attitude determination. Canada: University of Toronto, 2001.
[10] 冀红霞, 杨静. 基于非线性预测滤波的卫星姿态确定[J]. 系统仿真学报, 2010: 22(S1), 34-38. Ji Hongxia, Yang Jing. Satellite attitude determination based on nonlinear predictive filter[J]. Journal of System Simulation, 2010, 22(S1): 34-38. (in Chinese)
[11] Ajeesh P K, Sadasivan P. Performance analysis of nonlinear-predictive-filter-based chaotic synchronization[J]. IEEE Transactions on Circuits and Systems-II: Express Briefs, 2006, 53(9): 886-890.
[12] 杨静, 张洪钺, 李骥. 预测滤波在惯导非线性对准中的应用[J]. 中国惯性技术学报, 2003, 11(6):44-52. Yang Jing, Zhang Hongyue, Li Ji. INS nonlinear alignment with large azimuth misalignment angle using predictive filter[J]. Journal of Chinese Inertial Technology, 2003, 11(6):44-52. (in Chinese)
[13] 宫晓林, 房建成. 基于预测滤波的捷联惯导任意双位置对准方法[J]. 北京航空航天大学学报, 2008, 34(5):533-536. Gong Xiaolin, Fang Jiancheng. Method of any two-position alignment based on predictive filter for SINS[J]. Journal of Beijing University of Aeronautics and Astronautics, 2008, 34(5):533-536. (in Chinese)
[14] 刘百奇, 宫晓琳, 房建成. 基于GPS 观测量和模型预测滤波的机载SINS/GPS 空中自对准[J]. 中国惯性技术学学报, 2007, 15(5):568-572. Liu Baiqi, Gong Xiaolin, Fang Jiancheng, In-flight self-alignment for airborne SINS/GPS based on GPS observation and model predict filter[J]. Journal of Chinese Inertial Technology, 2007, 15(5):568-572. (in Chinese)
[15] 赵晓旭. 基于姿态敏感器与星间测量的星座自主导航方法研究. 北京:北京航空航天大学自动化科学与电气工程学院, 2010. Zhao Xiaoxu. Study on autonomous navigation of constellation using attitude sensor and inter-satellite measurement. Beijing: School of Automation Science and Electrical Engineering Beihang University, 2010. (in Chinese)
[16] Li J, Zhang H Y. Stability analysis of the predictive filter [J]. Journal of Guidance, Control, and Dynamics, 2006, 29(3): 738-741.
CJA