Started writing the Kalman filter class.