continuing EKF slam