[doc] describe the details supervision service
[testing] Improve tests on waypoint services

Test the interaction between goto, stop, resume and get_dest.
Fix #202