adding fixing kalman filter