A symplectic moving horizon estimation algorithm with its application to the Earth—Moon L2 libration point navigation
- 18 Downloads
Accurate state estimations are perquisites of autonomous navigation and orbit maintenance missions. The extended Kalman filter (EKF) and the unscented Kalman filter (UKF), are the most commonly used method. However, the EKF results in poor estimation performance for systems are with high nonlinearity. As for the UKF, irregular sampling instants are required. In addition, both the EKF and the UKF cannot treat constraints. In this paper, a symplectic moving horizon estimation algorithm, where constraints can be considered, for nonlinear systems are developed. The estimation problem to be solved at each sampling instant is seen as a nonlinear constrained optimal control problem. The original nonlinear problem is transferred into a series of linear-quadratic problems and solved iteratively. A symplectic method based on the variational principle is proposed to solve such linear-quadratic problems, where the solution domain is divided into sub-intervals, and state, costate, and parametric variables are locally interpolated with linear approximation. The optimality conditions result in a linear complementarity problem which can be solved by the Lemke’s method easily. The developed symplectic moving horizon estimation method is applied to the Earth-Moon L2 libration point navigation. And numerical simulations demonstrate that though more time-consuming, the proposed method results in better estimation performance than the EKF and the UKF.
Keywordsmoving horizon estimation symplectic method quasilinearization variational principle L2 libration point navigation
The authors are grateful for the financial support of the National Natural Science Foundation of China (Grant No. 11772074).
- Hill, K., Born, G. H., Lo, M. W. Linked, autonomous, interplanetary satellite orbit navigation (LiAISON) in lunar halo orbits. In: Proceedings of AAS/AIAA Astrodynamical Specialists Conference, 2005.Google Scholar
- Welch, G., Bishop, G. An introduction to the Kalman filter. University of North Carolina, 2001.Google Scholar
- Bryson, A. E. Jr., Ho, Y. C. Applied Optimal Control. Hemisphere, 1975.Google Scholar
- Wang, X. W., Peng, H. J., Zhang, S., Chen, B. S., Zhong, W. X. A symplectic local pseudospectral method for solving nonlinear state-delayed optimal control problems with inequality constraints. International Journal of Robust and Nonlinear Control, 2018, 28(6): 2097–2120.MathSciNetCrossRefzbMATHGoogle Scholar