New navigation harness almost done.

Needs override to detect control goes back to the micro controller.
More improvements to Navigaton module.
Fixed GPS course heading, and nav. test ready.
Finished preliminary Atlas state machine diagrams.
Merge branch 'launch-attempt2'
Merged Darrel drive changes with new navigation.