Added subscriber to final.cpp. The package doesn't compile yet.
Merge branch 'master' of https://github.com/UBC-Snowbots/IGVC2014