-
Notifications
You must be signed in to change notification settings - Fork 9
/
Copy pathPCA9554.cpp
122 lines (103 loc) · 2.04 KB
/
PCA9554.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
#include <PCA9554.h>
PCA9554::PCA9554(byte SlaveAddress)
{
_SlaveAddress = SlaveAddress;
}
bool PCA9554::twiRead(byte ®isterAddress)
{
Wire.beginTransmission(_SlaveAddress);
Wire.write(registerAddress);
if(Wire.endTransmission() == 0)
{
delay(15);
Wire.requestFrom(_SlaveAddress, 1, true);
while(Wire.available() < 1);
registerAddress = Wire.read();
return true;
}
return false;
}
bool PCA9554::twiWrite(byte registerAddress, byte dataWrite)
{
Wire.beginTransmission(_SlaveAddress);
Wire.write(registerAddress);
Wire.write(dataWrite);
if(Wire.endTransmission() == 0)
return true;
return false;
}
bool PCA9554::pinMode(byte pinNumber, bool state)
{
byte oldValue = CONFIGPORT;
if(this->twiRead(oldValue) && (pinNumber <= 7))
{
if(!state)
{
oldValue |= (1 << pinNumber);
if(this->portMode(oldValue))
return true;
return false;
}
else if(state)
{
oldValue &= ~(1 << pinNumber);
if(this->portMode(oldValue))
return true;
return false;
}
}
return false;
}
bool PCA9554::portMode(byte value)
{
if(this->twiWrite(CONFIGPORT, value))
return true;
return false;
}
bool PCA9554::digitalWrite(byte pinNumber, bool state)
{
byte oldValue = OUTPUTPORT;
if(this->twiRead(oldValue) && pinNumber <= 7)
{
if(state)
{
oldValue |= (1 << pinNumber);
if(this->digitalWritePort(oldValue))
return true;
return false;
}
else if(!state)
{
oldValue &= ~(1 << pinNumber);
if(this->digitalWritePort(oldValue))
return true;
return false;
}
}
return false;
}
bool PCA9554::digitalWritePort(byte value)
{
if(this->twiWrite(OUTPUTPORT, value))
return true;
return false;
}
bool PCA9554::digitalRead(byte &pinNumber)
{
byte oldValue = INPUTPORT;
if(this->twiRead(oldValue) && (pinNumber <= 7))
{
oldValue &= (1 << pinNumber);
if(oldValue > 0) pinNumber = 1;
else pinNumber = 0;
return true;
}
return false;
}
bool PCA9554::digitalReadPort(byte &value)
{
value = INPUTPORT;
if(this->twiRead(value))
return true;
return false;
}