Add MAVlink driver to v2