![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
Code to drive Team 1's robot for the 2016 R5 robotics competition.
Dependencies: mbed navigation R5_StepperDrive LongRangeSensor DistanceSensor scanner Gripper ColorSensor
r5driver.cpp
- Committer:
- j_j205
- Date:
- 2015-10-16
- Revision:
- 2:3b162e764c9d
- Parent:
- 1:1958e6db41fc
- Child:
- 3:72b652325643
File content as of revision 2:3b162e764c9d:
#include <cstdio> #include "weighted_graph.h" #include "mbed.h" Serial pc(USBTX, USBRX); int main() { pc.baud(115200); WeightedGraph testMap(6); pc.printf("testMap created\n\n"); int result; result = testMap.loadMap("testmap.txt"); if (result == 1) pc.printf("testmap.txt did not open properly\n\n"); else pc.printf("testmap.txt loaded sucessfully\n\n"); pc.printf("testMap has %i vertices\n", testMap.getVerts() ); return 0; }