| line |
stmt |
bran |
cond |
sub |
pod |
time |
code |
|
1
|
|
|
|
|
|
|
#include "EXTERN.h" |
|
2
|
|
|
|
|
|
|
#include "perl.h" |
|
3
|
|
|
|
|
|
|
#include "XSUB.h" |
|
4
|
|
|
|
|
|
|
|
|
5
|
|
|
|
|
|
|
#include |
|
6
|
|
|
|
|
|
|
#include |
|
7
|
|
|
|
|
|
|
#include |
|
8
|
|
|
|
|
|
|
#include |
|
9
|
|
|
|
|
|
|
#include |
|
10
|
|
|
|
|
|
|
#include |
|
11
|
|
|
|
|
|
|
#include |
|
12
|
|
|
|
|
|
|
#include |
|
13
|
|
|
|
|
|
|
#include |
|
14
|
|
|
|
|
|
|
#include |
|
15
|
|
|
|
|
|
|
#include "mcp23017.h" |
|
16
|
|
|
|
|
|
|
#include "bit.h" |
|
17
|
|
|
|
|
|
|
|
|
18
|
|
|
|
|
|
|
/* setup functions */ |
|
19
|
|
|
|
|
|
|
|
|
20
|
0
|
|
|
|
|
|
int GPIO_getFd (int expanderAddr){ |
|
21
|
|
|
|
|
|
|
|
|
22
|
|
|
|
|
|
|
int fd; |
|
23
|
|
|
|
|
|
|
|
|
24
|
0
|
0
|
|
|
|
|
if ((fd = open("/dev/i2c-1", O_RDWR)) < 0) { |
|
25
|
0
|
|
|
|
|
|
close(fd); |
|
26
|
0
|
|
|
|
|
|
printf("Couldn't open the device: %s\n", strerror(errno)); |
|
27
|
0
|
|
|
|
|
|
croak("...this is a fatal error\n"); |
|
28
|
|
|
|
|
|
|
} |
|
29
|
|
|
|
|
|
|
|
|
30
|
0
|
0
|
|
|
|
|
if (ioctl(fd, I2C_SLAVE_FORCE, expanderAddr) < 0) { |
|
31
|
0
|
|
|
|
|
|
close(fd); |
|
32
|
0
|
|
|
|
|
|
printf( |
|
33
|
|
|
|
|
|
|
"Couldn't find device at addr %d: %s\n", |
|
34
|
|
|
|
|
|
|
expanderAddr, |
|
35
|
0
|
|
|
|
|
|
strerror(errno) |
|
36
|
|
|
|
|
|
|
); |
|
37
|
0
|
|
|
|
|
|
exit(-1); |
|
38
|
|
|
|
|
|
|
} |
|
39
|
|
|
|
|
|
|
|
|
40
|
0
|
|
|
|
|
|
_establishI2C(fd); |
|
41
|
|
|
|
|
|
|
|
|
42
|
0
|
|
|
|
|
|
return fd; |
|
43
|
|
|
|
|
|
|
} |
|
44
|
|
|
|
|
|
|
|
|
45
|
0
|
|
|
|
|
|
void _establishI2C (int fd){ |
|
46
|
|
|
|
|
|
|
|
|
47
|
0
|
|
|
|
|
|
int buf[1] = { 0x00 }; |
|
48
|
|
|
|
|
|
|
|
|
49
|
0
|
0
|
|
|
|
|
if (write(fd, buf, 1) != 1){ |
|
50
|
0
|
|
|
|
|
|
close(fd); |
|
51
|
0
|
|
|
|
|
|
printf("Error: Received no ACK bit, couldn't establish connection!"); |
|
52
|
0
|
|
|
|
|
|
exit(-1); |
|
53
|
|
|
|
|
|
|
} |
|
54
|
0
|
|
|
|
|
|
} |
|
55
|
|
|
|
|
|
|
|
|
56
|
|
|
|
|
|
|
/* register operations */ |
|
57
|
|
|
|
|
|
|
|
|
58
|
0
|
|
|
|
|
|
void _checkRegisterReadOnly (uint8_t reg){ |
|
59
|
0
|
|
|
|
|
|
uint8_t readOnlyRegisters[6] = {0x0A, 0X0B, 0x0E, 0x0F, 0x10, 0x11}; |
|
60
|
|
|
|
|
|
|
|
|
61
|
0
|
0
|
|
|
|
|
for (int i=0; i < sizeof(readOnlyRegisters); i++){ |
|
62
|
0
|
0
|
|
|
|
|
if (reg == readOnlyRegisters[i]){ |
|
63
|
0
|
|
|
|
|
|
warn("error: register 0x%x is read-only...\n", reg); |
|
64
|
0
|
|
|
|
|
|
croak("Attempt to write to read-only register failed\n"); |
|
65
|
|
|
|
|
|
|
} |
|
66
|
|
|
|
|
|
|
} |
|
67
|
0
|
|
|
|
|
|
} |
|
68
|
|
|
|
|
|
|
|
|
69
|
0
|
|
|
|
|
|
int _skipRegisterReadOnly (uint8_t reg){ |
|
70
|
0
|
|
|
|
|
|
uint8_t readOnlyRegisters[6] = {0x0A, 0X0B, 0x0E, 0x0F, 0x10, 0x11}; |
|
71
|
|
|
|
|
|
|
|
|
72
|
0
|
0
|
|
|
|
|
for (int i=0; i < sizeof(readOnlyRegisters); i++){ |
|
73
|
0
|
0
|
|
|
|
|
if (reg == readOnlyRegisters[i]){ |
|
74
|
0
|
|
|
|
|
|
return 1; |
|
75
|
|
|
|
|
|
|
} |
|
76
|
|
|
|
|
|
|
} |
|
77
|
0
|
|
|
|
|
|
return 0; |
|
78
|
|
|
|
|
|
|
} |
|
79
|
|
|
|
|
|
|
|
|
80
|
0
|
|
|
|
|
|
int GPIO_getRegister (int fd, int reg){ |
|
81
|
|
|
|
|
|
|
|
|
82
|
|
|
|
|
|
|
uint8_t buf[1]; |
|
83
|
0
|
|
|
|
|
|
buf[0] = reg; |
|
84
|
|
|
|
|
|
|
|
|
85
|
0
|
0
|
|
|
|
|
if ((write(fd, buf, 1)) != 1){ |
|
86
|
0
|
|
|
|
|
|
close(fd); |
|
87
|
0
|
|
|
|
|
|
croak( |
|
88
|
|
|
|
|
|
|
"Could not write register pointer %d: %s\n", |
|
89
|
|
|
|
|
|
|
reg, |
|
90
|
0
|
|
|
|
|
|
strerror(errno) |
|
91
|
|
|
|
|
|
|
); |
|
92
|
|
|
|
|
|
|
} |
|
93
|
|
|
|
|
|
|
|
|
94
|
0
|
0
|
|
|
|
|
if ((read(fd, buf, 1)) != 1){ |
|
95
|
0
|
|
|
|
|
|
close(fd); |
|
96
|
0
|
|
|
|
|
|
croak("Could not read register %d: %s\n", reg, strerror(errno)); |
|
97
|
|
|
|
|
|
|
} |
|
98
|
|
|
|
|
|
|
|
|
99
|
0
|
|
|
|
|
|
return buf[0]; |
|
100
|
|
|
|
|
|
|
} |
|
101
|
|
|
|
|
|
|
|
|
102
|
0
|
|
|
|
|
|
int GPIO_getRegisterBit (int fd, int reg, int bit){ |
|
103
|
0
|
|
|
|
|
|
bit = GPIO__pinBit(bit); |
|
104
|
0
|
|
|
|
|
|
int regData = GPIO_getRegister(fd, (int) reg); |
|
105
|
0
|
|
|
|
|
|
return bitGet(regData, bit, bit); |
|
106
|
|
|
|
|
|
|
} |
|
107
|
|
|
|
|
|
|
|
|
108
|
0
|
|
|
|
|
|
int GPIO_getRegisterBits (int fd, int reg, int msb, int lsb){ |
|
109
|
0
|
|
|
|
|
|
return bitGet(GPIO_getRegister(fd, reg), msb, lsb); |
|
110
|
|
|
|
|
|
|
} |
|
111
|
|
|
|
|
|
|
|
|
112
|
0
|
|
|
|
|
|
int GPIO_setRegister(int fd, int reg, int value, char* name){ |
|
113
|
0
|
|
|
|
|
|
_checkRegisterReadOnly(reg); |
|
114
|
|
|
|
|
|
|
|
|
115
|
0
|
|
|
|
|
|
uint8_t buf[2] = {reg, value}; |
|
116
|
|
|
|
|
|
|
|
|
117
|
0
|
0
|
|
|
|
|
if ((write(fd, buf, sizeof(buf))) != 2){ |
|
118
|
0
|
|
|
|
|
|
close(fd); |
|
119
|
0
|
|
|
|
|
|
printf( |
|
120
|
|
|
|
|
|
|
"Could not write to the %s register: %s\n", |
|
121
|
|
|
|
|
|
|
name, |
|
122
|
0
|
|
|
|
|
|
strerror(errno) |
|
123
|
|
|
|
|
|
|
); |
|
124
|
0
|
|
|
|
|
|
exit(-1); |
|
125
|
|
|
|
|
|
|
} |
|
126
|
|
|
|
|
|
|
|
|
127
|
0
|
|
|
|
|
|
return 0; |
|
128
|
|
|
|
|
|
|
} |
|
129
|
|
|
|
|
|
|
|
|
130
|
|
|
|
|
|
|
/* pin functions */ |
|
131
|
|
|
|
|
|
|
|
|
132
|
0
|
|
|
|
|
|
int GPIO__pinBit (int pin){ |
|
133
|
0
|
0
|
|
|
|
|
if (pin < 0 || pin > 15){ |
|
|
|
0
|
|
|
|
|
|
|
134
|
0
|
|
|
|
|
|
croak("pin '%d' is out of bounds. Pins 0-15 are available\n"); |
|
135
|
|
|
|
|
|
|
} |
|
136
|
|
|
|
|
|
|
|
|
137
|
|
|
|
|
|
|
// since we're dealing with a register per bank, |
|
138
|
|
|
|
|
|
|
// We need to know where in the double register to |
|
139
|
|
|
|
|
|
|
// look |
|
140
|
|
|
|
|
|
|
|
|
141
|
0
|
0
|
|
|
|
|
return pin < 8 ? pin : pin - 8; |
|
142
|
|
|
|
|
|
|
} |
|
143
|
|
|
|
|
|
|
|
|
144
|
0
|
|
|
|
|
|
bool GPIO_readPin (int fd, int pin){ |
|
145
|
0
|
0
|
|
|
|
|
int reg = pin < 8 ? reg = MCP23017_GPIOA : MCP23017_GPIOB; |
|
146
|
0
|
|
|
|
|
|
int bit = GPIO__pinBit(pin); |
|
147
|
|
|
|
|
|
|
|
|
148
|
0
|
|
|
|
|
|
return (bool) GPIO_getRegisterBit(fd, reg, bit); |
|
149
|
|
|
|
|
|
|
} |
|
150
|
|
|
|
|
|
|
|
|
151
|
0
|
|
|
|
|
|
void GPIO_writePin (int fd, int pin, bool state){ |
|
152
|
0
|
0
|
|
|
|
|
int reg = pin < 8 ? reg = MCP23017_GPIOA : MCP23017_GPIOB; |
|
153
|
0
|
|
|
|
|
|
int bit = GPIO__pinBit(pin); |
|
154
|
|
|
|
|
|
|
int value; |
|
155
|
|
|
|
|
|
|
|
|
156
|
0
|
0
|
|
|
|
|
if (state == HIGH){ |
|
157
|
0
|
|
|
|
|
|
value = bitOn(GPIO_getRegister(fd, reg), bit); |
|
158
|
|
|
|
|
|
|
} |
|
159
|
|
|
|
|
|
|
else { |
|
160
|
0
|
|
|
|
|
|
value = bitOff(GPIO_getRegister(fd, reg), bit); |
|
161
|
|
|
|
|
|
|
} |
|
162
|
|
|
|
|
|
|
|
|
163
|
0
|
|
|
|
|
|
GPIO_setRegister(fd, reg, value, "writePin()"); |
|
164
|
0
|
|
|
|
|
|
} |
|
165
|
|
|
|
|
|
|
|
|
166
|
0
|
|
|
|
|
|
void GPIO_pinMode (int fd, int pin, int mode){ |
|
167
|
0
|
|
|
|
|
|
int reg = pin < 8 ? (int) MCP23017_IODIRA : (int) MCP23017_IODIRB; |
|
168
|
0
|
|
|
|
|
|
int bit = GPIO__pinBit(pin); |
|
169
|
|
|
|
|
|
|
int value; |
|
170
|
|
|
|
|
|
|
|
|
171
|
0
|
0
|
|
|
|
|
if (mode == INPUT){ |
|
172
|
0
|
|
|
|
|
|
value = bitOn(GPIO_getRegister(fd, reg), bit); |
|
173
|
|
|
|
|
|
|
|
|
174
|
|
|
|
|
|
|
} |
|
175
|
|
|
|
|
|
|
else { |
|
176
|
0
|
|
|
|
|
|
value = bitOff(GPIO_getRegister(fd, reg), bit); |
|
177
|
|
|
|
|
|
|
} |
|
178
|
|
|
|
|
|
|
|
|
179
|
0
|
|
|
|
|
|
GPIO_setRegister(fd, reg, value, "pinMode()"); |
|
180
|
0
|
|
|
|
|
|
} |
|
181
|
|
|
|
|
|
|
|
|
182
|
0
|
|
|
|
|
|
void GPIO_pullUp (int fd, int pin, int state){ |
|
183
|
0
|
0
|
|
|
|
|
int reg = pin < 8 ? MCP23017_GPPUA : MCP23017_GPPUB; |
|
184
|
0
|
|
|
|
|
|
int bit = GPIO__pinBit(pin); |
|
185
|
|
|
|
|
|
|
int value; |
|
186
|
|
|
|
|
|
|
|
|
187
|
0
|
0
|
|
|
|
|
if (state == HIGH){ |
|
188
|
0
|
|
|
|
|
|
value = bitOn(GPIO_getRegister(fd, reg), bit); |
|
189
|
|
|
|
|
|
|
} |
|
190
|
|
|
|
|
|
|
else { |
|
191
|
0
|
|
|
|
|
|
value = bitOff(GPIO_getRegister(fd, reg), bit); |
|
192
|
|
|
|
|
|
|
} |
|
193
|
|
|
|
|
|
|
|
|
194
|
0
|
|
|
|
|
|
GPIO_setRegister(fd, reg, value, "pullUp()"); |
|
195
|
0
|
|
|
|
|
|
} |
|
196
|
|
|
|
|
|
|
|
|
197
|
|
|
|
|
|
|
/* operational functions */ |
|
198
|
|
|
|
|
|
|
|
|
199
|
0
|
|
|
|
|
|
void GPIO_clean (int fd){ |
|
200
|
|
|
|
|
|
|
|
|
201
|
0
|
0
|
|
|
|
|
for (int i = 0; i < 0x16; i++){ |
|
202
|
0
|
0
|
|
|
|
|
if (_skipRegisterReadOnly(i)){ |
|
203
|
0
|
|
|
|
|
|
continue; |
|
204
|
|
|
|
|
|
|
} |
|
205
|
|
|
|
|
|
|
|
|
206
|
0
|
0
|
|
|
|
|
if (i == MCP23017_IODIRA || i == MCP23017_IODIRB){ |
|
|
|
0
|
|
|
|
|
|
|
207
|
|
|
|
|
|
|
// direction registers get set back to INPUT |
|
208
|
0
|
|
|
|
|
|
GPIO_setRegister(fd, (int) i, (int) 0xFF, "IODIR"); |
|
209
|
0
|
|
|
|
|
|
continue; |
|
210
|
|
|
|
|
|
|
} |
|
211
|
0
|
|
|
|
|
|
GPIO_setRegister(fd, i, 0x00, "rest"); |
|
212
|
|
|
|
|
|
|
} |
|
213
|
0
|
|
|
|
|
|
} |
|
214
|
|
|
|
|
|
|
|
|
215
|
|
|
|
|
|
|
MODULE = RPi::GPIOExpander::MCP23017 PACKAGE = RPi::GPIOExpander::MCP23017 PREFIX = GPIO_ |
|
216
|
|
|
|
|
|
|
|
|
217
|
|
|
|
|
|
|
PROTOTYPES: DISABLE |
|
218
|
|
|
|
|
|
|
|
|
219
|
|
|
|
|
|
|
# setup functions |
|
220
|
|
|
|
|
|
|
|
|
221
|
|
|
|
|
|
|
int |
|
222
|
|
|
|
|
|
|
GPIO_getFd (expanderAddr) |
|
223
|
|
|
|
|
|
|
int expanderAddr |
|
224
|
|
|
|
|
|
|
|
|
225
|
|
|
|
|
|
|
# register functions |
|
226
|
|
|
|
|
|
|
|
|
227
|
|
|
|
|
|
|
int |
|
228
|
|
|
|
|
|
|
GPIO_getRegister (fd, reg) |
|
229
|
|
|
|
|
|
|
int fd |
|
230
|
|
|
|
|
|
|
int reg |
|
231
|
|
|
|
|
|
|
|
|
232
|
|
|
|
|
|
|
int |
|
233
|
|
|
|
|
|
|
GPIO_getRegisterBit (fd, reg, bit) |
|
234
|
|
|
|
|
|
|
int fd |
|
235
|
|
|
|
|
|
|
int reg |
|
236
|
|
|
|
|
|
|
int bit |
|
237
|
|
|
|
|
|
|
|
|
238
|
|
|
|
|
|
|
int |
|
239
|
|
|
|
|
|
|
GPIO_getRegisterBits (fd, reg, msb, lsb) |
|
240
|
|
|
|
|
|
|
int fd |
|
241
|
|
|
|
|
|
|
int reg |
|
242
|
|
|
|
|
|
|
int msb |
|
243
|
|
|
|
|
|
|
int lsb |
|
244
|
|
|
|
|
|
|
|
|
245
|
|
|
|
|
|
|
int |
|
246
|
|
|
|
|
|
|
GPIO_setRegister (fd, reg, value, name) |
|
247
|
|
|
|
|
|
|
int fd |
|
248
|
|
|
|
|
|
|
int reg |
|
249
|
|
|
|
|
|
|
int value |
|
250
|
|
|
|
|
|
|
char* name |
|
251
|
|
|
|
|
|
|
|
|
252
|
|
|
|
|
|
|
# pin functions |
|
253
|
|
|
|
|
|
|
|
|
254
|
|
|
|
|
|
|
int |
|
255
|
|
|
|
|
|
|
GPIO__pinBit (pin) |
|
256
|
|
|
|
|
|
|
int pin |
|
257
|
|
|
|
|
|
|
|
|
258
|
|
|
|
|
|
|
int |
|
259
|
|
|
|
|
|
|
GPIO_readPin (fd, pin) |
|
260
|
|
|
|
|
|
|
int fd |
|
261
|
|
|
|
|
|
|
int pin |
|
262
|
|
|
|
|
|
|
|
|
263
|
|
|
|
|
|
|
void |
|
264
|
|
|
|
|
|
|
GPIO_writePin (fd, pin, state) |
|
265
|
|
|
|
|
|
|
int fd |
|
266
|
|
|
|
|
|
|
int pin |
|
267
|
|
|
|
|
|
|
int state |
|
268
|
|
|
|
|
|
|
|
|
269
|
|
|
|
|
|
|
void |
|
270
|
|
|
|
|
|
|
GPIO_pinMode (fd, pin, mode) |
|
271
|
|
|
|
|
|
|
int fd |
|
272
|
|
|
|
|
|
|
int pin |
|
273
|
|
|
|
|
|
|
int mode |
|
274
|
|
|
|
|
|
|
|
|
275
|
|
|
|
|
|
|
void |
|
276
|
|
|
|
|
|
|
GPIO_pullUp (fd, pin, state) |
|
277
|
|
|
|
|
|
|
int fd |
|
278
|
|
|
|
|
|
|
int pin |
|
279
|
|
|
|
|
|
|
int state |
|
280
|
|
|
|
|
|
|
|
|
281
|
|
|
|
|
|
|
# operational functions |
|
282
|
|
|
|
|
|
|
|
|
283
|
|
|
|
|
|
|
void |
|
284
|
|
|
|
|
|
|
GPIO_clean (fd) |
|
285
|
|
|
|
|
|
|
int fd |
|
286
|
|
|
|
|
|
|
PREINIT: |
|
287
|
|
|
|
|
|
|
I32* temp; |
|
288
|
|
|
|
|
|
|
PPCODE: |
|
289
|
0
|
|
|
|
|
|
temp = PL_markstack_ptr++; |
|
290
|
0
|
|
|
|
|
|
GPIO_clean(fd); |
|
291
|
0
|
0
|
|
|
|
|
if (PL_markstack_ptr != temp) { |
|
292
|
0
|
|
|
|
|
|
PL_markstack_ptr = temp; |
|
293
|
0
|
|
|
|
|
|
XSRETURN_EMPTY; |
|
294
|
|
|
|
|
|
|
} |
|
295
|
0
|
|
|
|
|
|
return; |