/* $NetBSD: usbhid.c,v 1.24 2004/01/05 23:23:37 jmmv Exp $ */ /* * Copyright (c) 2001 The NetBSD Foundation, Inc. * All rights reserved. * * This code is derived from software contributed to The NetBSD Foundation * by David Sainty * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by the NetBSD * Foundation, Inc. and its contributors. * 4. Neither the name of The NetBSD Foundation nor the names of its * contributors may be used to endorse or promote products derived * from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #ifndef lint __RCSID("$NetBSD: usbhid.c,v 1.24 2004/01/05 23:23:37 jmmv Exp $"); #endif #include #include #include #include #include #include #include #include #include #include #include #include #include /* * Zero if not in a verbose mode. Greater levels of verbosity * are indicated by values larger than one. */ unsigned int verbose; /* Parser tokens */ #define DELIM_USAGE '.' #define DELIM_PAGE ':' #define DELIM_SET '=' static int reportid; struct Susbvar { /* Variable name, not NUL terminated */ char const *variable; size_t varlen; char const *value; /* Value to set variable to */ #define MATCH_ALL (1 << 0) #define MATCH_COLLECTIONS (1 << 1) #define MATCH_NODATA (1 << 2) #define MATCH_CONSTANTS (1 << 3) #define MATCH_WASMATCHED (1 << 4) #define MATCH_SHOWPAGENAME (1 << 5) #define MATCH_SHOWNUMERIC (1 << 6) #define MATCH_WRITABLE (1 << 7) #define MATCH_SHOWVALUES (1 << 8) unsigned int mflags; /* Workspace for hidmatch() */ ssize_t matchindex; int (*opfunc)(struct hid_item *item, struct Susbvar *var, u_int32_t const *collist, size_t collen, u_char *buf); }; struct Sreport { struct usb_ctl_report *buffer; enum {srs_uninit, srs_clean, srs_dirty} status; int report_id; size_t size; }; static struct { int uhid_report; hid_kind_t hid_kind; char const *name; } const reptoparam[] = { #define REPORT_INPUT 0 { UHID_INPUT_REPORT, hid_input, "input" }, #define REPORT_OUTPUT 1 { UHID_OUTPUT_REPORT, hid_output, "output" }, #define REPORT_FEATURE 2 { UHID_FEATURE_REPORT, hid_feature, "feature" } #define REPORT_MAXVAL 2 }; /* * Extract 16-bit unsigned usage ID from a numeric string. Returns -1 * if string failed to parse correctly. */ static int strtousage(const char *nptr, size_t nlen) { char *endptr; long result; char numstr[16]; if (nlen >= sizeof(numstr) || !isdigit((unsigned char)*nptr)) return -1; /* * We use strtol() here, but unfortunately strtol() requires a * NUL terminated string - which we don't have - at least not * officially. */ memcpy(numstr, nptr, nlen); numstr[nlen] = '\0'; result = strtol(numstr, &endptr, 0); if (result < 0 || result > 0xffff || endptr != &numstr[nlen]) return -1; return result; } struct usagedata { char const *page_name; char const *usage_name; size_t page_len; size_t usage_len; int isfinal; u_int32_t usage_id; }; /* * Test a rule against the current usage data. Returns -1 on no * match, 0 on partial match and 1 on complete match. */ static int hidtestrule(struct Susbvar *var, struct usagedata *cache) { char const *varname; ssize_t matchindex, pagesplit; size_t strind, varlen; int numusage; u_int32_t usage_id; matchindex = var->matchindex; varname = var->variable; varlen = var->varlen; usage_id = cache->usage_id; /* * Parse the current variable name, locating the end of the * current 'usage', and possibly where the usage page name * ends. */ pagesplit = -1; for (strind = matchindex; strind < varlen; strind++) { if (varname[strind] == DELIM_USAGE) break; if (varname[strind] == DELIM_PAGE) pagesplit = strind; } if (cache->isfinal && strind != varlen) /* * Variable name is too long (hit delimiter instead of * end-of-variable). */ return -1; if (pagesplit >= 0) { /* * Page name was specified, determine whether it was * symbolic or numeric. */ char const *strstart; int numpage; strstart = &varname[matchindex]; numpage = strtousage(strstart, pagesplit - matchindex); if (numpage >= 0) { /* Valid numeric */ if (numpage != HID_PAGE(usage_id)) /* Numeric didn't match page ID */ return -1; } else { /* Not a valid numeric */ /* * Load and cache the page name if and only if * it hasn't already been loaded (it's a * fairly expensive operation). */ if (cache->page_name == NULL) { cache->page_name = hid_usage_page(HID_PAGE(usage_id)); cache->page_len = strlen(cache->page_name); } /* * Compare specified page name to actual page * name. */ if (cache->page_len != (size_t)(pagesplit - matchindex) || memcmp(cache->page_name, &varname[matchindex], cache->page_len) != 0) /* Mismatch, page name wrong */ return -1; } /* Page matches, discard page name */ matchindex = pagesplit + 1; } numusage = strtousage(&varname[matchindex], strind - matchindex); if (numusage >= 0) { /* Valid numeric */ if (numusage != HID_USAGE(usage_id)) /* Numeric didn't match usage ID */ return -1; } else { /* Not a valid numeric */ /* Load and cache the usage name */ if (cache->usage_name == NULL) { cache->usage_name = hid_usage_in_page(usage_id); cache->usage_len = strlen(cache->usage_name); } /* * Compare specified usage name to actual usage name */ if (cache->usage_len != (size_t)(strind - matchindex) || memcmp(cache->usage_name, &varname[matchindex], cache->usage_len) != 0) /* Mismatch, usage name wrong */ return -1; } if (cache->isfinal) /* Match */ return 1; /* * Partial match: Move index past this usage string + * delimiter */ var->matchindex = strind + 1; return 0; } /* * hidmatch() determines whether the item specified in 'item', and * nested within a heirarchy of collections specified in 'collist' * matches any of the rules in the list 'varlist'. Returns the * matching rule on success, or NULL on no match. */ static struct Susbvar* hidmatch(u_int32_t const *collist, size_t collen, struct hid_item *item, struct Susbvar *varlist, size_t vlsize) { size_t colind, vlactive, vlind; int iscollection; /* * Keep track of how many variables are still "active". When * the active count reaches zero, don't bother to continue * looking for matches. */ vlactive = vlsize; iscollection = item->kind == hid_collection || item->kind == hid_endcollection; for (vlind = 0; vlind < vlsize; vlind++) { struct Susbvar *var; var = &varlist[vlind]; var->matchindex = 0; if (!(var->mflags & MATCH_COLLECTIONS) && iscollection) { /* Don't match collections for this variable */ var->matchindex = -1; vlactive--; } else if (!iscollection && !(var->mflags & MATCH_CONSTANTS) && (item->flags & HIO_CONST)) { /* * Don't match constants for this variable, * but ignore the constant bit on collections. */ var->matchindex = -1; vlactive--; } else if ((var->mflags & MATCH_WRITABLE) && ((item->kind != hid_output && item->kind != hid_feature) || (item->flags & HIO_CONST))) { /* * If we are only matching writable items, if * this is not an output or feature kind, or * it is a constant, reject it. */ var->matchindex = -1; vlactive--; } else if (var->mflags & MATCH_ALL) { /* Match immediately */ return &varlist[vlind]; } } /* * Loop through each usage in the collection list, including * the 'item' itself on the final iteration. For each usage, * test which variables named in the rule list are still * applicable - if any. */ for (colind = 0; vlactive > 0 && colind <= collen; colind++) { struct usagedata cache; cache.isfinal = (colind == collen); if (cache.isfinal) cache.usage_id = item->usage; else cache.usage_id = collist[colind]; cache.usage_name = NULL; cache.page_name = NULL; /* * Loop through each rule, testing whether the rule is * still applicable or not. For each rule, * 'matchindex' retains the current match state as an * index into the variable name string, or -1 if this * rule has been proven not to match. */ for (vlind = 0; vlind < vlsize; vlind++) { struct Susbvar *var; int matchres; var = &varlist[vlind]; if (var->matchindex < 0) /* Mismatch at a previous level */ continue; matchres = hidtestrule(var, &cache); if (matchres < 0) { /* Bad match */ var->matchindex = -1; vlactive--; continue; } else if (matchres > 0) { /* Complete match */ return var; } } } return NULL; } static void allocreport(struct Sreport *report, report_desc_t rd, int repindex) { int reptsize; reptsize = hid_report_size(rd, reptoparam[repindex].hid_kind, reportid); if (reptsize < 0) errx(1, "Negative report size"); report->size = reptsize; if (report->size > 0) { /* * Allocate a buffer with enough space for the * report in the variable-sized data field. */ report->buffer = malloc(sizeof(*report->buffer) - sizeof(report->buffer->ucr_data) + report->size); if (report->buffer == NULL) err(1, NULL); } else report->buffer = NULL; report->status = srs_clean; } static void freereport(struct Sreport *report) { if (report->buffer != NULL) free(report->buffer); report->status = srs_uninit; } static void getreport(struct Sreport *report, int hidfd, report_desc_t rd, int repindex) { if (report->status == srs_uninit) { allocreport(report, rd, repindex); if (report->size == 0) return; report->buffer->ucr_report = reptoparam[repindex].uhid_report; if (ioctl(hidfd, USB_GET_REPORT, report->buffer) < 0) err(1, "USB_GET_REPORT (probably not supported by " "device)"); } } static void setreport(struct Sreport *report, int hidfd, int repindex) { if (report->status == srs_dirty) { report->buffer->ucr_report = reptoparam[repindex].uhid_report; if (ioctl(hidfd, USB_SET_REPORT, report->buffer) < 0) err(1, "USB_SET_REPORT(%s)", reptoparam[repindex].name); report->status = srs_clean; } } /* ARGSUSED1 */ static int varop_value(struct hid_item *item, struct Susbvar *var, u_int32_t const *collist, size_t collen, u_char *buf) { printf("%d\n", hid_get_data(buf, item)); return 0; } /* ARGSUSED1 */ static int varop_display(struct hid_item *item, struct Susbvar *var, u_int32_t const *collist, size_t collen, u_char *buf) { size_t colitem; int val, i; for (i = 0; i < item->report_count; i++) { for (colitem = 0; colitem < collen; colitem++) { if (var->mflags & MATCH_SHOWPAGENAME) printf("%s:", hid_usage_page(HID_PAGE(collist[colitem]))); printf("%s.", hid_usage_in_page(collist[colitem])); } if (var->mflags & MATCH_SHOWPAGENAME) printf("%s:", hid_usage_page(HID_PAGE(item->usage))); val = hid_get_data(buf, item); item->pos += item->report_size; if (item->usage_minimum != 0 || item->usage_maximum != 0) { val += item->usage_minimum; printf("%s=1", hid_usage_in_page(val)); } else { printf("%s=%d%s", hid_usage_in_page(item->usage), val, item->flags & HIO_CONST ? " (const)" : ""); } if (item->report_count > 1) printf(" [%d]", i); printf("\n"); } return 0; } /* ARGSUSED1 */ static int varop_modify(struct hid_item *item, struct Susbvar *var, u_int32_t const *collist, size_t collen, u_char *buf) { u_int dataval; dataval = (u_int)strtol(var->value, NULL, 10); hid_set_data(buf, item, dataval); if (var->mflags & MATCH_SHOWVALUES) /* Display set value */ varop_display(item, var, collist, collen, buf); return 1; } static void reportitem(char const *label, struct hid_item const *item, unsigned int mflags) { int isconst = item->flags & HIO_CONST, isvar = item->flags & HIO_VARIABLE; printf("%s size=%d count=%d%s%s page=%s", label, item->report_size, item->report_count, isconst ? " Const" : "", !isvar && !isconst ? " Array" : "", hid_usage_page(HID_PAGE(item->usage))); if (item->usage_minimum != 0 || item->usage_maximum != 0) { printf(" usage=%s..%s", hid_usage_in_page(item->usage_minimum), hid_usage_in_page(item->usage_maximum)); if (mflags & MATCH_SHOWNUMERIC) printf(" (%u:0x%x..%u:0x%x)", HID_PAGE(item->usage_minimum), HID_USAGE(item->usage_minimum), HID_PAGE(item->usage_maximum), HID_USAGE(item->usage_maximum)); } else { printf(" usage=%s", hid_usage_in_page(item->usage)); if (mflags & MATCH_SHOWNUMERIC) printf(" (%u:0x%x)", HID_PAGE(item->usage), HID_USAGE(item->usage)); } printf(", logical range %d..%d", item->logical_minimum, item->logical_maximum); if (item->physical_minimum != item->physical_maximum) printf(", physical range %d..%d", item->physical_minimum, item->physical_maximum); if (item->unit) printf(", unit=0x%02x exp=%d", item->unit, item->unit_exponent); printf("\n"); } /* ARGSUSED1 */ static int varop_report(struct hid_item *item, struct Susbvar *var, u_int32_t const *collist, size_t collen, u_char *buf) { switch (item->kind) { case hid_collection: printf("Collection page=%s usage=%s", hid_usage_page(HID_PAGE(item->usage)), hid_usage_in_page(item->usage)); if (var->mflags & MATCH_SHOWNUMERIC) printf(" (%u:0x%x)\n", HID_PAGE(item->usage), HID_USAGE(item->usage)); else printf("\n"); break; case hid_endcollection: printf("End collection\n"); break; case hid_input: reportitem("Input ", item, var->mflags); break; case hid_output: reportitem("Output ", item, var->mflags); break; case hid_feature: reportitem("Feature", item, var->mflags); break; } return 0; } static void devloop(int hidfd, report_desc_t rd, struct Susbvar *varlist, size_t vlsize) { u_char *dbuf; struct hid_data *hdata; size_t collind, dlen; struct hid_item hitem; u_int32_t colls[128]; struct Sreport inreport; allocreport(&inreport, rd, REPORT_INPUT); if (inreport.size <= 0) errx(1, "Input report descriptor invalid length"); dlen = inreport.size; dbuf = inreport.buffer->ucr_data; for (;;) { ssize_t readlen; readlen = read(hidfd, dbuf, dlen); if (readlen < 0) err(1, "Device read error"); if (dlen != (size_t)readlen) errx(1, "Unexpected response length: %lu != %lu", (unsigned long)readlen, (unsigned long)dlen); collind = 0; hdata = hid_start_parse(rd, 1 << hid_input, reportid); if (hdata == NULL) errx(1, "Failed to start parser"); while (hid_get_item(hdata, &hitem)) { struct Susbvar *matchvar; switch (hitem.kind) { case hid_collection: if (collind >= (sizeof(colls) / sizeof(*colls))) errx(1, "Excessive nested collections"); colls[collind++] = hitem.usage; break; case hid_endcollection: if (collind == 0) errx(1, "Excessive collection ends"); collind--; break; case hid_input: break; case hid_output: case hid_feature: errx(1, "Unexpected non-input item returned"); } if (reportid != -1 && hitem.report_ID != reportid) continue; matchvar = hidmatch(colls, collind, &hitem, varlist, vlsize); if (matchvar != NULL) matchvar->opfunc(&hitem, matchvar, colls, collind, inreport.buffer->ucr_data); } hid_end_parse(hdata); printf("\n"); } /* NOTREACHED */ } static void devshow(int hidfd, report_desc_t rd, struct Susbvar *varlist, size_t vlsize, int kindset) { struct hid_data *hdata; size_t collind, repind, vlind; struct hid_item hitem; u_int32_t colls[128]; struct Sreport reports[REPORT_MAXVAL + 1]; for (repind = 0; repind < (sizeof(reports) / sizeof(*reports)); repind++) { reports[repind].status = srs_uninit; reports[repind].buffer = NULL; } collind = 0; hdata = hid_start_parse(rd, kindset, reportid); if (hdata == NULL) errx(1, "Failed to start parser"); while (hid_get_item(hdata, &hitem)) { struct Susbvar *matchvar; int repindex; if (verbose > 3) printf("item: kind=%d repid=%d usage=0x%x\n", hitem.kind, hitem.report_ID, hitem.usage); repindex = -1; switch (hitem.kind) { case hid_collection: if (collind >= (sizeof(colls) / sizeof(*colls))) errx(1, "Excessive nested collections"); colls[collind++] = hitem.usage; break; case hid_endcollection: if (collind == 0) errx(1, "Excessive collection ends"); collind--; break; case hid_input: repindex = REPORT_INPUT; break; case hid_output: repindex = REPORT_OUTPUT; break; case hid_feature: repindex = REPORT_FEATURE; break; } if (reportid != -1 && hitem.report_ID != reportid) continue; matchvar = hidmatch(colls, collind, &hitem, varlist, vlsize); if (matchvar != NULL) { u_char *bufdata; struct Sreport *repptr; matchvar->mflags |= MATCH_WASMATCHED; if (repindex >= 0) repptr = &reports[repindex]; else repptr = NULL; if (repptr != NULL && !(matchvar->mflags & MATCH_NODATA)) getreport(repptr, hidfd, rd, repindex); bufdata = (repptr == NULL || repptr->buffer == NULL) ? NULL : repptr->buffer->ucr_data; if (matchvar->opfunc(&hitem, matchvar, colls, collind, bufdata)) repptr->status = srs_dirty; } } hid_end_parse(hdata); for (repind = 0; repind < (sizeof(reports) / sizeof(*reports)); repind++) { setreport(&reports[repind], hidfd, repind); freereport(&reports[repind]); } /* Warn about any items that we couldn't find a match for */ for (vlind = 0; vlind < vlsize; vlind++) { struct Susbvar *var; var = &varlist[vlind]; if (var->variable != NULL && !(var->mflags & MATCH_WASMATCHED)) warnx("Failed to match: %.*s", (int)var->varlen, var->variable); } } static void usage(void) { const char *progname = getprogname(); fprintf(stderr, "usage: %s -f device [-t tablefile] [-l] [-v] -a\n", progname); fprintf(stderr, " %s -f device [-t tablefile] [-v] -r\n", progname); fprintf(stderr, " %s -f device [-t tablefile] [-l] [-n] [-v] name ...\n", progname); fprintf(stderr, " %s -f device [-t tablefile] -w name=value ...\n", progname); exit(1); } int main(int argc, char **argv) { char const *dev; char const *table; size_t varnum; int aflag, lflag, nflag, rflag, wflag; int ch, hidfd; report_desc_t repdesc; char devnamebuf[PATH_MAX]; struct Susbvar variables[128]; wflag = aflag = nflag = verbose = rflag = lflag = 0; dev = NULL; table = NULL; while ((ch = getopt(argc, argv, "?af:lnrt:vw")) != -1) { switch (ch) { case 'a': aflag = 1; break; case 'f': dev = optarg; break; case 'l': lflag = 1; break; case 'n': nflag = 1; break; case 'r': rflag = 1; break; case 't': table = optarg; break; case 'v': verbose++; break; case 'w': wflag = 1; break; case '?': default: usage(); /* NOTREACHED */ } } argc -= optind; argv += optind; if (dev == NULL || (lflag && (wflag || rflag))) { /* * No device specified, or attempting to loop and set * or dump report at the same time */ usage(); /* NOTREACHED */ } for (varnum = 0; varnum < (size_t)argc; varnum++) { char const *name, *valuesep; struct Susbvar *svar; svar = &variables[varnum]; name = argv[varnum]; valuesep = strchr(name, DELIM_SET); svar->variable = name; svar->mflags = 0; if (valuesep == NULL) { /* Read variable */ if (wflag) errx(1, "Must not specify -w to read variables"); svar->value = NULL; svar->varlen = strlen(name); if (nflag) { /* Display value of variable only */ svar->opfunc = varop_value; } else { /* Display name and value of variable */ svar->opfunc = varop_display; if (verbose >= 1) /* Show page names in verbose modes */ svar->mflags |= MATCH_SHOWPAGENAME; } } else { /* Write variable */ if (!wflag) errx(2, "Must specify -w to set variables"); svar->mflags |= MATCH_WRITABLE; if (verbose >= 1) /* * Allow displaying of set value in * verbose mode. This isn't * particularly useful though, so * don't bother documenting it. */ svar->mflags |= MATCH_SHOWVALUES; svar->varlen = valuesep - name; svar->value = valuesep + 1; svar->opfunc = varop_modify; } } if (aflag || rflag) { struct Susbvar *svar; svar = &variables[varnum++]; svar->variable = NULL; svar->mflags = MATCH_ALL; if (rflag) { /* * Dump report descriptor. Do dump collection * items also, and hint that it won't be * necessary to get the item status. */ svar->opfunc = varop_report; svar->mflags |= MATCH_COLLECTIONS | MATCH_NODATA; switch (verbose) { default: /* Level 2: Show item numerics and constants */ svar->mflags |= MATCH_SHOWNUMERIC; /* FALLTHROUGH */ case 1: /* Level 1: Just show constants */ svar->mflags |= MATCH_CONSTANTS; /* FALLTHROUGH */ case 0: break; } } else { /* Display name and value of variable */ svar->opfunc = varop_display; switch (verbose) { default: /* Level 2: Show constants and page names */ svar->mflags |= MATCH_CONSTANTS; /* FALLTHROUGH */ case 1: /* Level 1: Just show page names */ svar->mflags |= MATCH_SHOWPAGENAME; /* FALLTHROUGH */ case 0: break; } } } if (varnum == 0) { /* Nothing to do... Display usage information. */ usage(); /* NOTREACHED */ } hid_init(table); if (dev[0] != '/') { snprintf(devnamebuf, sizeof(devnamebuf), "/dev/%s%s", isdigit(dev[0]) ? "uhid" : "", dev); dev = devnamebuf; } hidfd = open(dev, O_RDWR); if (hidfd < 0) err(1, "%s", dev); if (ioctl(hidfd, USB_GET_REPORT_ID, &reportid) < 0) reportid = -1; if (verbose > 1) printf("report ID=%d\n", reportid); repdesc = hid_get_report_desc(hidfd); if (repdesc == 0) errx(1, "USB_GET_REPORT_DESC"); if (lflag) { devloop(hidfd, repdesc, variables, varnum); /* NOTREACHED */ } if (rflag) /* Report mode header */ printf("Report descriptor:\n"); devshow(hidfd, repdesc, variables, varnum, 1 << hid_input | 1 << hid_output | 1 << hid_feature); if (rflag) { /* Report mode trailer */ size_t repindex; for (repindex = 0; repindex < (sizeof(reptoparam) / sizeof(*reptoparam)); repindex++) { int size; size = hid_report_size(repdesc, reptoparam[repindex].hid_kind, reportid); printf("Total %7s size %d bytes\n", reptoparam[repindex].name, size); } } hid_dispose_report_desc(repdesc); exit(0); /* NOTREACHED */ }