@@ -47,8 +47,6 @@ bool Mcp::mcpBegin(uint8_t _addr, uint8_t *_r)
47
47
updateAllRegisters (_addr, _r);
48
48
if (_addr == MCP23017_EXT_ADDR)
49
49
second_mcp_inited = 1 ;
50
- if (_addr == MCP23017_INT_ADDR)
51
- first_mcp_inited = 1 ;
52
50
return true ;
53
51
}
54
52
@@ -62,7 +60,7 @@ bool Mcp::mcpBegin(uint8_t _addr, uint8_t *_r)
62
60
*/
63
61
void Mcp::readMCPRegisters (uint8_t _addr, uint8_t *k)
64
62
{
65
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
63
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
66
64
return ;
67
65
Wire.beginTransmission (_addr);
68
66
Wire.write (0x00 );
@@ -89,7 +87,7 @@ void Mcp::readMCPRegisters(uint8_t _addr, uint8_t *k)
89
87
*/
90
88
void Mcp::readMCPRegisters (uint8_t _addr, uint8_t _regName, uint8_t *k, uint8_t _n)
91
89
{
92
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
90
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
93
91
return ;
94
92
Wire.beginTransmission (_addr);
95
93
Wire.write (_regName);
@@ -114,7 +112,7 @@ void Mcp::readMCPRegisters(uint8_t _addr, uint8_t _regName, uint8_t *k, uint8_t
114
112
*/
115
113
void Mcp::readMCPRegister (uint8_t _addr, uint8_t _regName, uint8_t *k)
116
114
{
117
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
115
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
118
116
return ;
119
117
Wire.beginTransmission (_addr);
120
118
Wire.write (_regName);
@@ -134,7 +132,7 @@ void Mcp::readMCPRegister(uint8_t _addr, uint8_t _regName, uint8_t *k)
134
132
*/
135
133
void Mcp::updateAllRegisters (uint8_t _addr, uint8_t *k)
136
134
{
137
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
135
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
138
136
return ;
139
137
Wire.beginTransmission (_addr);
140
138
Wire.write (0x00 );
@@ -157,7 +155,7 @@ void Mcp::updateAllRegisters(uint8_t _addr, uint8_t *k)
157
155
*/
158
156
void Mcp::updateRegister (uint8_t _addr, uint8_t _regName, uint8_t _d)
159
157
{
160
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
158
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
161
159
return ;
162
160
Wire.beginTransmission (_addr);
163
161
Wire.write (_regName);
@@ -180,7 +178,7 @@ void Mcp::updateRegister(uint8_t _addr, uint8_t _regName, uint8_t _d)
180
178
*/
181
179
void Mcp::updateRegister (uint8_t _addr, uint8_t _regName, uint8_t *k, uint8_t _n)
182
180
{
183
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
181
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
184
182
return ;
185
183
Wire.beginTransmission (_addr);
186
184
Wire.write (_regName);
@@ -212,7 +210,7 @@ void Mcp::updateRegister(uint8_t _addr, uint8_t _regName, uint8_t *k, uint8_t _n
212
210
*/
213
211
void Mcp::pinModeInternal (uint8_t _addr, uint8_t *_r, uint8_t _pin, uint8_t _mode)
214
212
{
215
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
213
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
216
214
return ;
217
215
uint8_t _port = (_pin / 8 ) & 1 ;
218
216
uint8_t _p = _pin % 8 ;
@@ -261,7 +259,7 @@ void Mcp::pinModeInternal(uint8_t _addr, uint8_t *_r, uint8_t _pin, uint8_t _mod
261
259
*/
262
260
void Mcp::digitalWriteInternal (uint8_t _addr, uint8_t *_r, uint8_t _pin, uint8_t _state)
263
261
{
264
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
262
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
265
263
return ;
266
264
uint8_t _port = (_pin / 8 ) & 1 ;
267
265
uint8_t _p = _pin % 8 ;
@@ -286,7 +284,7 @@ void Mcp::digitalWriteInternal(uint8_t _addr, uint8_t *_r, uint8_t _pin, uint8_t
286
284
*/
287
285
uint8_t Mcp::digitalReadInternal (uint8_t _addr, uint8_t *_r, uint8_t _pin)
288
286
{
289
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
287
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
290
288
return 0 ;
291
289
uint8_t _port = (_pin / 8 ) & 1 ;
292
290
uint8_t _p = _pin % 8 ;
@@ -315,7 +313,7 @@ uint8_t Mcp::digitalReadInternal(uint8_t _addr, uint8_t *_r, uint8_t _pin)
315
313
void Mcp::setIntOutputInternal (uint8_t _addr, uint8_t *_r, uint8_t intPort, uint8_t mirroring, uint8_t openDrain,
316
314
uint8_t polarity)
317
315
{
318
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
316
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
319
317
return ;
320
318
intPort &= 1 ;
321
319
mirroring &= 1 ;
@@ -341,7 +339,7 @@ void Mcp::setIntOutputInternal(uint8_t _addr, uint8_t *_r, uint8_t intPort, uint
341
339
*/
342
340
void Mcp::setIntPinInternal (uint8_t _addr, uint8_t *_r, uint8_t _pin, uint8_t _mode)
343
341
{
344
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
342
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
345
343
return ;
346
344
uint8_t _port = (_pin / 8 ) & 1 ;
347
345
uint8_t _p = _pin % 8 ;
@@ -534,7 +532,7 @@ uint16_t Mcp::getPorts()
534
532
*/
535
533
void Mcp::removeIntPinInternal (uint8_t _addr, uint8_t *_r, uint8_t _pin)
536
534
{
537
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
535
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
538
536
return ;
539
537
uint8_t _port = (_pin / 8 ) & 1 ;
540
538
uint8_t _p = _pin % 8 ;
@@ -556,7 +554,7 @@ void Mcp::removeIntPinInternal(uint8_t _addr, uint8_t *_r, uint8_t _pin)
556
554
*/
557
555
uint16_t Mcp::getINTInternal (uint8_t _addr, uint8_t *_r)
558
556
{
559
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
557
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
560
558
return 0 ;
561
559
readMCPRegisters (_addr, MCP23017_INTFA, _r, 2 );
562
560
return ((_r[MCP23017_INTFB] << 8 ) | _r[MCP23017_INTFA]);
@@ -579,7 +577,7 @@ uint16_t Mcp::getINTInternal(uint8_t _addr, uint8_t *_r)
579
577
*/
580
578
uint16_t Mcp::getINTstateInternal (uint8_t _addr, uint8_t *_r)
581
579
{
582
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
580
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
583
581
return 0 ;
584
582
readMCPRegisters (_addr, MCP23017_INTCAPA, _r, 2 );
585
583
return ((_r[MCP23017_INTCAPB] << 8 ) | _r[MCP23017_INTCAPA]);
@@ -599,7 +597,7 @@ uint16_t Mcp::getINTstateInternal(uint8_t _addr, uint8_t *_r)
599
597
*/
600
598
void Mcp::setPortsInternal (uint8_t _addr, uint8_t *_r, uint16_t _d)
601
599
{
602
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
600
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
603
601
return ;
604
602
_r[MCP23017_GPIOA] = _d & 0xff ;
605
603
_r[MCP23017_GPIOB] = (_d >> 8 ) & 0xff ;
@@ -620,7 +618,7 @@ void Mcp::setPortsInternal(uint8_t _addr, uint8_t *_r, uint16_t _d)
620
618
*/
621
619
uint16_t Mcp::getPortsInternal (uint8_t _addr, uint8_t *_r)
622
620
{
623
- if (( _addr == MCP23017_EXT_ADDR && !second_mcp_inited) || (_addr == MCP23017_INT_ADDR && !first_mcp_inited) )
621
+ if (_addr == MCP23017_EXT_ADDR && !second_mcp_inited )
624
622
return 0 ;
625
623
readMCPRegisters (_addr, MCP23017_GPIOA, _r, 2 );
626
624
return ((_r[MCP23017_GPIOB] << 8 ) | (_r[MCP23017_GPIOA]));
0 commit comments