rpi_gpio 0.4.0 → 0.5.0
Sign up to get free protection for your applications and to get access to all the features.
- checksums.yaml +4 -4
- data/README.md +48 -7
- data/Rakefile +3 -1
- data/ext/rpi_gpio/extconf.rb +1 -3
- data/lib/rpi_gpio.rb +329 -0
- data/lib/rpi_gpio/rpi_gpio.so +0 -0
- metadata +26 -27
- data/Gemfile.lock +0 -36
- data/ext/rpi_gpio/c_gpio.c +0 -305
- data/ext/rpi_gpio/c_gpio.h +0 -55
- data/ext/rpi_gpio/common.c +0 -93
- data/ext/rpi_gpio/common.h +0 -47
- data/ext/rpi_gpio/cpuinfo.c +0 -272
- data/ext/rpi_gpio/cpuinfo.h +0 -40
- data/ext/rpi_gpio/event_gpio.c +0 -605
- data/ext/rpi_gpio/event_gpio.h +0 -40
- data/ext/rpi_gpio/rb_gpio.c +0 -453
- data/ext/rpi_gpio/rb_gpio.h +0 -47
- data/ext/rpi_gpio/rb_pwm.c +0 -148
- data/ext/rpi_gpio/rb_pwm.h +0 -41
- data/ext/rpi_gpio/rpi_gpio.c +0 -45
- data/ext/rpi_gpio/rpi_gpio.h +0 -28
- data/ext/rpi_gpio/soft_pwm.c +0 -235
- data/ext/rpi_gpio/soft_pwm.h +0 -33
data/ext/rpi_gpio/common.h
DELETED
@@ -1,47 +0,0 @@
|
|
1
|
-
/*
|
2
|
-
Original code by Ben Croston modified for Ruby by Nick Lowery
|
3
|
-
(github.com/clockvapor)
|
4
|
-
Copyright (c) 2014-2020 Nick Lowery
|
5
|
-
|
6
|
-
Copyright (c) 2013-2015 Ben Croston
|
7
|
-
|
8
|
-
Permission is hereby granted, free of charge, to any person obtaining a copy of
|
9
|
-
this software and associated documentation files (the "Software"), to deal in
|
10
|
-
the Software without restriction, including without limitation the rights to
|
11
|
-
use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies
|
12
|
-
of the Software, and to permit persons to whom the Software is furnished to do
|
13
|
-
so, subject to the following conditions:
|
14
|
-
|
15
|
-
The above copyright notice and this permission notice shall be included in all
|
16
|
-
copies or substantial portions of the Software.
|
17
|
-
|
18
|
-
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
19
|
-
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
20
|
-
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
21
|
-
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
22
|
-
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
23
|
-
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
24
|
-
SOFTWARE.
|
25
|
-
*/
|
26
|
-
|
27
|
-
#include "cpuinfo.h"
|
28
|
-
|
29
|
-
#define MODE_UNKNOWN -1
|
30
|
-
#define BOARD 10
|
31
|
-
#define BCM 11
|
32
|
-
#define SERIAL 40
|
33
|
-
#define SPI 41
|
34
|
-
#define I2C 42
|
35
|
-
#define PWM 43
|
36
|
-
|
37
|
-
int gpio_mode;
|
38
|
-
const int pin_to_gpio_rev1[41];
|
39
|
-
const int pin_to_gpio_rev2[41];
|
40
|
-
const int pin_to_gpio_rev3[41];
|
41
|
-
const int (*pin_to_gpio)[41];
|
42
|
-
int gpio_direction[54];
|
43
|
-
rpi_info rpiinfo;
|
44
|
-
int setup_error;
|
45
|
-
int module_setup;
|
46
|
-
int check_gpio_priv(void);
|
47
|
-
int get_gpio_number(int channel, unsigned int *gpio);
|
data/ext/rpi_gpio/cpuinfo.c
DELETED
@@ -1,272 +0,0 @@
|
|
1
|
-
/*
|
2
|
-
Original code by Ben Croston modified for Ruby by Nick Lowery
|
3
|
-
(github.com/clockvapor)
|
4
|
-
Copyright (c) 2014-2020 Nick Lowery
|
5
|
-
|
6
|
-
Copyright (c) 2012-2019 Ben Croston
|
7
|
-
|
8
|
-
Permission is hereby granted, free of charge, to any person obtaining a copy of
|
9
|
-
this software and associated documentation files (the "Software"), to deal in
|
10
|
-
the Software without restriction, including without limitation the rights to
|
11
|
-
use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies
|
12
|
-
of the Software, and to permit persons to whom the Software is furnished to do
|
13
|
-
so, subject to the following conditions:
|
14
|
-
|
15
|
-
The above copyright notice and this permission notice shall be included in all
|
16
|
-
copies or substantial portions of the Software.
|
17
|
-
|
18
|
-
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
19
|
-
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
20
|
-
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
21
|
-
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
22
|
-
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
23
|
-
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
24
|
-
SOFTWARE.
|
25
|
-
*/
|
26
|
-
|
27
|
-
/* See the following for up to date information:
|
28
|
-
* https://www.raspberrypi.org/documentation/hardware/raspberrypi/revision-codes/README.md
|
29
|
-
*/
|
30
|
-
|
31
|
-
#include <stdio.h>
|
32
|
-
#include <stdint.h>
|
33
|
-
#include <stdlib.h>
|
34
|
-
#include <string.h>
|
35
|
-
#include <arpa/inet.h>
|
36
|
-
#include "cpuinfo.h"
|
37
|
-
|
38
|
-
int get_rpi_info(rpi_info *info)
|
39
|
-
{
|
40
|
-
FILE *fp;
|
41
|
-
char buffer[1024];
|
42
|
-
char hardware[1024];
|
43
|
-
char revision[1024];
|
44
|
-
int found = 0;
|
45
|
-
int len;
|
46
|
-
|
47
|
-
if ((fp = fopen("/proc/device-tree/system/linux,revision", "r"))) {
|
48
|
-
uint32_t n;
|
49
|
-
if (fread(&n, sizeof(n), 1, fp) != 1) {
|
50
|
-
fclose(fp);
|
51
|
-
return -1;
|
52
|
-
}
|
53
|
-
sprintf(revision, "%x", ntohl(n));
|
54
|
-
found = 1;
|
55
|
-
}
|
56
|
-
else if ((fp = fopen("/proc/cpuinfo", "r"))) {
|
57
|
-
while(!feof(fp) && fgets(buffer, sizeof(buffer), fp)) {
|
58
|
-
sscanf(buffer, "Hardware : %s", hardware);
|
59
|
-
if (strcmp(hardware, "BCM2708") == 0 ||
|
60
|
-
strcmp(hardware, "BCM2709") == 0 ||
|
61
|
-
strcmp(hardware, "BCM2835") == 0 ||
|
62
|
-
strcmp(hardware, "BCM2836") == 0 ||
|
63
|
-
strcmp(hardware, "BCM2837") == 0 ) {
|
64
|
-
found = 1;
|
65
|
-
}
|
66
|
-
sscanf(buffer, "Revision : %s", revision);
|
67
|
-
}
|
68
|
-
}
|
69
|
-
else
|
70
|
-
return -1;
|
71
|
-
fclose(fp);
|
72
|
-
|
73
|
-
if (!found)
|
74
|
-
return -1;
|
75
|
-
|
76
|
-
if ((len = strlen(revision)) == 0)
|
77
|
-
return -1;
|
78
|
-
|
79
|
-
if (len >= 6 && strtol((char[]){revision[len-6],0}, NULL, 16) & 8) {
|
80
|
-
// new scheme
|
81
|
-
//info->rev = revision[len-1]-'0';
|
82
|
-
strcpy(info->revision, revision);
|
83
|
-
switch (revision[len-3]) {
|
84
|
-
case '0' :
|
85
|
-
switch (revision[len-2]) {
|
86
|
-
case '0': info->type = "Model A"; info->p1_revision = 2; break;
|
87
|
-
case '1': info->type = "Model B"; info->p1_revision = 2; break;
|
88
|
-
case '2': info->type = "Model A+"; info->p1_revision = 3; break;
|
89
|
-
case '3': info->type = "Model B+"; info->p1_revision = 3; break;
|
90
|
-
case '4': info->type = "Pi 2 Model B"; info->p1_revision = 3; break;
|
91
|
-
case '5': info->type = "Alpha"; info->p1_revision = 3; break;
|
92
|
-
case '6': info->type = "Compute Module 1"; info->p1_revision = 0; break;
|
93
|
-
case '8': info->type = "Pi 3 Model B"; info->p1_revision = 3; break;
|
94
|
-
case '9': info->type = "Zero"; info->p1_revision = 3; break;
|
95
|
-
case 'a': info->type = "Compute Module 3"; info->p1_revision = 0; break;
|
96
|
-
case 'c': info->type = "Zero W"; info->p1_revision = 3; break;
|
97
|
-
case 'd': info->type = "Pi 3 Model B+"; info->p1_revision = 3; break;
|
98
|
-
case 'e': info->type = "Pi 3 Model A+"; info->p1_revision = 3; break;
|
99
|
-
default : info->type = "Unknown"; info->p1_revision = 3; break;
|
100
|
-
} break;
|
101
|
-
case '1':
|
102
|
-
switch (revision[len-2]) {
|
103
|
-
case '0': info->type = "Compute Module 3+"; info->p1_revision = 0; break;
|
104
|
-
case '1': info->type = "Pi 4 Model B"; info->p1_revision = 3; break;
|
105
|
-
default : info->type = "Unknown"; info->p1_revision = 3; break;
|
106
|
-
} break;
|
107
|
-
default: info->type = "Unknown"; info->p1_revision = 3; break;
|
108
|
-
}
|
109
|
-
|
110
|
-
switch (revision[len-4]) {
|
111
|
-
case '0': info->processor = "BCM2835"; break;
|
112
|
-
case '1': info->processor = "BCM2836"; break;
|
113
|
-
case '2': info->processor = "BCM2837"; break;
|
114
|
-
case '3': info->processor = "BCM2711"; break;
|
115
|
-
default : info->processor = "Unknown"; break;
|
116
|
-
}
|
117
|
-
switch (revision[len-5]) {
|
118
|
-
case '0': info->manufacturer = "Sony"; break;
|
119
|
-
case '1': info->manufacturer = "Egoman"; break;
|
120
|
-
case '2': info->manufacturer = "Embest"; break;
|
121
|
-
case '3': info->manufacturer = "Sony Japan"; break;
|
122
|
-
case '4': info->manufacturer = "Embest"; break;
|
123
|
-
case '5': info->manufacturer = "Stadium"; break;
|
124
|
-
default : info->manufacturer = "Unknown"; break;
|
125
|
-
}
|
126
|
-
switch (strtol((char[]){revision[len-6],0}, NULL, 16) & 7) {
|
127
|
-
case 0: info->ram = "256M"; break;
|
128
|
-
case 1: info->ram = "512M"; break;
|
129
|
-
case 2: info->ram = "1G"; break;
|
130
|
-
case 3: info->ram = "2G"; break;
|
131
|
-
case 4: info->ram = "4G"; break;
|
132
|
-
default: info->ram = "Unknown"; break;
|
133
|
-
}
|
134
|
-
} else {
|
135
|
-
// old scheme
|
136
|
-
info->ram = "Unknown";
|
137
|
-
info->manufacturer = "Unknown";
|
138
|
-
info->processor = "Unknown";
|
139
|
-
info->type = "Unknown";
|
140
|
-
strcpy(info->revision, revision);
|
141
|
-
|
142
|
-
uint64_t rev;
|
143
|
-
sscanf(revision, "%llx", &rev);
|
144
|
-
rev = rev & 0xefffffff; // ignore preceeding 1000 for overvolt
|
145
|
-
|
146
|
-
if (rev == 0x0002 || rev == 0x0003) {
|
147
|
-
info->type = "Model B";
|
148
|
-
info->p1_revision = 1;
|
149
|
-
info->ram = "256M";
|
150
|
-
info->manufacturer = "Egoman";
|
151
|
-
info->processor = "BCM2835";
|
152
|
-
} else if (rev == 0x0004) {
|
153
|
-
info->type = "Model B";
|
154
|
-
info->p1_revision = 2;
|
155
|
-
info->ram = "256M";
|
156
|
-
info->manufacturer = "Sony UK";
|
157
|
-
info->processor = "BCM2835";
|
158
|
-
} else if (rev == 0x0005) {
|
159
|
-
info->type = "Model B";
|
160
|
-
info->p1_revision = 2;
|
161
|
-
info->ram = "256M";
|
162
|
-
info->manufacturer = "Qisda";
|
163
|
-
info->processor = "BCM2835";
|
164
|
-
} else if (rev == 0x0006) {
|
165
|
-
info->type = "Model B";
|
166
|
-
info->p1_revision = 2;
|
167
|
-
info->ram = "256M";
|
168
|
-
info->manufacturer = "Egoman";
|
169
|
-
info->processor = "BCM2835";
|
170
|
-
} else if (rev == 0x0007) {
|
171
|
-
info->type = "Model A";
|
172
|
-
info->p1_revision = 2;
|
173
|
-
info->ram = "256M";
|
174
|
-
info->manufacturer = "Egoman";
|
175
|
-
info->processor = "BCM2835";
|
176
|
-
} else if (rev == 0x0008) {
|
177
|
-
info->type = "Model A";
|
178
|
-
info->p1_revision = 2;
|
179
|
-
info->ram = "256M";
|
180
|
-
info->manufacturer = "Sony UK";
|
181
|
-
info->processor = "BCM2835";
|
182
|
-
} else if (rev == 0x0009) {
|
183
|
-
info->type = "Model A";
|
184
|
-
info->p1_revision = 2;
|
185
|
-
info->ram = "256M";
|
186
|
-
info->manufacturer = "Qisda";
|
187
|
-
info->processor = "BCM2835";
|
188
|
-
} else if (rev == 0x000d) {
|
189
|
-
info->type = "Model B";
|
190
|
-
info->p1_revision = 2;
|
191
|
-
info->ram = "512M";
|
192
|
-
info->manufacturer = "Egoman";
|
193
|
-
info->processor = "BCM2835";
|
194
|
-
} else if (rev == 0x000e) {
|
195
|
-
info->type = "Model B";
|
196
|
-
info->p1_revision = 2;
|
197
|
-
info->ram = "512M";
|
198
|
-
info->manufacturer = "Sony UK";
|
199
|
-
info->processor = "BCM2835";
|
200
|
-
} else if (rev == 0x000f) {
|
201
|
-
info->type = "Model B";
|
202
|
-
info->p1_revision = 2;
|
203
|
-
info->ram = "512M";
|
204
|
-
info->manufacturer = "Qisda";
|
205
|
-
info->processor = "BCM2835";
|
206
|
-
} else if (rev == 0x0010) {
|
207
|
-
info->type = "Model B+";
|
208
|
-
info->p1_revision = 3;
|
209
|
-
info->ram = "512M";
|
210
|
-
info->manufacturer = "Sony UK";
|
211
|
-
info->processor = "BCM2835";
|
212
|
-
} else if (rev == 0x0011) {
|
213
|
-
info->type = "Compute Module 1";
|
214
|
-
info->p1_revision = 0;
|
215
|
-
info->ram = "512M";
|
216
|
-
info->manufacturer = "Sony UK";
|
217
|
-
info->processor = "BCM2835";
|
218
|
-
} else if (rev == 0x0012) {
|
219
|
-
info->type = "Model A+";
|
220
|
-
info->p1_revision = 3;
|
221
|
-
info->ram = "256M";
|
222
|
-
info->manufacturer = "Sony UK";
|
223
|
-
info->processor = "BCM2835";
|
224
|
-
} else if (rev == 0x0013) {
|
225
|
-
info->type = "Model B+";
|
226
|
-
info->p1_revision = 3;
|
227
|
-
info->ram = "512M";
|
228
|
-
info->manufacturer = "Embest";
|
229
|
-
info->processor = "BCM2835";
|
230
|
-
} else if (rev == 0x0014) {
|
231
|
-
info->type = "Compute Module 1";
|
232
|
-
info->p1_revision = 0;
|
233
|
-
info->ram = "512M";
|
234
|
-
info->manufacturer = "Embest";
|
235
|
-
info->processor = "BCM2835";
|
236
|
-
} else if (rev == 0x0015) {
|
237
|
-
info->type = "Model A+";
|
238
|
-
info->p1_revision = 3;
|
239
|
-
info->ram = "Unknown";
|
240
|
-
info->manufacturer = "Embest";
|
241
|
-
info->processor = "BCM2835";
|
242
|
-
} else { // don't know - assume revision 3 p1 connector
|
243
|
-
info->p1_revision = 3;
|
244
|
-
}
|
245
|
-
}
|
246
|
-
return 0;
|
247
|
-
}
|
248
|
-
|
249
|
-
/*
|
250
|
-
|
251
|
-
32 bits
|
252
|
-
NEW 23: will be 1 for the new scheme, 0 for the old scheme
|
253
|
-
MEMSIZE 20: 0=256M 1=512M 2=1G
|
254
|
-
MANUFACTURER 16: 0=SONY 1=EGOMAN
|
255
|
-
PROCESSOR 12: 0=2835 1=2836
|
256
|
-
TYPE 04: 0=MODELA 1=MODELB 2=MODELA+ 3=MODELB+ 4=Pi2 MODEL B 5=ALPHA 6=CM
|
257
|
-
REV 00: 0=REV0 1=REV1 2=REV2
|
258
|
-
|
259
|
-
pi2 = 1<<23 | 2<<20 | 1<<12 | 4<<4 = 0xa01040
|
260
|
-
|
261
|
-
--------------------
|
262
|
-
|
263
|
-
SRRR MMMM PPPP TTTT TTTT VVVV
|
264
|
-
|
265
|
-
S scheme (0=old, 1=new)
|
266
|
-
R RAM (0=256, 1=512, 2=1024)
|
267
|
-
M manufacturer (0='SONY',1='EGOMAN',2='EMBEST',3='UNKNOWN',4='EMBEST')
|
268
|
-
P processor (0=2835, 1=2836 2=2837)
|
269
|
-
T type (0='A', 1='B', 2='A+', 3='B+', 4='Pi 2 B', 5='Alpha', 6='Compute Module')
|
270
|
-
V revision (0-15)
|
271
|
-
|
272
|
-
*/
|
data/ext/rpi_gpio/cpuinfo.h
DELETED
@@ -1,40 +0,0 @@
|
|
1
|
-
/*
|
2
|
-
Original code by Ben Croston modified for Ruby by Nick Lowery
|
3
|
-
(github.com/clockvapor)
|
4
|
-
Copyright (c) 2014-2016 Nick Lowery
|
5
|
-
|
6
|
-
Copyright (c) 2012-2015 Ben Croston
|
7
|
-
|
8
|
-
Permission is hereby granted, free of charge, to any person obtaining a copy of
|
9
|
-
this software and associated documentation files (the "Software"), to deal in
|
10
|
-
the Software without restriction, including without limitation the rights to
|
11
|
-
use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies
|
12
|
-
of the Software, and to permit persons to whom the Software is furnished to do
|
13
|
-
so, subject to the following conditions:
|
14
|
-
|
15
|
-
The above copyright notice and this permission notice shall be included in all
|
16
|
-
copies or substantial portions of the Software.
|
17
|
-
|
18
|
-
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
19
|
-
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
20
|
-
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
21
|
-
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
22
|
-
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
23
|
-
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
24
|
-
SOFTWARE.
|
25
|
-
*/
|
26
|
-
|
27
|
-
#ifndef CPUINFO_H
|
28
|
-
#define CPUINFO_H
|
29
|
-
typedef struct
|
30
|
-
{
|
31
|
-
int p1_revision;
|
32
|
-
char *ram;
|
33
|
-
char *manufacturer;
|
34
|
-
char *processor;
|
35
|
-
char *type;
|
36
|
-
char revision[1024];
|
37
|
-
} rpi_info;
|
38
|
-
#endif /* CPUINFO_H */
|
39
|
-
|
40
|
-
int get_rpi_info(rpi_info *info);
|
data/ext/rpi_gpio/event_gpio.c
DELETED
@@ -1,605 +0,0 @@
|
|
1
|
-
/*
|
2
|
-
Original code by Ben Croston modified for Ruby by Nick Lowery
|
3
|
-
(github.com/clockvapor)
|
4
|
-
Copyright (c) 2014-2020 Nick Lowery
|
5
|
-
|
6
|
-
Copyright (c) 2013-2018 Ben Croston
|
7
|
-
|
8
|
-
Permission is hereby granted, free of charge, to any person obtaining a copy of
|
9
|
-
this software and associated documentation files (the "Software"), to deal in
|
10
|
-
the Software without restriction, including without limitation the rights to
|
11
|
-
use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies
|
12
|
-
of the Software, and to permit persons to whom the Software is furnished to do
|
13
|
-
so, subject to the following conditions:
|
14
|
-
|
15
|
-
The above copyright notice and this permission notice shall be included in all
|
16
|
-
copies or substantial portions of the Software.
|
17
|
-
|
18
|
-
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
19
|
-
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
20
|
-
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
21
|
-
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
22
|
-
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
23
|
-
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
24
|
-
SOFTWARE.
|
25
|
-
*/
|
26
|
-
|
27
|
-
#include <pthread.h>
|
28
|
-
#include <sys/epoll.h>
|
29
|
-
#include <stdio.h>
|
30
|
-
#include <stdlib.h>
|
31
|
-
#include <errno.h>
|
32
|
-
#include <fcntl.h>
|
33
|
-
#include <unistd.h>
|
34
|
-
#include <string.h>
|
35
|
-
#include <sys/time.h>
|
36
|
-
#include "event_gpio.h"
|
37
|
-
|
38
|
-
const char *stredge[4] = {"none", "rising", "falling", "both"};
|
39
|
-
|
40
|
-
struct gpios
|
41
|
-
{
|
42
|
-
unsigned int gpio;
|
43
|
-
int value_fd;
|
44
|
-
int exported;
|
45
|
-
int edge;
|
46
|
-
int initial_thread;
|
47
|
-
int initial_wait;
|
48
|
-
int thread_added;
|
49
|
-
int bouncetime;
|
50
|
-
unsigned long long lastcall;
|
51
|
-
struct gpios *next;
|
52
|
-
};
|
53
|
-
struct gpios *gpio_list = NULL;
|
54
|
-
|
55
|
-
// event callbacks
|
56
|
-
struct callback
|
57
|
-
{
|
58
|
-
unsigned int gpio;
|
59
|
-
void (*func)(unsigned int gpio);
|
60
|
-
struct callback *next;
|
61
|
-
};
|
62
|
-
struct callback *callbacks = NULL;
|
63
|
-
|
64
|
-
pthread_t threads;
|
65
|
-
int event_occurred[54] = { 0 };
|
66
|
-
int thread_running = 0;
|
67
|
-
int epfd_thread = -1;
|
68
|
-
int epfd_blocking = -1;
|
69
|
-
|
70
|
-
/************* /sys/class/gpio functions ************/
|
71
|
-
#define x_write(fd, buf, len) do { \
|
72
|
-
size_t x_write_len = (len); \
|
73
|
-
\
|
74
|
-
if ((size_t)write((fd), (buf), x_write_len) != x_write_len) { \
|
75
|
-
close(fd); \
|
76
|
-
return (-1); \
|
77
|
-
} \
|
78
|
-
} while (/* CONSTCOND */ 0)
|
79
|
-
|
80
|
-
int gpio_export(unsigned int gpio)
|
81
|
-
{
|
82
|
-
int fd, len;
|
83
|
-
char str_gpio[3];
|
84
|
-
char filename[33];
|
85
|
-
|
86
|
-
snprintf(filename, sizeof(filename), "/sys/class/gpio/gpio%d", gpio);
|
87
|
-
|
88
|
-
/* return if gpio already exported */
|
89
|
-
if (access(filename, F_OK) != -1) {
|
90
|
-
return 0;
|
91
|
-
}
|
92
|
-
|
93
|
-
if ((fd = open("/sys/class/gpio/export", O_WRONLY)) < 0) {
|
94
|
-
return -1;
|
95
|
-
}
|
96
|
-
|
97
|
-
len = snprintf(str_gpio, sizeof(str_gpio), "%d", gpio);
|
98
|
-
x_write(fd, str_gpio, len);
|
99
|
-
close(fd);
|
100
|
-
|
101
|
-
return 0;
|
102
|
-
}
|
103
|
-
|
104
|
-
int gpio_unexport(unsigned int gpio)
|
105
|
-
{
|
106
|
-
int fd, len;
|
107
|
-
char str_gpio[3];
|
108
|
-
|
109
|
-
if ((fd = open("/sys/class/gpio/unexport", O_WRONLY)) < 0)
|
110
|
-
return -1;
|
111
|
-
|
112
|
-
len = snprintf(str_gpio, sizeof(str_gpio), "%d", gpio);
|
113
|
-
x_write(fd, str_gpio, len);
|
114
|
-
close(fd);
|
115
|
-
|
116
|
-
return 0;
|
117
|
-
}
|
118
|
-
|
119
|
-
int gpio_set_direction(unsigned int gpio, unsigned int in_flag)
|
120
|
-
{
|
121
|
-
int retry;
|
122
|
-
struct timespec delay;
|
123
|
-
int fd;
|
124
|
-
char filename[33];
|
125
|
-
|
126
|
-
snprintf(filename, sizeof(filename), "/sys/class/gpio/gpio%d/direction", gpio);
|
127
|
-
|
128
|
-
// retry waiting for udev to set correct file permissions
|
129
|
-
delay.tv_sec = 0;
|
130
|
-
delay.tv_nsec = 10000000L; // 10ms
|
131
|
-
for (retry=0; retry<100; retry++) {
|
132
|
-
if ((fd = open(filename, O_WRONLY)) >= 0)
|
133
|
-
break;
|
134
|
-
nanosleep(&delay, NULL);
|
135
|
-
}
|
136
|
-
if (retry >= 100)
|
137
|
-
return -1;
|
138
|
-
|
139
|
-
if (in_flag)
|
140
|
-
x_write(fd, "in", 3);
|
141
|
-
else
|
142
|
-
x_write(fd, "out", 4);
|
143
|
-
|
144
|
-
close(fd);
|
145
|
-
return 0;
|
146
|
-
}
|
147
|
-
|
148
|
-
int gpio_set_edge(unsigned int gpio, unsigned int edge)
|
149
|
-
{
|
150
|
-
int fd;
|
151
|
-
char filename[28];
|
152
|
-
|
153
|
-
snprintf(filename, sizeof(filename), "/sys/class/gpio/gpio%d/edge", gpio);
|
154
|
-
|
155
|
-
if ((fd = open(filename, O_WRONLY)) < 0)
|
156
|
-
return -1;
|
157
|
-
|
158
|
-
x_write(fd, stredge[edge], strlen(stredge[edge]) + 1);
|
159
|
-
close(fd);
|
160
|
-
return 0;
|
161
|
-
}
|
162
|
-
|
163
|
-
int open_value_file(unsigned int gpio)
|
164
|
-
{
|
165
|
-
int fd;
|
166
|
-
char filename[29];
|
167
|
-
|
168
|
-
// create file descriptor of value file
|
169
|
-
snprintf(filename, sizeof(filename), "/sys/class/gpio/gpio%d/value", gpio);
|
170
|
-
if ((fd = open(filename, O_RDONLY | O_NONBLOCK)) < 0)
|
171
|
-
return -1;
|
172
|
-
return fd;
|
173
|
-
}
|
174
|
-
|
175
|
-
/********* gpio list functions **********/
|
176
|
-
struct gpios *get_gpio(unsigned int gpio)
|
177
|
-
{
|
178
|
-
struct gpios *g = gpio_list;
|
179
|
-
while (g != NULL) {
|
180
|
-
if (g->gpio == gpio)
|
181
|
-
return g;
|
182
|
-
g = g->next;
|
183
|
-
}
|
184
|
-
return NULL;
|
185
|
-
}
|
186
|
-
|
187
|
-
struct gpios *get_gpio_from_value_fd(int fd)
|
188
|
-
{
|
189
|
-
struct gpios *g = gpio_list;
|
190
|
-
while (g != NULL) {
|
191
|
-
if (g->value_fd == fd)
|
192
|
-
return g;
|
193
|
-
g = g->next;
|
194
|
-
}
|
195
|
-
return NULL;
|
196
|
-
}
|
197
|
-
|
198
|
-
struct gpios *new_gpio(unsigned int gpio)
|
199
|
-
{
|
200
|
-
struct gpios *new_gpio;
|
201
|
-
|
202
|
-
new_gpio = malloc(sizeof(struct gpios));
|
203
|
-
if (new_gpio == 0) {
|
204
|
-
return NULL; // out of memory
|
205
|
-
}
|
206
|
-
|
207
|
-
new_gpio->gpio = gpio;
|
208
|
-
if (gpio_export(gpio) != 0) {
|
209
|
-
free(new_gpio);
|
210
|
-
return NULL;
|
211
|
-
}
|
212
|
-
new_gpio->exported = 1;
|
213
|
-
|
214
|
-
if (gpio_set_direction(gpio,1) != 0) { // 1==input
|
215
|
-
free(new_gpio);
|
216
|
-
return NULL;
|
217
|
-
}
|
218
|
-
|
219
|
-
if ((new_gpio->value_fd = open_value_file(gpio)) == -1) {
|
220
|
-
gpio_unexport(gpio);
|
221
|
-
free(new_gpio);
|
222
|
-
return NULL;
|
223
|
-
}
|
224
|
-
|
225
|
-
new_gpio->initial_thread = 1;
|
226
|
-
new_gpio->initial_wait = 1;
|
227
|
-
new_gpio->bouncetime = -666;
|
228
|
-
new_gpio->lastcall = 0;
|
229
|
-
new_gpio->thread_added = 0;
|
230
|
-
|
231
|
-
if (gpio_list == NULL) {
|
232
|
-
new_gpio->next = NULL;
|
233
|
-
} else {
|
234
|
-
new_gpio->next = gpio_list;
|
235
|
-
}
|
236
|
-
gpio_list = new_gpio;
|
237
|
-
return new_gpio;
|
238
|
-
}
|
239
|
-
|
240
|
-
void delete_gpio(unsigned int gpio)
|
241
|
-
{
|
242
|
-
struct gpios *g = gpio_list;
|
243
|
-
struct gpios *prev = NULL;
|
244
|
-
|
245
|
-
while (g != NULL) {
|
246
|
-
if (g->gpio == gpio) {
|
247
|
-
if (prev == NULL)
|
248
|
-
gpio_list = g->next;
|
249
|
-
else
|
250
|
-
prev->next = g->next;
|
251
|
-
free(g);
|
252
|
-
return;
|
253
|
-
} else {
|
254
|
-
prev = g;
|
255
|
-
g = g->next;
|
256
|
-
}
|
257
|
-
}
|
258
|
-
}
|
259
|
-
|
260
|
-
int gpio_event_added(unsigned int gpio)
|
261
|
-
{
|
262
|
-
struct gpios *g = gpio_list;
|
263
|
-
while (g != NULL) {
|
264
|
-
if (g->gpio == gpio)
|
265
|
-
return g->edge;
|
266
|
-
g = g->next;
|
267
|
-
}
|
268
|
-
return 0;
|
269
|
-
}
|
270
|
-
|
271
|
-
/******* callback list functions ********/
|
272
|
-
int add_edge_callback(unsigned int gpio, void (*func)(unsigned int gpio))
|
273
|
-
{
|
274
|
-
struct callback *cb = callbacks;
|
275
|
-
struct callback *new_cb;
|
276
|
-
|
277
|
-
new_cb = malloc(sizeof(struct callback));
|
278
|
-
if (new_cb == 0)
|
279
|
-
return -1; // out of memory
|
280
|
-
|
281
|
-
new_cb->gpio = gpio;
|
282
|
-
new_cb->func = func;
|
283
|
-
new_cb->next = NULL;
|
284
|
-
|
285
|
-
if (callbacks == NULL) {
|
286
|
-
// start new list
|
287
|
-
callbacks = new_cb;
|
288
|
-
} else {
|
289
|
-
// add to end of list
|
290
|
-
while (cb->next != NULL)
|
291
|
-
cb = cb->next;
|
292
|
-
cb->next = new_cb;
|
293
|
-
}
|
294
|
-
return 0;
|
295
|
-
}
|
296
|
-
|
297
|
-
int callback_exists(unsigned int gpio)
|
298
|
-
{
|
299
|
-
struct callback *cb = callbacks;
|
300
|
-
while (cb != NULL) {
|
301
|
-
if (cb->gpio == gpio)
|
302
|
-
return 1;
|
303
|
-
cb = cb->next;
|
304
|
-
}
|
305
|
-
return 0;
|
306
|
-
}
|
307
|
-
|
308
|
-
void run_callbacks(unsigned int gpio)
|
309
|
-
{
|
310
|
-
struct callback *cb = callbacks;
|
311
|
-
while (cb != NULL)
|
312
|
-
{
|
313
|
-
if (cb->gpio == gpio)
|
314
|
-
cb->func(cb->gpio);
|
315
|
-
cb = cb->next;
|
316
|
-
}
|
317
|
-
}
|
318
|
-
|
319
|
-
void remove_callbacks(unsigned int gpio)
|
320
|
-
{
|
321
|
-
struct callback *cb = callbacks;
|
322
|
-
struct callback *temp;
|
323
|
-
struct callback *prev = NULL;
|
324
|
-
|
325
|
-
while (cb != NULL)
|
326
|
-
{
|
327
|
-
if (cb->gpio == gpio)
|
328
|
-
{
|
329
|
-
if (prev == NULL)
|
330
|
-
callbacks = cb->next;
|
331
|
-
else
|
332
|
-
prev->next = cb->next;
|
333
|
-
temp = cb;
|
334
|
-
cb = cb->next;
|
335
|
-
free(temp);
|
336
|
-
} else {
|
337
|
-
prev = cb;
|
338
|
-
cb = cb->next;
|
339
|
-
}
|
340
|
-
}
|
341
|
-
}
|
342
|
-
|
343
|
-
void *poll_thread(void *threadarg)
|
344
|
-
{
|
345
|
-
struct epoll_event events;
|
346
|
-
char buf;
|
347
|
-
struct timeval tv_timenow;
|
348
|
-
unsigned long long timenow;
|
349
|
-
struct gpios *g;
|
350
|
-
int n;
|
351
|
-
|
352
|
-
thread_running = 1;
|
353
|
-
while (thread_running) {
|
354
|
-
n = epoll_wait(epfd_thread, &events, 1, -1);
|
355
|
-
if (n > 0) {
|
356
|
-
lseek(events.data.fd, 0, SEEK_SET);
|
357
|
-
if (read(events.data.fd, &buf, 1) != 1) {
|
358
|
-
thread_running = 0;
|
359
|
-
pthread_exit(NULL);
|
360
|
-
}
|
361
|
-
g = get_gpio_from_value_fd(events.data.fd);
|
362
|
-
if (g->initial_thread) { // ignore first epoll trigger
|
363
|
-
g->initial_thread = 0;
|
364
|
-
} else {
|
365
|
-
gettimeofday(&tv_timenow, NULL);
|
366
|
-
timenow = tv_timenow.tv_sec*1E6 + tv_timenow.tv_usec;
|
367
|
-
if (g->bouncetime == -666 || timenow - g->lastcall > (unsigned int)g->bouncetime*1000 || g->lastcall == 0 || g->lastcall > timenow) {
|
368
|
-
g->lastcall = timenow;
|
369
|
-
event_occurred[g->gpio] = 1;
|
370
|
-
run_callbacks(g->gpio);
|
371
|
-
}
|
372
|
-
}
|
373
|
-
} else if (n == -1) {
|
374
|
-
/* If a signal is received while we are waiting,
|
375
|
-
epoll_wait will return with an EINTR error.
|
376
|
-
Just try again in that case. */
|
377
|
-
if (errno == EINTR) {
|
378
|
-
continue;
|
379
|
-
}
|
380
|
-
thread_running = 0;
|
381
|
-
pthread_exit(NULL);
|
382
|
-
}
|
383
|
-
}
|
384
|
-
thread_running = 0;
|
385
|
-
pthread_exit(NULL);
|
386
|
-
}
|
387
|
-
|
388
|
-
void remove_edge_detect(unsigned int gpio)
|
389
|
-
{
|
390
|
-
struct epoll_event ev;
|
391
|
-
struct gpios *g = get_gpio(gpio);
|
392
|
-
|
393
|
-
if (g == NULL)
|
394
|
-
return;
|
395
|
-
|
396
|
-
// delete epoll of fd
|
397
|
-
|
398
|
-
ev.events = EPOLLIN | EPOLLET | EPOLLPRI;
|
399
|
-
ev.data.fd = g->value_fd;
|
400
|
-
epoll_ctl(epfd_thread, EPOLL_CTL_DEL, g->value_fd, &ev);
|
401
|
-
|
402
|
-
// delete callbacks for gpio
|
403
|
-
remove_callbacks(gpio);
|
404
|
-
|
405
|
-
// btc fixme - check return result??
|
406
|
-
gpio_set_edge(gpio, NO_EDGE);
|
407
|
-
g->edge = NO_EDGE;
|
408
|
-
|
409
|
-
if (g->value_fd != -1)
|
410
|
-
close(g->value_fd);
|
411
|
-
|
412
|
-
// btc fixme - check return result??
|
413
|
-
gpio_unexport(gpio);
|
414
|
-
event_occurred[gpio] = 0;
|
415
|
-
|
416
|
-
delete_gpio(gpio);
|
417
|
-
}
|
418
|
-
|
419
|
-
int event_detected(unsigned int gpio)
|
420
|
-
{
|
421
|
-
if (event_occurred[gpio]) {
|
422
|
-
event_occurred[gpio] = 0;
|
423
|
-
return 1;
|
424
|
-
} else {
|
425
|
-
return 0;
|
426
|
-
}
|
427
|
-
}
|
428
|
-
|
429
|
-
void event_cleanup(int gpio)
|
430
|
-
// gpio of -666 means clean every channel used
|
431
|
-
{
|
432
|
-
struct gpios *g = gpio_list;
|
433
|
-
struct gpios *next_gpio = NULL;
|
434
|
-
|
435
|
-
while (g != NULL) {
|
436
|
-
next_gpio = g->next;
|
437
|
-
if ((gpio == -666) || ((int)g->gpio == gpio))
|
438
|
-
remove_edge_detect(g->gpio);
|
439
|
-
g = next_gpio;
|
440
|
-
}
|
441
|
-
if (gpio_list == NULL) {
|
442
|
-
if (epfd_blocking != -1) {
|
443
|
-
close(epfd_blocking);
|
444
|
-
epfd_blocking = -1;
|
445
|
-
}
|
446
|
-
if (epfd_thread != -1) {
|
447
|
-
close(epfd_thread);
|
448
|
-
epfd_thread = -1;
|
449
|
-
}
|
450
|
-
thread_running = 0;
|
451
|
-
}
|
452
|
-
}
|
453
|
-
|
454
|
-
void event_cleanup_all(void)
|
455
|
-
{
|
456
|
-
event_cleanup(-666);
|
457
|
-
}
|
458
|
-
|
459
|
-
int add_edge_detect(unsigned int gpio, unsigned int edge, int bouncetime)
|
460
|
-
// return values:
|
461
|
-
// 0 - Success
|
462
|
-
// 1 - Edge detection already added
|
463
|
-
// 2 - Other error
|
464
|
-
{
|
465
|
-
pthread_t threads;
|
466
|
-
struct epoll_event ev;
|
467
|
-
long t = 0;
|
468
|
-
struct gpios *g;
|
469
|
-
int i = -1;
|
470
|
-
|
471
|
-
i = gpio_event_added(gpio);
|
472
|
-
if (i == 0) { // event not already added
|
473
|
-
if ((g = new_gpio(gpio)) == NULL) {
|
474
|
-
return 2;
|
475
|
-
}
|
476
|
-
|
477
|
-
gpio_set_edge(gpio, edge);
|
478
|
-
g->edge = edge;
|
479
|
-
g->bouncetime = bouncetime;
|
480
|
-
} else if (i == (int)edge) { // get existing event
|
481
|
-
g = get_gpio(gpio);
|
482
|
-
if ((bouncetime != -666 && g->bouncetime != bouncetime) || // different event bouncetime used
|
483
|
-
(g->thread_added)) // event already added
|
484
|
-
return 1;
|
485
|
-
} else {
|
486
|
-
return 1;
|
487
|
-
}
|
488
|
-
|
489
|
-
// create epfd_thread if not already open
|
490
|
-
if ((epfd_thread == -1) && ((epfd_thread = epoll_create(1)) == -1))
|
491
|
-
return 2;
|
492
|
-
|
493
|
-
// add to epoll fd
|
494
|
-
ev.events = EPOLLIN | EPOLLET | EPOLLPRI;
|
495
|
-
ev.data.fd = g->value_fd;
|
496
|
-
if (epoll_ctl(epfd_thread, EPOLL_CTL_ADD, g->value_fd, &ev) == -1) {
|
497
|
-
remove_edge_detect(gpio);
|
498
|
-
return 2;
|
499
|
-
}
|
500
|
-
g->thread_added = 1;
|
501
|
-
|
502
|
-
// start poll thread if it is not already running
|
503
|
-
if (!thread_running) {
|
504
|
-
if (pthread_create(&threads, NULL, poll_thread, (void *)t) != 0) {
|
505
|
-
remove_edge_detect(gpio);
|
506
|
-
return 2;
|
507
|
-
}
|
508
|
-
}
|
509
|
-
return 0;
|
510
|
-
}
|
511
|
-
|
512
|
-
int blocking_wait_for_edge(unsigned int gpio, unsigned int edge, int bouncetime, int timeout)
|
513
|
-
// return values:
|
514
|
-
// 1 - Success (edge detected)
|
515
|
-
// 0 - Timeout
|
516
|
-
// -1 - Edge detection already added
|
517
|
-
// -2 - Other error
|
518
|
-
{
|
519
|
-
int n, ed;
|
520
|
-
struct epoll_event events, ev;
|
521
|
-
char buf;
|
522
|
-
struct gpios *g = NULL;
|
523
|
-
struct timeval tv_timenow;
|
524
|
-
unsigned long long timenow;
|
525
|
-
int finished = 0;
|
526
|
-
int initial_edge = 1;
|
527
|
-
|
528
|
-
if (callback_exists(gpio))
|
529
|
-
return -1;
|
530
|
-
|
531
|
-
// add gpio if it has not been added already
|
532
|
-
ed = gpio_event_added(gpio);
|
533
|
-
if (ed == (int)edge) { // get existing record
|
534
|
-
g = get_gpio(gpio);
|
535
|
-
if (g->bouncetime != -666 && g->bouncetime != bouncetime) {
|
536
|
-
return -1;
|
537
|
-
}
|
538
|
-
} else if (ed == NO_EDGE) { // not found so add event
|
539
|
-
if ((g = new_gpio(gpio)) == NULL) {
|
540
|
-
return -2;
|
541
|
-
}
|
542
|
-
gpio_set_edge(gpio, edge);
|
543
|
-
g->edge = edge;
|
544
|
-
g->bouncetime = bouncetime;
|
545
|
-
} else { // ed != edge - event for a different edge
|
546
|
-
g = get_gpio(gpio);
|
547
|
-
gpio_set_edge(gpio, edge);
|
548
|
-
g->edge = edge;
|
549
|
-
g->bouncetime = bouncetime;
|
550
|
-
g->initial_wait = 1;
|
551
|
-
}
|
552
|
-
|
553
|
-
// create epfd_blocking if not already open
|
554
|
-
if ((epfd_blocking == -1) && ((epfd_blocking = epoll_create(1)) == -1)) {
|
555
|
-
return -2;
|
556
|
-
}
|
557
|
-
|
558
|
-
// add to epoll fd
|
559
|
-
ev.events = EPOLLIN | EPOLLET | EPOLLPRI;
|
560
|
-
ev.data.fd = g->value_fd;
|
561
|
-
if (epoll_ctl(epfd_blocking, EPOLL_CTL_ADD, g->value_fd, &ev) == -1) {
|
562
|
-
return -2;
|
563
|
-
}
|
564
|
-
|
565
|
-
// wait for edge
|
566
|
-
while (!finished) {
|
567
|
-
n = epoll_wait(epfd_blocking, &events, 1, timeout);
|
568
|
-
if (n == -1) {
|
569
|
-
/* If a signal is received while we are waiting,
|
570
|
-
epoll_wait will return with an EINTR error.
|
571
|
-
Just try again in that case. */
|
572
|
-
if (errno == EINTR) {
|
573
|
-
continue;
|
574
|
-
}
|
575
|
-
epoll_ctl(epfd_blocking, EPOLL_CTL_DEL, g->value_fd, &ev);
|
576
|
-
return -2;
|
577
|
-
}
|
578
|
-
if (initial_edge) { // first time triggers with current state, so ignore
|
579
|
-
initial_edge = 0;
|
580
|
-
} else {
|
581
|
-
gettimeofday(&tv_timenow, NULL);
|
582
|
-
timenow = tv_timenow.tv_sec*1E6 + tv_timenow.tv_usec;
|
583
|
-
if (g->bouncetime == -666 || timenow - g->lastcall > (unsigned int)g->bouncetime*1000 || g->lastcall == 0 || g->lastcall > timenow) {
|
584
|
-
g->lastcall = timenow;
|
585
|
-
finished = 1;
|
586
|
-
}
|
587
|
-
}
|
588
|
-
}
|
589
|
-
|
590
|
-
// check event was valid
|
591
|
-
if (n > 0) {
|
592
|
-
lseek(events.data.fd, 0, SEEK_SET);
|
593
|
-
if ((read(events.data.fd, &buf, 1) != 1) || (events.data.fd != g->value_fd)) {
|
594
|
-
epoll_ctl(epfd_blocking, EPOLL_CTL_DEL, g->value_fd, &ev);
|
595
|
-
return -2;
|
596
|
-
}
|
597
|
-
}
|
598
|
-
|
599
|
-
epoll_ctl(epfd_blocking, EPOLL_CTL_DEL, g->value_fd, &ev);
|
600
|
-
if (n == 0) {
|
601
|
-
return 0; // timeout
|
602
|
-
} else {
|
603
|
-
return 1; // edge found
|
604
|
-
}
|
605
|
-
}
|