wr

Dependencies:   BertlLib mbed

Committer:
manuelschnider
Date:
Tue Jun 14 11:15:13 2016 +0000
Revision:
0:a8e2201d9c4d
zz

Who changed what in which revision?

UserRevisionLine numberNew 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 }