Odometry and motion planning for omni drive robots
measurement and correction of systematic odometry errors in mobile robots .