Code to drive Team 1's robot for the 2016 R5 robotics competition.

Dependencies:   mbed navigation R5_StepperDrive LongRangeSensor DistanceSensor scanner Gripper ColorSensor

Revision:
11:b5f75d25a4b3
Parent:
9:a956ba674cea
Child:
12:e9f878ced6e7
--- a/r5driver.cpp	Fri Oct 30 15:56:19 2015 +0000
+++ b/r5driver.cpp	Sun Nov 22 19:33:03 2015 +0000
@@ -68,6 +68,8 @@
     r5nav.printRoute(pc);
     r5nav.setVertex(RED_DROP_ZONE);
     wait(0.1);
+    
+    r5nav.printGraph(pc);
 
     return 0;
 }
\ No newline at end of file