Kalman filtering : theory and practice using Matlab - Grewal (John Wiley & Sons, Inc., 2001)