1 /* $NetBSD: usbhidaction.c,v 1.8 2002/06/11 06:06:21 itojun Exp $ */ 2 /* $FreeBSD$ */ 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 <dev/usb/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 } 521