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