针对一类具有未建模误差和扰动的非线性系统的状态估计问题,提出一种在线估计并补偿模型误差的非线性滤波算法,该算法利用非线性预测滤波(NPF)基于预测输出残差的方差最小的基本原则估计模型误差,再利用扩展卡尔曼滤波(EKF)的思想对补偿后的模型进行状态估计;详细推导了状态估计误差及其方差阵的传播模型。以卫星姿态确定系统为例,仿真结果显示改进算法对未建模误差以及初始状态误差的鲁棒性,而滤波周期增大会导致估计精度下降。与扩展卡尔曼滤波和预测滤波相比,改进算法不仅可以实时估计并补偿系统模型误差的影响,提高姿态估计的精度,而且收敛速度快,从而进一步验证了算法的有效性。
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.
[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.