/* * Driver for the Cirrus EP93xx matrix keypad controller. * * Copyright (c) 2008 H Hartley Sweeten * * Based on the pxa27x matrix keypad controller by Rodolfo Giometti. * * 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. * * NOTE: * * The 3-key reset is triggered by pressing the 3 keys in * Row 0, Columns 2, 4, and 7 at the same time. This action can * be disabled by setting the EP93XX_KEYPAD_DISABLE_3_KEY flag. * * Normal operation for the matrix does not autorepeat the key press. * This action can be enabled by setting the EP93XX_KEYPAD_AUTOREPEAT * flag. */ #include #include #include #include #include #include #include #include #include /* * Keypad Interface Register offsets */ #define KEY_INIT 0x00 /* Key Scan Initialization register */ #define KEY_DIAG 0x04 /* Key Scan Diagnostic register */ #define KEY_REG 0x08 /* Key Value Capture register */ /* Key Scan Initialization Register bit defines */ #define KEY_INIT_DBNC_MASK (0x00ff0000) #define KEY_INIT_DBNC_SHIFT (16) #define KEY_INIT_DIS3KY (1<<15) #define KEY_INIT_DIAG (1<<14) #define KEY_INIT_BACK (1<<13) #define KEY_INIT_T2 (1<<12) #define KEY_INIT_PRSCL_MASK (0x000003ff) #define KEY_INIT_PRSCL_SHIFT (0) /* Key Scan Diagnostic Register bit defines */ #define KEY_DIAG_MASK (0x0000003f) #define KEY_DIAG_SHIFT (0) /* Key Value Capture Register bit defines */ #define KEY_REG_K (1<<15) #define KEY_REG_INT (1<<14) #define KEY_REG_2KEYS (1<<13) #define KEY_REG_1KEY (1<<12) #define KEY_REG_KEY2_MASK (0x00000fc0) #define KEY_REG_KEY2_SHIFT (6) #define KEY_REG_KEY1_MASK (0x0000003f) #define KEY_REG_KEY1_SHIFT (0) #define EP93XX_MATRIX_SIZE (EP93XX_MATRIX_ROWS * EP93XX_MATRIX_COLS) struct ep93xx_keypad { struct ep93xx_keypad_platform_data *pdata; struct input_dev *input_dev; struct clk *clk; void __iomem *mmio_base; unsigned short keycodes[EP93XX_MATRIX_SIZE]; int key1; int key2; int irq; bool enabled; }; static irqreturn_t ep93xx_keypad_irq_handler(int irq, void *dev_id) { struct ep93xx_keypad *keypad = dev_id; struct input_dev *input_dev = keypad->input_dev; unsigned int status; int keycode, key1, key2; status = __raw_readl(keypad->mmio_base + KEY_REG); keycode = (status & KEY_REG_KEY1_MASK) >> KEY_REG_KEY1_SHIFT; key1 = keypad->keycodes[keycode]; keycode = (status & KEY_REG_KEY2_MASK) >> KEY_REG_KEY2_SHIFT; key2 = keypad->keycodes[keycode]; if (status & KEY_REG_2KEYS) { if (keypad->key1 && key1 != keypad->key1 && key2 != keypad->key1) input_report_key(input_dev, keypad->key1, 0); if (keypad->key2 && key1 != keypad->key2 && key2 != keypad->key2) input_report_key(input_dev, keypad->key2, 0); input_report_key(input_dev, key1, 1); input_report_key(input_dev, key2, 1); keypad->key1 = key1; keypad->key2 = key2; } else if (status & KEY_REG_1KEY) { if (keypad->key1 && key1 != keypad->key1) input_report_key(input_dev, keypad->key1, 0); if (keypad->key2 && key1 != keypad->key2) input_report_key(input_dev, keypad->key2, 0); input_report_key(input_dev, key1, 1); keypad->key1 = key1; keypad->key2 = 0; } else { input_report_key(input_dev, keypad->key1, 0); input_report_key(input_dev, keypad->key2, 0); keypad->key1 = keypad->key2 = 0; } input_sync(input_dev); return IRQ_HANDLED; } static void ep93xx_keypad_config(struct ep93xx_keypad *keypad) { struct ep93xx_keypad_platform_data *pdata = keypad->pdata; unsigned int val = 0; if (pdata->flags & EP93XX_KEYPAD_KDIV) clk_set_rate(keypad->clk, EP93XX_KEYTCHCLK_DIV4); else clk_set_rate(keypad->clk, EP93XX_KEYTCHCLK_DIV16); if (pdata->flags & EP93XX_KEYPAD_DISABLE_3_KEY) val |= KEY_INIT_DIS3KY; if (pdata->flags & EP93XX_KEYPAD_DIAG_MODE) val |= KEY_INIT_DIAG; if (pdata->flags & EP93XX_KEYPAD_BACK_DRIVE) val |= KEY_INIT_BACK; if (pdata->flags & EP93XX_KEYPAD_TEST_MODE) val |= KEY_INIT_T2; val |= ((pdata->debounce << KEY_INIT_DBNC_SHIFT) & KEY_INIT_DBNC_MASK); val |= ((pdata->prescale << KEY_INIT_PRSCL_SHIFT) & KEY_INIT_PRSCL_MASK); __raw_writel(val, keypad->mmio_base + KEY_INIT); } static int ep93xx_keypad_open(struct input_dev *pdev) { struct ep93xx_keypad *keypad = input_get_drvdata(pdev); if (!keypad->enabled) { ep93xx_keypad_config(keypad); clk_enable(keypad->clk); keypad->enabled = true; } return 0; } static void ep93xx_keypad_close(struct input_dev *pdev) { struct ep93xx_keypad *keypad = input_get_drvdata(pdev); if (keypad->enabled) { clk_disable(keypad->clk); keypad->enabled = false; } } #ifdef CONFIG_PM /* * NOTE: I don't know if this is correct, or will work on the ep93xx. * * None of the existing ep93xx drivers have power management support. * But, this is basically what the pxa27x_keypad driver does. */ static int ep93xx_keypad_suspend(struct platform_device *pdev, pm_message_t state) { struct ep93xx_keypad *keypad = platform_get_drvdata(pdev); struct input_dev *input_dev = keypad->input_dev; mutex_lock(&input_dev->mutex); if (keypad->enabled) { clk_disable(keypad->clk); keypad->enabled = false; } mutex_unlock(&input_dev->mutex); if (device_may_wakeup(&pdev->dev)) enable_irq_wake(keypad->irq); return 0; } static int ep93xx_keypad_resume(struct platform_device *pdev) { struct ep93xx_keypad *keypad = platform_get_drvdata(pdev); struct input_dev *input_dev = keypad->input_dev; if (device_may_wakeup(&pdev->dev)) disable_irq_wake(keypad->irq); mutex_lock(&input_dev->mutex); if (input_dev->users) { if (!keypad->enabled) { ep93xx_keypad_config(keypad); clk_enable(keypad->clk); keypad->enabled = true; } } mutex_unlock(&input_dev->mutex); return 0; } #else /* !CONFIG_PM */ #define ep93xx_keypad_suspend NULL #define ep93xx_keypad_resume NULL #endif /* !CONFIG_PM */ static int __devinit ep93xx_keypad_probe(struct platform_device *pdev) { struct ep93xx_keypad *keypad; const struct matrix_keymap_data *keymap_data; struct input_dev *input_dev; struct resource *res; int err; keypad = kzalloc(sizeof(struct ep93xx_keypad), GFP_KERNEL); if (!keypad) return -ENOMEM; keypad->pdata = pdev->dev.platform_data; if (!keypad->pdata) { err = -EINVAL; goto failed_free; } keymap_data = keypad->pdata->keymap_data; if (!keymap_data) { err = -EINVAL; goto failed_free; } keypad->irq = platform_get_irq(pdev, 0); if (!keypad->irq) { err = -ENXIO; goto failed_free; } res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!res) { err = -ENXIO; goto failed_free; } res = request_mem_region(res->start, resource_size(res), pdev->name); if (!res) { err = -EBUSY; goto failed_free; } keypad->mmio_base = ioremap(res->start, resource_size(res)); if (keypad->mmio_base == NULL) { err = -ENXIO; goto failed_free_mem; } err = ep93xx_keypad_acquire_gpio(pdev); if (err) goto failed_free_io; keypad->clk = clk_get(&pdev->dev, NULL); if (IS_ERR(keypad->clk)) { err = PTR_ERR(keypad->clk); goto failed_free_gpio; } input_dev = input_allocate_device(); if (!input_dev) { err = -ENOMEM; goto failed_put_clk; } keypad->input_dev = input_dev; input_dev->name = pdev->name; input_dev->id.bustype = BUS_HOST; input_dev->open = ep93xx_keypad_open; input_dev->close = ep93xx_keypad_close; input_dev->dev.parent = &pdev->dev; input_dev->keycode = keypad->keycodes; input_dev->keycodesize = sizeof(keypad->keycodes[0]); input_dev->keycodemax = ARRAY_SIZE(keypad->keycodes); input_set_drvdata(input_dev, keypad); input_dev->evbit[0] = BIT_MASK(EV_KEY); if (keypad->pdata->flags & EP93XX_KEYPAD_AUTOREPEAT) input_dev->evbit[0] |= BIT_MASK(EV_REP); matrix_keypad_build_keymap(keymap_data, 3, input_dev->keycode, input_dev->keybit); platform_set_drvdata(pdev, keypad); err = request_irq(keypad->irq, ep93xx_keypad_irq_handler, 0, pdev->name, keypad); if (err) goto failed_free_dev; err = input_register_device(input_dev); if (err) goto failed_free_irq; device_init_wakeup(&pdev->dev, 1); return 0; failed_free_irq: free_irq(keypad->irq, pdev); platform_set_drvdata(pdev, NULL); failed_free_dev: input_free_device(input_dev); failed_put_clk: clk_put(keypad->clk); failed_free_gpio: ep93xx_keypad_release_gpio(pdev); failed_free_io: iounmap(keypad->mmio_base); failed_free_mem: release_mem_region(res->start, resource_size(res)); failed_free: kfree(keypad); return err; } static int __devexit ep93xx_keypad_remove(struct platform_device *pdev) { struct ep93xx_keypad *keypad = platform_get_drvdata(pdev); struct resource *res; free_irq(keypad->irq, pdev); platform_set_drvdata(pdev, NULL); if (keypad->enabled) clk_disable(keypad->clk); clk_put(keypad->clk); input_unregister_device(keypad->input_dev); ep93xx_keypad_release_gpio(pdev); iounmap(keypad->mmio_base); res = platform_get_resource(pdev, IORESOURCE_MEM, 0); release_mem_region(res->start, resource_size(res)); kfree(keypad); return 0; } static struct platform_driver ep93xx_keypad_driver = { .driver = { .name = "ep93xx-keypad", .owner = THIS_MODULE, }, .probe = ep93xx_keypad_probe, .remove = __devexit_p(ep93xx_keypad_remove), .suspend = ep93xx_keypad_suspend, .resume = ep93xx_keypad_resume, }; static int __init ep93xx_keypad_init(void) { return platform_driver_register(&ep93xx_keypad_driver); } static void __exit ep93xx_keypad_exit(void) { platform_driver_unregister(&ep93xx_keypad_driver); } module_init(ep93xx_keypad_init); module_exit(ep93xx_keypad_exit); MODULE_LICENSE("GPL"); MODULE_AUTHOR("H Hartley Sweeten "); MODULE_DESCRIPTION("EP93xx Matrix Keypad Controller"); MODULE_ALIAS("platform:ep93xx-keypad");