Kalman filter autonomous vehicle