hp-wmi.c 17.5 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28
/*
 * HP WMI hotkeys
 *
 * Copyright (C) 2008 Red Hat <mjg@redhat.com>
 *
 * Portions based on wistron_btns.c:
 * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
 * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
 * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
29
#include <linux/slab.h>
30 31
#include <linux/types.h>
#include <linux/input.h>
32
#include <linux/input/sparse-keymap.h>
33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50
#include <linux/platform_device.h>
#include <linux/acpi.h>
#include <linux/rfkill.h>
#include <linux/string.h>

MODULE_AUTHOR("Matthew Garrett <mjg59@srcf.ucam.org>");
MODULE_DESCRIPTION("HP laptop WMI hotkeys driver");
MODULE_LICENSE("GPL");

MODULE_ALIAS("wmi:95F24279-4D7B-4334-9387-ACCDC67EF61C");
MODULE_ALIAS("wmi:5FB7F034-2C63-45e9-BE91-3D44E2C707E4");

#define HPWMI_EVENT_GUID "95F24279-4D7B-4334-9387-ACCDC67EF61C"
#define HPWMI_BIOS_GUID "5FB7F034-2C63-45e9-BE91-3D44E2C707E4"

#define HPWMI_DISPLAY_QUERY 0x1
#define HPWMI_HDDTEMP_QUERY 0x2
#define HPWMI_ALS_QUERY 0x3
51
#define HPWMI_HARDWARE_QUERY 0x4
52
#define HPWMI_WIRELESS_QUERY 0x5
53
#define HPWMI_HOTKEY_QUERY 0xc
54

55
#define PREFIX "HP WMI: "
56
#define UNIMP "Unimplemented "
57

A
Alan Jenkins 已提交
58 59 60 61 62 63
enum hp_wmi_radio {
	HPWMI_WIFI = 0,
	HPWMI_BLUETOOTH = 1,
	HPWMI_WWAN = 2,
};

64 65
enum hp_wmi_event_ids {
	HPWMI_DOCK_EVENT = 1,
66 67
	HPWMI_PARK_HDD = 2,
	HPWMI_SMART_ADAPTER = 3,
68 69
	HPWMI_BEZEL_BUTTON = 4,
	HPWMI_WIRELESS = 5,
70 71
	HPWMI_CPU_BATTERY_THROTTLE = 6,
	HPWMI_LOCK_SWITCH = 7,
72 73
};

74
static int __devinit hp_wmi_bios_setup(struct platform_device *device);
75
static int __exit hp_wmi_bios_remove(struct platform_device *device);
F
Frans Pop 已提交
76
static int hp_wmi_resume_handler(struct device *device);
77 78 79 80 81 82

struct bios_args {
	u32 signature;
	u32 command;
	u32 commandtype;
	u32 datasize;
M
Matthew Garrett 已提交
83
	u32 data;
84 85 86 87 88
};

struct bios_return {
	u32 sigpass;
	u32 return_code;
M
Matthew Garrett 已提交
89
	u32 value;
90 91
};

92 93 94 95 96 97 98
enum hp_return_value {
	HPWMI_RET_WRONG_SIGNATURE	= 0x02,
	HPWMI_RET_UNKNOWN_COMMAND	= 0x03,
	HPWMI_RET_UNKNOWN_CMDTYPE	= 0x04,
	HPWMI_RET_INVALID_PARAMETERS	= 0x05,
};

99 100 101 102 103 104 105 106 107 108
static const struct key_entry hp_wmi_keymap[] = {
	{ KE_KEY, 0x02,   { KEY_BRIGHTNESSUP } },
	{ KE_KEY, 0x03,   { KEY_BRIGHTNESSDOWN } },
	{ KE_KEY, 0x20e6, { KEY_PROG1 } },
	{ KE_KEY, 0x20e8, { KEY_MEDIA } },
	{ KE_KEY, 0x2142, { KEY_MEDIA } },
	{ KE_KEY, 0x213b, { KEY_INFO } },
	{ KE_KEY, 0x2169, { KEY_DIRECTION } },
	{ KE_KEY, 0x231b, { KEY_HELP } },
	{ KE_END, 0 }
109 110 111 112 113 114 115 116 117
};

static struct input_dev *hp_wmi_input_dev;
static struct platform_device *hp_wmi_platform_dev;

static struct rfkill *wifi_rfkill;
static struct rfkill *bluetooth_rfkill;
static struct rfkill *wwan_rfkill;

118
static const struct dev_pm_ops hp_wmi_pm_ops = {
F
Frans Pop 已提交
119 120 121 122
	.resume  = hp_wmi_resume_handler,
	.restore  = hp_wmi_resume_handler,
};

123 124
static struct platform_driver hp_wmi_driver = {
	.driver = {
F
Frans Pop 已提交
125 126 127
		.name = "hp-wmi",
		.owner = THIS_MODULE,
		.pm = &hp_wmi_pm_ops,
128 129 130 131 132
	},
	.probe = hp_wmi_bios_setup,
	.remove = hp_wmi_bios_remove,
};

133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151
/*
 * hp_wmi_perform_query
 *
 * query:	The commandtype -> What should be queried
 * write:	The command -> 0 read, 1 write, 3 ODM specific
 * buffer:	Buffer used as input and/or output
 * buffersize:	Size of buffer
 *
 * returns zero on success
 *         an HP WMI query specific error code (which is positive)
 *         -EINVAL if the query was not successful at all
 *         -EINVAL if the output buffer size exceeds buffersize
 *
 * Note: The buffersize must at least be the maximum of the input and output
 *       size. E.g. Battery info query (0x7) is defined to have 1 byte input
 *       and 128 byte output. The caller would do:
 *       buffer = kzalloc(128, GFP_KERNEL);
 *       ret = hp_wmi_perform_query(0x7, 0, buffer, 128)
 */
