fix some mavlink issues