This library is togle sw on/off edge and level decision. input sw level noise and chatting cancel. MDX-20 controler用
Fork of DigitalSw by
DigitalSw.cpp@6:55845c4ef887, 2016-12-11 (annotated)
- Committer:
- suupen
- Date:
- Sun Dec 11 01:28:31 2016 +0000
- Revision:
- 6:55845c4ef887
- Parent:
- 5:9198c5c0afcb
- Child:
- 7:b8d12d3d6ff0
main??????????
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
suupen | 0:45e3ec3004a6 | 1 | /** |
suupen | 0:45e3ec3004a6 | 2 | * digital Sw Library |
suupen | 0:45e3ec3004a6 | 3 | */ |
suupen | 0:45e3ec3004a6 | 4 | |
suupen | 0:45e3ec3004a6 | 5 | #include "DigitalSw.h" |
suupen | 0:45e3ec3004a6 | 6 | |
suupen | 0:45e3ec3004a6 | 7 | /** |
suupen | 0:45e3ec3004a6 | 8 | * |
suupen | 0:45e3ec3004a6 | 9 | */ |
suupen | 5:9198c5c0afcb | 10 | DigitalSw::DigitalSw(PinName sw, uint8_t pull |
suupen | 5:9198c5c0afcb | 11 | ) : _sw(sw), _pull(pull) |
suupen | 0:45e3ec3004a6 | 12 | { |
suupen | 0:45e3ec3004a6 | 13 | |
suupen | 0:45e3ec3004a6 | 14 | _onEdge = 0; |
suupen | 0:45e3ec3004a6 | 15 | _offEdge = 0; |
suupen | 0:45e3ec3004a6 | 16 | _levelNow = 1; |
suupen | 0:45e3ec3004a6 | 17 | _levelOld = 1; |
suupen | 0:45e3ec3004a6 | 18 | |
suupen | 5:9198c5c0afcb | 19 | if(_pull == 1) { |
suupen | 5:9198c5c0afcb | 20 | _sw.mode(PullUp); |
suupen | 5:9198c5c0afcb | 21 | } else { |
suupen | 5:9198c5c0afcb | 22 | _sw.mode(PullDown); |
suupen | 5:9198c5c0afcb | 23 | } |
suupen | 5:9198c5c0afcb | 24 | |
suupen | 0:45e3ec3004a6 | 25 | _sw.rise(this, &DigitalSw::swLevelUp); |
suupen | 0:45e3ec3004a6 | 26 | _sw.fall(this, &DigitalSw::swLevelDown); |
suupen | 0:45e3ec3004a6 | 27 | |
suupen | 0:45e3ec3004a6 | 28 | |
suupen | 0:45e3ec3004a6 | 29 | } |
suupen | 0:45e3ec3004a6 | 30 | |
suupen | 0:45e3ec3004a6 | 31 | void DigitalSw::reset(void) |
suupen | 0:45e3ec3004a6 | 32 | { |
suupen | 0:45e3ec3004a6 | 33 | _onEdge = 0; |
suupen | 0:45e3ec3004a6 | 34 | _offEdge = 0; |
suupen | 0:45e3ec3004a6 | 35 | _levelNow = 1; |
suupen | 0:45e3ec3004a6 | 36 | _levelOld = 1; |
suupen | 0:45e3ec3004a6 | 37 | } |
suupen | 0:45e3ec3004a6 | 38 | |
suupen | 0:45e3ec3004a6 | 39 | int16_t DigitalSw::getLevel(void) |
suupen | 0:45e3ec3004a6 | 40 | { |
suupen | 6:55845c4ef887 | 41 | if(_levelNow == 0){ |
suupen | 6:55845c4ef887 | 42 | return 1; |
suupen | 6:55845c4ef887 | 43 | } |
suupen | 6:55845c4ef887 | 44 | else{ |
suupen | 6:55845c4ef887 | 45 | return 0; |
suupen | 6:55845c4ef887 | 46 | } |
suupen | 0:45e3ec3004a6 | 47 | } |
suupen | 0:45e3ec3004a6 | 48 | |
suupen | 0:45e3ec3004a6 | 49 | int16_t DigitalSw::getOnEdge(void) |
suupen | 0:45e3ec3004a6 | 50 | { |
suupen | 0:45e3ec3004a6 | 51 | int16_t ans = _onEdge; |
suupen | 0:45e3ec3004a6 | 52 | _onEdge = 0; |
suupen | 0:45e3ec3004a6 | 53 | |
suupen | 0:45e3ec3004a6 | 54 | return ans; |
suupen | 0:45e3ec3004a6 | 55 | } |
suupen | 0:45e3ec3004a6 | 56 | |
suupen | 0:45e3ec3004a6 | 57 | int16_t DigitalSw::getOffEdge(void) |
suupen | 0:45e3ec3004a6 | 58 | { |
suupen | 0:45e3ec3004a6 | 59 | int16_t ans = _offEdge; |
suupen | 0:45e3ec3004a6 | 60 | _offEdge = 0; |
suupen | 0:45e3ec3004a6 | 61 | |
suupen | 0:45e3ec3004a6 | 62 | return ans; |
suupen | 0:45e3ec3004a6 | 63 | } |
suupen | 0:45e3ec3004a6 | 64 | |
suupen | 0:45e3ec3004a6 | 65 | |
suupen | 0:45e3ec3004a6 | 66 | |
suupen | 0:45e3ec3004a6 | 67 | void DigitalSw::swLevelUp(void) |
suupen | 0:45e3ec3004a6 | 68 | { |
suupen | 0:45e3ec3004a6 | 69 | uint8_t levelCheck = 0xaa; |
suupen | 0:45e3ec3004a6 | 70 | |
suupen | 0:45e3ec3004a6 | 71 | while((levelCheck != 0x00) && (levelCheck != 0xff)) { |
suupen | 5:9198c5c0afcb | 72 | wait_us(100); |
suupen | 0:45e3ec3004a6 | 73 | levelCheck = (levelCheck << 1) | _sw.read(); |
suupen | 0:45e3ec3004a6 | 74 | } |
suupen | 0:45e3ec3004a6 | 75 | |
suupen | 0:45e3ec3004a6 | 76 | if(levelCheck == 0xff) { |
suupen | 0:45e3ec3004a6 | 77 | _levelOld = _levelNow; |
suupen | 0:45e3ec3004a6 | 78 | _levelNow = 1; |
suupen | 0:45e3ec3004a6 | 79 | |
suupen | 0:45e3ec3004a6 | 80 | |
suupen | 0:45e3ec3004a6 | 81 | if(_levelOld == 0) { |
suupen | 0:45e3ec3004a6 | 82 | _offEdge |= 1; |
suupen | 0:45e3ec3004a6 | 83 | } |
suupen | 0:45e3ec3004a6 | 84 | } |
suupen | 0:45e3ec3004a6 | 85 | } |
suupen | 0:45e3ec3004a6 | 86 | |
suupen | 0:45e3ec3004a6 | 87 | void DigitalSw::swLevelDown(void) |
suupen | 0:45e3ec3004a6 | 88 | { |
suupen | 0:45e3ec3004a6 | 89 | uint8_t levelCheck = 0xaa; |
suupen | 0:45e3ec3004a6 | 90 | |
suupen | 0:45e3ec3004a6 | 91 | while((levelCheck != 0x00) && (levelCheck != 0xff)) { |
suupen | 5:9198c5c0afcb | 92 | wait_us(100); |
suupen | 0:45e3ec3004a6 | 93 | levelCheck = (levelCheck << 1) | _sw.read(); |
suupen | 0:45e3ec3004a6 | 94 | } |
suupen | 0:45e3ec3004a6 | 95 | |
suupen | 0:45e3ec3004a6 | 96 | if(levelCheck == 0x00) { |
suupen | 0:45e3ec3004a6 | 97 | _levelOld = _levelNow; |
suupen | 0:45e3ec3004a6 | 98 | _levelNow = 0; |
suupen | 0:45e3ec3004a6 | 99 | |
suupen | 0:45e3ec3004a6 | 100 | |
suupen | 0:45e3ec3004a6 | 101 | if(_levelOld == 1) { |
suupen | 0:45e3ec3004a6 | 102 | _onEdge |= 1; |
suupen | 0:45e3ec3004a6 | 103 | } |
suupen | 0:45e3ec3004a6 | 104 | } |
suupen | 0:45e3ec3004a6 | 105 | } |
suupen | 0:45e3ec3004a6 | 106 |