Alignment that checks front sensors are about equal
Revert "Alignment that checks front sensors are about equal"

This reverts commit 3112f4a92086222382de9c60b8a92f24feb5029f.
Some Localization simplification
Merged Nav, ShortestPath, and Localization