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