Increase mavlink test coverage