Kalman filtering : theory and practice using MATLAB - Grewal, Mohinder S.,