Pileus Git - ~andy/linux/blob - 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  */
  26 struct 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 */
  34 static 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
  48 static int __devinit 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 = ab8500_irq_get_virq(ab8500, irq_dbf);
  78         ponkey->irq_dbr = ab8500_irq_get_virq(ab8500, 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
 110 err_free_dbr_irq:
 111         free_irq(ponkey->irq_dbr, ponkey);
 112 err_free_dbf_irq:
 113         free_irq(ponkey->irq_dbf, ponkey);
 114 err_free_mem:
 115         input_free_device(input);
 116         kfree(ponkey);
 117
 118         return error;
 119 }
 120
 121 static int __devexit 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
 136 static const struct of_device_id ab8500_ponkey_match[] = {
 137         { .compatible = "stericsson,ab8500-ponkey", },
 138         {}
 139 };
 140 #endif
 141
 142 static 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         = __devexit_p(ab8500_ponkey_remove),
 150 };
 151 module_platform_driver(ab8500_ponkey_driver);
 152
 153 MODULE_LICENSE("GPL v2");
 154 MODULE_AUTHOR("Sundar Iyer <sundar.iyer@stericsson.com>");
 155 MODULE_DESCRIPTION("ST-Ericsson AB8500 Power-ON(Pon) Key driver");