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