heading is not call with hil , no need to test
Merge remote-tracking branch 'upstream/master' into hil
Merge remote-tracking branch 'upstream/master' into hil
change serial and gps so they can be use with softserial.
fix upstream format
Merge branch 'upstream' into hil
Merge remote-tracking branch 'origin/hil' into hil_plane