File content as of revision 7:baec885e57db:

#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();
    enableAllButton.mode(PullDown);
    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);
//    }
//    wait(1);
    while (true) 
    {
   //     checkEnableButtonState();
      //  displayMessage("clicks: %f", &pc, buttonClicks);
   //     int action = getMenuInput(&pc);
        actualDistance = getDistance(0);
       pc.printf("test\n");
       pc.printf("%d", actualDistance);
        wait(1);
     //   if(actualDistance <= 10)
//        {
//            resetEngines();
//        }else
//        {
//            forward();
//        }
    //    applyStates();
    }
}