Home | History | Annotate | Line # | Download | only in usbhidctl
usbhid.c revision 1.32
      1 /*	$NetBSD: usbhid.c,v 1.32 2006/10/22 06:16:37 dsainty Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2001 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by David Sainty <David.Sainty (at) dtsp.co.nz>
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  * 3. All advertising materials mentioning features or use of this software
     19  *    must display the following acknowledgement:
     20  *        This product includes software developed by the NetBSD
     21  *        Foundation, Inc. and its contributors.
     22  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  *    contributors may be used to endorse or promote products derived
     24  *    from this software without specific prior written permission.
     25  *
     26  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  * POSSIBILITY OF SUCH DAMAGE.
     37  */
     38 #include <sys/cdefs.h>
     39 
     40 #ifndef lint
     41 __RCSID("$NetBSD: usbhid.c,v 1.32 2006/10/22 06:16:37 dsainty Exp $");
     42 #endif
     43 
     44 #include <sys/types.h>
     45 
     46 #include <dev/usb/usb.h>
     47 #include <dev/usb/usbhid.h>
     48 
     49 #include <ctype.h>
     50 #include <err.h>
     51 #include <errno.h>
     52 #include <fcntl.h>
     53 #include <limits.h>
     54 #include <stdio.h>
     55 #include <stdlib.h>
     56 #include <string.h>
     57 #include <unistd.h>
     58 #include <usbhid.h>
     59 
     60 /*
     61  * Zero if not in a verbose mode.  Greater levels of verbosity
     62  * are indicated by values larger than one.
     63  */
     64 unsigned int verbose;
     65 
     66 /* Parser tokens */
     67 #define DELIM_USAGE '.'
     68 #define DELIM_PAGE ':'
     69 #define DELIM_SET '='
     70 #define DELIM_INSTANCE '#'
     71 
     72 static int reportid;
     73 
     74 struct Susbvar {
     75 	/* Variable name, not NUL terminated */
     76 	char const *variable;
     77 	size_t varlen;
     78 
     79 	char const *value; /* Value to set variable to */
     80 
     81 #define MATCH_ALL		(1 << 0)
     82 #define MATCH_COLLECTIONS	(1 << 1)
     83 #define MATCH_NODATA		(1 << 2)
     84 #define MATCH_CONSTANTS		(1 << 3)
     85 #define MATCH_WASMATCHED	(1 << 4)
     86 #define MATCH_SHOWPAGENAME	(1 << 5)
     87 #define MATCH_SHOWNUMERIC	(1 << 6)
     88 #define MATCH_WRITABLE		(1 << 7)
     89 #define MATCH_SHOWVALUES	(1 << 8)
     90 	unsigned int mflags;
     91 
     92 	/*
     93 	 * An instance number can be used to identify an item by
     94 	 * position as well as by name.  This allows us to manipulate
     95 	 * devices that don't assign unique names to all usage items.
     96 	 */
     97 	int usageinstance;
     98 
     99 	/* Workspace for hidmatch() */
    100 	ssize_t matchindex;
    101 	int matchcount;
    102 
    103 	int (*opfunc)(struct hid_item *item, struct Susbvar *var,
    104 		      u_int32_t const *collist, size_t collen, u_char *buf);
    105 };
    106 
    107 struct Sreport {
    108 	struct usb_ctl_report *buffer;
    109 
    110 	enum {srs_uninit, srs_clean, srs_dirty} status;
    111 	int use_getreport; /* Non-zero if we expect USB_GET_REPORT to work */
    112 	int report_id;
    113 	size_t size;
    114 };
    115 
    116 static struct {
    117 	int uhid_report;
    118 	hid_kind_t hid_kind;
    119 	char const *name;
    120 } const reptoparam[] = {
    121 #define REPORT_INPUT 0
    122 	{ UHID_INPUT_REPORT, hid_input, "input" },
    123 #define REPORT_OUTPUT 1
    124 	{ UHID_OUTPUT_REPORT, hid_output, "output" },
    125 #define REPORT_FEATURE 2
    126 	{ UHID_FEATURE_REPORT, hid_feature, "feature" }
    127 #define REPORT_MAXVAL 2
    128 };
    129 
    130 /*
    131  * Extract 16-bit unsigned usage ID from a numeric string.  Returns -1
    132  * if string failed to parse correctly.
    133  */
    134 static int
    135 strtousage(const char *nptr, size_t nlen)
    136 {
    137 	char *endptr;
    138 	long result;
    139 	char numstr[16];
    140 
    141 	if (nlen >= sizeof(numstr) || !isdigit((unsigned char)*nptr))
    142 		return -1;
    143 
    144 	/*
    145 	 * We use strtol() here, but unfortunately strtol() requires a
    146 	 * NUL terminated string - which we don't have - at least not
    147 	 * officially.
    148 	 */
    149 	memcpy(numstr, nptr, nlen);
    150 	numstr[nlen] = '\0';
    151 
    152 	result = strtol(numstr, &endptr, 0);
    153 
    154 	if (result < 0 || result > 0xffff || endptr != &numstr[nlen])
    155 		return -1;
    156 
    157 	return result;
    158 }
    159 
    160 struct usagedata {
    161 	char const *page_name;
    162 	char const *usage_name;
    163 	size_t page_len;
    164 	size_t usage_len;
    165 	int isfinal;
    166 	u_int32_t usage_id;
    167 };
    168 
    169 /*
    170  * Test a rule against the current usage data.  Returns -1 on no
    171  * match, 0 on partial match and 1 on complete match.
    172  */
    173 static int
    174 hidtestrule(struct Susbvar *var, struct usagedata *cache)
    175 {
    176 	char const *varname;
    177 	ssize_t matchindex, pagesplit;
    178 	size_t strind, varlen;
    179 	int numusage;
    180 	u_int32_t usage_id;
    181 
    182 	matchindex = var->matchindex;
    183 	varname = var->variable;
    184 	varlen = var->varlen;
    185 
    186 	usage_id = cache->usage_id;
    187 
    188 	/*
    189 	 * Parse the current variable name, locating the end of the
    190 	 * current 'usage', and possibly where the usage page name
    191 	 * ends.
    192 	 */
    193 	pagesplit = -1;
    194 	for (strind = matchindex; strind < varlen; strind++) {
    195 		if (varname[strind] == DELIM_USAGE)
    196 			break;
    197 		if (varname[strind] == DELIM_PAGE)
    198 			pagesplit = strind;
    199 	}
    200 
    201 	if (cache->isfinal && strind != varlen)
    202 		/*
    203 		 * Variable name is too long (hit delimiter instead of
    204 		 * end-of-variable).
    205 		 */
    206 		return -1;
    207 
    208 	if (pagesplit >= 0) {
    209 		/*
    210 		 * Page name was specified, determine whether it was
    211 		 * symbolic or numeric.
    212 		 */
    213 		char const *strstart;
    214 		int numpage;
    215 
    216 		strstart = &varname[matchindex];
    217 
    218 		numpage = strtousage(strstart, pagesplit - matchindex);
    219 
    220 		if (numpage >= 0) {
    221 			/* Valid numeric */
    222 
    223 			if (numpage != HID_PAGE(usage_id))
    224 				/* Numeric didn't match page ID */
    225 				return -1;
    226 		} else {
    227 			/* Not a valid numeric */
    228 
    229 			/*
    230 			 * Load and cache the page name if and only if
    231 			 * it hasn't already been loaded (it's a
    232 			 * fairly expensive operation).
    233 			 */
    234 			if (cache->page_name == NULL) {
    235 				cache->page_name = hid_usage_page(HID_PAGE(usage_id));
    236 				cache->page_len = strlen(cache->page_name);
    237 			}
    238 
    239 			/*
    240 			 * Compare specified page name to actual page
    241 			 * name.
    242 			 */
    243 			if (cache->page_len !=
    244 			    (size_t)(pagesplit - matchindex) ||
    245 			    memcmp(cache->page_name,
    246 				   &varname[matchindex],
    247 				   cache->page_len) != 0)
    248 				/* Mismatch, page name wrong */
    249 				return -1;
    250 		}
    251 
    252 		/* Page matches, discard page name */
    253 		matchindex = pagesplit + 1;
    254 	}
    255 
    256 	numusage = strtousage(&varname[matchindex], strind - matchindex);
    257 
    258 	if (numusage >= 0) {
    259 		/* Valid numeric */
    260 
    261 		if (numusage != HID_USAGE(usage_id))
    262 			/* Numeric didn't match usage ID */
    263 			return -1;
    264 	} else {
    265 		/* Not a valid numeric */
    266 
    267 		/* Load and cache the usage name */
    268 		if (cache->usage_name == NULL) {
    269 			cache->usage_name = hid_usage_in_page(usage_id);
    270 			cache->usage_len = strlen(cache->usage_name);
    271 		}
    272 
    273 		/*
    274 		 * Compare specified usage name to actual usage name
    275 		 */
    276 		if (cache->usage_len != (size_t)(strind - matchindex) ||
    277 		    memcmp(cache->usage_name, &varname[matchindex],
    278 			   cache->usage_len) != 0)
    279 			/* Mismatch, usage name wrong */
    280 			return -1;
    281 	}
    282 
    283 	if (cache->isfinal)
    284 		/* Match */
    285 		return 1;
    286 
    287 	/*
    288 	 * Partial match: Move index past this usage string +
    289 	 * delimiter
    290 	 */
    291 	var->matchindex = strind + 1;
    292 
    293 	return 0;
    294 }
    295 
    296 /*
    297  * Clear state in HID variable records used by hidmatch().
    298  */
    299 static void
    300 resethidvars(struct Susbvar *varlist, size_t vlsize)
    301 {
    302 	size_t vlind;
    303 	for (vlind = 0; vlind < vlsize; vlind++)
    304 		varlist[vlind].matchcount = 0;
    305 }
    306 
    307 /*
    308  * hidmatch() determines whether the item specified in 'item', and
    309  * nested within a hierarchy of collections specified in 'collist'
    310  * matches any of the rules in the list 'varlist'.  Returns the
    311  * matching rule on success, or NULL on no match.
    312  */
    313 static struct Susbvar*
    314 hidmatch(u_int32_t const *collist, size_t collen, struct hid_item *item,
    315 	 struct Susbvar *varlist, size_t vlsize)
    316 {
    317 	struct Susbvar *result;
    318 	size_t colind, vlactive, vlind;
    319 	int iscollection;
    320 
    321 	/*
    322 	 * Keep track of how many variables are still "active".  When
    323 	 * the active count reaches zero, don't bother to continue
    324 	 * looking for matches.
    325 	 */
    326 	vlactive = vlsize;
    327 
    328 	iscollection = item->kind == hid_collection ||
    329 		item->kind == hid_endcollection;
    330 
    331 	for (vlind = 0; vlind < vlsize; vlind++) {
    332 		struct Susbvar *var;
    333 
    334 		var = &varlist[vlind];
    335 
    336 		var->matchindex = 0;
    337 
    338 		if (!(var->mflags & MATCH_COLLECTIONS) && iscollection) {
    339 			/* Don't match collections for this variable */
    340 			var->matchindex = -1;
    341 			vlactive--;
    342 		} else if (!iscollection && !(var->mflags & MATCH_CONSTANTS) &&
    343 			   (item->flags & HIO_CONST)) {
    344 			/*
    345 			 * Don't match constants for this variable,
    346 			 * but ignore the constant bit on collections.
    347 			 */
    348 			var->matchindex = -1;
    349 			vlactive--;
    350 		} else if ((var->mflags & MATCH_WRITABLE) &&
    351 			   ((item->kind != hid_output &&
    352 			     item->kind != hid_feature) ||
    353 			    (item->flags & HIO_CONST))) {
    354 			/*
    355 			 * If we are only matching writable items, if
    356 			 * this is not an output or feature kind, or
    357 			 * it is a constant, reject it.
    358 			 */
    359 			var->matchindex = -1;
    360 			vlactive--;
    361 		} else if (var->mflags & MATCH_ALL) {
    362 			/* Match immediately */
    363 			return &varlist[vlind];
    364 		}
    365 	}
    366 
    367 	/*
    368 	 * Loop through each usage in the collection list, including
    369 	 * the 'item' itself on the final iteration.  For each usage,
    370 	 * test which variables named in the rule list are still
    371 	 * applicable - if any.
    372 	 */
    373 	result = NULL;
    374 	for (colind = 0; vlactive > 0 && colind <= collen; colind++) {
    375 		struct usagedata cache;
    376 
    377 		cache.page_len = 0;	/* XXX gcc */
    378 		cache.usage_len = 0;	/* XXX gcc */
    379 
    380 		cache.isfinal = (colind == collen);
    381 		if (cache.isfinal)
    382 			cache.usage_id = item->usage;
    383 		else
    384 			cache.usage_id = collist[colind];
    385 
    386 		cache.usage_name = NULL;
    387 		cache.page_name = NULL;
    388 
    389 		/*
    390 		 * Loop through each rule, testing whether the rule is
    391 		 * still applicable or not.  For each rule,
    392 		 * 'matchindex' retains the current match state as an
    393 		 * index into the variable name string, or -1 if this
    394 		 * rule has been proven not to match.
    395 		 */
    396 		for (vlind = 0; vlind < vlsize; vlind++) {
    397 			struct Susbvar *var;
    398 			int matchres;
    399 
    400 			var = &varlist[vlind];
    401 
    402 			if (var->matchindex < 0)
    403 				/* Mismatch at a previous level */
    404 				continue;
    405 
    406 			matchres = hidtestrule(var, &cache);
    407 
    408 			if (matchres == 0)
    409 				/* Partial match */
    410 				continue;
    411 
    412 			if (matchres > 0) {
    413 				/* Complete match */
    414 				if (var->usageinstance < 0 ||
    415 				    var->matchcount == var->usageinstance)
    416 					result = var;
    417 				var->matchcount++;
    418 			}
    419 
    420 			/*
    421 			 * We either matched completely, or not at
    422 			 * all.  Either way, this variable is no
    423 			 * longer active.
    424 			 */
    425 			var->matchindex = -1;
    426 			vlactive--;
    427 		}
    428 	}
    429 
    430 	return result;
    431 }
    432 
    433 static void
    434 allocreport(struct Sreport *report, report_desc_t rd, int repindex)
    435 {
    436 	int reptsize;
    437 
    438 	reptsize = hid_report_size(rd, reptoparam[repindex].hid_kind, reportid);
    439 	if (reptsize < 0)
    440 		errx(1, "Negative report size");
    441 	report->size = reptsize;
    442 
    443 	if (report->size > 0) {
    444 		/*
    445 		 * Allocate a buffer with enough space for the
    446 		 * report in the variable-sized data field.
    447 		 */
    448 		report->buffer = malloc(sizeof(*report->buffer) -
    449 					sizeof(report->buffer->ucr_data) +
    450 					report->size);
    451 		if (report->buffer == NULL)
    452 			err(1, NULL);
    453 	} else
    454 		report->buffer = NULL;
    455 
    456 	report->status = srs_clean;
    457 }
    458 
    459 static void
    460 freereport(struct Sreport *report)
    461 {
    462 	if (report->buffer != NULL)
    463 		free(report->buffer);
    464 	report->status = srs_uninit;
    465 }
    466 
    467 static void
    468 getreport(struct Sreport *report, int hidfd, report_desc_t rd, int repindex)
    469 {
    470 	if (report->status == srs_uninit) {
    471 		allocreport(report, rd, repindex);
    472 		if (report->size == 0)
    473 			return;
    474 
    475 		report->buffer->ucr_report = reptoparam[repindex].uhid_report;
    476 
    477 		if (report->use_getreport) {
    478 			if (ioctl(hidfd, USB_GET_REPORT, report->buffer) < 0)
    479 				err(1, "USB_GET_REPORT(%s) [probably not "
    480 				    "supported by device]",
    481 				    reptoparam[repindex].name);
    482 		} else {
    483 			memset(report->buffer->ucr_data, '\0', report->size);
    484 		}
    485 	}
    486 }
    487 
    488 static void
    489 setreport(struct Sreport *report, int hidfd, int repindex)
    490 {
    491 	if (report->status == srs_dirty) {
    492 		report->buffer->ucr_report = reptoparam[repindex].uhid_report;
    493 
    494 		if (ioctl(hidfd, USB_SET_REPORT, report->buffer) < 0)
    495 			err(1, "USB_SET_REPORT(%s)",
    496 			    reptoparam[repindex].name);
    497 
    498 		report->status = srs_clean;
    499 	}
    500 }
    501 
    502 /* ARGSUSED1 */
    503 static int
    504 varop_value(struct hid_item *item, struct Susbvar *var,
    505 	    u_int32_t const *collist, size_t collen, u_char *buf)
    506 {
    507 	printf("%d\n", hid_get_data(buf, item));
    508 	return 0;
    509 }
    510 
    511 /* ARGSUSED1 */
    512 static int
    513 varop_display(struct hid_item *item, struct Susbvar *var,
    514 	      u_int32_t const *collist, size_t collen, u_char *buf)
    515 {
    516 	size_t colitem;
    517 	int val, i;
    518 
    519 	for (i = 0; i < item->report_count; i++) {
    520 		for (colitem = 0; colitem < collen; colitem++) {
    521 			if (var->mflags & MATCH_SHOWPAGENAME)
    522 				printf("%s:",
    523 				    hid_usage_page(HID_PAGE(collist[colitem])));
    524 			printf("%s.", hid_usage_in_page(collist[colitem]));
    525 		}
    526 		if (var->mflags & MATCH_SHOWPAGENAME)
    527 			printf("%s:", hid_usage_page(HID_PAGE(item->usage)));
    528 		val = hid_get_data(buf, item);
    529 		item->pos += item->report_size;
    530 		if (item->usage_minimum != 0 || item->usage_maximum != 0) {
    531 			val += item->usage_minimum;
    532 			printf("%s=1", hid_usage_in_page(val));
    533 		} else {
    534 			printf("%s=%d%s", hid_usage_in_page(item->usage),
    535 			       val, item->flags & HIO_CONST ? " (const)" : "");
    536 		}
    537 		if (item->report_count > 1)
    538 			printf(" [%d]", i);
    539 		printf("\n");
    540 	}
    541 	return 0;
    542 }
    543 
    544 /* ARGSUSED1 */
    545 static int
    546 varop_modify(struct hid_item *item, struct Susbvar *var,
    547 	     u_int32_t const *collist, size_t collen, u_char *buf)
    548 {
    549 	u_int dataval;
    550 
    551 	dataval = (u_int)strtol(var->value, NULL, 10);
    552 
    553 	hid_set_data(buf, item, dataval);
    554 
    555 	if (var->mflags & MATCH_SHOWVALUES)
    556 		/* Display set value */
    557 		varop_display(item, var, collist, collen, buf);
    558 
    559 	return 1;
    560 }
    561 
    562 static void
    563 reportitem(char const *label, struct hid_item const *item, unsigned int mflags)
    564 {
    565 	int isconst = item->flags & HIO_CONST,
    566 	    isvar = item->flags & HIO_VARIABLE;
    567 	printf("%s size=%d count=%d%s%s page=%s", label,
    568 	       item->report_size, item->report_count,
    569 	       isconst ? " Const" : "",
    570 	       !isvar && !isconst ? " Array" : "",
    571 	       hid_usage_page(HID_PAGE(item->usage)));
    572 	if (item->usage_minimum != 0 || item->usage_maximum != 0) {
    573 		printf(" usage=%s..%s", hid_usage_in_page(item->usage_minimum),
    574 		       hid_usage_in_page(item->usage_maximum));
    575 		if (mflags & MATCH_SHOWNUMERIC)
    576 			printf(" (%u:0x%x..%u:0x%x)",
    577 			       HID_PAGE(item->usage_minimum),
    578 			       HID_USAGE(item->usage_minimum),
    579 			       HID_PAGE(item->usage_maximum),
    580 			       HID_USAGE(item->usage_maximum));
    581 	} else {
    582 		printf(" usage=%s", hid_usage_in_page(item->usage));
    583 		if (mflags & MATCH_SHOWNUMERIC)
    584 			printf(" (%u:0x%x)",
    585 			       HID_PAGE(item->usage), HID_USAGE(item->usage));
    586 	}
    587 	printf(", logical range %d..%d",
    588 	       item->logical_minimum, item->logical_maximum);
    589 	if (item->physical_minimum != item->physical_maximum)
    590 		printf(", physical range %d..%d",
    591 		       item->physical_minimum, item->physical_maximum);
    592 	if (item->unit)
    593 		printf(", unit=0x%02x exp=%d", item->unit,
    594 		       item->unit_exponent);
    595 	printf("\n");
    596 }
    597 
    598 /* ARGSUSED1 */
    599 static int
    600 varop_report(struct hid_item *item, struct Susbvar *var,
    601 	     u_int32_t const *collist, size_t collen, u_char *buf)
    602 {
    603 	switch (item->kind) {
    604 	case hid_collection:
    605 		printf("Collection page=%s usage=%s",
    606 		       hid_usage_page(HID_PAGE(item->usage)),
    607 		       hid_usage_in_page(item->usage));
    608 		if (var->mflags & MATCH_SHOWNUMERIC)
    609 			printf(" (%u:0x%x)\n",
    610 			       HID_PAGE(item->usage), HID_USAGE(item->usage));
    611 		else
    612 			printf("\n");
    613 		break;
    614 	case hid_endcollection:
    615 		printf("End collection\n");
    616 		break;
    617 	case hid_input:
    618 		reportitem("Input  ", item, var->mflags);
    619 		break;
    620 	case hid_output:
    621 		reportitem("Output ", item, var->mflags);
    622 		break;
    623 	case hid_feature:
    624 		reportitem("Feature", item, var->mflags);
    625 		break;
    626 	}
    627 
    628 	return 0;
    629 }
    630 
    631 static void
    632 devloop(int hidfd, report_desc_t rd, struct Susbvar *varlist, size_t vlsize)
    633 {
    634 	u_char *dbuf;
    635 	struct hid_data *hdata;
    636 	size_t collind, dlen;
    637 	struct hid_item hitem;
    638 	u_int32_t colls[256];
    639 	struct Sreport inreport;
    640 
    641 	allocreport(&inreport, rd, REPORT_INPUT);
    642 
    643 	if (inreport.size <= 0)
    644 		errx(1, "Input report descriptor invalid length");
    645 
    646 	dlen = inreport.size;
    647 	dbuf = inreport.buffer->ucr_data;
    648 
    649 	for (;;) {
    650 		ssize_t readlen;
    651 
    652 		readlen = read(hidfd, dbuf, dlen);
    653 		if (readlen < 0)
    654 			err(1, "Device read error");
    655 		if (dlen != (size_t)readlen)
    656 			errx(1, "Unexpected response length: %lu != %lu",
    657 			     (unsigned long)readlen, (unsigned long)dlen);
    658 
    659 		collind = 0;
    660 		resethidvars(varlist, vlsize);
    661 
    662 		hdata = hid_start_parse(rd, 1 << hid_input, reportid);
    663 		if (hdata == NULL)
    664 			errx(1, "Failed to start parser");
    665 
    666 		while (hid_get_item(hdata, &hitem)) {
    667 			struct Susbvar *matchvar;
    668 
    669 			switch (hitem.kind) {
    670 			case hid_collection:
    671 				if (collind >= (sizeof(colls) / sizeof(*colls)))
    672 					errx(1, "Excessive nested collections");
    673 				colls[collind++] = hitem.usage;
    674 				break;
    675 			case hid_endcollection:
    676 				if (collind == 0)
    677 					errx(1, "Excessive collection ends");
    678 				collind--;
    679 				break;
    680 			case hid_input:
    681 				break;
    682 			case hid_output:
    683 			case hid_feature:
    684 				errx(1, "Unexpected non-input item returned");
    685 			}
    686 
    687 			if (reportid != -1 && hitem.report_ID != reportid)
    688 				continue;
    689 
    690 			matchvar = hidmatch(colls, collind, &hitem,
    691 					    varlist, vlsize);
    692 
    693 			if (matchvar != NULL)
    694 				matchvar->opfunc(&hitem, matchvar,
    695 						 colls, collind,
    696 						 inreport.buffer->ucr_data);
    697 		}
    698 		hid_end_parse(hdata);
    699 		printf("\n");
    700 	}
    701 	/* NOTREACHED */
    702 }
    703 
    704 static void
    705 devshow(int hidfd, report_desc_t rd, struct Susbvar *varlist, size_t vlsize,
    706 	int zeromode, int kindset)
    707 {
    708 	struct hid_data *hdata;
    709 	size_t collind, repind, vlind;
    710 	struct hid_item hitem;
    711 	u_int32_t colls[256];
    712 	struct Sreport reports[REPORT_MAXVAL + 1];
    713 
    714 
    715 	for (repind = 0; repind < (sizeof(reports) / sizeof(*reports));
    716 	     repind++) {
    717 		reports[repind].status = srs_uninit;
    718 		reports[repind].buffer = NULL;
    719 		reports[repind].use_getreport = !zeromode;
    720 	}
    721 
    722 	collind = 0;
    723 	resethidvars(varlist, vlsize);
    724 
    725 	hdata = hid_start_parse(rd, kindset, reportid);
    726 	if (hdata == NULL)
    727 		errx(1, "Failed to start parser");
    728 
    729 	while (hid_get_item(hdata, &hitem)) {
    730 		struct Susbvar *matchvar;
    731 		int repindex;
    732 
    733 		if (verbose > 3)
    734 			printf("item: kind=%d repid=%d usage=0x%x\n",
    735 			       hitem.kind, hitem.report_ID, hitem.usage);
    736 		repindex = -1;
    737 		switch (hitem.kind) {
    738 		case hid_collection:
    739 			if (collind >= (sizeof(colls) / sizeof(*colls)))
    740 				errx(1, "Excessive nested collections");
    741 			colls[collind++] = hitem.usage;
    742 			break;
    743 		case hid_endcollection:
    744 			if (collind == 0)
    745 				errx(1, "Excessive collection ends");
    746 			collind--;
    747 			break;
    748 		case hid_input:
    749 			repindex = REPORT_INPUT;
    750 			break;
    751 		case hid_output:
    752 			repindex = REPORT_OUTPUT;
    753 			break;
    754 		case hid_feature:
    755 			repindex = REPORT_FEATURE;
    756 			break;
    757 		}
    758 
    759 		if (reportid != -1 && hitem.report_ID != reportid)
    760 			continue;
    761 
    762 		matchvar = hidmatch(colls, collind, &hitem, varlist, vlsize);
    763 
    764 		if (matchvar != NULL) {
    765 			u_char *bufdata;
    766 			struct Sreport *repptr;
    767 
    768 			matchvar->mflags |= MATCH_WASMATCHED;
    769 
    770 			if (repindex >= 0)
    771 				repptr = &reports[repindex];
    772 			else
    773 				repptr = NULL;
    774 
    775 			if (repptr != NULL &&
    776 			    !(matchvar->mflags & MATCH_NODATA))
    777 				getreport(repptr, hidfd, rd, repindex);
    778 
    779 			bufdata = (repptr == NULL || repptr->buffer == NULL) ?
    780 				NULL : repptr->buffer->ucr_data;
    781 
    782 			if (matchvar->opfunc(&hitem, matchvar, colls, collind,
    783 					     bufdata) && repptr)
    784 				repptr->status = srs_dirty;
    785 		}
    786 	}
    787 	hid_end_parse(hdata);
    788 
    789 	for (repind = 0; repind < (sizeof(reports) / sizeof(*reports));
    790 	     repind++) {
    791 		setreport(&reports[repind], hidfd, repind);
    792 		freereport(&reports[repind]);
    793 	}
    794 
    795 	/* Warn about any items that we couldn't find a match for */
    796 	for (vlind = 0; vlind < vlsize; vlind++) {
    797 		struct Susbvar *var;
    798 
    799 		var = &varlist[vlind];
    800 
    801 		if (var->variable != NULL &&
    802 		    !(var->mflags & MATCH_WASMATCHED))
    803 			warnx("Failed to match: %.*s", (int)var->varlen,
    804 			      var->variable);
    805 	}
    806 }
    807 
    808 static void
    809 usage(void)
    810 {
    811 	const char *progname = getprogname();
    812 
    813 	fprintf(stderr, "usage: %s -f device [-t tablefile] [-l] [-v] -a\n",
    814 	    progname);
    815 	fprintf(stderr, "       %s -f device [-t tablefile] [-v] -r\n",
    816 	    progname);
    817 	fprintf(stderr,
    818 	    "       %s -f device [-t tablefile] [-l] [-n] [-v] name ...\n",
    819 	    progname);
    820 	fprintf(stderr,
    821 	    "       %s -f device [-t tablefile] -w name=value ...\n",
    822 	    progname);
    823 	exit(1);
    824 }
    825 
    826 int
    827 main(int argc, char **argv)
    828 {
    829 	char const *dev;
    830 	char const *table;
    831 	size_t varnum;
    832 	int aflag, lflag, nflag, rflag, wflag, zflag;
    833 	int ch, hidfd;
    834 	report_desc_t repdesc;
    835 	char devnamebuf[PATH_MAX];
    836 	struct Susbvar variables[128];
    837 
    838 	aflag = lflag = nflag = rflag = verbose = wflag = zflag = 0;
    839 	dev = NULL;
    840 	table = NULL;
    841 	while ((ch = getopt(argc, argv, "?af:lnrt:vwz")) != -1) {
    842 		switch (ch) {
    843 		case 'a':
    844 			aflag = 1;
    845 			break;
    846 		case 'f':
    847 			dev = optarg;
    848 			break;
    849 		case 'l':
    850 			lflag = 1;
    851 			break;
    852 		case 'n':
    853 			nflag = 1;
    854 			break;
    855 		case 'r':
    856 			rflag = 1;
    857 			break;
    858 		case 't':
    859 			table = optarg;
    860 			break;
    861 		case 'v':
    862 			verbose++;
    863 			break;
    864 		case 'w':
    865 			wflag = 1;
    866 			break;
    867 		case 'z':
    868 			zflag = 1;
    869 			break;
    870 		case '?':
    871 		default:
    872 			usage();
    873 			/* NOTREACHED */
    874 		}
    875 	}
    876 	argc -= optind;
    877 	argv += optind;
    878 	if (dev == NULL || (lflag && (wflag || rflag))) {
    879 		/*
    880 		 * No device specified, or attempting to loop and set
    881 		 * or dump report at the same time
    882 		 */
    883 		usage();
    884 		/* NOTREACHED */
    885 	}
    886 
    887 	for (varnum = 0; varnum < (size_t)argc; varnum++) {
    888 		char const *name, *valuesep, *varinst;
    889 		struct Susbvar *svar;
    890 		size_t namelen;
    891 
    892 		svar = &variables[varnum];
    893 		name = argv[varnum];
    894 		valuesep = strchr(name, DELIM_SET);
    895 
    896 		svar->variable = name;
    897 		svar->mflags = 0;
    898 		svar->usageinstance = 0;
    899 
    900 		if (valuesep == NULL) {
    901 			/* Read variable */
    902 			if (wflag)
    903 				errx(1, "Must not specify -w to read variables");
    904 			svar->value = NULL;
    905 			namelen = strlen(name);
    906 
    907 			if (nflag) {
    908 				/* Display value of variable only */
    909 				svar->opfunc = varop_value;
    910 			} else {
    911 				/* Display name and value of variable */
    912 				svar->opfunc = varop_display;
    913 
    914 				if (verbose >= 1)
    915 					/* Show page names in verbose modes */
    916 					svar->mflags |= MATCH_SHOWPAGENAME;
    917 			}
    918 		} else {
    919 			/* Write variable */
    920 			if (!wflag)
    921 				errx(2, "Must specify -w to set variables");
    922 			svar->mflags |= MATCH_WRITABLE;
    923 			if (verbose >= 1)
    924 				/*
    925 				 * Allow displaying of set value in
    926 				 * verbose mode.  This isn't
    927 				 * particularly useful though, so
    928 				 * don't bother documenting it.
    929 				 */
    930 				svar->mflags |= MATCH_SHOWVALUES;
    931 			namelen = valuesep - name;
    932 			svar->value = valuesep + 1;
    933 			svar->opfunc = varop_modify;
    934 		}
    935 
    936 		varinst = memchr(name, DELIM_INSTANCE, namelen);
    937 
    938 		if (varinst != NULL && ++varinst != &name[namelen]) {
    939 			char *endptr;
    940 
    941 			svar->usageinstance = strtol(varinst, &endptr, 0);
    942 
    943 			if (&name[namelen] != (char const*)endptr)
    944 				errx(1, "%s%c%s", "Error parsing item "
    945 				     "instance number after '",
    946 				     DELIM_INSTANCE, "'");
    947 
    948 			namelen = varinst - 1 - name;
    949 		}
    950 
    951 		svar->varlen = namelen;
    952 	}
    953 
    954 	if (aflag || rflag) {
    955 		struct Susbvar *svar;
    956 
    957 		svar = &variables[varnum++];
    958 
    959 		svar->variable = NULL;
    960 		svar->mflags = MATCH_ALL;
    961 
    962 		if (rflag) {
    963 			/*
    964 			 * Dump report descriptor.  Do dump collection
    965 			 * items also, and hint that it won't be
    966 			 * necessary to get the item status.
    967 			 */
    968 			svar->opfunc = varop_report;
    969 			svar->mflags |= MATCH_COLLECTIONS | MATCH_NODATA;
    970 
    971 			switch (verbose) {
    972 			default:
    973 				/* Level 2: Show item numerics and constants */
    974 				svar->mflags |= MATCH_SHOWNUMERIC;
    975 				/* FALLTHROUGH */
    976 			case 1:
    977 				/* Level 1: Just show constants */
    978 				svar->mflags |= MATCH_CONSTANTS;
    979 				/* FALLTHROUGH */
    980 			case 0:
    981 				break;
    982 			}
    983 		} else {
    984 			/* Display name and value of variable */
    985 			svar->opfunc = varop_display;
    986 
    987 			switch (verbose) {
    988 			default:
    989 				/* Level 2: Show constants and page names */
    990 				svar->mflags |= MATCH_CONSTANTS;
    991 				/* FALLTHROUGH */
    992 			case 1:
    993 				/* Level 1: Just show page names */
    994 				svar->mflags |= MATCH_SHOWPAGENAME;
    995 				/* FALLTHROUGH */
    996 			case 0:
    997 				break;
    998 			}
    999 		}
   1000 	}
   1001 
   1002 	if (varnum == 0) {
   1003 		/* Nothing to do...  Display usage information. */
   1004 		usage();
   1005 		/* NOTREACHED */
   1006 	}
   1007 
   1008 	hid_init(table);
   1009 
   1010 	if (dev[0] != '/') {
   1011 		snprintf(devnamebuf, sizeof(devnamebuf), "/dev/%s%s",
   1012 			 isdigit((unsigned char)dev[0]) ? "uhid" : "", dev);
   1013 		dev = devnamebuf;
   1014 	}
   1015 
   1016 	hidfd = open(dev, O_RDWR);
   1017 	if (hidfd < 0)
   1018 		err(1, "%s", dev);
   1019 
   1020 	if (ioctl(hidfd, USB_GET_REPORT_ID, &reportid) < 0)
   1021 		reportid = -1;
   1022 	if (verbose > 1)
   1023 		printf("report ID=%d\n", reportid);
   1024 	repdesc = hid_get_report_desc(hidfd);
   1025 	if (repdesc == 0)
   1026 		errx(1, "USB_GET_REPORT_DESC");
   1027 
   1028 	if (lflag) {
   1029 		devloop(hidfd, repdesc, variables, varnum);
   1030 		/* NOTREACHED */
   1031 	}
   1032 
   1033 	if (rflag)
   1034 		/* Report mode header */
   1035 		printf("Report descriptor:\n");
   1036 
   1037 	devshow(hidfd, repdesc, variables, varnum, zflag,
   1038 		1 << hid_input |
   1039 		1 << hid_output |
   1040 		1 << hid_feature);
   1041 
   1042 	if (rflag) {
   1043 		/* Report mode trailer */
   1044 		size_t repindex;
   1045 		for (repindex = 0;
   1046 		     repindex < (sizeof(reptoparam) / sizeof(*reptoparam));
   1047 		     repindex++) {
   1048 			int size;
   1049 			size = hid_report_size(repdesc,
   1050 					       reptoparam[repindex].hid_kind,
   1051 					       reportid);
   1052 			printf("Total %7s size %d bytes\n",
   1053 			       reptoparam[repindex].name, size);
   1054 		}
   1055 	}
   1056 
   1057 	hid_dispose_report_desc(repdesc);
   1058 	exit(0);
   1059 	/* NOTREACHED */
   1060 }
   1061