| /* |
| * DaVinci Key Scan Driver for TI platforms |
| * |
| * Copyright (C) 2009 Texas Instruments, Inc |
| * |
| * Author: Miguel Aguilar <miguel.aguilar@ridgerun.com> |
| * |
| * Initial Code: Sandeep Paulraj <s-paulraj@ti.com> |
| * |
| * 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 <linux/slab.h> |
| |
| #include <asm/irq.h> |
| |
| #include <mach/hardware.h> |
| #include <mach/irqs.h> |
| #include <mach/keyscan.h> |
| |
| /* Key scan registers */ |
| #define DAVINCI_KEYSCAN_KEYCTRL 0x0000 |
| #define DAVINCI_KEYSCAN_INTENA 0x0004 |
| #define DAVINCI_KEYSCAN_INTFLAG 0x0008 |
| #define DAVINCI_KEYSCAN_INTCLR 0x000c |
| #define DAVINCI_KEYSCAN_STRBWIDTH 0x0010 |
| #define DAVINCI_KEYSCAN_INTERVAL 0x0014 |
| #define DAVINCI_KEYSCAN_CONTTIME 0x0018 |
| #define DAVINCI_KEYSCAN_CURRENTST 0x001c |
| #define DAVINCI_KEYSCAN_PREVSTATE 0x0020 |
| #define DAVINCI_KEYSCAN_EMUCTRL 0x0024 |
| #define DAVINCI_KEYSCAN_IODFTCTRL 0x002c |
| |
| /* Key Control Register (KEYCTRL) */ |
| #define DAVINCI_KEYSCAN_KEYEN 0x00000001 |
| #define DAVINCI_KEYSCAN_PREVMODE 0x00000002 |
| #define DAVINCI_KEYSCAN_CHATOFF 0x00000004 |
| #define DAVINCI_KEYSCAN_AUTODET 0x00000008 |
| #define DAVINCI_KEYSCAN_SCANMODE 0x00000010 |
| #define DAVINCI_KEYSCAN_OUTTYPE 0x00000020 |
| |
| /* Masks for the interrupts */ |
| #define DAVINCI_KEYSCAN_INT_CONT 0x00000008 |
| #define DAVINCI_KEYSCAN_INT_OFF 0x00000004 |
| #define DAVINCI_KEYSCAN_INT_ON 0x00000002 |
| #define DAVINCI_KEYSCAN_INT_CHANGE 0x00000001 |
| #define DAVINCI_KEYSCAN_INT_ALL 0x0000000f |
| |
| struct davinci_ks { |
| struct input_dev *input; |
| struct davinci_ks_platform_data *pdata; |
| int irq; |
| void __iomem *base; |
| resource_size_t pbase; |
| size_t base_size; |
| unsigned short keymap[]; |
| }; |
| |
| /* Initializing the kp Module */ |
| static int __init davinci_ks_initialize(struct davinci_ks *davinci_ks) |
| { |
| struct device *dev = &davinci_ks->input->dev; |
| struct davinci_ks_platform_data *pdata = davinci_ks->pdata; |
| u32 matrix_ctrl; |
| |
| /* Enable all interrupts */ |
| __raw_writel(DAVINCI_KEYSCAN_INT_ALL, |
| davinci_ks->base + DAVINCI_KEYSCAN_INTENA); |
| |
| /* Clear interrupts if any */ |
| __raw_writel(DAVINCI_KEYSCAN_INT_ALL, |
| davinci_ks->base + DAVINCI_KEYSCAN_INTCLR); |
| |
| /* Setup the scan period = strobe + interval */ |
| __raw_writel(pdata->strobe, |
| davinci_ks->base + DAVINCI_KEYSCAN_STRBWIDTH); |
| __raw_writel(pdata->interval, |
| davinci_ks->base + DAVINCI_KEYSCAN_INTERVAL); |
| __raw_writel(0x01, |
| davinci_ks->base + DAVINCI_KEYSCAN_CONTTIME); |
| |
| /* Define matrix type */ |
| switch (pdata->matrix_type) { |
| case DAVINCI_KEYSCAN_MATRIX_4X4: |
| matrix_ctrl = 0; |
| break; |
| case DAVINCI_KEYSCAN_MATRIX_5X3: |
| matrix_ctrl = (1 << 6); |
| break; |
| default: |
| dev_err(dev->parent, "wrong matrix type\n"); |
| return -EINVAL; |
| } |
| |
| /* Enable key scan module and set matrix type */ |
| __raw_writel(DAVINCI_KEYSCAN_AUTODET | DAVINCI_KEYSCAN_KEYEN | |
| matrix_ctrl, davinci_ks->base + DAVINCI_KEYSCAN_KEYCTRL); |
| |
| return 0; |
| } |
| |
| static irqreturn_t davinci_ks_interrupt(int irq, void *dev_id) |
| { |
| struct davinci_ks *davinci_ks = dev_id; |
| struct device *dev = &davinci_ks->input->dev; |
| unsigned short *keymap = davinci_ks->keymap; |
| int keymapsize = davinci_ks->pdata->keymapsize; |
| u32 prev_status, new_status, changed; |
| bool release; |
| int keycode = KEY_UNKNOWN; |
| int i; |
| |
| /* Disable interrupt */ |
| __raw_writel(0x0, davinci_ks->base + DAVINCI_KEYSCAN_INTENA); |
| |
| /* Reading previous and new status of the key scan */ |
| prev_status = __raw_readl(davinci_ks->base + DAVINCI_KEYSCAN_PREVSTATE); |
| new_status = __raw_readl(davinci_ks->base + DAVINCI_KEYSCAN_CURRENTST); |
| |
| changed = prev_status ^ new_status; |
| |
| if (changed) { |
| /* |
| * It goes through all bits in 'changed' to ensure |
| * that no key changes are being missed |
| */ |
| for (i = 0 ; i < keymapsize; i++) { |
| if ((changed>>i) & 0x1) { |
| keycode = keymap[i]; |
| release = (new_status >> i) & 0x1; |
| dev_dbg(dev->parent, "key %d %s\n", keycode, |
| release ? "released" : "pressed"); |
| input_report_key(davinci_ks->input, keycode, |
| !release); |
| input_sync(davinci_ks->input); |
| } |
| } |
| /* Clearing interrupt */ |
| __raw_writel(DAVINCI_KEYSCAN_INT_ALL, |
| davinci_ks->base + DAVINCI_KEYSCAN_INTCLR); |
| } |
| |
| /* Enable interrupts */ |
| __raw_writel(0x1, davinci_ks->base + DAVINCI_KEYSCAN_INTENA); |
| |
| return IRQ_HANDLED; |
| } |
| |
| static int __init davinci_ks_probe(struct platform_device *pdev) |
| { |
| struct davinci_ks *davinci_ks; |
| struct input_dev *key_dev; |
| struct resource *res, *mem; |
| struct device *dev = &pdev->dev; |
| struct davinci_ks_platform_data *pdata = pdev->dev.platform_data; |
| int error, i; |
| |
| if (pdata->device_enable) { |
| error = pdata->device_enable(dev); |
| if (error < 0) { |
| dev_dbg(dev, "device enable function failed\n"); |
| return error; |
| } |
| } |
| |
| if (!pdata->keymap) { |
| dev_dbg(dev, "no keymap from pdata\n"); |
| return -EINVAL; |
| } |
| |
| davinci_ks = kzalloc(sizeof(struct davinci_ks) + |
| sizeof(unsigned short) * pdata->keymapsize, GFP_KERNEL); |
| if (!davinci_ks) { |
| dev_dbg(dev, "could not allocate memory for private data\n"); |
| return -ENOMEM; |
| } |
| |
| memcpy(davinci_ks->keymap, pdata->keymap, |
| sizeof(unsigned short) * pdata->keymapsize); |
| |
| key_dev = input_allocate_device(); |
| if (!key_dev) { |
| dev_dbg(dev, "could not allocate input device\n"); |
| error = -ENOMEM; |
| goto fail1; |
| } |
| |
| davinci_ks->input = key_dev; |
| |
| davinci_ks->irq = platform_get_irq(pdev, 0); |
| if (davinci_ks->irq < 0) { |
| dev_err(dev, "no key scan irq\n"); |
| error = davinci_ks->irq; |
| goto fail2; |
| } |
| |
| res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| if (!res) { |
| dev_err(dev, "no mem resource\n"); |
| error = -EINVAL; |
| goto fail2; |
| } |
| |
| davinci_ks->pbase = res->start; |
| davinci_ks->base_size = resource_size(res); |
| |
| mem = request_mem_region(davinci_ks->pbase, davinci_ks->base_size, |
| pdev->name); |
| if (!mem) { |
| dev_err(dev, "key scan registers at %08x are not free\n", |
| davinci_ks->pbase); |
| error = -EBUSY; |
| goto fail2; |
| } |
| |
| davinci_ks->base = ioremap(davinci_ks->pbase, davinci_ks->base_size); |
| if (!davinci_ks->base) { |
| dev_err(dev, "can't ioremap MEM resource.\n"); |
| error = -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 platform data */ |
| davinci_ks->pdata = pdata; |
| |
| for (i = 0; i < davinci_ks->pdata->keymapsize; i++) |
| __set_bit(davinci_ks->pdata->keymap[i], key_dev->keybit); |
| |
| key_dev->name = "davinci_keyscan"; |
| key_dev->phys = "davinci_keyscan/input0"; |
| key_dev->dev.parent = &pdev->dev; |
| key_dev->id.bustype = BUS_HOST; |
| key_dev->id.vendor = 0x0001; |
| key_dev->id.product = 0x0001; |
| key_dev->id.version = 0x0001; |
| key_dev->keycode = davinci_ks->keymap; |
| key_dev->keycodesize = sizeof(davinci_ks->keymap[0]); |
| key_dev->keycodemax = davinci_ks->pdata->keymapsize; |
| |
| error = input_register_device(davinci_ks->input); |
| if (error < 0) { |
| dev_err(dev, "unable to register davinci key scan device\n"); |
| goto fail4; |
| } |
| |
| error = request_irq(davinci_ks->irq, davinci_ks_interrupt, |
| IRQF_DISABLED, pdev->name, davinci_ks); |
| if (error < 0) { |
| dev_err(dev, "unable to register davinci key scan interrupt\n"); |
| goto fail5; |
| } |
| |
| error = davinci_ks_initialize(davinci_ks); |
| if (error < 0) { |
| dev_err(dev, "unable to initialize davinci key scan device\n"); |
| goto fail6; |
| } |
| |
| platform_set_drvdata(pdev, davinci_ks); |
| return 0; |
| |
| fail6: |
| free_irq(davinci_ks->irq, davinci_ks); |
| fail5: |
| input_unregister_device(davinci_ks->input); |
| key_dev = NULL; |
| fail4: |
| iounmap(davinci_ks->base); |
| fail3: |
| release_mem_region(davinci_ks->pbase, davinci_ks->base_size); |
| fail2: |
| input_free_device(key_dev); |
| fail1: |
| kfree(davinci_ks); |
| |
| return error; |
| } |
| |
| static int __devexit davinci_ks_remove(struct platform_device *pdev) |
| { |
| struct davinci_ks *davinci_ks = platform_get_drvdata(pdev); |
| |
| free_irq(davinci_ks->irq, davinci_ks); |
| |
| input_unregister_device(davinci_ks->input); |
| |
| iounmap(davinci_ks->base); |
| release_mem_region(davinci_ks->pbase, davinci_ks->base_size); |
| |
| platform_set_drvdata(pdev, NULL); |
| |
| kfree(davinci_ks); |
| |
| return 0; |
| } |
| |
| static struct platform_driver davinci_ks_driver = { |
| .driver = { |
| .name = "davinci_keyscan", |
| .owner = THIS_MODULE, |
| }, |
| .remove = __devexit_p(davinci_ks_remove), |
| }; |
| |
| static int __init davinci_ks_init(void) |
| { |
| return platform_driver_probe(&davinci_ks_driver, davinci_ks_probe); |
| } |
| module_init(davinci_ks_init); |
| |
| static void __exit davinci_ks_exit(void) |
| { |
| platform_driver_unregister(&davinci_ks_driver); |
| } |
| module_exit(davinci_ks_exit); |
| |
| MODULE_AUTHOR("Miguel Aguilar"); |
| MODULE_DESCRIPTION("Texas Instruments DaVinci Key Scan Driver"); |
| MODULE_LICENSE("GPL"); |