Merge branch 'modsplit-Oct31_2011' of git://git.kernel.org/pub/scm/linux/kernel/git...
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / platform / x86 / wmi.c
bloba134c26870b0d048929fc9eb6fe07e1e7172e35c
1 /*
2 * ACPI-WMI mapping driver
4 * Copyright (C) 2007-2008 Carlos Corbacho <carlos@strangeworlds.co.uk>
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>
11 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
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.
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.
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.
27 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
30 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
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 <linux/module.h>
40 #include <acpi/acpi_bus.h>
41 #include <acpi/acpi_drivers.h>
43 ACPI_MODULE_NAME("wmi");
44 MODULE_AUTHOR("Carlos Corbacho");
45 MODULE_DESCRIPTION("ACPI-WMI Mapping Driver");
46 MODULE_LICENSE("GPL");
48 #define ACPI_WMI_CLASS "wmi"
50 static DEFINE_MUTEX(wmi_data_lock);
51 static LIST_HEAD(wmi_block_list);
53 struct guid_block {
54 char guid[16];
55 union {
56 char object_id[2];
57 struct {
58 unsigned char notify_id;
59 unsigned char reserved;
62 u8 instance_count;
63 u8 flags;
66 struct wmi_block {
67 struct list_head list;
68 struct guid_block gblock;
69 acpi_handle handle;
70 wmi_notify_handler handler;
71 void *handler_data;
72 struct device dev;
77 * If the GUID data block is marked as expensive, we must enable and
78 * explicitily disable data collection.
80 #define ACPI_WMI_EXPENSIVE 0x1
81 #define ACPI_WMI_METHOD 0x2 /* GUID is a method */
82 #define ACPI_WMI_STRING 0x4 /* GUID takes & returns a string */
83 #define ACPI_WMI_EVENT 0x8 /* GUID is an event */
85 static int debug_event;
86 module_param(debug_event, bool, 0444);
87 MODULE_PARM_DESC(debug_event,
88 "Log WMI Events [0/1]");
90 static int debug_dump_wdg;
91 module_param(debug_dump_wdg, bool, 0444);
92 MODULE_PARM_DESC(debug_dump_wdg,
93 "Dump available WMI interfaces [0/1]");
95 static int acpi_wmi_remove(struct acpi_device *device, int type);
96 static int acpi_wmi_add(struct acpi_device *device);
97 static void acpi_wmi_notify(struct acpi_device *device, u32 event);
99 static const struct acpi_device_id wmi_device_ids[] = {
100 {"PNP0C14", 0},
101 {"pnp0c14", 0},
102 {"", 0},
104 MODULE_DEVICE_TABLE(acpi, wmi_device_ids);
106 static struct acpi_driver acpi_wmi_driver = {
107 .name = "wmi",
108 .class = ACPI_WMI_CLASS,
109 .ids = wmi_device_ids,
110 .ops = {
111 .add = acpi_wmi_add,
112 .remove = acpi_wmi_remove,
113 .notify = acpi_wmi_notify,
118 * GUID parsing functions
122 * wmi_parse_hexbyte - Convert a ASCII hex number to a byte
123 * @src: Pointer to at least 2 characters to convert.
125 * Convert a two character ASCII hex string to a number.
127 * Return: 0-255 Success, the byte was parsed correctly
128 * -1 Error, an invalid character was supplied
130 static int wmi_parse_hexbyte(const u8 *src)
132 int h;
133 int value;
135 /* high part */
136 h = value = hex_to_bin(src[0]);
137 if (value < 0)
138 return -1;
140 /* low part */
141 value = hex_to_bin(src[1]);
142 if (value >= 0)
143 return (h << 4) | value;
144 return -1;
148 * wmi_swap_bytes - Rearrange GUID bytes to match GUID binary
149 * @src: Memory block holding binary GUID (16 bytes)
150 * @dest: Memory block to hold byte swapped binary GUID (16 bytes)
152 * Byte swap a binary GUID to match it's real GUID value
154 static void wmi_swap_bytes(u8 *src, u8 *dest)
156 int i;
158 for (i = 0; i <= 3; i++)
159 memcpy(dest + i, src + (3 - i), 1);
161 for (i = 0; i <= 1; i++)
162 memcpy(dest + 4 + i, src + (5 - i), 1);
164 for (i = 0; i <= 1; i++)
165 memcpy(dest + 6 + i, src + (7 - i), 1);
167 memcpy(dest + 8, src + 8, 8);
171 * wmi_parse_guid - Convert GUID from ASCII to binary
172 * @src: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
173 * @dest: Memory block to hold binary GUID (16 bytes)
175 * N.B. The GUID need not be NULL terminated.
177 * Return: 'true' @dest contains binary GUID
178 * 'false' @dest contents are undefined
180 static bool wmi_parse_guid(const u8 *src, u8 *dest)
182 static const int size[] = { 4, 2, 2, 2, 6 };
183 int i, j, v;
185 if (src[8] != '-' || src[13] != '-' ||
186 src[18] != '-' || src[23] != '-')
187 return false;
189 for (j = 0; j < 5; j++, src++) {
190 for (i = 0; i < size[j]; i++, src += 2, *dest++ = v) {
191 v = wmi_parse_hexbyte(src);
192 if (v < 0)
193 return false;
197 return true;
201 * Convert a raw GUID to the ACII string representation
203 static int wmi_gtoa(const char *in, char *out)
205 int i;
207 for (i = 3; i >= 0; i--)
208 out += sprintf(out, "%02X", in[i] & 0xFF);
210 out += sprintf(out, "-");
211 out += sprintf(out, "%02X", in[5] & 0xFF);
212 out += sprintf(out, "%02X", in[4] & 0xFF);
213 out += sprintf(out, "-");
214 out += sprintf(out, "%02X", in[7] & 0xFF);
215 out += sprintf(out, "%02X", in[6] & 0xFF);
216 out += sprintf(out, "-");
217 out += sprintf(out, "%02X", in[8] & 0xFF);
218 out += sprintf(out, "%02X", in[9] & 0xFF);
219 out += sprintf(out, "-");
221 for (i = 10; i <= 15; i++)
222 out += sprintf(out, "%02X", in[i] & 0xFF);
224 *out = '\0';
225 return 0;
228 static bool find_guid(const char *guid_string, struct wmi_block **out)
230 char tmp[16], guid_input[16];
231 struct wmi_block *wblock;
232 struct guid_block *block;
233 struct list_head *p;
235 wmi_parse_guid(guid_string, tmp);
236 wmi_swap_bytes(tmp, guid_input);
238 list_for_each(p, &wmi_block_list) {
239 wblock = list_entry(p, struct wmi_block, list);
240 block = &wblock->gblock;
242 if (memcmp(block->guid, guid_input, 16) == 0) {
243 if (out)
244 *out = wblock;
245 return 1;
248 return 0;
251 static acpi_status wmi_method_enable(struct wmi_block *wblock, int enable)
253 struct guid_block *block = NULL;
254 char method[5];
255 struct acpi_object_list input;
256 union acpi_object params[1];
257 acpi_status status;
258 acpi_handle handle;
260 block = &wblock->gblock;
261 handle = wblock->handle;
263 if (!block)
264 return AE_NOT_EXIST;
266 input.count = 1;
267 input.pointer = params;
268 params[0].type = ACPI_TYPE_INTEGER;
269 params[0].integer.value = enable;
271 snprintf(method, 5, "WE%02X", block->notify_id);
272 status = acpi_evaluate_object(handle, method, &input, NULL);
274 if (status != AE_OK && status != AE_NOT_FOUND)
275 return status;
276 else
277 return AE_OK;
281 * Exported WMI functions
284 * wmi_evaluate_method - Evaluate a WMI method
285 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
286 * @instance: Instance index
287 * @method_id: Method ID to call
288 * &in: Buffer containing input for the method call
289 * &out: Empty buffer to return the method results
291 * Call an ACPI-WMI method
293 acpi_status wmi_evaluate_method(const char *guid_string, u8 instance,
294 u32 method_id, const struct acpi_buffer *in, struct acpi_buffer *out)
296 struct guid_block *block = NULL;
297 struct wmi_block *wblock = NULL;
298 acpi_handle handle;
299 acpi_status status;
300 struct acpi_object_list input;
301 union acpi_object params[3];
302 char method[5] = "WM";
304 if (!find_guid(guid_string, &wblock))
305 return AE_ERROR;
307 block = &wblock->gblock;
308 handle = wblock->handle;
310 if (!(block->flags & ACPI_WMI_METHOD))
311 return AE_BAD_DATA;
313 if (block->instance_count < instance)
314 return AE_BAD_PARAMETER;
316 input.count = 2;
317 input.pointer = params;
318 params[0].type = ACPI_TYPE_INTEGER;
319 params[0].integer.value = instance;
320 params[1].type = ACPI_TYPE_INTEGER;
321 params[1].integer.value = method_id;
323 if (in) {
324 input.count = 3;
326 if (block->flags & ACPI_WMI_STRING) {
327 params[2].type = ACPI_TYPE_STRING;
328 } else {
329 params[2].type = ACPI_TYPE_BUFFER;
331 params[2].buffer.length = in->length;
332 params[2].buffer.pointer = in->pointer;
335 strncat(method, block->object_id, 2);
337 status = acpi_evaluate_object(handle, method, &input, out);
339 return status;
341 EXPORT_SYMBOL_GPL(wmi_evaluate_method);
344 * wmi_query_block - Return contents of a WMI block
345 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
346 * @instance: Instance index
347 * &out: Empty buffer to return the contents of the data block to
349 * Return the contents of an ACPI-WMI data block to a buffer
351 acpi_status wmi_query_block(const char *guid_string, u8 instance,
352 struct acpi_buffer *out)
354 struct guid_block *block = NULL;
355 struct wmi_block *wblock = NULL;
356 acpi_handle handle, wc_handle;
357 acpi_status status, wc_status = AE_ERROR;
358 struct acpi_object_list input, wc_input;
359 union acpi_object wc_params[1], wq_params[1];
360 char method[5];
361 char wc_method[5] = "WC";
363 if (!guid_string || !out)
364 return AE_BAD_PARAMETER;
366 if (!find_guid(guid_string, &wblock))
367 return AE_ERROR;
369 block = &wblock->gblock;
370 handle = wblock->handle;
372 if (block->instance_count < instance)
373 return AE_BAD_PARAMETER;
375 /* Check GUID is a data block */
376 if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD))
377 return AE_ERROR;
379 input.count = 1;
380 input.pointer = wq_params;
381 wq_params[0].type = ACPI_TYPE_INTEGER;
382 wq_params[0].integer.value = instance;
385 * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method first to
386 * enable collection.
388 if (block->flags & ACPI_WMI_EXPENSIVE) {
389 wc_input.count = 1;
390 wc_input.pointer = wc_params;
391 wc_params[0].type = ACPI_TYPE_INTEGER;
392 wc_params[0].integer.value = 1;
394 strncat(wc_method, block->object_id, 2);
397 * Some GUIDs break the specification by declaring themselves
398 * expensive, but have no corresponding WCxx method. So we
399 * should not fail if this happens.
401 wc_status = acpi_get_handle(handle, wc_method, &wc_handle);
402 if (ACPI_SUCCESS(wc_status))
403 wc_status = acpi_evaluate_object(handle, wc_method,
404 &wc_input, NULL);
407 strcpy(method, "WQ");
408 strncat(method, block->object_id, 2);
410 status = acpi_evaluate_object(handle, method, &input, out);
413 * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method, even if
414 * the WQxx method failed - we should disable collection anyway.
416 if ((block->flags & ACPI_WMI_EXPENSIVE) && ACPI_SUCCESS(wc_status)) {
417 wc_params[0].integer.value = 0;
418 status = acpi_evaluate_object(handle,
419 wc_method, &wc_input, NULL);
422 return status;
424 EXPORT_SYMBOL_GPL(wmi_query_block);
427 * wmi_set_block - Write to a WMI block
428 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
429 * @instance: Instance index
430 * &in: Buffer containing new values for the data block
432 * Write the contents of the input buffer to an ACPI-WMI data block
434 acpi_status wmi_set_block(const char *guid_string, u8 instance,
435 const struct acpi_buffer *in)
437 struct guid_block *block = NULL;
438 struct wmi_block *wblock = NULL;
439 acpi_handle handle;
440 struct acpi_object_list input;
441 union acpi_object params[2];
442 char method[5] = "WS";
444 if (!guid_string || !in)
445 return AE_BAD_DATA;
447 if (!find_guid(guid_string, &wblock))
448 return AE_ERROR;
450 block = &wblock->gblock;
451 handle = wblock->handle;
453 if (block->instance_count < instance)
454 return AE_BAD_PARAMETER;
456 /* Check GUID is a data block */
457 if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD))
458 return AE_ERROR;
460 input.count = 2;
461 input.pointer = params;
462 params[0].type = ACPI_TYPE_INTEGER;
463 params[0].integer.value = instance;
465 if (block->flags & ACPI_WMI_STRING) {
466 params[1].type = ACPI_TYPE_STRING;
467 } else {
468 params[1].type = ACPI_TYPE_BUFFER;
470 params[1].buffer.length = in->length;
471 params[1].buffer.pointer = in->pointer;
473 strncat(method, block->object_id, 2);
475 return acpi_evaluate_object(handle, method, &input, NULL);
477 EXPORT_SYMBOL_GPL(wmi_set_block);
479 static void wmi_dump_wdg(const struct guid_block *g)
481 char guid_string[37];
483 wmi_gtoa(g->guid, guid_string);
485 pr_info("%s:\n", guid_string);
486 pr_info("\tobject_id: %c%c\n", g->object_id[0], g->object_id[1]);
487 pr_info("\tnotify_id: %02X\n", g->notify_id);
488 pr_info("\treserved: %02X\n", g->reserved);
489 pr_info("\tinstance_count: %d\n", g->instance_count);
490 pr_info("\tflags: %#x", g->flags);
491 if (g->flags) {
492 if (g->flags & ACPI_WMI_EXPENSIVE)
493 pr_cont(" ACPI_WMI_EXPENSIVE");
494 if (g->flags & ACPI_WMI_METHOD)
495 pr_cont(" ACPI_WMI_METHOD");
496 if (g->flags & ACPI_WMI_STRING)
497 pr_cont(" ACPI_WMI_STRING");
498 if (g->flags & ACPI_WMI_EVENT)
499 pr_cont(" ACPI_WMI_EVENT");
501 pr_cont("\n");
505 static void wmi_notify_debug(u32 value, void *context)
507 struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
508 union acpi_object *obj;
509 acpi_status status;
511 status = wmi_get_event_data(value, &response);
512 if (status != AE_OK) {
513 pr_info("bad event status 0x%x\n", status);
514 return;
517 obj = (union acpi_object *)response.pointer;
519 if (!obj)
520 return;
522 pr_info("DEBUG Event ");
523 switch(obj->type) {
524 case ACPI_TYPE_BUFFER:
525 pr_cont("BUFFER_TYPE - length %d\n", obj->buffer.length);
526 break;
527 case ACPI_TYPE_STRING:
528 pr_cont("STRING_TYPE - %s\n", obj->string.pointer);
529 break;
530 case ACPI_TYPE_INTEGER:
531 pr_cont("INTEGER_TYPE - %llu\n", obj->integer.value);
532 break;
533 case ACPI_TYPE_PACKAGE:
534 pr_cont("PACKAGE_TYPE - %d elements\n", obj->package.count);
535 break;
536 default:
537 pr_cont("object type 0x%X\n", obj->type);
539 kfree(obj);
543 * wmi_install_notify_handler - Register handler for WMI events
544 * @handler: Function to handle notifications
545 * @data: Data to be returned to handler when event is fired
547 * Register a handler for events sent to the ACPI-WMI mapper device.
549 acpi_status wmi_install_notify_handler(const char *guid,
550 wmi_notify_handler handler, void *data)
552 struct wmi_block *block;
553 acpi_status status = AE_NOT_EXIST;
554 char tmp[16], guid_input[16];
555 struct list_head *p;
557 if (!guid || !handler)
558 return AE_BAD_PARAMETER;
560 wmi_parse_guid(guid, tmp);
561 wmi_swap_bytes(tmp, guid_input);
563 list_for_each(p, &wmi_block_list) {
564 acpi_status wmi_status;
565 block = list_entry(p, struct wmi_block, list);
567 if (memcmp(block->gblock.guid, guid_input, 16) == 0) {
568 if (block->handler &&
569 block->handler != wmi_notify_debug)
570 return AE_ALREADY_ACQUIRED;
572 block->handler = handler;
573 block->handler_data = data;
575 wmi_status = wmi_method_enable(block, 1);
576 if ((wmi_status != AE_OK) ||
577 ((wmi_status == AE_OK) && (status == AE_NOT_EXIST)))
578 status = wmi_status;
582 return status;
584 EXPORT_SYMBOL_GPL(wmi_install_notify_handler);
587 * wmi_uninstall_notify_handler - Unregister handler for WMI events
589 * Unregister handler for events sent to the ACPI-WMI mapper device.
591 acpi_status wmi_remove_notify_handler(const char *guid)
593 struct wmi_block *block;
594 acpi_status status = AE_NOT_EXIST;
595 char tmp[16], guid_input[16];
596 struct list_head *p;
598 if (!guid)
599 return AE_BAD_PARAMETER;
601 wmi_parse_guid(guid, tmp);
602 wmi_swap_bytes(tmp, guid_input);
604 list_for_each(p, &wmi_block_list) {
605 acpi_status wmi_status;
606 block = list_entry(p, struct wmi_block, list);
608 if (memcmp(block->gblock.guid, guid_input, 16) == 0) {
609 if (!block->handler ||
610 block->handler == wmi_notify_debug)
611 return AE_NULL_ENTRY;
613 if (debug_event) {
614 block->handler = wmi_notify_debug;
615 status = AE_OK;
616 } else {
617 wmi_status = wmi_method_enable(block, 0);
618 block->handler = NULL;
619 block->handler_data = NULL;
620 if ((wmi_status != AE_OK) ||
621 ((wmi_status == AE_OK) &&
622 (status == AE_NOT_EXIST)))
623 status = wmi_status;
628 return status;
630 EXPORT_SYMBOL_GPL(wmi_remove_notify_handler);
633 * wmi_get_event_data - Get WMI data associated with an event
635 * @event: Event to find
636 * @out: Buffer to hold event data. out->pointer should be freed with kfree()
638 * Returns extra data associated with an event in WMI.
640 acpi_status wmi_get_event_data(u32 event, struct acpi_buffer *out)
642 struct acpi_object_list input;
643 union acpi_object params[1];
644 struct guid_block *gblock;
645 struct wmi_block *wblock;
646 struct list_head *p;
648 input.count = 1;
649 input.pointer = params;
650 params[0].type = ACPI_TYPE_INTEGER;
651 params[0].integer.value = event;
653 list_for_each(p, &wmi_block_list) {
654 wblock = list_entry(p, struct wmi_block, list);
655 gblock = &wblock->gblock;
657 if ((gblock->flags & ACPI_WMI_EVENT) &&
658 (gblock->notify_id == event))
659 return acpi_evaluate_object(wblock->handle, "_WED",
660 &input, out);
663 return AE_NOT_FOUND;
665 EXPORT_SYMBOL_GPL(wmi_get_event_data);
668 * wmi_has_guid - Check if a GUID is available
669 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
671 * Check if a given GUID is defined by _WDG
673 bool wmi_has_guid(const char *guid_string)
675 return find_guid(guid_string, NULL);
677 EXPORT_SYMBOL_GPL(wmi_has_guid);
680 * sysfs interface
682 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr,
683 char *buf)
685 char guid_string[37];
686 struct wmi_block *wblock;
688 wblock = dev_get_drvdata(dev);
689 if (!wblock)
690 return -ENOMEM;
692 wmi_gtoa(wblock->gblock.guid, guid_string);
694 return sprintf(buf, "wmi:%s\n", guid_string);
697 static struct device_attribute wmi_dev_attrs[] = {
698 __ATTR_RO(modalias),
699 __ATTR_NULL
702 static int wmi_dev_uevent(struct device *dev, struct kobj_uevent_env *env)
704 char guid_string[37];
706 struct wmi_block *wblock;
708 if (add_uevent_var(env, "MODALIAS="))
709 return -ENOMEM;
711 wblock = dev_get_drvdata(dev);
712 if (!wblock)
713 return -ENOMEM;
715 wmi_gtoa(wblock->gblock.guid, guid_string);
717 strcpy(&env->buf[env->buflen - 1], "wmi:");
718 memcpy(&env->buf[env->buflen - 1 + 4], guid_string, 36);
719 env->buflen += 40;
721 return 0;
724 static void wmi_dev_free(struct device *dev)
726 struct wmi_block *wmi_block = container_of(dev, struct wmi_block, dev);
728 kfree(wmi_block);
731 static struct class wmi_class = {
732 .name = "wmi",
733 .dev_release = wmi_dev_free,
734 .dev_uevent = wmi_dev_uevent,
735 .dev_attrs = wmi_dev_attrs,
738 static int wmi_create_device(const struct guid_block *gblock,
739 struct wmi_block *wblock, acpi_handle handle)
741 char guid_string[37];
743 wblock->dev.class = &wmi_class;
745 wmi_gtoa(gblock->guid, guid_string);
746 dev_set_name(&wblock->dev, guid_string);
748 dev_set_drvdata(&wblock->dev, wblock);
750 return device_register(&wblock->dev);
753 static void wmi_free_devices(void)
755 struct wmi_block *wblock, *next;
757 /* Delete devices for all the GUIDs */
758 list_for_each_entry_safe(wblock, next, &wmi_block_list, list) {
759 list_del(&wblock->list);
760 if (wblock->dev.class)
761 device_unregister(&wblock->dev);
762 else
763 kfree(wblock);
767 static bool guid_already_parsed(const char *guid_string)
769 struct wmi_block *wblock;
771 list_for_each_entry(wblock, &wmi_block_list, list)
772 if (memcmp(wblock->gblock.guid, guid_string, 16) == 0)
773 return true;
775 return false;
779 * Parse the _WDG method for the GUID data blocks
781 static acpi_status parse_wdg(acpi_handle handle)
783 struct acpi_buffer out = {ACPI_ALLOCATE_BUFFER, NULL};
784 union acpi_object *obj;
785 const struct guid_block *gblock;
786 struct wmi_block *wblock;
787 acpi_status status;
788 int retval;
789 u32 i, total;
791 status = acpi_evaluate_object(handle, "_WDG", NULL, &out);
792 if (ACPI_FAILURE(status))
793 return -ENXIO;
795 obj = (union acpi_object *) out.pointer;
796 if (!obj)
797 return -ENXIO;
799 if (obj->type != ACPI_TYPE_BUFFER) {
800 retval = -ENXIO;
801 goto out_free_pointer;
804 gblock = (const struct guid_block *)obj->buffer.pointer;
805 total = obj->buffer.length / sizeof(struct guid_block);
807 for (i = 0; i < total; i++) {
808 if (debug_dump_wdg)
809 wmi_dump_wdg(&gblock[i]);
811 wblock = kzalloc(sizeof(struct wmi_block), GFP_KERNEL);
812 if (!wblock)
813 return AE_NO_MEMORY;
815 wblock->handle = handle;
816 wblock->gblock = gblock[i];
819 Some WMI devices, like those for nVidia hooks, have a
820 duplicate GUID. It's not clear what we should do in this
821 case yet, so for now, we'll just ignore the duplicate
822 for device creation.
824 if (!guid_already_parsed(gblock[i].guid)) {
825 retval = wmi_create_device(&gblock[i], wblock, handle);
826 if (retval) {
827 wmi_free_devices();
828 goto out_free_pointer;
832 list_add_tail(&wblock->list, &wmi_block_list);
834 if (debug_event) {
835 wblock->handler = wmi_notify_debug;
836 wmi_method_enable(wblock, 1);
840 retval = 0;
842 out_free_pointer:
843 kfree(out.pointer);
845 return retval;
849 * WMI can have EmbeddedControl access regions. In which case, we just want to
850 * hand these off to the EC driver.
852 static acpi_status
853 acpi_wmi_ec_space_handler(u32 function, acpi_physical_address address,
854 u32 bits, u64 *value,
855 void *handler_context, void *region_context)
857 int result = 0, i = 0;
858 u8 temp = 0;
860 if ((address > 0xFF) || !value)
861 return AE_BAD_PARAMETER;
863 if (function != ACPI_READ && function != ACPI_WRITE)
864 return AE_BAD_PARAMETER;
866 if (bits != 8)
867 return AE_BAD_PARAMETER;
869 if (function == ACPI_READ) {
870 result = ec_read(address, &temp);
871 (*value) |= ((u64)temp) << i;
872 } else {
873 temp = 0xff & ((*value) >> i);
874 result = ec_write(address, temp);
877 switch (result) {
878 case -EINVAL:
879 return AE_BAD_PARAMETER;
880 break;
881 case -ENODEV:
882 return AE_NOT_FOUND;
883 break;
884 case -ETIME:
885 return AE_TIME;
886 break;
887 default:
888 return AE_OK;
892 static void acpi_wmi_notify(struct acpi_device *device, u32 event)
894 struct guid_block *block;
895 struct wmi_block *wblock;
896 struct list_head *p;
897 char guid_string[37];
899 list_for_each(p, &wmi_block_list) {
900 wblock = list_entry(p, struct wmi_block, list);
901 block = &wblock->gblock;
903 if ((block->flags & ACPI_WMI_EVENT) &&
904 (block->notify_id == event)) {
905 if (wblock->handler)
906 wblock->handler(event, wblock->handler_data);
907 if (debug_event) {
908 wmi_gtoa(wblock->gblock.guid, guid_string);
909 pr_info("DEBUG Event GUID: %s\n", guid_string);
912 acpi_bus_generate_netlink_event(
913 device->pnp.device_class, dev_name(&device->dev),
914 event, 0);
915 break;
920 static int acpi_wmi_remove(struct acpi_device *device, int type)
922 acpi_remove_address_space_handler(device->handle,
923 ACPI_ADR_SPACE_EC, &acpi_wmi_ec_space_handler);
924 wmi_free_devices();
926 return 0;
929 static int acpi_wmi_add(struct acpi_device *device)
931 acpi_status status;
932 int error;
934 status = acpi_install_address_space_handler(device->handle,
935 ACPI_ADR_SPACE_EC,
936 &acpi_wmi_ec_space_handler,
937 NULL, NULL);
938 if (ACPI_FAILURE(status)) {
939 pr_err("Error installing EC region handler\n");
940 return -ENODEV;
943 error = parse_wdg(device->handle);
944 if (error) {
945 acpi_remove_address_space_handler(device->handle,
946 ACPI_ADR_SPACE_EC,
947 &acpi_wmi_ec_space_handler);
948 pr_err("Failed to parse WDG method\n");
949 return error;
952 return 0;
955 static int __init acpi_wmi_init(void)
957 int error;
959 if (acpi_disabled)
960 return -ENODEV;
962 error = class_register(&wmi_class);
963 if (error)
964 return error;
966 error = acpi_bus_register_driver(&acpi_wmi_driver);
967 if (error) {
968 pr_err("Error loading mapper\n");
969 class_unregister(&wmi_class);
970 return error;
973 pr_info("Mapper loaded\n");
974 return 0;
977 static void __exit acpi_wmi_exit(void)
979 acpi_bus_unregister_driver(&acpi_wmi_driver);
980 class_unregister(&wmi_class);
982 pr_info("Mapper unloaded\n");
985 subsys_initcall(acpi_wmi_init);
986 module_exit(acpi_wmi_exit);