Texas State IEEE / Mbed 2 deprecated R5 2016 Robotics Team 1

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-15
Revision:
1:1958e6db41fc
Parent:
0:a3c39d3359ac
Child:
2:3b162e764c9d

File content as of revision 1:1958e6db41fc:

#include <cstdio>
#include "navigation.h"
#include "weighted_graph.h"

Serial pc(USBTX, USBRX);

int main()
{
    pc.baud(115200);
    
    WeightedGraph testMap;
    pc.printf("testMap created\n\n");

    int result;
    result = testMap.loadMap("testmap.dat");

    if (result == 1)
        pc.printf("testmap.dat did not open properly\n\n");

    else
        pc.printf("testmap.dat loaded sucessfully\n\n");



    pc.printf("testMap has %i vertices\n", testMap.getVerts() );

    return 0;
}