use cubicles
Merge branch 'fixBugs' of github.com:SquadCollaborativeRobotics/global_planner into fixBugs