GitHub-Mirror/u-boot
2
0
Fork 0
mirror of https://github.com/Fishwaldo/u-boot.git synced 2025-04-15 10:51:31 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

usb: Fix USB keyboard polling via control endpoint

Browse source 
USB keyboard polling failed for some keyboards on PowerPC 5020.
This was caused by requesting only 4 bytes of data from keyboards that
produce an 8 byte HID report.

Signed-off-by: Adrian Cox <adrian@humboldt.co.uk>
Signed-off-by: Wolfgang Denk <wd@denx.de>
Cc: Marek Vasut <marex@denx.de>
This commit is contained in:
Adrian Cox 2014-04-10 14:02:44 +01:00 • committed by Marek Vasut
parent ea42777567
commit 08a98b89df
1 changed files with 25 additions and 11 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

36
common/usb_kbd.c
View file

@ -91,6 +91,12 @@ static const unsigned char usb_kbd_arrow[] = {
#define USB_KBD_LEDMASK \ #define USB_KBD_LEDMASK \
(USB_KBD_NUMLOCK | USB_KBD_CAPSLOCK | USB_KBD_SCROLLLOCK) (USB_KBD_NUMLOCK | USB_KBD_CAPSLOCK | USB_KBD_SCROLLLOCK)
/*
* USB Keyboard reports are 8 bytes in boot protocol.
* Appendix B of HID Device Class Definition 1.11
*/
#define USB_KBD_BOOT_REPORT_SIZE 8
struct usb_kbd_pdata { struct usb_kbd_pdata {
uint32_t repeat_delay; uint32_t repeat_delay;
@ -99,7 +105,7 @@ struct usb_kbd_pdata {
uint8_t usb_kbd_buffer[USB_KBD_BUFFER_LEN]; uint8_t usb_kbd_buffer[USB_KBD_BUFFER_LEN];
uint8_t *new; uint8_t *new;
uint8_t old[8]; uint8_t old[USB_KBD_BOOT_REPORT_SIZE];
uint8_t flags; uint8_t flags;
}; };
@ -131,7 +137,8 @@ void usb_kbd_generic_poll(void)
/* Submit a interrupt transfer request */ /* Submit a interrupt transfer request */
maxp = usb_maxpacket(usb_kbd_dev, pipe); maxp = usb_maxpacket(usb_kbd_dev, pipe);
usb_submit_int_msg(usb_kbd_dev, pipe, data->new, usb_submit_int_msg(usb_kbd_dev, pipe, data->new,
maxp > 8 ? 8 : maxp, ep->bInterval); min(maxp, USB_KBD_BOOT_REPORT_SIZE),
ep->bInterval);
} }
/* Puts character in the queue and sets up the in and out pointer. */ /* Puts character in the queue and sets up the in and out pointer. */
@ -266,8 +273,11 @@ static uint32_t usb_kbd_service_key(struct usb_device *dev, int i, int up)
old = data->old; old = data->old;
} }
if ((old[i] > 3) && (memscan(new + 2, old[i], 6) == new + 8)) if ((old[i] > 3) &&
(memscan(new + 2, old[i], USB_KBD_BOOT_REPORT_SIZE - 2) ==
new + USB_KBD_BOOT_REPORT_SIZE)) {
res |= usb_kbd_translate(data, old[i], data->new[0], up); res |= usb_kbd_translate(data, old[i], data->new[0], up);
}
return res; return res;
} }
@ -285,7 +295,7 @@ static int usb_kbd_irq_worker(struct usb_device *dev)
else if ((data->new[0] == LEFT_CNTR) || (data->new[0] == RIGHT_CNTR)) else if ((data->new[0] == LEFT_CNTR) || (data->new[0] == RIGHT_CNTR))
data->flags |= USB_KBD_CTRL; data->flags |= USB_KBD_CTRL;
for (i = 2; i < 8; i++) { for (i = 2; i < USB_KBD_BOOT_REPORT_SIZE; i++) {
res |= usb_kbd_service_key(dev, i, 0); res |= usb_kbd_service_key(dev, i, 0);
res |= usb_kbd_service_key(dev, i, 1); res |= usb_kbd_service_key(dev, i, 1);
} }
@ -297,7 +307,7 @@ static int usb_kbd_irq_worker(struct usb_device *dev)
if (res == 1) if (res == 1)
usb_kbd_setled(dev); usb_kbd_setled(dev);
memcpy(data->old, data->new, 8); memcpy(data->old, data->new, USB_KBD_BOOT_REPORT_SIZE);
return 1; return 1;
} }
@ -305,7 +315,8 @@ static int usb_kbd_irq_worker(struct usb_device *dev)
/* Keyboard interrupt handler */ /* Keyboard interrupt handler */
static int usb_kbd_irq(struct usb_device *dev) static int usb_kbd_irq(struct usb_device *dev)
{ {
if ((dev->irq_status != 0) || (dev->irq_act_len != 8)) { if ((dev->irq_status != 0) ||
(dev->irq_act_len != USB_KBD_BOOT_REPORT_SIZE)) {
debug("USB KBD: Error %lX, len %d\n", debug("USB KBD: Error %lX, len %d\n",
dev->irq_status, dev->irq_act_len); dev->irq_status, dev->irq_act_len);
return 1; return 1;
@ -333,7 +344,8 @@ static inline void usb_kbd_poll_for_event(struct usb_device *dev)
/* Submit a interrupt transfer request */ /* Submit a interrupt transfer request */
maxp = usb_maxpacket(dev, pipe); maxp = usb_maxpacket(dev, pipe);
usb_submit_int_msg(dev, pipe, &data->new[0], usb_submit_int_msg(dev, pipe, &data->new[0],
maxp > 8 ? 8 : maxp, ep->bInterval); min(maxp, USB_KBD_BOOT_REPORT_SIZE),
ep->bInterval);
usb_kbd_irq_worker(dev); usb_kbd_irq_worker(dev);
#elif defined(CONFIG_SYS_USB_EVENT_POLL_VIA_CONTROL_EP) #elif defined(CONFIG_SYS_USB_EVENT_POLL_VIA_CONTROL_EP)
@ -341,8 +353,8 @@ static inline void usb_kbd_poll_for_event(struct usb_device *dev)
struct usb_kbd_pdata *data = dev->privptr; struct usb_kbd_pdata *data = dev->privptr;
iface = &dev->config.if_desc[0]; iface = &dev->config.if_desc[0];
usb_get_report(dev, iface->desc.bInterfaceNumber, usb_get_report(dev, iface->desc.bInterfaceNumber,
1, 0, data->new, sizeof(data->new)); 1, 0, data->new, USB_KBD_BOOT_REPORT_SIZE);
if (memcmp(data->old, data->new, sizeof(data->new))) if (memcmp(data->old, data->new, USB_KBD_BOOT_REPORT_SIZE))
usb_kbd_irq_worker(dev); usb_kbd_irq_worker(dev);
#endif #endif
} }
@ -441,7 +453,8 @@ static int usb_kbd_probe(struct usb_device *dev, unsigned int ifnum)
memset(data, 0, sizeof(struct usb_kbd_pdata)); memset(data, 0, sizeof(struct usb_kbd_pdata));
/* allocate input buffer aligned and sized to USB DMA alignment */ /* allocate input buffer aligned and sized to USB DMA alignment */
data->new = memalign(USB_DMA_MINALIGN, roundup(8, USB_DMA_MINALIGN)); data->new = memalign(USB_DMA_MINALIGN,
roundup(USB_KBD_BOOT_REPORT_SIZE, USB_DMA_MINALIGN));
/* Insert private data into USB device structure */ /* Insert private data into USB device structure */
dev->privptr = data; dev->privptr = data;
@ -459,7 +472,8 @@ static int usb_kbd_probe(struct usb_device *dev, unsigned int ifnum)
usb_set_idle(dev, iface->desc.bInterfaceNumber, REPEAT_RATE, 0); usb_set_idle(dev, iface->desc.bInterfaceNumber, REPEAT_RATE, 0);
debug("USB KBD: enable interrupt pipe...\n"); debug("USB KBD: enable interrupt pipe...\n");
if (usb_submit_int_msg(dev, pipe, data->new, maxp > 8 ? 8 : maxp, if (usb_submit_int_msg(dev, pipe, data->new,
min(maxp, USB_KBD_BOOT_REPORT_SIZE),
ep->bInterval) < 0) { ep->bInterval) < 0) {
printf("Failed to get keyboard state from device %04x:%04x\n", printf("Failed to get keyboard state from device %04x:%04x\n",
dev->descriptor.idVendor, dev->descriptor.idProduct); dev->descriptor.idVendor, dev->descriptor.idProduct);