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