Added GPS code, updated doxygen, added gps data plots, modified Board and Serial modules.
Completed GPS code (still bugs) and updated test data.
Updated GPS state machine.
Finished GPS lat,lon,alt code. Still need velocity and error setting.