M
Matthew Garrett 已提交
152
static int hp_wmi_perform_query(int query, int write, u32 *buffer,
153
				int buffersize)
154 155 156 157 158 159 160 161
{
	struct bios_return bios_return;
	acpi_status status;
	union acpi_object *obj;
	struct bios_args args = {
		.signature = 0x55434553,
		.command = write ? 0x2 : 0x1,
		.commandtype = query,
162
		.datasize = buffersize,
M
Matthew Garrett 已提交
163
		.data = *buffer,
164 165 166 167 168 169 170 171
	};
	struct acpi_buffer input = { sizeof(struct bios_args), &args };
	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };

	status = wmi_evaluate_method(HPWMI_BIOS_GUID, 0, 0x3, &input, &output);

	obj = output.pointer;

T
Thomas Renninger 已提交
172
	if (!obj)
173
		return -EINVAL;
T
Thomas Renninger 已提交
174 175 176 177
	else if (obj->type != ACPI_TYPE_BUFFER) {
		kfree(obj);
		return -EINVAL;
	}
178 179

	bios_return = *((struct bios_return *)obj->buffer.pointer);
180

181 182 183 184 185 186 187 188 189
	if (bios_return.return_code) {
		if (bios_return.return_code != HPWMI_RET_UNKNOWN_CMDTYPE)
			printk(KERN_WARNING PREFIX "query 0x%x returned "
						   "error 0x%x\n",
			       query, bios_return.return_code);
		kfree(obj);
		return bios_return.return_code;
	}

M
Matthew Garrett 已提交
190
	memcpy(buffer, &bios_return.value, sizeof(bios_return.value));
191 192

	kfree(obj);
193
	return 0;
194 195 196 197
}

static int hp_wmi_display_state(void)
{
M
Matthew Garrett 已提交
198 199
	int state = 0;
	int ret = hp_wmi_perform_query(HPWMI_DISPLAY_QUERY, 0, &state,
200 201 202 203
				       sizeof(state));
	if (ret)
		return -EINVAL;
	return state;
204 205 206 207
}

