kalman filter is stuck