Damian Herman / Mbed 2 deprecated NetrunnerMain

Dependencies:   mbed

main.cpp

Committer:
overkiller
Date:
2015-08-15
Revision:
6:9eb153e1d472
Parent:
5:1afe17a20a5b
Child:
7:baec885e57db

File content as of revision 6:9eb153e1d472:

#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);
        if(actualDistance <= 10)
        {
            resetEngines();
        }else
        {
            forward();
        }
        applyStates();
    }
}