net/mlx5_en: Add missing check for memory allocation failure
[deliverable/linux.git] / 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>");
This page took 0.086632 seconds and 5 git commands to generate.