Lots of changes to achieve higher accuracy of the april tags.  Includes code to stop and get a second, standing still look at the tag, and communicate with the global planner. also made some minor parameter adjustments for speed