1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/module.h>
14#include <linux/input.h>
15#include <linux/init.h>
16#include <linux/kernel.h>
17#include <linux/acpi.h>
18#include <linux/gpio/consumer.h>
19#include <linux/gpio_keys.h>
20#include <linux/gpio.h>
21#include <linux/platform_device.h>
22
23struct soc_button_info {
24 const char *name;
25 int acpi_index;
26 unsigned int event_type;
27 unsigned int event_code;
28 bool autorepeat;
29 bool wakeup;
30};
31
32
33
34
35
36
37#define BUTTON_TYPES 2
38
39struct soc_button_data {
40 struct platform_device *children[BUTTON_TYPES];
41};
42
43
44
45
46static int soc_button_lookup_gpio(struct device *dev, int acpi_index)
47{
48 struct gpio_desc *desc;
49 int gpio;
50
51 desc = gpiod_get_index(dev, NULL, acpi_index, GPIOD_ASIS);
52 if (IS_ERR(desc))
53 return PTR_ERR(desc);
54
55 gpio = desc_to_gpio(desc);
56
57 gpiod_put(desc);
58
59 return gpio;
60}
61
62static struct platform_device *
63soc_button_device_create(struct platform_device *pdev,
64 const struct soc_button_info *button_info,
65 bool autorepeat)
66{
67 const struct soc_button_info *info;
68 struct platform_device *pd;
69 struct gpio_keys_button *gpio_keys;
70 struct gpio_keys_platform_data *gpio_keys_pdata;
71 int n_buttons = 0;
72 int gpio;
73 int error;
74
75 for (info = button_info; info->name; info++)
76 if (info->autorepeat == autorepeat)
77 n_buttons++;
78
79 gpio_keys_pdata = devm_kzalloc(&pdev->dev,
80 sizeof(*gpio_keys_pdata) +
81 sizeof(*gpio_keys) * n_buttons,
82 GFP_KERNEL);
83 if (!gpio_keys_pdata)
84 return ERR_PTR(-ENOMEM);
85
86 gpio_keys = (void *)(gpio_keys_pdata + 1);
87 n_buttons = 0;
88
89 for (info = button_info; info->name; info++) {
90 if (info->autorepeat != autorepeat)
91 continue;
92
93 gpio = soc_button_lookup_gpio(&pdev->dev, info->acpi_index);
94 if (!gpio_is_valid(gpio))
95 continue;
96
97 gpio_keys[n_buttons].type = info->event_type;
98 gpio_keys[n_buttons].code = info->event_code;
99 gpio_keys[n_buttons].gpio = gpio;
100 gpio_keys[n_buttons].active_low = 1;
101 gpio_keys[n_buttons].desc = info->name;
102 gpio_keys[n_buttons].wakeup = info->wakeup;
103
104 gpio_keys[n_buttons].debounce_interval = 50;
105 n_buttons++;
106 }
107
108 if (n_buttons == 0) {
109 error = -ENODEV;
110 goto err_free_mem;
111 }
112
113 gpio_keys_pdata->buttons = gpio_keys;
114 gpio_keys_pdata->nbuttons = n_buttons;
115 gpio_keys_pdata->rep = autorepeat;
116
117 pd = platform_device_alloc("gpio-keys", PLATFORM_DEVID_AUTO);
118 if (!pd) {
119 error = -ENOMEM;
120 goto err_free_mem;
121 }
122
123 error = platform_device_add_data(pd, gpio_keys_pdata,
124 sizeof(*gpio_keys_pdata));
125 if (error)
126 goto err_free_pdev;
127
128 error = platform_device_add(pd);
129 if (error)
130 goto err_free_pdev;
131
132 return pd;
133
134err_free_pdev:
135 platform_device_put(pd);
136err_free_mem:
137 devm_kfree(&pdev->dev, gpio_keys_pdata);
138 return ERR_PTR(error);
139}
140
141static int soc_button_get_acpi_object_int(const union acpi_object *obj)
142{
143 if (obj->type != ACPI_TYPE_INTEGER)
144 return -1;
145
146 return obj->integer.value;
147}
148
149
150static int soc_button_parse_btn_desc(struct device *dev,
151 const union acpi_object *desc,
152 int collection_uid,
153 struct soc_button_info *info)
154{
155 int upage, usage;
156
157 if (desc->type != ACPI_TYPE_PACKAGE ||
158 desc->package.count != 5 ||
159
160 soc_button_get_acpi_object_int(&desc->package.elements[0]) != 1 ||
161
162 soc_button_get_acpi_object_int(&desc->package.elements[2]) !=
163 collection_uid) {
164 dev_err(dev, "Invalid ACPI Button Descriptor\n");
165 return -ENODEV;
166 }
167
168 info->event_type = EV_KEY;
169 info->acpi_index =
170 soc_button_get_acpi_object_int(&desc->package.elements[1]);
171 upage = soc_button_get_acpi_object_int(&desc->package.elements[3]);
172 usage = soc_button_get_acpi_object_int(&desc->package.elements[4]);
173
174
175
176
177
178
179
180
181
182
183
184 if (upage == 0x01 && usage == 0x81) {
185 info->name = "power";
186 info->event_code = KEY_POWER;
187 info->wakeup = true;
188 } else if (upage == 0x07 && usage == 0xe3) {
189 info->name = "home";
190 info->event_code = KEY_LEFTMETA;
191 info->wakeup = true;
192 } else if (upage == 0x0c && usage == 0xe9) {
193 info->name = "volume_up";
194 info->event_code = KEY_VOLUMEUP;
195 info->autorepeat = true;
196 } else if (upage == 0x0c && usage == 0xea) {
197 info->name = "volume_down";
198 info->event_code = KEY_VOLUMEDOWN;
199 info->autorepeat = true;
200 } else {
201 dev_warn(dev, "Unknown button index %d upage %02x usage %02x, ignoring\n",
202 info->acpi_index, upage, usage);
203 info->name = "unknown";
204 info->event_code = KEY_RESERVED;
205 }
206
207 return 0;
208}
209
210
211static const u8 btns_desc_uuid[16] = {
212 0x25, 0xd6, 0x6b, 0xfa, 0xe8, 0x9c, 0x0d, 0x47,
213 0xa2, 0xc7, 0xb3, 0xca, 0x36, 0xc4, 0x28, 0x2e
214};
215
216
217static struct soc_button_info *soc_button_get_button_info(struct device *dev)
218{
219 struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER };
220 const union acpi_object *desc, *el0, *uuid, *btns_desc = NULL;
221 struct soc_button_info *button_info;
222 acpi_status status;
223 int i, btn, collection_uid = -1;
224
225 status = acpi_evaluate_object_typed(ACPI_HANDLE(dev), "_DSD", NULL,
226 &buf, ACPI_TYPE_PACKAGE);
227 if (ACPI_FAILURE(status)) {
228 dev_err(dev, "ACPI _DSD object not found\n");
229 return ERR_PTR(-ENODEV);
230 }
231
232
233 desc = buf.pointer;
234 for (i = 0; (i + 1) < desc->package.count; i += 2) {
235 uuid = &desc->package.elements[i];
236
237 if (uuid->type != ACPI_TYPE_BUFFER ||
238 uuid->buffer.length != 16 ||
239 desc->package.elements[i + 1].type != ACPI_TYPE_PACKAGE) {
240 break;
241 }
242
243 if (memcmp(uuid->buffer.pointer, btns_desc_uuid, 16) == 0) {
244 btns_desc = &desc->package.elements[i + 1];
245 break;
246 }
247 }
248
249 if (!btns_desc) {
250 dev_err(dev, "ACPI Button Descriptors not found\n");
251 button_info = ERR_PTR(-ENODEV);
252 goto out;
253 }
254
255
256 el0 = &btns_desc->package.elements[0];
257 if (el0->type == ACPI_TYPE_PACKAGE &&
258 el0->package.count == 5 &&
259
260 soc_button_get_acpi_object_int(&el0->package.elements[0]) == 0 &&
261
262 soc_button_get_acpi_object_int(&el0->package.elements[2]) == 0) {
263 collection_uid = soc_button_get_acpi_object_int(
264 &el0->package.elements[1]);
265 }
266 if (collection_uid == -1) {
267 dev_err(dev, "Invalid Button Collection Descriptor\n");
268 button_info = ERR_PTR(-ENODEV);
269 goto out;
270 }
271
272
273 button_info = devm_kcalloc(dev, btns_desc->package.count,
274 sizeof(*button_info), GFP_KERNEL);
275 if (!button_info) {
276 button_info = ERR_PTR(-ENOMEM);
277 goto out;
278 }
279
280
281 for (i = 1, btn = 0; i < btns_desc->package.count; i++, btn++) {
282 if (soc_button_parse_btn_desc(dev,
283 &btns_desc->package.elements[i],
284 collection_uid,
285 &button_info[btn])) {
286 button_info = ERR_PTR(-ENODEV);
287 goto out;
288 }
289 }
290
291out:
292 kfree(buf.pointer);
293 return button_info;
294}
295
296static int soc_button_remove(struct platform_device *pdev)
297{
298 struct soc_button_data *priv = platform_get_drvdata(pdev);
299
300 int i;
301
302 for (i = 0; i < BUTTON_TYPES; i++)
303 if (priv->children[i])
304 platform_device_unregister(priv->children[i]);
305
306 return 0;
307}
308
309static int soc_button_probe(struct platform_device *pdev)
310{
311 struct device *dev = &pdev->dev;
312 const struct acpi_device_id *id;
313 struct soc_button_info *button_info;
314 struct soc_button_data *priv;
315 struct platform_device *pd;
316 int i;
317 int error;
318
319 id = acpi_match_device(dev->driver->acpi_match_table, dev);
320 if (!id)
321 return -ENODEV;
322
323 if (!id->driver_data) {
324 button_info = soc_button_get_button_info(dev);
325 if (IS_ERR(button_info))
326 return PTR_ERR(button_info);
327 } else {
328 button_info = (struct soc_button_info *)id->driver_data;
329 }
330
331 error = gpiod_count(dev, NULL);
332 if (error < 0) {
333 dev_dbg(dev, "no GPIO attached, ignoring...\n");
334 return -ENODEV;
335 }
336
337 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
338 if (!priv)
339 return -ENOMEM;
340
341 platform_set_drvdata(pdev, priv);
342
343 for (i = 0; i < BUTTON_TYPES; i++) {
344 pd = soc_button_device_create(pdev, button_info, i == 0);
345 if (IS_ERR(pd)) {
346 error = PTR_ERR(pd);
347 if (error != -ENODEV) {
348 soc_button_remove(pdev);
349 return error;
350 }
351 continue;
352 }
353
354 priv->children[i] = pd;
355 }
356
357 if (!priv->children[0] && !priv->children[1])
358 return -ENODEV;
359
360 if (!id->driver_data)
361 devm_kfree(dev, button_info);
362
363 return 0;
364}
365
366
367
368
369
370
371static struct soc_button_info soc_button_PNP0C40[] = {
372 { "power", 0, EV_KEY, KEY_POWER, false, true },
373 { "home", 1, EV_KEY, KEY_LEFTMETA, false, true },
374 { "volume_up", 2, EV_KEY, KEY_VOLUMEUP, true, false },
375 { "volume_down", 3, EV_KEY, KEY_VOLUMEDOWN, true, false },
376 { "rotation_lock", 4, EV_SW, SW_ROTATE_LOCK, false, false },
377 { }
378};
379
380static const struct acpi_device_id soc_button_acpi_match[] = {
381 { "PNP0C40", (unsigned long)soc_button_PNP0C40 },
382 { "ACPI0011", 0 },
383 { }
384};
385
386MODULE_DEVICE_TABLE(acpi, soc_button_acpi_match);
387
388static struct platform_driver soc_button_driver = {
389 .probe = soc_button_probe,
390 .remove = soc_button_remove,
391 .driver = {
392 .name = KBUILD_MODNAME,
393 .acpi_match_table = ACPI_PTR(soc_button_acpi_match),
394 },
395};
396module_platform_driver(soc_button_driver);
397
398MODULE_LICENSE("GPL");
399