Finished GPS changes to ECEF and library.

Many changes to GPS, initial Navigation system finished. Added
functionallity to the AtLAs state machine, but it is still unfinished.