fixes in kalman filter