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