added extra for current waypoint retrieval.
Merge branch 'master' of github.com:3drobotics/3DR-Services-Library into dp_3dr_services
waypoint improvement.