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

Dependencies:   mbed navigation R5_StepperDrive LongRangeSensor DistanceSensor scanner Gripper ColorSensor

Revision:
0:a3c39d3359ac
Child:
1:1958e6db41fc
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/r5driver.cpp	Wed Oct 14 21:49:02 2015 +0000
@@ -0,0 +1,17 @@
+#include <cstdio>
+#include "wgraph.h"
+#include "mbed.h"
+
+Serial pc(USBTX, USBRX);
+
+int main()
+{
+    pc.baud(115200);
+    
+    WGraph R5Map;
+    pc.printf("R5Map created\n");
+    pc.printf("\nR5Map has %i vertices\n", R5Map.getVerts() );
+    //R5Map.printGraph();
+
+    return 0;
+}