Update to mavlink test

updated mavlinktest to now poll for degree 5 times and take the most
prominent.