Updated final.cpp so that it works with sb_msgs::gps
Changed precision to 6 decimal places. GPS estimatation ~10cm.
Merge branch 'master' of https://github.com/UBC-Snowbots/IGVC2014