tim010 tim010 / Mbed 2 deprecated Grupa7-GlavniprojekatRadar

Muris Nuhodžić Edis Kunić

Dependencies:   mbed sMotor

main.cpp@0:6c2fbb3ed2b9, 2014-06-05 (annotated)

Committer:
tim010
Date:
Thu Jun 05 17:56:50 2014 +0000
Revision:
0:6c2fbb3ed2b9
MMuris Nuhod?i? ; Edis Kuni?

Who changed what in which revision?

UserRevisionLine numberNew contents of line
tim010 0:6c2fbb3ed2b9 1 #include "mbed.h"
tim010 0:6c2fbb3ed2b9 2 #include "sMotor.h"
tim010 0:6c2fbb3ed2b9 3 AnalogIn IR(dp4);
tim010 0:6c2fbb3ed2b9 4
tim010 0:6c2fbb3ed2b9 5 Serial pc(USBTX, USBRX);
tim010 0:6c2fbb3ed2b9 6 sMotor motor(dp9, dp10, dp11, dp13); // creates new stepper motor: IN1, IN2, IN3, IN4
tim010 0:6c2fbb3ed2b9 7
tim010 0:6c2fbb3ed2b9 8 int step_speed = 1200 ; // set default motor speed
tim010 0:6c2fbb3ed2b9 9 int numstep = 512/36; // defines full turn of 360 degree
tim010 0:6c2fbb3ed2b9 10 int direction = 0; //0 for right, 1 for left
tim010 0:6c2fbb3ed2b9 11 int brojkoraka = 36 ;
tim010 0:6c2fbb3ed2b9 12 bool p=true;
tim010 0:6c2fbb3ed2b9 13 /*int distanca[]={ 10 , 15 , 20 ,25 , 30 , 35 , 40 , 45 , 50 , 55 , 60 , 65 , 70 , 75 , 80 , 85 , 90};
tim010 0:6c2fbb3ed2b9 14 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 };*/
tim010 0:6c2fbb3ed2b9 15
tim010 0:6c2fbb3ed2b9 16 int provjeri(float n){
tim010 0:6c2fbb3ed2b9 17 if(n<0.21)return 200;
tim010 0:6c2fbb3ed2b9 18 if(n>0.89)return 1;
tim010 0:6c2fbb3ed2b9 19 if(n<=0.89 && n>0.87) return 10;
tim010 0:6c2fbb3ed2b9 20 if(n<=0.87 && n>0.81) return 15;
tim010 0:6c2fbb3ed2b9 21 if(n<=0.81 && n>0.71) return 20;
tim010 0:6c2fbb3ed2b9 22 if(n<=0.71 && n>0.62) return 25;
tim010 0:6c2fbb3ed2b9 23 if(n<=0.62 && n>0.54) return 30;
tim010 0:6c2fbb3ed2b9 24 if(n<=0.54 && n>0.47) return 35;
tim010 0:6c2fbb3ed2b9 25 if(n<=0.47 && n>0.43) return 40;
tim010 0:6c2fbb3ed2b9 26 if(n<=0.43 && n>0.39) return 45;
tim010 0:6c2fbb3ed2b9 27 if(n<=0.39 && n>0.34) return 50;
tim010 0:6c2fbb3ed2b9 28 if(n<=0.34 && n>0.32) return 55;
tim010 0:6c2fbb3ed2b9 29 if(n<=0.32 && n>0.29) return 60;
tim010 0:6c2fbb3ed2b9 30 if(n<=0.29 && n>0.28) return 65;
tim010 0:6c2fbb3ed2b9 31 if(n<=0.28 && n>0.25) return 70;
tim010 0:6c2fbb3ed2b9 32 if(n<=0.25 && n>0.24) return 75;
tim010 0:6c2fbb3ed2b9 33 if(n<=0.24 && n>0.23) return 80;
tim010 0:6c2fbb3ed2b9 34 if(n<=0.23 && n>0.21) return 85;
tim010 0:6c2fbb3ed2b9 35 }
tim010 0:6c2fbb3ed2b9 36 int main() {
tim010 0:6c2fbb3ed2b9 37 float a;
tim010 0:6c2fbb3ed2b9 38
tim010 0:6c2fbb3ed2b9 39 int brojac=0;
tim010 0:6c2fbb3ed2b9 40 while(1)
tim010 0:6c2fbb3ed2b9 41
tim010 0:6c2fbb3ed2b9 42 {
tim010 0:6c2fbb3ed2b9 43 motor.step(numstep, direction, step_speed);
tim010 0:6c2fbb3ed2b9 44 a = IR;
tim010 0:6c2fbb3ed2b9 45 brojac++;
tim010 0:6c2fbb3ed2b9 46 if(brojac==36){brojac=0;direction=1-direction;}
tim010 0:6c2fbb3ed2b9 47 int b=provjeri(a);
tim010 0:6c2fbb3ed2b9 48 pc.printf("%d\n",b );
tim010 0:6c2fbb3ed2b9 49 wait(1);
tim010 0:6c2fbb3ed2b9 50 }
tim010 0:6c2fbb3ed2b9 51
tim010 0:6c2fbb3ed2b9 52
tim010 0:6c2fbb3ed2b9 53 }