Martin Sturm
/
Project
strings.cpp@0:2fab16867d73, 2011-11-30 (annotated)
- Committer:
- XkLi
- Date:
- Wed Nov 30 18:06:50 2011 +0000
- Revision:
- 0:2fab16867d73
- Child:
- 1:44f0b9d5883b
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
XkLi | 0:2fab16867d73 | 1 | #include "strings.h" |
XkLi | 0:2fab16867d73 | 2 | |
XkLi | 0:2fab16867d73 | 3 | int tempEL = 40; |
XkLi | 0:2fab16867d73 | 4 | int tempA = 40; |
XkLi | 0:2fab16867d73 | 5 | int tempD = 40; |
XkLi | 0:2fab16867d73 | 6 | int tempG = 40; |
XkLi | 0:2fab16867d73 | 7 | int tempB = 40; |
XkLi | 0:2fab16867d73 | 8 | int tempEH = 40; |
XkLi | 0:2fab16867d73 | 9 | |
XkLi | 0:2fab16867d73 | 10 | //inputs for string detection |
XkLi | 0:2fab16867d73 | 11 | AnalogIn EStringL(p20); |
XkLi | 0:2fab16867d73 | 12 | AnalogIn AString(p19); |
XkLi | 0:2fab16867d73 | 13 | AnalogIn DString(p18); |
XkLi | 0:2fab16867d73 | 14 | AnalogIn GString(p17); |
XkLi | 0:2fab16867d73 | 15 | AnalogIn BString(p16); |
XkLi | 0:2fab16867d73 | 16 | AnalogIn EStringH(p15); |
XkLi | 0:2fab16867d73 | 17 | |
XkLi | 0:2fab16867d73 | 18 | //detection range |
XkLi | 0:2fab16867d73 | 19 | int bufferVal = 15; |
XkLi | 0:2fab16867d73 | 20 | |
XkLi | 0:2fab16867d73 | 21 | |
XkLi | 0:2fab16867d73 | 22 | |
XkLi | 0:2fab16867d73 | 23 | char output = 0; |
XkLi | 0:2fab16867d73 | 24 | |
XkLi | 0:2fab16867d73 | 25 | char Strings() { |
XkLi | 0:2fab16867d73 | 26 | |
XkLi | 0:2fab16867d73 | 27 | |
XkLi | 0:2fab16867d73 | 28 | |
XkLi | 0:2fab16867d73 | 29 | if(abs(EStringL-tempEL) > bufferVal) { |
XkLi | 0:2fab16867d73 | 30 | output = (output|0x01); |
XkLi | 0:2fab16867d73 | 31 | }else { |
XkLi | 0:2fab16867d73 | 32 | output = (output&0xFE); |
XkLi | 0:2fab16867d73 | 33 | } |
XkLi | 0:2fab16867d73 | 34 | if(abs(AString-tempA) > bufferVal) { |
XkLi | 0:2fab16867d73 | 35 | output = (output|0x02); |
XkLi | 0:2fab16867d73 | 36 | }else { |
XkLi | 0:2fab16867d73 | 37 | output = (output&0xFD); |
XkLi | 0:2fab16867d73 | 38 | } |
XkLi | 0:2fab16867d73 | 39 | if(abs(DString-tempD) > bufferVal) { |
XkLi | 0:2fab16867d73 | 40 | output = (output|0x04); |
XkLi | 0:2fab16867d73 | 41 | }else { |
XkLi | 0:2fab16867d73 | 42 | output = (output&0xFB); |
XkLi | 0:2fab16867d73 | 43 | } |
XkLi | 0:2fab16867d73 | 44 | if(abs(GString-tempG) > bufferVal) { |
XkLi | 0:2fab16867d73 | 45 | output = (output|0x08); |
XkLi | 0:2fab16867d73 | 46 | }else { |
XkLi | 0:2fab16867d73 | 47 | output = (output&0xF7); |
XkLi | 0:2fab16867d73 | 48 | } |
XkLi | 0:2fab16867d73 | 49 | if(abs(BString-tempB) > bufferVal) { |
XkLi | 0:2fab16867d73 | 50 | output = (output|0x10); |
XkLi | 0:2fab16867d73 | 51 | }else { |
XkLi | 0:2fab16867d73 | 52 | output = (output&0xEF); |
XkLi | 0:2fab16867d73 | 53 | } |
XkLi | 0:2fab16867d73 | 54 | if(abs(EStringH-tempEH) > bufferVal) { |
XkLi | 0:2fab16867d73 | 55 | output = (output|0x20); |
XkLi | 0:2fab16867d73 | 56 | }else { |
XkLi | 0:2fab16867d73 | 57 | output = (output&0xDF); |
XkLi | 0:2fab16867d73 | 58 | } |
XkLi | 0:2fab16867d73 | 59 | wait(0.02); |
XkLi | 0:2fab16867d73 | 60 | |
XkLi | 0:2fab16867d73 | 61 | |
XkLi | 0:2fab16867d73 | 62 | return output; |
XkLi | 0:2fab16867d73 | 63 | } |