Working on atlas drive system.
Merged Darrel and John changes.
Changes to GPS, Navigation, and Atlas, as well as mavlink messages (needs generating)