File content as of revision 5:1afe17a20a5b:

#include "mbed.h"
#include "include/EngineDriver.h"
#include "include/SerialPrompt.h"
#include "include/SR04.h"
Serial pc(USBTX, USBRX);

int initDrivingUnit(int testLoops)
{
        pc.printf("Testing engines...\n\r");
        enableAll();
        int i = 0;
        while(i < testLoops)
        {
            testEngines();
            applyStates();
            i++;
        }
    resetEngines();
    return 0;
}
int main()
{
    if(initDrivingUnit(1) == 0)
    {
        pc.printf("Ready to accept commands.\n\r Netrunner will start moving in 1 second");
        displayPrompt(&pc);
    }
    inState[0] = 0;
    inState[1] = 1;
    inState[2] = 1;
    inState[3] = 0;
    wait(1);
    while (true) 
    {
        int action = getMenuInput(&pc);
        float dist = getDistance(0);
        displayMessage(distMsg, &pc, dist);
        if(dist <= 10)
        {
            resetEngines();
        }else
        {
            forward();
        }
        applyStates();
    }
}