Kalman filtering : theory and practice using MATLAB / Mohinder Grewal and Angus P. Andrews (Wiley, 2001)