Updates to make Rover5 platform move

Added encoder interrupt handlers to example.
Removed encoder simulation from MotorDriver
Changed Navigator to take control as soon as final waypoint is reached.
Added progress messages and output formatting to make it easier to sift
through all the verbosity.
Starting to refactor WaypointManager commands.