]>
Commit | Line | Data |
---|---|---|
83d290c5 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
affae2bf WD |
2 | /* |
3 | * (C) Copyright 2001 | |
4 | * Denis Peter, MPL AG Switzerland | |
5 | * | |
6 | * Part of this source has been derived from the Linux USB | |
7 | * project. | |
affae2bf WD |
8 | */ |
9 | #include <common.h> | |
24b852a7 | 10 | #include <console.h> |
697033cb | 11 | #include <dm.h> |
0ea09dfe | 12 | #include <errno.h> |
9a8c72a6 | 13 | #include <malloc.h> |
cf92e05c | 14 | #include <memalign.h> |
52cb4d4f | 15 | #include <stdio_dev.h> |
f8f3e0e5 | 16 | #include <watchdog.h> |
c918261c | 17 | #include <asm/byteorder.h> |
affae2bf | 18 | |
affae2bf WD |
19 | #include <usb.h> |
20 | ||
affae2bf | 21 | /* |
00b7d6ec | 22 | * If overwrite_console returns 1, the stdin, stderr and stdout |
affae2bf WD |
23 | * are switched to the serial port, else the settings in the |
24 | * environment are used | |
25 | */ | |
6d0f6bcf | 26 | #ifdef CONFIG_SYS_CONSOLE_OVERWRITE_ROUTINE |
00b7d6ec | 27 | extern int overwrite_console(void); |
affae2bf | 28 | #else |
00b7d6ec | 29 | int overwrite_console(void) |
affae2bf | 30 | { |
00b7d6ec | 31 | return 0; |
affae2bf WD |
32 | } |
33 | #endif | |
34 | ||
9a8c72a6 | 35 | /* Keyboard sampling rate */ |
8454c84a | 36 | #define REPEAT_RATE 40 /* 40msec -> 25cps */ |
9a8c72a6 | 37 | #define REPEAT_DELAY 10 /* 10 x REPEAT_RATE = 400msec */ |
affae2bf WD |
38 | |
39 | #define NUM_LOCK 0x53 | |
00b7d6ec MV |
40 | #define CAPS_LOCK 0x39 |
41 | #define SCROLL_LOCK 0x47 | |
affae2bf | 42 | |
affae2bf | 43 | /* Modifier bits */ |
9a8c72a6 MV |
44 | #define LEFT_CNTR (1 << 0) |
45 | #define LEFT_SHIFT (1 << 1) | |
46 | #define LEFT_ALT (1 << 2) | |
47 | #define LEFT_GUI (1 << 3) | |
48 | #define RIGHT_CNTR (1 << 4) | |
49 | #define RIGHT_SHIFT (1 << 5) | |
50 | #define RIGHT_ALT (1 << 6) | |
51 | #define RIGHT_GUI (1 << 7) | |
52 | ||
53 | /* Size of the keyboard buffer */ | |
54 | #define USB_KBD_BUFFER_LEN 0x20 | |
55 | ||
56 | /* Device name */ | |
00b7d6ec | 57 | #define DEVNAME "usbkbd" |
affae2bf | 58 | |
9a8c72a6 MV |
59 | /* Keyboard maps */ |
60 | static const unsigned char usb_kbd_numkey[] = { | |
00b7d6ec MV |
61 | '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', |
62 | '\r', 0x1b, '\b', '\t', ' ', '-', '=', '[', ']', | |
63 | '\\', '#', ';', '\'', '`', ',', '.', '/' | |
affae2bf | 64 | }; |
9a8c72a6 | 65 | static const unsigned char usb_kbd_numkey_shifted[] = { |
00b7d6ec MV |
66 | '!', '@', '#', '$', '%', '^', '&', '*', '(', ')', |
67 | '\r', 0x1b, '\b', '\t', ' ', '_', '+', '{', '}', | |
68 | '|', '~', ':', '"', '~', '<', '>', '?' | |
affae2bf WD |
69 | }; |
70 | ||
d53da847 VP |
71 | static const unsigned char usb_kbd_num_keypad[] = { |
72 | '/', '*', '-', '+', '\r', | |
73 | '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', | |
74 | '.', 0, 0, 0, '=' | |
75 | }; | |
76 | ||
4151a400 AM |
77 | /* |
78 | * map arrow keys to ^F/^B ^N/^P, can't really use the proper | |
79 | * ANSI sequence for arrow keys because the queuing code breaks | |
80 | * when a single keypress expands to 3 queue elements | |
81 | */ | |
82 | static const unsigned char usb_kbd_arrow[] = { | |
83 | 0x6, 0x2, 0xe, 0x10 | |
84 | }; | |
85 | ||
9a8c72a6 MV |
86 | /* |
87 | * NOTE: It's important for the NUM, CAPS, SCROLL-lock bits to be in this | |
88 | * order. See usb_kbd_setled() function! | |
89 | */ | |
90 | #define USB_KBD_NUMLOCK (1 << 0) | |
91 | #define USB_KBD_CAPSLOCK (1 << 1) | |
92 | #define USB_KBD_SCROLLLOCK (1 << 2) | |
93 | #define USB_KBD_CTRL (1 << 3) | |
48c8073e | 94 | |
9a8c72a6 MV |
95 | #define USB_KBD_LEDMASK \ |
96 | (USB_KBD_NUMLOCK | USB_KBD_CAPSLOCK | USB_KBD_SCROLLLOCK) | |
48c8073e | 97 | |
08a98b89 AC |
98 | /* |
99 | * USB Keyboard reports are 8 bytes in boot protocol. | |
100 | * Appendix B of HID Device Class Definition 1.11 | |
101 | */ | |
102 | #define USB_KBD_BOOT_REPORT_SIZE 8 | |
103 | ||
9a8c72a6 | 104 | struct usb_kbd_pdata { |
8f8d7d24 HG |
105 | unsigned long intpipe; |
106 | int intpktsize; | |
107 | int intinterval; | |
8454c84a | 108 | unsigned long last_report; |
8e553119 | 109 | struct int_queue *intq; |
8f8d7d24 | 110 | |
9a8c72a6 | 111 | uint32_t repeat_delay; |
affae2bf | 112 | |
9a8c72a6 MV |
113 | uint32_t usb_in_pointer; |
114 | uint32_t usb_out_pointer; | |
115 | uint8_t usb_kbd_buffer[USB_KBD_BUFFER_LEN]; | |
48c8073e | 116 | |
d7475386 | 117 | uint8_t *new; |
08a98b89 | 118 | uint8_t old[USB_KBD_BOOT_REPORT_SIZE]; |
48c8073e | 119 | |
9a8c72a6 MV |
120 | uint8_t flags; |
121 | }; | |
48c8073e | 122 | |
07551f23 JL |
123 | extern int __maybe_unused net_busy_flag; |
124 | ||
125 | /* The period of time between two calls of usb_kbd_testc(). */ | |
126 | static unsigned long __maybe_unused kbd_testc_tms; | |
127 | ||
9a8c72a6 MV |
128 | /* Puts character in the queue and sets up the in and out pointer. */ |
129 | static void usb_kbd_put_queue(struct usb_kbd_pdata *data, char c) | |
affae2bf | 130 | { |
9a8c72a6 MV |
131 | if (data->usb_in_pointer == USB_KBD_BUFFER_LEN - 1) { |
132 | /* Check for buffer full. */ | |
133 | if (data->usb_out_pointer == 0) | |
134 | return; | |
affae2bf | 135 | |
9a8c72a6 MV |
136 | data->usb_in_pointer = 0; |
137 | } else { | |
138 | /* Check for buffer full. */ | |
139 | if (data->usb_in_pointer == data->usb_out_pointer - 1) | |
140 | return; | |
affae2bf | 141 | |
9a8c72a6 MV |
142 | data->usb_in_pointer++; |
143 | } | |
affae2bf | 144 | |
9a8c72a6 | 145 | data->usb_kbd_buffer[data->usb_in_pointer] = c; |
affae2bf WD |
146 | } |
147 | ||
9a8c72a6 MV |
148 | /* |
149 | * Set the LEDs. Since this is used in the irq routine, the control job is | |
150 | * issued with a timeout of 0. This means, that the job is queued without | |
151 | * waiting for job completion. | |
affae2bf | 152 | */ |
affae2bf WD |
153 | static void usb_kbd_setled(struct usb_device *dev) |
154 | { | |
9a8c72a6 MV |
155 | struct usb_interface *iface = &dev->config.if_desc[0]; |
156 | struct usb_kbd_pdata *data = dev->privptr; | |
9b239381 | 157 | ALLOC_ALIGN_BUFFER(uint32_t, leds, 1, USB_DMA_MINALIGN); |
9a8c72a6 | 158 | |
9b239381 | 159 | *leds = data->flags & USB_KBD_LEDMASK; |
affae2bf WD |
160 | usb_control_msg(dev, usb_sndctrlpipe(dev, 0), |
161 | USB_REQ_SET_REPORT, USB_TYPE_CLASS | USB_RECIP_INTERFACE, | |
9b239381 | 162 | 0x200, iface->desc.bInterfaceNumber, leds, 1, 0); |
affae2bf WD |
163 | } |
164 | ||
9a8c72a6 | 165 | #define CAPITAL_MASK 0x20 |
affae2bf | 166 | /* Translate the scancode in ASCII */ |
9a8c72a6 MV |
167 | static int usb_kbd_translate(struct usb_kbd_pdata *data, unsigned char scancode, |
168 | unsigned char modifier, int pressed) | |
affae2bf | 169 | { |
9a8c72a6 | 170 | uint8_t keycode = 0; |
affae2bf | 171 | |
9a8c72a6 | 172 | /* Key released */ |
00b7d6ec | 173 | if (pressed == 0) { |
9a8c72a6 | 174 | data->repeat_delay = 0; |
affae2bf WD |
175 | return 0; |
176 | } | |
9a8c72a6 | 177 | |
00b7d6ec | 178 | if (pressed == 2) { |
9a8c72a6 MV |
179 | data->repeat_delay++; |
180 | if (data->repeat_delay < REPEAT_DELAY) | |
affae2bf | 181 | return 0; |
9a8c72a6 MV |
182 | |
183 | data->repeat_delay = REPEAT_DELAY; | |
affae2bf | 184 | } |
9a8c72a6 MV |
185 | |
186 | /* Alphanumeric values */ | |
187 | if ((scancode > 3) && (scancode <= 0x1d)) { | |
188 | keycode = scancode - 4 + 'a'; | |
189 | ||
190 | if (data->flags & USB_KBD_CAPSLOCK) | |
00b7d6ec | 191 | keycode &= ~CAPITAL_MASK; |
9a8c72a6 MV |
192 | |
193 | if (modifier & (LEFT_SHIFT | RIGHT_SHIFT)) { | |
194 | /* Handle CAPSLock + Shift pressed simultaneously */ | |
00b7d6ec | 195 | if (keycode & CAPITAL_MASK) |
00b7d6ec | 196 | keycode &= ~CAPITAL_MASK; |
affae2bf | 197 | else |
00b7d6ec | 198 | keycode |= CAPITAL_MASK; |
affae2bf WD |
199 | } |
200 | } | |
9a8c72a6 | 201 | |
bdbcbe75 | 202 | if ((scancode > 0x1d) && (scancode < 0x39)) { |
9a8c72a6 MV |
203 | /* Shift pressed */ |
204 | if (modifier & (LEFT_SHIFT | RIGHT_SHIFT)) | |
205 | keycode = usb_kbd_numkey_shifted[scancode - 0x1e]; | |
206 | else | |
207 | keycode = usb_kbd_numkey[scancode - 0x1e]; | |
affae2bf | 208 | } |
4785a694 | 209 | |
4151a400 AM |
210 | /* Arrow keys */ |
211 | if ((scancode >= 0x4f) && (scancode <= 0x52)) | |
212 | keycode = usb_kbd_arrow[scancode - 0x4f]; | |
213 | ||
d53da847 VP |
214 | /* Numeric keypad */ |
215 | if ((scancode >= 0x54) && (scancode <= 0x67)) | |
216 | keycode = usb_kbd_num_keypad[scancode - 0x54]; | |
217 | ||
9a8c72a6 | 218 | if (data->flags & USB_KBD_CTRL) |
4785a694 ZW |
219 | keycode = scancode - 0x3; |
220 | ||
00b7d6ec MV |
221 | if (pressed == 1) { |
222 | if (scancode == NUM_LOCK) { | |
9a8c72a6 | 223 | data->flags ^= USB_KBD_NUMLOCK; |
affae2bf WD |
224 | return 1; |
225 | } | |
9a8c72a6 | 226 | |
00b7d6ec | 227 | if (scancode == CAPS_LOCK) { |
9a8c72a6 | 228 | data->flags ^= USB_KBD_CAPSLOCK; |
affae2bf WD |
229 | return 1; |
230 | } | |
00b7d6ec | 231 | if (scancode == SCROLL_LOCK) { |
9a8c72a6 | 232 | data->flags ^= USB_KBD_SCROLLLOCK; |
affae2bf WD |
233 | return 1; |
234 | } | |
235 | } | |
9a8c72a6 MV |
236 | |
237 | /* Report keycode if any */ | |
238 | if (keycode) { | |
ceb4972a | 239 | debug("%c", keycode); |
9a8c72a6 | 240 | usb_kbd_put_queue(data, keycode); |
affae2bf | 241 | } |
9a8c72a6 | 242 | |
affae2bf WD |
243 | return 0; |
244 | } | |
245 | ||
9a8c72a6 MV |
246 | static uint32_t usb_kbd_service_key(struct usb_device *dev, int i, int up) |
247 | { | |
248 | uint32_t res = 0; | |
249 | struct usb_kbd_pdata *data = dev->privptr; | |
250 | uint8_t *new; | |
251 | uint8_t *old; | |
252 | ||
253 | if (up) { | |
254 | new = data->old; | |
255 | old = data->new; | |
256 | } else { | |
257 | new = data->new; | |
258 | old = data->old; | |
259 | } | |
260 | ||
08a98b89 AC |
261 | if ((old[i] > 3) && |
262 | (memscan(new + 2, old[i], USB_KBD_BOOT_REPORT_SIZE - 2) == | |
263 | new + USB_KBD_BOOT_REPORT_SIZE)) { | |
9a8c72a6 | 264 | res |= usb_kbd_translate(data, old[i], data->new[0], up); |
08a98b89 | 265 | } |
9a8c72a6 MV |
266 | |
267 | return res; | |
268 | } | |
269 | ||
affae2bf | 270 | /* Interrupt service routine */ |
48c8073e | 271 | static int usb_kbd_irq_worker(struct usb_device *dev) |
affae2bf | 272 | { |
9a8c72a6 MV |
273 | struct usb_kbd_pdata *data = dev->privptr; |
274 | int i, res = 0; | |
4785a694 | 275 | |
9a8c72a6 MV |
276 | /* No combo key pressed */ |
277 | if (data->new[0] == 0x00) | |
278 | data->flags &= ~USB_KBD_CTRL; | |
279 | /* Left or Right Ctrl pressed */ | |
280 | else if ((data->new[0] == LEFT_CNTR) || (data->new[0] == RIGHT_CNTR)) | |
281 | data->flags |= USB_KBD_CTRL; | |
00b7d6ec | 282 | |
08a98b89 | 283 | for (i = 2; i < USB_KBD_BOOT_REPORT_SIZE; i++) { |
9a8c72a6 MV |
284 | res |= usb_kbd_service_key(dev, i, 0); |
285 | res |= usb_kbd_service_key(dev, i, 1); | |
affae2bf | 286 | } |
00b7d6ec | 287 | |
9a8c72a6 MV |
288 | /* Key is still pressed */ |
289 | if ((data->new[2] > 3) && (data->old[2] == data->new[2])) | |
290 | res |= usb_kbd_translate(data, data->new[2], data->new[0], 2); | |
291 | ||
00b7d6ec | 292 | if (res == 1) |
affae2bf | 293 | usb_kbd_setled(dev); |
00b7d6ec | 294 | |
08a98b89 | 295 | memcpy(data->old, data->new, USB_KBD_BOOT_REPORT_SIZE); |
00b7d6ec | 296 | |
9a8c72a6 | 297 | return 1; |
affae2bf WD |
298 | } |
299 | ||
9a8c72a6 | 300 | /* Keyboard interrupt handler */ |
48c8073e MV |
301 | static int usb_kbd_irq(struct usb_device *dev) |
302 | { | |
08a98b89 AC |
303 | if ((dev->irq_status != 0) || |
304 | (dev->irq_act_len != USB_KBD_BOOT_REPORT_SIZE)) { | |
ceb4972a VG |
305 | debug("USB KBD: Error %lX, len %d\n", |
306 | dev->irq_status, dev->irq_act_len); | |
48c8073e MV |
307 | return 1; |
308 | } | |
309 | ||
310 | return usb_kbd_irq_worker(dev); | |
311 | } | |
312 | ||
9a8c72a6 MV |
313 | /* Interrupt polling */ |
314 | static inline void usb_kbd_poll_for_event(struct usb_device *dev) | |
315 | { | |
8454c84a | 316 | #if defined(CONFIG_SYS_USB_EVENT_POLL) |
8f8d7d24 | 317 | struct usb_kbd_pdata *data = dev->privptr; |
f9636e8d AM |
318 | |
319 | /* Submit a interrupt transfer request */ | |
8f8d7d24 HG |
320 | usb_submit_int_msg(dev, data->intpipe, &data->new[0], data->intpktsize, |
321 | data->intinterval); | |
f9636e8d | 322 | |
9a8c72a6 | 323 | usb_kbd_irq_worker(dev); |
8454c84a HG |
324 | #elif defined(CONFIG_SYS_USB_EVENT_POLL_VIA_CONTROL_EP) || \ |
325 | defined(CONFIG_SYS_USB_EVENT_POLL_VIA_INT_QUEUE) | |
326 | #if defined(CONFIG_SYS_USB_EVENT_POLL_VIA_CONTROL_EP) | |
9a8c72a6 MV |
327 | struct usb_interface *iface; |
328 | struct usb_kbd_pdata *data = dev->privptr; | |
329 | iface = &dev->config.if_desc[0]; | |
330 | usb_get_report(dev, iface->desc.bInterfaceNumber, | |
08a98b89 | 331 | 1, 0, data->new, USB_KBD_BOOT_REPORT_SIZE); |
8454c84a | 332 | if (memcmp(data->old, data->new, USB_KBD_BOOT_REPORT_SIZE)) { |
9a8c72a6 | 333 | usb_kbd_irq_worker(dev); |
8454c84a | 334 | #else |
8e553119 HG |
335 | struct usb_kbd_pdata *data = dev->privptr; |
336 | if (poll_int_queue(dev, data->intq)) { | |
337 | usb_kbd_irq_worker(dev); | |
338 | /* We've consumed all queued int packets, create new */ | |
339 | destroy_int_queue(dev, data->intq); | |
340 | data->intq = create_int_queue(dev, data->intpipe, 1, | |
8bb6c1d1 HG |
341 | USB_KBD_BOOT_REPORT_SIZE, data->new, |
342 | data->intinterval); | |
8454c84a HG |
343 | #endif |
344 | data->last_report = get_timer(0); | |
345 | /* Repeat last usb hid report every REPEAT_RATE ms for keyrepeat */ | |
346 | } else if (data->last_report != -1 && | |
347 | get_timer(data->last_report) > REPEAT_RATE) { | |
348 | usb_kbd_irq_worker(dev); | |
349 | data->last_report = get_timer(0); | |
8e553119 | 350 | } |
9a8c72a6 MV |
351 | #endif |
352 | } | |
353 | ||
354 | /* test if a character is in the queue */ | |
709ea543 | 355 | static int usb_kbd_testc(struct stdio_dev *sdev) |
9a8c72a6 MV |
356 | { |
357 | struct stdio_dev *dev; | |
358 | struct usb_device *usb_kbd_dev; | |
359 | struct usb_kbd_pdata *data; | |
360 | ||
c95e2b9e JL |
361 | #ifdef CONFIG_CMD_NET |
362 | /* | |
363 | * If net_busy_flag is 1, NET transfer is running, | |
364 | * then we check key-pressed every second (first check may be | |
365 | * less than 1 second) to improve TFTP booting performance. | |
366 | */ | |
367 | if (net_busy_flag && (get_timer(kbd_testc_tms) < CONFIG_SYS_HZ)) | |
368 | return 0; | |
369 | kbd_testc_tms = get_timer(0); | |
370 | #endif | |
4fb67f47 | 371 | dev = stdio_get_by_name(sdev->name); |
9a8c72a6 MV |
372 | usb_kbd_dev = (struct usb_device *)dev->priv; |
373 | data = usb_kbd_dev->privptr; | |
374 | ||
375 | usb_kbd_poll_for_event(usb_kbd_dev); | |
376 | ||
377 | return !(data->usb_in_pointer == data->usb_out_pointer); | |
378 | } | |
379 | ||
380 | /* gets the character from the queue */ | |
709ea543 | 381 | static int usb_kbd_getc(struct stdio_dev *sdev) |
9a8c72a6 MV |
382 | { |
383 | struct stdio_dev *dev; | |
384 | struct usb_device *usb_kbd_dev; | |
385 | struct usb_kbd_pdata *data; | |
386 | ||
4fb67f47 | 387 | dev = stdio_get_by_name(sdev->name); |
9a8c72a6 MV |
388 | usb_kbd_dev = (struct usb_device *)dev->priv; |
389 | data = usb_kbd_dev->privptr; | |
390 | ||
f8f3e0e5 MS |
391 | while (data->usb_in_pointer == data->usb_out_pointer) { |
392 | WATCHDOG_RESET(); | |
9a8c72a6 | 393 | usb_kbd_poll_for_event(usb_kbd_dev); |
f8f3e0e5 | 394 | } |
9a8c72a6 MV |
395 | |
396 | if (data->usb_out_pointer == USB_KBD_BUFFER_LEN - 1) | |
397 | data->usb_out_pointer = 0; | |
398 | else | |
399 | data->usb_out_pointer++; | |
400 | ||
401 | return data->usb_kbd_buffer[data->usb_out_pointer]; | |
402 | } | |
403 | ||
404 | /* probes the USB device dev for keyboard type. */ | |
34ab37ee | 405 | static int usb_kbd_probe_dev(struct usb_device *dev, unsigned int ifnum) |
affae2bf | 406 | { |
8f8bd565 | 407 | struct usb_interface *iface; |
affae2bf | 408 | struct usb_endpoint_descriptor *ep; |
9a8c72a6 | 409 | struct usb_kbd_pdata *data; |
affae2bf | 410 | |
00b7d6ec MV |
411 | if (dev->descriptor.bNumConfigurations != 1) |
412 | return 0; | |
9a8c72a6 | 413 | |
affae2bf WD |
414 | iface = &dev->config.if_desc[ifnum]; |
415 | ||
2cdb58eb | 416 | if (iface->desc.bInterfaceClass != USB_CLASS_HID) |
8f8bd565 | 417 | return 0; |
9a8c72a6 | 418 | |
2cdb58eb | 419 | if (iface->desc.bInterfaceSubClass != USB_SUB_HID_BOOT) |
8f8bd565 | 420 | return 0; |
9a8c72a6 | 421 | |
2cdb58eb | 422 | if (iface->desc.bInterfaceProtocol != USB_PROT_HID_KEYBOARD) |
8f8bd565 | 423 | return 0; |
9a8c72a6 | 424 | |
8f8bd565 TR |
425 | if (iface->desc.bNumEndpoints != 1) |
426 | return 0; | |
affae2bf WD |
427 | |
428 | ep = &iface->ep_desc[0]; | |
429 | ||
9a8c72a6 | 430 | /* Check if endpoint 1 is interrupt endpoint */ |
00b7d6ec MV |
431 | if (!(ep->bEndpointAddress & 0x80)) |
432 | return 0; | |
9a8c72a6 | 433 | |
00b7d6ec MV |
434 | if ((ep->bmAttributes & 3) != 3) |
435 | return 0; | |
9a8c72a6 | 436 | |
ceb4972a | 437 | debug("USB KBD: found set protocol...\n"); |
9a8c72a6 MV |
438 | |
439 | data = malloc(sizeof(struct usb_kbd_pdata)); | |
440 | if (!data) { | |
441 | printf("USB KBD: Error allocating private data\n"); | |
442 | return 0; | |
443 | } | |
444 | ||
445 | /* Clear private data */ | |
446 | memset(data, 0, sizeof(struct usb_kbd_pdata)); | |
447 | ||
d7475386 | 448 | /* allocate input buffer aligned and sized to USB DMA alignment */ |
08a98b89 AC |
449 | data->new = memalign(USB_DMA_MINALIGN, |
450 | roundup(USB_KBD_BOOT_REPORT_SIZE, USB_DMA_MINALIGN)); | |
d7475386 | 451 | |
9a8c72a6 MV |
452 | /* Insert private data into USB device structure */ |
453 | dev->privptr = data; | |
454 | ||
455 | /* Set IRQ handler */ | |
456 | dev->irq_handle = usb_kbd_irq; | |
457 | ||
8f8d7d24 HG |
458 | data->intpipe = usb_rcvintpipe(dev, ep->bEndpointAddress); |
459 | data->intpktsize = min(usb_maxpacket(dev, data->intpipe), | |
460 | USB_KBD_BOOT_REPORT_SIZE); | |
461 | data->intinterval = ep->bInterval; | |
8454c84a | 462 | data->last_report = -1; |
9a8c72a6 MV |
463 | |
464 | /* We found a USB Keyboard, install it. */ | |
465 | usb_set_protocol(dev, iface->desc.bInterfaceNumber, 0); | |
466 | ||
de451493 | 467 | debug("USB KBD: found set idle...\n"); |
8454c84a HG |
468 | #if !defined(CONFIG_SYS_USB_EVENT_POLL_VIA_CONTROL_EP) && \ |
469 | !defined(CONFIG_SYS_USB_EVENT_POLL_VIA_INT_QUEUE) | |
8454c84a | 470 | usb_set_idle(dev, iface->desc.bInterfaceNumber, REPEAT_RATE / 4, 0); |
de451493 HG |
471 | #else |
472 | usb_set_idle(dev, iface->desc.bInterfaceNumber, 0, 0); | |
8454c84a | 473 | #endif |
9a8c72a6 | 474 | |
ceb4972a | 475 | debug("USB KBD: enable interrupt pipe...\n"); |
8e553119 HG |
476 | #ifdef CONFIG_SYS_USB_EVENT_POLL_VIA_INT_QUEUE |
477 | data->intq = create_int_queue(dev, data->intpipe, 1, | |
8bb6c1d1 HG |
478 | USB_KBD_BOOT_REPORT_SIZE, data->new, |
479 | data->intinterval); | |
8e553119 | 480 | if (!data->intq) { |
e4b70d80 SW |
481 | #elif defined(CONFIG_SYS_USB_EVENT_POLL_VIA_CONTROL_EP) |
482 | if (usb_get_report(dev, iface->desc.bInterfaceNumber, | |
483 | 1, 0, data->new, USB_KBD_BOOT_REPORT_SIZE) < 0) { | |
8e553119 | 484 | #else |
8f8d7d24 HG |
485 | if (usb_submit_int_msg(dev, data->intpipe, data->new, data->intpktsize, |
486 | data->intinterval) < 0) { | |
8e553119 | 487 | #endif |
5da2dc97 VP |
488 | printf("Failed to get keyboard state from device %04x:%04x\n", |
489 | dev->descriptor.idVendor, dev->descriptor.idProduct); | |
490 | /* Abort, we don't want to use that non-functional keyboard. */ | |
491 | return 0; | |
492 | } | |
9a8c72a6 MV |
493 | |
494 | /* Success. */ | |
affae2bf WD |
495 | return 1; |
496 | } | |
497 | ||
603afaf0 SG |
498 | static int probe_usb_keyboard(struct usb_device *dev) |
499 | { | |
500 | char *stdinname; | |
501 | struct stdio_dev usb_kbd_dev; | |
502 | int error; | |
503 | ||
504 | /* Try probing the keyboard */ | |
34ab37ee | 505 | if (usb_kbd_probe_dev(dev, 0) != 1) |
603afaf0 SG |
506 | return -ENOENT; |
507 | ||
508 | /* Register the keyboard */ | |
509 | debug("USB KBD: register.\n"); | |
510 | memset(&usb_kbd_dev, 0, sizeof(struct stdio_dev)); | |
511 | strcpy(usb_kbd_dev.name, DEVNAME); | |
1caf934a | 512 | usb_kbd_dev.flags = DEV_FLAGS_INPUT; |
603afaf0 SG |
513 | usb_kbd_dev.getc = usb_kbd_getc; |
514 | usb_kbd_dev.tstc = usb_kbd_testc; | |
515 | usb_kbd_dev.priv = (void *)dev; | |
516 | error = stdio_register(&usb_kbd_dev); | |
517 | if (error) | |
518 | return error; | |
519 | ||
00caae6d | 520 | stdinname = env_get("stdin"); |
b0265429 | 521 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
603afaf0 SG |
522 | error = iomux_doenv(stdin, stdinname); |
523 | if (error) | |
524 | return error; | |
525 | #else | |
526 | /* Check if this is the standard input device. */ | |
527 | if (strcmp(stdinname, DEVNAME)) | |
528 | return 1; | |
529 | ||
530 | /* Reassign the console */ | |
531 | if (overwrite_console()) | |
532 | return 1; | |
533 | ||
534 | error = console_assign(stdin, DEVNAME); | |
535 | if (error) | |
536 | return error; | |
537 | #endif | |
538 | ||
539 | return 0; | |
540 | } | |
541 | ||
fd09c205 | 542 | #if !CONFIG_IS_ENABLED(DM_USB) |
9a8c72a6 MV |
543 | /* Search for keyboard and register it if found. */ |
544 | int drv_usb_kbd_init(void) | |
545 | { | |
9a8c72a6 MV |
546 | int error, i; |
547 | ||
697033cb | 548 | debug("%s: Probing for keyboard\n", __func__); |
697033cb | 549 | /* Scan all USB Devices */ |
9a8c72a6 | 550 | for (i = 0; i < USB_MAX_DEVICE; i++) { |
603afaf0 SG |
551 | struct usb_device *dev; |
552 | ||
9a8c72a6 MV |
553 | /* Get USB device. */ |
554 | dev = usb_get_dev_index(i); | |
555 | if (!dev) | |
603afaf0 | 556 | break; |
9a8c72a6 MV |
557 | |
558 | if (dev->devnum == -1) | |
559 | continue; | |
560 | ||
603afaf0 SG |
561 | error = probe_usb_keyboard(dev); |
562 | if (!error) | |
9a8c72a6 | 563 | return 1; |
603afaf0 | 564 | if (error && error != -ENOENT) |
9a8c72a6 | 565 | return error; |
9a8c72a6 MV |
566 | } |
567 | ||
568 | /* No USB Keyboard found */ | |
569 | return -1; | |
570 | } | |
571 | ||
572 | /* Deregister the keyboard. */ | |
8a8a2257 | 573 | int usb_kbd_deregister(int force) |
9a8c72a6 | 574 | { |
869588de | 575 | #if CONFIG_IS_ENABLED(SYS_STDIO_DEREGISTER) |
dfe5b1c8 HG |
576 | struct stdio_dev *dev; |
577 | struct usb_device *usb_kbd_dev; | |
578 | struct usb_kbd_pdata *data; | |
579 | ||
580 | dev = stdio_get_by_name(DEVNAME); | |
581 | if (dev) { | |
582 | usb_kbd_dev = (struct usb_device *)dev->priv; | |
583 | data = usb_kbd_dev->privptr; | |
584 | if (stdio_deregister_dev(dev, force) != 0) | |
585 | return 1; | |
b0265429 | 586 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
00caae6d | 587 | if (iomux_doenv(stdin, env_get("stdin")) != 0) |
3cbcb289 HG |
588 | return 1; |
589 | #endif | |
8e553119 HG |
590 | #ifdef CONFIG_SYS_USB_EVENT_POLL_VIA_INT_QUEUE |
591 | destroy_int_queue(usb_kbd_dev, data->intq); | |
592 | #endif | |
dfe5b1c8 HG |
593 | free(data->new); |
594 | free(data); | |
595 | } | |
0ea09dfe HG |
596 | |
597 | return 0; | |
9a8c72a6 MV |
598 | #else |
599 | return 1; | |
600 | #endif | |
601 | } | |
34ab37ee | 602 | |
9a80e714 HG |
603 | #endif |
604 | ||
fd09c205 | 605 | #if CONFIG_IS_ENABLED(DM_USB) |
34ab37ee SG |
606 | |
607 | static int usb_kbd_probe(struct udevice *dev) | |
608 | { | |
609 | struct usb_device *udev = dev_get_parent_priv(dev); | |
34ab37ee | 610 | |
8319aeb1 | 611 | return probe_usb_keyboard(udev); |
34ab37ee SG |
612 | } |
613 | ||
8a834870 SG |
614 | static int usb_kbd_remove(struct udevice *dev) |
615 | { | |
616 | struct usb_device *udev = dev_get_parent_priv(dev); | |
617 | struct usb_kbd_pdata *data; | |
618 | struct stdio_dev *sdev; | |
619 | int ret; | |
620 | ||
621 | sdev = stdio_get_by_name(DEVNAME); | |
622 | if (!sdev) { | |
623 | ret = -ENXIO; | |
624 | goto err; | |
625 | } | |
626 | data = udev->privptr; | |
627 | if (stdio_deregister_dev(sdev, true)) { | |
628 | ret = -EPERM; | |
629 | goto err; | |
630 | } | |
b0265429 | 631 | #if CONFIG_IS_ENABLED(CONSOLE_MUX) |
00caae6d | 632 | if (iomux_doenv(stdin, env_get("stdin"))) { |
8a834870 SG |
633 | ret = -ENOLINK; |
634 | goto err; | |
635 | } | |
636 | #endif | |
637 | #ifdef CONFIG_SYS_USB_EVENT_POLL_VIA_INT_QUEUE | |
638 | destroy_int_queue(udev, data->intq); | |
639 | #endif | |
640 | free(data->new); | |
641 | free(data); | |
642 | ||
643 | return 0; | |
644 | err: | |
645 | printf("%s: warning, ret=%d", __func__, ret); | |
646 | return ret; | |
647 | } | |
648 | ||
34ab37ee SG |
649 | static const struct udevice_id usb_kbd_ids[] = { |
650 | { .compatible = "usb-keyboard" }, | |
651 | { } | |
652 | }; | |
653 | ||
654 | U_BOOT_DRIVER(usb_kbd) = { | |
655 | .name = "usb_kbd", | |
656 | .id = UCLASS_KEYBOARD, | |
657 | .of_match = usb_kbd_ids, | |
658 | .probe = usb_kbd_probe, | |
8a834870 | 659 | .remove = usb_kbd_remove, |
34ab37ee SG |
660 | }; |
661 | ||
34ab37ee SG |
662 | static const struct usb_device_id kbd_id_table[] = { |
663 | { | |
664 | .match_flags = USB_DEVICE_ID_MATCH_INT_CLASS | | |
665 | USB_DEVICE_ID_MATCH_INT_SUBCLASS | | |
666 | USB_DEVICE_ID_MATCH_INT_PROTOCOL, | |
667 | .bInterfaceClass = USB_CLASS_HID, | |
2cdb58eb SG |
668 | .bInterfaceSubClass = USB_SUB_HID_BOOT, |
669 | .bInterfaceProtocol = USB_PROT_HID_KEYBOARD, | |
34ab37ee SG |
670 | }, |
671 | { } /* Terminating entry */ | |
672 | }; | |
673 | ||
674 | U_BOOT_USB_DEVICE(usb_kbd, kbd_id_table); | |
675 | ||
676 | #endif |