- added ublox GPS Configuration
- fixed GCS heading calculation