Minor bug fix to ensure callbacks fire before first waypoint is set

src/cs4313_utilities/robot_driver.py

@@ -20,6 +20,7 @@ if __name__ == "__main__":
     # Just some canned waypoints for testing
     waypointList = [[5.0, 5.0], [-10.0, 5.0], [-5.0, -5.0], [10.0, -5.0], [0.0, 0.0] ]
 
+    rbt.spinOnce()  # Let it process at least one round of callbacks before starting
     for waypoint in waypointList:
         print("Setting waypoint (" + str(waypoint[0]) + ", " + str(waypoint[1]) + ")")
         robot.setWaypoint(waypoint[0], waypoint[1])