Input: add support for SEGA Dreamcast keyboard

Signed-off by: Adrian McMenamin <adrian@mcmen.demon.co.uk>
Acked-by: Arjan van de Ven <arjan@linux.intel.com>
Signed-off-by: Dmitry Torokhov <dtor@mail.ru>

3 files changed, 263 insertions, 0 deletions

diff --git a/drivers/input/keyboard/Kconfig b/drivers/input/keyboard/Kconfig
index 18303f2bbafd..f6f79e880b20 100644
--- a/drivers/input/keyboard/Kconfig
+++ b/drivers/input/keyboard/Kconfig
@@ -274,4 +274,14 @@ config KEYBOARD_GPIO
           To compile this driver as a module, choose M here: the
           module will be called gpio-keys.
 
+config KEYBOARD_MAPLE
+        tristate "Maple bus keyboard"
+        depends on SH_DREAMCAST && MAPLE
+        help
+          Say Y here if you have a Dreamcast console running Linux and have
+          a keyboard attached to its Maple bus.
+
+          To compile this driver as a module, choose M here: the
+          module will be called maple_keyb.
+
 endif
diff --git a/drivers/input/keyboard/Makefile b/drivers/input/keyboard/Makefile
index 4cc7dc947db1..2776aa4a3a95 100644
--- a/drivers/input/keyboard/Makefile
+++ b/drivers/input/keyboard/Makefile
@@ -23,4 +23,5 @@ obj-$(CONFIG_KEYBOARD_AAED2000)		+= aaed2000_kbd.o
 obj-$(CONFIG_KEYBOARD_GPIO)             += gpio_keys.o
 obj-$(CONFIG_KEYBOARD_HP6XX)            += jornada680_kbd.o
 obj-$(CONFIG_KEYBOARD_HP7XX)            += jornada720_kbd.o
+obj-$(CONFIG_KEYBOARD_MAPLE)            += maple_keyb.o
 
