Linux Audio

Check our new training course

Loading...
v3.1
  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
 42ACPI_MODULE_NAME("wmi");
 43MODULE_AUTHOR("Carlos Corbacho");
 44MODULE_DESCRIPTION("ACPI-WMI Mapping Driver");
 45MODULE_LICENSE("GPL");
 46
 47#define ACPI_WMI_CLASS "wmi"
 48
 49static DEFINE_MUTEX(wmi_data_lock);
 50static LIST_HEAD(wmi_block_list);
 51
 52struct 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
 65struct 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
 84static int debug_event;
 85module_param(debug_event, bool, 0444);
 86MODULE_PARM_DESC(debug_event,
 87		 "Log WMI Events [0/1]");
 88
 89static int debug_dump_wdg;
 90module_param(debug_dump_wdg, bool, 0444);
 91MODULE_PARM_DESC(debug_dump_wdg,
 92		 "Dump available WMI interfaces [0/1]");
 93
 94static int acpi_wmi_remove(struct acpi_device *device, int type);
 95static int acpi_wmi_add(struct acpi_device *device);
 96static void acpi_wmi_notify(struct acpi_device *device, u32 event);
 97
 98static const struct acpi_device_id wmi_device_ids[] = {
 99	{"PNP0C14", 0},
100	{"pnp0c14", 0},
101	{"", 0},
102};
103MODULE_DEVICE_TABLE(acpi, wmi_device_ids);
104
105static 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 */
129static 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 */
153static 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 */
179static 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 */
202static 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
227static 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
250static 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 */
292acpi_status wmi_evaluate_method(const char *guid_string, u8 instance,
293u32 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}
340EXPORT_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 */
350acpi_status wmi_query_block(const char *guid_string, u8 instance,
351struct 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}
423EXPORT_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 */
433acpi_status wmi_set_block(const char *guid_string, u8 instance,
434const 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}
476EXPORT_SYMBOL_GPL(wmi_set_block);
477
478static 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
504static 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 */
548acpi_status wmi_install_notify_handler(const char *guid,
549wmi_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}
583EXPORT_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 */
590acpi_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}
629EXPORT_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 */
639acpi_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}
664EXPORT_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 */
672bool wmi_has_guid(const char *guid_string)
673{
674	return find_guid(guid_string, NULL);
675}
676EXPORT_SYMBOL_GPL(wmi_has_guid);
677
678/*
679 * sysfs interface
680 */
681static 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
696static struct device_attribute wmi_dev_attrs[] = {
697	__ATTR_RO(modalias),
698	__ATTR_NULL
699};
700
701static 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
723static 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
730static 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
737static 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
752static 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
762static 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 */
776static 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
837out_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 */
847static acpi_status
848acpi_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
887static 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
915static 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
924static 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
950static 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
972static 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
980subsys_initcall(acpi_wmi_init);
981module_exit(acpi_wmi_exit);
v3.5.6
  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 <linux/module.h>
 40#include <acpi/acpi_bus.h>
 41#include <acpi/acpi_drivers.h>
 42
 43ACPI_MODULE_NAME("wmi");
 44MODULE_AUTHOR("Carlos Corbacho");
 45MODULE_DESCRIPTION("ACPI-WMI Mapping Driver");
 46MODULE_LICENSE("GPL");
 47
 48#define ACPI_WMI_CLASS "wmi"
 49
 50static DEFINE_MUTEX(wmi_data_lock);
 51static LIST_HEAD(wmi_block_list);
 52
 53struct guid_block {
 54	char guid[16];
 55	union {
 56		char object_id[2];
 57		struct {
 58			unsigned char notify_id;
 59			unsigned char reserved;
 60		};
 61	};
 62	u8 instance_count;
 63	u8 flags;
 64};
 65
 66struct 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;
 73};
 74
 75
 76/*
 77 * If the GUID data block is marked as expensive, we must enable and
 78 * explicitily disable data collection.
 79 */
 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 */
 84
 85static bool debug_event;
 86module_param(debug_event, bool, 0444);
 87MODULE_PARM_DESC(debug_event,
 88		 "Log WMI Events [0/1]");
 89
 90static bool debug_dump_wdg;
 91module_param(debug_dump_wdg, bool, 0444);
 92MODULE_PARM_DESC(debug_dump_wdg,
 93		 "Dump available WMI interfaces [0/1]");
 94
 95static int acpi_wmi_remove(struct acpi_device *device, int type);
 96static int acpi_wmi_add(struct acpi_device *device);
 97static void acpi_wmi_notify(struct acpi_device *device, u32 event);
 98
 99static const struct acpi_device_id wmi_device_ids[] = {
100	{"PNP0C14", 0},
101	{"pnp0c14", 0},
102	{"", 0},
103};
104MODULE_DEVICE_TABLE(acpi, wmi_device_ids);
105
106static 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,
114	},
115};
116
117/*
118 * GUID parsing functions
119 */
120
121/**
122 * wmi_parse_hexbyte - Convert a ASCII hex number to a byte
123 * @src:  Pointer to at least 2 characters to convert.
124 *
125 * Convert a two character ASCII hex string to a number.
126 *
127 * Return:  0-255  Success, the byte was parsed correctly
128 *          -1     Error, an invalid character was supplied
129 */
130static int wmi_parse_hexbyte(const u8 *src)
131{
132	int h;
133	int value;
134
135	/* high part */
136	h = value = hex_to_bin(src[0]);
137	if (value < 0)
138		return -1;
139
140	/* low part */
141	value = hex_to_bin(src[1]);
142	if (value >= 0)
143		return (h << 4) | value;
144	return -1;
145}
146
147/**
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)
151 *
152 * Byte swap a binary GUID to match it's real GUID value
153 */
154static void wmi_swap_bytes(u8 *src, u8 *dest)
155{
156	int i;
157
158	for (i = 0; i <= 3; i++)
159		memcpy(dest + i, src + (3 - i), 1);
160
161	for (i = 0; i <= 1; i++)
162		memcpy(dest + 4 + i, src + (5 - i), 1);
163
164	for (i = 0; i <= 1; i++)
165		memcpy(dest + 6 + i, src + (7 - i), 1);
166
167	memcpy(dest + 8, src + 8, 8);
168}
169
170/**
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)
174 *
175 * N.B. The GUID need not be NULL terminated.
176 *
177 * Return:  'true'   @dest contains binary GUID
178 *          'false'  @dest contents are undefined
179 */
180static bool wmi_parse_guid(const u8 *src, u8 *dest)
181{
182	static const int size[] = { 4, 2, 2, 2, 6 };
183	int i, j, v;
184
185	if (src[8]  != '-' || src[13] != '-' ||
186		src[18] != '-' || src[23] != '-')
187		return false;
188
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;
194		}
195	}
196
197	return true;
198}
199
200/*
201 * Convert a raw GUID to the ACII string representation
202 */
203static int wmi_gtoa(const char *in, char *out)
204{
205	int i;
206
207	for (i = 3; i >= 0; i--)
208		out += sprintf(out, "%02X", in[i] & 0xFF);
209
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, "-");
220
221	for (i = 10; i <= 15; i++)
222		out += sprintf(out, "%02X", in[i] & 0xFF);
223
224	*out = '\0';
225	return 0;
226}
227
228static bool find_guid(const char *guid_string, struct wmi_block **out)
229{
230	char tmp[16], guid_input[16];
231	struct wmi_block *wblock;
232	struct guid_block *block;
233	struct list_head *p;
234
235	wmi_parse_guid(guid_string, tmp);
236	wmi_swap_bytes(tmp, guid_input);
237
238	list_for_each(p, &wmi_block_list) {
239		wblock = list_entry(p, struct wmi_block, list);
240		block = &wblock->gblock;
241
242		if (memcmp(block->guid, guid_input, 16) == 0) {
243			if (out)
244				*out = wblock;
245			return 1;
246		}
247	}
248	return 0;
249}
250
251static acpi_status wmi_method_enable(struct wmi_block *wblock, int enable)
252{
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;
259
260	block = &wblock->gblock;
261	handle = wblock->handle;
262
263	if (!block)
264		return AE_NOT_EXIST;
265
266	input.count = 1;
267	input.pointer = params;
268	params[0].type = ACPI_TYPE_INTEGER;
269	params[0].integer.value = enable;
270
271	snprintf(method, 5, "WE%02X", block->notify_id);
272	status = acpi_evaluate_object(handle, method, &input, NULL);
273
274	if (status != AE_OK && status != AE_NOT_FOUND)
275		return status;
276	else
277		return AE_OK;
278}
279
280/*
281 * Exported WMI functions
282 */
283/**
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
290 *
291 * Call an ACPI-WMI method
292 */
293acpi_status wmi_evaluate_method(const char *guid_string, u8 instance,
294u32 method_id, const struct acpi_buffer *in, struct acpi_buffer *out)
295{
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";
303
304	if (!find_guid(guid_string, &wblock))
305		return AE_ERROR;
306
307	block = &wblock->gblock;
308	handle = wblock->handle;
309
310	if (!(block->flags & ACPI_WMI_METHOD))
311		return AE_BAD_DATA;
312
313	if (block->instance_count < instance)
314		return AE_BAD_PARAMETER;
315
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;
322
323	if (in) {
324		input.count = 3;
325
326		if (block->flags & ACPI_WMI_STRING) {
327			params[2].type = ACPI_TYPE_STRING;
328		} else {
329			params[2].type = ACPI_TYPE_BUFFER;
330		}
331		params[2].buffer.length = in->length;
332		params[2].buffer.pointer = in->pointer;
333	}
334
335	strncat(method, block->object_id, 2);
336
337	status = acpi_evaluate_object(handle, method, &input, out);
338
339	return status;
340}
341EXPORT_SYMBOL_GPL(wmi_evaluate_method);
342
343/**
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
348 *
349 * Return the contents of an ACPI-WMI data block to a buffer
350 */
351acpi_status wmi_query_block(const char *guid_string, u8 instance,
352struct acpi_buffer *out)
353{
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";
362
363	if (!guid_string || !out)
364		return AE_BAD_PARAMETER;
365
366	if (!find_guid(guid_string, &wblock))
367		return AE_ERROR;
368
369	block = &wblock->gblock;
370	handle = wblock->handle;
371
372	if (block->instance_count < instance)
373		return AE_BAD_PARAMETER;
374
375	/* Check GUID is a data block */
376	if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD))
377		return AE_ERROR;
378
379	input.count = 1;
380	input.pointer = wq_params;
381	wq_params[0].type = ACPI_TYPE_INTEGER;
382	wq_params[0].integer.value = instance;
383
384	/*
385	 * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method first to
386	 * enable collection.
387	 */
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;
393
394		strncat(wc_method, block->object_id, 2);
395
396		/*
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.
400		 */
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);
405	}
406
407	strcpy(method, "WQ");
408	strncat(method, block->object_id, 2);
409
410	status = acpi_evaluate_object(handle, method, &input, out);
411
412	/*
413	 * If ACPI_WMI_EXPENSIVE, call the relevant WCxx method, even if
414	 * the WQxx method failed - we should disable collection anyway.
415	 */
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);
420	}
421
422	return status;
423}
424EXPORT_SYMBOL_GPL(wmi_query_block);
425
426/**
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
431 *
432 * Write the contents of the input buffer to an ACPI-WMI data block
433 */
434acpi_status wmi_set_block(const char *guid_string, u8 instance,
435const struct acpi_buffer *in)
436{
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";
443
444	if (!guid_string || !in)
445		return AE_BAD_DATA;
446
447	if (!find_guid(guid_string, &wblock))
448		return AE_ERROR;
449
450	block = &wblock->gblock;
451	handle = wblock->handle;
452
453	if (block->instance_count < instance)
454		return AE_BAD_PARAMETER;
455
456	/* Check GUID is a data block */
457	if (block->flags & (ACPI_WMI_EVENT | ACPI_WMI_METHOD))
458		return AE_ERROR;
459
460	input.count = 2;
461	input.pointer = params;
462	params[0].type = ACPI_TYPE_INTEGER;
463	params[0].integer.value = instance;
464
465	if (block->flags & ACPI_WMI_STRING) {
466		params[1].type = ACPI_TYPE_STRING;
467	} else {
468		params[1].type = ACPI_TYPE_BUFFER;
469	}
470	params[1].buffer.length = in->length;
471	params[1].buffer.pointer = in->pointer;
472
473	strncat(method, block->object_id, 2);
474
475	return acpi_evaluate_object(handle, method, &input, NULL);
476}
477EXPORT_SYMBOL_GPL(wmi_set_block);
478
479static void wmi_dump_wdg(const struct guid_block *g)
480{
481	char guid_string[37];
482
483	wmi_gtoa(g->guid, guid_string);
484
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");
500	}
501	pr_cont("\n");
502
503}
504
505static void wmi_notify_debug(u32 value, void *context)
506{
507	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
508	union acpi_object *obj;
509	acpi_status status;
510
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;
515	}
516
517	obj = (union acpi_object *)response.pointer;
518
519	if (!obj)
520		return;
521
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);
538	}
539	kfree(obj);
540}
541
542/**
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
546 *
547 * Register a handler for events sent to the ACPI-WMI mapper device.
548 */
549acpi_status wmi_install_notify_handler(const char *guid,
550wmi_notify_handler handler, void *data)
551{
552	struct wmi_block *block;
553	acpi_status status = AE_NOT_EXIST;
554	char tmp[16], guid_input[16];
555	struct list_head *p;
556
557	if (!guid || !handler)
558		return AE_BAD_PARAMETER;
559
560	wmi_parse_guid(guid, tmp);
561	wmi_swap_bytes(tmp, guid_input);
562
563	list_for_each(p, &wmi_block_list) {
564		acpi_status wmi_status;
565		block = list_entry(p, struct wmi_block, list);
566
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;
571
572			block->handler = handler;
573			block->handler_data = data;
574
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;
579		}
580	}
581
582	return status;
583}
584EXPORT_SYMBOL_GPL(wmi_install_notify_handler);
585
586/**
587 * wmi_uninstall_notify_handler - Unregister handler for WMI events
588 *
589 * Unregister handler for events sent to the ACPI-WMI mapper device.
590 */
591acpi_status wmi_remove_notify_handler(const char *guid)
592{
593	struct wmi_block *block;
594	acpi_status status = AE_NOT_EXIST;
595	char tmp[16], guid_input[16];
596	struct list_head *p;
597
598	if (!guid)
599		return AE_BAD_PARAMETER;
600
601	wmi_parse_guid(guid, tmp);
602	wmi_swap_bytes(tmp, guid_input);
603
604	list_for_each(p, &wmi_block_list) {
605		acpi_status wmi_status;
606		block = list_entry(p, struct wmi_block, list);
607
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;
612
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;
624			}
625		}
626	}
627
628	return status;
629}
630EXPORT_SYMBOL_GPL(wmi_remove_notify_handler);
631
632/**
633 * wmi_get_event_data - Get WMI data associated with an event
634 *
635 * @event: Event to find
636 * @out: Buffer to hold event data. out->pointer should be freed with kfree()
637 *
638 * Returns extra data associated with an event in WMI.
639 */
640acpi_status wmi_get_event_data(u32 event, struct acpi_buffer *out)
641{
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;
647
648	input.count = 1;
649	input.pointer = params;
650	params[0].type = ACPI_TYPE_INTEGER;
651	params[0].integer.value = event;
652
653	list_for_each(p, &wmi_block_list) {
654		wblock = list_entry(p, struct wmi_block, list);
655		gblock = &wblock->gblock;
656
657		if ((gblock->flags & ACPI_WMI_EVENT) &&
658			(gblock->notify_id == event))
659			return acpi_evaluate_object(wblock->handle, "_WED",
660				&input, out);
661	}
662
663	return AE_NOT_FOUND;
664}
665EXPORT_SYMBOL_GPL(wmi_get_event_data);
666
667/**
668 * wmi_has_guid - Check if a GUID is available
669 * @guid_string: 36 char string of the form fa50ff2b-f2e8-45de-83fa-65417f2f49ba
670 *
671 * Check if a given GUID is defined by _WDG
672 */
673bool wmi_has_guid(const char *guid_string)
674{
675	return find_guid(guid_string, NULL);
676}
677EXPORT_SYMBOL_GPL(wmi_has_guid);
678
679/*
680 * sysfs interface
681 */
682static ssize_t modalias_show(struct device *dev, struct device_attribute *attr,
683			     char *buf)
684{
685	char guid_string[37];
686	struct wmi_block *wblock;
687
688	wblock = dev_get_drvdata(dev);
689	if (!wblock)
690		return -ENOMEM;
691
692	wmi_gtoa(wblock->gblock.guid, guid_string);
693
694	return sprintf(buf, "wmi:%s\n", guid_string);
695}
696
697static struct device_attribute wmi_dev_attrs[] = {
698	__ATTR_RO(modalias),
699	__ATTR_NULL
700};
701
702static int wmi_dev_uevent(struct device *dev, struct kobj_uevent_env *env)
703{
704	char guid_string[37];
705
706	struct wmi_block *wblock;
707
708	if (add_uevent_var(env, "MODALIAS="))
709		return -ENOMEM;
710
711	wblock = dev_get_drvdata(dev);
712	if (!wblock)
713		return -ENOMEM;
714
715	wmi_gtoa(wblock->gblock.guid, guid_string);
716
717	strcpy(&env->buf[env->buflen - 1], "wmi:");
718	memcpy(&env->buf[env->buflen - 1 + 4], guid_string, 36);
719	env->buflen += 40;
720
721	return 0;
722}
723
724static void wmi_dev_free(struct device *dev)
725{
726	struct wmi_block *wmi_block = container_of(dev, struct wmi_block, dev);
727
728	kfree(wmi_block);
729}
730
731static 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,
736};
737
738static int wmi_create_device(const struct guid_block *gblock,
739			     struct wmi_block *wblock, acpi_handle handle)
740{
741	char guid_string[37];
742
743	wblock->dev.class = &wmi_class;
744
745	wmi_gtoa(gblock->guid, guid_string);
746	dev_set_name(&wblock->dev, guid_string);
747
748	dev_set_drvdata(&wblock->dev, wblock);
749
750	return device_register(&wblock->dev);
751}
752
753static void wmi_free_devices(void)
754{
755	struct wmi_block *wblock, *next;
756
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);
764	}
765}
766
767static bool guid_already_parsed(const char *guid_string)
768{
769	struct wmi_block *wblock;
770
771	list_for_each_entry(wblock, &wmi_block_list, list)
772		if (memcmp(wblock->gblock.guid, guid_string, 16) == 0)
773			return true;
774
775	return false;
776}
777
778/*
779 * Parse the _WDG method for the GUID data blocks
780 */
781static acpi_status parse_wdg(acpi_handle handle)
782{
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;
790
791	status = acpi_evaluate_object(handle, "_WDG", NULL, &out);
792	if (ACPI_FAILURE(status))
793		return -ENXIO;
794
795	obj = (union acpi_object *) out.pointer;
796	if (!obj)
797		return -ENXIO;
798
799	if (obj->type != ACPI_TYPE_BUFFER) {
800		retval = -ENXIO;
801		goto out_free_pointer;
802	}
803
804	gblock = (const struct guid_block *)obj->buffer.pointer;
805	total = obj->buffer.length / sizeof(struct guid_block);
806
807	for (i = 0; i < total; i++) {
808		if (debug_dump_wdg)
809			wmi_dump_wdg(&gblock[i]);
810
811		wblock = kzalloc(sizeof(struct wmi_block), GFP_KERNEL);
812		if (!wblock)
813			return AE_NO_MEMORY;
814
815		wblock->handle = handle;
816		wblock->gblock = gblock[i];
817
818		/*
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.
823		*/
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;
829			}
830		}
831
832		list_add_tail(&wblock->list, &wmi_block_list);
833
834		if (debug_event) {
835			wblock->handler = wmi_notify_debug;
836			wmi_method_enable(wblock, 1);
837		}
838	}
839
840	retval = 0;
841
842out_free_pointer:
843	kfree(out.pointer);
844
845	return retval;
846}
847
848/*
849 * WMI can have EmbeddedControl access regions. In which case, we just want to
850 * hand these off to the EC driver.
851 */
852static acpi_status
853acpi_wmi_ec_space_handler(u32 function, acpi_physical_address address,
854		      u32 bits, u64 *value,
855		      void *handler_context, void *region_context)
856{
857	int result = 0, i = 0;
858	u8 temp = 0;
859
860	if ((address > 0xFF) || !value)
861		return AE_BAD_PARAMETER;
862
863	if (function != ACPI_READ && function != ACPI_WRITE)
864		return AE_BAD_PARAMETER;
865
866	if (bits != 8)
867		return AE_BAD_PARAMETER;
868
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);
875	}
876
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;
889	}
890}
891
892static void acpi_wmi_notify(struct acpi_device *device, u32 event)
893{
894	struct guid_block *block;
895	struct wmi_block *wblock;
896	struct list_head *p;
897	char guid_string[37];
898
899	list_for_each(p, &wmi_block_list) {
900		wblock = list_entry(p, struct wmi_block, list);
901		block = &wblock->gblock;
902
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);
910			}
911
912			acpi_bus_generate_netlink_event(
913				device->pnp.device_class, dev_name(&device->dev),
914				event, 0);
915			break;
916		}
917	}
918}
919
920static int acpi_wmi_remove(struct acpi_device *device, int type)
921{
922	acpi_remove_address_space_handler(device->handle,
923				ACPI_ADR_SPACE_EC, &acpi_wmi_ec_space_handler);
924	wmi_free_devices();
925
926	return 0;
927}
928
929static int acpi_wmi_add(struct acpi_device *device)
930{
931	acpi_status status;
932	int error;
933
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;
941	}
942
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;
950	}
951
952	return 0;
953}
954
955static int __init acpi_wmi_init(void)
956{
957	int error;
958
959	if (acpi_disabled)
960		return -ENODEV;
961
962	error = class_register(&wmi_class);
963	if (error)
964		return error;
965
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;
971	}
972
973	pr_info("Mapper loaded\n");
974	return 0;
975}
976
977static void __exit acpi_wmi_exit(void)
978{
979	acpi_bus_unregister_driver(&acpi_wmi_driver);
980	class_unregister(&wmi_class);
981
982	pr_info("Mapper unloaded\n");
983}
984
985subsys_initcall(acpi_wmi_init);
986module_exit(acpi_wmi_exit);