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-14
Revision:
0:a3c39d3359ac
Child:
1:1958e6db41fc

File content as of revision 0:a3c39d3359ac:

#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;
}