FreeBSD/Linux Kernel Cross Reference
sys/dev/hid/hid.c
1 /* $FreeBSD$ */
2 /* $NetBSD: hid.c,v 1.17 2001/11/13 06:24:53 lukem Exp $ */
3 /*-
4 * SPDX-License-Identifier: BSD-2-Clause-NetBSD
5 *
6 * Copyright (c) 1998 The NetBSD Foundation, Inc.
7 * All rights reserved.
8 *
9 * This code is derived from software contributed to The NetBSD Foundation
10 * by Lennart Augustsson (lennart@augustsson.net) at
11 * Carlstedt Research & Technology.
12 *
13 * Redistribution and use in source and binary forms, with or without
14 * modification, are permitted provided that the following conditions
15 * are met:
16 * 1. Redistributions of source code must retain the above copyright
17 * notice, this list of conditions and the following disclaimer.
18 * 2. Redistributions in binary form must reproduce the above copyright
19 * notice, this list of conditions and the following disclaimer in the
20 * documentation and/or other materials provided with the distribution.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
23 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
24 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
25 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
26 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32 * POSSIBILITY OF SUCH DAMAGE.
33 */
34
35 #include "opt_hid.h"
36
37 #include <sys/param.h>
38 #include <sys/bus.h>
39 #include <sys/kdb.h>
40 #include <sys/kernel.h>
41 #include <sys/malloc.h>
42 #include <sys/module.h>
43 #include <sys/sysctl.h>
44
45 #define HID_DEBUG_VAR hid_debug
46 #include <dev/hid/hid.h>
47 #include <dev/hid/hidquirk.h>
48
49 #include "hid_if.h"
50
51 /*
52 * Define this unconditionally in case a kernel module is loaded that
53 * has been compiled with debugging options.
54 */
55 int hid_debug = 0;
56
57 SYSCTL_NODE(_hw, OID_AUTO, hid, CTLFLAG_RW, 0, "HID debugging");
58 SYSCTL_INT(_hw_hid, OID_AUTO, debug, CTLFLAG_RWTUN,
59 &hid_debug, 0, "Debug level");
60
61 #ifdef HIDRAW_MAKE_UHID_ALIAS
62 devclass_t hidraw_devclass;
63 #endif
64
65 static void hid_clear_local(struct hid_item *);
66 static uint8_t hid_get_byte(struct hid_data *s, const uint16_t wSize);
67
68 static hid_test_quirk_t hid_test_quirk_w;
69 hid_test_quirk_t *hid_test_quirk_p = &hid_test_quirk_w;
70
71 #define MAXUSAGE 64
72 #define MAXPUSH 4
73 #define MAXID 16
74 #define MAXLOCCNT 2048
75
76 struct hid_pos_data {
77 int32_t rid;
78 uint32_t pos;
79 };
80
81 struct hid_data {
82 const uint8_t *start;
83 const uint8_t *end;
84 const uint8_t *p;
85 struct hid_item cur[MAXPUSH];
86 struct hid_pos_data last_pos[MAXID];
87 int32_t usages_min[MAXUSAGE];
88 int32_t usages_max[MAXUSAGE];
89 int32_t usage_last; /* last seen usage */
90 uint32_t loc_size; /* last seen size */
91 uint32_t loc_count; /* last seen count */
92 uint32_t ncount; /* end usage item count */
93 uint32_t icount; /* current usage item count */
94 uint8_t kindset; /* we have 5 kinds so 8 bits are enough */
95 uint8_t pushlevel; /* current pushlevel */
96 uint8_t nusage; /* end "usages_min/max" index */
97 uint8_t iusage; /* current "usages_min/max" index */
98 uint8_t ousage; /* current "usages_min/max" offset */
99 uint8_t susage; /* usage set flags */
100 };
101
102 /*------------------------------------------------------------------------*
103 * hid_clear_local
104 *------------------------------------------------------------------------*/
105 static void
106 hid_clear_local(struct hid_item *c)
107 {
108
109 c->loc.count = 0;
110 c->loc.size = 0;
111 c->nusages = 0;
112 memset(c->usages, 0, sizeof(c->usages));
113 c->usage_minimum = 0;
114 c->usage_maximum = 0;
115 c->designator_index = 0;
116 c->designator_minimum = 0;
117 c->designator_maximum = 0;
118 c->string_index = 0;
119 c->string_minimum = 0;
120 c->string_maximum = 0;
121 c->set_delimiter = 0;
122 }
123
124 static void
125 hid_switch_rid(struct hid_data *s, struct hid_item *c, int32_t next_rID)
126 {
127 uint8_t i;
128
129 /* check for same report ID - optimise */
130
131 if (c->report_ID == next_rID)
132 return;
133
134 /* save current position for current rID */
135
136 if (c->report_ID == 0) {
137 i = 0;
138 } else {
139 for (i = 1; i != MAXID; i++) {
140 if (s->last_pos[i].rid == c->report_ID)
141 break;
142 if (s->last_pos[i].rid == 0)
143 break;
144 }
145 }
146 if (i != MAXID) {
147 s->last_pos[i].rid = c->report_ID;
148 s->last_pos[i].pos = c->loc.pos;
149 }
150
151 /* store next report ID */
152
153 c->report_ID = next_rID;
154
155 /* lookup last position for next rID */
156
157 if (next_rID == 0) {
158 i = 0;
159 } else {
160 for (i = 1; i != MAXID; i++) {
161 if (s->last_pos[i].rid == next_rID)
162 break;
163 if (s->last_pos[i].rid == 0)
164 break;
165 }
166 }
167 if (i != MAXID) {
168 s->last_pos[i].rid = next_rID;
169 c->loc.pos = s->last_pos[i].pos;
170 } else {
171 DPRINTF("Out of RID entries, position is set to zero!\n");
172 c->loc.pos = 0;
173 }
174 }
175
176 /*------------------------------------------------------------------------*
177 * hid_start_parse
178 *------------------------------------------------------------------------*/
179 struct hid_data *
180 hid_start_parse(const void *d, hid_size_t len, int kindset)
181 {
182 struct hid_data *s;
183
184 if ((kindset-1) & kindset) {
185 DPRINTFN(0, "Only one bit can be "
186 "set in the kindset\n");
187 return (NULL);
188 }
189
190 s = malloc(sizeof *s, M_TEMP, M_WAITOK | M_ZERO);
191 s->start = s->p = d;
192 s->end = ((const uint8_t *)d) + len;
193 s->kindset = kindset;
194 return (s);
195 }
196
197 /*------------------------------------------------------------------------*
198 * hid_end_parse
199 *------------------------------------------------------------------------*/
200 void
201 hid_end_parse(struct hid_data *s)
202 {
203 if (s == NULL)
204 return;
205
206 free(s, M_TEMP);
207 }
208
209 /*------------------------------------------------------------------------*
210 * get byte from HID descriptor
211 *------------------------------------------------------------------------*/
212 static uint8_t
213 hid_get_byte(struct hid_data *s, const uint16_t wSize)
214 {
215 const uint8_t *ptr;
216 uint8_t retval;
217
218 ptr = s->p;
219
220 /* check if end is reached */
221 if (ptr == s->end)
222 return (0);
223
224 /* read out a byte */
225 retval = *ptr;
226
227 /* check if data pointer can be advanced by "wSize" bytes */
228 if ((s->end - ptr) < wSize)
229 ptr = s->end;
230 else
231 ptr += wSize;
232
233 /* update pointer */
234 s->p = ptr;
235
236 return (retval);
237 }
238
239 /*------------------------------------------------------------------------*
240 * hid_get_item
241 *------------------------------------------------------------------------*/
242 int
243 hid_get_item(struct hid_data *s, struct hid_item *h)
244 {
245 struct hid_item *c;
246 unsigned int bTag, bType, bSize;
247 uint32_t oldpos;
248 int32_t mask;
249 int32_t dval;
250
251 if (s == NULL)
252 return (0);
253
254 c = &s->cur[s->pushlevel];
255
256 top:
257 /* check if there is an array of items */
258 if (s->icount < s->ncount) {
259 /* get current usage */
260 if (s->iusage < s->nusage) {
261 dval = s->usages_min[s->iusage] + s->ousage;
262 c->usage = dval;
263 s->usage_last = dval;
264 if (dval == s->usages_max[s->iusage]) {
265 s->iusage ++;
266 s->ousage = 0;
267 } else {
268 s->ousage ++;
269 }
270 } else {
271 DPRINTFN(1, "Using last usage\n");
272 dval = s->usage_last;
273 }
274 c->nusages = 1;
275 /* array type HID item may have multiple usages */
276 while ((c->flags & HIO_VARIABLE) == 0 && s->ousage == 0 &&
277 s->iusage < s->nusage && c->nusages < HID_ITEM_MAXUSAGE)
278 c->usages[c->nusages++] = s->usages_min[s->iusage++];
279 if ((c->flags & HIO_VARIABLE) == 0 && s->ousage == 0 &&
280 s->iusage < s->nusage)
281 DPRINTFN(0, "HID_ITEM_MAXUSAGE should be increased "
282 "up to %hhu to parse the HID report descriptor\n",
283 s->nusage);
284 s->icount ++;
285 /*
286 * Only copy HID item, increment position and return
287 * if correct kindset!
288 */
289 if (s->kindset & (1 << c->kind)) {
290 *h = *c;
291 DPRINTFN(1, "%u,%u,%u\n", h->loc.pos,
292 h->loc.size, h->loc.count);
293 c->loc.pos += c->loc.size * c->loc.count;
294 return (1);
295 }
296 }
297
298 /* reset state variables */
299 s->icount = 0;
300 s->ncount = 0;
301 s->iusage = 0;
302 s->nusage = 0;
303 s->susage = 0;
304 s->ousage = 0;
305 hid_clear_local(c);
306
307 /* get next item */
308 while (s->p != s->end) {
309 bSize = hid_get_byte(s, 1);
310 if (bSize == 0xfe) {
311 /* long item */
312 bSize = hid_get_byte(s, 1);
313 bSize |= hid_get_byte(s, 1) << 8;
314 bTag = hid_get_byte(s, 1);
315 bType = 0xff; /* XXX what should it be */
316 } else {
317 /* short item */
318 bTag = bSize >> 4;
319 bType = (bSize >> 2) & 3;
320 bSize &= 3;
321 if (bSize == 3)
322 bSize = 4;
323 }
324 switch (bSize) {
325 case 0:
326 dval = 0;
327 mask = 0;
328 break;
329 case 1:
330 dval = (int8_t)hid_get_byte(s, 1);
331 mask = 0xFF;
332 break;
333 case 2:
334 dval = hid_get_byte(s, 1);
335 dval |= hid_get_byte(s, 1) << 8;
336 dval = (int16_t)dval;
337 mask = 0xFFFF;
338 break;
339 case 4:
340 dval = hid_get_byte(s, 1);
341 dval |= hid_get_byte(s, 1) << 8;
342 dval |= hid_get_byte(s, 1) << 16;
343 dval |= hid_get_byte(s, 1) << 24;
344 mask = 0xFFFFFFFF;
345 break;
346 default:
347 dval = hid_get_byte(s, bSize);
348 DPRINTFN(0, "bad length %u (data=0x%02x)\n",
349 bSize, dval);
350 continue;
351 }
352
353 switch (bType) {
354 case 0: /* Main */
355 switch (bTag) {
356 case 8: /* Input */
357 c->kind = hid_input;
358 ret:
359 c->flags = dval;
360 c->loc.count = s->loc_count;
361 c->loc.size = s->loc_size;
362
363 if (c->flags & HIO_VARIABLE) {
364 /* range check usage count */
365 if (c->loc.count > MAXLOCCNT) {
366 DPRINTFN(0, "Number of "
367 "items(%u) truncated to %u\n",
368 (unsigned)(c->loc.count),
369 MAXLOCCNT);
370 s->ncount = MAXLOCCNT;
371 } else
372 s->ncount = c->loc.count;
373
374 /*
375 * The "top" loop will return
376 * one and one item:
377 */
378 c->loc.count = 1;
379 } else {
380 s->ncount = 1;
381 }
382 goto top;
383
384 case 9: /* Output */
385 c->kind = hid_output;
386 goto ret;
387 case 10: /* Collection */
388 c->kind = hid_collection;
389 c->collection = dval;
390 c->collevel++;
391 c->usage = s->usage_last;
392 c->nusages = 1;
393 *h = *c;
394 return (1);
395 case 11: /* Feature */
396 c->kind = hid_feature;
397 goto ret;
398 case 12: /* End collection */
399 c->kind = hid_endcollection;
400 if (c->collevel == 0) {
401 DPRINTFN(0, "invalid end collection\n");
402 return (0);
403 }
404 c->collevel--;
405 *h = *c;
406 return (1);
407 default:
408 DPRINTFN(0, "Main bTag=%d\n", bTag);
409 break;
410 }
411 break;
412 case 1: /* Global */
413 switch (bTag) {
414 case 0:
415 c->_usage_page = dval << 16;
416 break;
417 case 1:
418 c->logical_minimum = dval;
419 break;
420 case 2:
421 c->logical_maximum = dval;
422 break;
423 case 3:
424 c->physical_minimum = dval;
425 break;
426 case 4:
427 c->physical_maximum = dval;
428 break;
429 case 5:
430 c->unit_exponent = dval;
431 break;
432 case 6:
433 c->unit = dval;
434 break;
435 case 7:
436 /* mask because value is unsigned */
437 s->loc_size = dval & mask;
438 break;
439 case 8:
440 hid_switch_rid(s, c, dval & mask);
441 break;
442 case 9:
443 /* mask because value is unsigned */
444 s->loc_count = dval & mask;
445 break;
446 case 10: /* Push */
447 /* stop parsing, if invalid push level */
448 if ((s->pushlevel + 1) >= MAXPUSH) {
449 DPRINTFN(0, "Cannot push item @ %d\n", s->pushlevel);
450 return (0);
451 }
452 s->pushlevel ++;
453 s->cur[s->pushlevel] = *c;
454 /* store size and count */
455 c->loc.size = s->loc_size;
456 c->loc.count = s->loc_count;
457 /* update current item pointer */
458 c = &s->cur[s->pushlevel];
459 break;
460 case 11: /* Pop */
461 /* stop parsing, if invalid push level */
462 if (s->pushlevel == 0) {
463 DPRINTFN(0, "Cannot pop item @ 0\n");
464 return (0);
465 }
466 s->pushlevel --;
467 /* preserve position */
468 oldpos = c->loc.pos;
469 c = &s->cur[s->pushlevel];
470 /* restore size and count */
471 s->loc_size = c->loc.size;
472 s->loc_count = c->loc.count;
473 /* set default item location */
474 c->loc.pos = oldpos;
475 c->loc.size = 0;
476 c->loc.count = 0;
477 break;
478 default:
479 DPRINTFN(0, "Global bTag=%d\n", bTag);
480 break;
481 }
482 break;
483 case 2: /* Local */
484 switch (bTag) {
485 case 0:
486 if (bSize != 4)
487 dval = (dval & mask) | c->_usage_page;
488
489 /* set last usage, in case of a collection */
490 s->usage_last = dval;
491
492 if (s->nusage < MAXUSAGE) {
493 s->usages_min[s->nusage] = dval;
494 s->usages_max[s->nusage] = dval;
495 s->nusage ++;
496 } else {
497 DPRINTFN(0, "max usage reached\n");
498 }
499
500 /* clear any pending usage sets */
501 s->susage = 0;
502 break;
503 case 1:
504 s->susage |= 1;
505
506 if (bSize != 4)
507 dval = (dval & mask) | c->_usage_page;
508 c->usage_minimum = dval;
509
510 goto check_set;
511 case 2:
512 s->susage |= 2;
513
514 if (bSize != 4)
515 dval = (dval & mask) | c->_usage_page;
516 c->usage_maximum = dval;
517
518 check_set:
519 if (s->susage != 3)
520 break;
521
522 /* sanity check */
523 if ((s->nusage < MAXUSAGE) &&
524 (c->usage_minimum <= c->usage_maximum)) {
525 /* add usage range */
526 s->usages_min[s->nusage] =
527 c->usage_minimum;
528 s->usages_max[s->nusage] =
529 c->usage_maximum;
530 s->nusage ++;
531 } else {
532 DPRINTFN(0, "Usage set dropped\n");
533 }
534 s->susage = 0;
535 break;
536 case 3:
537 c->designator_index = dval;
538 break;
539 case 4:
540 c->designator_minimum = dval;
541 break;
542 case 5:
543 c->designator_maximum = dval;
544 break;
545 case 7:
546 c->string_index = dval;
547 break;
548 case 8:
549 c->string_minimum = dval;
550 break;
551 case 9:
552 c->string_maximum = dval;
553 break;
554 case 10:
555 c->set_delimiter = dval;
556 break;
557 default:
558 DPRINTFN(0, "Local bTag=%d\n", bTag);
559 break;
560 }
561 break;
562 default:
563 DPRINTFN(0, "default bType=%d\n", bType);
564 break;
565 }
566 }
567 return (0);
568 }
569
570 /*------------------------------------------------------------------------*
571 * hid_report_size
572 *------------------------------------------------------------------------*/
573 int
574 hid_report_size(const void *buf, hid_size_t len, enum hid_kind k, uint8_t id)
575 {
576 struct hid_data *d;
577 struct hid_item h;
578 uint32_t temp;
579 uint32_t hpos;
580 uint32_t lpos;
581 int report_id = 0;
582
583 hpos = 0;
584 lpos = 0xFFFFFFFF;
585
586 for (d = hid_start_parse(buf, len, 1 << k); hid_get_item(d, &h);) {
587 if (h.kind == k && h.report_ID == id) {
588 /* compute minimum */
589 if (lpos > h.loc.pos)
590 lpos = h.loc.pos;
591 /* compute end position */
592 temp = h.loc.pos + (h.loc.size * h.loc.count);
593 /* compute maximum */
594 if (hpos < temp)
595 hpos = temp;
596 if (h.report_ID != 0)
597 report_id = 1;
598 }
599 }
600 hid_end_parse(d);
601
602 /* safety check - can happen in case of currupt descriptors */
603 if (lpos > hpos)
604 temp = 0;
605 else
606 temp = hpos - lpos;
607
608 /* return length in bytes rounded up */
609 return ((temp + 7) / 8 + report_id);
610 }
611
612 int
613 hid_report_size_max(const void *buf, hid_size_t len, enum hid_kind k,
614 uint8_t *id)
615 {
616 struct hid_data *d;
617 struct hid_item h;
618 uint32_t temp;
619 uint32_t hpos;
620 uint32_t lpos;
621 uint8_t any_id;
622
623 any_id = 0;
624 hpos = 0;
625 lpos = 0xFFFFFFFF;
626
627 for (d = hid_start_parse(buf, len, 1 << k); hid_get_item(d, &h);) {
628 if (h.kind == k) {
629 /* check for ID-byte presence */
630 if ((h.report_ID != 0) && !any_id) {
631 if (id != NULL)
632 *id = h.report_ID;
633 any_id = 1;
634 }
635 /* compute minimum */
636 if (lpos > h.loc.pos)
637 lpos = h.loc.pos;
638 /* compute end position */
639 temp = h.loc.pos + (h.loc.size * h.loc.count);
640 /* compute maximum */
641 if (hpos < temp)
642 hpos = temp;
643 }
644 }
645 hid_end_parse(d);
646
647 /* safety check - can happen in case of currupt descriptors */
648 if (lpos > hpos)
649 temp = 0;
650 else
651 temp = hpos - lpos;
652
653 /* check for ID byte */
654 if (any_id)
655 temp += 8;
656 else if (id != NULL)
657 *id = 0;
658
659 /* return length in bytes rounded up */
660 return ((temp + 7) / 8);
661 }
662
663 /*------------------------------------------------------------------------*
664 * hid_locate
665 *------------------------------------------------------------------------*/
666 int
667 hid_locate(const void *desc, hid_size_t size, int32_t u, enum hid_kind k,
668 uint8_t index, struct hid_location *loc, uint32_t *flags, uint8_t *id)
669 {
670 struct hid_data *d;
671 struct hid_item h;
672 int i;
673
674 for (d = hid_start_parse(desc, size, 1 << k); hid_get_item(d, &h);) {
675 for (i = 0; i < h.nusages; i++) {
676 if (h.kind == k && h.usages[i] == u) {
677 if (index--)
678 break;
679 if (loc != NULL)
680 *loc = h.loc;
681 if (flags != NULL)
682 *flags = h.flags;
683 if (id != NULL)
684 *id = h.report_ID;
685 hid_end_parse(d);
686 return (1);
687 }
688 }
689 }
690 if (loc != NULL)
691 loc->size = 0;
692 if (flags != NULL)
693 *flags = 0;
694 if (id != NULL)
695 *id = 0;
696 hid_end_parse(d);
697 return (0);
698 }
699
700 /*------------------------------------------------------------------------*
701 * hid_get_data
702 *------------------------------------------------------------------------*/
703 static uint32_t
704 hid_get_data_sub(const uint8_t *buf, hid_size_t len, struct hid_location *loc,
705 int is_signed)
706 {
707 uint32_t hpos = loc->pos;
708 uint32_t hsize = loc->size;
709 uint32_t data;
710 uint32_t rpos;
711 uint8_t n;
712
713 DPRINTFN(11, "hid_get_data: loc %d/%d\n", hpos, hsize);
714
715 /* Range check and limit */
716 if (hsize == 0)
717 return (0);
718 if (hsize > 32)
719 hsize = 32;
720
721 /* Get data in a safe way */
722 data = 0;
723 rpos = (hpos / 8);
724 n = (hsize + 7) / 8;
725 rpos += n;
726 while (n--) {
727 rpos--;
728 if (rpos < len)
729 data |= buf[rpos] << (8 * n);
730 }
731
732 /* Correctly shift down data */
733 data = (data >> (hpos % 8));
734 n = 32 - hsize;
735
736 /* Mask and sign extend in one */
737 if (is_signed != 0)
738 data = (int32_t)((int32_t)data << n) >> n;
739 else
740 data = (uint32_t)((uint32_t)data << n) >> n;
741
742 DPRINTFN(11, "hid_get_data: loc %d/%d = %lu\n",
743 loc->pos, loc->size, (long)data);
744 return (data);
745 }
746
747 int32_t
748 hid_get_data(const uint8_t *buf, hid_size_t len, struct hid_location *loc)
749 {
750 return (hid_get_data_sub(buf, len, loc, 1));
751 }
752
753 uint32_t
754 hid_get_udata(const uint8_t *buf, hid_size_t len, struct hid_location *loc)
755 {
756 return (hid_get_data_sub(buf, len, loc, 0));
757 }
758
759 /*------------------------------------------------------------------------*
760 * hid_put_data
761 *------------------------------------------------------------------------*/
762 void
763 hid_put_udata(uint8_t *buf, hid_size_t len,
764 struct hid_location *loc, unsigned int value)
765 {
766 uint32_t hpos = loc->pos;
767 uint32_t hsize = loc->size;
768 uint64_t data;
769 uint64_t mask;
770 uint32_t rpos;
771 uint8_t n;
772
773 DPRINTFN(11, "hid_put_data: loc %d/%d = %u\n", hpos, hsize, value);
774
775 /* Range check and limit */
776 if (hsize == 0)
777 return;
778 if (hsize > 32)
779 hsize = 32;
780
781 /* Put data in a safe way */
782 rpos = (hpos / 8);
783 n = (hsize + 7) / 8;
784 data = ((uint64_t)value) << (hpos % 8);
785 mask = ((1ULL << hsize) - 1ULL) << (hpos % 8);
786 rpos += n;
787 while (n--) {
788 rpos--;
789 if (rpos < len) {
790 buf[rpos] &= ~(mask >> (8 * n));
791 buf[rpos] |= (data >> (8 * n));
792 }
793 }
794 }
795
796 /*------------------------------------------------------------------------*
797 * hid_is_collection
798 *------------------------------------------------------------------------*/
799 int
800 hid_is_collection(const void *desc, hid_size_t size, int32_t usage)
801 {
802 struct hid_data *hd;
803 struct hid_item hi;
804 int err;
805
806 hd = hid_start_parse(desc, size, hid_input);
807 if (hd == NULL)
808 return (0);
809
810 while ((err = hid_get_item(hd, &hi))) {
811 if (hi.kind == hid_collection &&
812 hi.usage == usage)
813 break;
814 }
815 hid_end_parse(hd);
816 return (err);
817 }
818
819 /*------------------------------------------------------------------------*
820 * calculate HID item resolution. unit/mm for distances, unit/rad for angles
821 *------------------------------------------------------------------------*/
822 int32_t
823 hid_item_resolution(struct hid_item *hi)
824 {
825 /*
826 * hid unit scaling table according to HID Usage Table Review
827 * Request 39 Tbl 17 http://www.usb.org/developers/hidpage/HUTRR39b.pdf
828 */
829 static const int64_t scale[0x10][2] = {
830 [0x00] = { 1, 1 },
831 [0x01] = { 1, 10 },
832 [0x02] = { 1, 100 },
833 [0x03] = { 1, 1000 },
834 [0x04] = { 1, 10000 },
835 [0x05] = { 1, 100000 },
836 [0x06] = { 1, 1000000 },
837 [0x07] = { 1, 10000000 },
838 [0x08] = { 100000000, 1 },
839 [0x09] = { 10000000, 1 },
840 [0x0A] = { 1000000, 1 },
841 [0x0B] = { 100000, 1 },
842 [0x0C] = { 10000, 1 },
843 [0x0D] = { 1000, 1 },
844 [0x0E] = { 100, 1 },
845 [0x0F] = { 10, 1 },
846 };
847 int64_t logical_size;
848 int64_t physical_size;
849 int64_t multiplier;
850 int64_t divisor;
851 int64_t resolution;
852
853 switch (hi->unit) {
854 case HUM_CENTIMETER:
855 multiplier = 1;
856 divisor = 10;
857 break;
858 case HUM_INCH:
859 case HUM_INCH_EGALAX:
860 multiplier = 10;
861 divisor = 254;
862 break;
863 case HUM_RADIAN:
864 multiplier = 1;
865 divisor = 1;
866 break;
867 case HUM_DEGREE:
868 multiplier = 573;
869 divisor = 10;
870 break;
871 default:
872 return (0);
873 }
874
875 if ((hi->logical_maximum <= hi->logical_minimum) ||
876 (hi->physical_maximum <= hi->physical_minimum) ||
877 (hi->unit_exponent < 0) || (hi->unit_exponent >= nitems(scale)))
878 return (0);
879
880 logical_size = (int64_t)hi->logical_maximum -
881 (int64_t)hi->logical_minimum;
882 physical_size = (int64_t)hi->physical_maximum -
883 (int64_t)hi->physical_minimum;
884 /* Round to ceiling */
885 resolution = logical_size * multiplier * scale[hi->unit_exponent][0] /
886 (physical_size * divisor * scale[hi->unit_exponent][1]);
887
888 if (resolution > INT32_MAX)
889 return (0);
890
891 return (resolution);
892 }
893
894 /*------------------------------------------------------------------------*
895 * hid_is_mouse
896 *
897 * This function will decide if a USB descriptor belongs to a USB mouse.
898 *
899 * Return values:
900 * Zero: Not a USB mouse.
901 * Else: Is a USB mouse.
902 *------------------------------------------------------------------------*/
903 int
904 hid_is_mouse(const void *d_ptr, uint16_t d_len)
905 {
906 struct hid_data *hd;
907 struct hid_item hi;
908 int mdepth;
909 int found;
910
911 hd = hid_start_parse(d_ptr, d_len, 1 << hid_input);
912 if (hd == NULL)
913 return (0);
914
915 mdepth = 0;
916 found = 0;
917
918 while (hid_get_item(hd, &hi)) {
919 switch (hi.kind) {
920 case hid_collection:
921 if (mdepth != 0)
922 mdepth++;
923 else if (hi.collection == 1 &&
924 hi.usage ==
925 HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_MOUSE))
926 mdepth++;
927 break;
928 case hid_endcollection:
929 if (mdepth != 0)
930 mdepth--;
931 break;
932 case hid_input:
933 if (mdepth == 0)
934 break;
935 if (hi.usage ==
936 HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_X) &&
937 (hi.flags & (HIO_CONST|HIO_RELATIVE)) == HIO_RELATIVE)
938 found++;
939 if (hi.usage ==
940 HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_Y) &&
941 (hi.flags & (HIO_CONST|HIO_RELATIVE)) == HIO_RELATIVE)
942 found++;
943 break;
944 default:
945 break;
946 }
947 }
948 hid_end_parse(hd);
949 return (found);
950 }
951
952 /*------------------------------------------------------------------------*
953 * hid_is_keyboard
954 *
955 * This function will decide if a USB descriptor belongs to a USB keyboard.
956 *
957 * Return values:
958 * Zero: Not a USB keyboard.
959 * Else: Is a USB keyboard.
960 *------------------------------------------------------------------------*/
961 int
962 hid_is_keyboard(const void *d_ptr, uint16_t d_len)
963 {
964 if (hid_is_collection(d_ptr, d_len,
965 HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_KEYBOARD)))
966 return (1);
967 return (0);
968 }
969
970 /*------------------------------------------------------------------------*
971 * hid_test_quirk - test a device for a given quirk
972 *
973 * Return values:
974 * false: The HID device does not have the given quirk.
975 * true: The HID device has the given quirk.
976 *------------------------------------------------------------------------*/
977 bool
978 hid_test_quirk(const struct hid_device_info *dev_info, uint16_t quirk)
979 {
980 bool found;
981 uint8_t x;
982
983 if (quirk == HQ_NONE)
984 return (false);
985
986 /* search the automatic per device quirks first */
987 for (x = 0; x != HID_MAX_AUTO_QUIRK; x++) {
988 if (dev_info->autoQuirk[x] == quirk)
989 return (true);
990 }
991
992 /* search global quirk table, if any */
993 found = (hid_test_quirk_p) (dev_info, quirk);
994
995 return (found);
996 }
997
998 static bool
999 hid_test_quirk_w(const struct hid_device_info *dev_info, uint16_t quirk)
1000 {
1001 return (false); /* no match */
1002 }
1003
1004 int
1005 hid_add_dynamic_quirk(struct hid_device_info *dev_info, uint16_t quirk)
1006 {
1007 uint8_t x;
1008
1009 for (x = 0; x != HID_MAX_AUTO_QUIRK; x++) {
1010 if (dev_info->autoQuirk[x] == 0 ||
1011 dev_info->autoQuirk[x] == quirk) {
1012 dev_info->autoQuirk[x] = quirk;
1013 return (0); /* success */
1014 }
1015 }
1016 return (ENOSPC);
1017 }
1018
1019 void
1020 hid_quirk_unload(void *arg)
1021 {
1022 /* reset function pointer */
1023 hid_test_quirk_p = &hid_test_quirk_w;
1024 #ifdef NOT_YET
1025 hidquirk_ioctl_p = &hidquirk_ioctl_w;
1026 #endif
1027
1028 /* wait for CPU to exit the loaded functions, if any */
1029
1030 /* XXX this is a tradeoff */
1031
1032 pause("WAIT", hz);
1033 }
1034
1035 int
1036 hid_get_rdesc(device_t dev, void *data, hid_size_t len)
1037 {
1038 return (HID_GET_RDESC(device_get_parent(dev), data, len));
1039 }
1040
1041 int
1042 hid_read(device_t dev, void *data, hid_size_t maxlen, hid_size_t *actlen)
1043 {
1044 return (HID_READ(device_get_parent(dev), data, maxlen, actlen));
1045 }
1046
1047 int
1048 hid_write(device_t dev, const void *data, hid_size_t len)
1049 {
1050 return (HID_WRITE(device_get_parent(dev), data, len));
1051 }
1052
1053 int
1054 hid_get_report(device_t dev, void *data, hid_size_t maxlen, hid_size_t *actlen,
1055 uint8_t type, uint8_t id)
1056 {
1057 return (HID_GET_REPORT(device_get_parent(dev), data, maxlen, actlen,
1058 type, id));
1059 }
1060
1061 int
1062 hid_set_report(device_t dev, const void *data, hid_size_t len, uint8_t type,
1063 uint8_t id)
1064 {
1065 return (HID_SET_REPORT(device_get_parent(dev), data, len, type, id));
1066 }
1067
1068 int
1069 hid_set_idle(device_t dev, uint16_t duration, uint8_t id)
1070 {
1071 return (HID_SET_IDLE(device_get_parent(dev), duration, id));
1072 }
1073
1074 int
1075 hid_set_protocol(device_t dev, uint16_t protocol)
1076 {
1077 return (HID_SET_PROTOCOL(device_get_parent(dev), protocol));
1078 }
1079
1080 MODULE_VERSION(hid, 1);
Cache object: 119ee8d22f70f5cecc63ab14e1e5df27
|