static int hp_wmi_hddtemp_state(void)
{
M
Matthew Garrett 已提交
208 209
	int state = 0;
	int ret = hp_wmi_perform_query(HPWMI_HDDTEMP_QUERY, 0, &state,
210 211 212 213
				       sizeof(state));
	if (ret)
		return -EINVAL;
	return state;
214 215 216 217
}

static int hp_wmi_als_state(void)
{
M
Matthew Garrett 已提交
218 219
	int state = 0;
	int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 0, &state,
220 221 222 223
				       sizeof(state));
	if (ret)
		return -EINVAL;
	return state;
224 225 226 227
}

static int hp_wmi_dock_state(void)
{
M
Matthew Garrett 已提交
228 229
	int state = 0;
	int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
230
				       sizeof(state));
231

232 233
	if (ret)
		return -EINVAL;
234

235
	return state & 0x1;
236 237
}

238
static int hp_wmi_tablet_state(void)
239
{
M
Matthew Garrett 已提交
240 241
	int state = 0;
	int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
242 243
				       sizeof(state));
	if (ret)
244 245
		return ret;

246
	return (state & 0x4) ? 1 : 0;
247 248
}

J
Johannes Berg 已提交
249
static int hp_wmi_set_block(void *data, bool blocked)
250
{
A
Alan Jenkins 已提交
251 252
	enum hp_wmi_radio r = (enum hp_wmi_radio) data;
	int query = BIT(r + 8) | ((!blocked) << r);
253
	int ret;
254

255
	ret = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1,
M
Matthew Garrett 已提交
256
				   &query, sizeof(query));
257 258 259
	if (ret)
		return -EINVAL;
	return 0;
260 261
}

J
Johannes Berg 已提交
262 263 264
static const struct rfkill_ops hp_wmi_rfkill_ops = {
	.set_block = hp_wmi_set_block,
};
265

A
Alan Jenkins 已提交
266
static bool hp_wmi_get_sw_state(enum hp_wmi_radio r)
267
{
M
Matthew Garrett 已提交
268
	int wireless = 0;
269 270
	int mask;
	hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
M
Matthew Garrett 已提交
271
			     &wireless, sizeof(wireless));
272 273 274
	/* TBD: Pass error */

	mask = 0x200 << (r * 8);
275

A
Alan Jenkins 已提交
276
	if (wireless & mask)
J
Johannes Berg 已提交
277
		return false;
278
	else
J
Johannes Berg 已提交
279
		return true;
280 281
}

A
Alan Jenkins 已提交
282
static bool hp_wmi_get_hw_state(enum hp_wmi_radio r)
283
{
M
Matthew Garrett 已提交
284
	int wireless = 0;
285 286
	int mask;
	hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
M
Matthew Garrett 已提交
287
			     &wireless, sizeof(wireless));
288 289 290
	/* TBD: Pass error */

	mask = 0x800 << (r * 8);
291

A
Alan Jenkins 已提交
292
	if (wireless & mask)
J
Johannes Berg 已提交
293
		return false;
294
	else
J
Johannes Berg 已提交
295
		return true;
296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333
}

static ssize_t show_display(struct device *dev, struct device_attribute *attr,
			    char *buf)
{
	int value = hp_wmi_display_state();
	if (value < 0)
		return -EINVAL;
	return sprintf(buf, "%d\n", value);
}

static ssize_t show_hddtemp(struct device *dev, struct device_attribute *attr,
			    char *buf)
{
	int value = hp_wmi_hddtemp_state();
	if (value < 0)
		return -EINVAL;
	return sprintf(buf, "%d\n", value);
}

static ssize_t show_als(struct device *dev, struct device_attribute *attr,
			char *buf)
{
	int value = hp_wmi_als_state();
	if (value < 0)
		return -EINVAL;
	return sprintf(buf, "%d\n", value);
}

