|
4 | 4 | // VERSION: 0.2.1
|
5 | 5 | // PURPOSE: Fast ShiftIn for 74HC165 register, AVR optimized
|
6 | 6 | // DATE: 2013-09-29
|
7 |
| -// URL: https://github.com/RobTillaart/FastShiftIn.git |
| 7 | +// URL: https://github.com/RobTillaart/FastShiftIn |
8 | 8 | //
|
9 | 9 |
|
10 | 10 | #include "FastShiftIn.h"
|
11 | 11 |
|
12 | 12 | FastShiftIn::FastShiftIn(const uint8_t datapin, const uint8_t clockpin, const uint8_t bitOrder)
|
13 | 13 | {
|
14 |
| - _bitorder = bitOrder; |
| 14 | + _bitorder = bitOrder; |
15 | 15 |
|
16 |
| - pinMode(datapin, INPUT); |
17 |
| - pinMode(clockpin, OUTPUT); |
| 16 | + pinMode(datapin, INPUT); |
| 17 | + pinMode(clockpin, OUTPUT); |
18 | 18 |
|
19 | 19 | #if defined(ARDUINO_ARCH_AVR) || defined(ARDUINO_ARCH_MEGAAVR)
|
20 | 20 |
|
21 |
| - // uint8_t _datatimer = digitalPinToTimer(datapin); |
22 |
| - // if (_datatimer != NOT_ON_TIMER) turnOffPWM(_datatimer); TODO |
23 |
| - uint8_t _dataport = digitalPinToPort(datapin); |
24 |
| - _datain = portOutputRegister(_dataport); |
25 |
| - _databit = digitalPinToBitMask(datapin); |
| 21 | + // uint8_t _datatimer = digitalPinToTimer(datapin); |
| 22 | + // if (_datatimer != NOT_ON_TIMER) turnOffPWM(_datatimer); TODO |
| 23 | + uint8_t _dataport = digitalPinToPort(datapin); |
| 24 | + _datain = portOutputRegister(_dataport); |
| 25 | + _databit = digitalPinToBitMask(datapin); |
26 | 26 |
|
27 |
| - // uint8_t _clocktimer = digitalPinToTimer(clockpin); |
28 |
| - // if (_clocktimer != NOT_ON_TIMER) turnOffPWM(_clocktimer); |
29 |
| - uint8_t _clockport = digitalPinToPort(clockpin); |
30 |
| - _clockin = portOutputRegister(_clockport); |
31 |
| - _clockbit = digitalPinToBitMask(clockpin); |
| 27 | + // uint8_t _clocktimer = digitalPinToTimer(clockpin); |
| 28 | + // if (_clocktimer != NOT_ON_TIMER) turnOffPWM(_clocktimer); |
| 29 | + uint8_t _clockport = digitalPinToPort(clockpin); |
| 30 | + _clockin = portOutputRegister(_clockport); |
| 31 | + _clockbit = digitalPinToBitMask(clockpin); |
32 | 32 |
|
33 | 33 | #else // reference implementation
|
34 | 34 |
|
35 |
| - // reuse these vars as pin to save some space |
36 |
| - _databit = datapin; |
37 |
| - _clockbit = clockpin; |
| 35 | + // reuse these vars as pin to save some space |
| 36 | + _databit = datapin; |
| 37 | + _clockbit = clockpin; |
38 | 38 |
|
39 | 39 | #endif
|
40 | 40 | }
|
41 | 41 |
|
42 | 42 | int FastShiftIn::read()
|
43 | 43 | {
|
44 |
| - if (_bitorder == LSBFIRST) |
45 |
| - { |
46 |
| - return readLSBFIRST(); |
47 |
| - } |
48 |
| - return readMSBFIRST(); |
| 44 | + if (_bitorder == LSBFIRST) |
| 45 | + { |
| 46 | + return readLSBFIRST(); |
| 47 | + } |
| 48 | + return readMSBFIRST(); |
49 | 49 | }
|
50 | 50 |
|
51 | 51 | #if defined(ARDUINO_ARCH_AVR) || defined(ARDUINO_ARCH_MEGAAVR)
|
52 | 52 |
|
53 | 53 | int FastShiftIn::readLSBFIRST()
|
54 | 54 | {
|
55 |
| - uint8_t value = 0; |
56 |
| - uint8_t cbmask1 = _clockbit; |
57 |
| - uint8_t cbmask2 = ~_clockbit; |
58 |
| - uint8_t dbmask = _databit; |
59 |
| - |
60 |
| - for (uint8_t m = 1; m > 0; m <<= 1) |
61 |
| - { |
62 |
| - uint8_t oldSREG = SREG; |
63 |
| - cli(); |
64 |
| - *_clockin |= cbmask1; |
65 |
| - if ((*_datain & dbmask) > 0) |
66 |
| - { |
67 |
| - value |= m; |
68 |
| - } |
69 |
| - *_clockin &= cbmask2; |
70 |
| - SREG = oldSREG; |
71 |
| - } |
72 |
| - _value = value; |
73 |
| - return _value; |
| 55 | + uint8_t value = 0; |
| 56 | + uint8_t cbmask1 = _clockbit; |
| 57 | + uint8_t cbmask2 = ~_clockbit; |
| 58 | + uint8_t dbmask = _databit; |
| 59 | + |
| 60 | + for (uint8_t m = 1; m > 0; m <<= 1) |
| 61 | + { |
| 62 | + uint8_t oldSREG = SREG; |
| 63 | + cli(); |
| 64 | + *_clockin |= cbmask1; |
| 65 | + if ((*_datain & dbmask) > 0) |
| 66 | + { |
| 67 | + value |= m; |
| 68 | + } |
| 69 | + *_clockin &= cbmask2; |
| 70 | + SREG = oldSREG; |
| 71 | + } |
| 72 | + _value = value; |
| 73 | + return _value; |
74 | 74 | }
|
75 | 75 |
|
76 | 76 | int FastShiftIn::readMSBFIRST()
|
77 | 77 | {
|
78 |
| - uint8_t value = 0; |
79 |
| - uint8_t cbmask1 = _clockbit; |
80 |
| - uint8_t cbmask2 = ~cbmask1; |
81 |
| - uint8_t dbmask = _databit; |
82 |
| - |
83 |
| - for (uint8_t n = 128; n > 0; n >>= 1) |
84 |
| - { |
85 |
| - uint8_t oldSREG = SREG; |
86 |
| - cli(); |
87 |
| - *_clockin |= cbmask1; |
88 |
| - |
89 |
| - if ((*_datain & dbmask) > 0) |
90 |
| - { |
91 |
| - value |= n; |
92 |
| - } |
93 |
| - *_clockin &= cbmask2; |
94 |
| - SREG = oldSREG; |
95 |
| - } |
96 |
| - _value = value; |
97 |
| - return _value; |
| 78 | + uint8_t value = 0; |
| 79 | + uint8_t cbmask1 = _clockbit; |
| 80 | + uint8_t cbmask2 = ~cbmask1; |
| 81 | + uint8_t dbmask = _databit; |
| 82 | + |
| 83 | + for (uint8_t n = 128; n > 0; n >>= 1) |
| 84 | + { |
| 85 | + uint8_t oldSREG = SREG; |
| 86 | + cli(); |
| 87 | + *_clockin |= cbmask1; |
| 88 | + if ((*_datain & dbmask) > 0) |
| 89 | + { |
| 90 | + value |= n; |
| 91 | + } |
| 92 | + *_clockin &= cbmask2; |
| 93 | + SREG = oldSREG; |
| 94 | + } |
| 95 | + _value = value; |
| 96 | + return _value; |
98 | 97 | }
|
99 | 98 |
|
100 |
| -#else // reference implementation // note this has no cli() |
| 99 | +#else // reference implementation - note this has no cli() |
101 | 100 |
|
102 | 101 | int FastShiftIn::readLSBFIRST()
|
103 | 102 | {
|
104 |
| - return shiftIn(_databit, _clockbit, LSBFIRST); |
| 103 | + return shiftIn(_databit, _clockbit, LSBFIRST); |
105 | 104 | }
|
106 | 105 |
|
107 | 106 | int FastShiftIn::readMSBFIRST()
|
108 | 107 | {
|
109 |
| - return shiftIn(_databit, _clockbit, MSBFIRST); |
| 108 | + return shiftIn(_databit, _clockbit, MSBFIRST); |
110 | 109 | }
|
111 | 110 |
|
112 | 111 | #endif
|
|
0 commit comments