sb_gps finished, compilation not tested yet.
Merge branch 'master' of https://github.com/UBC-Snowbots/IGVC2014