Merge branch 'master' of github.com:SquadCollaborativeRobotics/global_planner
Merge branch 'master' of github.com:SquadCollaborativeRobotics/global_planner into april_tags
Added more useful functions