Crude navigation

Dependencies:   GPS L3GD20 LSM303DLHC mbed PID

move.h

Committer:
Spilly
Date:
2015-03-17
Revision:
4:a397b44a0fe8
Parent:
0:e79311aae7ed

File content as of revision 4:a397b44a0fe8:

//L298n connections
DigitalOut pinI1(D5);
DigitalOut pinI2(D6);
DigitalOut pinI3(D10);
DigitalOut pinI4(D11);
PwmOut ENA(D12);    //Left
PwmOut ENB(D13);    //Right

void goStop(float valueOne, float valueTwo)
{
    pinI1 = 0;
    pinI2 = 0;
    pinI3 = 0;
    pinI4 = 0;
    ENA =  valueOne;
    ENB = valueTwo;
}

void goForward(float valueOne, float valueTwo)
{
    pinI1 = 1;
    pinI2 = 0;
    pinI3 = 0;
    pinI4 = 1;
    ENA =  valueOne;
    ENB = valueTwo;
}

void goBackward(float valueOne, float valueTwo)
{
    pinI1 = 0;
    pinI2 = 1;
    pinI3 = 1;
    pinI4 = 0;
    ENA =  valueOne;
    ENB = valueTwo;
}

void goLeft(float valueOne, float valueTwo)
{
    pinI1 = 0;
    pinI2 = 1;
    pinI3 = 0;
    pinI4 = 1;
    ENA =  valueOne;
    ENB = valueTwo;
}

void goRight(float valueOne, float valueTwo)
{
    pinI1 = 1;
    pinI2 = 0;
    pinI3 = 1;
    pinI4 = 0;
    ENA =  valueOne;
    ENB = valueTwo;
}