Add mavlink as submodule.
Overhaul for new mavlink setpoint message type.