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 }
521