1 #include <stdio.h>
2 #include <stdlib.h>
3 #include <string.h>
4 #include <stdint.h>
5 #include <dirent.h>
6 #include <fcntl.h>
7 #include <sys/ioctl.h>
8 #include <sys/inotify.h>
9 #include <sys/limits.h>
10 #include <sys/poll.h>
11 #include <linux/input.h>
12 #include <errno.h>
13 #include <unistd.h>
14
15 struct label {
16 const char *name;
17 int value;
18 };
19
20 #define LABEL(constant) { #constant, constant }
21 #define LABEL_END { NULL, -1 }
22
23 static struct label key_value_labels[] = {
24 { "UP", 0 },
25 { "DOWN", 1 },
26 { "REPEAT", 2 },
27 LABEL_END,
28 };
29
30 #include "input.h-labels.h"
31
32 #undef LABEL
33 #undef LABEL_END
34
35 static struct pollfd *ufds;
36 static char **device_names;
37 static int nfds;
38
39 enum {
40 PRINT_DEVICE_ERRORS = 1U << 0,
41 PRINT_DEVICE = 1U << 1,
42 PRINT_DEVICE_NAME = 1U << 2,
43 PRINT_DEVICE_INFO = 1U << 3,
44 PRINT_VERSION = 1U << 4,
45 PRINT_POSSIBLE_EVENTS = 1U << 5,
46 PRINT_INPUT_PROPS = 1U << 6,
47 PRINT_HID_DESCRIPTOR = 1U << 7,
48
49 PRINT_ALL_INFO = (1U << 8) - 1,
50
51 PRINT_LABELS = 1U << 16,
52 };
53
get_label(const struct label * labels,int value)54 static const char *get_label(const struct label *labels, int value)
55 {
56 while(labels->name && value != labels->value) {
57 labels++;
58 }
59 return labels->name;
60 }
61
print_input_props(int fd)62 static int print_input_props(int fd)
63 {
64 uint8_t bits[INPUT_PROP_CNT / 8];
65 int i, j;
66 int res;
67 int count;
68 const char *bit_label;
69
70 printf(" input props:\n");
71 res = ioctl(fd, EVIOCGPROP(sizeof(bits)), bits);
72 if(res < 0) {
73 printf(" <not available\n");
74 return 1;
75 }
76 count = 0;
77 for(i = 0; i < res; i++) {
78 for(j = 0; j < 8; j++) {
79 if (bits[i] & 1 << j) {
80 bit_label = get_label(input_prop_labels, i * 8 + j);
81 if(bit_label)
82 printf(" %s\n", bit_label);
83 else
84 printf(" %04x\n", i * 8 + j);
85 count++;
86 }
87 }
88 }
89 if (!count)
90 printf(" <none>\n");
91 return 0;
92 }
93
print_possible_events(int fd,int print_flags)94 static int print_possible_events(int fd, int print_flags)
95 {
96 uint8_t *bits = NULL;
97 ssize_t bits_size = 0;
98 const char* label;
99 int i, j, k;
100 int res, res2;
101 struct label* bit_labels;
102 const char *bit_label;
103
104 printf(" events:\n");
105 for(i = EV_KEY; i <= EV_MAX; i++) { // skip EV_SYN since we cannot query its available codes
106 int count = 0;
107 while(1) {
108 res = ioctl(fd, EVIOCGBIT(i, bits_size), bits);
109 if(res < bits_size)
110 break;
111 bits_size = res + 16;
112 bits = realloc(bits, bits_size * 2);
113 if(bits == NULL) {
114 fprintf(stderr, "failed to allocate buffer of size %d\n", (int)bits_size);
115 return 1;
116 }
117 }
118 res2 = 0;
119 switch(i) {
120 case EV_KEY:
121 res2 = ioctl(fd, EVIOCGKEY(res), bits + bits_size);
122 label = "KEY";
123 bit_labels = key_labels;
124 break;
125 case EV_REL:
126 label = "REL";
127 bit_labels = rel_labels;
128 break;
129 case EV_ABS:
130 label = "ABS";
131 bit_labels = abs_labels;
132 break;
133 case EV_MSC:
134 label = "MSC";
135 bit_labels = msc_labels;
136 break;
137 case EV_LED:
138 res2 = ioctl(fd, EVIOCGLED(res), bits + bits_size);
139 label = "LED";
140 bit_labels = led_labels;
141 break;
142 case EV_SND:
143 res2 = ioctl(fd, EVIOCGSND(res), bits + bits_size);
144 label = "SND";
145 bit_labels = snd_labels;
146 break;
147 case EV_SW:
148 res2 = ioctl(fd, EVIOCGSW(bits_size), bits + bits_size);
149 label = "SW ";
150 bit_labels = sw_labels;
151 break;
152 case EV_REP:
153 label = "REP";
154 bit_labels = rep_labels;
155 break;
156 case EV_FF:
157 label = "FF ";
158 bit_labels = ff_labels;
159 break;
160 case EV_PWR:
161 label = "PWR";
162 bit_labels = NULL;
163 break;
164 case EV_FF_STATUS:
165 label = "FFS";
166 bit_labels = ff_status_labels;
167 break;
168 default:
169 res2 = 0;
170 label = "???";
171 bit_labels = NULL;
172 }
173 for(j = 0; j < res; j++) {
174 for(k = 0; k < 8; k++)
175 if(bits[j] & 1 << k) {
176 char down;
177 if(j < res2 && (bits[j + bits_size] & 1 << k))
178 down = '*';
179 else
180 down = ' ';
181 if(count == 0)
182 printf(" %s (%04x):", label, i);
183 else if((count & (print_flags & PRINT_LABELS ? 0x3 : 0x7)) == 0 || i == EV_ABS)
184 printf("\n ");
185 if(bit_labels && (print_flags & PRINT_LABELS)) {
186 bit_label = get_label(bit_labels, j * 8 + k);
187 if(bit_label)
188 printf(" %.20s%c%*s", bit_label, down, (int) (20 - strlen(bit_label)), "");
189 else
190 printf(" %04x%c ", j * 8 + k, down);
191 } else {
192 printf(" %04x%c", j * 8 + k, down);
193 }
194 if(i == EV_ABS) {
195 struct input_absinfo abs;
196 if(ioctl(fd, EVIOCGABS(j * 8 + k), &abs) == 0) {
197 printf(" : value %d, min %d, max %d, fuzz %d, flat %d, resolution %d",
198 abs.value, abs.minimum, abs.maximum, abs.fuzz, abs.flat,
199 abs.resolution);
200 }
201 }
202 count++;
203 }
204 }
205 if(count)
206 printf("\n");
207 }
208 free(bits);
209 return 0;
210 }
211
print_event(int type,int code,int value,int print_flags)212 static void print_event(int type, int code, int value, int print_flags)
213 {
214 const char *type_label, *code_label, *value_label;
215
216 if (print_flags & PRINT_LABELS) {
217 type_label = get_label(ev_labels, type);
218 code_label = NULL;
219 value_label = NULL;
220
221 switch(type) {
222 case EV_SYN:
223 code_label = get_label(syn_labels, code);
224 break;
225 case EV_KEY:
226 code_label = get_label(key_labels, code);
227 value_label = get_label(key_value_labels, value);
228 break;
229 case EV_REL:
230 code_label = get_label(rel_labels, code);
231 break;
232 case EV_ABS:
233 code_label = get_label(abs_labels, code);
234 switch(code) {
235 case ABS_MT_TOOL_TYPE:
236 value_label = get_label(mt_tool_labels, value);
237 }
238 break;
239 case EV_MSC:
240 code_label = get_label(msc_labels, code);
241 break;
242 case EV_LED:
243 code_label = get_label(led_labels, code);
244 break;
245 case EV_SND:
246 code_label = get_label(snd_labels, code);
247 break;
248 case EV_SW:
249 code_label = get_label(sw_labels, code);
250 break;
251 case EV_REP:
252 code_label = get_label(rep_labels, code);
253 break;
254 case EV_FF:
255 code_label = get_label(ff_labels, code);
256 break;
257 case EV_FF_STATUS:
258 code_label = get_label(ff_status_labels, code);
259 break;
260 }
261
262 if (type_label)
263 printf("%-12.12s", type_label);
264 else
265 printf("%04x ", type);
266 if (code_label)
267 printf(" %-20.20s", code_label);
268 else
269 printf(" %04x ", code);
270 if (value_label)
271 printf(" %-20.20s", value_label);
272 else
273 printf(" %08x ", value);
274 } else {
275 printf("%04x %04x %08x", type, code, value);
276 }
277 }
278
print_hid_descriptor(int bus,int vendor,int product)279 static void print_hid_descriptor(int bus, int vendor, int product)
280 {
281 const char *dirname = "/sys/kernel/debug/hid";
282 char prefix[16];
283 DIR *dir;
284 struct dirent *de;
285 char filename[PATH_MAX];
286 FILE *file;
287 char line[2048];
288
289 snprintf(prefix, sizeof(prefix), "%04X:%04X:%04X.", bus, vendor, product);
290
291 dir = opendir(dirname);
292 if(dir == NULL)
293 return;
294 while((de = readdir(dir))) {
295 if (strstr(de->d_name, prefix) == de->d_name) {
296 snprintf(filename, sizeof(filename), "%s/%s/rdesc", dirname, de->d_name);
297
298 file = fopen(filename, "r");
299 if (file) {
300 printf(" HID descriptor: %s\n\n", de->d_name);
301 while (fgets(line, sizeof(line), file)) {
302 fputs(" ", stdout);
303 fputs(line, stdout);
304 }
305 fclose(file);
306 puts("");
307 }
308 }
309 }
310 closedir(dir);
311 }
312
open_device(const char * device,int print_flags)313 static int open_device(const char *device, int print_flags)
314 {
315 int version;
316 int fd;
317 int clkid = CLOCK_MONOTONIC;
318 struct pollfd *new_ufds;
319 char **new_device_names;
320 char name[80];
321 char location[80];
322 char idstr[80];
323 struct input_id id;
324
325 fd = open(device, O_RDWR);
326 if(fd < 0) {
327 if(print_flags & PRINT_DEVICE_ERRORS)
328 fprintf(stderr, "could not open %s, %s\n", device, strerror(errno));
329 return -1;
330 }
331
332 if(ioctl(fd, EVIOCGVERSION, &version)) {
333 if(print_flags & PRINT_DEVICE_ERRORS)
334 fprintf(stderr, "could not get driver version for %s, %s\n", device, strerror(errno));
335 return -1;
336 }
337 if(ioctl(fd, EVIOCGID, &id)) {
338 if(print_flags & PRINT_DEVICE_ERRORS)
339 fprintf(stderr, "could not get driver id for %s, %s\n", device, strerror(errno));
340 return -1;
341 }
342 name[sizeof(name) - 1] = '\0';
343 location[sizeof(location) - 1] = '\0';
344 idstr[sizeof(idstr) - 1] = '\0';
345 if(ioctl(fd, EVIOCGNAME(sizeof(name) - 1), &name) < 1) {
346 //fprintf(stderr, "could not get device name for %s, %s\n", device, strerror(errno));
347 name[0] = '\0';
348 }
349 if(ioctl(fd, EVIOCGPHYS(sizeof(location) - 1), &location) < 1) {
350 //fprintf(stderr, "could not get location for %s, %s\n", device, strerror(errno));
351 location[0] = '\0';
352 }
353 if(ioctl(fd, EVIOCGUNIQ(sizeof(idstr) - 1), &idstr) < 1) {
354 //fprintf(stderr, "could not get idstring for %s, %s\n", device, strerror(errno));
355 idstr[0] = '\0';
356 }
357
358 if (ioctl(fd, EVIOCSCLOCKID, &clkid) != 0) {
359 fprintf(stderr, "Can't enable monotonic clock reporting: %s\n", strerror(errno));
360 // a non-fatal error
361 }
362
363 new_ufds = realloc(ufds, sizeof(ufds[0]) * (nfds + 1));
364 if(new_ufds == NULL) {
365 fprintf(stderr, "out of memory\n");
366 return -1;
367 }
368 ufds = new_ufds;
369 new_device_names = realloc(device_names, sizeof(device_names[0]) * (nfds + 1));
370 if(new_device_names == NULL) {
371 fprintf(stderr, "out of memory\n");
372 return -1;
373 }
374 device_names = new_device_names;
375
376 if(print_flags & PRINT_DEVICE)
377 printf("add device %d: %s\n", nfds, device);
378 if(print_flags & PRINT_DEVICE_INFO)
379 printf(" bus: %04x\n"
380 " vendor %04x\n"
381 " product %04x\n"
382 " version %04x\n",
383 id.bustype, id.vendor, id.product, id.version);
384 if(print_flags & PRINT_DEVICE_NAME)
385 printf(" name: \"%s\"\n", name);
386 if(print_flags & PRINT_DEVICE_INFO)
387 printf(" location: \"%s\"\n"
388 " id: \"%s\"\n", location, idstr);
389 if(print_flags & PRINT_VERSION)
390 printf(" version: %d.%d.%d\n",
391 version >> 16, (version >> 8) & 0xff, version & 0xff);
392
393 if(print_flags & PRINT_POSSIBLE_EVENTS) {
394 print_possible_events(fd, print_flags);
395 }
396
397 if(print_flags & PRINT_INPUT_PROPS) {
398 print_input_props(fd);
399 }
400 if(print_flags & PRINT_HID_DESCRIPTOR) {
401 print_hid_descriptor(id.bustype, id.vendor, id.product);
402 }
403
404 ufds[nfds].fd = fd;
405 ufds[nfds].events = POLLIN;
406 device_names[nfds] = strdup(device);
407 nfds++;
408
409 return 0;
410 }
411
close_device(const char * device,int print_flags)412 int close_device(const char *device, int print_flags)
413 {
414 int i;
415 for(i = 1; i < nfds; i++) {
416 if(strcmp(device_names[i], device) == 0) {
417 int count = nfds - i - 1;
418 if(print_flags & PRINT_DEVICE)
419 printf("remove device %d: %s\n", i, device);
420 free(device_names[i]);
421 memmove(device_names + i, device_names + i + 1, sizeof(device_names[0]) * count);
422 memmove(ufds + i, ufds + i + 1, sizeof(ufds[0]) * count);
423 nfds--;
424 return 0;
425 }
426 }
427 if(print_flags & PRINT_DEVICE_ERRORS)
428 fprintf(stderr, "remote device: %s not found\n", device);
429 return -1;
430 }
431
read_notify(const char * dirname,int nfd,int print_flags)432 static int read_notify(const char *dirname, int nfd, int print_flags)
433 {
434 int res;
435 char devname[PATH_MAX];
436 char *filename;
437 char event_buf[512];
438 int event_size;
439 int event_pos = 0;
440 struct inotify_event *event;
441
442 res = read(nfd, event_buf, sizeof(event_buf));
443 if(res < (int)sizeof(*event)) {
444 if(errno == EINTR)
445 return 0;
446 fprintf(stderr, "could not get event, %s\n", strerror(errno));
447 return 1;
448 }
449 //printf("got %d bytes of event information\n", res);
450
451 strcpy(devname, dirname);
452 filename = devname + strlen(devname);
453 *filename++ = '/';
454
455 while(res >= (int)sizeof(*event)) {
456 event = (struct inotify_event *)(event_buf + event_pos);
457 //printf("%d: %08x \"%s\"\n", event->wd, event->mask, event->len ? event->name : "");
458 if(event->len) {
459 strcpy(filename, event->name);
460 if(event->mask & IN_CREATE) {
461 open_device(devname, print_flags);
462 }
463 else {
464 close_device(devname, print_flags);
465 }
466 }
467 event_size = sizeof(*event) + event->len;
468 res -= event_size;
469 event_pos += event_size;
470 }
471 return 0;
472 }
473
scan_dir(const char * dirname,int print_flags)474 static int scan_dir(const char *dirname, int print_flags)
475 {
476 char devname[PATH_MAX];
477 char *filename;
478 DIR *dir;
479 struct dirent *de;
480 dir = opendir(dirname);
481 if(dir == NULL)
482 return -1;
483 strcpy(devname, dirname);
484 filename = devname + strlen(devname);
485 *filename++ = '/';
486 while((de = readdir(dir))) {
487 if(de->d_name[0] == '.' &&
488 (de->d_name[1] == '\0' ||
489 (de->d_name[1] == '.' && de->d_name[2] == '\0')))
490 continue;
491 strcpy(filename, de->d_name);
492 open_device(devname, print_flags);
493 }
494 closedir(dir);
495 return 0;
496 }
497
usage(char * name)498 static void usage(char *name)
499 {
500 fprintf(stderr, "Usage: %s [-t] [-n] [-s switchmask] [-S] [-v [mask]] [-d] [-p] [-i] [-l] [-q] [-c count] [-r] [device]\n", name);
501 fprintf(stderr, " -t: show time stamps\n");
502 fprintf(stderr, " -n: don't print newlines\n");
503 fprintf(stderr, " -s: print switch states for given bits\n");
504 fprintf(stderr, " -S: print all switch states\n");
505 fprintf(stderr, " -v: verbosity mask (errs=1, dev=2, name=4, info=8, vers=16, pos. events=32, props=64)\n");
506 fprintf(stderr, " -d: show HID descriptor, if available\n");
507 fprintf(stderr, " -p: show possible events (errs, dev, name, pos. events)\n");
508 fprintf(stderr, " -i: show all device info and possible events\n");
509 fprintf(stderr, " -l: label event types and names in plain text\n");
510 fprintf(stderr, " -q: quiet (clear verbosity mask)\n");
511 fprintf(stderr, " -c: print given number of events then exit\n");
512 fprintf(stderr, " -r: print rate events are received\n");
513 }
514
getevent_main(int argc,char * argv[])515 int getevent_main(int argc, char *argv[])
516 {
517 int c;
518 int i;
519 int res;
520 int get_time = 0;
521 int print_device = 0;
522 char *newline = "\n";
523 uint16_t get_switch = 0;
524 struct input_event event;
525 int print_flags = 0;
526 int print_flags_set = 0;
527 int dont_block = -1;
528 int event_count = 0;
529 int sync_rate = 0;
530 int64_t last_sync_time = 0;
531 const char *device = NULL;
532 const char *device_path = "/dev/input";
533
534 opterr = 0;
535 do {
536 c = getopt(argc, argv, "tns:Sv::dpilqc:rh");
537 if (c == EOF)
538 break;
539 switch (c) {
540 case 't':
541 get_time = 1;
542 break;
543 case 'n':
544 newline = "";
545 break;
546 case 's':
547 get_switch = strtoul(optarg, NULL, 0);
548 if(dont_block == -1)
549 dont_block = 1;
550 break;
551 case 'S':
552 get_switch = ~0;
553 if(dont_block == -1)
554 dont_block = 1;
555 break;
556 case 'v':
557 if(optarg)
558 print_flags |= strtoul(optarg, NULL, 0);
559 else
560 print_flags |= PRINT_DEVICE | PRINT_DEVICE_NAME | PRINT_DEVICE_INFO | PRINT_VERSION;
561 print_flags_set = 1;
562 break;
563 case 'd':
564 print_flags |= PRINT_HID_DESCRIPTOR;
565 break;
566 case 'p':
567 print_flags |= PRINT_DEVICE_ERRORS | PRINT_DEVICE
568 | PRINT_DEVICE_NAME | PRINT_POSSIBLE_EVENTS | PRINT_INPUT_PROPS;
569 print_flags_set = 1;
570 if(dont_block == -1)
571 dont_block = 1;
572 break;
573 case 'i':
574 print_flags |= PRINT_ALL_INFO;
575 print_flags_set = 1;
576 if(dont_block == -1)
577 dont_block = 1;
578 break;
579 case 'l':
580 print_flags |= PRINT_LABELS;
581 break;
582 case 'q':
583 print_flags_set = 1;
584 break;
585 case 'c':
586 event_count = atoi(optarg);
587 dont_block = 0;
588 break;
589 case 'r':
590 sync_rate = 1;
591 break;
592 case '?':
593 fprintf(stderr, "%s: invalid option -%c\n",
594 argv[0], optopt);
595 case 'h':
596 usage(argv[0]);
597 exit(1);
598 }
599 } while (1);
600 if(dont_block == -1)
601 dont_block = 0;
602
603 if (optind + 1 == argc) {
604 device = argv[optind];
605 optind++;
606 }
607 if (optind != argc) {
608 usage(argv[0]);
609 exit(1);
610 }
611 nfds = 1;
612 ufds = calloc(1, sizeof(ufds[0]));
613 ufds[0].fd = inotify_init();
614 ufds[0].events = POLLIN;
615 if(device) {
616 if(!print_flags_set)
617 print_flags |= PRINT_DEVICE_ERRORS;
618 res = open_device(device, print_flags);
619 if(res < 0) {
620 return 1;
621 }
622 } else {
623 if(!print_flags_set)
624 print_flags |= PRINT_DEVICE_ERRORS | PRINT_DEVICE | PRINT_DEVICE_NAME;
625 print_device = 1;
626 res = inotify_add_watch(ufds[0].fd, device_path, IN_DELETE | IN_CREATE);
627 if(res < 0) {
628 fprintf(stderr, "could not add watch for %s, %s\n", device_path, strerror(errno));
629 return 1;
630 }
631 res = scan_dir(device_path, print_flags);
632 if(res < 0) {
633 fprintf(stderr, "scan dir failed for %s\n", device_path);
634 return 1;
635 }
636 }
637
638 if(get_switch) {
639 for(i = 1; i < nfds; i++) {
640 uint16_t sw;
641 res = ioctl(ufds[i].fd, EVIOCGSW(1), &sw);
642 if(res < 0) {
643 fprintf(stderr, "could not get switch state, %s\n", strerror(errno));
644 return 1;
645 }
646 sw &= get_switch;
647 printf("%04x%s", sw, newline);
648 }
649 }
650
651 if(dont_block)
652 return 0;
653
654 while(1) {
655 //int pollres =
656 poll(ufds, nfds, -1);
657 //printf("poll %d, returned %d\n", nfds, pollres);
658 if(ufds[0].revents & POLLIN) {
659 read_notify(device_path, ufds[0].fd, print_flags);
660 }
661 for(i = 1; i < nfds; i++) {
662 if(ufds[i].revents) {
663 if(ufds[i].revents & POLLIN) {
664 res = read(ufds[i].fd, &event, sizeof(event));
665 if(res < (int)sizeof(event)) {
666 fprintf(stderr, "could not get event\n");
667 return 1;
668 }
669 if(get_time) {
670 printf("[%8ld.%06ld] ", event.time.tv_sec, event.time.tv_usec);
671 }
672 if(print_device)
673 printf("%s: ", device_names[i]);
674 print_event(event.type, event.code, event.value, print_flags);
675 if(sync_rate && event.type == 0 && event.code == 0) {
676 int64_t now = event.time.tv_sec * 1000000LL + event.time.tv_usec;
677 if(last_sync_time)
678 printf(" rate %lld", 1000000LL / (now - last_sync_time));
679 last_sync_time = now;
680 }
681 printf("%s", newline);
682 if(event_count && --event_count == 0)
683 return 0;
684 }
685 }
686 }
687 }
688
689 return 0;
690 }
691