WP and servo mods
WP and servo mods

Add code to capture waypoints.
Add code to pretty print waypoints.
Remove log in set_throttle_servo() - too chatty.
Document pull_waypoints()
Minor changes to goto wp
ProgrammingRobotsStudyGroup/robo_magellan,ProgrammingRobotsStudyGroup/robo_magellan,ProgrammingRobotsStudyGroup/robo_magellan,ProgrammingRobotsStudyGroup/robo_magellan