Added a WaypointWriter that fills in the waypoints in EEPROM from a hardcoded list of coordinates. This is only temporary until we have some sort of mission planner. Integrated the waypoints into the Captain. Right now it should be pretty much ready to go. It will follow multiple waypoints until it gets to the end of the list (location = 0,0).
Fixed a few scaling bugs in the GPS class and added more printing to show the information.
Add printing of GPS time.
Added loop timers to the main loop for navigation, satcom, telemetry, and serial printing.
Fixed APM to output to channel one and two by default.
Update message update function to provide altitude and heading information.