Update mavlink library
plugins: Add msgs and srvs for Waypoint plugin
plugins: refactor context & link to single UAS class

UAS same functions as in QGC.