integrated GPS and Nav

Added interrupt routine for GPS. This code works for simple GPS point
navigation w/ mag and gps