Lecture notes on Kalman filtering by A. Johnson