Fixed some typos in the Kalman filter code