Mavlink range finder

This adds MAVLink support for range finders and untangles the logging for range finders. Test flown and logs reviewed.