LXR linux/drivers/input/misc/ab8500-ponkey.c

   1/*
   2 * Copyright (C) ST-Ericsson SA 2010
   3 *
   4 * License Terms: GNU General Public License v2
   5 * Author: Sundar Iyer <sundar.iyer@stericsson.com> for ST-Ericsson
   6 *
   7 * AB8500 Power-On Key handler
   8 */
   9
  10#include <linux/kernel.h>
  11#include <linux/module.h>
  12#include <linux/platform_device.h>
  13#include <linux/input.h>
  14#include <linux/interrupt.h>
  15#include <linux/mfd/abx500/ab8500.h>
  16#include <linux/of.h>
  17#include <linux/slab.h>
  18
  19/**
  20 * struct ab8500_ponkey - ab8500 ponkey information
  21 * @input_dev: pointer to input device
  22 * @ab8500: ab8500 parent
  23 * @irq_dbf: irq number for falling transition
  24 * @irq_dbr: irq number for rising transition
  25 */
  26struct ab8500_ponkey {
  27        struct input_dev        *idev;
  28        struct ab8500           *ab8500;
  29        int                     irq_dbf;
  30        int                     irq_dbr;
  31};
  32
  33/* AB8500 gives us an interrupt when ONKEY is held */
  34static irqreturn_t ab8500_ponkey_handler(int irq, void *data)
  35{
  36        struct ab8500_ponkey *ponkey = data;
  37
  38        if (irq == ponkey->irq_dbf)
  39                input_report_key(ponkey->idev, KEY_POWER, true);
  40        else if (irq == ponkey->irq_dbr)
  41                input_report_key(ponkey->idev, KEY_POWER, false);
  42
  43        input_sync(ponkey->idev);
  44
  45        return IRQ_HANDLED;
  46}
  47
  48static int ab8500_ponkey_probe(struct platform_device *pdev)
  49{
  50        struct ab8500 *ab8500 = dev_get_drvdata(pdev->dev.parent);
  51        struct ab8500_ponkey *ponkey;
  52        struct input_dev *input;
  53        int irq_dbf, irq_dbr;
  54        int error;
  55
  56        irq_dbf = platform_get_irq_byname(pdev, "ONKEY_DBF");
  57        if (irq_dbf < 0) {
  58                dev_err(&pdev->dev, "No IRQ for ONKEY_DBF, error=%d\n", irq_dbf);
  59                return irq_dbf;
  60        }
  61
  62        irq_dbr = platform_get_irq_byname(pdev, "ONKEY_DBR");
  63        if (irq_dbr < 0) {
  64                dev_err(&pdev->dev, "No IRQ for ONKEY_DBR, error=%d\n", irq_dbr);
  65                return irq_dbr;
  66        }
  67
  68        ponkey = kzalloc(sizeof(struct ab8500_ponkey), GFP_KERNEL);
  69        input = input_allocate_device();
  70        if (!ponkey || !input) {
  71                error = -ENOMEM;
  72                goto err_free_mem;
  73        }
  74
  75        ponkey->idev = input;
  76        ponkey->ab8500 = ab8500;
  77        ponkey->irq_dbf = irq_dbf;
  78        ponkey->irq_dbr = irq_dbr;
  79
  80        input->name = "AB8500 POn(PowerOn) Key";
  81        input->dev.parent = &pdev->dev;
  82
  83        input_set_capability(input, EV_KEY, KEY_POWER);
  84
  85        error = request_any_context_irq(ponkey->irq_dbf, ab8500_ponkey_handler,
  86                                        0, "ab8500-ponkey-dbf", ponkey);
  87        if (error < 0) {
  88                dev_err(ab8500->dev, "Failed to request dbf IRQ#%d: %d\n",
  89                        ponkey->irq_dbf, error);
  90                goto err_free_mem;
  91        }
  92
  93        error = request_any_context_irq(ponkey->irq_dbr, ab8500_ponkey_handler,
  94                                        0, "ab8500-ponkey-dbr", ponkey);
  95        if (error < 0) {
  96                dev_err(ab8500->dev, "Failed to request dbr IRQ#%d: %d\n",
  97                        ponkey->irq_dbr, error);
  98                goto err_free_dbf_irq;
  99        }
 100
 101        error = input_register_device(ponkey->idev);
 102        if (error) {
 103                dev_err(ab8500->dev, "Can't register input device: %d\n", error);
 104                goto err_free_dbr_irq;
 105        }
 106
 107        platform_set_drvdata(pdev, ponkey);
 108        return 0;
 109
 110err_free_dbr_irq:
 111        free_irq(ponkey->irq_dbr, ponkey);
 112err_free_dbf_irq:
 113        free_irq(ponkey->irq_dbf, ponkey);
 114err_free_mem:
 115        input_free_device(input);
 116        kfree(ponkey);
 117
 118        return error;
 119}
 120
 121static int ab8500_ponkey_remove(struct platform_device *pdev)
 122{
 123        struct ab8500_ponkey *ponkey = platform_get_drvdata(pdev);
 124
 125        free_irq(ponkey->irq_dbf, ponkey);
 126        free_irq(ponkey->irq_dbr, ponkey);
 127        input_unregister_device(ponkey->idev);
 128        kfree(ponkey);
 129
 130        platform_set_drvdata(pdev, NULL);
 131
 132        return 0;
 133}
 134
 135#ifdef CONFIG_OF
 136static const struct of_device_id ab8500_ponkey_match[] = {
 137        { .compatible = "stericsson,ab8500-ponkey", },
 138        {}
 139};
 140#endif
 141
 142static struct platform_driver ab8500_ponkey_driver = {
 143        .driver         = {
 144                .name   = "ab8500-poweron-key",
 145                .owner  = THIS_MODULE,
 146                .of_match_table = of_match_ptr(ab8500_ponkey_match),
 147        },
 148        .probe          = ab8500_ponkey_probe,
 149        .remove         = ab8500_ponkey_remove,
 150};
 151module_platform_driver(ab8500_ponkey_driver);
 152
 153MODULE_LICENSE("GPL v2");
 154MODULE_AUTHOR("Sundar Iyer <sundar.iyer@stericsson.com>");
 155MODULE_DESCRIPTION("ST-Ericsson AB8500 Power-ON(Pon) Key driver");
 156