Kalman filtering, theory and practice using matlab - Mohinder S, Grewal Angus P, Andrews (USA JOHN WILEY & SONS, 2001)