Kalman filter commented v2