#include "mbed.h"
#define dp23 P0_0

AnalogIn desnolijevo(dp11);
AnalogIn goredole(dp10);
DigitalIn taster(dp9);
Serial terminal(USBTX, USBRX);
bool lijevo=0, desno=0, gore=0, dole=0, centarx=0;
int granica1=0.3,granica2=0.3,granica3=0.7,granica4=0.7;
char lijevos[10]="Lijevo\n", desnos[10]="Desno\n", gores[10]="Gore\n", doles[10]="Dole\n", centars[10]="Centar\n";

void xOsa (float vrijednost, float vrijednost2) {
    if (vrijednost<granica1 && lijevo==0) {
        granica1+=0.1;
        lijevo=1;
        desno=0;
        centarx=0;
        terminal.printf("\r\n");
        terminal.printf(lijevos);

    }
    else if (vrijednost>granica1 && vrijednost<granica3 && vrijednost2>granica2 && vrijednost2<granica4  && centarx==0) {
        granica1-=0.1;
        granica2-=0.1;
        granica3+=0.1;
        granica4+=0.1;
        centarx=1;
        lijevo=0;
        desno=0;
        gore=0;
        dole=0;
        terminal.printf("\r\n");
        terminal.printf(centars);
    }
    else if (vrijednost>granica3 && desno==0) {
        granica3-=0.1;
        desno=1;
        lijevo=0;
        centarx=0;
        terminal.printf("\r\n");
        terminal.printf(desnos);

    }
    if (vrijednost2<granica2 && gore==0) {
        granica2+=0.1;
        gore=1;
        dole=0;
        centarx=0;
        terminal.printf("\r\n");
        terminal.printf(gores);

    }
    else if (vrijednost2>granica4 && dole==0) {
        granica4-=0.1;
        dole=1;
        gore=0;
        centarx=0;
        terminal.printf("\r\n");
        terminal.printf(doles);

    }
}
int main() {
    taster.mode(PullUp);
    while(1) {
        float x=0, y=0;
        x=desnolijevo.read();
        y=goredole.read();
        xOsa(x, y);
        wait (0.1);
    }
}