Navigation stack for an omnidirectional robot