diff --git a/drivers/input/keyboard/maple_keyb.c b/drivers/input/keyboard/maple_keyb.c
new file mode 100644
index 000000000000..2b404284c28a
--- /dev/null
+++ b/drivers/input/keyboard/maple_keyb.c
@@ -0,0 +1,252 @@
+/*
+ * SEGA Dreamcast keyboard driver
+ * Based on drivers/usb/usbkbd.c
+ * Copyright YAEGASHI Takeshi, 2001
+ * Porting to 2.6 Copyright Adrian McMenamin, 2007
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, see the file COPYING, or write
+ * to the Free Software Foundation, Inc.,
+ * 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ */
+
+#include <linux/kernel.h>
+#include <linux/slab.h>
+#include <linux/input.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/timer.h>
+#include <linux/maple.h>
+#include <asm/mach/maple.h>
+
+/* Very simple mutex to ensure proper cleanup */
+static DEFINE_MUTEX(maple_keyb_mutex);
+
+#define NR_SCANCODES 256
+
+MODULE_AUTHOR("YAEGASHI Takeshi, Adrian McMenamin");
+MODULE_DESCRIPTION("SEGA Dreamcast keyboard driver");
+MODULE_LICENSE("GPL");
+
+struct dc_kbd {
+        struct input_dev *dev;
+        unsigned short keycode[NR_SCANCODES];
+        unsigned char new[8];
+        unsigned char old[8];
+};
+
+static const unsigned short dc_kbd_keycode[NR_SCANCODES] = {
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_A, KEY_B, KEY_C, KEY_D,
+        KEY_E, KEY_F, KEY_G, KEY_H, KEY_I, KEY_J, KEY_K, KEY_L,
+        KEY_M, KEY_N, KEY_O, KEY_P, KEY_Q, KEY_R, KEY_S, KEY_T,
+        KEY_U, KEY_V, KEY_W, KEY_X, KEY_Y, KEY_Z, KEY_1, KEY_2,
+        KEY_3, KEY_4, KEY_5, KEY_6, KEY_7, KEY_8, KEY_9, KEY_0,
+        KEY_ENTER, KEY_ESC, KEY_BACKSPACE, KEY_TAB, KEY_SPACE, KEY_MINUS, KEY_EQUAL, KEY_LEFTBRACE,
+        KEY_RIGHTBRACE, KEY_BACKSLASH, KEY_BACKSLASH, KEY_SEMICOLON, KEY_APOSTROPHE, KEY_GRAVE, KEY_COMMA,
+        KEY_DOT, KEY_SLASH, KEY_CAPSLOCK, KEY_F1, KEY_F2, KEY_F3, KEY_F4, KEY_F5, KEY_F6,
+        KEY_F7, KEY_F8, KEY_F9, KEY_F10, KEY_F11, KEY_F12, KEY_SYSRQ,
+        KEY_SCROLLLOCK, KEY_PAUSE, KEY_INSERT, KEY_HOME, KEY_PAGEUP, KEY_DELETE,
+        KEY_END, KEY_PAGEDOWN, KEY_RIGHT, KEY_LEFT, KEY_DOWN, KEY_UP,
+        KEY_NUMLOCK, KEY_KPSLASH, KEY_KPASTERISK, KEY_KPMINUS, KEY_KPPLUS, KEY_KPENTER, KEY_KP1, KEY_KP2,
+        KEY_KP3, KEY_KP4, KEY_KP5, KEY_KP6, KEY_KP7, KEY_KP8, KEY_KP9, KEY_KP0, KEY_KPDOT,
+        KEY_102ND, KEY_COMPOSE, KEY_POWER, KEY_KPEQUAL, KEY_F13, KEY_F14, KEY_F15,
+        KEY_F16, KEY_F17, KEY_F18, KEY_F19, KEY_F20,
+        KEY_F21, KEY_F22, KEY_F23, KEY_F24, KEY_OPEN, KEY_HELP, KEY_PROPS, KEY_FRONT,
+        KEY_STOP, KEY_AGAIN, KEY_UNDO, KEY_CUT, KEY_COPY, KEY_PASTE, KEY_FIND, KEY_MUTE,
+        KEY_VOLUMEUP, KEY_VOLUMEDOWN, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_KPCOMMA, KEY_RESERVED, KEY_RO, KEY_KATAKANAHIRAGANA , KEY_YEN,
+        KEY_HENKAN, KEY_MUHENKAN, KEY_KPJPCOMMA, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_HANGEUL, KEY_HANJA, KEY_KATAKANA, KEY_HIRAGANA, KEY_ZENKAKUHANKAKU, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
+        KEY_LEFTCTRL, KEY_LEFTSHIFT, KEY_LEFTALT, KEY_LEFTMETA, KEY_RIGHTCTRL, KEY_RIGHTSHIFT, KEY_RIGHTALT, KEY_RIGHTMETA,
+        KEY_PLAYPAUSE, KEY_STOPCD, KEY_PREVIOUSSONG, KEY_NEXTSONG, KEY_EJECTCD, KEY_VOLUMEUP, KEY_VOLUMEDOWN, KEY_MUTE,
+        KEY_WWW, KEY_BACK, KEY_FORWARD, KEY_STOP, KEY_FIND, KEY_SCROLLUP, KEY_SCROLLDOWN, KEY_EDIT, KEY_SLEEP,
+        KEY_SCREENLOCK, KEY_REFRESH, KEY_CALC, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED
+};
+
+static void dc_scan_kbd(struct dc_kbd *kbd)
+{
+        struct input_dev *dev = kbd->dev;
+        void *ptr;
+        int code, keycode;
+        int i;
+
+        for (i = 0; i < 8; i++) {
+                code = i + 224;
+                keycode = kbd->keycode[code];
+                input_event(dev, EV_MSC, MSC_SCAN, code);
+                input_report_key(dev, keycode, (kbd->new[0] >> i) & 1);
+        }
+
+        for (i = 2; i < 8; i++) {
+                ptr = memchr(kbd->new + 2, kbd->old[i], 6);
+                code = kbd->old[i];
+                if (code > 3 && ptr == NULL) {
+                        keycode = kbd->keycode[code];
+                        if (keycode) {
+                                input_event(dev, EV_MSC, MSC_SCAN, code);
+                                input_report_key(dev, keycode, 0);
+                        } else
+                                printk(KERN_DEBUG "maple_keyb: "
+                                        "Unknown key (scancode %#x) released.",
+                                        code);
+                }
+                ptr = memchr(kbd->old + 2, kbd->new[i], 6);
+                code = kbd->new[i];
+                if (code > 3 && ptr) {
+                        keycode = kbd->keycode[code];
+                        if (keycode) {
+                                input_event(dev, EV_MSC, MSC_SCAN, code);
+                                input_report_key(dev, keycode, 1);
+                        } else
+                                printk(KERN_DEBUG "maple_keyb: "
+                                        "Unknown key (scancode %#x) pressed.",
+                                        code);
+                }
+        }
+        input_sync(dev);
+        memcpy(kbd->old, kbd->new, 8);
+}
+
+static void dc_kbd_callback(struct mapleq *mq)
+{
+        struct maple_device *mapledev = mq->dev;
+        struct dc_kbd *kbd = mapledev->private_data;
+        unsigned long *buf = mq->recvbuf;
+
+        /*
+         * We should always be getting the lock because the only
+         * time it may be locked if driver is in cleanup phase.
+         */
+        if (likely(mutex_trylock(&maple_keyb_mutex))) {
+
+                if (buf[1] == mapledev->function) {
+                        memcpy(kbd->new, buf + 2, 8);
+                        dc_scan_kbd(kbd);
+                }
+
+                mutex_unlock(&maple_keyb_mutex);
+        }
+}
+
+static int dc_kbd_connect(struct maple_device *mdev)
+{
+        int i, error;
+        struct dc_kbd *kbd;
+        struct input_dev *dev;
+
+        if (!(mdev->function & MAPLE_FUNC_KEYBOARD))
+                return -EINVAL;
+
+        kbd = kzalloc(sizeof(struct dc_kbd), GFP_KERNEL);
+        dev = input_allocate_device();
+        if (!kbd || !dev) {
+                error = -ENOMEM;
+                goto fail;
+        }
+
+        mdev->private_data = kbd;
+
+        kbd->dev = dev;
+        memcpy(kbd->keycode, dc_kbd_keycode, sizeof(kbd->keycode));
+
+        dev->name = mdev->product_name;
+        dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
+        dev->keycode = kbd->keycode;
+        dev->keycodesize = sizeof (unsigned short);
+        dev->keycodemax = ARRAY_SIZE(kbd->keycode);
+        dev->id.bustype = BUS_HOST;
+        dev->dev.parent = &mdev->dev;
+
+        for (i = 0; i < NR_SCANCODES; i++)
+                __set_bit(dc_kbd_keycode[i], dev->keybit);
+        __clear_bit(KEY_RESERVED, dev->keybit);
+
+        input_set_capability(dev, EV_MSC, MSC_SCAN);
+        input_set_drvdata(dev, kbd);
+
+        error = input_register_device(dev);
+        if (error)
+                goto fail;
+
+        /* Maple polling is locked to VBLANK - which may be just 50/s */
+        maple_getcond_callback(mdev, dc_kbd_callback, HZ/50, MAPLE_FUNC_KEYBOARD);
+        return 0;
+
+ fail:
+        input_free_device(dev);
+        kfree(kbd);
+        mdev->private_data = NULL;
+        return error;
+}
+
+static void dc_kbd_disconnect(struct maple_device *mdev)
+{
+        struct dc_kbd *kbd;
+
+        mutex_lock(&maple_keyb_mutex);
+
+        kbd = mdev->private_data;
+        mdev->private_data = NULL;
+        input_unregister_device(kbd->dev);
+        kfree(kbd);
+
+        mutex_unlock(&maple_keyb_mutex);
+}
+
+/* allow the keyboard to be used */
+static int probe_maple_kbd(struct device *dev)
+{
+        struct maple_device *mdev = to_maple_dev(dev);
+        struct maple_driver *mdrv = to_maple_driver(dev->driver);
+        int error;
+
+        error = dc_kbd_connect(mdev);
+        if (error)
+                return error;
+
+        mdev->driver = mdrv;
+        mdev->registered = 1;
+
+        return 0;
+}
+
+static struct maple_driver dc_kbd_driver = {
+        .function = MAPLE_FUNC_KEYBOARD,
+        .connect = dc_kbd_connect,
+        .disconnect = dc_kbd_disconnect,
+        .drv = {
+                .name = "Dreamcast_keyboard",
+                .probe = probe_maple_kbd,
+       },
+};
+
+static int __init dc_kbd_init(void)
+{
+        return maple_driver_register(&dc_kbd_driver.drv);
+}
+
+static void __exit dc_kbd_exit(void)
+{
+        driver_unregister(&dc_kbd_driver.drv);
+}
+
+module_init(dc_kbd_init);
+module_exit(dc_kbd_exit);