SChuleEE 1
/
mbed_linie
wr
main.cpp@0:a8e2201d9c4d, 2016-06-14 (annotated)
- Committer:
- manuelschnider
- Date:
- Tue Jun 14 11:15:13 2016 +0000
- Revision:
- 0:a8e2201d9c4d
zz
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
manuelschnider | 0:a8e2201d9c4d | 1 | #include "mbed.h" |
manuelschnider | 0:a8e2201d9c4d | 2 | #include "Serial_HL.h" |
manuelschnider | 0:a8e2201d9c4d | 3 | #include "Bertl14.h" |
manuelschnider | 0:a8e2201d9c4d | 4 | #include "BertlObjects.h" |
manuelschnider | 0:a8e2201d9c4d | 5 | |
manuelschnider | 0:a8e2201d9c4d | 6 | // main=2^0 LS ENC 2^2 |
manuelschnider | 0:a8e2201d9c4d | 7 | BusOut boardPow(p30, P1_6, P1_7); |
manuelschnider | 0:a8e2201d9c4d | 8 | AnalogInHL ls1(p18), ls2(p16), ls3(p20), ls4(p19),ls5(p17); |
manuelschnider | 0:a8e2201d9c4d | 9 | |
manuelschnider | 0:a8e2201d9c4d | 10 | |
manuelschnider | 0:a8e2201d9c4d | 11 | int main(void) |
manuelschnider | 0:a8e2201d9c4d | 12 | { |
manuelschnider | 0:a8e2201d9c4d | 13 | boardPow=3; |
manuelschnider | 0:a8e2201d9c4d | 14 | |
manuelschnider | 0:a8e2201d9c4d | 15 | pex.WaitUntilFrontButtonPressed(); |
manuelschnider | 0:a8e2201d9c4d | 16 | mL.SetPow(0.3); mR.SetPow(0.3); |
manuelschnider | 0:a8e2201d9c4d | 17 | |
manuelschnider | 0:a8e2201d9c4d | 18 | while(1) |
manuelschnider | 0:a8e2201d9c4d | 19 | { |
manuelschnider | 0:a8e2201d9c4d | 20 | if(ls1.Read()>600&&ls5.Read()<600) |
manuelschnider | 0:a8e2201d9c4d | 21 | { |
manuelschnider | 0:a8e2201d9c4d | 22 | mL.SetPow(-0.3); mR.SetPow(0.3); |
manuelschnider | 0:a8e2201d9c4d | 23 | } |
manuelschnider | 0:a8e2201d9c4d | 24 | if(ls5.Read()>600&&ls1.Read()<600) |
manuelschnider | 0:a8e2201d9c4d | 25 | { |
manuelschnider | 0:a8e2201d9c4d | 26 | mL.SetPow(0.3); mR.SetPow(-0.3); |
manuelschnider | 0:a8e2201d9c4d | 27 | } |
manuelschnider | 0:a8e2201d9c4d | 28 | if(ls5.Read()<600&&ls1.Read()<600&&ls3.Read()>600) |
manuelschnider | 0:a8e2201d9c4d | 29 | { |
manuelschnider | 0:a8e2201d9c4d | 30 | mL.SetPow(0.3); mR.SetPow(0.3); |
manuelschnider | 0:a8e2201d9c4d | 31 | } |
manuelschnider | 0:a8e2201d9c4d | 32 | if(ls5.Read()<400&&ls1.Read()<400&&ls3.Read()<400&&ls2.Read()<400&&ls4.Read()<500) |
manuelschnider | 0:a8e2201d9c4d | 33 | { |
manuelschnider | 0:a8e2201d9c4d | 34 | wait(0.07); |
manuelschnider | 0:a8e2201d9c4d | 35 | if(ls5.Read()<400&&ls1.Read()<400&&ls3.Read()<400&&ls2.Read()<400&&ls4.Read()<500) |
manuelschnider | 0:a8e2201d9c4d | 36 | { |
manuelschnider | 0:a8e2201d9c4d | 37 | mL.SetPow(0); mR.SetPow(0); |
manuelschnider | 0:a8e2201d9c4d | 38 | wait(2); |
manuelschnider | 0:a8e2201d9c4d | 39 | mL.SetPow(-0.3); mR.SetPow(0.3); |
manuelschnider | 0:a8e2201d9c4d | 40 | wait(0.7); |
manuelschnider | 0:a8e2201d9c4d | 41 | } |
manuelschnider | 0:a8e2201d9c4d | 42 | } |
manuelschnider | 0:a8e2201d9c4d | 43 | } |
manuelschnider | 0:a8e2201d9c4d | 44 | } |