static ssize_t show_dock(struct device *dev, struct device_attribute *attr,
			 char *buf)
{
	int value = hp_wmi_dock_state();
	if (value < 0)
		return -EINVAL;
	return sprintf(buf, "%d\n", value);
}

334 335 336 337 338 339 340 341 342
static ssize_t show_tablet(struct device *dev, struct device_attribute *attr,
			 char *buf)
{
	int value = hp_wmi_tablet_state();
	if (value < 0)
		return -EINVAL;
	return sprintf(buf, "%d\n", value);
}

343 344 345 346
static ssize_t set_als(struct device *dev, struct device_attribute *attr,
		       const char *buf, size_t count)
{
	u32 tmp = simple_strtoul(buf, NULL, 10);
M
Matthew Garrett 已提交
347
	int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 1, &tmp,
348 349 350 351
				       sizeof(tmp));
	if (ret)
		return -EINVAL;

352 353 354 355 356 357 358
	return count;
}

static DEVICE_ATTR(display, S_IRUGO, show_display, NULL);
static DEVICE_ATTR(hddtemp, S_IRUGO, show_hddtemp, NULL);
static DEVICE_ATTR(als, S_IRUGO | S_IWUSR, show_als, set_als);
static DEVICE_ATTR(dock, S_IRUGO, show_dock, NULL);
359
static DEVICE_ATTR(tablet, S_IRUGO, show_tablet, NULL);
360

A
Adrian Bunk 已提交
361
static void hp_wmi_notify(u32 value, void *context)
362 363 364
{
	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
365
	u32 event_id, event_data;
M
Matthew Garrett 已提交
366
	int key_code = 0, ret;
367
	u32 *location;
368
	acpi_status status;
369

370 371
	status = wmi_get_event_data(value, &response);
	if (status != AE_OK) {
372
		printk(KERN_INFO PREFIX "bad event status 0x%x\n", status);
373 374
		return;
	}
375 376 377

	obj = (union acpi_object *)response.pointer;

378 379 380
	if (!obj)
		return;
	if (obj->type != ACPI_TYPE_BUFFER) {
381 382
		printk(KERN_INFO "hp-wmi: Unknown response received %d\n",
		       obj->type);
T
Thomas Renninger 已提交
383
		kfree(obj);
A
Alan Jenkins 已提交
384 385 386
		return;
	}

387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403
	/*
	 * Depending on ACPI version the concatenation of id and event data
	 * inside _WED function will result in a 8 or 16 byte buffer.
	 */
	location = (u32 *)obj->buffer.pointer;
	if (obj->buffer.length == 8) {
		event_id = *location;
		event_data = *(location + 1);
	} else if (obj->buffer.length == 16) {
		event_id = *location;
		event_data = *(location + 2);
	} else {
		printk(KERN_INFO "hp-wmi: Unknown buffer length %d\n",
		       obj->buffer.length);
		kfree(obj);
		return;
	}
T
Thomas Renninger 已提交
404
	kfree(obj);
405 406

	switch (event_id) {
407
	case HPWMI_DOCK_EVENT:
A
Alan Jenkins 已提交
408 409 410 411 412
		input_report_switch(hp_wmi_input_dev, SW_DOCK,
				    hp_wmi_dock_state());
		input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
				    hp_wmi_tablet_state());
		input_sync(hp_wmi_input_dev);
413
		break;
414 415 416 417
	case HPWMI_PARK_HDD:
		break;
	case HPWMI_SMART_ADAPTER:
		break;
418
	case HPWMI_BEZEL_BUTTON:
419
		ret = hp_wmi_perform_query(HPWMI_HOTKEY_QUERY, 0,
M
Matthew Garrett 已提交
420
					   &key_code,
421 422 423
					   sizeof(key_code));
		if (ret)
			break;
424 425 426

		if (!sparse_keymap_report_event(hp_wmi_input_dev,
						key_code, 1, true))
427
			printk(KERN_INFO PREFIX "Unknown key code - 0x%x\n",
428
			       key_code);
429 430
		break;
	case HPWMI_WIRELESS:
A
Alan Jenkins 已提交
431 432 433 434 435 436 437 438 439 440 441 442
		if (wifi_rfkill)
			rfkill_set_states(wifi_rfkill,
					  hp_wmi_get_sw_state(HPWMI_WIFI),
					  hp_wmi_get_hw_state(HPWMI_WIFI));
		if (bluetooth_rfkill)
			rfkill_set_states(bluetooth_rfkill,
					  hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
					  hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
		if (wwan_rfkill)
			rfkill_set_states(wwan_rfkill,
					  hp_wmi_get_sw_state(HPWMI_WWAN),
					  hp_wmi_get_hw_state(HPWMI_WWAN));
443
		break;
444 445 446 447 448 449
	case HPWMI_CPU_BATTERY_THROTTLE:
		printk(KERN_INFO PREFIX UNIMP "CPU throttle because of 3 Cell"
		       " battery event detected\n");
		break;
	case HPWMI_LOCK_SWITCH:
		break;
450
	default:
451 452
		printk(KERN_INFO PREFIX "Unknown event_id - %d - 0x%x\n",
		       event_id, event_data);
453 454
		break;
	}
455 456 457 458
}

