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