Many MavLink updates:

- updated to latest MavLink library
- added ability to send/receive/delete waypoints
- added more telemetry data
- added status messages to inform user
- many bugfixes (still some bugs left)

Note: These changes are not flight-tested!