Odometry integrated with Extended Kalman Filter