Fundamentals of Kalman filtering a practical approach - Zarchan, Paul (Progress in astronautics and aeronautics, 2005)