Pileus Git - ~andy/linux/blob - drivers/input/misc/pmic8xxx-pwrkey.c

   1 /* Copyright (c) 2010-2011, Code Aurora Forum. All rights reserved.
   2  *
   3  * This program is free software; you can redistribute it and/or modify
   4  * it under the terms of the GNU General Public License version 2 and
   5  * only version 2 as published by the Free Software Foundation.
   6  *
   7  * This program is distributed in the hope that it will be useful,
   8  * but WITHOUT ANY WARRANTY; without even the implied warranty of
   9  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  10  * GNU General Public License for more details.
  11  */
  12
  13 #include <linux/module.h>
  14 #include <linux/kernel.h>
  15 #include <linux/errno.h>
  16 #include <linux/slab.h>
  17 #include <linux/input.h>
  18 #include <linux/interrupt.h>
  19 #include <linux/platform_device.h>
  20 #include <linux/regmap.h>
  21 #include <linux/log2.h>
  22
  23 #include <linux/input/pmic8xxx-pwrkey.h>
  24
  25 #define PON_CNTL_1 0x1C
  26 #define PON_CNTL_PULL_UP BIT(7)
  27 #define PON_CNTL_TRIG_DELAY_MASK (0x7)
  28
  29 /**
  30  * struct pmic8xxx_pwrkey - pmic8xxx pwrkey information
  31  * @key_press_irq: key press irq number
  32  */
  33 struct pmic8xxx_pwrkey {
  34         int key_press_irq;
  35 };
  36
  37 static irqreturn_t pwrkey_press_irq(int irq, void *_pwr)
  38 {
  39         struct input_dev *pwr = _pwr;
  40
  41         input_report_key(pwr, KEY_POWER, 1);
  42         input_sync(pwr);
  43
  44         return IRQ_HANDLED;
  45 }
  46
  47 static irqreturn_t pwrkey_release_irq(int irq, void *_pwr)
  48 {
  49         struct input_dev *pwr = _pwr;
  50
  51         input_report_key(pwr, KEY_POWER, 0);
  52         input_sync(pwr);
  53
  54         return IRQ_HANDLED;
  55 }
  56
  57 #ifdef CONFIG_PM_SLEEP
  58 static int pmic8xxx_pwrkey_suspend(struct device *dev)
  59 {
  60         struct pmic8xxx_pwrkey *pwrkey = dev_get_drvdata(dev);
  61
  62         if (device_may_wakeup(dev))
  63                 enable_irq_wake(pwrkey->key_press_irq);
  64
  65         return 0;
  66 }
  67
  68 static int pmic8xxx_pwrkey_resume(struct device *dev)
  69 {
  70         struct pmic8xxx_pwrkey *pwrkey = dev_get_drvdata(dev);
  71
  72         if (device_may_wakeup(dev))
  73                 disable_irq_wake(pwrkey->key_press_irq);
  74
  75         return 0;
  76 }
  77 #endif
  78
  79 static SIMPLE_DEV_PM_OPS(pm8xxx_pwr_key_pm_ops,
  80                 pmic8xxx_pwrkey_suspend, pmic8xxx_pwrkey_resume);
  81
  82 static int pmic8xxx_pwrkey_probe(struct platform_device *pdev)
  83 {
  84         struct input_dev *pwr;
  85         int key_release_irq = platform_get_irq(pdev, 0);
  86         int key_press_irq = platform_get_irq(pdev, 1);
  87         int err;
  88         unsigned int delay;
  89         unsigned int pon_cntl;
  90         struct regmap *regmap;
  91         struct pmic8xxx_pwrkey *pwrkey;
  92         const struct pm8xxx_pwrkey_platform_data *pdata =
  93                                         dev_get_platdata(&pdev->dev);
  94
  95         if (!pdata) {
  96                 dev_err(&pdev->dev, "power key platform data not supplied\n");
  97                 return -EINVAL;
  98         }
  99
 100         if (pdata->kpd_trigger_delay_us > 62500) {
 101                 dev_err(&pdev->dev, "invalid power key trigger delay\n");
 102                 return -EINVAL;
 103         }
 104
 105         regmap = dev_get_regmap(pdev->dev.parent, NULL);
 106         if (!regmap) {
 107                 dev_err(&pdev->dev, "failed to locate regmap for the device\n");
 108                 return -ENODEV;
 109         }
 110
 111         pwrkey = devm_kzalloc(&pdev->dev, sizeof(*pwrkey), GFP_KERNEL);
 112         if (!pwrkey)
 113                 return -ENOMEM;
 114
 115         pwrkey->key_press_irq = key_press_irq;
 116
 117         pwr = devm_input_allocate_device(&pdev->dev);
 118         if (!pwr) {
 119                 dev_dbg(&pdev->dev, "Can't allocate power button\n");
 120                 return -ENOMEM;
 121         }
 122
 123         input_set_capability(pwr, EV_KEY, KEY_POWER);
 124
 125         pwr->name = "pmic8xxx_pwrkey";
 126         pwr->phys = "pmic8xxx_pwrkey/input0";
 127
 128         delay = (pdata->kpd_trigger_delay_us << 10) / USEC_PER_SEC;
 129         delay = 1 + ilog2(delay);
 130
 131         err = regmap_read(regmap, PON_CNTL_1, &pon_cntl);
 132         if (err < 0) {
 133                 dev_err(&pdev->dev, "failed reading PON_CNTL_1 err=%d\n", err);
 134                 return err;
 135         }
 136
 137         pon_cntl &= ~PON_CNTL_TRIG_DELAY_MASK;
 138         pon_cntl |= (delay & PON_CNTL_TRIG_DELAY_MASK);
 139         if (pdata->pull_up)
 140                 pon_cntl |= PON_CNTL_PULL_UP;
 141         else
 142                 pon_cntl &= ~PON_CNTL_PULL_UP;
 143
 144         err = regmap_write(regmap, PON_CNTL_1, pon_cntl);
 145         if (err < 0) {
 146                 dev_err(&pdev->dev, "failed writing PON_CNTL_1 err=%d\n", err);
 147                 return err;
 148         }
 149
 150         err = devm_request_irq(&pdev->dev, key_press_irq, pwrkey_press_irq,
 151                                IRQF_TRIGGER_RISING,
 152                                "pmic8xxx_pwrkey_press", pwr);
 153         if (err) {
 154                 dev_err(&pdev->dev, "Can't get %d IRQ for pwrkey: %d\n",
 155                         key_press_irq, err);
 156                 return err;
 157         }
 158
 159         err = devm_request_irq(&pdev->dev, key_release_irq, pwrkey_release_irq,
 160                                IRQF_TRIGGER_RISING,
 161                                "pmic8xxx_pwrkey_release", pwr);
 162         if (err) {
 163                 dev_err(&pdev->dev, "Can't get %d IRQ for pwrkey: %d\n",
 164                         key_release_irq, err);
 165                 return err;
 166         }
 167
 168         err = input_register_device(pwr);
 169         if (err) {
 170                 dev_err(&pdev->dev, "Can't register power key: %d\n", err);
 171                 return err;
 172         }
 173
 174         platform_set_drvdata(pdev, pwrkey);
 175         device_init_wakeup(&pdev->dev, pdata->wakeup);
 176
 177         return 0;
 178 }
 179
 180 static int pmic8xxx_pwrkey_remove(struct platform_device *pdev)
 181 {
 182         device_init_wakeup(&pdev->dev, 0);
 183
 184         return 0;
 185 }
 186
 187 static struct platform_driver pmic8xxx_pwrkey_driver = {
 188         .probe          = pmic8xxx_pwrkey_probe,
 189         .remove         = pmic8xxx_pwrkey_remove,
 190         .driver         = {
 191                 .name   = PM8XXX_PWRKEY_DEV_NAME,
 192                 .owner  = THIS_MODULE,
 193                 .pm     = &pm8xxx_pwr_key_pm_ops,
 194         },
 195 };
 196 module_platform_driver(pmic8xxx_pwrkey_driver);
 197
 198 MODULE_ALIAS("platform:pmic8xxx_pwrkey");
 199 MODULE_DESCRIPTION("PMIC8XXX Power Key driver");
 200 MODULE_LICENSE("GPL v2");
 201 MODULE_AUTHOR("Trilok Soni <tsoni@codeaurora.org>");