Navigation TODO List:

[GreatAlexander]

• [x] Check if we are using Global or Local navigation on the youBot
• [ ] Attempt clearing costmaps to avoid aborted navigation