wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 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 | * |
Wolfgang Denk | d79de1d | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 8 | * SPDX-License-Identifier: GPL-2.0+ |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 9 | */ |
| 10 | #include <common.h> |
Hans de Goede | f565623 | 2014-09-20 16:54:34 +0200 | [diff] [blame] | 11 | #include <errno.h> |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 12 | #include <malloc.h> |
Jean-Christophe PLAGNIOL-VILLARD | 2a7a031 | 2009-05-16 12:14:54 +0200 | [diff] [blame] | 13 | #include <stdio_dev.h> |
Christian Eggers | 4e0e8d0 | 2008-05-21 22:12:00 +0200 | [diff] [blame] | 14 | #include <asm/byteorder.h> |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 15 | |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 16 | #include <usb.h> |
| 17 | |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 18 | /* |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 19 | * If overwrite_console returns 1, the stdin, stderr and stdout |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 20 | * are switched to the serial port, else the settings in the |
| 21 | * environment are used |
| 22 | */ |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 23 | #ifdef CONFIG_SYS_CONSOLE_OVERWRITE_ROUTINE |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 24 | extern int overwrite_console(void); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 25 | #else |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 26 | int overwrite_console(void) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 27 | { |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 28 | return 0; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 29 | } |
| 30 | #endif |
| 31 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 32 | /* Keyboard sampling rate */ |
| 33 | #define REPEAT_RATE (40 / 4) /* 40msec -> 25cps */ |
| 34 | #define REPEAT_DELAY 10 /* 10 x REPEAT_RATE = 400msec */ |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 35 | |
| 36 | #define NUM_LOCK 0x53 |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 37 | #define CAPS_LOCK 0x39 |
| 38 | #define SCROLL_LOCK 0x47 |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 39 | |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 40 | /* Modifier bits */ |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 41 | #define LEFT_CNTR (1 << 0) |
| 42 | #define LEFT_SHIFT (1 << 1) |
| 43 | #define LEFT_ALT (1 << 2) |
| 44 | #define LEFT_GUI (1 << 3) |
| 45 | #define RIGHT_CNTR (1 << 4) |
| 46 | #define RIGHT_SHIFT (1 << 5) |
| 47 | #define RIGHT_ALT (1 << 6) |
| 48 | #define RIGHT_GUI (1 << 7) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 49 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 50 | /* Size of the keyboard buffer */ |
| 51 | #define USB_KBD_BUFFER_LEN 0x20 |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 52 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 53 | /* Device name */ |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 54 | #define DEVNAME "usbkbd" |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 55 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 56 | /* Keyboard maps */ |
| 57 | static const unsigned char usb_kbd_numkey[] = { |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 58 | '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', |
| 59 | '\r', 0x1b, '\b', '\t', ' ', '-', '=', '[', ']', |
| 60 | '\\', '#', ';', '\'', '`', ',', '.', '/' |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 61 | }; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 62 | static const unsigned char usb_kbd_numkey_shifted[] = { |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 63 | '!', '@', '#', '$', '%', '^', '&', '*', '(', ')', |
| 64 | '\r', 0x1b, '\b', '\t', ' ', '_', '+', '{', '}', |
| 65 | '|', '~', ':', '"', '~', '<', '>', '?' |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 66 | }; |
| 67 | |
Vincent Palatin | 92f6a62 | 2012-01-09 12:59:36 +0000 | [diff] [blame] | 68 | static const unsigned char usb_kbd_num_keypad[] = { |
| 69 | '/', '*', '-', '+', '\r', |
| 70 | '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', |
| 71 | '.', 0, 0, 0, '=' |
| 72 | }; |
| 73 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 74 | /* |
Allen Martin | 1bfb4cd | 2012-11-06 13:26:03 -0800 | [diff] [blame] | 75 | * map arrow keys to ^F/^B ^N/^P, can't really use the proper |
| 76 | * ANSI sequence for arrow keys because the queuing code breaks |
| 77 | * when a single keypress expands to 3 queue elements |
| 78 | */ |
| 79 | static const unsigned char usb_kbd_arrow[] = { |
| 80 | 0x6, 0x2, 0xe, 0x10 |
| 81 | }; |
| 82 | |
| 83 | /* |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 84 | * NOTE: It's important for the NUM, CAPS, SCROLL-lock bits to be in this |
| 85 | * order. See usb_kbd_setled() function! |
| 86 | */ |
| 87 | #define USB_KBD_NUMLOCK (1 << 0) |
| 88 | #define USB_KBD_CAPSLOCK (1 << 1) |
| 89 | #define USB_KBD_SCROLLLOCK (1 << 2) |
| 90 | #define USB_KBD_CTRL (1 << 3) |
Marek Vasut | 82cf9a4 | 2011-09-25 20:00:37 +0100 | [diff] [blame] | 91 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 92 | #define USB_KBD_LEDMASK \ |
| 93 | (USB_KBD_NUMLOCK | USB_KBD_CAPSLOCK | USB_KBD_SCROLLLOCK) |
Marek Vasut | 82cf9a4 | 2011-09-25 20:00:37 +0100 | [diff] [blame] | 94 | |
Adrian Cox | 17472dc | 2014-04-10 14:02:44 +0100 | [diff] [blame] | 95 | /* |
| 96 | * USB Keyboard reports are 8 bytes in boot protocol. |
| 97 | * Appendix B of HID Device Class Definition 1.11 |
| 98 | */ |
| 99 | #define USB_KBD_BOOT_REPORT_SIZE 8 |
| 100 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 101 | struct usb_kbd_pdata { |
Hans de Goede | 3c79470 | 2014-09-24 14:06:10 +0200 | [diff] [blame] | 102 | unsigned long intpipe; |
| 103 | int intpktsize; |
| 104 | int intinterval; |
Hans de Goede | 2d02ae7 | 2014-09-24 14:06:11 +0200 | [diff] [blame] | 105 | struct int_queue *intq; |
Hans de Goede | 3c79470 | 2014-09-24 14:06:10 +0200 | [diff] [blame] | 106 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 107 | uint32_t repeat_delay; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 108 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 109 | uint32_t usb_in_pointer; |
| 110 | uint32_t usb_out_pointer; |
| 111 | uint8_t usb_kbd_buffer[USB_KBD_BUFFER_LEN]; |
Marek Vasut | 82cf9a4 | 2011-09-25 20:00:37 +0100 | [diff] [blame] | 112 | |
Allen Martin | ef769ca | 2012-10-24 08:32:04 +0000 | [diff] [blame] | 113 | uint8_t *new; |
Adrian Cox | 17472dc | 2014-04-10 14:02:44 +0100 | [diff] [blame] | 114 | uint8_t old[USB_KBD_BOOT_REPORT_SIZE]; |
Marek Vasut | 82cf9a4 | 2011-09-25 20:00:37 +0100 | [diff] [blame] | 115 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 116 | uint8_t flags; |
| 117 | }; |
Marek Vasut | 82cf9a4 | 2011-09-25 20:00:37 +0100 | [diff] [blame] | 118 | |
Jim Lin | c562f97 | 2013-08-13 19:04:22 +0800 | [diff] [blame] | 119 | extern int __maybe_unused net_busy_flag; |
| 120 | |
| 121 | /* The period of time between two calls of usb_kbd_testc(). */ |
| 122 | static unsigned long __maybe_unused kbd_testc_tms; |
| 123 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 124 | /* Puts character in the queue and sets up the in and out pointer. */ |
| 125 | static void usb_kbd_put_queue(struct usb_kbd_pdata *data, char c) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 126 | { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 127 | if (data->usb_in_pointer == USB_KBD_BUFFER_LEN - 1) { |
| 128 | /* Check for buffer full. */ |
| 129 | if (data->usb_out_pointer == 0) |
| 130 | return; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 131 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 132 | data->usb_in_pointer = 0; |
| 133 | } else { |
| 134 | /* Check for buffer full. */ |
| 135 | if (data->usb_in_pointer == data->usb_out_pointer - 1) |
| 136 | return; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 137 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 138 | data->usb_in_pointer++; |
| 139 | } |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 140 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 141 | data->usb_kbd_buffer[data->usb_in_pointer] = c; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 142 | } |
| 143 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 144 | /* |
| 145 | * Set the LEDs. Since this is used in the irq routine, the control job is |
| 146 | * issued with a timeout of 0. This means, that the job is queued without |
| 147 | * waiting for job completion. |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 148 | */ |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 149 | static void usb_kbd_setled(struct usb_device *dev) |
| 150 | { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 151 | struct usb_interface *iface = &dev->config.if_desc[0]; |
| 152 | struct usb_kbd_pdata *data = dev->privptr; |
Hans de Goede | e402b6c | 2014-09-20 16:51:26 +0200 | [diff] [blame] | 153 | ALLOC_ALIGN_BUFFER(uint32_t, leds, 1, USB_DMA_MINALIGN); |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 154 | |
Hans de Goede | e402b6c | 2014-09-20 16:51:26 +0200 | [diff] [blame] | 155 | *leds = data->flags & USB_KBD_LEDMASK; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 156 | usb_control_msg(dev, usb_sndctrlpipe(dev, 0), |
| 157 | USB_REQ_SET_REPORT, USB_TYPE_CLASS | USB_RECIP_INTERFACE, |
Hans de Goede | e402b6c | 2014-09-20 16:51:26 +0200 | [diff] [blame] | 158 | 0x200, iface->desc.bInterfaceNumber, leds, 1, 0); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 159 | } |
| 160 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 161 | #define CAPITAL_MASK 0x20 |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 162 | /* Translate the scancode in ASCII */ |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 163 | static int usb_kbd_translate(struct usb_kbd_pdata *data, unsigned char scancode, |
| 164 | unsigned char modifier, int pressed) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 165 | { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 166 | uint8_t keycode = 0; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 167 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 168 | /* Key released */ |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 169 | if (pressed == 0) { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 170 | data->repeat_delay = 0; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 171 | return 0; |
| 172 | } |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 173 | |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 174 | if (pressed == 2) { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 175 | data->repeat_delay++; |
| 176 | if (data->repeat_delay < REPEAT_DELAY) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 177 | return 0; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 178 | |
| 179 | data->repeat_delay = REPEAT_DELAY; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 180 | } |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 181 | |
| 182 | /* Alphanumeric values */ |
| 183 | if ((scancode > 3) && (scancode <= 0x1d)) { |
| 184 | keycode = scancode - 4 + 'a'; |
| 185 | |
| 186 | if (data->flags & USB_KBD_CAPSLOCK) |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 187 | keycode &= ~CAPITAL_MASK; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 188 | |
| 189 | if (modifier & (LEFT_SHIFT | RIGHT_SHIFT)) { |
| 190 | /* Handle CAPSLock + Shift pressed simultaneously */ |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 191 | if (keycode & CAPITAL_MASK) |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 192 | keycode &= ~CAPITAL_MASK; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 193 | else |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 194 | keycode |= CAPITAL_MASK; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 195 | } |
| 196 | } |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 197 | |
| 198 | if ((scancode > 0x1d) && (scancode < 0x3a)) { |
| 199 | /* Shift pressed */ |
| 200 | if (modifier & (LEFT_SHIFT | RIGHT_SHIFT)) |
| 201 | keycode = usb_kbd_numkey_shifted[scancode - 0x1e]; |
| 202 | else |
| 203 | keycode = usb_kbd_numkey[scancode - 0x1e]; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 204 | } |
Zhang Wei | 37cc4f0 | 2008-01-03 10:51:15 +0800 | [diff] [blame] | 205 | |
Allen Martin | 1bfb4cd | 2012-11-06 13:26:03 -0800 | [diff] [blame] | 206 | /* Arrow keys */ |
| 207 | if ((scancode >= 0x4f) && (scancode <= 0x52)) |
| 208 | keycode = usb_kbd_arrow[scancode - 0x4f]; |
| 209 | |
Vincent Palatin | 92f6a62 | 2012-01-09 12:59:36 +0000 | [diff] [blame] | 210 | /* Numeric keypad */ |
| 211 | if ((scancode >= 0x54) && (scancode <= 0x67)) |
| 212 | keycode = usb_kbd_num_keypad[scancode - 0x54]; |
| 213 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 214 | if (data->flags & USB_KBD_CTRL) |
Zhang Wei | 37cc4f0 | 2008-01-03 10:51:15 +0800 | [diff] [blame] | 215 | keycode = scancode - 0x3; |
| 216 | |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 217 | if (pressed == 1) { |
| 218 | if (scancode == NUM_LOCK) { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 219 | data->flags ^= USB_KBD_NUMLOCK; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 220 | return 1; |
| 221 | } |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 222 | |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 223 | if (scancode == CAPS_LOCK) { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 224 | data->flags ^= USB_KBD_CAPSLOCK; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 225 | return 1; |
| 226 | } |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 227 | if (scancode == SCROLL_LOCK) { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 228 | data->flags ^= USB_KBD_SCROLLLOCK; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 229 | return 1; |
| 230 | } |
| 231 | } |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 232 | |
| 233 | /* Report keycode if any */ |
| 234 | if (keycode) { |
Vivek Gautam | f94c95d | 2013-04-12 16:34:33 +0530 | [diff] [blame] | 235 | debug("%c", keycode); |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 236 | usb_kbd_put_queue(data, keycode); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 237 | } |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 238 | |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 239 | return 0; |
| 240 | } |
| 241 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 242 | static uint32_t usb_kbd_service_key(struct usb_device *dev, int i, int up) |
| 243 | { |
| 244 | uint32_t res = 0; |
| 245 | struct usb_kbd_pdata *data = dev->privptr; |
| 246 | uint8_t *new; |
| 247 | uint8_t *old; |
| 248 | |
| 249 | if (up) { |
| 250 | new = data->old; |
| 251 | old = data->new; |
| 252 | } else { |
| 253 | new = data->new; |
| 254 | old = data->old; |
| 255 | } |
| 256 | |
Adrian Cox | 17472dc | 2014-04-10 14:02:44 +0100 | [diff] [blame] | 257 | if ((old[i] > 3) && |
| 258 | (memscan(new + 2, old[i], USB_KBD_BOOT_REPORT_SIZE - 2) == |
| 259 | new + USB_KBD_BOOT_REPORT_SIZE)) { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 260 | res |= usb_kbd_translate(data, old[i], data->new[0], up); |
Adrian Cox | 17472dc | 2014-04-10 14:02:44 +0100 | [diff] [blame] | 261 | } |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 262 | |
| 263 | return res; |
| 264 | } |
| 265 | |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 266 | /* Interrupt service routine */ |
Marek Vasut | 82cf9a4 | 2011-09-25 20:00:37 +0100 | [diff] [blame] | 267 | static int usb_kbd_irq_worker(struct usb_device *dev) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 268 | { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 269 | struct usb_kbd_pdata *data = dev->privptr; |
| 270 | int i, res = 0; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 271 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 272 | /* No combo key pressed */ |
| 273 | if (data->new[0] == 0x00) |
| 274 | data->flags &= ~USB_KBD_CTRL; |
| 275 | /* Left or Right Ctrl pressed */ |
| 276 | else if ((data->new[0] == LEFT_CNTR) || (data->new[0] == RIGHT_CNTR)) |
| 277 | data->flags |= USB_KBD_CTRL; |
Zhang Wei | 37cc4f0 | 2008-01-03 10:51:15 +0800 | [diff] [blame] | 278 | |
Adrian Cox | 17472dc | 2014-04-10 14:02:44 +0100 | [diff] [blame] | 279 | for (i = 2; i < USB_KBD_BOOT_REPORT_SIZE; i++) { |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 280 | res |= usb_kbd_service_key(dev, i, 0); |
| 281 | res |= usb_kbd_service_key(dev, i, 1); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 282 | } |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 283 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 284 | /* Key is still pressed */ |
| 285 | if ((data->new[2] > 3) && (data->old[2] == data->new[2])) |
| 286 | res |= usb_kbd_translate(data, data->new[2], data->new[0], 2); |
| 287 | |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 288 | if (res == 1) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 289 | usb_kbd_setled(dev); |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 290 | |
Adrian Cox | 17472dc | 2014-04-10 14:02:44 +0100 | [diff] [blame] | 291 | memcpy(data->old, data->new, USB_KBD_BOOT_REPORT_SIZE); |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 292 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 293 | return 1; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 294 | } |
| 295 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 296 | /* Keyboard interrupt handler */ |
Marek Vasut | 82cf9a4 | 2011-09-25 20:00:37 +0100 | [diff] [blame] | 297 | static int usb_kbd_irq(struct usb_device *dev) |
| 298 | { |
Adrian Cox | 17472dc | 2014-04-10 14:02:44 +0100 | [diff] [blame] | 299 | if ((dev->irq_status != 0) || |
| 300 | (dev->irq_act_len != USB_KBD_BOOT_REPORT_SIZE)) { |
Vivek Gautam | f94c95d | 2013-04-12 16:34:33 +0530 | [diff] [blame] | 301 | debug("USB KBD: Error %lX, len %d\n", |
| 302 | dev->irq_status, dev->irq_act_len); |
Marek Vasut | 82cf9a4 | 2011-09-25 20:00:37 +0100 | [diff] [blame] | 303 | return 1; |
| 304 | } |
| 305 | |
| 306 | return usb_kbd_irq_worker(dev); |
| 307 | } |
| 308 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 309 | /* Interrupt polling */ |
| 310 | static inline void usb_kbd_poll_for_event(struct usb_device *dev) |
| 311 | { |
| 312 | #if defined(CONFIG_SYS_USB_EVENT_POLL) |
Hans de Goede | 3c79470 | 2014-09-24 14:06:10 +0200 | [diff] [blame] | 313 | struct usb_kbd_pdata *data = dev->privptr; |
amartin@nvidia.com | 185da95 | 2011-12-20 14:56:16 +0000 | [diff] [blame] | 314 | |
| 315 | /* Submit a interrupt transfer request */ |
Hans de Goede | 3c79470 | 2014-09-24 14:06:10 +0200 | [diff] [blame] | 316 | usb_submit_int_msg(dev, data->intpipe, &data->new[0], data->intpktsize, |
| 317 | data->intinterval); |
amartin@nvidia.com | 185da95 | 2011-12-20 14:56:16 +0000 | [diff] [blame] | 318 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 319 | usb_kbd_irq_worker(dev); |
| 320 | #elif defined(CONFIG_SYS_USB_EVENT_POLL_VIA_CONTROL_EP) |
| 321 | struct usb_interface *iface; |
| 322 | struct usb_kbd_pdata *data = dev->privptr; |
| 323 | iface = &dev->config.if_desc[0]; |
| 324 | usb_get_report(dev, iface->desc.bInterfaceNumber, |
Adrian Cox | 17472dc | 2014-04-10 14:02:44 +0100 | [diff] [blame] | 325 | 1, 0, data->new, USB_KBD_BOOT_REPORT_SIZE); |
| 326 | if (memcmp(data->old, data->new, USB_KBD_BOOT_REPORT_SIZE)) |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 327 | usb_kbd_irq_worker(dev); |
Hans de Goede | 2d02ae7 | 2014-09-24 14:06:11 +0200 | [diff] [blame] | 328 | #elif defined(CONFIG_SYS_USB_EVENT_POLL_VIA_INT_QUEUE) |
| 329 | struct usb_kbd_pdata *data = dev->privptr; |
| 330 | if (poll_int_queue(dev, data->intq)) { |
| 331 | usb_kbd_irq_worker(dev); |
| 332 | /* We've consumed all queued int packets, create new */ |
| 333 | destroy_int_queue(dev, data->intq); |
| 334 | data->intq = create_int_queue(dev, data->intpipe, 1, |
Hans de Goede | bbd2d2a | 2015-01-11 20:38:28 +0100 | [diff] [blame] | 335 | USB_KBD_BOOT_REPORT_SIZE, data->new, |
| 336 | data->intinterval); |
Hans de Goede | 2d02ae7 | 2014-09-24 14:06:11 +0200 | [diff] [blame] | 337 | } |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 338 | #endif |
| 339 | } |
| 340 | |
| 341 | /* test if a character is in the queue */ |
Simon Glass | 0d1e1f7 | 2014-07-23 06:54:59 -0600 | [diff] [blame] | 342 | static int usb_kbd_testc(struct stdio_dev *sdev) |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 343 | { |
| 344 | struct stdio_dev *dev; |
| 345 | struct usb_device *usb_kbd_dev; |
| 346 | struct usb_kbd_pdata *data; |
| 347 | |
Jim Lin | e2ebec8 | 2013-08-26 20:21:09 +0800 | [diff] [blame] | 348 | #ifdef CONFIG_CMD_NET |
| 349 | /* |
| 350 | * If net_busy_flag is 1, NET transfer is running, |
| 351 | * then we check key-pressed every second (first check may be |
| 352 | * less than 1 second) to improve TFTP booting performance. |
| 353 | */ |
| 354 | if (net_busy_flag && (get_timer(kbd_testc_tms) < CONFIG_SYS_HZ)) |
| 355 | return 0; |
| 356 | kbd_testc_tms = get_timer(0); |
| 357 | #endif |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 358 | dev = stdio_get_by_name(DEVNAME); |
| 359 | usb_kbd_dev = (struct usb_device *)dev->priv; |
| 360 | data = usb_kbd_dev->privptr; |
| 361 | |
| 362 | usb_kbd_poll_for_event(usb_kbd_dev); |
| 363 | |
| 364 | return !(data->usb_in_pointer == data->usb_out_pointer); |
| 365 | } |
| 366 | |
| 367 | /* gets the character from the queue */ |
Simon Glass | 0d1e1f7 | 2014-07-23 06:54:59 -0600 | [diff] [blame] | 368 | static int usb_kbd_getc(struct stdio_dev *sdev) |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 369 | { |
| 370 | struct stdio_dev *dev; |
| 371 | struct usb_device *usb_kbd_dev; |
| 372 | struct usb_kbd_pdata *data; |
| 373 | |
| 374 | dev = stdio_get_by_name(DEVNAME); |
| 375 | usb_kbd_dev = (struct usb_device *)dev->priv; |
| 376 | data = usb_kbd_dev->privptr; |
| 377 | |
| 378 | while (data->usb_in_pointer == data->usb_out_pointer) |
| 379 | usb_kbd_poll_for_event(usb_kbd_dev); |
| 380 | |
| 381 | if (data->usb_out_pointer == USB_KBD_BUFFER_LEN - 1) |
| 382 | data->usb_out_pointer = 0; |
| 383 | else |
| 384 | data->usb_out_pointer++; |
| 385 | |
| 386 | return data->usb_kbd_buffer[data->usb_out_pointer]; |
| 387 | } |
| 388 | |
| 389 | /* probes the USB device dev for keyboard type. */ |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 390 | static int usb_kbd_probe(struct usb_device *dev, unsigned int ifnum) |
| 391 | { |
Tom Rix | 83b9e1d | 2009-10-31 12:37:38 -0500 | [diff] [blame] | 392 | struct usb_interface *iface; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 393 | struct usb_endpoint_descriptor *ep; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 394 | struct usb_kbd_pdata *data; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 395 | |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 396 | if (dev->descriptor.bNumConfigurations != 1) |
| 397 | return 0; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 398 | |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 399 | iface = &dev->config.if_desc[ifnum]; |
| 400 | |
Tom Rix | 83b9e1d | 2009-10-31 12:37:38 -0500 | [diff] [blame] | 401 | if (iface->desc.bInterfaceClass != 3) |
| 402 | return 0; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 403 | |
Tom Rix | 83b9e1d | 2009-10-31 12:37:38 -0500 | [diff] [blame] | 404 | if (iface->desc.bInterfaceSubClass != 1) |
| 405 | return 0; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 406 | |
Tom Rix | 83b9e1d | 2009-10-31 12:37:38 -0500 | [diff] [blame] | 407 | if (iface->desc.bInterfaceProtocol != 1) |
| 408 | return 0; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 409 | |
Tom Rix | 83b9e1d | 2009-10-31 12:37:38 -0500 | [diff] [blame] | 410 | if (iface->desc.bNumEndpoints != 1) |
| 411 | return 0; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 412 | |
| 413 | ep = &iface->ep_desc[0]; |
| 414 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 415 | /* Check if endpoint 1 is interrupt endpoint */ |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 416 | if (!(ep->bEndpointAddress & 0x80)) |
| 417 | return 0; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 418 | |
Marek Vasut | b930098 | 2011-10-10 05:34:25 +0000 | [diff] [blame] | 419 | if ((ep->bmAttributes & 3) != 3) |
| 420 | return 0; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 421 | |
Vivek Gautam | f94c95d | 2013-04-12 16:34:33 +0530 | [diff] [blame] | 422 | debug("USB KBD: found set protocol...\n"); |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 423 | |
| 424 | data = malloc(sizeof(struct usb_kbd_pdata)); |
| 425 | if (!data) { |
| 426 | printf("USB KBD: Error allocating private data\n"); |
| 427 | return 0; |
| 428 | } |
| 429 | |
| 430 | /* Clear private data */ |
| 431 | memset(data, 0, sizeof(struct usb_kbd_pdata)); |
| 432 | |
Allen Martin | ef769ca | 2012-10-24 08:32:04 +0000 | [diff] [blame] | 433 | /* allocate input buffer aligned and sized to USB DMA alignment */ |
Adrian Cox | 17472dc | 2014-04-10 14:02:44 +0100 | [diff] [blame] | 434 | data->new = memalign(USB_DMA_MINALIGN, |
| 435 | roundup(USB_KBD_BOOT_REPORT_SIZE, USB_DMA_MINALIGN)); |
Allen Martin | ef769ca | 2012-10-24 08:32:04 +0000 | [diff] [blame] | 436 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 437 | /* Insert private data into USB device structure */ |
| 438 | dev->privptr = data; |
| 439 | |
| 440 | /* Set IRQ handler */ |
| 441 | dev->irq_handle = usb_kbd_irq; |
| 442 | |
Hans de Goede | 3c79470 | 2014-09-24 14:06:10 +0200 | [diff] [blame] | 443 | data->intpipe = usb_rcvintpipe(dev, ep->bEndpointAddress); |
| 444 | data->intpktsize = min(usb_maxpacket(dev, data->intpipe), |
| 445 | USB_KBD_BOOT_REPORT_SIZE); |
| 446 | data->intinterval = ep->bInterval; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 447 | |
| 448 | /* We found a USB Keyboard, install it. */ |
| 449 | usb_set_protocol(dev, iface->desc.bInterfaceNumber, 0); |
| 450 | |
Vivek Gautam | f94c95d | 2013-04-12 16:34:33 +0530 | [diff] [blame] | 451 | debug("USB KBD: found set idle...\n"); |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 452 | usb_set_idle(dev, iface->desc.bInterfaceNumber, REPEAT_RATE, 0); |
| 453 | |
Vivek Gautam | f94c95d | 2013-04-12 16:34:33 +0530 | [diff] [blame] | 454 | debug("USB KBD: enable interrupt pipe...\n"); |
Hans de Goede | 2d02ae7 | 2014-09-24 14:06:11 +0200 | [diff] [blame] | 455 | #ifdef CONFIG_SYS_USB_EVENT_POLL_VIA_INT_QUEUE |
| 456 | data->intq = create_int_queue(dev, data->intpipe, 1, |
Hans de Goede | bbd2d2a | 2015-01-11 20:38:28 +0100 | [diff] [blame] | 457 | USB_KBD_BOOT_REPORT_SIZE, data->new, |
| 458 | data->intinterval); |
Hans de Goede | 2d02ae7 | 2014-09-24 14:06:11 +0200 | [diff] [blame] | 459 | if (!data->intq) { |
| 460 | #else |
Hans de Goede | 3c79470 | 2014-09-24 14:06:10 +0200 | [diff] [blame] | 461 | if (usb_submit_int_msg(dev, data->intpipe, data->new, data->intpktsize, |
| 462 | data->intinterval) < 0) { |
Hans de Goede | 2d02ae7 | 2014-09-24 14:06:11 +0200 | [diff] [blame] | 463 | #endif |
Vincent Palatin | 0eab998 | 2013-05-10 19:48:59 -0700 | [diff] [blame] | 464 | printf("Failed to get keyboard state from device %04x:%04x\n", |
| 465 | dev->descriptor.idVendor, dev->descriptor.idProduct); |
| 466 | /* Abort, we don't want to use that non-functional keyboard. */ |
| 467 | return 0; |
| 468 | } |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 469 | |
| 470 | /* Success. */ |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 471 | return 1; |
| 472 | } |
| 473 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 474 | /* Search for keyboard and register it if found. */ |
| 475 | int drv_usb_kbd_init(void) |
| 476 | { |
Hans de Goede | 7d21c8b | 2014-09-20 16:54:36 +0200 | [diff] [blame] | 477 | struct stdio_dev usb_kbd_dev; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 478 | struct usb_device *dev; |
| 479 | char *stdinname = getenv("stdin"); |
| 480 | int error, i; |
| 481 | |
| 482 | /* Scan all USB Devices */ |
| 483 | for (i = 0; i < USB_MAX_DEVICE; i++) { |
| 484 | /* Get USB device. */ |
| 485 | dev = usb_get_dev_index(i); |
| 486 | if (!dev) |
| 487 | return -1; |
| 488 | |
| 489 | if (dev->devnum == -1) |
| 490 | continue; |
| 491 | |
| 492 | /* Try probing the keyboard */ |
| 493 | if (usb_kbd_probe(dev, 0) != 1) |
| 494 | continue; |
| 495 | |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 496 | /* Register the keyboard */ |
Vivek Gautam | f94c95d | 2013-04-12 16:34:33 +0530 | [diff] [blame] | 497 | debug("USB KBD: register.\n"); |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 498 | memset(&usb_kbd_dev, 0, sizeof(struct stdio_dev)); |
| 499 | strcpy(usb_kbd_dev.name, DEVNAME); |
| 500 | usb_kbd_dev.flags = DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 501 | usb_kbd_dev.getc = usb_kbd_getc; |
| 502 | usb_kbd_dev.tstc = usb_kbd_testc; |
| 503 | usb_kbd_dev.priv = (void *)dev; |
| 504 | error = stdio_register(&usb_kbd_dev); |
| 505 | if (error) |
| 506 | return error; |
| 507 | |
amartin@nvidia.com | c9d6202 | 2011-12-23 10:29:48 +0000 | [diff] [blame] | 508 | #ifdef CONFIG_CONSOLE_MUX |
| 509 | error = iomux_doenv(stdin, stdinname); |
| 510 | if (error) |
| 511 | return error; |
| 512 | #else |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 513 | /* Check if this is the standard input device. */ |
| 514 | if (strcmp(stdinname, DEVNAME)) |
| 515 | return 1; |
| 516 | |
| 517 | /* Reassign the console */ |
| 518 | if (overwrite_console()) |
| 519 | return 1; |
| 520 | |
| 521 | error = console_assign(stdin, DEVNAME); |
| 522 | if (error) |
| 523 | return error; |
amartin@nvidia.com | c9d6202 | 2011-12-23 10:29:48 +0000 | [diff] [blame] | 524 | #endif |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 525 | |
| 526 | return 1; |
| 527 | } |
| 528 | |
| 529 | /* No USB Keyboard found */ |
| 530 | return -1; |
| 531 | } |
| 532 | |
| 533 | /* Deregister the keyboard. */ |
Hans de Goede | 3e51df0 | 2014-09-20 16:54:38 +0200 | [diff] [blame] | 534 | int usb_kbd_deregister(int force) |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 535 | { |
| 536 | #ifdef CONFIG_SYS_STDIO_DEREGISTER |
Hans de Goede | 55a5451 | 2014-09-24 14:06:08 +0200 | [diff] [blame] | 537 | struct stdio_dev *dev; |
| 538 | struct usb_device *usb_kbd_dev; |
| 539 | struct usb_kbd_pdata *data; |
| 540 | |
| 541 | dev = stdio_get_by_name(DEVNAME); |
| 542 | if (dev) { |
| 543 | usb_kbd_dev = (struct usb_device *)dev->priv; |
| 544 | data = usb_kbd_dev->privptr; |
| 545 | if (stdio_deregister_dev(dev, force) != 0) |
| 546 | return 1; |
Hans de Goede | e8790a2 | 2015-01-11 20:34:44 +0100 | [diff] [blame] | 547 | #ifdef CONFIG_CONSOLE_MUX |
| 548 | if (iomux_doenv(stdin, getenv("stdin")) != 0) |
| 549 | return 1; |
| 550 | #endif |
Hans de Goede | 2d02ae7 | 2014-09-24 14:06:11 +0200 | [diff] [blame] | 551 | #ifdef CONFIG_SYS_USB_EVENT_POLL_VIA_INT_QUEUE |
| 552 | destroy_int_queue(usb_kbd_dev, data->intq); |
| 553 | #endif |
Hans de Goede | 55a5451 | 2014-09-24 14:06:08 +0200 | [diff] [blame] | 554 | free(data->new); |
| 555 | free(data); |
| 556 | } |
Hans de Goede | f565623 | 2014-09-20 16:54:34 +0200 | [diff] [blame] | 557 | |
| 558 | return 0; |
Marek Vasut | 7534a3e | 2011-10-10 16:34:26 +0100 | [diff] [blame] | 559 | #else |
| 560 | return 1; |
| 561 | #endif |
| 562 | } |