Further decoupling of mavlink and navigation

- move waypoints and missionlib to navigator
- Move nav data out of mavlink