?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
percpu: handle __percpu notations in UP accessors
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / platform / x86 / wmi.c
blobb2978a04317f9de32755a719b4c7abe215e588b6
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 #include <linux/kernel.h>
31 #include <linux/init.h>
32 #include <linux/types.h>
33 #include <linux/device.h>
34 #include <linux/list.h>
35 #include <linux/acpi.h>
36 #include <linux/slab.h>
37 #include <acpi/acpi_bus.h>
38 #include <acpi/acpi_drivers.h>
39
40 ACPI_MODULE_NAME("wmi");
41 MODULE_AUTHOR("Carlos Corbacho");
42 MODULE_DESCRIPTION("ACPI-WMI Mapping Driver");
43 MODULE_LICENSE("GPL");
44
45 #define ACPI_WMI_CLASS "wmi"
46
47 #define PREFIX "ACPI: WMI: "
48
49 static DEFINE_MUTEX(wmi_data_lock);
50
51 struct guid_block {
52 char guid[16];
53 union {
54 char object_id[2];
55 struct {
56 unsigned char notify_id;
57 unsigned char reserved;
58 };
59 };
60 u8 instance_count;
61 u8 flags;
62 };
63
64 struct wmi_block {
65 struct list_head list;
66 struct guid_block gblock;
67 acpi_handle handle;
68 wmi_notify_handler handler;
69 void *handler_data;
70 struct device *dev;
71 };
72
73 static struct wmi_block wmi_blocks;
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 unsigned int x; /* For correct wrapping */
132 int h;
133
134 /* high part */
135 x = src[0];
136 if (x - '0' <= '9' - '0') {
137 h = x - '0';
138 } else if (x - 'a' <= 'f' - 'a') {
139 h = x - 'a' + 10;
140 } else if (x - 'A' <= 'F' - 'A') {
141 h = x - 'A' + 10;
142 } else {
143 return -1;
144 }
145 h <<= 4;
146
147 /* low part */
148 x = src[1];
149 if (x - '0' <= '9' - '0')
150 return h | (x - '0');
151 if (x - 'a' <= 'f' - 'a')
152 return h | (x - 'a' + 10);
153 if (x - 'A' <= 'F' - 'A')
154 return h | (x - 'A' + 10);
155 return -1;
156 }
157
158 /**
159 * wmi_swap_bytes - Rearrange GUID bytes to match GUID binary
160 * @src: Memory block holding binary GUID (16 bytes)
161 * @dest: Memory block to hold byte swapped binary GUID (16 bytes)
162 *
163 * Byte swap a binary GUID to match it's real GUID value
164 */
165 static void wmi_swap_bytes(u8 *src, u8 *dest)
166 {
167 int i;
168
169 for (i = 0; i <= 3; i++)
170 memcpy(dest + i, src + (3 - i), 1);
171
172 for (i = 0; i <= 1; i++)
173 memcpy(dest + 4 + i, src + (5 - i), 1);
174
175 for (i = 0; i <= 1; i++)
176 memcpy(dest + 6 + i, src + (7 - i), 1);
177
178 memcpy(dest + 8, src + 8, 8);
179 }
180
181 /**
182 * wmi_parse_guid - Convert GUID from ASCII to binary
183 * @src: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
184 * @dest: Memory block to hold binary GUID (16 bytes)
185 *
186 * N.B. The GUID need not be NULL terminated.
187 *
188 * Return: 'true' @dest contains binary GUID
189 * 'false' @dest contents are undefined
190 */
191 static bool wmi_parse_guid(const u8 *src, u8 *dest)
192 {
193 static const int size[] = { 4, 2, 2, 2, 6 };
194 int i, j, v;
195
196 if (src[8] != '-' || src[13] != '-' ||
197 src[18] != '-' || src[23] != '-')
198 return false;
199
200 for (j = 0; j < 5; j++, src++) {
201 for (i = 0; i < size[j]; i++, src += 2, *dest++ = v) {
202 v = wmi_parse_hexbyte(src);
203 if (v < 0)
204 return false;
205 }
206 }
207
208 return true;
209 }
210
211 /*
212 * Convert a raw GUID to the ACII string representation
213 */
214 static int wmi_gtoa(const char *in, char *out)
215 {
216 int i;
217
218 for (i = 3; i >= 0; i--)
219 out += sprintf(out, "%02X", in[i] & 0xFF);
220
221 out += sprintf(out, "-");
222 out += sprintf(out, "%02X", in[5] & 0xFF);
223 out += sprintf(out, "%02X", in[4] & 0xFF);
224 out += sprintf(out, "-");
225 out += sprintf(out, "%02X", in[7] & 0xFF);
226 out += sprintf(out, "%02X", in[6] & 0xFF);
227 out += sprintf(out, "-");
228 out += sprintf(out, "%02X", in[8] & 0xFF);
229 out += sprintf(out, "%02X", in[9] & 0xFF);
230 out += sprintf(out, "-");
231
232 for (i = 10; i <= 15; i++)
233 out += sprintf(out, "%02X", in[i] & 0xFF);
234
235 out = '\0';
236 return 0;
237 }
238
239 static bool find_guid(const char *guid_string, struct wmi_block **out)
240 {
241 char tmp[16], guid_input[16];
242 struct wmi_block *wblock;
243 struct guid_block *block;
244 struct list_head *p;
245
246 wmi_parse_guid(guid_string, tmp);
247 wmi_swap_bytes(tmp, guid_input);
248
249 list_for_each(p, &wmi_blocks.list) {
250 wblock = list_entry(p, struct wmi_block, list);
251 block = &wblock->gblock;
252
253 if (memcmp(block->guid, guid_input, 16) == 0) {
254 if (out)
255 *out = wblock;
256 return 1;
257 }
258 }
259 return 0;
260 }
261
262 static acpi_status wmi_method_enable(struct wmi_block *wblock, int enable)
263 {
264 struct guid_block *block = NULL;
265 char method[5];
266 struct acpi_object_list input;
267 union acpi_object params[1];
268 acpi_status status;
269 acpi_handle handle;
270
271 block = &wblock->gblock;
272 handle = wblock->handle;
273
274 if (!block)
275 return AE_NOT_EXIST;
276
277 input.count = 1;
278 input.pointer = params;
279 params[0].type = ACPI_TYPE_INTEGER;
280 params[0].integer.value = enable;
281
282 snprintf(method, 5, "WE%02X", block->notify_id);
283 status = acpi_evaluate_object(handle, method, &input, NULL);
284
285 if (status != AE_OK && status != AE_NOT_FOUND)
286 return status;
287 else
288 return AE_OK;
289 }
290
291 /*
292 * Exported WMI functions
293 */
294 /**
295 * wmi_evaluate_method - Evaluate a WMI method
296 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
297 * @instance: Instance index
298 * @method_id: Method ID to call
299 * &in: Buffer containing input for the method call
300 * &out: Empty buffer to return the method results
301 *
302 * Call an ACPI-WMI method
303 */
304 acpi_status wmi_evaluate_method(const char *guid_string, u8 instance,
305 u32 method_id, const struct acpi_buffer *in, struct acpi_buffer *out)
306 {
307 struct guid_block *block = NULL;
308 struct wmi_block *wblock = NULL;
309 acpi_handle handle;
310 acpi_status status;
311 struct acpi_object_list input;
312 union acpi_object params[3];
313 char method[5] = "WM";
314
315 if (!find_guid(guid_string, &wblock))
316 return AE_ERROR;
317
318 block = &wblock->gblock;
319 handle = wblock->handle;
320
321 if (!(block->flags & ACPI_WMI_METHOD))
322 return AE_BAD_DATA;
323
324 if (block->instance_count < instance)
325 return AE_BAD_PARAMETER;
326
327 input.count = 2;
328 input.pointer = params;
329 params[0].type = ACPI_TYPE_INTEGER;
330 params[0].integer.value = instance;
331 params[1].type = ACPI_TYPE_INTEGER;
332 params[1].integer.value = method_id;
333
334 if (in) {
335 input.count = 3;
336
337 if (block->flags & ACPI_WMI_STRING) {
338 params[2].type = ACPI_TYPE_STRING;
339 } else {
340 params[2].type = ACPI_TYPE_BUFFER;
341 }
342 params[2].buffer.length = in->length;
343 params[2].buffer.pointer = in->pointer;
344 }
345
346 strncat(method, block->object_id, 2);
347
348 status = acpi_evaluate_object(handle, method, &input, out);
349
350 return status;
351 }
352 EXPORT_SYMBOL_GPL(wmi_evaluate_method);
353
354 /**
355 * wmi_query_block - Return contents of a WMI block
356 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
357 * @instance: Instance index
358 * &out: Empty buffer to return the contents of the data block to
359 *
360 * Return the contents of an ACPI-WMI data block to a buffer
361 */
362 acpi_status wmi_query_block(const char *guid_string, u8 instance,
363 struct acpi_buffer *out)
364 {
365 struct guid_block *block = NULL;
366 struct wmi_block *wblock = NULL;
367 acpi_handle handle, wc_handle;
368 acpi_status status, wc_status = AE_ERROR;
369 struct acpi_object_list input, wc_input;
370 union acpi_object wc_params[1], wq_params[1];
371 char method[5];
372 char wc_method[5] = "WC";
373
374 if (!guid_string || !out)
375 return AE_BAD_PARAMETER;
376
377 if (!find_guid(guid_string, &wblock))
378 return AE_ERROR;
379
380 block = &wblock->gblock;
381 handle = wblock->handle;
382
383 if (block->instance_count < instance)
384 return AE_BAD_PARAMETER;
385
386 /* Check GUID is a data block */
387 if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD))
388 return AE_ERROR;
389
390 input.count = 1;
391 input.pointer = wq_params;
392 wq_params[0].type = ACPI_TYPE_INTEGER;
393 wq_params[0].integer.value = instance;
394
395 /*
396 * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method first to
397 * enable collection.
398 */
399 if (block->flags & ACPI_WMI_EXPENSIVE) {
400 wc_input.count = 1;
401 wc_input.pointer = wc_params;
402 wc_params[0].type = ACPI_TYPE_INTEGER;
403 wc_params[0].integer.value = 1;
404
405 strncat(wc_method, block->object_id, 2);
406
407 /*
408 * Some GUIDs break the specification by declaring themselves
409 * expensive, but have no corresponding WCxx method. So we
410 * should not fail if this happens.
411 */
412 wc_status = acpi_get_handle(handle, wc_method, &wc_handle);
413 if (ACPI_SUCCESS(wc_status))
414 wc_status = acpi_evaluate_object(handle, wc_method,
415 &wc_input, NULL);
416 }
417
418 strcpy(method, "WQ");
419 strncat(method, block->object_id, 2);
420
421 status = acpi_evaluate_object(handle, method, &input, out);
422
423 /*
424 * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method, even if
425 * the WQxx method failed - we should disable collection anyway.
426 */
427 if ((block->flags & ACPI_WMI_EXPENSIVE) && ACPI_SUCCESS(wc_status)) {
428 wc_params[0].integer.value = 0;
429 status = acpi_evaluate_object(handle,
430 wc_method, &wc_input, NULL);
431 }
432
433 return status;
434 }
435 EXPORT_SYMBOL_GPL(wmi_query_block);
436
437 /**
438 * wmi_set_block - Write to a WMI block
439 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
440 * @instance: Instance index
441 * &in: Buffer containing new values for the data block
442 *
443 * Write the contents of the input buffer to an ACPI-WMI data block
444 */
445 acpi_status wmi_set_block(const char *guid_string, u8 instance,
446 const struct acpi_buffer *in)
447 {
448 struct guid_block *block = NULL;
449 struct wmi_block *wblock = NULL;
450 acpi_handle handle;
451 struct acpi_object_list input;
452 union acpi_object params[2];
453 char method[5] = "WS";
454
455 if (!guid_string || !in)
456 return AE_BAD_DATA;
457
458 if (!find_guid(guid_string, &wblock))
459 return AE_ERROR;
460
461 block = &wblock->gblock;
462 handle = wblock->handle;
463
464 if (block->instance_count < instance)
465 return AE_BAD_PARAMETER;
466
467 /* Check GUID is a data block */
468 if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD))
469 return AE_ERROR;
470
471 input.count = 2;
472 input.pointer = params;
473 params[0].type = ACPI_TYPE_INTEGER;
474 params[0].integer.value = instance;
475
476 if (block->flags & ACPI_WMI_STRING) {
477 params[1].type = ACPI_TYPE_STRING;
478 } else {
479 params[1].type = ACPI_TYPE_BUFFER;
480 }
481 params[1].buffer.length = in->length;
482 params[1].buffer.pointer = in->pointer;
483
484 strncat(method, block->object_id, 2);
485
486 return acpi_evaluate_object(handle, method, &input, NULL);
487 }
488 EXPORT_SYMBOL_GPL(wmi_set_block);
489
490 static void wmi_dump_wdg(struct guid_block *g)
491 {
492 char guid_string[37];
493
494 wmi_gtoa(g->guid, guid_string);
495 printk(KERN_INFO PREFIX "%s:\n", guid_string);
496 printk(KERN_INFO PREFIX "\tobject_id: %c%c\n",
497 g->object_id[0], g->object_id[1]);
498 printk(KERN_INFO PREFIX "\tnotify_id: %02X\n", g->notify_id);
499 printk(KERN_INFO PREFIX "\treserved: %02X\n", g->reserved);
500 printk(KERN_INFO PREFIX "\tinstance_count: %d\n", g->instance_count);
501 printk(KERN_INFO PREFIX "\tflags: %#x", g->flags);
502 if (g->flags) {
503 printk(" ");
504 if (g->flags & ACPI_WMI_EXPENSIVE)
505 printk("ACPI_WMI_EXPENSIVE ");
506 if (g->flags & ACPI_WMI_METHOD)
507 printk("ACPI_WMI_METHOD ");
508 if (g->flags & ACPI_WMI_STRING)
509 printk("ACPI_WMI_STRING ");
510 if (g->flags & ACPI_WMI_EVENT)
511 printk("ACPI_WMI_EVENT ");
512 }
513 printk("\n");
514
515 }
516
517 static void wmi_notify_debug(u32 value, void *context)
518 {
519 struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
520 union acpi_object *obj;
521 acpi_status status;
522
523 status = wmi_get_event_data(value, &response);
524 if (status != AE_OK) {
525 printk(KERN_INFO "wmi: bad event status 0x%x\n", status);
526 return;
527 }
528
529 obj = (union acpi_object *)response.pointer;
530
531 if (!obj)
532 return;
533
534 printk(KERN_INFO PREFIX "DEBUG Event ");
535 switch(obj->type) {
536 case ACPI_TYPE_BUFFER:
537 printk("BUFFER_TYPE - length %d\n", obj->buffer.length);
538 break;
539 case ACPI_TYPE_STRING:
540 printk("STRING_TYPE - %s\n", obj->string.pointer);
541 break;
542 case ACPI_TYPE_INTEGER:
543 printk("INTEGER_TYPE - %llu\n", obj->integer.value);
544 break;
545 case ACPI_TYPE_PACKAGE:
546 printk("PACKAGE_TYPE - %d elements\n", obj->package.count);
547 break;
548 default:
549 printk("object type 0x%X\n", obj->type);
550 }
551 kfree(obj);
552 }
553
554 /**
555 * wmi_install_notify_handler - Register handler for WMI events
556 * @handler: Function to handle notifications
557 * @data: Data to be returned to handler when event is fired
558 *
559 * Register a handler for events sent to the ACPI-WMI mapper device.
560 */
561 acpi_status wmi_install_notify_handler(const char *guid,
562 wmi_notify_handler handler, void *data)
563 {
564 struct wmi_block *block;
565 acpi_status status;
566
567 if (!guid || !handler)
568 return AE_BAD_PARAMETER;
569
570 if (!find_guid(guid, &block))
571 return AE_NOT_EXIST;
572
573 if (block->handler && block->handler != wmi_notify_debug)
574 return AE_ALREADY_ACQUIRED;
575
576 block->handler = handler;
577 block->handler_data = data;
578
579 status = wmi_method_enable(block, 1);
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_OK;
594
595 if (!guid)
596 return AE_BAD_PARAMETER;
597
598 if (!find_guid(guid, &block))
599 return AE_NOT_EXIST;
600
601 if (!block->handler || block->handler == wmi_notify_debug)
602 return AE_NULL_ENTRY;
603
604 if (debug_event) {
605 block->handler = wmi_notify_debug;
606 } else {
607 status = wmi_method_enable(block, 0);
608 block->handler = NULL;
609 block->handler_data = NULL;
610 }
611 return status;
612 }
613 EXPORT_SYMBOL_GPL(wmi_remove_notify_handler);
614
615 /**
616 * wmi_get_event_data - Get WMI data associated with an event
617 *
618 * @event: Event to find
619 * @out: Buffer to hold event data. out->pointer should be freed with kfree()
620 *
621 * Returns extra data associated with an event in WMI.
622 */
623 acpi_status wmi_get_event_data(u32 event, struct acpi_buffer *out)
624 {
625 struct acpi_object_list input;
626 union acpi_object params[1];
627 struct guid_block *gblock;
628 struct wmi_block *wblock;
629 struct list_head *p;
630
631 input.count = 1;
632 input.pointer = params;
633 params[0].type = ACPI_TYPE_INTEGER;
634 params[0].integer.value = event;
635
636 list_for_each(p, &wmi_blocks.list) {
637 wblock = list_entry(p, struct wmi_block, list);
638 gblock = &wblock->gblock;
639
640 if ((gblock->flags & ACPI_WMI_EVENT) &&
641 (gblock->notify_id == event))
642 return acpi_evaluate_object(wblock->handle, "_WED",
643 &input, out);
644 }
645
646 return AE_NOT_FOUND;
647 }
648 EXPORT_SYMBOL_GPL(wmi_get_event_data);
649
650 /**
651 * wmi_has_guid - Check if a GUID is available
652 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
653 *
654 * Check if a given GUID is defined by _WDG
655 */
656 bool wmi_has_guid(const char *guid_string)
657 {
658 return find_guid(guid_string, NULL);
659 }
660 EXPORT_SYMBOL_GPL(wmi_has_guid);
661
662 /*
663 * sysfs interface
664 */
665 static ssize_t show_modalias(struct device *dev, struct device_attribute *attr,
666 char *buf)
667 {
668 char guid_string[37];
669 struct wmi_block *wblock;
670
671 wblock = dev_get_drvdata(dev);
672 if (!wblock)
673 return -ENOMEM;
674
675 wmi_gtoa(wblock->gblock.guid, guid_string);
676
677 return sprintf(buf, "wmi:%s\n", guid_string);
678 }
679 static DEVICE_ATTR(modalias, S_IRUGO, show_modalias, NULL);
680
681 static int wmi_dev_uevent(struct device *dev, struct kobj_uevent_env *env)
682 {
683 char guid_string[37];
684
685 struct wmi_block *wblock;
686
687 if (add_uevent_var(env, "MODALIAS="))
688 return -ENOMEM;
689
690 wblock = dev_get_drvdata(dev);
691 if (!wblock)
692 return -ENOMEM;
693
694 wmi_gtoa(wblock->gblock.guid, guid_string);
695
696 strcpy(&env->buf[env->buflen - 1], "wmi:");
697 memcpy(&env->buf[env->buflen - 1 + 4], guid_string, 36);
698 env->buflen += 40;
699
700 return 0;
701 }
702
703 static void wmi_dev_free(struct device *dev)
704 {
705 kfree(dev);
706 }
707
708 static struct class wmi_class = {
709 .name = "wmi",
710 .dev_release = wmi_dev_free,
711 .dev_uevent = wmi_dev_uevent,
712 };
713
714 static int wmi_create_devs(void)
715 {
716 int result;
717 char guid_string[37];
718 struct guid_block *gblock;
719 struct wmi_block *wblock;
720 struct list_head *p;
721 struct device *guid_dev;
722
723 /* Create devices for all the GUIDs */
724 list_for_each(p, &wmi_blocks.list) {
725 wblock = list_entry(p, struct wmi_block, list);
726
727 guid_dev = kzalloc(sizeof(struct device), GFP_KERNEL);
728 if (!guid_dev)
729 return -ENOMEM;
730
731 wblock->dev = guid_dev;
732
733 guid_dev->class = &wmi_class;
734 dev_set_drvdata(guid_dev, wblock);
735
736 gblock = &wblock->gblock;
737
738 wmi_gtoa(gblock->guid, guid_string);
739 dev_set_name(guid_dev, guid_string);
740
741 result = device_register(guid_dev);
742 if (result)
743 return result;
744
745 result = device_create_file(guid_dev, &dev_attr_modalias);
746 if (result)
747 return result;
748 }
749
750 return 0;
751 }
752
753 static void wmi_remove_devs(void)
754 {
755 struct guid_block *gblock;
756 struct wmi_block *wblock;
757 struct list_head *p;
758 struct device *guid_dev;
759
760 /* Delete devices for all the GUIDs */
761 list_for_each(p, &wmi_blocks.list) {
762 wblock = list_entry(p, struct wmi_block, list);
763
764 guid_dev = wblock->dev;
765 gblock = &wblock->gblock;
766
767 device_remove_file(guid_dev, &dev_attr_modalias);
768
769 device_unregister(guid_dev);
770 }
771 }
772
773 static void wmi_class_exit(void)
774 {
775 wmi_remove_devs();
776 class_unregister(&wmi_class);
777 }
778
779 static int wmi_class_init(void)
780 {
781 int ret;
782
783 ret = class_register(&wmi_class);
784 if (ret)
785 return ret;
786
787 ret = wmi_create_devs();
788 if (ret)
789 wmi_class_exit();
790
791 return ret;
792 }
793
794 static bool guid_already_parsed(const char *guid_string)
795 {
796 struct guid_block *gblock;
797 struct wmi_block *wblock;
798 struct list_head *p;
799
800 list_for_each(p, &wmi_blocks.list) {
801 wblock = list_entry(p, struct wmi_block, list);
802 gblock = &wblock->gblock;
803
804 if (strncmp(gblock->guid, guid_string, 16) == 0)
805 return true;
806 }
807 return false;
808 }
809
810 /*
811 * Parse the _WDG method for the GUID data blocks
812 */
813 static acpi_status parse_wdg(acpi_handle handle)
814 {
815 struct acpi_buffer out = {ACPI_ALLOCATE_BUFFER, NULL};
816 union acpi_object *obj;
817 struct guid_block *gblock;
818 struct wmi_block *wblock;
819 char guid_string[37];
820 acpi_status status;
821 u32 i, total;
822
823 status = acpi_evaluate_object(handle, "_WDG", NULL, &out);
824
825 if (ACPI_FAILURE(status))
826 return status;
827
828 obj = (union acpi_object *) out.pointer;
829
830 if (obj->type != ACPI_TYPE_BUFFER)
831 return AE_ERROR;
832
833 total = obj->buffer.length / sizeof(struct guid_block);
834
835 gblock = kmemdup(obj->buffer.pointer, obj->buffer.length, GFP_KERNEL);
836 if (!gblock) {
837 status = AE_NO_MEMORY;
838 goto out_free_pointer;
839 }
840
841 for (i = 0; i < total; i++) {
842 /*
843 Some WMI devices, like those for nVidia hooks, have a
844 duplicate GUID. It's not clear what we should do in this
845 case yet, so for now, we'll just ignore the duplicate.
846 Anyone who wants to add support for that device can come
847 up with a better workaround for the mess then.
848 */
849 if (guid_already_parsed(gblock[i].guid) == true) {
850 wmi_gtoa(gblock[i].guid, guid_string);
851 printk(KERN_INFO PREFIX "Skipping duplicate GUID %s\n",
852 guid_string);
853 continue;
854 }
855 if (debug_dump_wdg)
856 wmi_dump_wdg(&gblock[i]);
857
858 wblock = kzalloc(sizeof(struct wmi_block), GFP_KERNEL);
859 if (!wblock) {
860 status = AE_NO_MEMORY;
861 goto out_free_gblock;
862 }
863
864 wblock->gblock = gblock[i];
865 wblock->handle = handle;
866 if (debug_event) {
867 wblock->handler = wmi_notify_debug;
868 status = wmi_method_enable(wblock, 1);
869 }
870 list_add_tail(&wblock->list, &wmi_blocks.list);
871 }
872
873 out_free_gblock:
874 kfree(gblock);
875 out_free_pointer:
876 kfree(out.pointer);
877
878 return status;
879 }
880
881 /*
882 * WMI can have EmbeddedControl access regions. In which case, we just want to
883 * hand these off to the EC driver.
884 */
885 static acpi_status
886 acpi_wmi_ec_space_handler(u32 function, acpi_physical_address address,
887 u32 bits, u64 *value,
888 void *handler_context, void *region_context)
889 {
890 int result = 0, i = 0;
891 u8 temp = 0;
892
893 if ((address > 0xFF) || !value)
894 return AE_BAD_PARAMETER;
895
896 if (function != ACPI_READ && function != ACPI_WRITE)
897 return AE_BAD_PARAMETER;
898
899 if (bits != 8)
900 return AE_BAD_PARAMETER;
901
902 if (function == ACPI_READ) {
903 result = ec_read(address, &temp);
904 (*value) |= ((u64)temp) << i;
905 } else {
906 temp = 0xff & ((*value) >> i);
907 result = ec_write(address, temp);
908 }
909
910 switch (result) {
911 case -EINVAL:
912 return AE_BAD_PARAMETER;
913 break;
914 case -ENODEV:
915 return AE_NOT_FOUND;
916 break;
917 case -ETIME:
918 return AE_TIME;
919 break;
920 default:
921 return AE_OK;
922 }
923 }
924
925 static void acpi_wmi_notify(struct acpi_device *device, u32 event)
926 {
927 struct guid_block *block;
928 struct wmi_block *wblock;
929 struct list_head *p;
930 char guid_string[37];
931
932 list_for_each(p, &wmi_blocks.list) {
933 wblock = list_entry(p, struct wmi_block, list);
934 block = &wblock->gblock;
935
936 if ((block->flags & ACPI_WMI_EVENT) &&
937 (block->notify_id == event)) {
938 if (wblock->handler)
939 wblock->handler(event, wblock->handler_data);
940 if (debug_event) {
941 wmi_gtoa(wblock->gblock.guid, guid_string);
942 printk(KERN_INFO PREFIX "DEBUG Event GUID:"
943 " %s\n", guid_string);
944 }
945
946 acpi_bus_generate_netlink_event(
947 device->pnp.device_class, dev_name(&device->dev),
948 event, 0);
949 break;
950 }
951 }
952 }
953
954 static int acpi_wmi_remove(struct acpi_device *device, int type)
955 {
956 acpi_remove_address_space_handler(device->handle,
957 ACPI_ADR_SPACE_EC, &acpi_wmi_ec_space_handler);
958
959 return 0;
960 }
961
962 static int acpi_wmi_add(struct acpi_device *device)
963 {
964 acpi_status status;
965 int result = 0;
966
967 status = acpi_install_address_space_handler(device->handle,
968 ACPI_ADR_SPACE_EC,
969 &acpi_wmi_ec_space_handler,
970 NULL, NULL);
971 if (ACPI_FAILURE(status))
972 return -ENODEV;
973
974 status = parse_wdg(device->handle);
975 if (ACPI_FAILURE(status)) {
976 printk(KERN_ERR PREFIX "Error installing EC region handler\n");
977 return -ENODEV;
978 }
979
980 return result;
981 }
982
983 static int __init acpi_wmi_init(void)
984 {
985 int result;
986
987 INIT_LIST_HEAD(&wmi_blocks.list);
988
989 if (acpi_disabled)
990 return -ENODEV;
991
992 result = acpi_bus_register_driver(&acpi_wmi_driver);
993
994 if (result < 0) {
995 printk(KERN_INFO PREFIX "Error loading mapper\n");
996 return -ENODEV;
997 }
998
999 result = wmi_class_init();
1000 if (result) {
1001 acpi_bus_unregister_driver(&acpi_wmi_driver);
1002 return result;
1003 }
1004
1005 printk(KERN_INFO PREFIX "Mapper loaded\n");
1006
1007 return result;
1008 }
1009
1010 static void __exit acpi_wmi_exit(void)
1011 {
1012 struct list_head *p, *tmp;
1013 struct wmi_block *wblock;
1014
1015 wmi_class_exit();
1016
1017 acpi_bus_unregister_driver(&acpi_wmi_driver);
1018
1019 list_for_each_safe(p, tmp, &wmi_blocks.list) {
1020 wblock = list_entry(p, struct wmi_block, list);
1021
1022 list_del(p);
1023 kfree(wblock);
1024 }
1025
1026 printk(KERN_INFO PREFIX "Mapper unloaded\n");
1027 }
1028
1029 subsys_initcall(acpi_wmi_init);
1030 module_exit(acpi_wmi_exit);
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree