Kalman filtering : theory and practice using MATLAB - Grewal, Mohinder S. (A Wiley, 2001)