]> www.pilppa.org Git - linux-2.6-omap-h63xx.git/commitdiff
Input: add support for enhanced rotary controller on pxa930 and pxa935
authorYong Yao <yaoyong@marvell.com>
Mon, 29 Dec 2008 12:00:02 +0000 (04:00 -0800)
committerDmitry Torokhov <dmitry.torokhov@gmail.com>
Mon, 29 Dec 2008 12:59:16 +0000 (04:59 -0800)
Signed-off-by: Yong Yao <yaoyong@marvell.com>
Signed-off-by: Eric Miao <eric.miao@marvell.com>
Signed-off-by: Dmitry Torokhov <dtor@mail.ru>
arch/arm/mach-pxa/include/mach/pxa930_rotary.h [new file with mode: 0644]
drivers/input/keyboard/Kconfig
drivers/input/keyboard/Makefile
drivers/input/keyboard/pxa930_rotary.c [new file with mode: 0644]

diff --git a/arch/arm/mach-pxa/include/mach/pxa930_rotary.h b/arch/arm/mach-pxa/include/mach/pxa930_rotary.h
new file mode 100644 (file)
index 0000000..053587c
--- /dev/null
@@ -0,0 +1,20 @@
+#ifndef __ASM_ARCH_PXA930_ROTARY_H
+#define __ASM_ARCH_PXA930_ROTARY_H
+
+/* NOTE:
+ *
+ * rotary can be either interpreted as a ralative input event (e.g.
+ * REL_WHEEL or REL_HWHEEL) or a specific key event (e.g. UP/DOWN
+ * or LEFT/RIGHT), depending on if up_key & down_key are assigned
+ * or rel_code is assigned a non-zero value. When all are non-zero,
+ * up_key and down_key will be preferred.
+ */
+struct pxa930_rotary_platform_data {
+       int     up_key;
+       int     down_key;
+       int     rel_code;
+};
+
+void __init pxa930_set_rotarykey_info(struct pxa930_rotary_platform_data *info);
+
+#endif /* __ASM_ARCH_PXA930_ROTARY_H */
index efd70a9745910bfacd97e39b4fdebe451fa14ca4..35561689ff38717f60ddc588493d7d02206f2008 100644 (file)
@@ -268,6 +268,15 @@ config KEYBOARD_PXA27x
          To compile this driver as a module, choose M here: the
          module will be called pxa27x_keypad.
 
+config KEYBOARD_PXA930_ROTARY
+       tristate "PXA930/PXA935 Enhanced Rotary Controller Support"
+       depends on CPU_PXA930 || CPU_PXA935
+       help
+         Enable support for PXA930/PXA935 Enhanced Rotary Controller.
+
+         To compile this driver as a module, choose M here: the
+         module will be called pxa930_rotary.
+
 config KEYBOARD_AAED2000
        tristate "AAED-2000 keyboard"
        depends on MACH_AAED2000
index 0edc8f285d1cf57f21a93eb4da8e6fa279920a7a..36351e1190f9e2db8d49da0ac1b6a941c8b547d1 100644 (file)
@@ -20,6 +20,7 @@ obj-$(CONFIG_KEYBOARD_HIL)            += hil_kbd.o
 obj-$(CONFIG_KEYBOARD_HIL_OLD)         += hilkbd.o
 obj-$(CONFIG_KEYBOARD_OMAP)            += omap-keypad.o
 obj-$(CONFIG_KEYBOARD_PXA27x)          += pxa27x_keypad.o
+obj-$(CONFIG_KEYBOARD_PXA930_ROTARY)   += pxa930_rotary.o
 obj-$(CONFIG_KEYBOARD_AAED2000)                += aaed2000_kbd.o
 obj-$(CONFIG_KEYBOARD_GPIO)            += gpio_keys.o
 obj-$(CONFIG_KEYBOARD_HP6XX)           += jornada680_kbd.o
