tidy, this isn't going to work without a 10DOF board
better compass calculations, tuning, gps fix
NOTE: GPS should now work, but results are awful, probably needs a PID