The beginnings of reintegrating path following. In a compilable state.
Merge branch 'master' of https://github.com/amccaleb/UCSC-Rover-2014