]> git.ipfire.org Git - people/ms/u-boot.git/blob - common/usb_kbd.c
[PCS440EP] - The DIAG LEDs are now blinking, if an error occur
[people/ms/u-boot.git] / common / usb_kbd.c
1 /*
2 * (C) Copyright 2001
3 * Denis Peter, MPL AG Switzerland
4 *
5 * Part of this source has been derived from the Linux USB
6 * project.
7 *
8 * See file CREDITS for list of people who contributed to this
9 * project.
10 *
11 * This program is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU General Public License as
13 * published by the Free Software Foundation; either version 2 of
14 * the License, or (at your option) any later version.
15 *
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
24 * MA 02111-1307 USA
25 *
26 */
27 #include <common.h>
28 #include <devices.h>
29
30 #ifdef CONFIG_USB_KEYBOARD
31
32 #include <usb.h>
33
34 #undef USB_KBD_DEBUG
35 /*
36 * if overwrite_console returns 1, the stdin, stderr and stdout
37 * are switched to the serial port, else the settings in the
38 * environment are used
39 */
40 #ifdef CFG_CONSOLE_OVERWRITE_ROUTINE
41 extern int overwrite_console (void);
42 #else
43 int overwrite_console (void)
44 {
45 return (0);
46 }
47 #endif
48
49 #ifdef USB_KBD_DEBUG
50 #define USB_KBD_PRINTF(fmt,args...) printf (fmt ,##args)
51 #else
52 #define USB_KBD_PRINTF(fmt,args...)
53 #endif
54
55
56 #define REPEAT_RATE 40/4 /* 40msec -> 25cps */
57 #define REPEAT_DELAY 10 /* 10 x REAPEAT_RATE = 400msec */
58
59 #define NUM_LOCK 0x53
60 #define CAPS_LOCK 0x39
61 #define SCROLL_LOCK 0x47
62
63
64 /* Modifier bits */
65 #define LEFT_CNTR 0
66 #define LEFT_SHIFT 1
67 #define LEFT_ALT 2
68 #define LEFT_GUI 3
69 #define RIGHT_CNTR 4
70 #define RIGHT_SHIFT 5
71 #define RIGHT_ALT 6
72 #define RIGHT_GUI 7
73
74 #define USB_KBD_BUFFER_LEN 0x20 /* size of the keyboardbuffer */
75
76 static volatile char usb_kbd_buffer[USB_KBD_BUFFER_LEN];
77 static volatile int usb_in_pointer = 0;
78 static volatile int usb_out_pointer = 0;
79
80 unsigned char new[8];
81 unsigned char old[8];
82 int repeat_delay;
83 #define DEVNAME "usbkbd"
84 static unsigned char num_lock = 0;
85 static unsigned char caps_lock = 0;
86 static unsigned char scroll_lock = 0;
87
88 static unsigned char leds __attribute__ ((aligned (0x4)));
89
90 static unsigned char usb_kbd_numkey[] = {
91 '1', '2', '3', '4', '5', '6', '7', '8', '9', '0','\r',0x1b,'\b','\t',' ', '-',
92 '=', '[', ']','\\', '#', ';', '\'', '`', ',', '.', '/'
93 };
94 static unsigned char usb_kbd_numkey_shifted[] = {
95 '!', '@', '#', '$', '%', '^', '&', '*', '(', ')','\r',0x1b,'\b','\t',' ', '_',
96 '+', '{', '}', '|', '~', ':', '"', '~', '<', '>', '?'
97 };
98
99 /******************************************************************
100 * Queue handling
101 ******************************************************************/
102 /* puts character in the queue and sets up the in and out pointer */
103 static void usb_kbd_put_queue(char data)
104 {
105 if((usb_in_pointer+1)==USB_KBD_BUFFER_LEN) {
106 if(usb_out_pointer==0) {
107 return; /* buffer full */
108 } else{
109 usb_in_pointer=0;
110 }
111 } else {
112 if((usb_in_pointer+1)==usb_out_pointer)
113 return; /* buffer full */
114 usb_in_pointer++;
115 }
116 usb_kbd_buffer[usb_in_pointer]=data;
117 return;
118 }
119
120 /* test if a character is in the queue */
121 static int usb_kbd_testc(void)
122 {
123 if(usb_in_pointer==usb_out_pointer)
124 return(0); /* no data */
125 else
126 return(1);
127 }
128 /* gets the character from the queue */
129 static int usb_kbd_getc(void)
130 {
131 char c;
132 while(usb_in_pointer==usb_out_pointer);
133 if((usb_out_pointer+1)==USB_KBD_BUFFER_LEN)
134 usb_out_pointer=0;
135 else
136 usb_out_pointer++;
137 c=usb_kbd_buffer[usb_out_pointer];
138 return (int)c;
139
140 }
141
142 /* forward decleration */
143 static int usb_kbd_probe(struct usb_device *dev, unsigned int ifnum);
144
145 /* search for keyboard and register it if found */
146 int drv_usb_kbd_init(void)
147 {
148 int error,i,index;
149 device_t usb_kbd_dev,*old_dev;
150 struct usb_device *dev;
151 char *stdinname = getenv ("stdin");
152
153 usb_in_pointer=0;
154 usb_out_pointer=0;
155 /* scan all USB Devices */
156 for(i=0;i<USB_MAX_DEVICE;i++) {
157 dev=usb_get_dev_index(i); /* get device */
158 if(dev->devnum!=-1) {
159 if(usb_kbd_probe(dev,0)==1) { /* Ok, we found a keyboard */
160 /* check, if it is already registered */
161 USB_KBD_PRINTF("USB KBD found set up device.\n");
162 for (index=1; index<=ListNumItems(devlist); index++) {
163 old_dev = ListGetPtrToItem(devlist, index);
164 if(strcmp(old_dev->name,DEVNAME)==0) {
165 /* ok, already registered, just return ok */
166 USB_KBD_PRINTF("USB KBD is already registered.\n");
167 return 1;
168 }
169 }
170 /* register the keyboard */
171 USB_KBD_PRINTF("USB KBD register.\n");
172 memset (&usb_kbd_dev, 0, sizeof(device_t));
173 strcpy(usb_kbd_dev.name, DEVNAME);
174 usb_kbd_dev.flags = DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
175 usb_kbd_dev.putc = NULL;
176 usb_kbd_dev.puts = NULL;
177 usb_kbd_dev.getc = usb_kbd_getc;
178 usb_kbd_dev.tstc = usb_kbd_testc;
179 error = device_register (&usb_kbd_dev);
180 if(error==0) {
181 /* check if this is the standard input device */
182 if(strcmp(stdinname,DEVNAME)==0) {
183 /* reassign the console */
184 if(overwrite_console()) {
185 return 1;
186 }
187 error=console_assign(stdin,DEVNAME);
188 if(error==0)
189 return 1;
190 else
191 return error;
192 }
193 return 1;
194 }
195 return error;
196 }
197 }
198 }
199 /* no USB Keyboard found */
200 return -1;
201 }
202
203
204 /* deregistering the keyboard */
205 int usb_kbd_deregister(void)
206 {
207 return device_deregister(DEVNAME);
208 }
209
210 /**************************************************************************
211 * Low Level drivers
212 */
213
214 /* set the LEDs. Since this is used in the irq routine, the control job
215 is issued with a timeout of 0. This means, that the job is queued without
216 waiting for job completion */
217
218 static void usb_kbd_setled(struct usb_device *dev)
219 {
220 struct usb_interface_descriptor *iface;
221 iface = &dev->config.if_desc[0];
222 leds=0;
223 if(scroll_lock!=0)
224 leds|=1;
225 leds<<=1;
226 if(caps_lock!=0)
227 leds|=1;
228 leds<<=1;
229 if(num_lock!=0)
230 leds|=1;
231 usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
232 USB_REQ_SET_REPORT, USB_TYPE_CLASS | USB_RECIP_INTERFACE,
233 0x200, iface->bInterfaceNumber,(void *)&leds, 1, 0);
234
235 }
236
237
238 #define CAPITAL_MASK 0x20
239 /* Translate the scancode in ASCII */
240 static int usb_kbd_translate(unsigned char scancode,unsigned char modifier,int pressed)
241 {
242 unsigned char keycode;
243
244 if(pressed==0) {
245 /* key released */
246 repeat_delay=0;
247 return 0;
248 }
249 if(pressed==2) {
250 repeat_delay++;
251 if(repeat_delay<REPEAT_DELAY)
252 return 0;
253 repeat_delay=REPEAT_DELAY;
254 }
255 keycode=0;
256 if((scancode>3) && (scancode<0x1d)) { /* alpha numeric values */
257 keycode=scancode-4 + 0x61;
258 if(caps_lock)
259 keycode&=~CAPITAL_MASK; /* switch to capital Letters */
260 if(((modifier&(1<<LEFT_SHIFT))!=0)||((modifier&(1<<RIGHT_SHIFT))!=0)) {
261 if(keycode & CAPITAL_MASK)
262 keycode&=~CAPITAL_MASK; /* switch to capital Letters */
263 else
264 keycode|=CAPITAL_MASK; /* switch to non capital Letters */
265 }
266 }
267 if((scancode>0x1d) && (scancode<0x3A)) {
268 if(((modifier&(1<<LEFT_SHIFT))!=0)||((modifier&(1<<RIGHT_SHIFT))!=0)) /* shifted */
269 keycode=usb_kbd_numkey_shifted[scancode-0x1e];
270 else /* non shifted */
271 keycode=usb_kbd_numkey[scancode-0x1e];
272 }
273 if(pressed==1) {
274 if(scancode==NUM_LOCK) {
275 num_lock=~num_lock;
276 return 1;
277 }
278 if(scancode==CAPS_LOCK) {
279 caps_lock=~caps_lock;
280 return 1;
281 }
282 if(scancode==SCROLL_LOCK) {
283 scroll_lock=~scroll_lock;
284 return 1;
285 }
286 }
287 if(keycode!=0) {
288 USB_KBD_PRINTF("%c",keycode);
289 usb_kbd_put_queue(keycode);
290 }
291 return 0;
292 }
293
294 /* Interrupt service routine */
295 static int usb_kbd_irq(struct usb_device *dev)
296 {
297 int i,res;
298
299 if((dev->irq_status!=0)||(dev->irq_act_len!=8))
300 {
301 USB_KBD_PRINTF("usb_keyboard Error %lX, len %d\n",dev->irq_status,dev->irq_act_len);
302 return 1;
303 }
304 res=0;
305 for (i = 2; i < 8; i++) {
306 if (old[i] > 3 && memscan(&new[2], old[i], 6) == &new[8]) {
307 res|=usb_kbd_translate(old[i],new[0],0);
308 }
309 if (new[i] > 3 && memscan(&old[2], new[i], 6) == &old[8]) {
310 res|=usb_kbd_translate(new[i],new[0],1);
311 }
312 }
313 if((new[2]>3) && (old[2]==new[2])) /* still pressed */
314 res|=usb_kbd_translate(new[2],new[0],2);
315 if(res==1)
316 usb_kbd_setled(dev);
317 memcpy(&old[0],&new[0], 8);
318 return 1; /* install IRQ Handler again */
319 }
320
321 /* probes the USB device dev for keyboard type */
322 static int usb_kbd_probe(struct usb_device *dev, unsigned int ifnum)
323 {
324 struct usb_interface_descriptor *iface;
325 struct usb_endpoint_descriptor *ep;
326 int pipe,maxp;
327
328 if (dev->descriptor.bNumConfigurations != 1) return 0;
329 iface = &dev->config.if_desc[ifnum];
330
331 if (iface->bInterfaceClass != 3) return 0;
332 if (iface->bInterfaceSubClass != 1) return 0;
333 if (iface->bInterfaceProtocol != 1) return 0;
334 if (iface->bNumEndpoints != 1) return 0;
335
336 ep = &iface->ep_desc[0];
337
338 if (!(ep->bEndpointAddress & 0x80)) return 0;
339 if ((ep->bmAttributes & 3) != 3) return 0;
340 USB_KBD_PRINTF("USB KBD found set protocol...\n");
341 /* ok, we found a USB Keyboard, install it */
342 /* usb_kbd_get_hid_desc(dev); */
343 usb_set_protocol(dev, iface->bInterfaceNumber, 0);
344 USB_KBD_PRINTF("USB KBD found set idle...\n");
345 usb_set_idle(dev, iface->bInterfaceNumber, REPEAT_RATE, 0);
346 memset(&new[0], 0, 8);
347 memset(&old[0], 0, 8);
348 repeat_delay=0;
349 pipe = usb_rcvintpipe(dev, ep->bEndpointAddress);
350 maxp = usb_maxpacket(dev, pipe);
351 dev->irq_handle=usb_kbd_irq;
352 USB_KBD_PRINTF("USB KBD enable interrupt pipe...\n");
353 usb_submit_int_msg(dev,pipe,&new[0], maxp > 8 ? 8 : maxp,ep->bInterval);
354 return 1;
355 }
356
357
358 #if 0
359 struct usb_hid_descriptor {
360 unsigned char bLength;
361 unsigned char bDescriptorType; /* 0x21 for HID */
362 unsigned short bcdHID; /* release number */
363 unsigned char bCountryCode;
364 unsigned char bNumDescriptors;
365 unsigned char bReportDescriptorType;
366 unsigned short wDescriptorLength;
367 } __attribute__ ((packed));
368
369 /*
370 * We parse each description item into this structure. Short items data
371 * values are expanded to 32-bit signed int, long items contain a pointer
372 * into the data area.
373 */
374
375 struct hid_item {
376 unsigned char format;
377 unsigned char size;
378 unsigned char type;
379 unsigned char tag;
380 union {
381 unsigned char u8;
382 char s8;
383 unsigned short u16;
384 short s16;
385 unsigned long u32;
386 long s32;
387 unsigned char *longdata;
388 } data;
389 };
390
391 /*
392 * HID report item format
393 */
394
395 #define HID_ITEM_FORMAT_SHORT 0
396 #define HID_ITEM_FORMAT_LONG 1
397
398 /*
399 * Special tag indicating long items
400 */
401
402 #define HID_ITEM_TAG_LONG 15
403
404
405 static struct usb_hid_descriptor usb_kbd_hid_desc;
406
407 void usb_kbd_display_hid(struct usb_hid_descriptor *hid)
408 {
409 printf("USB_HID_DESC:\n");
410 printf(" bLenght 0x%x\n",hid->bLength);
411 printf(" bcdHID 0x%x\n",hid->bcdHID);
412 printf(" bCountryCode %d\n",hid->bCountryCode);
413 printf(" bNumDescriptors 0x%x\n",hid->bNumDescriptors);
414 printf(" bReportDescriptorType 0x%x\n",hid->bReportDescriptorType);
415 printf(" wDescriptorLength 0x%x\n",hid->wDescriptorLength);
416 }
417
418
419 /*
420 * Fetch a report description item from the data stream. We support long
421 * items, though they are not used yet.
422 */
423
424 static int fetch_item(unsigned char *start,unsigned char *end, struct hid_item *item)
425 {
426 if((end - start) > 0) {
427 unsigned char b = *start++;
428 item->type = (b >> 2) & 3;
429 item->tag = (b >> 4) & 15;
430 if (item->tag == HID_ITEM_TAG_LONG) {
431 item->format = HID_ITEM_FORMAT_LONG;
432 if ((end - start) >= 2) {
433 item->size = *start++;
434 item->tag = *start++;
435 if ((end - start) >= item->size) {
436 item->data.longdata = start;
437 start += item->size;
438 return item->size;
439 }
440 }
441 } else {
442 item->format = HID_ITEM_FORMAT_SHORT;
443 item->size = b & 3;
444 switch (item->size) {
445 case 0:
446 return item->size;
447 case 1:
448 if ((end - start) >= 1) {
449 item->data.u8 = *start++;
450 return item->size;
451 }
452 break;
453 case 2:
454 if ((end - start) >= 2) {
455 item->data.u16 = swap_16((unsigned short *)start);
456 start+=2;
457 return item->size;
458 }
459 case 3:
460 item->size++;
461 if ((end - start) >= 4) {
462 item->data.u32 = swap_32((unsigned long *)start);
463 start+=4;
464 return item->size;
465 }
466 }
467 }
468 }
469 return -1;
470 }
471
472 /*
473 * HID report descriptor item type (prefix bit 2,3)
474 */
475
476 #define HID_ITEM_TYPE_MAIN 0
477 #define HID_ITEM_TYPE_GLOBAL 1
478 #define HID_ITEM_TYPE_LOCAL 2
479 #define HID_ITEM_TYPE_RESERVED 3
480 /*
481 * HID report descriptor main item tags
482 */
483
484 #define HID_MAIN_ITEM_TAG_INPUT 8
485 #define HID_MAIN_ITEM_TAG_OUTPUT 9
486 #define HID_MAIN_ITEM_TAG_FEATURE 11
487 #define HID_MAIN_ITEM_TAG_BEGIN_COLLECTION 10
488 #define HID_MAIN_ITEM_TAG_END_COLLECTION 12
489 /*
490 * HID report descriptor main item contents
491 */
492
493 #define HID_MAIN_ITEM_CONSTANT 0x001
494 #define HID_MAIN_ITEM_VARIABLE 0x002
495 #define HID_MAIN_ITEM_RELATIVE 0x004
496 #define HID_MAIN_ITEM_WRAP 0x008
497 #define HID_MAIN_ITEM_NONLINEAR 0x010
498 #define HID_MAIN_ITEM_NO_PREFERRED 0x020
499 #define HID_MAIN_ITEM_NULL_STATE 0x040
500 #define HID_MAIN_ITEM_VOLATILE 0x080
501 #define HID_MAIN_ITEM_BUFFERED_BYTE 0x100
502
503 /*
504 * HID report descriptor collection item types
505 */
506
507 #define HID_COLLECTION_PHYSICAL 0
508 #define HID_COLLECTION_APPLICATION 1
509 #define HID_COLLECTION_LOGICAL 2
510 /*
511 * HID report descriptor global item tags
512 */
513
514 #define HID_GLOBAL_ITEM_TAG_USAGE_PAGE 0
515 #define HID_GLOBAL_ITEM_TAG_LOGICAL_MINIMUM 1
516 #define HID_GLOBAL_ITEM_TAG_LOGICAL_MAXIMUM 2
517 #define HID_GLOBAL_ITEM_TAG_PHYSICAL_MINIMUM 3
518 #define HID_GLOBAL_ITEM_TAG_PHYSICAL_MAXIMUM 4
519 #define HID_GLOBAL_ITEM_TAG_UNIT_EXPONENT 5
520 #define HID_GLOBAL_ITEM_TAG_UNIT 6
521 #define HID_GLOBAL_ITEM_TAG_REPORT_SIZE 7
522 #define HID_GLOBAL_ITEM_TAG_REPORT_ID 8
523 #define HID_GLOBAL_ITEM_TAG_REPORT_COUNT 9
524 #define HID_GLOBAL_ITEM_TAG_PUSH 10
525 #define HID_GLOBAL_ITEM_TAG_POP 11
526
527 /*
528 * HID report descriptor local item tags
529 */
530
531 #define HID_LOCAL_ITEM_TAG_USAGE 0
532 #define HID_LOCAL_ITEM_TAG_USAGE_MINIMUM 1
533 #define HID_LOCAL_ITEM_TAG_USAGE_MAXIMUM 2
534 #define HID_LOCAL_ITEM_TAG_DESIGNATOR_INDEX 3
535 #define HID_LOCAL_ITEM_TAG_DESIGNATOR_MINIMUM 4
536 #define HID_LOCAL_ITEM_TAG_DESIGNATOR_MAXIMUM 5
537 #define HID_LOCAL_ITEM_TAG_STRING_INDEX 7
538 #define HID_LOCAL_ITEM_TAG_STRING_MINIMUM 8
539 #define HID_LOCAL_ITEM_TAG_STRING_MAXIMUM 9
540 #define HID_LOCAL_ITEM_TAG_DELIMITER 10
541
542
543 static void usb_kbd_show_item(struct hid_item *item)
544 {
545 switch(item->type) {
546 case HID_ITEM_TYPE_MAIN:
547 switch(item->tag) {
548 case HID_MAIN_ITEM_TAG_INPUT:
549 printf("Main Input");
550 break;
551 case HID_MAIN_ITEM_TAG_OUTPUT:
552 printf("Main Output");
553 break;
554 case HID_MAIN_ITEM_TAG_FEATURE:
555 printf("Main Feature");
556 break;
557 case HID_MAIN_ITEM_TAG_BEGIN_COLLECTION:
558 printf("Main Begin Collection");
559 break;
560 case HID_MAIN_ITEM_TAG_END_COLLECTION:
561 printf("Main End Collection");
562 break;
563 default:
564 printf("Main reserved %d",item->tag);
565 break;
566 }
567 break;
568 case HID_ITEM_TYPE_GLOBAL:
569 switch(item->tag) {
570 case HID_GLOBAL_ITEM_TAG_USAGE_PAGE:
571 printf("- Global Usage Page");
572 break;
573 case HID_GLOBAL_ITEM_TAG_LOGICAL_MINIMUM:
574 printf("- Global Logical Minimum");
575 break;
576 case HID_GLOBAL_ITEM_TAG_LOGICAL_MAXIMUM:
577 printf("- Global Logical Maximum");
578 break;
579 case HID_GLOBAL_ITEM_TAG_PHYSICAL_MINIMUM:
580 printf("- Global physical Minimum");
581 break;
582 case HID_GLOBAL_ITEM_TAG_PHYSICAL_MAXIMUM:
583 printf("- Global physical Maximum");
584 break;
585 case HID_GLOBAL_ITEM_TAG_UNIT_EXPONENT:
586 printf("- Global Unit Exponent");
587 break;
588 case HID_GLOBAL_ITEM_TAG_UNIT:
589 printf("- Global Unit");
590 break;
591 case HID_GLOBAL_ITEM_TAG_REPORT_SIZE:
592 printf("- Global Report Size");
593 break;
594 case HID_GLOBAL_ITEM_TAG_REPORT_ID:
595 printf("- Global Report ID");
596 break;
597 case HID_GLOBAL_ITEM_TAG_REPORT_COUNT:
598 printf("- Global Report Count");
599 break;
600 case HID_GLOBAL_ITEM_TAG_PUSH:
601 printf("- Global Push");
602 break;
603 case HID_GLOBAL_ITEM_TAG_POP:
604 printf("- Global Pop");
605 break;
606 default:
607 printf("- Global reserved %d",item->tag);
608 break;
609 }
610 break;
611 case HID_ITEM_TYPE_LOCAL:
612 switch(item->tag) {
613 case HID_LOCAL_ITEM_TAG_USAGE:
614 printf("-- Local Usage");
615 break;
616 case HID_LOCAL_ITEM_TAG_USAGE_MINIMUM:
617 printf("-- Local Usage Minimum");
618 break;
619 case HID_LOCAL_ITEM_TAG_USAGE_MAXIMUM:
620 printf("-- Local Usage Maximum");
621 break;
622 case HID_LOCAL_ITEM_TAG_DESIGNATOR_INDEX:
623 printf("-- Local Designator Index");
624 break;
625 case HID_LOCAL_ITEM_TAG_DESIGNATOR_MINIMUM:
626 printf("-- Local Designator Minimum");
627 break;
628 case HID_LOCAL_ITEM_TAG_DESIGNATOR_MAXIMUM:
629 printf("-- Local Designator Maximum");
630 break;
631 case HID_LOCAL_ITEM_TAG_STRING_INDEX:
632 printf("-- Local String Index");
633 break;
634 case HID_LOCAL_ITEM_TAG_STRING_MINIMUM:
635 printf("-- Local String Minimum");
636 break;
637 case HID_LOCAL_ITEM_TAG_STRING_MAXIMUM:
638 printf("-- Local String Maximum");
639 break;
640 case HID_LOCAL_ITEM_TAG_DELIMITER:
641 printf("-- Local Delimiter");
642 break;
643 default:
644 printf("-- Local reserved %d",item->tag);
645 break;
646 }
647 break;
648 default:
649 printf("--- reserved %d",item->type);
650 break;
651 }
652 switch(item->size) {
653 case 1:
654 printf(" %d",item->data.u8);
655 break;
656 case 2:
657 printf(" %d",item->data.u16);
658 break;
659 case 4:
660 printf(" %ld",item->data.u32);
661 break;
662 }
663 printf("\n");
664 }
665
666
667 static int usb_kbd_get_hid_desc(struct usb_device *dev)
668 {
669 unsigned char buffer[256];
670 struct usb_descriptor_header *head;
671 struct usb_config_descriptor *config;
672 int index,len,i;
673 unsigned char *start, *end;
674 struct hid_item item;
675
676 if(usb_get_configuration_no(dev,&buffer[0],0)==-1)
677 return -1;
678 head =(struct usb_descriptor_header *)&buffer[0];
679 if(head->bDescriptorType!=USB_DT_CONFIG) {
680 printf(" ERROR: NOT USB_CONFIG_DESC %x\n",head->bDescriptorType);
681 return -1;
682 }
683 index=head->bLength;
684 config=(struct usb_config_descriptor *)&buffer[0];
685 len=swap_16(config->wTotalLength);
686 /* Ok the first entry must be a configuration entry, now process the others */
687 head=(struct usb_descriptor_header *)&buffer[index];
688 while(index+1 < len) {
689 if(head->bDescriptorType==USB_DT_HID) {
690 printf("HID desc found\n");
691 memcpy(&usb_kbd_hid_desc,&buffer[index],buffer[index]);
692 usb_kbd_hid_desc.bcdHID=swap_16(usb_kbd_hid_desc.bcdHID);
693 usb_kbd_hid_desc.wDescriptorLength=swap_16(usb_kbd_hid_desc.wDescriptorLength);
694 usb_kbd_display_hid(&usb_kbd_hid_desc);
695 len=0;
696 break;
697 }
698 index+=head->bLength;
699 head=(struct usb_descriptor_header *)&buffer[index];
700 }
701 if(len>0)
702 return -1;
703 len=usb_kbd_hid_desc.wDescriptorLength;
704 if((index = usb_get_class_descriptor(dev, 0, USB_DT_REPORT, 0, &buffer[0], len)) < 0) {
705 printf("reading report descriptor failed\n");
706 return -1;
707 }
708 printf(" report descriptor (size %u, read %d)\n", len, index);
709 start=&buffer[0];
710 end=&buffer[len];
711 i=0;
712 do {
713 index=fetch_item(start,end,&item);
714 i+=index;
715 i++;
716 if(index>=0)
717 usb_kbd_show_item(&item);
718
719 start+=index;
720 start++;
721 } while(index>=0);
722
723 }
724
725
726 #endif
727
728 #endif /* CONFIG_USB_KEYBOARD */