Localization working in planner test
TurboUlla is now able to navigate in the simulator
Updated navigation demo. Still having some localization issues?