V4.2 Formatting

-Moved a few functions around in the Nav functions
-Could get rid of a few empty ISR's
-Buildable, Not tested, 1 truncation warning