adapted mavlink_onboard_mod to current status for testing rpg_commander