Benjamin Ramić
/
LV6_Grupa8_Tim10_Zadatak1
lv6
main.cpp@0:ed637ab95222, 2016-06-12 (annotated)
- Committer:
- 2016US_BenjaminRamic
- Date:
- Sun Jun 12 13:45:41 2016 +0000
- Revision:
- 0:ed637ab95222
lv6;
Who changed what in which revision?
User | Revision | Line number | New 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 | } |