|
12 | 12 | #include "FastShiftOut.h" |
13 | 13 |
|
14 | 14 |
|
15 | | -FastShiftOut::FastShiftOut(const uint8_t datapin, const uint8_t clockpin, const uint8_t bitOrder) |
| 15 | +FastShiftOut::FastShiftOut(uint8_t dataOut, uint8_t clockPin, uint8_t bitOrder) |
16 | 16 | { |
17 | | - _bitorder = bitOrder; |
18 | | - pinMode(datapin, OUTPUT); |
19 | | - pinMode(clockpin, OUTPUT); |
| 17 | + _bitOrder = bitOrder; |
| 18 | + pinMode(dataOut, OUTPUT); |
| 19 | + pinMode(clockPin, OUTPUT); |
20 | 20 | // https://www.arduino.cc/reference/en/language/functions/advanced-io/shiftout/ |
21 | | - digitalWrite(clockpin, LOW); // assume rising pulses from clock |
| 21 | + digitalWrite(clockPin, LOW); // assume rising pulses from clock |
22 | 22 |
|
23 | 23 | #if defined(ARDUINO_ARCH_AVR) || defined(ARDUINO_ARCH_MEGAAVR) |
24 | 24 |
|
25 | | - // uint8_t _datatimer = digitalPinToTimer(datapin); |
26 | | - // if (_datatimer != NOT_ON_TIMER) turnOffPWM(_datatimer); TODO |
27 | | - uint8_t _dataport = digitalPinToPort(datapin); |
28 | | - _dataout = portOutputRegister(_dataport); |
29 | | - _databit = digitalPinToBitMask(datapin); |
| 25 | + uint8_t _port = digitalPinToPort(dataOut); |
| 26 | + _dataOutRegister = portOutputRegister(_port); |
| 27 | + _dataOutBit = digitalPinToBitMask(dataOut); |
30 | 28 |
|
31 | | - // uint8_t _clocktimer = digitalPinToTimer(clockpin); |
32 | | - // if (_clocktimer != NOT_ON_TIMER) turnOffPWM(_clocktimer); |
33 | | - uint8_t _clockport = digitalPinToPort(clockpin); |
34 | | - _clockout = portOutputRegister(_clockport); |
35 | | - _clockbit = digitalPinToBitMask(clockpin); |
| 29 | + _port = digitalPinToPort(clockPin); |
| 30 | + _clockRegister = portOutputRegister(_port); |
| 31 | + _clockBit = digitalPinToBitMask(clockPin); |
36 | 32 |
|
37 | 33 | #else // reference implementation |
38 | 34 |
|
39 | | - // reuse these variables as pin to save some space |
40 | | - _databit = datapin; |
41 | | - _clockbit = clockpin; |
| 35 | + _dataPinOut = dataOut; |
| 36 | + _clockPin = clockPin; |
42 | 37 |
|
43 | 38 | #endif |
44 | 39 | } |
45 | 40 |
|
46 | 41 |
|
47 | | -size_t FastShiftOut::write(const uint8_t data) |
| 42 | +size_t FastShiftOut::write(uint8_t data) |
48 | 43 | { |
49 | 44 | _value = data; |
50 | | - if (_bitorder == LSBFIRST) |
| 45 | + if (_bitOrder == LSBFIRST) |
51 | 46 | { |
52 | 47 | return writeLSBFIRST(data); |
53 | 48 | } |
54 | 49 | return writeMSBFIRST(data); |
55 | 50 | } |
56 | 51 |
|
57 | 52 |
|
58 | | -size_t FastShiftOut::writeLSBFIRST(const uint8_t data) |
| 53 | +size_t FastShiftOut::writeLSBFIRST(uint8_t data) |
59 | 54 | { |
| 55 | + uint8_t value = data; |
| 56 | + _value = value; |
| 57 | + |
60 | 58 | #if defined(ARDUINO_ARCH_AVR) || defined(ARDUINO_ARCH_MEGAAVR) |
61 | | - uint8_t cbmask1 = _clockbit; |
62 | | - uint8_t cbmask2 = ~_clockbit; |
63 | | - uint8_t dbmask1 = _databit; |
64 | | - uint8_t dbmask2 = ~_databit; |
65 | 59 |
|
66 | | - for (uint8_t i = 0, m = 1; i < 8; i++) |
| 60 | + uint8_t cbmask1 = _clockBit; |
| 61 | + uint8_t cbmask2 = ~_clockBit; |
| 62 | + uint8_t outmask1 = _dataOutBit; |
| 63 | + uint8_t outmask2 = ~_dataOutBit; |
| 64 | + |
| 65 | + for (uint8_t m = 1; m > 0; m <<= 1) |
67 | 66 | { |
68 | 67 | uint8_t oldSREG = SREG; |
69 | 68 | noInterrupts(); |
70 | | - if ((data & m) == 0) *_dataout &= dbmask2; |
71 | | - else *_dataout |= dbmask1; |
72 | | - *_clockout |= cbmask1; |
73 | | - *_clockout &= cbmask2; |
| 69 | + if ((value & m) == 0) *_dataOutRegister &= outmask2; |
| 70 | + else *_dataOutRegister |= outmask1; |
| 71 | + *_clockRegister |= cbmask1; |
| 72 | + *_clockRegister &= cbmask2; |
74 | 73 | SREG = oldSREG; |
75 | | - m <<= 1; |
76 | 74 | } |
77 | | - return 1; |
| 75 | + |
78 | 76 | #else |
79 | | - shiftOut(_databit, _clockbit, LSBFIRST, data); |
80 | | - return 1; |
| 77 | + |
| 78 | + shiftOut(_dataPinOut, _clockPin, LSBFIRST, value); |
| 79 | + |
81 | 80 | #endif |
| 81 | + |
| 82 | + return 1; |
82 | 83 | } |
83 | 84 |
|
84 | 85 |
|
85 | | -size_t FastShiftOut::writeMSBFIRST(const uint8_t data) |
| 86 | +size_t FastShiftOut::writeMSBFIRST(uint8_t data) |
86 | 87 | { |
| 88 | + uint8_t value = data; |
| 89 | + _value = value; |
| 90 | + |
87 | 91 | #if defined(ARDUINO_ARCH_AVR) || defined(ARDUINO_ARCH_MEGAAVR) |
88 | | - uint8_t cbmask1 = _clockbit; |
89 | | - uint8_t cbmask2 = ~_clockbit; |
90 | | - uint8_t dbmask1 = _databit; |
91 | | - uint8_t dbmask2 = ~_databit; |
92 | 92 |
|
93 | | - for (uint8_t i = 0, n = 128; i < 8; i++) |
| 93 | + uint8_t cbmask1 = _clockBit; |
| 94 | + uint8_t cbmask2 = ~_clockBit; |
| 95 | + uint8_t outmask1 = _dataOutBit; |
| 96 | + uint8_t outmask2 = ~_dataOutBit; |
| 97 | + |
| 98 | + for (uint8_t m = 0x80; m > 0; m >>= 1) |
94 | 99 | { |
95 | 100 | uint8_t oldSREG = SREG; |
96 | 101 | noInterrupts(); |
97 | | - if ((data & n) == 0) *_dataout &= dbmask2; |
98 | | - else *_dataout |= dbmask1; |
99 | | - *_clockout |= cbmask1; |
100 | | - *_clockout &= cbmask2; |
| 102 | + if ((value & m) == 0) *_dataOutRegister &= outmask2; |
| 103 | + else *_dataOutRegister |= outmask1; |
| 104 | + *_clockRegister |= cbmask1; |
| 105 | + *_clockRegister &= cbmask2; |
101 | 106 | SREG = oldSREG; |
102 | | - n >>= 1; |
103 | 107 | } |
104 | | - return 1; |
105 | | -#else // reference implementation // note this has no cli() |
106 | | - shiftOut(_databit, _clockbit, MSBFIRST, data); |
107 | | - return 1; |
| 108 | + |
| 109 | +#else |
| 110 | + |
| 111 | + shiftOut(_dataPinOut, _clockPin, MSBFIRST, value); |
| 112 | + |
108 | 113 | #endif |
| 114 | + |
| 115 | + return 1; |
| 116 | + |
109 | 117 | } |
110 | 118 |
|
111 | 119 |
|
| 120 | +uint8_t FastShiftOut::lastWritten(void) |
| 121 | +{ |
| 122 | + return _value; |
| 123 | +}; |
| 124 | + |
| 125 | + |
112 | 126 | bool FastShiftOut::setBitOrder(const uint8_t bitOrder) |
113 | 127 | { |
114 | 128 | if ((bitOrder == LSBFIRST) || (bitOrder == MSBFIRST)) |
115 | 129 | { |
116 | | - _bitorder = bitOrder; |
| 130 | + _bitOrder = bitOrder; |
117 | 131 | return true; |
118 | 132 | }; |
119 | 133 | return false; |
120 | 134 | } |
121 | 135 |
|
122 | 136 |
|
| 137 | +uint8_t FastShiftOut::getBitOrder(void) |
| 138 | +{ |
| 139 | + return _bitOrder; |
| 140 | +}; |
| 141 | + |
| 142 | + |
123 | 143 | // -- END OF FILE -- |
| 144 | + |
0 commit comments