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 #include <linux/of.h>
  23
  24 #define PON_CNTL_1 0x1C
  25 #define PON_CNTL_PULL_UP BIT(7)
  26 #define PON_CNTL_TRIG_DELAY_MASK (0x7)
  27
  28 /**
  29  * struct pmic8xxx_pwrkey - pmic8xxx pwrkey information
  30  * @key_press_irq: key press irq number
  31  */
  32 struct pmic8xxx_pwrkey {
  33         int key_press_irq;
  34 };
  35
  36 static irqreturn_t pwrkey_press_irq(int irq, void *_pwr)
  37 {
  38         struct input_dev *pwr = _pwr;
  39
  40         input_report_key(pwr, KEY_POWER, 1);
  41         input_sync(pwr);
  42
  43         return IRQ_HANDLED;
  44 }
  45
  46 static irqreturn_t pwrkey_release_irq(int irq, void *_pwr)
  47 {
  48         struct input_dev *pwr = _pwr;
  49
  50         input_report_key(pwr, KEY_POWER, 0);
  51         input_sync(pwr);
  52
  53         return IRQ_HANDLED;
  54 }
  55
  56 static int __maybe_unused pmic8xxx_pwrkey_suspend(struct device *dev)
  57 {
  58         struct pmic8xxx_pwrkey *pwrkey = dev_get_drvdata(dev);
  59
  60         if (device_may_wakeup(dev))
  61                 enable_irq_wake(pwrkey->key_press_irq);
  62
  63         return 0;
  64 }
  65
  66 static int __maybe_unused pmic8xxx_pwrkey_resume(struct device *dev)
  67 {
  68         struct pmic8xxx_pwrkey *pwrkey = dev_get_drvdata(dev);
  69
  70         if (device_may_wakeup(dev))
  71                 disable_irq_wake(pwrkey->key_press_irq);
  72
  73         return 0;
  74 }
  75
  76 static SIMPLE_DEV_PM_OPS(pm8xxx_pwr_key_pm_ops,
  77                 pmic8xxx_pwrkey_suspend, pmic8xxx_pwrkey_resume);
  78
  79 static int pmic8xxx_pwrkey_probe(struct platform_device *pdev)
  80 {
  81         struct input_dev *pwr;
  82         int key_release_irq = platform_get_irq(pdev, 0);
  83         int key_press_irq = platform_get_irq(pdev, 1);
  84         int err;
  85         unsigned int delay;
  86         unsigned int pon_cntl;
  87         struct regmap *regmap;
  88         struct pmic8xxx_pwrkey *pwrkey;
  89         u32 kpd_delay;
  90         bool pull_up;
  91
  92         if (of_property_read_u32(pdev->dev.of_node, "debounce", &kpd_delay))
  93                 kpd_delay = 15625;
  94
  95         if (kpd_delay > 62500 || kpd_delay == 0) {
  96                 dev_err(&pdev->dev, "invalid power key trigger delay\n");
  97                 return -EINVAL;
  98         }
  99
 100         pull_up = of_property_read_bool(pdev->dev.of_node, "pull-up");
 101
 102         regmap = dev_get_regmap(pdev->dev.parent, NULL);
 103         if (!regmap) {
 104                 dev_err(&pdev->dev, "failed to locate regmap for the device\n");
 105                 return -ENODEV;
 106         }
 107
 108         pwrkey = devm_kzalloc(&pdev->dev, sizeof(*pwrkey), GFP_KERNEL);
 109         if (!pwrkey)
 110                 return -ENOMEM;
 111
 112         pwrkey->key_press_irq = key_press_irq;
 113
 114         pwr = devm_input_allocate_device(&pdev->dev);
 115         if (!pwr) {
 116                 dev_dbg(&pdev->dev, "Can't allocate power button\n");
 117                 return -ENOMEM;
 118         }
 119
 120         input_set_capability(pwr, EV_KEY, KEY_POWER);
 121
 122         pwr->name = "pmic8xxx_pwrkey";
 123         pwr->phys = "pmic8xxx_pwrkey/input0";
 124
 125         delay = (kpd_delay << 10) / USEC_PER_SEC;
 126         delay = 1 + ilog2(delay);
 127
 128         err = regmap_read(regmap, PON_CNTL_1, &pon_cntl);
 129         if (err < 0) {
 130                 dev_err(&pdev->dev, "failed reading PON_CNTL_1 err=%d\n", err);
 131                 return err;
 132         }
 133
 134         pon_cntl &= ~PON_CNTL_TRIG_DELAY_MASK;
 135         pon_cntl |= (delay & PON_CNTL_TRIG_DELAY_MASK);
 136         if (pull_up)
 137                 pon_cntl |= PON_CNTL_PULL_UP;
 138         else
 139                 pon_cntl &= ~PON_CNTL_PULL_UP;
 140
 141         err = regmap_write(regmap, PON_CNTL_1, pon_cntl);
 142         if (err < 0) {
 143                 dev_err(&pdev->dev, "failed writing PON_CNTL_1 err=%d\n", err);
 144                 return err;
 145         }
 146
 147         err = devm_request_irq(&pdev->dev, key_press_irq, pwrkey_press_irq,
 148                                IRQF_TRIGGER_RISING,
 149                                "pmic8xxx_pwrkey_press", pwr);
 150         if (err) {
 151                 dev_err(&pdev->dev, "Can't get %d IRQ for pwrkey: %d\n",
 152                         key_press_irq, err);
 153                 return err;
 154         }
 155
 156         err = devm_request_irq(&pdev->dev, key_release_irq, pwrkey_release_irq,
 157                                IRQF_TRIGGER_RISING,
 158                                "pmic8xxx_pwrkey_release", pwr);
 159         if (err) {
 160                 dev_err(&pdev->dev, "Can't get %d IRQ for pwrkey: %d\n",
 161                         key_release_irq, err);
 162                 return err;
 163         }
 164
 165         err = input_register_device(pwr);
 166         if (err) {
 167                 dev_err(&pdev->dev, "Can't register power key: %d\n", err);
 168                 return err;
 169         }
 170
 171         platform_set_drvdata(pdev, pwrkey);
 172         device_init_wakeup(&pdev->dev, 1);
 173
 174         return 0;
 175 }
 176
 177 static int pmic8xxx_pwrkey_remove(struct platform_device *pdev)
 178 {
 179         device_init_wakeup(&pdev->dev, 0);
 180
 181         return 0;
 182 }
 183
 184 static const struct of_device_id pm8xxx_pwr_key_id_table[] = {
 185         { .compatible = "qcom,pm8058-pwrkey" },
 186         { .compatible = "qcom,pm8921-pwrkey" },
 187         { }
 188 };
 189 MODULE_DEVICE_TABLE(of, pm8xxx_pwr_key_id_table);
 190
 191 static struct platform_driver pmic8xxx_pwrkey_driver = {
 192         .probe          = pmic8xxx_pwrkey_probe,
 193         .remove         = pmic8xxx_pwrkey_remove,
 194         .driver         = {
 195                 .name   = "pm8xxx-pwrkey",
 196                 .pm     = &pm8xxx_pwr_key_pm_ops,
 197                 .of_match_table = pm8xxx_pwr_key_id_table,
 198         },
 199 };
 200 module_platform_driver(pmic8xxx_pwrkey_driver);
 201
 202 MODULE_ALIAS("platform:pmic8xxx_pwrkey");
 203 MODULE_DESCRIPTION("PMIC8XXX Power Key driver");
 204 MODULE_LICENSE("GPL v2");
 205 MODULE_AUTHOR("Trilok Soni <tsoni@codeaurora.org>");