Serpentine / Mbed 2 deprecated foodcontroller

Tilt steering control

Dependencies:   MMA8451Q mbed

main.cpp

Committer:
pemb4660
Date:
2016-06-07
Revision:
0:8e22f474256a

File content as of revision 0:8e22f474256a:

#include "mbed.h"
#include "MMA8451Q.h"

#define MMA8451_I2C_ADDRESS (0x1d<<1)

int main()
{
    MMA8451Q acc(PTE25, PTE24, MMA8451_I2C_ADDRESS);
    PwmOut rled(LED_RED);
    PwmOut gled(LED_GREEN);
    bool right;

    while (1) {

        if(acc.getAccX() <= 0.1 && acc.getAccX() >= -0.1) {
            if (right == true) {
                rled = 0;
            } else
                gled = 0;
        }

        if (acc.getAccX() > 0.1) {
            rled = 0;
            gled = 1;
            right = true;
        }

        if (acc.getAccX() < -0.1) {
            rled = 1;
            gled = 0;
            right = false;
        }
        wait(0.1);
    }

}