diff --git a/drivers/input/keyboard/pxa930_rotary.c b/drivers/input/keyboard/pxa930_rotary.c
new file mode 100644 (file)
index 0000000..95fbba4
--- /dev/null
@@ -0,0 +1,212 @@
+/*
+ * Driver for the enhanced rotary controller on pxa930 and pxa935
+ *
+ * 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 <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/interrupt.h>
+#include <linux/input.h>
+#include <linux/platform_device.h>
+#include <linux/io.h>
+
+#include <mach/pxa930_rotary.h>
+
+#define SBCR   (0x04)
+#define ERCR   (0x0c)
+
+#define SBCR_ERSB      (1 << 5)
+
+struct pxa930_rotary {
+       struct input_dev        *input_dev;
+       void __iomem            *mmio_base;
+       int                     last_ercr;
+
+       struct pxa930_rotary_platform_data *pdata;
+};
+
+static void clear_sbcr(struct pxa930_rotary *r)
+{
+       uint32_t sbcr = __raw_readl(r->mmio_base + SBCR);
+
+       __raw_writel(sbcr | SBCR_ERSB, r->mmio_base + SBCR);
+       __raw_writel(sbcr & ~SBCR_ERSB, r->mmio_base + SBCR);
+}
+
+static irqreturn_t rotary_irq(int irq, void *dev_id)
+{
+       struct pxa930_rotary *r = dev_id;
+       struct pxa930_rotary_platform_data *pdata = r->pdata;
+       int ercr, delta, key;
+
+       ercr = __raw_readl(r->mmio_base + ERCR) & 0xf;
+       clear_sbcr(r);
+
+       delta = ercr - r->last_ercr;
+       if (delta == 0)
+               return IRQ_HANDLED;
+
+       r->last_ercr = ercr;
+
+       if (pdata->up_key && pdata->down_key) {
+               key = (delta > 0) ? pdata->up_key : pdata->down_key;
+               input_report_key(r->input_dev, key, 1);
+               input_sync(r->input_dev);
+               input_report_key(r->input_dev, key, 0);
+       } else
+               input_report_rel(r->input_dev, pdata->rel_code, delta);
+
+       input_sync(r->input_dev);
+
+       return IRQ_HANDLED;
+}
+
+static int pxa930_rotary_open(struct input_dev *dev)
+{
+       struct pxa930_rotary *r = input_get_drvdata(dev);
+
+       clear_sbcr(r);
+
+       return 0;
+}
+
+static void pxa930_rotary_close(struct input_dev *dev)
+{
+       struct pxa930_rotary *r = input_get_drvdata(dev);
+
+       clear_sbcr(r);
+}
+
+static int __devinit pxa930_rotary_probe(struct platform_device *pdev)
+{
+       struct pxa930_rotary_platform_data *pdata = pdev->dev.platform_data;
+       struct pxa930_rotary *r;
+       struct input_dev *input_dev;
+       struct resource *res;
+       int irq;
+       int err;
+
+       irq = platform_get_irq(pdev, 0);
+       if (irq < 0) {
+               dev_err(&pdev->dev, "no irq for rotary controller\n");
+               return -ENXIO;
+       }
+
+       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       if (!res) {
+               dev_err(&pdev->dev, "no I/O memory defined\n");
+               return -ENXIO;
+       }
+
+       if (!pdata) {
+               dev_err(&pdev->dev, "no platform data defined\n");
+               return -EINVAL;
+       }
+
+       r = kzalloc(sizeof(struct pxa930_rotary), GFP_KERNEL);
+       if (!r)
+               return -ENOMEM;
+
+       r->mmio_base = ioremap_nocache(res->start, resource_size(res));
+       if (r->mmio_base == NULL) {
+               dev_err(&pdev->dev, "failed to remap IO memory\n");
+               err = -ENXIO;
+               goto failed_free;
+       }
+
+       r->pdata = pdata;
+       platform_set_drvdata(pdev, r);
+
+       /* allocate and register the input device */
+       input_dev = input_allocate_device();
+       if (!input_dev) {
+               dev_err(&pdev->dev, "failed to allocate input device\n");
+               err = -ENOMEM;
+               goto failed_free_io;
+       }
+
+       input_dev->name = pdev->name;
+       input_dev->id.bustype = BUS_HOST;
+       input_dev->open = pxa930_rotary_open;
+       input_dev->close = pxa930_rotary_close;
+       input_dev->dev.parent = &pdev->dev;
+
+       if (pdata->up_key && pdata->down_key) {
+               __set_bit(pdata->up_key, input_dev->keybit);
+               __set_bit(pdata->down_key, input_dev->keybit);
+               __set_bit(EV_KEY, input_dev->evbit);
+       } else {
+               __set_bit(pdata->rel_code, input_dev->relbit);
+               __set_bit(EV_REL, input_dev->evbit);
+       }
+
+       r->input_dev = input_dev;
+       input_set_drvdata(input_dev, r);
+
+       err = request_irq(irq, rotary_irq, IRQF_DISABLED,
+                       "enhanced rotary", r);
+       if (err) {
+               dev_err(&pdev->dev, "failed to request IRQ\n");
+               goto failed_free_input;
+       }
+
+       err = input_register_device(input_dev);
+       if (err) {
+               dev_err(&pdev->dev, "failed to register input device\n");
+               goto failed_free_irq;
+       }
+
+       return 0;
+
+failed_free_irq:
+       free_irq(irq, r);
+failed_free_input:
+       input_free_device(input_dev);
+failed_free_io:
+       iounmap(r->mmio_base);
+failed_free:
+       kfree(r);
+       return err;
+}
+
+static int __devexit pxa930_rotary_remove(struct platform_device *pdev)
+{
+       struct pxa930_rotary *r = platform_get_drvdata(pdev);
+
+       free_irq(platform_get_irq(pdev, 0), r);
+       input_unregister_device(r->input_dev);
+       iounmap(r->mmio_base);
+       platform_set_drvdata(pdev, NULL);
+       kfree(r);
+
+       return 0;
+}
+
+static struct platform_driver pxa930_rotary_driver = {
+       .driver         = {
+               .name   = "pxa930-rotary",
+               .owner  = THIS_MODULE,
+       },
+       .probe          = pxa930_rotary_probe,
+       .remove         = __devexit_p(pxa930_rotary_remove),
+};
+
+static int __init pxa930_rotary_init(void)
+{
+       return platform_driver_register(&pxa930_rotary_driver);
+}
+module_init(pxa930_rotary_init);
+
+static void __exit pxa930_rotary_exit(void)
+{
+       platform_driver_unregister(&pxa930_rotary_driver);
+}
+module_exit(pxa930_rotary_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_DESCRIPTION("Driver for PXA93x Enhanced Rotary Controller");
+MODULE_AUTHOR("Yao Yong <yaoyong@marvell.com>");