?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
libc/nls: Sync with FreeBSD.
[dragonfly.git] / usr.bin / usbhidaction / usbhidaction.c
blob6cebed459305d36ba32af85b02f805144bcba724
1 /* $NetBSD: usbhidaction.c,v 1.8 2002/06/11 06:06:21 itojun Exp $ */
2 /* $FreeBSD: head/usr.bin/usbhidaction/usbhidaction.c 227195 2011-11-06 08:18:23Z ed $ */
3
4 /*
5 * Copyright (c) 2000, 2002 The NetBSD Foundation, Inc.
6 * All rights reserved.
7 *
8 * This code is derived from software contributed to The NetBSD Foundation
9 * by Lennart Augustsson <lennart@augustsson.net>.
10 *
11 * Redistribution and use in source and binary forms, with or without
12 * modification, are permitted provided that the following conditions
13 * are met:
14 * 1. Redistributions of source code must retain the above copyright
15 * notice, this list of conditions and the following disclaimer.
16 * 2. Redistributions in binary form must reproduce the above copyright
17 * notice, this list of conditions and the following disclaimer in the
18 * documentation and/or other materials provided with the distribution.
19 *
20 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
24 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 * POSSIBILITY OF SUCH DAMAGE.
31 */
32
33 #include <stdio.h>
34 #include <stdlib.h>
35 #include <string.h>
36 #include <ctype.h>
37 #include <err.h>
38 #include <fcntl.h>
39 #include <limits.h>
40 #include <unistd.h>
41 #include <sys/types.h>
42 #include <bus/u4b/usbhid.h>
43 #include <usbhid.h>
44 #include <syslog.h>
45 #include <signal.h>
46 #include <errno.h>
47 #include <sys/stat.h>
48
49 static int verbose = 0;
50 static int isdemon = 0;
51 static int reparse = 1;
52 static const char * pidfile = "/var/run/usbaction.pid";
53
54 struct command {
55 struct command *next;
56 int line;
57
58 struct hid_item item;
59 int value;
60 int lastseen;
61 int lastused;
62 int debounce;
63 char anyvalue;
64 char *name;
65 char *action;
66 };
67 static struct command *commands;
68
69 #define SIZE 4000
70
71 void usage(void);
72 struct command *parse_conf(const char *, report_desc_t, int, int);
73 void docmd(struct command *, int, const char *, int, char **);
74 void freecommands(struct command *);
75
76 static void
77 sighup(int sig __unused)
78 {
79 reparse = 1;
80 }
81
82 int
83 main(int argc, char **argv)
84 {
85 const char *conf = NULL;
86 const char *dev = NULL;
87 const char *table = NULL;
88 int fd, fp, ch, n, val, i;
89 size_t sz, sz1;
90 int demon, ignore, dieearly;
91 report_desc_t repd;
92 char buf[100];
93 char devnamebuf[PATH_MAX];
94 struct command *cmd;
95 int reportid = -1;
96
97 demon = 1;
98 ignore = 0;
99 dieearly = 0;
100 while ((ch = getopt(argc, argv, "c:def:ip:r:t:v")) != -1) {
101 switch(ch) {
102 case 'c':
103 conf = optarg;
104 break;
105 case 'd':
106 demon ^= 1;
107 break;
108 case 'e':
109 dieearly = 1;
110 break;
111 case 'i':
112 ignore++;
113 break;
114 case 'f':
115 dev = optarg;
116 break;
117 case 'p':
118 pidfile = optarg;
119 break;
120 case 'r':
121 reportid = atoi(optarg);
122 break;
123 case 't':
124 table = optarg;
125 break;
126 case 'v':
127 demon = 0;
128 verbose++;
129 break;
130 case '?':
131 default:
132 usage();
133 }
134 }
135 argc -= optind;
136 argv += optind;
137
138 if (conf == NULL || dev == NULL)
139 usage();
140
141 hid_init(table);
142
143 if (dev[0] != '/') {
144 snprintf(devnamebuf, sizeof(devnamebuf), "/dev/%s%s",
145 isdigit(dev[0]) ? "uhid" : "", dev);
146 dev = devnamebuf;
147 }
148
149 fd = open(dev, O_RDWR);
150 if (fd < 0)
151 err(1, "%s", dev);
152 repd = hid_get_report_desc(fd);
153 if (repd == NULL)
154 err(1, "hid_get_report_desc() failed");
155
156 commands = parse_conf(conf, repd, reportid, ignore);
157
158 sz = (size_t)hid_report_size(repd, hid_input, -1);
159
160 if (verbose)
161 printf("report size %zu\n", sz);
162 if (sz > sizeof buf)
163 errx(1, "report too large");
164
165 (void)signal(SIGHUP, sighup);
166
167 if (demon) {
168 fp = open(pidfile, O_WRONLY|O_CREAT, S_IRUSR|S_IRGRP|S_IROTH);
169 if (fp >= 0) {
170 sz1 = snprintf(buf, sizeof buf, "%ld\n",
171 (long)getpid());
172 if (sz1 > sizeof buf)
173 sz1 = sizeof buf;
174 write(fp, buf, sz1);
175 close(fp);
176 } else
177 err(1, "%s", pidfile);
178 if (daemon(0, 0) < 0)
179 err(1, "daemon()");
180 isdemon = 1;
181 }
182
183 for(;;) {
184 n = read(fd, buf, sz);
185 if (verbose > 2) {
186 printf("read %d bytes:", n);
187 for (i = 0; i < n; i++)
188 printf(" %02x", buf[i]);
189 printf("\n");
190 }
191 if (n < 0) {
192 if (verbose)
193 err(1, "read");
194 else
195 exit(1);
196 }
197 #if 0
198 if (n != sz) {
199 err(2, "read size");
200 }
201 #endif
202 for (cmd = commands; cmd; cmd = cmd->next) {
203 if (cmd->item.report_ID != 0 &&
204 buf[0] != cmd->item.report_ID)
205 continue;
206 if (cmd->item.flags & HIO_VARIABLE)
207 val = hid_get_data(buf, &cmd->item);
208 else {
209 uint32_t pos = cmd->item.pos;
210 for (i = 0; i < cmd->item.report_count; i++) {
211 val = hid_get_data(buf, &cmd->item);
212 if (val == cmd->value)
213 break;
214 cmd->item.pos += cmd->item.report_size;
215 }
216 cmd->item.pos = pos;
217 val = (i < cmd->item.report_count) ?
218 cmd->value : -1;
219 }
220 if (cmd->value != val && cmd->anyvalue == 0)
221 goto next;
222 if ((cmd->debounce == 0) ||
223 ((cmd->debounce == 1) && ((cmd->lastseen == -1) ||
224 (cmd->lastseen != val)))) {
225 docmd(cmd, val, dev, argc, argv);
226 goto next;
227 }
228 if ((cmd->debounce > 1) &&
229 ((cmd->lastused == -1) ||
230 (abs(cmd->lastused - val) >= cmd->debounce))) {
231 docmd(cmd, val, dev, argc, argv);
232 cmd->lastused = val;
233 goto next;
234 }
235 next:
236 cmd->lastseen = val;
237 }
238
239 if (dieearly)
240 exit(0);
241
242 if (reparse) {
243 struct command *cmds =
244 parse_conf(conf, repd, reportid, ignore);
245 if (cmds) {
246 freecommands(commands);
247 commands = cmds;
248 }
249 reparse = 0;
250 }
251 }
252
253 exit(0);
254 }
255
256 void
257 usage(void)
258 {
259
260 fprintf(stderr, "Usage: %s [-deiv] -c config_file -f hid_dev "
261 "[-p pidfile] [-t tablefile]\n", getprogname());
262 exit(1);
263 }
264
265 static int
266 peek(FILE *f)
267 {
268 int c;
269
270 c = getc(f);
271 if (c != EOF)
272 ungetc(c, f);
273 return c;
274 }
275
276 struct command *
277 parse_conf(const char *conf, report_desc_t repd, int reportid, int ignore)
278 {
279 FILE *f;
280 char *p;
281 int line;
282 char buf[SIZE], name[SIZE], value[SIZE], debounce[SIZE], action[SIZE];
283 char usbuf[SIZE], coll[SIZE], *tmp;
284 struct command *cmd, *cmds;
285 struct hid_data *d;
286 struct hid_item h;
287 int inst, cinst, u, lo, hi, range, t;
288
289 f = fopen(conf, "r");
290 if (f == NULL)
291 err(1, "%s", conf);
292
293 cmds = NULL;
294 for (line = 1; ; line++) {
295 if (fgets(buf, sizeof buf, f) == NULL)
296 break;
297 if (buf[0] == '#' || buf[0] == '\n')
298 continue;
299 p = strchr(buf, '\n');
300 while (p && isspace(peek(f))) {
301 if (fgets(p, sizeof buf - strlen(buf), f) == NULL)
302 break;
303 p = strchr(buf, '\n');
304 }
305 if (p)
306 *p = 0;
307 if (sscanf(buf, "%s %s %s %[^\n]",
308 name, value, debounce, action) != 4) {
309 if (isdemon) {
310 syslog(LOG_WARNING, "config file `%s', line %d"
311 ", syntax error: %s", conf, line, buf);
312 freecommands(cmds);
313 return (NULL);
314 } else {
315 errx(1, "config file `%s', line %d,"
316 ", syntax error: %s", conf, line, buf);
317 }
318 }
319 tmp = strchr(name, '#');
320 if (tmp != NULL) {
321 *tmp = 0;
322 inst = atoi(tmp + 1);
323 } else
324 inst = 0;
325
326 cmd = malloc(sizeof *cmd);
327 if (cmd == NULL)
328 err(1, "malloc failed");
329 cmd->next = cmds;
330 cmds = cmd;
331 cmd->line = line;
332
333 if (strcmp(value, "*") == 0) {
334 cmd->anyvalue = 1;
335 } else {
336 cmd->anyvalue = 0;
337 if (sscanf(value, "%d", &cmd->value) != 1) {
338 if (isdemon) {
339 syslog(LOG_WARNING,
340 "config file `%s', line %d, "
341 "bad value: %s (should be * or a number)\n",
342 conf, line, value);
343 freecommands(cmds);
344 return (NULL);
345 } else {
346 errx(1, "config file `%s', line %d, "
347 "bad value: %s (should be * or a number)\n",
348 conf, line, value);
349 }
350 }
351 }
352
353 if (sscanf(debounce, "%d", &cmd->debounce) != 1) {
354 if (isdemon) {
355 syslog(LOG_WARNING,
356 "config file `%s', line %d, "
357 "bad value: %s (should be a number >= 0)\n",
358 conf, line, debounce);
359 freecommands(cmds);
360 return (NULL);
361 } else {
362 errx(1, "config file `%s', line %d, "
363 "bad value: %s (should be a number >= 0)\n",
364 conf, line, debounce);
365 }
366 }
367
368 coll[0] = 0;
369 cinst = 0;
370 for (d = hid_start_parse(repd, 1 << hid_input, reportid);
371 hid_get_item(d, &h); ) {
372 if (verbose > 2)
373 printf("kind=%d usage=%x\n", h.kind, h.usage);
374 if (h.flags & HIO_CONST)
375 continue;
376 switch (h.kind) {
377 case hid_input:
378 if (h.usage_minimum != 0 ||
379 h.usage_maximum != 0) {
380 lo = h.usage_minimum;
381 hi = h.usage_maximum;
382 range = 1;
383 } else {
384 lo = h.usage;
385 hi = h.usage;
386 range = 0;
387 }
388 for (u = lo; u <= hi; u++) {
389 if (coll[0]) {
390 snprintf(usbuf, sizeof usbuf,
391 "%s.%s:%s", coll+1,
392 hid_usage_page(HID_PAGE(u)),
393 hid_usage_in_page(u));
394 } else {
395 snprintf(usbuf, sizeof usbuf,
396 "%s:%s",
397 hid_usage_page(HID_PAGE(u)),
398 hid_usage_in_page(u));
399 }
400 if (verbose > 2)
401 printf("usage %s\n", usbuf);
402 t = strlen(usbuf) - strlen(name);
403 if (t > 0) {
404 if (strcmp(usbuf + t, name))
405 continue;
406 if (usbuf[t - 1] != '.')
407 continue;
408 } else if (strcmp(usbuf, name))
409 continue;
410 if (inst == cinst++)
411 goto foundhid;
412 }
413 break;
414 case hid_collection:
415 snprintf(coll + strlen(coll),
416 sizeof coll - strlen(coll), ".%s:%s",
417 hid_usage_page(HID_PAGE(h.usage)),
418 hid_usage_in_page(h.usage));
419 break;
420 case hid_endcollection:
421 if (coll[0])
422 *strrchr(coll, '.') = 0;
423 break;
424 default:
425 break;
426 }
427 }
428 if (ignore) {
429 if (verbose)
430 warnx("ignore item '%s'", name);
431 continue;
432 }
433 if (isdemon) {
434 syslog(LOG_WARNING, "config file `%s', line %d, HID "
435 "item not found: `%s'\n", conf, line, name);
436 freecommands(cmds);
437 return (NULL);
438 } else {
439 errx(1, "config file `%s', line %d, HID item "
440 "not found: `%s'\n", conf, line, name);
441 }
442
443 foundhid:
444 hid_end_parse(d);
445 cmd->lastseen = -1;
446 cmd->lastused = -1;
447 cmd->item = h;
448 cmd->name = strdup(name);
449 cmd->action = strdup(action);
450 if (range) {
451 if (cmd->value == 1)
452 cmd->value = u - lo;
453 else
454 cmd->value = -1;
455 }
456
457 if (verbose)
458 printf("PARSE:%d %s, %d, '%s'\n", cmd->line, name,
459 cmd->value, cmd->action);
460 }
461 fclose(f);
462 return (cmds);
463 }
464
465 void
466 docmd(struct command *cmd, int value, const char *hid, int argc, char **argv)
467 {
468 char cmdbuf[SIZE], *p, *q;
469 size_t len;
470 int n, r;
471
472 for (p = cmd->action, q = cmdbuf; *p && q < &cmdbuf[SIZE-1]; ) {
473 if (*p == '$') {
474 p++;
475 len = &cmdbuf[SIZE-1] - q;
476 if (isdigit(*p)) {
477 n = strtol(p, &p, 10) - 1;
478 if (n >= 0 && n < argc) {
479 strncpy(q, argv[n], len);
480 q += strlen(q);
481 }
482 } else if (*p == 'V') {
483 p++;
484 snprintf(q, len, "%d", value);
485 q += strlen(q);
486 } else if (*p == 'N') {
487 p++;
488 strncpy(q, cmd->name, len);
489 q += strlen(q);
490 } else if (*p == 'H') {
491 p++;
492 strncpy(q, hid, len);
493 q += strlen(q);
494 } else if (*p) {
495 *q++ = *p++;
496 }
497 } else {
498 *q++ = *p++;
499 }
500 }
501 *q = 0;
502
503 if (verbose)
504 printf("system '%s'\n", cmdbuf);
505 r = system(cmdbuf);
506 if (verbose > 1 && r)
507 printf("return code = 0x%x\n", r);
508 }
509
510 void
511 freecommands(struct command *cmd)
512 {
513 struct command *next;
514
515 while (cmd) {
516 next = cmd->next;
517 free(cmd);
518 cmd = next;
519 }
520 }
DragonFly BSD