Kalman filtering theory and practice - Grewal, Mohinder S. (000000, 1993)