static int __init hp_wmi_input_setup(void)
{
459
	acpi_status status;
460 461 462
	int err;

	hp_wmi_input_dev = input_allocate_device();
463 464
	if (!hp_wmi_input_dev)
		return -ENOMEM;
465 466 467 468 469

	hp_wmi_input_dev->name = "HP WMI hotkeys";
	hp_wmi_input_dev->phys = "wmi/input0";
	hp_wmi_input_dev->id.bustype = BUS_HOST;

470 471 472 473 474 475 476
	__set_bit(EV_SW, hp_wmi_input_dev->evbit);
	__set_bit(SW_DOCK, hp_wmi_input_dev->swbit);
	__set_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit);

	err = sparse_keymap_setup(hp_wmi_input_dev, hp_wmi_keymap, NULL);
	if (err)
		goto err_free_dev;
477 478 479 480 481 482 483

	/* Set initial hardware state */
	input_report_switch(hp_wmi_input_dev, SW_DOCK, hp_wmi_dock_state());
	input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
			    hp_wmi_tablet_state());
	input_sync(hp_wmi_input_dev);

484 485 486 487
	status = wmi_install_notify_handler(HPWMI_EVENT_GUID, hp_wmi_notify, NULL);
	if (ACPI_FAILURE(status)) {
		err = -EIO;
		goto err_free_keymap;
488 489
	}

490 491 492 493
	err = input_register_device(hp_wmi_input_dev);
	if (err)
		goto err_uninstall_notifier;

494
	return 0;
495 496 497 498 499 500 501 502 503 504 505 506 507 508 509

 err_uninstall_notifier:
	wmi_remove_notify_handler(HPWMI_EVENT_GUID);
 err_free_keymap:
	sparse_keymap_free(hp_wmi_input_dev);
 err_free_dev:
	input_free_device(hp_wmi_input_dev);
	return err;
}

static void hp_wmi_input_destroy(void)
{
	wmi_remove_notify_handler(HPWMI_EVENT_GUID);
	sparse_keymap_free(hp_wmi_input_dev);
	input_unregister_device(hp_wmi_input_dev);
510 511 512 513 514 515 516 517
}

static void cleanup_sysfs(struct platform_device *device)
{
	device_remove_file(&device->dev, &dev_attr_display);
	device_remove_file(&device->dev, &dev_attr_hddtemp);
	device_remove_file(&device->dev, &dev_attr_als);
	device_remove_file(&device->dev, &dev_attr_dock);
518
	device_remove_file(&device->dev, &dev_attr_tablet);
519 520
}

