Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * SEGA Dreamcast keyboard driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * Based on drivers/usb/usbkbd.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright (c) YAEGASHI Takeshi, 2001
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * Porting to 2.6 Copyright (c) Adrian McMenamin, 2007 - 2009
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/timer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/maple.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) /* Very simple mutex to ensure proper cleanup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) static DEFINE_MUTEX(maple_keyb_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #define NR_SCANCODES 256
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) MODULE_AUTHOR("Adrian McMenamin <adrian@mcmen.demon.co.uk");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) MODULE_DESCRIPTION("SEGA Dreamcast keyboard driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) struct dc_kbd {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	struct input_dev *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	unsigned short keycode[NR_SCANCODES];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	unsigned char new[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	unsigned char old[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) static const unsigned short dc_kbd_keycode[NR_SCANCODES] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_A, KEY_B,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	KEY_C, KEY_D, KEY_E, KEY_F, KEY_G, KEY_H, KEY_I, KEY_J, KEY_K, KEY_L,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	KEY_M, KEY_N, KEY_O, KEY_P, KEY_Q, KEY_R, KEY_S, KEY_T, KEY_U, KEY_V,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	KEY_W, KEY_X, KEY_Y, KEY_Z, KEY_1, KEY_2, KEY_3, KEY_4, KEY_5, KEY_6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	KEY_7, KEY_8, KEY_9, KEY_0, KEY_ENTER, KEY_ESC, KEY_BACKSPACE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	KEY_TAB, KEY_SPACE, KEY_MINUS, KEY_EQUAL, KEY_LEFTBRACE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	KEY_RIGHTBRACE, KEY_BACKSLASH, KEY_BACKSLASH, KEY_SEMICOLON,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	KEY_APOSTROPHE, KEY_GRAVE, KEY_COMMA, KEY_DOT, KEY_SLASH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	KEY_CAPSLOCK, KEY_F1, KEY_F2, KEY_F3, KEY_F4, KEY_F5, KEY_F6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	KEY_F7, KEY_F8, KEY_F9, KEY_F10, KEY_F11, KEY_F12, KEY_SYSRQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	KEY_SCROLLLOCK, KEY_PAUSE, KEY_INSERT, KEY_HOME, KEY_PAGEUP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	KEY_DELETE, KEY_END, KEY_PAGEDOWN, KEY_RIGHT, KEY_LEFT, KEY_DOWN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	KEY_UP, KEY_NUMLOCK, KEY_KPSLASH, KEY_KPASTERISK, KEY_KPMINUS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	KEY_KPPLUS, KEY_KPENTER, KEY_KP1, KEY_KP2, KEY_KP3, KEY_KP4, KEY_KP5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	KEY_KP6, KEY_KP7, KEY_KP8, KEY_KP9, KEY_KP0, KEY_KPDOT, KEY_102ND,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	KEY_COMPOSE, KEY_POWER, KEY_KPEQUAL, KEY_F13, KEY_F14, KEY_F15,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	KEY_F16, KEY_F17, KEY_F18, KEY_F19, KEY_F20, KEY_F21, KEY_F22,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	KEY_F23, KEY_F24, KEY_OPEN, KEY_HELP, KEY_PROPS, KEY_FRONT, KEY_STOP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	KEY_AGAIN, KEY_UNDO, KEY_CUT, KEY_COPY, KEY_PASTE, KEY_FIND, KEY_MUTE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	KEY_VOLUMEUP, KEY_VOLUMEDOWN, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	KEY_KPCOMMA, KEY_RESERVED, KEY_RO, KEY_KATAKANAHIRAGANA , KEY_YEN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	KEY_HENKAN, KEY_MUHENKAN, KEY_KPJPCOMMA, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	KEY_RESERVED, KEY_HANGEUL, KEY_HANJA, KEY_KATAKANA, KEY_HIRAGANA,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	KEY_ZENKAKUHANKAKU, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	KEY_RESERVED, KEY_RESERVED, KEY_LEFTCTRL, KEY_LEFTSHIFT, KEY_LEFTALT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	KEY_LEFTMETA, KEY_RIGHTCTRL, KEY_RIGHTSHIFT, KEY_RIGHTALT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	KEY_RIGHTMETA, KEY_PLAYPAUSE, KEY_STOPCD, KEY_PREVIOUSSONG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	KEY_NEXTSONG, KEY_EJECTCD, KEY_VOLUMEUP, KEY_VOLUMEDOWN, KEY_MUTE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	KEY_WWW, KEY_BACK, KEY_FORWARD, KEY_STOP, KEY_FIND, KEY_SCROLLUP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	KEY_SCROLLDOWN, KEY_EDIT, KEY_SLEEP, KEY_SCREENLOCK, KEY_REFRESH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	KEY_CALC, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) static void dc_scan_kbd(struct dc_kbd *kbd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	struct input_dev *dev = kbd->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	void *ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	int code, keycode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	for (i = 0; i < 8; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 		code = i + 224;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 		keycode = kbd->keycode[code];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 		input_event(dev, EV_MSC, MSC_SCAN, code);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 		input_report_key(dev, keycode, (kbd->new[0] >> i) & 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	for (i = 2; i < 8; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		ptr = memchr(kbd->new + 2, kbd->old[i], 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 		code = kbd->old[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 		if (code > 3 && ptr == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 			keycode = kbd->keycode[code];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 			if (keycode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 				input_event(dev, EV_MSC, MSC_SCAN, code);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 				input_report_key(dev, keycode, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 			} else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 				dev_dbg(&dev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 					"Unknown key (scancode %#x) released.",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 					code);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 		ptr = memchr(kbd->old + 2, kbd->new[i], 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 		code = kbd->new[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 		if (code > 3 && ptr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 			keycode = kbd->keycode[code];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 			if (keycode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 				input_event(dev, EV_MSC, MSC_SCAN, code);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 				input_report_key(dev, keycode, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 			} else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 				dev_dbg(&dev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 					"Unknown key (scancode %#x) pressed.",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 					code);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	input_sync(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	memcpy(kbd->old, kbd->new, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) static void dc_kbd_callback(struct mapleq *mq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	struct maple_device *mapledev = mq->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 	struct dc_kbd *kbd = maple_get_drvdata(mapledev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	unsigned long *buf = (unsigned long *)(mq->recvbuf->buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	 * We should always get the lock because the only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	 * time it may be locked is if the driver is in the cleanup phase.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	if (likely(mutex_trylock(&maple_keyb_mutex))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 		if (buf[1] == mapledev->function) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 			memcpy(kbd->new, buf + 2, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 			dc_scan_kbd(kbd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 		mutex_unlock(&maple_keyb_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static int probe_maple_kbd(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	struct maple_device *mdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	struct maple_driver *mdrv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	int i, error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	struct dc_kbd *kbd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	struct input_dev *idev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	mdev = to_maple_dev(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	mdrv = to_maple_driver(dev->driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	kbd = kzalloc(sizeof(struct dc_kbd), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	if (!kbd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 		error = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 		goto fail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	idev = input_allocate_device();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	if (!idev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 		error = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 		goto fail_idev_alloc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	kbd->dev = idev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	memcpy(kbd->keycode, dc_kbd_keycode, sizeof(kbd->keycode));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	idev->name = mdev->product_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	idev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	idev->keycode = kbd->keycode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	idev->keycodesize = sizeof(unsigned short);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	idev->keycodemax = ARRAY_SIZE(kbd->keycode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	idev->id.bustype = BUS_HOST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	idev->dev.parent = &mdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	for (i = 0; i < NR_SCANCODES; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		__set_bit(dc_kbd_keycode[i], idev->keybit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	__clear_bit(KEY_RESERVED, idev->keybit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	input_set_capability(idev, EV_MSC, MSC_SCAN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	error = input_register_device(idev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 		goto fail_register;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	/* Maple polling is locked to VBLANK - which may be just 50/s */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	maple_getcond_callback(mdev, dc_kbd_callback, HZ/50,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		MAPLE_FUNC_KEYBOARD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	mdev->driver = mdrv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	maple_set_drvdata(mdev, kbd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 	return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) fail_register:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	maple_set_drvdata(mdev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	input_free_device(idev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) fail_idev_alloc:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	kfree(kbd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) fail:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) static int remove_maple_kbd(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	struct maple_device *mdev = to_maple_dev(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 	struct dc_kbd *kbd = maple_get_drvdata(mdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	mutex_lock(&maple_keyb_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 	input_unregister_device(kbd->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	kfree(kbd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	maple_set_drvdata(mdev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 	mutex_unlock(&maple_keyb_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) static struct maple_driver dc_kbd_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	.function = MAPLE_FUNC_KEYBOARD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	.drv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 		.name = "Dreamcast_keyboard",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 		.probe = probe_maple_kbd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 		.remove = remove_maple_kbd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) static int __init dc_kbd_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 	return maple_driver_register(&dc_kbd_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) static void __exit dc_kbd_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	maple_driver_unregister(&dc_kbd_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) module_init(dc_kbd_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) module_exit(dc_kbd_exit);