This source file includes following definitions.
- axp20x_show_attr
- axp20x_show_attr_startup
- axp20x_show_attr_shutdown
- axp20x_store_attr
- axp20x_store_attr_startup
- axp20x_store_attr_shutdown
- axp20x_pek_irq
- axp20x_pek_probe_input_device
- axp20x_pek_should_register_input
- axp20x_pek_should_register_input
- axp20x_pek_probe
- axp20x_pek_resume_noirq
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16 #include <linux/acpi.h>
17 #include <linux/errno.h>
18 #include <linux/irq.h>
19 #include <linux/init.h>
20 #include <linux/input.h>
21 #include <linux/interrupt.h>
22 #include <linux/kernel.h>
23 #include <linux/mfd/axp20x.h>
24 #include <linux/module.h>
25 #include <linux/platform_device.h>
26 #include <linux/regmap.h>
27 #include <linux/slab.h>
28
29 #define AXP20X_PEK_STARTUP_MASK (0xc0)
30 #define AXP20X_PEK_SHUTDOWN_MASK (0x03)
31
32 struct axp20x_info {
33 const struct axp20x_time *startup_time;
34 unsigned int startup_mask;
35 const struct axp20x_time *shutdown_time;
36 unsigned int shutdown_mask;
37 };
38
39 struct axp20x_pek {
40 struct axp20x_dev *axp20x;
41 struct input_dev *input;
42 struct axp20x_info *info;
43 int irq_dbr;
44 int irq_dbf;
45 };
46
47 struct axp20x_time {
48 unsigned int time;
49 unsigned int idx;
50 };
51
52 static const struct axp20x_time startup_time[] = {
53 { .time = 128, .idx = 0 },
54 { .time = 1000, .idx = 2 },
55 { .time = 3000, .idx = 1 },
56 { .time = 2000, .idx = 3 },
57 };
58
59 static const struct axp20x_time axp221_startup_time[] = {
60 { .time = 128, .idx = 0 },
61 { .time = 1000, .idx = 1 },
62 { .time = 2000, .idx = 2 },
63 { .time = 3000, .idx = 3 },
64 };
65
66 static const struct axp20x_time shutdown_time[] = {
67 { .time = 4000, .idx = 0 },
68 { .time = 6000, .idx = 1 },
69 { .time = 8000, .idx = 2 },
70 { .time = 10000, .idx = 3 },
71 };
72
73 static const struct axp20x_info axp20x_info = {
74 .startup_time = startup_time,
75 .startup_mask = AXP20X_PEK_STARTUP_MASK,
76 .shutdown_time = shutdown_time,
77 .shutdown_mask = AXP20X_PEK_SHUTDOWN_MASK,
78 };
79
80 static const struct axp20x_info axp221_info = {
81 .startup_time = axp221_startup_time,
82 .startup_mask = AXP20X_PEK_STARTUP_MASK,
83 .shutdown_time = shutdown_time,
84 .shutdown_mask = AXP20X_PEK_SHUTDOWN_MASK,
85 };
86
87 static ssize_t axp20x_show_attr(struct device *dev,
88 const struct axp20x_time *time,
89 unsigned int mask, char *buf)
90 {
91 struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
92 unsigned int val;
93 int ret, i;
94
95 ret = regmap_read(axp20x_pek->axp20x->regmap, AXP20X_PEK_KEY, &val);
96 if (ret != 0)
97 return ret;
98
99 val &= mask;
100 val >>= ffs(mask) - 1;
101
102 for (i = 0; i < 4; i++)
103 if (val == time[i].idx)
104 val = time[i].time;
105
106 return sprintf(buf, "%u\n", val);
107 }
108
109 static ssize_t axp20x_show_attr_startup(struct device *dev,
110 struct device_attribute *attr,
111 char *buf)
112 {
113 struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
114
115 return axp20x_show_attr(dev, axp20x_pek->info->startup_time,
116 axp20x_pek->info->startup_mask, buf);
117 }
118
119 static ssize_t axp20x_show_attr_shutdown(struct device *dev,
120 struct device_attribute *attr,
121 char *buf)
122 {
123 struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
124
125 return axp20x_show_attr(dev, axp20x_pek->info->shutdown_time,
126 axp20x_pek->info->shutdown_mask, buf);
127 }
128
129 static ssize_t axp20x_store_attr(struct device *dev,
130 const struct axp20x_time *time,
131 unsigned int mask, const char *buf,
132 size_t count)
133 {
134 struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
135 char val_str[20];
136 size_t len;
137 int ret, i;
138 unsigned int val, idx = 0;
139 unsigned int best_err = UINT_MAX;
140
141 val_str[sizeof(val_str) - 1] = '\0';
142 strncpy(val_str, buf, sizeof(val_str) - 1);
143 len = strlen(val_str);
144
145 if (len && val_str[len - 1] == '\n')
146 val_str[len - 1] = '\0';
147
148 ret = kstrtouint(val_str, 10, &val);
149 if (ret)
150 return ret;
151
152 for (i = 3; i >= 0; i--) {
153 unsigned int err;
154
155 err = abs(time[i].time - val);
156 if (err < best_err) {
157 best_err = err;
158 idx = time[i].idx;
159 }
160
161 if (!err)
162 break;
163 }
164
165 idx <<= ffs(mask) - 1;
166 ret = regmap_update_bits(axp20x_pek->axp20x->regmap, AXP20X_PEK_KEY,
167 mask, idx);
168 if (ret != 0)
169 return -EINVAL;
170
171 return count;
172 }
173
174 static ssize_t axp20x_store_attr_startup(struct device *dev,
175 struct device_attribute *attr,
176 const char *buf, size_t count)
177 {
178 struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
179
180 return axp20x_store_attr(dev, axp20x_pek->info->startup_time,
181 axp20x_pek->info->startup_mask, buf, count);
182 }
183
184 static ssize_t axp20x_store_attr_shutdown(struct device *dev,
185 struct device_attribute *attr,
186 const char *buf, size_t count)
187 {
188 struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
189
190 return axp20x_store_attr(dev, axp20x_pek->info->shutdown_time,
191 axp20x_pek->info->shutdown_mask, buf, count);
192 }
193
194 DEVICE_ATTR(startup, 0644, axp20x_show_attr_startup, axp20x_store_attr_startup);
195 DEVICE_ATTR(shutdown, 0644, axp20x_show_attr_shutdown,
196 axp20x_store_attr_shutdown);
197
198 static struct attribute *axp20x_attrs[] = {
199 &dev_attr_startup.attr,
200 &dev_attr_shutdown.attr,
201 NULL,
202 };
203 ATTRIBUTE_GROUPS(axp20x);
204
205 static irqreturn_t axp20x_pek_irq(int irq, void *pwr)
206 {
207 struct input_dev *idev = pwr;
208 struct axp20x_pek *axp20x_pek = input_get_drvdata(idev);
209
210
211
212
213
214 if (irq == axp20x_pek->irq_dbf)
215 input_report_key(idev, KEY_POWER, true);
216 else if (irq == axp20x_pek->irq_dbr)
217 input_report_key(idev, KEY_POWER, false);
218
219 input_sync(idev);
220
221 return IRQ_HANDLED;
222 }
223
224 static int axp20x_pek_probe_input_device(struct axp20x_pek *axp20x_pek,
225 struct platform_device *pdev)
226 {
227 struct axp20x_dev *axp20x = axp20x_pek->axp20x;
228 struct input_dev *idev;
229 int error;
230
231 axp20x_pek->irq_dbr = platform_get_irq_byname(pdev, "PEK_DBR");
232 if (axp20x_pek->irq_dbr < 0)
233 return axp20x_pek->irq_dbr;
234 axp20x_pek->irq_dbr = regmap_irq_get_virq(axp20x->regmap_irqc,
235 axp20x_pek->irq_dbr);
236
237 axp20x_pek->irq_dbf = platform_get_irq_byname(pdev, "PEK_DBF");
238 if (axp20x_pek->irq_dbf < 0)
239 return axp20x_pek->irq_dbf;
240 axp20x_pek->irq_dbf = regmap_irq_get_virq(axp20x->regmap_irqc,
241 axp20x_pek->irq_dbf);
242
243 axp20x_pek->input = devm_input_allocate_device(&pdev->dev);
244 if (!axp20x_pek->input)
245 return -ENOMEM;
246
247 idev = axp20x_pek->input;
248
249 idev->name = "axp20x-pek";
250 idev->phys = "m1kbd/input2";
251 idev->dev.parent = &pdev->dev;
252
253 input_set_capability(idev, EV_KEY, KEY_POWER);
254
255 input_set_drvdata(idev, axp20x_pek);
256
257 error = devm_request_any_context_irq(&pdev->dev, axp20x_pek->irq_dbr,
258 axp20x_pek_irq, 0,
259 "axp20x-pek-dbr", idev);
260 if (error < 0) {
261 dev_err(&pdev->dev, "Failed to request dbr IRQ#%d: %d\n",
262 axp20x_pek->irq_dbr, error);
263 return error;
264 }
265
266 error = devm_request_any_context_irq(&pdev->dev, axp20x_pek->irq_dbf,
267 axp20x_pek_irq, 0,
268 "axp20x-pek-dbf", idev);
269 if (error < 0) {
270 dev_err(&pdev->dev, "Failed to request dbf IRQ#%d: %d\n",
271 axp20x_pek->irq_dbf, error);
272 return error;
273 }
274
275 error = input_register_device(idev);
276 if (error) {
277 dev_err(&pdev->dev, "Can't register input device: %d\n",
278 error);
279 return error;
280 }
281
282 if (axp20x_pek->axp20x->variant == AXP288_ID)
283 enable_irq_wake(axp20x_pek->irq_dbr);
284
285 return 0;
286 }
287
288 #ifdef CONFIG_ACPI
289 static bool axp20x_pek_should_register_input(struct axp20x_pek *axp20x_pek,
290 struct platform_device *pdev)
291 {
292 unsigned long long hrv = 0;
293 acpi_status status;
294
295 if (IS_ENABLED(CONFIG_INPUT_SOC_BUTTON_ARRAY) &&
296 axp20x_pek->axp20x->variant == AXP288_ID) {
297 status = acpi_evaluate_integer(ACPI_HANDLE(pdev->dev.parent),
298 "_HRV", NULL, &hrv);
299 if (ACPI_FAILURE(status))
300 dev_err(&pdev->dev, "Failed to get PMIC hardware revision\n");
301
302
303
304
305
306
307
308 if (hrv == 3 && (acpi_dev_present("INTCFD9", NULL, -1) ||
309 acpi_dev_present("ACPI0011", NULL, -1)))
310 return false;
311
312 }
313
314 return true;
315 }
316 #else
317 static bool axp20x_pek_should_register_input(struct axp20x_pek *axp20x_pek,
318 struct platform_device *pdev)
319 {
320 return true;
321 }
322 #endif
323
324 static int axp20x_pek_probe(struct platform_device *pdev)
325 {
326 struct axp20x_pek *axp20x_pek;
327 const struct platform_device_id *match = platform_get_device_id(pdev);
328 int error;
329
330 if (!match) {
331 dev_err(&pdev->dev, "Failed to get platform_device_id\n");
332 return -EINVAL;
333 }
334
335 axp20x_pek = devm_kzalloc(&pdev->dev, sizeof(struct axp20x_pek),
336 GFP_KERNEL);
337 if (!axp20x_pek)
338 return -ENOMEM;
339
340 axp20x_pek->axp20x = dev_get_drvdata(pdev->dev.parent);
341
342 if (axp20x_pek_should_register_input(axp20x_pek, pdev)) {
343 error = axp20x_pek_probe_input_device(axp20x_pek, pdev);
344 if (error)
345 return error;
346 }
347
348 axp20x_pek->info = (struct axp20x_info *)match->driver_data;
349
350 platform_set_drvdata(pdev, axp20x_pek);
351
352 return 0;
353 }
354
355 static int __maybe_unused axp20x_pek_resume_noirq(struct device *dev)
356 {
357 struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
358
359 if (axp20x_pek->axp20x->variant != AXP288_ID)
360 return 0;
361
362
363
364
365
366 regmap_write(axp20x_pek->axp20x->regmap,
367 AXP20X_IRQ1_STATE + AXP288_IRQ_POKN / 8,
368 BIT(AXP288_IRQ_POKN % 8));
369
370 return 0;
371 }
372
373 static const struct dev_pm_ops axp20x_pek_pm_ops = {
374 #ifdef CONFIG_PM_SLEEP
375 .resume_noirq = axp20x_pek_resume_noirq,
376 #endif
377 };
378
379 static const struct platform_device_id axp_pek_id_match[] = {
380 {
381 .name = "axp20x-pek",
382 .driver_data = (kernel_ulong_t)&axp20x_info,
383 },
384 {
385 .name = "axp221-pek",
386 .driver_data = (kernel_ulong_t)&axp221_info,
387 },
388 { }
389 };
390 MODULE_DEVICE_TABLE(platform, axp_pek_id_match);
391
392 static struct platform_driver axp20x_pek_driver = {
393 .probe = axp20x_pek_probe,
394 .id_table = axp_pek_id_match,
395 .driver = {
396 .name = "axp20x-pek",
397 .pm = &axp20x_pek_pm_ops,
398 .dev_groups = axp20x_groups,
399 },
400 };
401 module_platform_driver(axp20x_pek_driver);
402
403 MODULE_DESCRIPTION("axp20x Power Button");
404 MODULE_AUTHOR("Carlo Caione <carlo@caione.org>");
405 MODULE_LICENSE("GPL");