Workaround for course correction not stopping after long distances.
Some cascade detection optimization.
Beginnings of D* Lite reintegration.
Merge branch 'master' of https://github.com/amccaleb/UCSC-Rover-2014