GPS support added to mavlink_onboard_fb
minor changes to RPG_gps_test code