Cleaned code and example in Kalman filter implementation.