Enable code for handling MAVLink messages

Joystick code is disabled