Linux Audio

Check our new training course

Loading...
v4.6
 
   1/*
   2 * HP WMI hotkeys
   3 *
   4 * Copyright (C) 2008 Red Hat <mjg@redhat.com>
   5 * Copyright (C) 2010, 2011 Anssi Hannula <anssi.hannula@iki.fi>
   6 *
   7 * Portions based on wistron_btns.c:
   8 * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
   9 * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
  10 * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
  11 *
  12 *  This program is free software; you can redistribute it and/or modify
  13 *  it under the terms of the GNU General Public License as published by
  14 *  the Free Software Foundation; either version 2 of the License, or
  15 *  (at your option) any later version.
  16 *
  17 *  This program is distributed in the hope that it will be useful,
  18 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  19 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20 *  GNU General Public License for more details.
  21 *
  22 *  You should have received a copy of the GNU General Public License
  23 *  along with this program; if not, write to the Free Software
  24 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  25 */
  26
  27#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  28
  29#include <linux/kernel.h>
  30#include <linux/module.h>
  31#include <linux/init.h>
  32#include <linux/slab.h>
  33#include <linux/types.h>
  34#include <linux/input.h>
  35#include <linux/input/sparse-keymap.h>
  36#include <linux/platform_device.h>
  37#include <linux/acpi.h>
  38#include <linux/rfkill.h>
  39#include <linux/string.h>
  40
  41MODULE_AUTHOR("Matthew Garrett <mjg59@srcf.ucam.org>");
  42MODULE_DESCRIPTION("HP laptop WMI hotkeys driver");
  43MODULE_LICENSE("GPL");
  44
  45MODULE_ALIAS("wmi:95F24279-4D7B-4334-9387-ACCDC67EF61C");
  46MODULE_ALIAS("wmi:5FB7F034-2C63-45e9-BE91-3D44E2C707E4");
  47
  48#define HPWMI_EVENT_GUID "95F24279-4D7B-4334-9387-ACCDC67EF61C"
  49#define HPWMI_BIOS_GUID "5FB7F034-2C63-45e9-BE91-3D44E2C707E4"
  50
  51#define HPWMI_DISPLAY_QUERY 0x1
  52#define HPWMI_HDDTEMP_QUERY 0x2
  53#define HPWMI_ALS_QUERY 0x3
  54#define HPWMI_HARDWARE_QUERY 0x4
  55#define HPWMI_WIRELESS_QUERY 0x5
  56#define HPWMI_BIOS_QUERY 0x9
  57#define HPWMI_FEATURE_QUERY 0xb
  58#define HPWMI_HOTKEY_QUERY 0xc
  59#define HPWMI_FEATURE2_QUERY 0xd
  60#define HPWMI_WIRELESS2_QUERY 0x1b
  61#define HPWMI_POSTCODEERROR_QUERY 0x2a
  62
  63enum hp_wmi_radio {
  64	HPWMI_WIFI = 0,
  65	HPWMI_BLUETOOTH = 1,
  66	HPWMI_WWAN = 2,
  67	HPWMI_GPS = 3,
  68};
  69
  70enum hp_wmi_event_ids {
  71	HPWMI_DOCK_EVENT = 1,
  72	HPWMI_PARK_HDD = 2,
  73	HPWMI_SMART_ADAPTER = 3,
  74	HPWMI_BEZEL_BUTTON = 4,
  75	HPWMI_WIRELESS = 5,
  76	HPWMI_CPU_BATTERY_THROTTLE = 6,
  77	HPWMI_LOCK_SWITCH = 7,
  78	HPWMI_LID_SWITCH = 8,
  79	HPWMI_SCREEN_ROTATION = 9,
  80	HPWMI_COOLSENSE_SYSTEM_MOBILE = 0x0A,
  81	HPWMI_COOLSENSE_SYSTEM_HOT = 0x0B,
  82	HPWMI_PROXIMITY_SENSOR = 0x0C,
  83	HPWMI_BACKLIT_KB_BRIGHTNESS = 0x0D,
  84	HPWMI_PEAKSHIFT_PERIOD = 0x0F,
  85	HPWMI_BATTERY_CHARGE_PERIOD = 0x10,
  86};
  87
  88struct bios_args {
  89	u32 signature;
  90	u32 command;
  91	u32 commandtype;
  92	u32 datasize;
  93	u32 data;
  94};
  95
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  96struct bios_return {
  97	u32 sigpass;
  98	u32 return_code;
  99};
 100
 101enum hp_return_value {
 102	HPWMI_RET_WRONG_SIGNATURE	= 0x02,
 103	HPWMI_RET_UNKNOWN_COMMAND	= 0x03,
 104	HPWMI_RET_UNKNOWN_CMDTYPE	= 0x04,
 105	HPWMI_RET_INVALID_PARAMETERS	= 0x05,
 106};
 107
 108enum hp_wireless2_bits {
 109	HPWMI_POWER_STATE	= 0x01,
 110	HPWMI_POWER_SOFT	= 0x02,
 111	HPWMI_POWER_BIOS	= 0x04,
 112	HPWMI_POWER_HARD	= 0x08,
 113};
 114
 115#define IS_HWBLOCKED(x) ((x & (HPWMI_POWER_BIOS | HPWMI_POWER_HARD)) \
 116			 != (HPWMI_POWER_BIOS | HPWMI_POWER_HARD))
 117#define IS_SWBLOCKED(x) !(x & HPWMI_POWER_SOFT)
 118
 119struct bios_rfkill2_device_state {
 120	u8 radio_type;
 121	u8 bus_type;
 122	u16 vendor_id;
 123	u16 product_id;
 124	u16 subsys_vendor_id;
 125	u16 subsys_product_id;
 126	u8 rfkill_id;
 127	u8 power;
 128	u8 unknown[4];
 129};
 130
 131/* 7 devices fit into the 128 byte buffer */
 132#define HPWMI_MAX_RFKILL2_DEVICES	7
 133
 134struct bios_rfkill2_state {
 135	u8 unknown[7];
 136	u8 count;
 137	u8 pad[8];
 138	struct bios_rfkill2_device_state device[HPWMI_MAX_RFKILL2_DEVICES];
 139};
 140
 141static const struct key_entry hp_wmi_keymap[] = {
 142	{ KE_KEY, 0x02,   { KEY_BRIGHTNESSUP } },
 143	{ KE_KEY, 0x03,   { KEY_BRIGHTNESSDOWN } },
 144	{ KE_KEY, 0x20e6, { KEY_PROG1 } },
 145	{ KE_KEY, 0x20e8, { KEY_MEDIA } },
 146	{ KE_KEY, 0x2142, { KEY_MEDIA } },
 147	{ KE_KEY, 0x213b, { KEY_INFO } },
 148	{ KE_KEY, 0x2169, { KEY_ROTATE_DISPLAY } },
 149	{ KE_KEY, 0x216a, { KEY_SETUP } },
 150	{ KE_KEY, 0x231b, { KEY_HELP } },
 151	{ KE_END, 0 }
 152};
 153
 154static struct input_dev *hp_wmi_input_dev;
 155static struct platform_device *hp_wmi_platform_dev;
 156
 157static struct rfkill *wifi_rfkill;
 158static struct rfkill *bluetooth_rfkill;
 159static struct rfkill *wwan_rfkill;
 160
 161struct rfkill2_device {
 162	u8 id;
 163	int num;
 164	struct rfkill *rfkill;
 165};
 166
 167static int rfkill2_count;
 168static struct rfkill2_device rfkill2[HPWMI_MAX_RFKILL2_DEVICES];
 169
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 170/*
 171 * hp_wmi_perform_query
 172 *
 173 * query:	The commandtype -> What should be queried
 174 * write:	The command -> 0 read, 1 write, 3 ODM specific
 175 * buffer:	Buffer used as input and/or output
 176 * insize:	Size of input buffer
 177 * outsize:	Size of output buffer
 178 *
 179 * returns zero on success
 180 *         an HP WMI query specific error code (which is positive)
 181 *         -EINVAL if the query was not successful at all
 182 *         -EINVAL if the output buffer size exceeds buffersize
 183 *
 184 * Note: The buffersize must at least be the maximum of the input and output
 185 *       size. E.g. Battery info query (0x7) is defined to have 1 byte input
 186 *       and 128 byte output. The caller would do:
 187 *       buffer = kzalloc(128, GFP_KERNEL);
 188 *       ret = hp_wmi_perform_query(0x7, 0, buffer, 1, 128)
 189 */
 190static int hp_wmi_perform_query(int query, int write, void *buffer,
 191				int insize, int outsize)
 192{
 
 193	struct bios_return *bios_return;
 194	int actual_outsize;
 195	union acpi_object *obj;
 196	struct bios_args args = {
 197		.signature = 0x55434553,
 198		.command = write ? 0x2 : 0x1,
 199		.commandtype = query,
 200		.datasize = insize,
 201		.data = 0,
 202	};
 203	struct acpi_buffer input = { sizeof(struct bios_args), &args };
 204	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
 205	u32 rc;
 
 
 
 
 206
 207	if (WARN_ON(insize > sizeof(args.data)))
 208		return -EINVAL;
 209	memcpy(&args.data, buffer, insize);
 210
 211	wmi_evaluate_method(HPWMI_BIOS_GUID, 0, 0x3, &input, &output);
 212
 213	obj = output.pointer;
 214
 215	if (!obj)
 216		return -EINVAL;
 217	else if (obj->type != ACPI_TYPE_BUFFER) {
 218		kfree(obj);
 219		return -EINVAL;
 
 220	}
 221
 222	bios_return = (struct bios_return *)obj->buffer.pointer;
 223	rc = bios_return->return_code;
 224
 225	if (rc) {
 226		if (rc != HPWMI_RET_UNKNOWN_CMDTYPE)
 227			pr_warn("query 0x%x returned error 0x%x\n", query, rc);
 228		kfree(obj);
 229		return rc;
 230	}
 231
 232	if (!outsize) {
 233		/* ignore output data */
 234		kfree(obj);
 235		return 0;
 236	}
 237
 238	actual_outsize = min(outsize, (int)(obj->buffer.length - sizeof(*bios_return)));
 239	memcpy(buffer, obj->buffer.pointer + sizeof(*bios_return), actual_outsize);
 240	memset(buffer + actual_outsize, 0, outsize - actual_outsize);
 241	kfree(obj);
 242	return 0;
 243}
 244
 245static int hp_wmi_display_state(void)
 246{
 247	int state = 0;
 248	int ret = hp_wmi_perform_query(HPWMI_DISPLAY_QUERY, 0, &state,
 249				       sizeof(state), sizeof(state));
 250	if (ret)
 251		return -EINVAL;
 252	return state;
 253}
 254
 255static int hp_wmi_hddtemp_state(void)
 256{
 257	int state = 0;
 258	int ret = hp_wmi_perform_query(HPWMI_HDDTEMP_QUERY, 0, &state,
 259				       sizeof(state), sizeof(state));
 260	if (ret)
 261		return -EINVAL;
 262	return state;
 263}
 264
 265static int hp_wmi_als_state(void)
 266{
 267	int state = 0;
 268	int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 0, &state,
 269				       sizeof(state), sizeof(state));
 270	if (ret)
 271		return -EINVAL;
 272	return state;
 273}
 274
 275static int hp_wmi_dock_state(void)
 276{
 277	int state = 0;
 278	int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
 279				       sizeof(state), sizeof(state));
 280
 281	if (ret)
 282		return -EINVAL;
 283
 284	return state & 0x1;
 285}
 286
 287static int hp_wmi_tablet_state(void)
 288{
 289	int state = 0;
 290	int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
 291				       sizeof(state), sizeof(state));
 292	if (ret)
 293		return ret;
 294
 295	return (state & 0x4) ? 1 : 0;
 
 
 
 296}
 297
 298static int __init hp_wmi_bios_2008_later(void)
 299{
 300	int state = 0;
 301	int ret = hp_wmi_perform_query(HPWMI_FEATURE_QUERY, 0, &state,
 302				       sizeof(state), sizeof(state));
 303	if (!ret)
 304		return 1;
 305
 306	return (ret == HPWMI_RET_UNKNOWN_CMDTYPE) ? 0 : -ENXIO;
 307}
 308
 309static int __init hp_wmi_bios_2009_later(void)
 310{
 311	int state = 0;
 312	int ret = hp_wmi_perform_query(HPWMI_FEATURE2_QUERY, 0, &state,
 313				       sizeof(state), sizeof(state));
 314	if (!ret)
 315		return 1;
 316
 317	return (ret == HPWMI_RET_UNKNOWN_CMDTYPE) ? 0 : -ENXIO;
 318}
 319
 320static int __init hp_wmi_enable_hotkeys(void)
 321{
 322	int value = 0x6e;
 323	int ret = hp_wmi_perform_query(HPWMI_BIOS_QUERY, 1, &value,
 324				       sizeof(value), 0);
 325	if (ret)
 326		return -EINVAL;
 327	return 0;
 328}
 329
 330static int hp_wmi_set_block(void *data, bool blocked)
 331{
 332	enum hp_wmi_radio r = (enum hp_wmi_radio) data;
 333	int query = BIT(r + 8) | ((!blocked) << r);
 334	int ret;
 335
 336	ret = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1,
 337				   &query, sizeof(query), 0);
 338	if (ret)
 339		return -EINVAL;
 340	return 0;
 341}
 342
 343static const struct rfkill_ops hp_wmi_rfkill_ops = {
 344	.set_block = hp_wmi_set_block,
 345};
 346
 347static bool hp_wmi_get_sw_state(enum hp_wmi_radio r)
 348{
 349	int wireless = 0;
 350	int mask;
 351	hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
 352			     &wireless, sizeof(wireless),
 353			     sizeof(wireless));
 354	/* TBD: Pass error */
 355
 356	mask = 0x200 << (r * 8);
 
 
 
 357
 358	if (wireless & mask)
 359		return false;
 360	else
 361		return true;
 362}
 363
 364static bool hp_wmi_get_hw_state(enum hp_wmi_radio r)
 365{
 366	int wireless = 0;
 367	int mask;
 368	hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
 369			     &wireless, sizeof(wireless),
 370			     sizeof(wireless));
 371	/* TBD: Pass error */
 372
 373	mask = 0x800 << (r * 8);
 
 374
 375	if (wireless & mask)
 376		return false;
 377	else
 378		return true;
 379}
 380
 381static int hp_wmi_rfkill2_set_block(void *data, bool blocked)
 382{
 383	int rfkill_id = (int)(long)data;
 384	char buffer[4] = { 0x01, 0x00, rfkill_id, !blocked };
 
 385
 386	if (hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, 1,
 387				   buffer, sizeof(buffer), 0))
 388		return -EINVAL;
 389	return 0;
 390}
 391
 392static const struct rfkill_ops hp_wmi_rfkill2_ops = {
 393	.set_block = hp_wmi_rfkill2_set_block,
 394};
 395
 396static int hp_wmi_rfkill2_refresh(void)
 397{
 398	int err, i;
 399	struct bios_rfkill2_state state;
 
 400
 401	err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, 0, &state,
 402				   0, sizeof(state));
 403	if (err)
 404		return err;
 405
 406	for (i = 0; i < rfkill2_count; i++) {
 407		int num = rfkill2[i].num;
 408		struct bios_rfkill2_device_state *devstate;
 409		devstate = &state.device[num];
 410
 411		if (num >= state.count ||
 412		    devstate->rfkill_id != rfkill2[i].id) {
 413			pr_warn("power configuration of the wireless devices unexpectedly changed\n");
 414			continue;
 415		}
 416
 417		rfkill_set_states(rfkill2[i].rfkill,
 418				  IS_SWBLOCKED(devstate->power),
 419				  IS_HWBLOCKED(devstate->power));
 420	}
 421
 422	return 0;
 423}
 424
 425static int hp_wmi_post_code_state(void)
 426{
 427	int state = 0;
 428	int ret = hp_wmi_perform_query(HPWMI_POSTCODEERROR_QUERY, 0, &state,
 429				       sizeof(state), sizeof(state));
 430	if (ret)
 431		return -EINVAL;
 432	return state;
 433}
 434
 435static ssize_t show_display(struct device *dev, struct device_attribute *attr,
 436			    char *buf)
 437{
 438	int value = hp_wmi_display_state();
 439	if (value < 0)
 440		return -EINVAL;
 441	return sprintf(buf, "%d\n", value);
 442}
 443
 444static ssize_t show_hddtemp(struct device *dev, struct device_attribute *attr,
 445			    char *buf)
 446{
 447	int value = hp_wmi_hddtemp_state();
 448	if (value < 0)
 449		return -EINVAL;
 450	return sprintf(buf, "%d\n", value);
 451}
 452
 453static ssize_t show_als(struct device *dev, struct device_attribute *attr,
 454			char *buf)
 455{
 456	int value = hp_wmi_als_state();
 457	if (value < 0)
 458		return -EINVAL;
 459	return sprintf(buf, "%d\n", value);
 460}
 461
 462static ssize_t show_dock(struct device *dev, struct device_attribute *attr,
 463			 char *buf)
 464{
 465	int value = hp_wmi_dock_state();
 466	if (value < 0)
 467		return -EINVAL;
 468	return sprintf(buf, "%d\n", value);
 469}
 470
 471static ssize_t show_tablet(struct device *dev, struct device_attribute *attr,
 472			 char *buf)
 473{
 474	int value = hp_wmi_tablet_state();
 475	if (value < 0)
 476		return -EINVAL;
 477	return sprintf(buf, "%d\n", value);
 478}
 479
 480static ssize_t show_postcode(struct device *dev, struct device_attribute *attr,
 481			 char *buf)
 482{
 483	/* Get the POST error code of previous boot failure. */
 484	int value = hp_wmi_post_code_state();
 485	if (value < 0)
 486		return -EINVAL;
 487	return sprintf(buf, "0x%x\n", value);
 488}
 489
 490static ssize_t set_als(struct device *dev, struct device_attribute *attr,
 491		       const char *buf, size_t count)
 492{
 493	u32 tmp = simple_strtoul(buf, NULL, 10);
 494	int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 1, &tmp,
 495				       sizeof(tmp), sizeof(tmp));
 496	if (ret)
 497		return -EINVAL;
 498
 499	return count;
 500}
 501
 502static ssize_t set_postcode(struct device *dev, struct device_attribute *attr,
 503		       const char *buf, size_t count)
 504{
 
 505	int ret;
 506	u32 tmp;
 507	long unsigned int tmp2;
 508
 509	ret = kstrtoul(buf, 10, &tmp2);
 510	if (ret || tmp2 != 1)
 511		return -EINVAL;
 
 
 512
 513	/* Clear the POST error code. It is kept until until cleared. */
 514	tmp = (u32) tmp2;
 515	ret = hp_wmi_perform_query(HPWMI_POSTCODEERROR_QUERY, 1, &tmp,
 516				       sizeof(tmp), sizeof(tmp));
 
 
 517	if (ret)
 518		return -EINVAL;
 519
 520	return count;
 521}
 522
 523static DEVICE_ATTR(display, S_IRUGO, show_display, NULL);
 524static DEVICE_ATTR(hddtemp, S_IRUGO, show_hddtemp, NULL);
 525static DEVICE_ATTR(als, S_IRUGO | S_IWUSR, show_als, set_als);
 526static DEVICE_ATTR(dock, S_IRUGO, show_dock, NULL);
 527static DEVICE_ATTR(tablet, S_IRUGO, show_tablet, NULL);
 528static DEVICE_ATTR(postcode, S_IRUGO | S_IWUSR, show_postcode, set_postcode);
 
 
 
 
 
 
 
 
 
 
 
 529
 530static void hp_wmi_notify(u32 value, void *context)
 531{
 532	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
 533	union acpi_object *obj;
 534	u32 event_id, event_data;
 535	int key_code = 0, ret;
 536	u32 *location;
 537	acpi_status status;
 
 
 538
 539	status = wmi_get_event_data(value, &response);
 540	if (status != AE_OK) {
 541		pr_info("bad event status 0x%x\n", status);
 542		return;
 543	}
 544
 545	obj = (union acpi_object *)response.pointer;
 546
 547	if (!obj)
 548		return;
 549	if (obj->type != ACPI_TYPE_BUFFER) {
 550		pr_info("Unknown response received %d\n", obj->type);
 551		kfree(obj);
 552		return;
 553	}
 554
 555	/*
 556	 * Depending on ACPI version the concatenation of id and event data
 557	 * inside _WED function will result in a 8 or 16 byte buffer.
 558	 */
 559	location = (u32 *)obj->buffer.pointer;
 560	if (obj->buffer.length == 8) {
 561		event_id = *location;
 562		event_data = *(location + 1);
 563	} else if (obj->buffer.length == 16) {
 564		event_id = *location;
 565		event_data = *(location + 2);
 566	} else {
 567		pr_info("Unknown buffer length %d\n", obj->buffer.length);
 568		kfree(obj);
 569		return;
 570	}
 571	kfree(obj);
 572
 573	switch (event_id) {
 574	case HPWMI_DOCK_EVENT:
 575		input_report_switch(hp_wmi_input_dev, SW_DOCK,
 576				    hp_wmi_dock_state());
 577		input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
 578				    hp_wmi_tablet_state());
 
 
 579		input_sync(hp_wmi_input_dev);
 580		break;
 581	case HPWMI_PARK_HDD:
 582		break;
 583	case HPWMI_SMART_ADAPTER:
 584		break;
 585	case HPWMI_BEZEL_BUTTON:
 586		ret = hp_wmi_perform_query(HPWMI_HOTKEY_QUERY, 0,
 587					   &key_code,
 588					   sizeof(key_code),
 589					   sizeof(key_code));
 590		if (ret)
 591			break;
 592
 593		if (!sparse_keymap_report_event(hp_wmi_input_dev,
 594						key_code, 1, true))
 595			pr_info("Unknown key code - 0x%x\n", key_code);
 596		break;
 597	case HPWMI_WIRELESS:
 598		if (rfkill2_count) {
 599			hp_wmi_rfkill2_refresh();
 600			break;
 601		}
 602
 603		if (wifi_rfkill)
 604			rfkill_set_states(wifi_rfkill,
 605					  hp_wmi_get_sw_state(HPWMI_WIFI),
 606					  hp_wmi_get_hw_state(HPWMI_WIFI));
 607		if (bluetooth_rfkill)
 608			rfkill_set_states(bluetooth_rfkill,
 609					  hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
 610					  hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
 611		if (wwan_rfkill)
 612			rfkill_set_states(wwan_rfkill,
 613					  hp_wmi_get_sw_state(HPWMI_WWAN),
 614					  hp_wmi_get_hw_state(HPWMI_WWAN));
 615		break;
 616	case HPWMI_CPU_BATTERY_THROTTLE:
 617		pr_info("Unimplemented CPU throttle because of 3 Cell battery event detected\n");
 618		break;
 619	case HPWMI_LOCK_SWITCH:
 620		break;
 621	case HPWMI_LID_SWITCH:
 622		break;
 623	case HPWMI_SCREEN_ROTATION:
 624		break;
 625	case HPWMI_COOLSENSE_SYSTEM_MOBILE:
 626		break;
 627	case HPWMI_COOLSENSE_SYSTEM_HOT:
 628		break;
 629	case HPWMI_PROXIMITY_SENSOR:
 630		break;
 631	case HPWMI_BACKLIT_KB_BRIGHTNESS:
 632		break;
 633	case HPWMI_PEAKSHIFT_PERIOD:
 634		break;
 635	case HPWMI_BATTERY_CHARGE_PERIOD:
 636		break;
 637	default:
 638		pr_info("Unknown event_id - %d - 0x%x\n", event_id, event_data);
 639		break;
 640	}
 641}
 642
 643static int __init hp_wmi_input_setup(void)
 644{
 645	acpi_status status;
 646	int err;
 647
 648	hp_wmi_input_dev = input_allocate_device();
 649	if (!hp_wmi_input_dev)
 650		return -ENOMEM;
 651
 652	hp_wmi_input_dev->name = "HP WMI hotkeys";
 653	hp_wmi_input_dev->phys = "wmi/input0";
 654	hp_wmi_input_dev->id.bustype = BUS_HOST;
 655
 656	__set_bit(EV_SW, hp_wmi_input_dev->evbit);
 657	__set_bit(SW_DOCK, hp_wmi_input_dev->swbit);
 658	__set_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit);
 
 
 
 
 
 
 
 
 
 
 
 
 659
 660	err = sparse_keymap_setup(hp_wmi_input_dev, hp_wmi_keymap, NULL);
 661	if (err)
 662		goto err_free_dev;
 663
 664	/* Set initial hardware state */
 665	input_report_switch(hp_wmi_input_dev, SW_DOCK, hp_wmi_dock_state());
 666	input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
 667			    hp_wmi_tablet_state());
 668	input_sync(hp_wmi_input_dev);
 669
 670	if (!hp_wmi_bios_2009_later() && hp_wmi_bios_2008_later())
 671		hp_wmi_enable_hotkeys();
 672
 673	status = wmi_install_notify_handler(HPWMI_EVENT_GUID, hp_wmi_notify, NULL);
 674	if (ACPI_FAILURE(status)) {
 675		err = -EIO;
 676		goto err_free_keymap;
 677	}
 678
 679	err = input_register_device(hp_wmi_input_dev);
 680	if (err)
 681		goto err_uninstall_notifier;
 682
 683	return 0;
 684
 685 err_uninstall_notifier:
 686	wmi_remove_notify_handler(HPWMI_EVENT_GUID);
 687 err_free_keymap:
 688	sparse_keymap_free(hp_wmi_input_dev);
 689 err_free_dev:
 690	input_free_device(hp_wmi_input_dev);
 691	return err;
 692}
 693
 694static void hp_wmi_input_destroy(void)
 695{
 696	wmi_remove_notify_handler(HPWMI_EVENT_GUID);
 697	sparse_keymap_free(hp_wmi_input_dev);
 698	input_unregister_device(hp_wmi_input_dev);
 699}
 700
 701static void cleanup_sysfs(struct platform_device *device)
 702{
 703	device_remove_file(&device->dev, &dev_attr_display);
 704	device_remove_file(&device->dev, &dev_attr_hddtemp);
 705	device_remove_file(&device->dev, &dev_attr_als);
 706	device_remove_file(&device->dev, &dev_attr_dock);
 707	device_remove_file(&device->dev, &dev_attr_tablet);
 708	device_remove_file(&device->dev, &dev_attr_postcode);
 709}
 710
 711static int __init hp_wmi_rfkill_setup(struct platform_device *device)
 712{
 713	int err;
 714	int wireless = 0;
 
 
 
 715
 716	err = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0, &wireless,
 717				   sizeof(wireless), sizeof(wireless));
 718	if (err)
 719		return err;
 720
 721	if (wireless & 0x1) {
 722		wifi_rfkill = rfkill_alloc("hp-wifi", &device->dev,
 723					   RFKILL_TYPE_WLAN,
 724					   &hp_wmi_rfkill_ops,
 725					   (void *) HPWMI_WIFI);
 726		if (!wifi_rfkill)
 727			return -ENOMEM;
 728		rfkill_init_sw_state(wifi_rfkill,
 729				     hp_wmi_get_sw_state(HPWMI_WIFI));
 730		rfkill_set_hw_state(wifi_rfkill,
 731				    hp_wmi_get_hw_state(HPWMI_WIFI));
 732		err = rfkill_register(wifi_rfkill);
 733		if (err)
 734			goto register_wifi_error;
 735	}
 736
 737	if (wireless & 0x2) {
 738		bluetooth_rfkill = rfkill_alloc("hp-bluetooth", &device->dev,
 739						RFKILL_TYPE_BLUETOOTH,
 740						&hp_wmi_rfkill_ops,
 741						(void *) HPWMI_BLUETOOTH);
 742		if (!bluetooth_rfkill) {
 743			err = -ENOMEM;
 744			goto register_bluetooth_error;
 745		}
 746		rfkill_init_sw_state(bluetooth_rfkill,
 747				     hp_wmi_get_sw_state(HPWMI_BLUETOOTH));
 748		rfkill_set_hw_state(bluetooth_rfkill,
 749				    hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
 750		err = rfkill_register(bluetooth_rfkill);
 751		if (err)
 752			goto register_bluetooth_error;
 753	}
 754
 755	if (wireless & 0x4) {
 756		wwan_rfkill = rfkill_alloc("hp-wwan", &device->dev,
 757					   RFKILL_TYPE_WWAN,
 758					   &hp_wmi_rfkill_ops,
 759					   (void *) HPWMI_WWAN);
 760		if (!wwan_rfkill) {
 761			err = -ENOMEM;
 762			goto register_wwan_error;
 763		}
 764		rfkill_init_sw_state(wwan_rfkill,
 765				     hp_wmi_get_sw_state(HPWMI_WWAN));
 766		rfkill_set_hw_state(wwan_rfkill,
 767				    hp_wmi_get_hw_state(HPWMI_WWAN));
 768		err = rfkill_register(wwan_rfkill);
 769		if (err)
 770			goto register_wwan_error;
 771	}
 772
 773	return 0;
 774
 775register_wwan_error:
 776	rfkill_destroy(wwan_rfkill);
 777	wwan_rfkill = NULL;
 778	if (bluetooth_rfkill)
 779		rfkill_unregister(bluetooth_rfkill);
 780register_bluetooth_error:
 781	rfkill_destroy(bluetooth_rfkill);
 782	bluetooth_rfkill = NULL;
 783	if (wifi_rfkill)
 784		rfkill_unregister(wifi_rfkill);
 785register_wifi_error:
 786	rfkill_destroy(wifi_rfkill);
 787	wifi_rfkill = NULL;
 788	return err;
 789}
 790
 791static int __init hp_wmi_rfkill2_setup(struct platform_device *device)
 792{
 793	int err, i;
 794	struct bios_rfkill2_state state;
 795	err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, 0, &state,
 
 
 796				   0, sizeof(state));
 797	if (err)
 798		return err;
 799
 800	if (state.count > HPWMI_MAX_RFKILL2_DEVICES) {
 801		pr_warn("unable to parse 0x1b query output\n");
 802		return -EINVAL;
 803	}
 804
 805	for (i = 0; i < state.count; i++) {
 806		struct rfkill *rfkill;
 807		enum rfkill_type type;
 808		char *name;
 809		switch (state.device[i].radio_type) {
 810		case HPWMI_WIFI:
 811			type = RFKILL_TYPE_WLAN;
 812			name = "hp-wifi";
 813			break;
 814		case HPWMI_BLUETOOTH:
 815			type = RFKILL_TYPE_BLUETOOTH;
 816			name = "hp-bluetooth";
 817			break;
 818		case HPWMI_WWAN:
 819			type = RFKILL_TYPE_WWAN;
 820			name = "hp-wwan";
 821			break;
 822		case HPWMI_GPS:
 823			type = RFKILL_TYPE_GPS;
 824			name = "hp-gps";
 825			break;
 826		default:
 827			pr_warn("unknown device type 0x%x\n",
 828				state.device[i].radio_type);
 829			continue;
 830		}
 831
 832		if (!state.device[i].vendor_id) {
 833			pr_warn("zero device %d while %d reported\n",
 834				i, state.count);
 835			continue;
 836		}
 837
 838		rfkill = rfkill_alloc(name, &device->dev, type,
 839				      &hp_wmi_rfkill2_ops, (void *)(long)i);
 840		if (!rfkill) {
 841			err = -ENOMEM;
 842			goto fail;
 843		}
 844
 845		rfkill2[rfkill2_count].id = state.device[i].rfkill_id;
 846		rfkill2[rfkill2_count].num = i;
 847		rfkill2[rfkill2_count].rfkill = rfkill;
 848
 849		rfkill_init_sw_state(rfkill,
 850				     IS_SWBLOCKED(state.device[i].power));
 851		rfkill_set_hw_state(rfkill,
 852				    IS_HWBLOCKED(state.device[i].power));
 853
 854		if (!(state.device[i].power & HPWMI_POWER_BIOS))
 855			pr_info("device %s blocked by BIOS\n", name);
 856
 857		err = rfkill_register(rfkill);
 858		if (err) {
 859			rfkill_destroy(rfkill);
 860			goto fail;
 861		}
 862
 863		rfkill2_count++;
 864	}
 865
 866	return 0;
 867fail:
 868	for (; rfkill2_count > 0; rfkill2_count--) {
 869		rfkill_unregister(rfkill2[rfkill2_count - 1].rfkill);
 870		rfkill_destroy(rfkill2[rfkill2_count - 1].rfkill);
 871	}
 872	return err;
 873}
 874
 875static int __init hp_wmi_bios_setup(struct platform_device *device)
 876{
 877	int err;
 878
 879	/* clear detected rfkill devices */
 880	wifi_rfkill = NULL;
 881	bluetooth_rfkill = NULL;
 882	wwan_rfkill = NULL;
 883	rfkill2_count = 0;
 884
 885	if (hp_wmi_bios_2009_later() || hp_wmi_rfkill_setup(device))
 886		hp_wmi_rfkill2_setup(device);
 887
 888	err = device_create_file(&device->dev, &dev_attr_display);
 889	if (err)
 890		goto add_sysfs_error;
 891	err = device_create_file(&device->dev, &dev_attr_hddtemp);
 892	if (err)
 893		goto add_sysfs_error;
 894	err = device_create_file(&device->dev, &dev_attr_als);
 895	if (err)
 896		goto add_sysfs_error;
 897	err = device_create_file(&device->dev, &dev_attr_dock);
 898	if (err)
 899		goto add_sysfs_error;
 900	err = device_create_file(&device->dev, &dev_attr_tablet);
 901	if (err)
 902		goto add_sysfs_error;
 903	err = device_create_file(&device->dev, &dev_attr_postcode);
 904	if (err)
 905		goto add_sysfs_error;
 906	return 0;
 907
 908add_sysfs_error:
 909	cleanup_sysfs(device);
 910	return err;
 911}
 912
 913static int __exit hp_wmi_bios_remove(struct platform_device *device)
 914{
 915	int i;
 916	cleanup_sysfs(device);
 917
 918	for (i = 0; i < rfkill2_count; i++) {
 919		rfkill_unregister(rfkill2[i].rfkill);
 920		rfkill_destroy(rfkill2[i].rfkill);
 921	}
 922
 923	if (wifi_rfkill) {
 924		rfkill_unregister(wifi_rfkill);
 925		rfkill_destroy(wifi_rfkill);
 926	}
 927	if (bluetooth_rfkill) {
 928		rfkill_unregister(bluetooth_rfkill);
 929		rfkill_destroy(bluetooth_rfkill);
 930	}
 931	if (wwan_rfkill) {
 932		rfkill_unregister(wwan_rfkill);
 933		rfkill_destroy(wwan_rfkill);
 934	}
 935
 936	return 0;
 937}
 938
 939static int hp_wmi_resume_handler(struct device *device)
 940{
 941	/*
 942	 * Hardware state may have changed while suspended, so trigger
 943	 * input events for the current state. As this is a switch,
 944	 * the input layer will only actually pass it on if the state
 945	 * changed.
 946	 */
 947	if (hp_wmi_input_dev) {
 948		input_report_switch(hp_wmi_input_dev, SW_DOCK,
 949				    hp_wmi_dock_state());
 950		input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
 951				    hp_wmi_tablet_state());
 
 
 952		input_sync(hp_wmi_input_dev);
 953	}
 954
 955	if (rfkill2_count)
 956		hp_wmi_rfkill2_refresh();
 957
 958	if (wifi_rfkill)
 959		rfkill_set_states(wifi_rfkill,
 960				  hp_wmi_get_sw_state(HPWMI_WIFI),
 961				  hp_wmi_get_hw_state(HPWMI_WIFI));
 962	if (bluetooth_rfkill)
 963		rfkill_set_states(bluetooth_rfkill,
 964				  hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
 965				  hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
 966	if (wwan_rfkill)
 967		rfkill_set_states(wwan_rfkill,
 968				  hp_wmi_get_sw_state(HPWMI_WWAN),
 969				  hp_wmi_get_hw_state(HPWMI_WWAN));
 970
 971	return 0;
 972}
 973
 974static const struct dev_pm_ops hp_wmi_pm_ops = {
 975	.resume  = hp_wmi_resume_handler,
 976	.restore  = hp_wmi_resume_handler,
 977};
 978
 979static struct platform_driver hp_wmi_driver = {
 980	.driver = {
 981		.name = "hp-wmi",
 982		.pm = &hp_wmi_pm_ops,
 
 983	},
 984	.remove = __exit_p(hp_wmi_bios_remove),
 985};
 986
 987static int __init hp_wmi_init(void)
 988{
 989	int err;
 990	int event_capable = wmi_has_guid(HPWMI_EVENT_GUID);
 991	int bios_capable = wmi_has_guid(HPWMI_BIOS_GUID);
 
 992
 993	if (!bios_capable && !event_capable)
 994		return -ENODEV;
 995
 996	if (event_capable) {
 997		err = hp_wmi_input_setup();
 998		if (err)
 999			return err;
1000	}
1001
1002	if (bios_capable) {
1003		hp_wmi_platform_dev =
1004			platform_device_register_simple("hp-wmi", -1, NULL, 0);
1005		if (IS_ERR(hp_wmi_platform_dev)) {
1006			err = PTR_ERR(hp_wmi_platform_dev);
1007			goto err_destroy_input;
1008		}
1009
1010		err = platform_driver_probe(&hp_wmi_driver, hp_wmi_bios_setup);
1011		if (err)
1012			goto err_unregister_device;
1013	}
1014
1015	return 0;
1016
1017err_unregister_device:
1018	platform_device_unregister(hp_wmi_platform_dev);
1019err_destroy_input:
1020	if (event_capable)
1021		hp_wmi_input_destroy();
1022
1023	return err;
1024}
1025module_init(hp_wmi_init);
1026
1027static void __exit hp_wmi_exit(void)
1028{
1029	if (wmi_has_guid(HPWMI_EVENT_GUID))
1030		hp_wmi_input_destroy();
1031
1032	if (hp_wmi_platform_dev) {
1033		platform_device_unregister(hp_wmi_platform_dev);
1034		platform_driver_unregister(&hp_wmi_driver);
1035	}
1036}
1037module_exit(hp_wmi_exit);
v5.4
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 * HP WMI hotkeys
   4 *
   5 * Copyright (C) 2008 Red Hat <mjg@redhat.com>
   6 * Copyright (C) 2010, 2011 Anssi Hannula <anssi.hannula@iki.fi>
   7 *
   8 * Portions based on wistron_btns.c:
   9 * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
  10 * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
  11 * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  12 */
  13
  14#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  15
  16#include <linux/kernel.h>
  17#include <linux/module.h>
  18#include <linux/init.h>
  19#include <linux/slab.h>
  20#include <linux/types.h>
  21#include <linux/input.h>
  22#include <linux/input/sparse-keymap.h>
  23#include <linux/platform_device.h>
  24#include <linux/acpi.h>
  25#include <linux/rfkill.h>
  26#include <linux/string.h>
  27
  28MODULE_AUTHOR("Matthew Garrett <mjg59@srcf.ucam.org>");
  29MODULE_DESCRIPTION("HP laptop WMI hotkeys driver");
  30MODULE_LICENSE("GPL");
  31
  32MODULE_ALIAS("wmi:95F24279-4D7B-4334-9387-ACCDC67EF61C");
  33MODULE_ALIAS("wmi:5FB7F034-2C63-45e9-BE91-3D44E2C707E4");
  34
  35#define HPWMI_EVENT_GUID "95F24279-4D7B-4334-9387-ACCDC67EF61C"
  36#define HPWMI_BIOS_GUID "5FB7F034-2C63-45e9-BE91-3D44E2C707E4"
  37
 
 
 
 
 
 
 
 
 
 
 
 
  38enum hp_wmi_radio {
  39	HPWMI_WIFI	= 0x0,
  40	HPWMI_BLUETOOTH	= 0x1,
  41	HPWMI_WWAN	= 0x2,
  42	HPWMI_GPS	= 0x3,
  43};
  44
  45enum hp_wmi_event_ids {
  46	HPWMI_DOCK_EVENT		= 0x01,
  47	HPWMI_PARK_HDD			= 0x02,
  48	HPWMI_SMART_ADAPTER		= 0x03,
  49	HPWMI_BEZEL_BUTTON		= 0x04,
  50	HPWMI_WIRELESS			= 0x05,
  51	HPWMI_CPU_BATTERY_THROTTLE	= 0x06,
  52	HPWMI_LOCK_SWITCH		= 0x07,
  53	HPWMI_LID_SWITCH		= 0x08,
  54	HPWMI_SCREEN_ROTATION		= 0x09,
  55	HPWMI_COOLSENSE_SYSTEM_MOBILE	= 0x0A,
  56	HPWMI_COOLSENSE_SYSTEM_HOT	= 0x0B,
  57	HPWMI_PROXIMITY_SENSOR		= 0x0C,
  58	HPWMI_BACKLIT_KB_BRIGHTNESS	= 0x0D,
  59	HPWMI_PEAKSHIFT_PERIOD		= 0x0F,
  60	HPWMI_BATTERY_CHARGE_PERIOD	= 0x10,
  61};
  62
  63struct bios_args {
  64	u32 signature;
  65	u32 command;
  66	u32 commandtype;
  67	u32 datasize;
  68	u32 data;
  69};
  70
  71enum hp_wmi_commandtype {
  72	HPWMI_DISPLAY_QUERY		= 0x01,
  73	HPWMI_HDDTEMP_QUERY		= 0x02,
  74	HPWMI_ALS_QUERY			= 0x03,
  75	HPWMI_HARDWARE_QUERY		= 0x04,
  76	HPWMI_WIRELESS_QUERY		= 0x05,
  77	HPWMI_BATTERY_QUERY		= 0x07,
  78	HPWMI_BIOS_QUERY		= 0x09,
  79	HPWMI_FEATURE_QUERY		= 0x0b,
  80	HPWMI_HOTKEY_QUERY		= 0x0c,
  81	HPWMI_FEATURE2_QUERY		= 0x0d,
  82	HPWMI_WIRELESS2_QUERY		= 0x1b,
  83	HPWMI_POSTCODEERROR_QUERY	= 0x2a,
  84};
  85
  86enum hp_wmi_command {
  87	HPWMI_READ	= 0x01,
  88	HPWMI_WRITE	= 0x02,
  89	HPWMI_ODM	= 0x03,
  90};
  91
  92enum hp_wmi_hardware_mask {
  93	HPWMI_DOCK_MASK		= 0x01,
  94	HPWMI_TABLET_MASK	= 0x04,
  95};
  96
  97struct bios_return {
  98	u32 sigpass;
  99	u32 return_code;
 100};
 101
 102enum hp_return_value {
 103	HPWMI_RET_WRONG_SIGNATURE	= 0x02,
 104	HPWMI_RET_UNKNOWN_COMMAND	= 0x03,
 105	HPWMI_RET_UNKNOWN_CMDTYPE	= 0x04,
 106	HPWMI_RET_INVALID_PARAMETERS	= 0x05,
 107};
 108
 109enum hp_wireless2_bits {
 110	HPWMI_POWER_STATE	= 0x01,
 111	HPWMI_POWER_SOFT	= 0x02,
 112	HPWMI_POWER_BIOS	= 0x04,
 113	HPWMI_POWER_HARD	= 0x08,
 114};
 115
 116#define IS_HWBLOCKED(x) ((x & (HPWMI_POWER_BIOS | HPWMI_POWER_HARD)) \
 117			 != (HPWMI_POWER_BIOS | HPWMI_POWER_HARD))
 118#define IS_SWBLOCKED(x) !(x & HPWMI_POWER_SOFT)
 119
 120struct bios_rfkill2_device_state {
 121	u8 radio_type;
 122	u8 bus_type;
 123	u16 vendor_id;
 124	u16 product_id;
 125	u16 subsys_vendor_id;
 126	u16 subsys_product_id;
 127	u8 rfkill_id;
 128	u8 power;
 129	u8 unknown[4];
 130};
 131
 132/* 7 devices fit into the 128 byte buffer */
 133#define HPWMI_MAX_RFKILL2_DEVICES	7
 134
 135struct bios_rfkill2_state {
 136	u8 unknown[7];
 137	u8 count;
 138	u8 pad[8];
 139	struct bios_rfkill2_device_state device[HPWMI_MAX_RFKILL2_DEVICES];
 140};
 141
 142static const struct key_entry hp_wmi_keymap[] = {
 143	{ KE_KEY, 0x02,   { KEY_BRIGHTNESSUP } },
 144	{ KE_KEY, 0x03,   { KEY_BRIGHTNESSDOWN } },
 145	{ KE_KEY, 0x20e6, { KEY_PROG1 } },
 146	{ KE_KEY, 0x20e8, { KEY_MEDIA } },
 147	{ KE_KEY, 0x2142, { KEY_MEDIA } },
 148	{ KE_KEY, 0x213b, { KEY_INFO } },
 149	{ KE_KEY, 0x2169, { KEY_ROTATE_DISPLAY } },
 150	{ KE_KEY, 0x216a, { KEY_SETUP } },
 151	{ KE_KEY, 0x231b, { KEY_HELP } },
 152	{ KE_END, 0 }
 153};
 154
 155static struct input_dev *hp_wmi_input_dev;
 156static struct platform_device *hp_wmi_platform_dev;
 157
 158static struct rfkill *wifi_rfkill;
 159static struct rfkill *bluetooth_rfkill;
 160static struct rfkill *wwan_rfkill;
 161
 162struct rfkill2_device {
 163	u8 id;
 164	int num;
 165	struct rfkill *rfkill;
 166};
 167
 168static int rfkill2_count;
 169static struct rfkill2_device rfkill2[HPWMI_MAX_RFKILL2_DEVICES];
 170
 171/* map output size to the corresponding WMI method id */
 172static inline int encode_outsize_for_pvsz(int outsize)
 173{
 174	if (outsize > 4096)
 175		return -EINVAL;
 176	if (outsize > 1024)
 177		return 5;
 178	if (outsize > 128)
 179		return 4;
 180	if (outsize > 4)
 181		return 3;
 182	if (outsize > 0)
 183		return 2;
 184	return 1;
 185}
 186
 187/*
 188 * hp_wmi_perform_query
 189 *
 190 * query:	The commandtype (enum hp_wmi_commandtype)
 191 * write:	The command (enum hp_wmi_command)
 192 * buffer:	Buffer used as input and/or output
 193 * insize:	Size of input buffer
 194 * outsize:	Size of output buffer
 195 *
 196 * returns zero on success
 197 *         an HP WMI query specific error code (which is positive)
 198 *         -EINVAL if the query was not successful at all
 199 *         -EINVAL if the output buffer size exceeds buffersize
 200 *
 201 * Note: The buffersize must at least be the maximum of the input and output
 202 *       size. E.g. Battery info query is defined to have 1 byte input
 203 *       and 128 byte output. The caller would do:
 204 *       buffer = kzalloc(128, GFP_KERNEL);
 205 *       ret = hp_wmi_perform_query(HPWMI_BATTERY_QUERY, HPWMI_READ, buffer, 1, 128)
 206 */
 207static int hp_wmi_perform_query(int query, enum hp_wmi_command command,
 208				void *buffer, int insize, int outsize)
 209{
 210	int mid;
 211	struct bios_return *bios_return;
 212	int actual_outsize;
 213	union acpi_object *obj;
 214	struct bios_args args = {
 215		.signature = 0x55434553,
 216		.command = command,
 217		.commandtype = query,
 218		.datasize = insize,
 219		.data = 0,
 220	};
 221	struct acpi_buffer input = { sizeof(struct bios_args), &args };
 222	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
 223	int ret = 0;
 224
 225	mid = encode_outsize_for_pvsz(outsize);
 226	if (WARN_ON(mid < 0))
 227		return mid;
 228
 229	if (WARN_ON(insize > sizeof(args.data)))
 230		return -EINVAL;
 231	memcpy(&args.data, buffer, insize);
 232
 233	wmi_evaluate_method(HPWMI_BIOS_GUID, 0, mid, &input, &output);
 234
 235	obj = output.pointer;
 236
 237	if (!obj)
 238		return -EINVAL;
 239
 240	if (obj->type != ACPI_TYPE_BUFFER) {
 241		ret = -EINVAL;
 242		goto out_free;
 243	}
 244
 245	bios_return = (struct bios_return *)obj->buffer.pointer;
 246	ret = bios_return->return_code;
 247
 248	if (ret) {
 249		if (ret != HPWMI_RET_UNKNOWN_CMDTYPE)
 250			pr_warn("query 0x%x returned error 0x%x\n", query, ret);
 251		goto out_free;
 
 252	}
 253
 254	/* Ignore output data of zero size */
 255	if (!outsize)
 256		goto out_free;
 
 
 257
 258	actual_outsize = min(outsize, (int)(obj->buffer.length - sizeof(*bios_return)));
 259	memcpy(buffer, obj->buffer.pointer + sizeof(*bios_return), actual_outsize);
 260	memset(buffer + actual_outsize, 0, outsize - actual_outsize);
 
 
 
 261
 262out_free:
 263	kfree(obj);
 264	return ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 265}
 266
 267static int hp_wmi_read_int(int query)
 268{
 269	int val = 0, ret;
 
 
 
 
 
 
 270
 271	ret = hp_wmi_perform_query(query, HPWMI_READ, &val,
 272				   sizeof(val), sizeof(val));
 
 
 
 273
 274	if (ret)
 275		return ret < 0 ? ret : -EINVAL;
 276
 277	return val;
 278}
 279
 280static int hp_wmi_hw_state(int mask)
 281{
 282	int state = hp_wmi_read_int(HPWMI_HARDWARE_QUERY);
 
 
 
 
 283
 284	if (state < 0)
 285		return state;
 286
 287	return !!(state & mask);
 288}
 289
 290static int __init hp_wmi_bios_2008_later(void)
 291{
 292	int state = 0;
 293	int ret = hp_wmi_perform_query(HPWMI_FEATURE_QUERY, HPWMI_READ, &state,
 294				       sizeof(state), sizeof(state));
 295	if (!ret)
 296		return 1;
 297
 298	return (ret == HPWMI_RET_UNKNOWN_CMDTYPE) ? 0 : -ENXIO;
 299}
 300
 301static int __init hp_wmi_bios_2009_later(void)
 302{
 303	int state = 0;
 304	int ret = hp_wmi_perform_query(HPWMI_FEATURE2_QUERY, HPWMI_READ, &state,
 305				       sizeof(state), sizeof(state));
 306	if (!ret)
 307		return 1;
 308
 309	return (ret == HPWMI_RET_UNKNOWN_CMDTYPE) ? 0 : -ENXIO;
 310}
 311
 312static int __init hp_wmi_enable_hotkeys(void)
 313{
 314	int value = 0x6e;
 315	int ret = hp_wmi_perform_query(HPWMI_BIOS_QUERY, HPWMI_WRITE, &value,
 316				       sizeof(value), 0);
 317
 318	return ret <= 0 ? ret : -EINVAL;
 
 319}
 320
 321static int hp_wmi_set_block(void *data, bool blocked)
 322{
 323	enum hp_wmi_radio r = (enum hp_wmi_radio) data;
 324	int query = BIT(r + 8) | ((!blocked) << r);
 325	int ret;
 326
 327	ret = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, HPWMI_WRITE,
 328				   &query, sizeof(query), 0);
 329
 330	return ret <= 0 ? ret : -EINVAL;
 
 331}
 332
 333static const struct rfkill_ops hp_wmi_rfkill_ops = {
 334	.set_block = hp_wmi_set_block,
 335};
 336
 337static bool hp_wmi_get_sw_state(enum hp_wmi_radio r)
 338{
 339	int mask = 0x200 << (r * 8);
 
 
 
 
 
 340
 341	int wireless = hp_wmi_read_int(HPWMI_WIRELESS_QUERY);
 342
 343	/* TBD: Pass error */
 344	WARN_ONCE(wireless < 0, "error executing HPWMI_WIRELESS_QUERY");
 345
 346	return !(wireless & mask);
 
 
 
 347}
 348
 349static bool hp_wmi_get_hw_state(enum hp_wmi_radio r)
 350{
 351	int mask = 0x800 << (r * 8);
 352
 353	int wireless = hp_wmi_read_int(HPWMI_WIRELESS_QUERY);
 
 
 
 354
 355	/* TBD: Pass error */
 356	WARN_ONCE(wireless < 0, "error executing HPWMI_WIRELESS_QUERY");
 357
 358	return !(wireless & mask);
 
 
 
 359}
 360
 361static int hp_wmi_rfkill2_set_block(void *data, bool blocked)
 362{
 363	int rfkill_id = (int)(long)data;
 364	char buffer[4] = { 0x01, 0x00, rfkill_id, !blocked };
 365	int ret;
 366
 367	ret = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, HPWMI_WRITE,
 368				   buffer, sizeof(buffer), 0);
 369
 370	return ret <= 0 ? ret : -EINVAL;
 371}
 372
 373static const struct rfkill_ops hp_wmi_rfkill2_ops = {
 374	.set_block = hp_wmi_rfkill2_set_block,
 375};
 376
 377static int hp_wmi_rfkill2_refresh(void)
 378{
 
 379	struct bios_rfkill2_state state;
 380	int err, i;
 381
 382	err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, HPWMI_READ, &state,
 383				   0, sizeof(state));
 384	if (err)
 385		return err;
 386
 387	for (i = 0; i < rfkill2_count; i++) {
 388		int num = rfkill2[i].num;
 389		struct bios_rfkill2_device_state *devstate;
 390		devstate = &state.device[num];
 391
 392		if (num >= state.count ||
 393		    devstate->rfkill_id != rfkill2[i].id) {
 394			pr_warn("power configuration of the wireless devices unexpectedly changed\n");
 395			continue;
 396		}
 397
 398		rfkill_set_states(rfkill2[i].rfkill,
 399				  IS_SWBLOCKED(devstate->power),
 400				  IS_HWBLOCKED(devstate->power));
 401	}
 402
 403	return 0;
 404}
 405
 406static ssize_t display_show(struct device *dev, struct device_attribute *attr,
 
 
 
 
 
 
 
 
 
 
 407			    char *buf)
 408{
 409	int value = hp_wmi_read_int(HPWMI_DISPLAY_QUERY);
 410	if (value < 0)
 411		return value;
 412	return sprintf(buf, "%d\n", value);
 413}
 414
 415static ssize_t hddtemp_show(struct device *dev, struct device_attribute *attr,
 416			    char *buf)
 417{
 418	int value = hp_wmi_read_int(HPWMI_HDDTEMP_QUERY);
 419	if (value < 0)
 420		return value;
 421	return sprintf(buf, "%d\n", value);
 422}
 423
 424static ssize_t als_show(struct device *dev, struct device_attribute *attr,
 425			char *buf)
 426{
 427	int value = hp_wmi_read_int(HPWMI_ALS_QUERY);
 428	if (value < 0)
 429		return value;
 430	return sprintf(buf, "%d\n", value);
 431}
 432
 433static ssize_t dock_show(struct device *dev, struct device_attribute *attr,
 434			 char *buf)
 435{
 436	int value = hp_wmi_hw_state(HPWMI_DOCK_MASK);
 437	if (value < 0)
 438		return value;
 439	return sprintf(buf, "%d\n", value);
 440}
 441
 442static ssize_t tablet_show(struct device *dev, struct device_attribute *attr,
 443			   char *buf)
 444{
 445	int value = hp_wmi_hw_state(HPWMI_TABLET_MASK);
 446	if (value < 0)
 447		return value;
 448	return sprintf(buf, "%d\n", value);
 449}
 450
 451static ssize_t postcode_show(struct device *dev, struct device_attribute *attr,
 452			     char *buf)
 453{
 454	/* Get the POST error code of previous boot failure. */
 455	int value = hp_wmi_read_int(HPWMI_POSTCODEERROR_QUERY);
 456	if (value < 0)
 457		return value;
 458	return sprintf(buf, "0x%x\n", value);
 459}
 460
 461static ssize_t als_store(struct device *dev, struct device_attribute *attr,
 462			 const char *buf, size_t count)
 463{
 464	u32 tmp = simple_strtoul(buf, NULL, 10);
 465	int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, HPWMI_WRITE, &tmp,
 466				       sizeof(tmp), sizeof(tmp));
 467	if (ret)
 468		return ret < 0 ? ret : -EINVAL;
 469
 470	return count;
 471}
 472
 473static ssize_t postcode_store(struct device *dev, struct device_attribute *attr,
 474			      const char *buf, size_t count)
 475{
 476	long unsigned int tmp2;
 477	int ret;
 478	u32 tmp;
 
 479
 480	ret = kstrtoul(buf, 10, &tmp2);
 481	if (!ret && tmp2 != 1)
 482		ret = -EINVAL;
 483	if (ret)
 484		goto out;
 485
 486	/* Clear the POST error code. It is kept until until cleared. */
 487	tmp = (u32) tmp2;
 488	ret = hp_wmi_perform_query(HPWMI_POSTCODEERROR_QUERY, HPWMI_WRITE, &tmp,
 489				       sizeof(tmp), sizeof(tmp));
 490
 491out:
 492	if (ret)
 493		return ret < 0 ? ret : -EINVAL;
 494
 495	return count;
 496}
 497
 498static DEVICE_ATTR_RO(display);
 499static DEVICE_ATTR_RO(hddtemp);
 500static DEVICE_ATTR_RW(als);
 501static DEVICE_ATTR_RO(dock);
 502static DEVICE_ATTR_RO(tablet);
 503static DEVICE_ATTR_RW(postcode);
 504
 505static struct attribute *hp_wmi_attrs[] = {
 506	&dev_attr_display.attr,
 507	&dev_attr_hddtemp.attr,
 508	&dev_attr_als.attr,
 509	&dev_attr_dock.attr,
 510	&dev_attr_tablet.attr,
 511	&dev_attr_postcode.attr,
 512	NULL,
 513};
 514ATTRIBUTE_GROUPS(hp_wmi);
 515
 516static void hp_wmi_notify(u32 value, void *context)
 517{
 518	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
 
 519	u32 event_id, event_data;
 520	union acpi_object *obj;
 
 521	acpi_status status;
 522	u32 *location;
 523	int key_code;
 524
 525	status = wmi_get_event_data(value, &response);
 526	if (status != AE_OK) {
 527		pr_info("bad event status 0x%x\n", status);
 528		return;
 529	}
 530
 531	obj = (union acpi_object *)response.pointer;
 532
 533	if (!obj)
 534		return;
 535	if (obj->type != ACPI_TYPE_BUFFER) {
 536		pr_info("Unknown response received %d\n", obj->type);
 537		kfree(obj);
 538		return;
 539	}
 540
 541	/*
 542	 * Depending on ACPI version the concatenation of id and event data
 543	 * inside _WED function will result in a 8 or 16 byte buffer.
 544	 */
 545	location = (u32 *)obj->buffer.pointer;
 546	if (obj->buffer.length == 8) {
 547		event_id = *location;
 548		event_data = *(location + 1);
 549	} else if (obj->buffer.length == 16) {
 550		event_id = *location;
 551		event_data = *(location + 2);
 552	} else {
 553		pr_info("Unknown buffer length %d\n", obj->buffer.length);
 554		kfree(obj);
 555		return;
 556	}
 557	kfree(obj);
 558
 559	switch (event_id) {
 560	case HPWMI_DOCK_EVENT:
 561		if (test_bit(SW_DOCK, hp_wmi_input_dev->swbit))
 562			input_report_switch(hp_wmi_input_dev, SW_DOCK,
 563					    hp_wmi_hw_state(HPWMI_DOCK_MASK));
 564		if (test_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit))
 565			input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
 566					    hp_wmi_hw_state(HPWMI_TABLET_MASK));
 567		input_sync(hp_wmi_input_dev);
 568		break;
 569	case HPWMI_PARK_HDD:
 570		break;
 571	case HPWMI_SMART_ADAPTER:
 572		break;
 573	case HPWMI_BEZEL_BUTTON:
 574		key_code = hp_wmi_read_int(HPWMI_HOTKEY_QUERY);
 575		if (key_code < 0)
 
 
 
 576			break;
 577
 578		if (!sparse_keymap_report_event(hp_wmi_input_dev,
 579						key_code, 1, true))
 580			pr_info("Unknown key code - 0x%x\n", key_code);
 581		break;
 582	case HPWMI_WIRELESS:
 583		if (rfkill2_count) {
 584			hp_wmi_rfkill2_refresh();
 585			break;
 586		}
 587
 588		if (wifi_rfkill)
 589			rfkill_set_states(wifi_rfkill,
 590					  hp_wmi_get_sw_state(HPWMI_WIFI),
 591					  hp_wmi_get_hw_state(HPWMI_WIFI));
 592		if (bluetooth_rfkill)
 593			rfkill_set_states(bluetooth_rfkill,
 594					  hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
 595					  hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
 596		if (wwan_rfkill)
 597			rfkill_set_states(wwan_rfkill,
 598					  hp_wmi_get_sw_state(HPWMI_WWAN),
 599					  hp_wmi_get_hw_state(HPWMI_WWAN));
 600		break;
 601	case HPWMI_CPU_BATTERY_THROTTLE:
 602		pr_info("Unimplemented CPU throttle because of 3 Cell battery event detected\n");
 603		break;
 604	case HPWMI_LOCK_SWITCH:
 605		break;
 606	case HPWMI_LID_SWITCH:
 607		break;
 608	case HPWMI_SCREEN_ROTATION:
 609		break;
 610	case HPWMI_COOLSENSE_SYSTEM_MOBILE:
 611		break;
 612	case HPWMI_COOLSENSE_SYSTEM_HOT:
 613		break;
 614	case HPWMI_PROXIMITY_SENSOR:
 615		break;
 616	case HPWMI_BACKLIT_KB_BRIGHTNESS:
 617		break;
 618	case HPWMI_PEAKSHIFT_PERIOD:
 619		break;
 620	case HPWMI_BATTERY_CHARGE_PERIOD:
 621		break;
 622	default:
 623		pr_info("Unknown event_id - %d - 0x%x\n", event_id, event_data);
 624		break;
 625	}
 626}
 627
 628static int __init hp_wmi_input_setup(void)
 629{
 630	acpi_status status;
 631	int err, val;
 632
 633	hp_wmi_input_dev = input_allocate_device();
 634	if (!hp_wmi_input_dev)
 635		return -ENOMEM;
 636
 637	hp_wmi_input_dev->name = "HP WMI hotkeys";
 638	hp_wmi_input_dev->phys = "wmi/input0";
 639	hp_wmi_input_dev->id.bustype = BUS_HOST;
 640
 641	__set_bit(EV_SW, hp_wmi_input_dev->evbit);
 642
 643	/* Dock */
 644	val = hp_wmi_hw_state(HPWMI_DOCK_MASK);
 645	if (!(val < 0)) {
 646		__set_bit(SW_DOCK, hp_wmi_input_dev->swbit);
 647		input_report_switch(hp_wmi_input_dev, SW_DOCK, val);
 648	}
 649
 650	/* Tablet mode */
 651	val = hp_wmi_hw_state(HPWMI_TABLET_MASK);
 652	if (!(val < 0)) {
 653		__set_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit);
 654		input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE, val);
 655	}
 656
 657	err = sparse_keymap_setup(hp_wmi_input_dev, hp_wmi_keymap, NULL);
 658	if (err)
 659		goto err_free_dev;
 660
 661	/* Set initial hardware state */
 
 
 
 662	input_sync(hp_wmi_input_dev);
 663
 664	if (!hp_wmi_bios_2009_later() && hp_wmi_bios_2008_later())
 665		hp_wmi_enable_hotkeys();
 666
 667	status = wmi_install_notify_handler(HPWMI_EVENT_GUID, hp_wmi_notify, NULL);
 668	if (ACPI_FAILURE(status)) {
 669		err = -EIO;
 670		goto err_free_dev;
 671	}
 672
 673	err = input_register_device(hp_wmi_input_dev);
 674	if (err)
 675		goto err_uninstall_notifier;
 676
 677	return 0;
 678
 679 err_uninstall_notifier:
 680	wmi_remove_notify_handler(HPWMI_EVENT_GUID);
 
 
 681 err_free_dev:
 682	input_free_device(hp_wmi_input_dev);
 683	return err;
 684}
 685
 686static void hp_wmi_input_destroy(void)
 687{
 688	wmi_remove_notify_handler(HPWMI_EVENT_GUID);
 
 689	input_unregister_device(hp_wmi_input_dev);
 690}
 691
 
 
 
 
 
 
 
 
 
 
 692static int __init hp_wmi_rfkill_setup(struct platform_device *device)
 693{
 694	int err, wireless;
 695
 696	wireless = hp_wmi_read_int(HPWMI_WIRELESS_QUERY);
 697	if (wireless < 0)
 698		return wireless;
 699
 700	err = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, HPWMI_WRITE, &wireless,
 701				   sizeof(wireless), 0);
 702	if (err)
 703		return err;
 704
 705	if (wireless & 0x1) {
 706		wifi_rfkill = rfkill_alloc("hp-wifi", &device->dev,
 707					   RFKILL_TYPE_WLAN,
 708					   &hp_wmi_rfkill_ops,
 709					   (void *) HPWMI_WIFI);
 710		if (!wifi_rfkill)
 711			return -ENOMEM;
 712		rfkill_init_sw_state(wifi_rfkill,
 713				     hp_wmi_get_sw_state(HPWMI_WIFI));
 714		rfkill_set_hw_state(wifi_rfkill,
 715				    hp_wmi_get_hw_state(HPWMI_WIFI));
 716		err = rfkill_register(wifi_rfkill);
 717		if (err)
 718			goto register_wifi_error;
 719	}
 720
 721	if (wireless & 0x2) {
 722		bluetooth_rfkill = rfkill_alloc("hp-bluetooth", &device->dev,
 723						RFKILL_TYPE_BLUETOOTH,
 724						&hp_wmi_rfkill_ops,
 725						(void *) HPWMI_BLUETOOTH);
 726		if (!bluetooth_rfkill) {
 727			err = -ENOMEM;
 728			goto register_bluetooth_error;
 729		}
 730		rfkill_init_sw_state(bluetooth_rfkill,
 731				     hp_wmi_get_sw_state(HPWMI_BLUETOOTH));
 732		rfkill_set_hw_state(bluetooth_rfkill,
 733				    hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
 734		err = rfkill_register(bluetooth_rfkill);
 735		if (err)
 736			goto register_bluetooth_error;
 737	}
 738
 739	if (wireless & 0x4) {
 740		wwan_rfkill = rfkill_alloc("hp-wwan", &device->dev,
 741					   RFKILL_TYPE_WWAN,
 742					   &hp_wmi_rfkill_ops,
 743					   (void *) HPWMI_WWAN);
 744		if (!wwan_rfkill) {
 745			err = -ENOMEM;
 746			goto register_wwan_error;
 747		}
 748		rfkill_init_sw_state(wwan_rfkill,
 749				     hp_wmi_get_sw_state(HPWMI_WWAN));
 750		rfkill_set_hw_state(wwan_rfkill,
 751				    hp_wmi_get_hw_state(HPWMI_WWAN));
 752		err = rfkill_register(wwan_rfkill);
 753		if (err)
 754			goto register_wwan_error;
 755	}
 756
 757	return 0;
 758
 759register_wwan_error:
 760	rfkill_destroy(wwan_rfkill);
 761	wwan_rfkill = NULL;
 762	if (bluetooth_rfkill)
 763		rfkill_unregister(bluetooth_rfkill);
 764register_bluetooth_error:
 765	rfkill_destroy(bluetooth_rfkill);
 766	bluetooth_rfkill = NULL;
 767	if (wifi_rfkill)
 768		rfkill_unregister(wifi_rfkill);
 769register_wifi_error:
 770	rfkill_destroy(wifi_rfkill);
 771	wifi_rfkill = NULL;
 772	return err;
 773}
 774
 775static int __init hp_wmi_rfkill2_setup(struct platform_device *device)
 776{
 
 777	struct bios_rfkill2_state state;
 778	int err, i;
 779
 780	err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, HPWMI_READ, &state,
 781				   0, sizeof(state));
 782	if (err)
 783		return err < 0 ? err : -EINVAL;
 784
 785	if (state.count > HPWMI_MAX_RFKILL2_DEVICES) {
 786		pr_warn("unable to parse 0x1b query output\n");
 787		return -EINVAL;
 788	}
 789
 790	for (i = 0; i < state.count; i++) {
 791		struct rfkill *rfkill;
 792		enum rfkill_type type;
 793		char *name;
 794		switch (state.device[i].radio_type) {
 795		case HPWMI_WIFI:
 796			type = RFKILL_TYPE_WLAN;
 797			name = "hp-wifi";
 798			break;
 799		case HPWMI_BLUETOOTH:
 800			type = RFKILL_TYPE_BLUETOOTH;
 801			name = "hp-bluetooth";
 802			break;
 803		case HPWMI_WWAN:
 804			type = RFKILL_TYPE_WWAN;
 805			name = "hp-wwan";
 806			break;
 807		case HPWMI_GPS:
 808			type = RFKILL_TYPE_GPS;
 809			name = "hp-gps";
 810			break;
 811		default:
 812			pr_warn("unknown device type 0x%x\n",
 813				state.device[i].radio_type);
 814			continue;
 815		}
 816
 817		if (!state.device[i].vendor_id) {
 818			pr_warn("zero device %d while %d reported\n",
 819				i, state.count);
 820			continue;
 821		}
 822
 823		rfkill = rfkill_alloc(name, &device->dev, type,
 824				      &hp_wmi_rfkill2_ops, (void *)(long)i);
 825		if (!rfkill) {
 826			err = -ENOMEM;
 827			goto fail;
 828		}
 829
 830		rfkill2[rfkill2_count].id = state.device[i].rfkill_id;
 831		rfkill2[rfkill2_count].num = i;
 832		rfkill2[rfkill2_count].rfkill = rfkill;
 833
 834		rfkill_init_sw_state(rfkill,
 835				     IS_SWBLOCKED(state.device[i].power));
 836		rfkill_set_hw_state(rfkill,
 837				    IS_HWBLOCKED(state.device[i].power));
 838
 839		if (!(state.device[i].power & HPWMI_POWER_BIOS))
 840			pr_info("device %s blocked by BIOS\n", name);
 841
 842		err = rfkill_register(rfkill);
 843		if (err) {
 844			rfkill_destroy(rfkill);
 845			goto fail;
 846		}
 847
 848		rfkill2_count++;
 849	}
 850
 851	return 0;
 852fail:
 853	for (; rfkill2_count > 0; rfkill2_count--) {
 854		rfkill_unregister(rfkill2[rfkill2_count - 1].rfkill);
 855		rfkill_destroy(rfkill2[rfkill2_count - 1].rfkill);
 856	}
 857	return err;
 858}
 859
 860static int __init hp_wmi_bios_setup(struct platform_device *device)
 861{
 
 
 862	/* clear detected rfkill devices */
 863	wifi_rfkill = NULL;
 864	bluetooth_rfkill = NULL;
 865	wwan_rfkill = NULL;
 866	rfkill2_count = 0;
 867
 868	if (hp_wmi_rfkill_setup(device))
 869		hp_wmi_rfkill2_setup(device);
 870
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 871	return 0;
 
 
 
 
 872}
 873
 874static int __exit hp_wmi_bios_remove(struct platform_device *device)
 875{
 876	int i;
 
 877
 878	for (i = 0; i < rfkill2_count; i++) {
 879		rfkill_unregister(rfkill2[i].rfkill);
 880		rfkill_destroy(rfkill2[i].rfkill);
 881	}
 882
 883	if (wifi_rfkill) {
 884		rfkill_unregister(wifi_rfkill);
 885		rfkill_destroy(wifi_rfkill);
 886	}
 887	if (bluetooth_rfkill) {
 888		rfkill_unregister(bluetooth_rfkill);
 889		rfkill_destroy(bluetooth_rfkill);
 890	}
 891	if (wwan_rfkill) {
 892		rfkill_unregister(wwan_rfkill);
 893		rfkill_destroy(wwan_rfkill);
 894	}
 895
 896	return 0;
 897}
 898
 899static int hp_wmi_resume_handler(struct device *device)
 900{
 901	/*
 902	 * Hardware state may have changed while suspended, so trigger
 903	 * input events for the current state. As this is a switch,
 904	 * the input layer will only actually pass it on if the state
 905	 * changed.
 906	 */
 907	if (hp_wmi_input_dev) {
 908		if (test_bit(SW_DOCK, hp_wmi_input_dev->swbit))
 909			input_report_switch(hp_wmi_input_dev, SW_DOCK,
 910					    hp_wmi_hw_state(HPWMI_DOCK_MASK));
 911		if (test_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit))
 912			input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
 913					    hp_wmi_hw_state(HPWMI_TABLET_MASK));
 914		input_sync(hp_wmi_input_dev);
 915	}
 916
 917	if (rfkill2_count)
 918		hp_wmi_rfkill2_refresh();
 919
 920	if (wifi_rfkill)
 921		rfkill_set_states(wifi_rfkill,
 922				  hp_wmi_get_sw_state(HPWMI_WIFI),
 923				  hp_wmi_get_hw_state(HPWMI_WIFI));
 924	if (bluetooth_rfkill)
 925		rfkill_set_states(bluetooth_rfkill,
 926				  hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
 927				  hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
 928	if (wwan_rfkill)
 929		rfkill_set_states(wwan_rfkill,
 930				  hp_wmi_get_sw_state(HPWMI_WWAN),
 931				  hp_wmi_get_hw_state(HPWMI_WWAN));
 932
 933	return 0;
 934}
 935
 936static const struct dev_pm_ops hp_wmi_pm_ops = {
 937	.resume  = hp_wmi_resume_handler,
 938	.restore  = hp_wmi_resume_handler,
 939};
 940
 941static struct platform_driver hp_wmi_driver = {
 942	.driver = {
 943		.name = "hp-wmi",
 944		.pm = &hp_wmi_pm_ops,
 945		.dev_groups = hp_wmi_groups,
 946	},
 947	.remove = __exit_p(hp_wmi_bios_remove),
 948};
 949
 950static int __init hp_wmi_init(void)
 951{
 
 952	int event_capable = wmi_has_guid(HPWMI_EVENT_GUID);
 953	int bios_capable = wmi_has_guid(HPWMI_BIOS_GUID);
 954	int err;
 955
 956	if (!bios_capable && !event_capable)
 957		return -ENODEV;
 958
 959	if (event_capable) {
 960		err = hp_wmi_input_setup();
 961		if (err)
 962			return err;
 963	}
 964
 965	if (bios_capable) {
 966		hp_wmi_platform_dev =
 967			platform_device_register_simple("hp-wmi", -1, NULL, 0);
 968		if (IS_ERR(hp_wmi_platform_dev)) {
 969			err = PTR_ERR(hp_wmi_platform_dev);
 970			goto err_destroy_input;
 971		}
 972
 973		err = platform_driver_probe(&hp_wmi_driver, hp_wmi_bios_setup);
 974		if (err)
 975			goto err_unregister_device;
 976	}
 977
 978	return 0;
 979
 980err_unregister_device:
 981	platform_device_unregister(hp_wmi_platform_dev);
 982err_destroy_input:
 983	if (event_capable)
 984		hp_wmi_input_destroy();
 985
 986	return err;
 987}
 988module_init(hp_wmi_init);
 989
 990static void __exit hp_wmi_exit(void)
 991{
 992	if (wmi_has_guid(HPWMI_EVENT_GUID))
 993		hp_wmi_input_destroy();
 994
 995	if (hp_wmi_platform_dev) {
 996		platform_device_unregister(hp_wmi_platform_dev);
 997		platform_driver_unregister(&hp_wmi_driver);
 998	}
 999}
1000module_exit(hp_wmi_exit);