File content as of revision 0:8cc3dba86d01:

#include "mbed.h"
//#include "sMotor.h"
AnalogIn IR(dp4);
 
Serial pc(USBTX, USBRX);/*
sMotor motor(dp13,dp11,dp10,dp9); 
 
//int brzina = 1200 ; 
int brojkoraka = 360 ; 
bool p=true;
 */int distanca[]={      10   ,  15 , 20   ,25   , 30   ,   35  , 40  ,    45   ,   50   , 55    ,  60  ,  65 ,  70   ,  75  , 80  ,    85   ,   90};
 float naponi[]={      0.89, 0.87, 0.81,  0.71 , 0.62 , 0.54,  0.47,  0.43,    0.39 ,  0.34,   0.32,   0.29,   0.28  , 0.25, 0.24,  0.23,            0.21 };

int provjeri(float n){
    if(n<0.21)return -1;
    if(n>0.89)return -1;
    
    if(n<=0.89 && n>0.87) return 10;
    if(n<=0.87 && n>0.81) return 15;
    if(n<=0.81 && n>0.71) return 20;
    if(n<=0.71 && n>0.62) return 25;
    if(n<=0.62 && n>0.54) return 30;
    if(n<=0.54 && n>0.47) return 35;
    if(n<=0.47 && n>0.43) return 40;
    if(n<=0.43 && n>0.39) return 45;
    if(n<=0.39 && n>0.34) return 50;
    if(n<=0.34 && n>0.32) return 55;
    if(n<=0.32 && n>0.29) return 60;
    if(n<=0.29 && n>0.28) return 65;
    if(n<=0.28 && n>0.25) return 70;
    if(n<=0.25 && n>0.24) return 75;
    if(n<=0.24 && n>0.23) return 80;
    if(n<=0.23 && n>0.21) return 85;
    }
int main() {
    float a;
    while(1)
    {a = IR;
        int b=provjeri(a);
        
        pc.printf("%d\n", b);
        wait(1);
    }
    
    
}