521
static int __devinit hp_wmi_bios_setup(struct platform_device *device)
522 523
{
	int err;
M
Matthew Garrett 已提交
524
	int wireless = 0;
525

M
Matthew Garrett 已提交
526
	err = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0, &wireless,
527 528 529
				   sizeof(wireless));
	if (err)
		return err;
530 531 532 533 534 535 536 537 538 539 540

	err = device_create_file(&device->dev, &dev_attr_display);
	if (err)
		goto add_sysfs_error;
	err = device_create_file(&device->dev, &dev_attr_hddtemp);
	if (err)
		goto add_sysfs_error;
	err = device_create_file(&device->dev, &dev_attr_als);
	if (err)
		goto add_sysfs_error;
	err = device_create_file(&device->dev, &dev_attr_dock);
541 542 543
	if (err)
		goto add_sysfs_error;
	err = device_create_file(&device->dev, &dev_attr_tablet);
544 545 546
	if (err)
		goto add_sysfs_error;

547
	if (wireless & 0x1) {
J
Johannes Berg 已提交
548 549 550
		wifi_rfkill = rfkill_alloc("hp-wifi", &device->dev,
					   RFKILL_TYPE_WLAN,
					   &hp_wmi_rfkill_ops,
A
Alan Jenkins 已提交
551 552 553 554 555
					   (void *) HPWMI_WIFI);
		rfkill_init_sw_state(wifi_rfkill,
				     hp_wmi_get_sw_state(HPWMI_WIFI));
		rfkill_set_hw_state(wifi_rfkill,
				    hp_wmi_get_hw_state(HPWMI_WIFI));
556 557
		err = rfkill_register(wifi_rfkill);
		if (err)
J
Johannes Berg 已提交
558
			goto register_wifi_error;
559 560 561
	}

	if (wireless & 0x2) {
J
Johannes Berg 已提交
562 563 564
		bluetooth_rfkill = rfkill_alloc("hp-bluetooth", &device->dev,
						RFKILL_TYPE_BLUETOOTH,
						&hp_wmi_rfkill_ops,
A
Alan Jenkins 已提交
565 566 567 568 569
						(void *) HPWMI_BLUETOOTH);
		rfkill_init_sw_state(bluetooth_rfkill,
				     hp_wmi_get_sw_state(HPWMI_BLUETOOTH));
		rfkill_set_hw_state(bluetooth_rfkill,
				    hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
570
		err = rfkill_register(bluetooth_rfkill);
571
		if (err)
572
			goto register_bluetooth_error;
573 574 575
	}

	if (wireless & 0x4) {
J
Johannes Berg 已提交
576 577 578
		wwan_rfkill = rfkill_alloc("hp-wwan", &device->dev,
					   RFKILL_TYPE_WWAN,
					   &hp_wmi_rfkill_ops,
A
Alan Jenkins 已提交
579 580 581 582 583
					   (void *) HPWMI_WWAN);
		rfkill_init_sw_state(wwan_rfkill,
				     hp_wmi_get_sw_state(HPWMI_WWAN));
		rfkill_set_hw_state(wwan_rfkill,
				    hp_wmi_get_hw_state(HPWMI_WWAN));
584 585 586
		err = rfkill_register(wwan_rfkill);
		if (err)
			goto register_wwan_err;
587
	}
588 589

	return 0;
590
register_wwan_err:
J
Johannes Berg 已提交
591
	rfkill_destroy(wwan_rfkill);
592 593
	if (bluetooth_rfkill)
		rfkill_unregister(bluetooth_rfkill);
594
register_bluetooth_error:
J
Johannes Berg 已提交
595
	rfkill_destroy(bluetooth_rfkill);
596 597
	if (wifi_rfkill)
		rfkill_unregister(wifi_rfkill);
J
Johannes Berg 已提交
598 599
register_wifi_error:
	rfkill_destroy(wifi_rfkill);
600 601 602 603 604 605 606 607 608
add_sysfs_error:
	cleanup_sysfs(device);
	return err;
}

