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