From a63a227ece28df06d4c8f04eec51c7649ef28aea Mon Sep 17 00:00:00 2001 From: mokopatches Date: Fri, 25 Jul 2008 22:21:22 +0100 Subject: [PATCH] s3c2410-qt2410-buttons.patch --- arch/arm/mach-s3c2410/mach-qt2410.c | 18 +++ drivers/input/keyboard/Kconfig | 5 + drivers/input/keyboard/Makefile | 1 + drivers/input/keyboard/qt2410kbd.c | 233 +++++++++++++++++++++++++++++++++++ 4 files changed, 257 insertions(+), 0 deletions(-) create mode 100644 drivers/input/keyboard/qt2410kbd.c diff --git a/arch/arm/mach-s3c2410/mach-qt2410.c b/arch/arm/mach-s3c2410/mach-qt2410.c index 6f7b56d..daf94cd 100644 --- a/arch/arm/mach-s3c2410/mach-qt2410.c +++ b/arch/arm/mach-s3c2410/mach-qt2410.c @@ -321,6 +321,24 @@ static int __init qt2410_tft_setup(char *str) __setup("tft=", qt2410_tft_setup); +static struct resource qt2410_button_resources[] = { + [0] = { + .start = S3C2410_GPF0, + .end = S3C2410_GPF0, + }, + [1] = { + .start = S3C2410_GPF2, + .end = S3C2410_GPF2, + }, +}; + +struct platform_device qt2410_button_dev = { + .name ="qt2410-button", + .num_resources = ARRAY_SIZE(qt2410_button_resources), + .resource = qt2410_button_resources, +}; + + static void __init qt2410_map_io(void) { s3c24xx_init_io(qt2410_iodesc, ARRAY_SIZE(qt2410_iodesc)); diff --git a/drivers/input/keyboard/Kconfig b/drivers/input/keyboard/Kconfig index b8ecca9..bc7aac3 100644 --- a/drivers/input/keyboard/Kconfig +++ b/drivers/input/keyboard/Kconfig @@ -334,5 +334,10 @@ config KEYBOARD_NEO1973 To compile this driver as a module, choose M here: the module will be called neo1973kbd. +config KEYBOARD_QT2410 + tristate "QT2410 buttons" + depends on MACH_QT2410 + default y + endif diff --git a/drivers/input/keyboard/Makefile b/drivers/input/keyboard/Makefile index b3aa339..63a8972 100644 --- a/drivers/input/keyboard/Makefile +++ b/drivers/input/keyboard/Makefile @@ -15,6 +15,7 @@ obj-$(CONFIG_KEYBOARD_NEWTON) += newtonkbd.o obj-$(CONFIG_KEYBOARD_STOWAWAY) += stowaway.o obj-$(CONFIG_KEYBOARD_CORGI) += corgikbd.o obj-$(CONFIG_KEYBOARD_NEO1973) += neo1973kbd.o +obj-$(CONFIG_KEYBOARD_QT2410) += qt2410kbd.o obj-$(CONFIG_KEYBOARD_SPITZ) += spitzkbd.o obj-$(CONFIG_KEYBOARD_TOSA) += tosakbd.o obj-$(CONFIG_KEYBOARD_HIL) += hil_kbd.o diff --git a/drivers/input/keyboard/qt2410kbd.c b/drivers/input/keyboard/qt2410kbd.c new file mode 100644 index 0000000..4d497a3 --- /dev/null +++ b/drivers/input/keyboard/qt2410kbd.c @@ -0,0 +1,233 @@ +/* + * Keyboard driver for Armzone QT2410 + * + * (C) 2006 by OpenMoko, Inc. + * Author: Harald Welte + * All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +struct gta01kbd { + struct input_dev *input; + unsigned int suspended; + unsigned long suspend_jiffies; +}; + +static irqreturn_t gta01kbd_interrupt(int irq, void *dev_id) +{ + struct gta01kbd *gta01kbd_data = dev_id; + + /* FIXME: use GPIO from platform_dev resources */ + if (s3c2410_gpio_getpin(S3C2410_GPF0)) + input_report_key(gta01kbd_data->input, KEY_PHONE, 1); + else + input_report_key(gta01kbd_data->input, KEY_PHONE, 0); + + input_sync(gta01kbd_data->input); + + return IRQ_HANDLED; +} + + +#ifdef CONFIG_PM +static int gta01kbd_suspend(struct platform_device *dev, pm_message_t state) +{ + struct gta01kbd *gta01kbd = platform_get_drvdata(dev); + + gta01kbd->suspended = 1; + + return 0; +} + +static int gta01kbd_resume(struct platform_device *dev) +{ + struct gta01kbd *gta01kbd = platform_get_drvdata(dev); + + gta01kbd->suspended = 0; + + return 0; +} +#else +#define gta01kbd_suspend NULL +#define gta01kbd_resume NULL +#endif + +static int gta01kbd_probe(struct platform_device *pdev) +{ + struct gta01kbd *gta01kbd; + struct input_dev *input_dev; + int irq_911; + int rc = 0; + + gta01kbd = kzalloc(sizeof(struct gta01kbd), GFP_KERNEL); + if (!gta01kbd) { + rc = -ENOMEM; + goto bail; + } + input_dev = input_allocate_device(); + if (!gta01kbd || !input_dev) { + rc = -ENOMEM; + goto bail_free; + } + + if (pdev->resource[0].flags != 0) {\ + rc = -EINVAL; + goto bail_free_dev; + } + + irq_911 = s3c2410_gpio_getirq(pdev->resource[0].start); + if (irq_911 < 0) { + rc = -EINVAL; + goto bail_free_dev; + } + + platform_set_drvdata(pdev, gta01kbd); + + gta01kbd->input = input_dev; + +#if 0 + spin_lock_init(>a01kbd->lock); + /* Init Keyboard rescan timer */ + init_timer(&corgikbd->timer); + corgikbd->timer.function = corgikbd_timer_callback; + corgikbd->timer.data = (unsigned long) corgikbd; + + /* Init Hinge Timer */ + init_timer(&corgikbd->htimer); + corgikbd->htimer.function = corgikbd_hinge_timer; + corgikbd->htimer.data = (unsigned long) corgikbd; + + corgikbd->suspend_jiffies=jiffies; + + memcpy(corgikbd->keycode, corgikbd_keycode, sizeof(corgikbd->keycode)); +#endif + + input_dev->name = "QT2410 Buttons"; + input_dev->phys = "qt2410kbd/input0"; + input_dev->id.bustype = BUS_HOST; + input_dev->id.vendor = 0x0001; + input_dev->id.product = 0x0001; + input_dev->id.version = 0x0100; + input_dev->cdev.dev = &pdev->dev; + input_dev->private = gta01kbd; + + input_dev->evbit[0] = BIT(EV_KEY); +#if 0 + input_dev->keycode = gta01kbd->keycode; + input_dev->keycodesize = sizeof(unsigned char); + input_dev->keycodemax = ARRAY_SIZE(corgikbd_keycode); + + for (i = 0; i < ARRAY_SIZE(corgikbd_keycode); i++) + set_bit(corgikbd->keycode[i], input_dev->keybit); + clear_bit(0, input_dev->keybit); + set_bit(SW_LID, input_dev->swbit); + set_bit(SW_TABLET_MODE, input_dev->swbit); + set_bit(SW_HEADPHONE_INSERT, input_dev->swbit); +#endif + + rc = input_register_device(gta01kbd->input); + if (rc) + goto bail_free_dev; + + s3c2410_gpio_cfgpin(S3C2410_GPF0, S3C2410_GPF0_EINT0); + if (request_irq(irq_911, gta01kbd_interrupt, + IRQF_DISABLED | IRQF_TRIGGER_RISING | + IRQF_TRIGGER_FALLING, "qt2410kbd_eint0", gta01kbd)) + printk(KERN_WARNING "gta01kbd: Can't get IRQ\n"); + enable_irq_wake(irq_911); + + /* FIXME: headphone insert */ + +#if 0 + mod_timer(&corgikbd->htimer, jiffies + msecs_to_jiffies(HINGE_SCAN_INTERVAL)); + + /* Setup sense interrupts - RisingEdge Detect, sense lines as inputs */ + for (i = 0; i < CORGI_KEY_SENSE_NUM; i++) { + pxa_gpio_mode(CORGI_GPIO_KEY_SENSE(i) | GPIO_IN); + if (request_irq(CORGI_IRQ_GPIO_KEY_SENSE(i), corgikbd_interrupt, + SA_INTERRUPT | SA_TRIGGER_RISING, + "corgikbd", corgikbd)) + printk(KERN_WARNING "corgikbd: Can't get IRQ: %d!\n", i); + } + + /* Set Strobe lines as outputs - set high */ + for (i = 0; i < CORGI_KEY_STROBE_NUM; i++) + pxa_gpio_mode(CORGI_GPIO_KEY_STROBE(i) | GPIO_OUT | GPIO_DFLT_HIGH); + + /* Setup the headphone jack as an input */ + pxa_gpio_mode(CORGI_GPIO_AK_INT | GPIO_IN); +#endif + + return 0; + +bail_free_dev: + input_free_device(input_dev); +bail_free: + kfree(gta01kbd); +bail: + return rc; +} + +static int gta01kbd_remove(struct platform_device *pdev) +{ + struct gta01kbd *gta01kbd = platform_get_drvdata(pdev); + + free_irq(s3c2410_gpio_getirq(pdev->resource[0].start), gta01kbd); +#if 0 + int i; + + for (i = 0; i < CORGI_KEY_SENSE_NUM; i++) + free_irq(CORGI_IRQ_GPIO_KEY_SENSE(i), corgikbd); + + del_timer_sync(&corgikbd->htimer); + del_timer_sync(&corgikbd->timer); +#endif + input_unregister_device(gta01kbd->input); + + kfree(gta01kbd); + + return 0; +} + +static struct platform_driver gta01kbd_driver = { + .probe = gta01kbd_probe, + .remove = gta01kbd_remove, + .suspend = gta01kbd_suspend, + .resume = gta01kbd_resume, + .driver = { + .name = "qt2410-button", + }, +}; + +static int __devinit gta01kbd_init(void) +{ + return platform_driver_register(>a01kbd_driver); +} + +static void __exit gta01kbd_exit(void) +{ + platform_driver_unregister(>a01kbd_driver); +} + +module_init(gta01kbd_init); +module_exit(gta01kbd_exit); + +MODULE_AUTHOR("Harald Welte "); +MODULE_DESCRIPTION("Armzone QT2410 Buttons Driver"); +MODULE_LICENSE("GPL"); -- 1.5.6.3