static int __exit hp_wmi_bios_remove(struct platform_device *device)
{
	cleanup_sysfs(device);

J
Johannes Berg 已提交
609
	if (wifi_rfkill) {
610
		rfkill_unregister(wifi_rfkill);
J
Johannes Berg 已提交
611 612 613
		rfkill_destroy(wifi_rfkill);
	}
	if (bluetooth_rfkill) {
614
		rfkill_unregister(bluetooth_rfkill);
615
		rfkill_destroy(bluetooth_rfkill);
J
Johannes Berg 已提交
616 617
	}
	if (wwan_rfkill) {
618
		rfkill_unregister(wwan_rfkill);
J
Johannes Berg 已提交
619 620
		rfkill_destroy(wwan_rfkill);
	}
621 622 623 624

	return 0;
}

F
Frans Pop 已提交
625
static int hp_wmi_resume_handler(struct device *device)
626 627
{
	/*
628 629
	 * Hardware state may have changed while suspended, so trigger
	 * input events for the current state. As this is a switch,
630 631 632
	 * the input layer will only actually pass it on if the state
	 * changed.
	 */
633 634 635 636 637 638 639
	if (hp_wmi_input_dev) {
		input_report_switch(hp_wmi_input_dev, SW_DOCK,
				    hp_wmi_dock_state());
		input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
				    hp_wmi_tablet_state());
		input_sync(hp_wmi_input_dev);
	}
640

A
Alan Jenkins 已提交
641 642 643 644 645 646 647 648 649 650 651 652 653
	if (wifi_rfkill)
		rfkill_set_states(wifi_rfkill,
				  hp_wmi_get_sw_state(HPWMI_WIFI),
				  hp_wmi_get_hw_state(HPWMI_WIFI));
	if (bluetooth_rfkill)
		rfkill_set_states(bluetooth_rfkill,
				  hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
				  hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
	if (wwan_rfkill)
		rfkill_set_states(wwan_rfkill,
				  hp_wmi_get_sw_state(HPWMI_WWAN),
				  hp_wmi_get_hw_state(HPWMI_WWAN));

654 655 656
	return 0;
}

657 658 659
static int __init hp_wmi_init(void)
{
	int err;
660 661
	int event_capable = wmi_has_guid(HPWMI_EVENT_GUID);
	int bios_capable = wmi_has_guid(HPWMI_BIOS_GUID);
662

663
	if (event_capable) {
664
		err = hp_wmi_input_setup();
665
		if (err)
666
			return err;
667 668
	}

669
	if (bios_capable) {
670 671
		err = platform_driver_register(&hp_wmi_driver);
		if (err)
672
			goto err_driver_reg;
673 674
		hp_wmi_platform_dev = platform_device_alloc("hp-wmi", -1);
		if (!hp_wmi_platform_dev) {
675 676
			err = -ENOMEM;
			goto err_device_alloc;
677
		}
678 679 680
		err = platform_device_add(hp_wmi_platform_dev);
		if (err)
			goto err_device_add;
681 682
	}

683 684 685
	if (!bios_capable && !event_capable)
		return -ENODEV;

686
	return 0;
687 688 689 690 691 692

err_device_add:
	platform_device_put(hp_wmi_platform_dev);
err_device_alloc:
	platform_driver_unregister(&hp_wmi_driver);
err_driver_reg:
693 694
	if (event_capable)
		hp_wmi_input_destroy();
695 696

	return err;
697 698 699 700
}

static void __exit hp_wmi_exit(void)
{
701 702 703
	if (wmi_has_guid(HPWMI_EVENT_GUID))
		hp_wmi_input_destroy();

704
	if (hp_wmi_platform_dev) {
705
		platform_device_unregister(hp_wmi_platform_dev);
706 707 708 709 710 711
		platform_driver_unregister(&hp_wmi_driver);
	}
}

module_init(hp_wmi_init);
module_exit(hp_wmi_exit);