Reset the manual waypoint controller on entry into autonomous mode

This removes all manual wayoints when you enter autonomous mode to
prevent the rover from immediately driving to whatever waypoints it
had before entering manual mode. (#130)

Author: wfvining

src/behaviours/src/LogicController.cpp

@@ -374,6 +374,7 @@ void LogicController::SetModeAuto() {
   if(processState == PROCESS_STATE_MANUAL) {
     // only do something if we are in manual mode
     this->Reset();
+    manualWaypointController.Reset();
   }
 }
 void LogicController::SetModeManual()

src/behaviours/src/ManualWaypointController.cpp

@@ -9,6 +9,8 @@ ManualWaypointController::~ManualWaypointController() {}
 
 void ManualWaypointController::Reset() {
   waypoints.clear();
+  num_waypoints = 0;
+  cleared_waypoints.clear();
 }
 
 bool ManualWaypointController::HasWork() {