lv6

Dependencies:   mbed

Committer:
2016US_BenjaminRamic
Date:
Sun Jun 12 13:45:41 2016 +0000
Revision:
0:ed637ab95222
lv6;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
2016US_BenjaminRamic 0:ed637ab95222 1 #include "mbed.h"
2016US_BenjaminRamic 0:ed637ab95222 2 #define dp23 P0_0
2016US_BenjaminRamic 0:ed637ab95222 3
2016US_BenjaminRamic 0:ed637ab95222 4 Serial pc(USBTX, USBRX); // tx, rx
2016US_BenjaminRamic 0:ed637ab95222 5
2016US_BenjaminRamic 0:ed637ab95222 6 AnalogIn VRx(dp11);
2016US_BenjaminRamic 0:ed637ab95222 7 AnalogIn VRy(dp10);
2016US_BenjaminRamic 0:ed637ab95222 8
2016US_BenjaminRamic 0:ed637ab95222 9 DigitalIn SW(dp9);
2016US_BenjaminRamic 0:ed637ab95222 10 Timer timer;
2016US_BenjaminRamic 0:ed637ab95222 11
2016US_BenjaminRamic 0:ed637ab95222 12 int smijer = 0; // 1 - lijevo, 3 - gore, 2 - desno, 4 - dole, 5 - centar
2016US_BenjaminRamic 0:ed637ab95222 13
2016US_BenjaminRamic 0:ed637ab95222 14 void usmjerenje(int noviSmijer)
2016US_BenjaminRamic 0:ed637ab95222 15 {
2016US_BenjaminRamic 0:ed637ab95222 16 if(noviSmijer != smijer)
2016US_BenjaminRamic 0:ed637ab95222 17 {
2016US_BenjaminRamic 0:ed637ab95222 18 smijer = noviSmijer;
2016US_BenjaminRamic 0:ed637ab95222 19 char text[300];
2016US_BenjaminRamic 0:ed637ab95222 20
2016US_BenjaminRamic 0:ed637ab95222 21 if(smijer == 1)
2016US_BenjaminRamic 0:ed637ab95222 22 {
2016US_BenjaminRamic 0:ed637ab95222 23 sprintf(text, "lijevo\n");
2016US_BenjaminRamic 0:ed637ab95222 24 pc.printf(text);
2016US_BenjaminRamic 0:ed637ab95222 25 }else if(smijer == 2)
2016US_BenjaminRamic 0:ed637ab95222 26 {
2016US_BenjaminRamic 0:ed637ab95222 27 sprintf(text, "desno\n");
2016US_BenjaminRamic 0:ed637ab95222 28 pc.printf(text);
2016US_BenjaminRamic 0:ed637ab95222 29 }else if(smijer == 3)
2016US_BenjaminRamic 0:ed637ab95222 30 {
2016US_BenjaminRamic 0:ed637ab95222 31 sprintf(text, "gore\n");
2016US_BenjaminRamic 0:ed637ab95222 32 pc.printf(text);
2016US_BenjaminRamic 0:ed637ab95222 33 }else if(smijer == 4)
2016US_BenjaminRamic 0:ed637ab95222 34 {
2016US_BenjaminRamic 0:ed637ab95222 35 sprintf(text, "dole\n");
2016US_BenjaminRamic 0:ed637ab95222 36 pc.printf(text);
2016US_BenjaminRamic 0:ed637ab95222 37 }else if(smijer == 5)
2016US_BenjaminRamic 0:ed637ab95222 38 {
2016US_BenjaminRamic 0:ed637ab95222 39 sprintf(text, "centar\n");
2016US_BenjaminRamic 0:ed637ab95222 40 pc.printf(text);
2016US_BenjaminRamic 0:ed637ab95222 41 }
2016US_BenjaminRamic 0:ed637ab95222 42 }
2016US_BenjaminRamic 0:ed637ab95222 43
2016US_BenjaminRamic 0:ed637ab95222 44 }
2016US_BenjaminRamic 0:ed637ab95222 45
2016US_BenjaminRamic 0:ed637ab95222 46 int main() {
2016US_BenjaminRamic 0:ed637ab95222 47 SW.mode(PullUp);
2016US_BenjaminRamic 0:ed637ab95222 48 timer.start();
2016US_BenjaminRamic 0:ed637ab95222 49 while (1)
2016US_BenjaminRamic 0:ed637ab95222 50 {
2016US_BenjaminRamic 0:ed637ab95222 51 if(VRx < 1.0/3.0)
2016US_BenjaminRamic 0:ed637ab95222 52 usmjerenje(1); // lijevo
2016US_BenjaminRamic 0:ed637ab95222 53 else if(VRx < 2.0/3.0)
2016US_BenjaminRamic 0:ed637ab95222 54 usmjerenje(5); // centar
2016US_BenjaminRamic 0:ed637ab95222 55 else
2016US_BenjaminRamic 0:ed637ab95222 56 usmjerenje(2); // desno
2016US_BenjaminRamic 0:ed637ab95222 57
2016US_BenjaminRamic 0:ed637ab95222 58 if(VRy < 1.0/3.0)
2016US_BenjaminRamic 0:ed637ab95222 59 usmjerenje(3); // gore
2016US_BenjaminRamic 0:ed637ab95222 60 else if(VRy < 2.0/3.0)
2016US_BenjaminRamic 0:ed637ab95222 61 usmjerenje(5); // centar
2016US_BenjaminRamic 0:ed637ab95222 62 else
2016US_BenjaminRamic 0:ed637ab95222 63 usmjerenje(4); // dole
2016US_BenjaminRamic 0:ed637ab95222 64 wait(1);
2016US_BenjaminRamic 0:ed637ab95222 65 }
2016US_BenjaminRamic 0:ed637ab95222 66 }