Revert "MAVLink update"

This reverts commit 233a17161aa34a2f56f04ea5e225f2ef27d7ab5e.