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
122
123
124
125
|
/*
* Copyright (C) 2013 Paul Kocialkowski
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
#include <stdlib.h>
#include <unistd.h>
#include <stdint.h>
#include <fcntl.h>
#include <errno.h>
#include <dirent.h>
#include <linux/ioctl.h>
#include <linux/input.h>
#define LOG_TAG "piranha_sensors"
#include <utils/Log.h>
#include "piranha_sensors.h"
int64_t input_timestamp(struct input_event *event)
{
if (event == NULL)
return -1;
return event->time.tv_sec*1000000000LL + event->time.tv_usec*1000;
}
int input_open(char *name)
{
DIR *d;
struct dirent *di;
char input_name[80] = { 0 };
char path[PATH_MAX];
char *c;
int fd;
int rc;
if (name == NULL)
return -EINVAL;
d = opendir("/dev/input");
if (d == NULL)
return -1;
while ((di = readdir(d))) {
if (di == NULL || strcmp(di->d_name, ".") == 0 || strcmp(di->d_name, "..") == 0)
continue;
snprintf(path, PATH_MAX, "/dev/input/%s", di->d_name);
fd = open(path, O_RDONLY | O_NONBLOCK);
if (fd < 0)
continue;
rc = ioctl(fd, EVIOCGNAME(sizeof(input_name) - 1), &input_name);
if (rc < 0)
continue;
c = strstr((char *) &input_name, "\n");
if (c != NULL)
*c = '\0';
if (strcmp(input_name, name) == 0)
return fd;
else
close(fd);
}
return -1;
}
int sysfs_path_prefix(char *name, char *path_prefix)
{
DIR *d;
struct dirent *di;
char input_name[80] = { 0 };
char path[PATH_MAX];
char *c;
int fd;
if (name == NULL || path_prefix == NULL)
return -EINVAL;
d = opendir("/sys/class/input");
if (d == NULL)
return -1;
while ((di = readdir(d))) {
if (di == NULL || strcmp(di->d_name, ".") == 0 || strcmp(di->d_name, "..") == 0)
continue;
snprintf(path, PATH_MAX, "/sys/class/input/%s/name", di->d_name);
fd = open(path, O_RDONLY);
if (fd < 0)
continue;
read(fd, &input_name, sizeof(input_name));
close(fd);
c = strstr((char *) &input_name, "\n");
if (c != NULL)
*c = '\0';
if (strcmp(input_name, name) == 0) {
snprintf(path_prefix, PATH_MAX, "/sys/class/input/%s", di->d_name);
return 0;
}
}
return -1;
}
|
