]> git.proxmox.com Git - mirror_ubuntu-focal-kernel.git/blob - drivers/platform/x86/wmi.c
Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[mirror_ubuntu-focal-kernel.git] / drivers / platform / x86 / wmi.c
1 /*
2 * ACPI-WMI mapping driver
3 *
4 * Copyright (C) 2007-2008 Carlos Corbacho <carlos@strangeworlds.co.uk>
5 *
6 * GUID parsing code from ldm.c is:
7 * Copyright (C) 2001,2002 Richard Russon <ldm@flatcap.org>
8 * Copyright (c) 2001-2007 Anton Altaparmakov
9 * Copyright (C) 2001,2002 Jakob Kemi <jakob.kemi@telia.com>
10 *
11 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
12 *
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License as published by
15 * the Free Software Foundation; either version 2 of the License, or (at
16 * your option) any later version.
17 *
18 * This program is distributed in the hope that it will be useful, but
19 * WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
21 * General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License along
24 * with this program; if not, write to the Free Software Foundation, Inc.,
25 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
26 *
27 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
28 */
29
30 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
31
32 #include <linux/kernel.h>
33 #include <linux/init.h>
34 #include <linux/types.h>
35 #include <linux/device.h>
36 #include <linux/list.h>
37 #include <linux/acpi.h>
38 #include <linux/slab.h>
39 #include <acpi/acpi_bus.h>
40 #include <acpi/acpi_drivers.h>
41
42 ACPI_MODULE_NAME("wmi");
43 MODULE_AUTHOR("Carlos Corbacho");
44 MODULE_DESCRIPTION("ACPI-WMI Mapping Driver");
45 MODULE_LICENSE("GPL");
46
47 #define ACPI_WMI_CLASS "wmi"
48
49 static DEFINE_MUTEX(wmi_data_lock);
50 static LIST_HEAD(wmi_block_list);
51
52 struct guid_block {
53 char guid[16];
54 union {
55 char object_id[2];
56 struct {
57 unsigned char notify_id;
58 unsigned char reserved;
59 };
60 };
61 u8 instance_count;
62 u8 flags;
63 };
64
65 struct wmi_block {
66 struct list_head list;
67 struct guid_block gblock;
68 acpi_handle handle;
69 wmi_notify_handler handler;
70 void *handler_data;
71 struct device dev;
72 };
73
74
75 /*
76 * If the GUID data block is marked as expensive, we must enable and
77 * explicitily disable data collection.
78 */
79 #define ACPI_WMI_EXPENSIVE 0x1
80 #define ACPI_WMI_METHOD 0x2 /* GUID is a method */
81 #define ACPI_WMI_STRING 0x4 /* GUID takes & returns a string */
82 #define ACPI_WMI_EVENT 0x8 /* GUID is an event */
83
84 static int debug_event;
85 module_param(debug_event, bool, 0444);
86 MODULE_PARM_DESC(debug_event,
87 "Log WMI Events [0/1]");
88
89 static int debug_dump_wdg;
90 module_param(debug_dump_wdg, bool, 0444);
91 MODULE_PARM_DESC(debug_dump_wdg,
92 "Dump available WMI interfaces [0/1]");
93
94 static int acpi_wmi_remove(struct acpi_device *device, int type);
95 static int acpi_wmi_add(struct acpi_device *device);
96 static void acpi_wmi_notify(struct acpi_device *device, u32 event);
97
98 static const struct acpi_device_id wmi_device_ids[] = {
99 {"PNP0C14", 0},
100 {"pnp0c14", 0},
101 {"", 0},
102 };
103 MODULE_DEVICE_TABLE(acpi, wmi_device_ids);
104
105 static struct acpi_driver acpi_wmi_driver = {
106 .name = "wmi",
107 .class = ACPI_WMI_CLASS,
108 .ids = wmi_device_ids,
109 .ops = {
110 .add = acpi_wmi_add,
111 .remove = acpi_wmi_remove,
112 .notify = acpi_wmi_notify,
113 },
114 };
115
116 /*
117 * GUID parsing functions
118 */
119
120 /**
121 * wmi_parse_hexbyte - Convert a ASCII hex number to a byte
122 * @src: Pointer to at least 2 characters to convert.
123 *
124 * Convert a two character ASCII hex string to a number.
125 *
126 * Return: 0-255 Success, the byte was parsed correctly
127 * -1 Error, an invalid character was supplied
128 */
129 static int wmi_parse_hexbyte(const u8 *src)
130 {
131 int h;
132 int value;
133
134 /* high part */
135 h = value = hex_to_bin(src[0]);
136 if (value < 0)
137 return -1;
138
139 /* low part */
140 value = hex_to_bin(src[1]);
141 if (value >= 0)
142 return (h << 4) | value;
143 return -1;
144 }
145
146 /**
147 * wmi_swap_bytes - Rearrange GUID bytes to match GUID binary
148 * @src: Memory block holding binary GUID (16 bytes)
149 * @dest: Memory block to hold byte swapped binary GUID (16 bytes)
150 *
151 * Byte swap a binary GUID to match it's real GUID value
152 */
153 static void wmi_swap_bytes(u8 *src, u8 *dest)
154 {
155 int i;
156
157 for (i = 0; i <= 3; i++)
158 memcpy(dest + i, src + (3 - i), 1);
159
160 for (i = 0; i <= 1; i++)
161 memcpy(dest + 4 + i, src + (5 - i), 1);
162
163 for (i = 0; i <= 1; i++)
164 memcpy(dest + 6 + i, src + (7 - i), 1);
165
166 memcpy(dest + 8, src + 8, 8);
167 }
168
169 /**
170 * wmi_parse_guid - Convert GUID from ASCII to binary
171 * @src: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
172 * @dest: Memory block to hold binary GUID (16 bytes)
173 *
174 * N.B. The GUID need not be NULL terminated.
175 *
176 * Return: 'true' @dest contains binary GUID
177 * 'false' @dest contents are undefined
178 */
179 static bool wmi_parse_guid(const u8 *src, u8 *dest)
180 {
181 static const int size[] = { 4, 2, 2, 2, 6 };
182 int i, j, v;
183
184 if (src[8] != '-' || src[13] != '-' ||
185 src[18] != '-' || src[23] != '-')
186 return false;
187
188 for (j = 0; j < 5; j++, src++) {
189 for (i = 0; i < size[j]; i++, src += 2, *dest++ = v) {
190 v = wmi_parse_hexbyte(src);
191 if (v < 0)
192 return false;
193 }
194 }
195
196 return true;
197 }
198
199 /*
200 * Convert a raw GUID to the ACII string representation
201 */
202 static int wmi_gtoa(const char *in, char *out)
203 {
204 int i;
205
206 for (i = 3; i >= 0; i--)
207 out += sprintf(out, "%02X", in[i] & 0xFF);
208
209 out += sprintf(out, "-");
210 out += sprintf(out, "%02X", in[5] & 0xFF);
211 out += sprintf(out, "%02X", in[4] & 0xFF);
212 out += sprintf(out, "-");
213 out += sprintf(out, "%02X", in[7] & 0xFF);
214 out += sprintf(out, "%02X", in[6] & 0xFF);
215 out += sprintf(out, "-");
216 out += sprintf(out, "%02X", in[8] & 0xFF);
217 out += sprintf(out, "%02X", in[9] & 0xFF);
218 out += sprintf(out, "-");
219
220 for (i = 10; i <= 15; i++)
221 out += sprintf(out, "%02X", in[i] & 0xFF);
222
223 *out = '\0';
224 return 0;
225 }
226
227 static bool find_guid(const char *guid_string, struct wmi_block **out)
228 {
229 char tmp[16], guid_input[16];
230 struct wmi_block *wblock;
231 struct guid_block *block;
232 struct list_head *p;
233
234 wmi_parse_guid(guid_string, tmp);
235 wmi_swap_bytes(tmp, guid_input);
236
237 list_for_each(p, &wmi_block_list) {
238 wblock = list_entry(p, struct wmi_block, list);
239 block = &wblock->gblock;
240
241 if (memcmp(block->guid, guid_input, 16) == 0) {
242 if (out)
243 *out = wblock;
244 return 1;
245 }
246 }
247 return 0;
248 }
249
250 static acpi_status wmi_method_enable(struct wmi_block *wblock, int enable)
251 {
252 struct guid_block *block = NULL;
253 char method[5];
254 struct acpi_object_list input;
255 union acpi_object params[1];
256 acpi_status status;
257 acpi_handle handle;
258
259 block = &wblock->gblock;
260 handle = wblock->handle;
261
262 if (!block)
263 return AE_NOT_EXIST;
264
265 input.count = 1;
266 input.pointer = params;
267 params[0].type = ACPI_TYPE_INTEGER;
268 params[0].integer.value = enable;
269
270 snprintf(method, 5, "WE%02X", block->notify_id);
271 status = acpi_evaluate_object(handle, method, &input, NULL);
272
273 if (status != AE_OK && status != AE_NOT_FOUND)
274 return status;
275 else
276 return AE_OK;
277 }
278
279 /*
280 * Exported WMI functions
281 */
282 /**
283 * wmi_evaluate_method - Evaluate a WMI method
284 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
285 * @instance: Instance index
286 * @method_id: Method ID to call
287 * &in: Buffer containing input for the method call
288 * &out: Empty buffer to return the method results
289 *
290 * Call an ACPI-WMI method
291 */
292 acpi_status wmi_evaluate_method(const char *guid_string, u8 instance,
293 u32 method_id, const struct acpi_buffer *in, struct acpi_buffer *out)
294 {
295 struct guid_block *block = NULL;
296 struct wmi_block *wblock = NULL;
297 acpi_handle handle;
298 acpi_status status;
299 struct acpi_object_list input;
300 union acpi_object params[3];
301 char method[5] = "WM";
302
303 if (!find_guid(guid_string, &wblock))
304 return AE_ERROR;
305
306 block = &wblock->gblock;
307 handle = wblock->handle;
308
309 if (!(block->flags & ACPI_WMI_METHOD))
310 return AE_BAD_DATA;
311
312 if (block->instance_count < instance)
313 return AE_BAD_PARAMETER;
314
315 input.count = 2;
316 input.pointer = params;
317 params[0].type = ACPI_TYPE_INTEGER;
318 params[0].integer.value = instance;
319 params[1].type = ACPI_TYPE_INTEGER;
320 params[1].integer.value = method_id;
321
322 if (in) {
323 input.count = 3;
324
325 if (block->flags & ACPI_WMI_STRING) {
326 params[2].type = ACPI_TYPE_STRING;
327 } else {
328 params[2].type = ACPI_TYPE_BUFFER;
329 }
330 params[2].buffer.length = in->length;
331 params[2].buffer.pointer = in->pointer;
332 }
333
334 strncat(method, block->object_id, 2);
335
336 status = acpi_evaluate_object(handle, method, &input, out);
337
338 return status;
339 }
340 EXPORT_SYMBOL_GPL(wmi_evaluate_method);
341
342 /**
343 * wmi_query_block - Return contents of a WMI block
344 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
345 * @instance: Instance index
346 * &out: Empty buffer to return the contents of the data block to
347 *
348 * Return the contents of an ACPI-WMI data block to a buffer
349 */
350 acpi_status wmi_query_block(const char *guid_string, u8 instance,
351 struct acpi_buffer *out)
352 {
353 struct guid_block *block = NULL;
354 struct wmi_block *wblock = NULL;
355 acpi_handle handle, wc_handle;
356 acpi_status status, wc_status = AE_ERROR;
357 struct acpi_object_list input, wc_input;
358 union acpi_object wc_params[1], wq_params[1];
359 char method[5];
360 char wc_method[5] = "WC";
361
362 if (!guid_string || !out)
363 return AE_BAD_PARAMETER;
364
365 if (!find_guid(guid_string, &wblock))
366 return AE_ERROR;
367
368 block = &wblock->gblock;
369 handle = wblock->handle;
370
371 if (block->instance_count < instance)
372 return AE_BAD_PARAMETER;
373
374 /* Check GUID is a data block */
375 if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD))
376 return AE_ERROR;
377
378 input.count = 1;
379 input.pointer = wq_params;
380 wq_params[0].type = ACPI_TYPE_INTEGER;
381 wq_params[0].integer.value = instance;
382
383 /*
384 * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method first to
385 * enable collection.
386 */
387 if (block->flags & ACPI_WMI_EXPENSIVE) {
388 wc_input.count = 1;
389 wc_input.pointer = wc_params;
390 wc_params[0].type = ACPI_TYPE_INTEGER;
391 wc_params[0].integer.value = 1;
392
393 strncat(wc_method, block->object_id, 2);
394
395 /*
396 * Some GUIDs break the specification by declaring themselves
397 * expensive, but have no corresponding WCxx method. So we
398 * should not fail if this happens.
399 */
400 wc_status = acpi_get_handle(handle, wc_method, &wc_handle);
401 if (ACPI_SUCCESS(wc_status))
402 wc_status = acpi_evaluate_object(handle, wc_method,
403 &wc_input, NULL);
404 }
405
406 strcpy(method, "WQ");
407 strncat(method, block->object_id, 2);
408
409 status = acpi_evaluate_object(handle, method, &input, out);
410
411 /*
412 * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method, even if
413 * the WQxx method failed - we should disable collection anyway.
414 */
415 if ((block->flags & ACPI_WMI_EXPENSIVE) && ACPI_SUCCESS(wc_status)) {
416 wc_params[0].integer.value = 0;
417 status = acpi_evaluate_object(handle,
418 wc_method, &wc_input, NULL);
419 }
420
421 return status;
422 }
423 EXPORT_SYMBOL_GPL(wmi_query_block);
424
425 /**
426 * wmi_set_block - Write to a WMI block
427 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
428 * @instance: Instance index
429 * &in: Buffer containing new values for the data block
430 *
431 * Write the contents of the input buffer to an ACPI-WMI data block
432 */
433 acpi_status wmi_set_block(const char *guid_string, u8 instance,
434 const struct acpi_buffer *in)
435 {
436 struct guid_block *block = NULL;
437 struct wmi_block *wblock = NULL;
438 acpi_handle handle;
439 struct acpi_object_list input;
440 union acpi_object params[2];
441 char method[5] = "WS";
442
443 if (!guid_string || !in)
444 return AE_BAD_DATA;
445
446 if (!find_guid(guid_string, &wblock))
447 return AE_ERROR;
448
449 block = &wblock->gblock;
450 handle = wblock->handle;
451
452 if (block->instance_count < instance)
453 return AE_BAD_PARAMETER;
454
455 /* Check GUID is a data block */
456 if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD))
457 return AE_ERROR;
458
459 input.count = 2;
460 input.pointer = params;
461 params[0].type = ACPI_TYPE_INTEGER;
462 params[0].integer.value = instance;
463
464 if (block->flags & ACPI_WMI_STRING) {
465 params[1].type = ACPI_TYPE_STRING;
466 } else {
467 params[1].type = ACPI_TYPE_BUFFER;
468 }
469 params[1].buffer.length = in->length;
470 params[1].buffer.pointer = in->pointer;
471
472 strncat(method, block->object_id, 2);
473
474 return acpi_evaluate_object(handle, method, &input, NULL);
475 }
476 EXPORT_SYMBOL_GPL(wmi_set_block);
477
478 static void wmi_dump_wdg(const struct guid_block *g)
479 {
480 char guid_string[37];
481
482 wmi_gtoa(g->guid, guid_string);
483
484 pr_info("%s:\n", guid_string);
485 pr_info("\tobject_id: %c%c\n", g->object_id[0], g->object_id[1]);
486 pr_info("\tnotify_id: %02X\n", g->notify_id);
487 pr_info("\treserved: %02X\n", g->reserved);
488 pr_info("\tinstance_count: %d\n", g->instance_count);
489 pr_info("\tflags: %#x ", g->flags);
490 if (g->flags) {
491 if (g->flags & ACPI_WMI_EXPENSIVE)
492 pr_cont("ACPI_WMI_EXPENSIVE ");
493 if (g->flags & ACPI_WMI_METHOD)
494 pr_cont("ACPI_WMI_METHOD ");
495 if (g->flags & ACPI_WMI_STRING)
496 pr_cont("ACPI_WMI_STRING ");
497 if (g->flags & ACPI_WMI_EVENT)
498 pr_cont("ACPI_WMI_EVENT ");
499 }
500 pr_cont("\n");
501
502 }
503
504 static void wmi_notify_debug(u32 value, void *context)
505 {
506 struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
507 union acpi_object *obj;
508 acpi_status status;
509
510 status = wmi_get_event_data(value, &response);
511 if (status != AE_OK) {
512 pr_info("bad event status 0x%x\n", status);
513 return;
514 }
515
516 obj = (union acpi_object *)response.pointer;
517
518 if (!obj)
519 return;
520
521 pr_info("DEBUG Event ");
522 switch(obj->type) {
523 case ACPI_TYPE_BUFFER:
524 pr_cont("BUFFER_TYPE - length %d\n", obj->buffer.length);
525 break;
526 case ACPI_TYPE_STRING:
527 pr_cont("STRING_TYPE - %s\n", obj->string.pointer);
528 break;
529 case ACPI_TYPE_INTEGER:
530 pr_cont("INTEGER_TYPE - %llu\n", obj->integer.value);
531 break;
532 case ACPI_TYPE_PACKAGE:
533 pr_cont("PACKAGE_TYPE - %d elements\n", obj->package.count);
534 break;
535 default:
536 pr_cont("object type 0x%X\n", obj->type);
537 }
538 kfree(obj);
539 }
540
541 /**
542 * wmi_install_notify_handler - Register handler for WMI events
543 * @handler: Function to handle notifications
544 * @data: Data to be returned to handler when event is fired
545 *
546 * Register a handler for events sent to the ACPI-WMI mapper device.
547 */
548 acpi_status wmi_install_notify_handler(const char *guid,
549 wmi_notify_handler handler, void *data)
550 {
551 struct wmi_block *block;
552 acpi_status status = AE_NOT_EXIST;
553 char tmp[16], guid_input[16];
554 struct list_head *p;
555
556 if (!guid || !handler)
557 return AE_BAD_PARAMETER;
558
559 wmi_parse_guid(guid, tmp);
560 wmi_swap_bytes(tmp, guid_input);
561
562 list_for_each(p, &wmi_block_list) {
563 acpi_status wmi_status;
564 block = list_entry(p, struct wmi_block, list);
565
566 if (memcmp(block->gblock.guid, guid_input, 16) == 0) {
567 if (block->handler &&
568 block->handler != wmi_notify_debug)
569 return AE_ALREADY_ACQUIRED;
570
571 block->handler = handler;
572 block->handler_data = data;
573
574 wmi_status = wmi_method_enable(block, 1);
575 if ((wmi_status != AE_OK) ||
576 ((wmi_status == AE_OK) && (status == AE_NOT_EXIST)))
577 status = wmi_status;
578 }
579 }
580
581 return status;
582 }
583 EXPORT_SYMBOL_GPL(wmi_install_notify_handler);
584
585 /**
586 * wmi_uninstall_notify_handler - Unregister handler for WMI events
587 *
588 * Unregister handler for events sent to the ACPI-WMI mapper device.
589 */
590 acpi_status wmi_remove_notify_handler(const char *guid)
591 {
592 struct wmi_block *block;
593 acpi_status status = AE_NOT_EXIST;
594 char tmp[16], guid_input[16];
595 struct list_head *p;
596
597 if (!guid)
598 return AE_BAD_PARAMETER;
599
600 wmi_parse_guid(guid, tmp);
601 wmi_swap_bytes(tmp, guid_input);
602
603 list_for_each(p, &wmi_block_list) {
604 acpi_status wmi_status;
605 block = list_entry(p, struct wmi_block, list);
606
607 if (memcmp(block->gblock.guid, guid_input, 16) == 0) {
608 if (!block->handler ||
609 block->handler == wmi_notify_debug)
610 return AE_NULL_ENTRY;
611
612 if (debug_event) {
613 block->handler = wmi_notify_debug;
614 status = AE_OK;
615 } else {
616 wmi_status = wmi_method_enable(block, 0);
617 block->handler = NULL;
618 block->handler_data = NULL;
619 if ((wmi_status != AE_OK) ||
620 ((wmi_status == AE_OK) &&
621 (status == AE_NOT_EXIST)))
622 status = wmi_status;
623 }
624 }
625 }
626
627 return status;
628 }
629 EXPORT_SYMBOL_GPL(wmi_remove_notify_handler);
630
631 /**
632 * wmi_get_event_data - Get WMI data associated with an event
633 *
634 * @event: Event to find
635 * @out: Buffer to hold event data. out->pointer should be freed with kfree()
636 *
637 * Returns extra data associated with an event in WMI.
638 */
639 acpi_status wmi_get_event_data(u32 event, struct acpi_buffer *out)
640 {
641 struct acpi_object_list input;
642 union acpi_object params[1];
643 struct guid_block *gblock;
644 struct wmi_block *wblock;
645 struct list_head *p;
646
647 input.count = 1;
648 input.pointer = params;
649 params[0].type = ACPI_TYPE_INTEGER;
650 params[0].integer.value = event;
651
652 list_for_each(p, &wmi_block_list) {
653 wblock = list_entry(p, struct wmi_block, list);
654 gblock = &wblock->gblock;
655
656 if ((gblock->flags & ACPI_WMI_EVENT) &&
657 (gblock->notify_id == event))
658 return acpi_evaluate_object(wblock->handle, "_WED",
659 &input, out);
660 }
661
662 return AE_NOT_FOUND;
663 }
664 EXPORT_SYMBOL_GPL(wmi_get_event_data);
665
666 /**
667 * wmi_has_guid - Check if a GUID is available
668 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
669 *
670 * Check if a given GUID is defined by _WDG
671 */
672 bool wmi_has_guid(const char *guid_string)
673 {
674 return find_guid(guid_string, NULL);
675 }
676 EXPORT_SYMBOL_GPL(wmi_has_guid);
677
678 /*
679 * sysfs interface
680 */
681 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr,
682 char *buf)
683 {
684 char guid_string[37];
685 struct wmi_block *wblock;
686
687 wblock = dev_get_drvdata(dev);
688 if (!wblock)
689 return -ENOMEM;
690
691 wmi_gtoa(wblock->gblock.guid, guid_string);
692
693 return sprintf(buf, "wmi:%s\n", guid_string);
694 }
695
696 static struct device_attribute wmi_dev_attrs[] = {
697 __ATTR_RO(modalias),
698 __ATTR_NULL
699 };
700
701 static int wmi_dev_uevent(struct device *dev, struct kobj_uevent_env *env)
702 {
703 char guid_string[37];
704
705 struct wmi_block *wblock;
706
707 if (add_uevent_var(env, "MODALIAS="))
708 return -ENOMEM;
709
710 wblock = dev_get_drvdata(dev);
711 if (!wblock)
712 return -ENOMEM;
713
714 wmi_gtoa(wblock->gblock.guid, guid_string);
715
716 strcpy(&env->buf[env->buflen - 1], "wmi:");
717 memcpy(&env->buf[env->buflen - 1 + 4], guid_string, 36);
718 env->buflen += 40;
719
720 return 0;
721 }
722
723 static void wmi_dev_free(struct device *dev)
724 {
725 struct wmi_block *wmi_block = container_of(dev, struct wmi_block, dev);
726
727 kfree(wmi_block);
728 }
729
730 static struct class wmi_class = {
731 .name = "wmi",
732 .dev_release = wmi_dev_free,
733 .dev_uevent = wmi_dev_uevent,
734 .dev_attrs = wmi_dev_attrs,
735 };
736
737 static int wmi_create_device(const struct guid_block *gblock,
738 struct wmi_block *wblock, acpi_handle handle)
739 {
740 char guid_string[37];
741
742 wblock->dev.class = &wmi_class;
743
744 wmi_gtoa(gblock->guid, guid_string);
745 dev_set_name(&wblock->dev, guid_string);
746
747 dev_set_drvdata(&wblock->dev, wblock);
748
749 return device_register(&wblock->dev);
750 }
751
752 static void wmi_free_devices(void)
753 {
754 struct wmi_block *wblock, *next;
755
756 /* Delete devices for all the GUIDs */
757 list_for_each_entry_safe(wblock, next, &wmi_block_list, list)
758 if (wblock->dev.class)
759 device_unregister(&wblock->dev);
760 }
761
762 static bool guid_already_parsed(const char *guid_string)
763 {
764 struct wmi_block *wblock;
765
766 list_for_each_entry(wblock, &wmi_block_list, list)
767 if (memcmp(wblock->gblock.guid, guid_string, 16) == 0)
768 return true;
769
770 return false;
771 }
772
773 /*
774 * Parse the _WDG method for the GUID data blocks
775 */
776 static acpi_status parse_wdg(acpi_handle handle)
777 {
778 struct acpi_buffer out = {ACPI_ALLOCATE_BUFFER, NULL};
779 union acpi_object *obj;
780 const struct guid_block *gblock;
781 struct wmi_block *wblock;
782 acpi_status status;
783 int retval;
784 u32 i, total;
785
786 status = acpi_evaluate_object(handle, "_WDG", NULL, &out);
787 if (ACPI_FAILURE(status))
788 return -ENXIO;
789
790 obj = (union acpi_object *) out.pointer;
791 if (!obj)
792 return -ENXIO;
793
794 if (obj->type != ACPI_TYPE_BUFFER) {
795 retval = -ENXIO;
796 goto out_free_pointer;
797 }
798
799 gblock = (const struct guid_block *)obj->buffer.pointer;
800 total = obj->buffer.length / sizeof(struct guid_block);
801
802 for (i = 0; i < total; i++) {
803 if (debug_dump_wdg)
804 wmi_dump_wdg(&gblock[i]);
805
806 wblock = kzalloc(sizeof(struct wmi_block), GFP_KERNEL);
807 if (!wblock)
808 return AE_NO_MEMORY;
809
810 wblock->handle = handle;
811 wblock->gblock = gblock[i];
812
813 /*
814 Some WMI devices, like those for nVidia hooks, have a
815 duplicate GUID. It's not clear what we should do in this
816 case yet, so for now, we'll just ignore the duplicate
817 for device creation.
818 */
819 if (!guid_already_parsed(gblock[i].guid)) {
820 retval = wmi_create_device(&gblock[i], wblock, handle);
821 if (retval) {
822 wmi_free_devices();
823 goto out_free_pointer;
824 }
825 }
826
827 list_add_tail(&wblock->list, &wmi_block_list);
828
829 if (debug_event) {
830 wblock->handler = wmi_notify_debug;
831 wmi_method_enable(wblock, 1);
832 }
833 }
834
835 retval = 0;
836
837 out_free_pointer:
838 kfree(out.pointer);
839
840 return retval;
841 }
842
843 /*
844 * WMI can have EmbeddedControl access regions. In which case, we just want to
845 * hand these off to the EC driver.
846 */
847 static acpi_status
848 acpi_wmi_ec_space_handler(u32 function, acpi_physical_address address,
849 u32 bits, u64 *value,
850 void *handler_context, void *region_context)
851 {
852 int result = 0, i = 0;
853 u8 temp = 0;
854
855 if ((address > 0xFF) || !value)
856 return AE_BAD_PARAMETER;
857
858 if (function != ACPI_READ && function != ACPI_WRITE)
859 return AE_BAD_PARAMETER;
860
861 if (bits != 8)
862 return AE_BAD_PARAMETER;
863
864 if (function == ACPI_READ) {
865 result = ec_read(address, &temp);
866 (*value) |= ((u64)temp) << i;
867 } else {
868 temp = 0xff & ((*value) >> i);
869 result = ec_write(address, temp);
870 }
871
872 switch (result) {
873 case -EINVAL:
874 return AE_BAD_PARAMETER;
875 break;
876 case -ENODEV:
877 return AE_NOT_FOUND;
878 break;
879 case -ETIME:
880 return AE_TIME;
881 break;
882 default:
883 return AE_OK;
884 }
885 }
886
887 static void acpi_wmi_notify(struct acpi_device *device, u32 event)
888 {
889 struct guid_block *block;
890 struct wmi_block *wblock;
891 struct list_head *p;
892 char guid_string[37];
893
894 list_for_each(p, &wmi_block_list) {
895 wblock = list_entry(p, struct wmi_block, list);
896 block = &wblock->gblock;
897
898 if ((block->flags & ACPI_WMI_EVENT) &&
899 (block->notify_id == event)) {
900 if (wblock->handler)
901 wblock->handler(event, wblock->handler_data);
902 if (debug_event) {
903 wmi_gtoa(wblock->gblock.guid, guid_string);
904 pr_info("DEBUG Event GUID: %s\n", guid_string);
905 }
906
907 acpi_bus_generate_netlink_event(
908 device->pnp.device_class, dev_name(&device->dev),
909 event, 0);
910 break;
911 }
912 }
913 }
914
915 static int acpi_wmi_remove(struct acpi_device *device, int type)
916 {
917 acpi_remove_address_space_handler(device->handle,
918 ACPI_ADR_SPACE_EC, &acpi_wmi_ec_space_handler);
919 wmi_free_devices();
920
921 return 0;
922 }
923
924 static int acpi_wmi_add(struct acpi_device *device)
925 {
926 acpi_status status;
927 int error;
928
929 status = acpi_install_address_space_handler(device->handle,
930 ACPI_ADR_SPACE_EC,
931 &acpi_wmi_ec_space_handler,
932 NULL, NULL);
933 if (ACPI_FAILURE(status)) {
934 pr_err("Error installing EC region handler\n");
935 return -ENODEV;
936 }
937
938 error = parse_wdg(device->handle);
939 if (error) {
940 acpi_remove_address_space_handler(device->handle,
941 ACPI_ADR_SPACE_EC,
942 &acpi_wmi_ec_space_handler);
943 pr_err("Failed to parse WDG method\n");
944 return error;
945 }
946
947 return 0;
948 }
949
950 static int __init acpi_wmi_init(void)
951 {
952 int error;
953
954 if (acpi_disabled)
955 return -ENODEV;
956
957 error = class_register(&wmi_class);
958 if (error)
959 return error;
960
961 error = acpi_bus_register_driver(&acpi_wmi_driver);
962 if (error) {
963 pr_err("Error loading mapper\n");
964 class_unregister(&wmi_class);
965 return error;
966 }
967
968 pr_info("Mapper loaded\n");
969 return 0;
970 }
971
972 static void __exit acpi_wmi_exit(void)
973 {
974 acpi_bus_unregister_driver(&acpi_wmi_driver);
975 class_unregister(&wmi_class);
976
977 pr_info("Mapper unloaded\n");
978 }
979
980 subsys_initcall(acpi_wmi_init);
981 module_exit(acpi_wmi_exit);