Add waypoint funcitons to destinations list and autopilot menu.
Merge branch 'waypointButton' into develop