Fundamentals Of Kalman Filtering by Paul Zarchan & Howard Musoff