Fixed a bunch of smaller HIL issues, GPS COG is now correct
Merge branch 'master' of github.com:mavlink/qgroundcontrol