From: Miguel Aguilar <[email protected]> Adds the driver for enabling keypad support on DM365 platform.
This driver was tested on DM365 EVM rev c. Signed-off-by: Miguel Aguilar <[email protected]> --- arch/arm/mach-davinci/include/mach/keypad.h | 35 +++ drivers/input/keyboard/Kconfig | 6 + drivers/input/keyboard/Makefile | 1 + drivers/input/keyboard/davinci_dm365_keypad.c | 331 +++++++++++++++++++++++++ 4 files changed, 373 insertions(+), 0 deletions(-) create mode 100644 arch/arm/mach-davinci/include/mach/keypad.h create mode 100644 drivers/input/keyboard/davinci_dm365_keypad.c diff --git a/arch/arm/mach-davinci/include/mach/keypad.h b/arch/arm/mach-davinci/include/mach/keypad.h new file mode 100644 index 0000000..922d20e --- /dev/null +++ b/arch/arm/mach-davinci/include/mach/keypad.h @@ -0,0 +1,35 @@ +/* + * Copyright (C) 2009 Texas Instruments, Inc + * + * Author: Miguel Aguilar <[email protected]> + * + * 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, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + */ + +#ifndef DAVINCI_KEYPAD_H +#define DAVINCI_KEYPAD_H + +#include <linux/io.h> + +struct davinci_kp_platform_data { + int *keymap; + u32 keymapsize; + u32 rep:1; + u32 strobe; + u32 interval; +}; + +#endif + diff --git a/drivers/input/keyboard/Kconfig b/drivers/input/keyboard/Kconfig index a6b989a..08ed7d4 100644 --- a/drivers/input/keyboard/Kconfig +++ b/drivers/input/keyboard/Kconfig @@ -361,4 +361,10 @@ config KEYBOARD_XTKBD To compile this driver as a module, choose M here: the module will be called xtkbd. +config KEYBOARD_DAVINCI_DM365 + tristate "TI DaVinci DM365 Keypad" + depends on ARCH_DAVINCI_DM365 + help + Supports the keypad module on the DM365 + endif diff --git a/drivers/input/keyboard/Makefile b/drivers/input/keyboard/Makefile index b5b5eae..1921bac 100644 --- a/drivers/input/keyboard/Makefile +++ b/drivers/input/keyboard/Makefile @@ -31,3 +31,4 @@ obj-$(CONFIG_KEYBOARD_STOWAWAY) += stowaway.o obj-$(CONFIG_KEYBOARD_SUNKBD) += sunkbd.o obj-$(CONFIG_KEYBOARD_TOSA) += tosakbd.o obj-$(CONFIG_KEYBOARD_XTKBD) += xtkbd.o +obj-$(CONFIG_KEYBOARD_DAVINCI_DM365) += davinci_dm365_keypad.o diff --git a/drivers/input/keyboard/davinci_dm365_keypad.c b/drivers/input/keyboard/davinci_dm365_keypad.c new file mode 100644 index 0000000..5db8eed --- /dev/null +++ b/drivers/input/keyboard/davinci_dm365_keypad.c @@ -0,0 +1,331 @@ +/* + * DaVinci DM365 Keypad Driver + * + * Copyright (C) 2009 Texas Instruments, Inc + * + * Author: Miguel Aguilar <[email protected]> + * + * Intial Code: Sandeep Paulraj <[email protected]> + * + * 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, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + */ +#include <linux/module.h> +#include <linux/init.h> +#include <linux/interrupt.h> +#include <linux/types.h> +#include <linux/input.h> +#include <linux/kernel.h> +#include <linux/delay.h> +#include <linux/platform_device.h> +#include <linux/errno.h> + +#include <asm/irq.h> + +#include <mach/hardware.h> +#include <mach/irqs.h> +#include <mach/keypad.h> + +/* Keypad registers */ +#define DM365_KEYPAD_KEYCTRL 0x0000 +#define DM365_KEYPAD_INTENA 0x0004 +#define DM365_KEYPAD_INTFLAG 0x0008 +#define DM365_KEYPAD_INTCLR 0x000c +#define DM365_KEYPAD_STRBWIDTH 0x0010 +#define DM365_KEYPAD_INTERVAL 0x0014 +#define DM365_KEYPAD_CONTTIME 0x0018 +#define DM365_KEYPAD_CURRENTST 0x001c +#define DM365_KEYPAD_PREVSTATE 0x0020 +#define DM365_KEYPAD_EMUCTRL 0x0024 +#define DM365_KEYPAD_IODFTCTRL 0x002c + +/* Key Control Register (KEYCTRL) */ +#define DM365_KEYPAD_KEYEN 0x00000001 +#define DM365_KEYPAD_PREVMODE 0x00000002 +#define DM365_KEYPAD_CHATOFF 0x00000004 +#define DM365_KEYPAD_AUTODET 0x00000008 +#define DM365_KEYPAD_SCANMODE 0x00000010 +#define DM365_KEYPAD_OUTTYPE 0x00000020 +#define DM365_KEYPAD_4X4 0x00000040 + +/* Masks for the interrupts */ +#define DM365_KEYPAD_INT_CONT 0x00000008 +#define DM365_KEYPAD_INT_OFF 0x00000004 +#define DM365_KEYPAD_INT_ON 0x00000002 +#define DM365_KEYPAD_INT_CHANGE 0x00000001 +#define DM365_KEYPAD_INT_ALL 0x0000000f + +struct davinci_kp { + struct input_dev *input; + struct davinci_kp_platform_data *pdata; + int irq; + void __iomem *base; + resource_size_t pbase; + size_t base_size; +}; + +static void dm365_kp_write(struct davinci_kp *dm365_kp, u32 val, u32 addr) +{ + u32 base = (u32)dm365_kp->base; + + __raw_writel(val,(u32 *)(base + addr)); +} + +static u32 dm365_kp_read(struct davinci_kp *dm365_kp, u32 addr) +{ + u32 base = (u32)dm365_kp->base; + + return __raw_readl((u32 *)(base + addr)); +} + +/* Initializing the kp Module */ +static void dm365_kp_initialize(struct davinci_kp *dm365_kp) +{ + u32 strobe = dm365_kp->pdata->strobe; + u32 interval = dm365_kp->pdata->interval; + + /* Enable all interrupts */ + dm365_kp_write(dm365_kp, DM365_KEYPAD_INT_ALL, DM365_KEYPAD_INTENA); + + /* Clear interrupts if any */ + dm365_kp_write(dm365_kp, DM365_KEYPAD_INT_ALL, DM365_KEYPAD_INTCLR); + + /* Setup the scan period = strobe + interval */ + dm365_kp_write(dm365_kp, strobe, DM365_KEYPAD_STRBWIDTH); + dm365_kp_write(dm365_kp, interval, DM365_KEYPAD_INTERVAL); + dm365_kp_write(dm365_kp, 0x01, DM365_KEYPAD_CONTTIME); + + /* Enable Keyscan module and enable */ + dm365_kp_write(dm365_kp, DM365_KEYPAD_AUTODET | DM365_KEYPAD_KEYEN, + DM365_KEYPAD_KEYCTRL); +} + +static irqreturn_t dm365_kp_interrupt(int irq, void *dev_id) +{ + int i; + u32 prev_status, new_status, changed; + int keycode = KEY_UNKNOWN; + struct davinci_kp *dm365_kp = dev_id; + int *keymap = dm365_kp->pdata->keymap; + u32 keymapsize = dm365_kp->pdata->keymapsize; + struct device *dev = &dm365_kp->input->dev; + + /* Disable interrupt */ + dm365_kp_write(dm365_kp, 0x0, DM365_KEYPAD_INTENA); + + /* Reading previous and new status of the keypad */ + prev_status = dm365_kp_read(dm365_kp, DM365_KEYPAD_PREVSTATE); + new_status = dm365_kp_read(dm365_kp, DM365_KEYPAD_CURRENTST); + + changed = prev_status ^ new_status; + + for (i = 0; i < keymapsize; i++) { + if ((changed >> i) & 0x1) { + keycode = keymap[i]; + if((new_status >> i) & 0x1) { + /* Report release */ + input_report_key(dm365_kp->input, keycode, 0); + input_sync(dm365_kp->input); + dev_dbg(dev, "dm365_keypad: key %d released\n", + keycode); + } else { + /* Report press */ + input_report_key(dm365_kp->input, keycode, 1); + input_sync(dm365_kp->input); + dev_dbg(dev, "dm365_keypad: key %d pressed\n", + keycode); + } + } + } + + /* Clearing interrupt */ + dm365_kp_write(dm365_kp, DM365_KEYPAD_INT_ALL, DM365_KEYPAD_INTCLR); + + /* Enable interrupts */ + dm365_kp_write(dm365_kp, 0x1, DM365_KEYPAD_INTENA); + + return IRQ_HANDLED; +} + +/* + * Registers keypad device with input sub system and configures + * DM365 keypad registers + */ +static int dm365_kp_probe(struct platform_device *pdev) +{ + struct davinci_kp *dm365_kp; + struct input_dev *key_dev; + struct resource *res, *mem; + int ret, i; + struct device * dev = &pdev->dev; + struct davinci_kp_platform_data *pdata = pdev->dev.platform_data; + + dev_info(dev, "DaVinci DM365 Keypad Driver\n"); + + if (!pdata->keymap) { + dev_dbg(dev, "%s: No keymap from pdata\n", pdev->name); + return -EINVAL; + } + + dm365_kp = kzalloc(sizeof *dm365_kp, GFP_KERNEL); + if(!dm365_kp) { + dev_dbg(dev, "%s: Could not allocate memory for private data\n", + pdev->name); + return -ENOMEM; + } + + key_dev = input_allocate_device(); + if (!key_dev) { + dev_dbg(dev, "%s: Could not allocate input device\n", + pdev->name); + ret = -ENOMEM; + goto fail1; + } + + platform_set_drvdata(pdev, dm365_kp); + + dm365_kp->input = key_dev; + + dm365_kp->irq = platform_get_irq(pdev, 0); + if (dm365_kp->irq <= 0) { + dev_err(dev, "%s: No DM365 Keypad irq\n", pdev->name); + ret = dm365_kp->irq; + goto fail2; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) { + dev_err(dev, "%s: No MEM resource\n", pdev->name); + ret = -ENODEV; + goto fail2; + } + + dm365_kp->pbase = res->start; + dm365_kp->base_size = resource_size(res); + + mem = request_mem_region(dm365_kp->pbase, dm365_kp->base_size, pdev->name); + if (!mem) { + dev_err(dev,"%s: KEYSCAN registers at %08x are not free\n", + pdev->name, dm365_kp->pbase); + ret = -EBUSY; + goto fail2; + } + + dm365_kp->base = ioremap(dm365_kp->pbase, dm365_kp->base_size); + if (!dm365_kp->base) { + dev_err(dev,"%s: Can't ioremap MEM resource.\n", pdev->name); + ret = -ENOMEM; + goto fail3; + } + + /* Enable auto repeat feature of Linux input subsystem */ + if (pdata->rep) + __set_bit(EV_REP, key_dev->evbit); + + /* Setup input device */ + __set_bit(EV_KEY, key_dev->evbit); + + /* Setup the keymap */ + dm365_kp->pdata = pdata; + + for (i = 0; i < dm365_kp->pdata->keymapsize; i++) + __set_bit(dm365_kp->pdata->keymap[i], key_dev->keybit); + + key_dev->name = "dm365_keypad"; + key_dev->phys = "dm365_keypad/input0"; + key_dev->dev.parent = &pdev->dev; + key_dev->id.bustype = BUS_HOST; + key_dev->id.vendor = 0x0001; + key_dev->id.product = 0x0365; + key_dev->id.version = 0x0001; + key_dev->keycode = dm365_kp->pdata->keymap; + key_dev->keycodesize = sizeof(unsigned int); + key_dev->keycodemax = dm365_kp->pdata->keymapsize; + + ret = input_register_device(dm365_kp->input); + if (ret < 0) { + dev_err(dev, "%s: Unable to register DaVinci DM365 keypad device\n", + pdev->name); + goto fail4; + } + + ret = request_irq(dm365_kp->irq, dm365_kp_interrupt, IRQF_DISABLED, + "dm365_keypad", dm365_kp); + if (ret < 0) { + dev_err(dev, "%s: Unable to register DaVinci DM365 keypad Interrupt\n", + pdev->name); + goto fail5; + } + + dm365_kp_initialize(dm365_kp); + + return 0; +fail5: + input_unregister_device(dm365_kp->input); + key_dev = NULL; +fail4: + iounmap(dm365_kp->base); +fail3: + release_mem_region(dm365_kp->pbase, dm365_kp->base_size); +fail2: + input_free_device(key_dev); +fail1: + kfree(dm365_kp); + + return ret; +} + +static int __exit dm365_kp_remove(struct platform_device *pdev) +{ + struct davinci_kp *dm365_kp = platform_get_drvdata(pdev); + + free_irq(dm365_kp->irq, dm365_kp); + + iounmap(dm365_kp->base); + release_mem_region(dm365_kp->pbase, dm365_kp->base_size); + + platform_set_drvdata(pdev, NULL); + + input_unregister_device(dm365_kp->input); + + kfree(dm365_kp); + + return 0; +} + +static struct platform_driver dm365_kp_driver = { + .driver = { + .name = "dm365_keypad", + .owner = THIS_MODULE, + }, + .remove = __exit_p(dm365_kp_remove), +}; + +static int __init dm365_kp_init(void) +{ + + + return platform_driver_probe(&dm365_kp_driver, dm365_kp_probe); +} +module_init(dm365_kp_init); + +static void __exit dm365_kp_exit(void) +{ + platform_driver_unregister(&dm365_kp_driver); +} +module_exit(dm365_kp_exit); + +MODULE_AUTHOR("Miguel Aguilar"); +MODULE_DESCRIPTION("Texas Instruments DaVinci DM365 EVM Keypad Driver"); +MODULE_LICENSE("GPL"); -- 1.6.0.4 _______________________________________________ Davinci-linux-open-source mailing list [email protected] http://linux.davincidsp.com/mailman/listinfo/davinci-linux-open-source
