Adapted fake_scan to work with new odometry