Pop lock n drop it

Dependencies:   m3pi_ng mbed

linepos.cpp

Committer:
vsal
Date:
2014-06-02
Revision:
11:af3d70d153bb
Parent:
7:d0c19729e7fd

File content as of revision 11:af3d70d153bb:

#include "mbed.h"
#include "m3pi_ng.h"
#include "DigitalIn.h"


m3pi hue;



float myLine(void)
{
    int sensors[5];
    hue.calibrated_sensor(sensors);
    float leftSen, rightSen, midSen;
    leftSen = sensors[1] / 1000;
    rightSen = sensors[3] / 1000;
    midSen = sensors[2] / 1000;
    return rightSen - leftSen;
}

int linepos()
{
    while(1)
    {
        hue.printf("%f", myLine());
    }
 
}