Linux Audio

Check our new training course

Loading...
v3.5.6
   1/*
   2 * Asus PC WMI hotkey driver
   3 *
   4 * Copyright(C) 2010 Intel Corporation.
   5 * Copyright(C) 2010-2011 Corentin Chary <corentin.chary@gmail.com>
   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/types.h>
  33#include <linux/slab.h>
  34#include <linux/input.h>
  35#include <linux/input/sparse-keymap.h>
  36#include <linux/fb.h>
  37#include <linux/backlight.h>
  38#include <linux/leds.h>
  39#include <linux/rfkill.h>
  40#include <linux/pci.h>
  41#include <linux/pci_hotplug.h>
  42#include <linux/hwmon.h>
  43#include <linux/hwmon-sysfs.h>
  44#include <linux/debugfs.h>
  45#include <linux/seq_file.h>
  46#include <linux/platform_device.h>
  47#include <linux/thermal.h>
  48#include <acpi/acpi_bus.h>
  49#include <acpi/acpi_drivers.h>
 
  50
  51#include "asus-wmi.h"
  52
  53MODULE_AUTHOR("Corentin Chary <corentincj@iksaif.net>, "
  54	      "Yong Wang <yong.y.wang@intel.com>");
  55MODULE_DESCRIPTION("Asus Generic WMI Driver");
  56MODULE_LICENSE("GPL");
  57
  58#define to_platform_driver(drv)					\
  59	(container_of((drv), struct platform_driver, driver))
  60
  61#define to_asus_wmi_driver(pdrv)					\
  62	(container_of((pdrv), struct asus_wmi_driver, platform_driver))
  63
  64#define ASUS_WMI_MGMT_GUID	"97845ED0-4E6D-11DE-8A39-0800200C9A66"
  65
  66#define NOTIFY_BRNUP_MIN		0x11
  67#define NOTIFY_BRNUP_MAX		0x1f
  68#define NOTIFY_BRNDOWN_MIN		0x20
  69#define NOTIFY_BRNDOWN_MAX		0x2e
  70#define NOTIFY_KBD_BRTUP		0xc4
  71#define NOTIFY_KBD_BRTDWN		0xc5
  72
  73/* WMI Methods */
  74#define ASUS_WMI_METHODID_SPEC	        0x43455053 /* BIOS SPECification */
  75#define ASUS_WMI_METHODID_SFBD		0x44424653 /* Set First Boot Device */
  76#define ASUS_WMI_METHODID_GLCD		0x44434C47 /* Get LCD status */
  77#define ASUS_WMI_METHODID_GPID		0x44495047 /* Get Panel ID?? (Resol) */
  78#define ASUS_WMI_METHODID_QMOD		0x444F4D51 /* Quiet MODe */
  79#define ASUS_WMI_METHODID_SPLV		0x4C425053 /* Set Panel Light Value */
 
  80#define ASUS_WMI_METHODID_SFUN		0x4E554653 /* FUNCtionalities */
  81#define ASUS_WMI_METHODID_SDSP		0x50534453 /* Set DiSPlay output */
  82#define ASUS_WMI_METHODID_GDSP		0x50534447 /* Get DiSPlay output */
  83#define ASUS_WMI_METHODID_DEVP		0x50564544 /* DEVice Policy */
  84#define ASUS_WMI_METHODID_OSVR		0x5256534F /* OS VeRsion */
  85#define ASUS_WMI_METHODID_DSTS		0x53544344 /* Device STatuS */
  86#define ASUS_WMI_METHODID_DSTS2		0x53545344 /* Device STatuS #2*/
  87#define ASUS_WMI_METHODID_BSTS		0x53545342 /* Bios STatuS ? */
  88#define ASUS_WMI_METHODID_DEVS		0x53564544 /* DEVice Set */
  89#define ASUS_WMI_METHODID_CFVS		0x53564643 /* CPU Frequency Volt Set */
  90#define ASUS_WMI_METHODID_KBFT		0x5446424B /* KeyBoard FilTer */
  91#define ASUS_WMI_METHODID_INIT		0x54494E49 /* INITialize */
  92#define ASUS_WMI_METHODID_HKEY		0x59454B48 /* Hot KEY ?? */
  93
  94#define ASUS_WMI_UNSUPPORTED_METHOD	0xFFFFFFFE
  95
  96/* Wireless */
  97#define ASUS_WMI_DEVID_HW_SWITCH	0x00010001
  98#define ASUS_WMI_DEVID_WIRELESS_LED	0x00010002
  99#define ASUS_WMI_DEVID_CWAP		0x00010003
 100#define ASUS_WMI_DEVID_WLAN		0x00010011
 
 101#define ASUS_WMI_DEVID_BLUETOOTH	0x00010013
 102#define ASUS_WMI_DEVID_GPS		0x00010015
 103#define ASUS_WMI_DEVID_WIMAX		0x00010017
 104#define ASUS_WMI_DEVID_WWAN3G		0x00010019
 105#define ASUS_WMI_DEVID_UWB		0x00010021
 106
 107/* Leds */
 108/* 0x000200XX and 0x000400XX */
 109#define ASUS_WMI_DEVID_LED1		0x00020011
 110#define ASUS_WMI_DEVID_LED2		0x00020012
 111#define ASUS_WMI_DEVID_LED3		0x00020013
 112#define ASUS_WMI_DEVID_LED4		0x00020014
 113#define ASUS_WMI_DEVID_LED5		0x00020015
 114#define ASUS_WMI_DEVID_LED6		0x00020016
 115
 116/* Backlight and Brightness */
 
 117#define ASUS_WMI_DEVID_BACKLIGHT	0x00050011
 118#define ASUS_WMI_DEVID_BRIGHTNESS	0x00050012
 119#define ASUS_WMI_DEVID_KBD_BACKLIGHT	0x00050021
 120#define ASUS_WMI_DEVID_LIGHT_SENSOR	0x00050022 /* ?? */
 
 121
 122/* Misc */
 123#define ASUS_WMI_DEVID_CAMERA		0x00060013
 124
 125/* Storage */
 126#define ASUS_WMI_DEVID_CARDREADER	0x00080013
 127
 128/* Input */
 129#define ASUS_WMI_DEVID_TOUCHPAD		0x00100011
 130#define ASUS_WMI_DEVID_TOUCHPAD_LED	0x00100012
 131
 132/* Fan, Thermal */
 133#define ASUS_WMI_DEVID_THERMAL_CTRL	0x00110011
 134#define ASUS_WMI_DEVID_FAN_CTRL		0x00110012
 135
 136/* Power */
 137#define ASUS_WMI_DEVID_PROCESSOR_STATE	0x00120012
 138
 
 
 
 139/* DSTS masks */
 140#define ASUS_WMI_DSTS_STATUS_BIT	0x00000001
 141#define ASUS_WMI_DSTS_UNKNOWN_BIT	0x00000002
 142#define ASUS_WMI_DSTS_PRESENCE_BIT	0x00010000
 143#define ASUS_WMI_DSTS_USER_BIT		0x00020000
 144#define ASUS_WMI_DSTS_BIOS_BIT		0x00040000
 145#define ASUS_WMI_DSTS_BRIGHTNESS_MASK	0x000000FF
 146#define ASUS_WMI_DSTS_MAX_BRIGTH_MASK	0x0000FF00
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 147
 148struct bios_args {
 149	u32 arg0;
 150	u32 arg1;
 151} __packed;
 152
 153/*
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 154 * <platform>/    - debugfs root directory
 155 *   dev_id      - current dev_id
 156 *   ctrl_param  - current ctrl_param
 157 *   method_id   - current method_id
 158 *   devs        - call DEVS(dev_id, ctrl_param) and print result
 159 *   dsts        - call DSTS(dev_id)  and print result
 160 *   call        - call method_id(dev_id, ctrl_param) and print result
 161 */
 162struct asus_wmi_debug {
 163	struct dentry *root;
 164	u32 method_id;
 165	u32 dev_id;
 166	u32 ctrl_param;
 167};
 168
 169struct asus_rfkill {
 170	struct asus_wmi *asus;
 171	struct rfkill *rfkill;
 172	u32 dev_id;
 173};
 174
 175struct asus_wmi {
 176	int dsts_id;
 177	int spec;
 178	int sfun;
 179
 180	struct input_dev *inputdev;
 181	struct backlight_device *backlight_device;
 182	struct device *hwmon_device;
 183	struct platform_device *platform_device;
 184
 
 
 185	struct led_classdev tpd_led;
 186	int tpd_led_wk;
 187	struct led_classdev kbd_led;
 188	int kbd_led_wk;
 
 
 189	struct workqueue_struct *led_workqueue;
 190	struct work_struct tpd_led_work;
 191	struct work_struct kbd_led_work;
 
 
 192
 193	struct asus_rfkill wlan;
 194	struct asus_rfkill bluetooth;
 195	struct asus_rfkill wimax;
 196	struct asus_rfkill wwan3g;
 197	struct asus_rfkill gps;
 198	struct asus_rfkill uwb;
 199
 
 
 
 
 200	struct hotplug_slot *hotplug_slot;
 201	struct mutex hotplug_lock;
 202	struct mutex wmi_lock;
 203	struct workqueue_struct *hotplug_workqueue;
 204	struct work_struct hotplug_work;
 205
 206	struct asus_wmi_debug debug;
 207
 208	struct asus_wmi_driver *driver;
 209};
 210
 211static int asus_wmi_input_init(struct asus_wmi *asus)
 212{
 213	int err;
 214
 215	asus->inputdev = input_allocate_device();
 216	if (!asus->inputdev)
 217		return -ENOMEM;
 218
 219	asus->inputdev->name = asus->driver->input_name;
 220	asus->inputdev->phys = asus->driver->input_phys;
 221	asus->inputdev->id.bustype = BUS_HOST;
 222	asus->inputdev->dev.parent = &asus->platform_device->dev;
 223	set_bit(EV_REP, asus->inputdev->evbit);
 224
 225	err = sparse_keymap_setup(asus->inputdev, asus->driver->keymap, NULL);
 226	if (err)
 227		goto err_free_dev;
 228
 229	err = input_register_device(asus->inputdev);
 230	if (err)
 231		goto err_free_keymap;
 232
 233	return 0;
 234
 235err_free_keymap:
 236	sparse_keymap_free(asus->inputdev);
 237err_free_dev:
 238	input_free_device(asus->inputdev);
 239	return err;
 240}
 241
 242static void asus_wmi_input_exit(struct asus_wmi *asus)
 243{
 244	if (asus->inputdev) {
 245		sparse_keymap_free(asus->inputdev);
 246		input_unregister_device(asus->inputdev);
 247	}
 248
 249	asus->inputdev = NULL;
 250}
 251
 252static int asus_wmi_evaluate_method(u32 method_id, u32 arg0, u32 arg1,
 253				    u32 *retval)
 254{
 255	struct bios_args args = {
 256		.arg0 = arg0,
 257		.arg1 = arg1,
 258	};
 259	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
 260	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
 261	acpi_status status;
 262	union acpi_object *obj;
 263	u32 tmp;
 264
 265	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 1, method_id,
 266				     &input, &output);
 267
 268	if (ACPI_FAILURE(status))
 269		goto exit;
 270
 271	obj = (union acpi_object *)output.pointer;
 272	if (obj && obj->type == ACPI_TYPE_INTEGER)
 273		tmp = (u32) obj->integer.value;
 274	else
 275		tmp = 0;
 276
 277	if (retval)
 278		*retval = tmp;
 279
 280	kfree(obj);
 281
 282exit:
 283	if (ACPI_FAILURE(status))
 284		return -EIO;
 285
 286	if (tmp == ASUS_WMI_UNSUPPORTED_METHOD)
 287		return -ENODEV;
 288
 289	return 0;
 290}
 291
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 292static int asus_wmi_get_devstate(struct asus_wmi *asus, u32 dev_id, u32 *retval)
 293{
 294	return asus_wmi_evaluate_method(asus->dsts_id, dev_id, 0, retval);
 295}
 296
 297static int asus_wmi_set_devstate(u32 dev_id, u32 ctrl_param,
 298				 u32 *retval)
 299{
 300	return asus_wmi_evaluate_method(ASUS_WMI_METHODID_DEVS, dev_id,
 301					ctrl_param, retval);
 302}
 303
 304/* Helper for special devices with magic return codes */
 305static int asus_wmi_get_devstate_bits(struct asus_wmi *asus,
 306				      u32 dev_id, u32 mask)
 307{
 308	u32 retval = 0;
 309	int err;
 310
 311	err = asus_wmi_get_devstate(asus, dev_id, &retval);
 312
 313	if (err < 0)
 314		return err;
 315
 316	if (!(retval & ASUS_WMI_DSTS_PRESENCE_BIT))
 317		return -ENODEV;
 318
 319	if (mask == ASUS_WMI_DSTS_STATUS_BIT) {
 320		if (retval & ASUS_WMI_DSTS_UNKNOWN_BIT)
 321			return -ENODEV;
 322	}
 323
 324	return retval & mask;
 325}
 326
 327static int asus_wmi_get_devstate_simple(struct asus_wmi *asus, u32 dev_id)
 328{
 329	return asus_wmi_get_devstate_bits(asus, dev_id,
 330					  ASUS_WMI_DSTS_STATUS_BIT);
 331}
 332
 333/*
 334 * LEDs
 335 */
 336/*
 337 * These functions actually update the LED's, and are called from a
 338 * workqueue. By doing this as separate work rather than when the LED
 339 * subsystem asks, we avoid messing with the Asus ACPI stuff during a
 340 * potentially bad time, such as a timer interrupt.
 341 */
 342static void tpd_led_update(struct work_struct *work)
 343{
 344	int ctrl_param;
 345	struct asus_wmi *asus;
 346
 347	asus = container_of(work, struct asus_wmi, tpd_led_work);
 348
 349	ctrl_param = asus->tpd_led_wk;
 350	asus_wmi_set_devstate(ASUS_WMI_DEVID_TOUCHPAD_LED, ctrl_param, NULL);
 351}
 352
 353static void tpd_led_set(struct led_classdev *led_cdev,
 354			enum led_brightness value)
 355{
 356	struct asus_wmi *asus;
 357
 358	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 359
 360	asus->tpd_led_wk = !!value;
 361	queue_work(asus->led_workqueue, &asus->tpd_led_work);
 362}
 363
 364static int read_tpd_led_state(struct asus_wmi *asus)
 365{
 366	return asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_TOUCHPAD_LED);
 367}
 368
 369static enum led_brightness tpd_led_get(struct led_classdev *led_cdev)
 370{
 371	struct asus_wmi *asus;
 372
 373	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 374
 375	return read_tpd_led_state(asus);
 376}
 377
 378static void kbd_led_update(struct work_struct *work)
 379{
 380	int ctrl_param = 0;
 381	struct asus_wmi *asus;
 382
 383	asus = container_of(work, struct asus_wmi, kbd_led_work);
 384
 385	/*
 386	 * bits 0-2: level
 387	 * bit 7: light on/off
 388	 */
 389	if (asus->kbd_led_wk > 0)
 390		ctrl_param = 0x80 | (asus->kbd_led_wk & 0x7F);
 391
 392	asus_wmi_set_devstate(ASUS_WMI_DEVID_KBD_BACKLIGHT, ctrl_param, NULL);
 393}
 394
 395static int kbd_led_read(struct asus_wmi *asus, int *level, int *env)
 396{
 397	int retval;
 398
 399	/*
 400	 * bits 0-2: level
 401	 * bit 7: light on/off
 402	 * bit 8-10: environment (0: dark, 1: normal, 2: light)
 403	 * bit 17: status unknown
 404	 */
 405	retval = asus_wmi_get_devstate_bits(asus, ASUS_WMI_DEVID_KBD_BACKLIGHT,
 406					    0xFFFF);
 407
 408	/* Unknown status is considered as off */
 409	if (retval == 0x8000)
 410		retval = 0;
 411
 412	if (retval >= 0) {
 413		if (level)
 414			*level = retval & 0x7F;
 415		if (env)
 416			*env = (retval >> 8) & 0x7F;
 417		retval = 0;
 418	}
 419
 420	return retval;
 421}
 422
 423static void kbd_led_set(struct led_classdev *led_cdev,
 424			enum led_brightness value)
 425{
 426	struct asus_wmi *asus;
 427
 428	asus = container_of(led_cdev, struct asus_wmi, kbd_led);
 429
 430	if (value > asus->kbd_led.max_brightness)
 431		value = asus->kbd_led.max_brightness;
 432	else if (value < 0)
 433		value = 0;
 434
 435	asus->kbd_led_wk = value;
 436	queue_work(asus->led_workqueue, &asus->kbd_led_work);
 437}
 438
 439static enum led_brightness kbd_led_get(struct led_classdev *led_cdev)
 440{
 441	struct asus_wmi *asus;
 442	int retval, value;
 443
 444	asus = container_of(led_cdev, struct asus_wmi, kbd_led);
 445
 446	retval = kbd_led_read(asus, &value, NULL);
 447
 448	if (retval < 0)
 449		return retval;
 450
 451	return value;
 452}
 453
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 454static void asus_wmi_led_exit(struct asus_wmi *asus)
 455{
 456	if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
 457		led_classdev_unregister(&asus->kbd_led);
 458	if (!IS_ERR_OR_NULL(asus->tpd_led.dev))
 459		led_classdev_unregister(&asus->tpd_led);
 
 
 
 
 460	if (asus->led_workqueue)
 461		destroy_workqueue(asus->led_workqueue);
 462}
 463
 464static int asus_wmi_led_init(struct asus_wmi *asus)
 465{
 466	int rv = 0;
 467
 468	asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
 469	if (!asus->led_workqueue)
 470		return -ENOMEM;
 471
 472	if (read_tpd_led_state(asus) >= 0) {
 473		INIT_WORK(&asus->tpd_led_work, tpd_led_update);
 474
 475		asus->tpd_led.name = "asus::touchpad";
 476		asus->tpd_led.brightness_set = tpd_led_set;
 477		asus->tpd_led.brightness_get = tpd_led_get;
 478		asus->tpd_led.max_brightness = 1;
 479
 480		rv = led_classdev_register(&asus->platform_device->dev,
 481					   &asus->tpd_led);
 482		if (rv)
 483			goto error;
 484	}
 485
 486	if (kbd_led_read(asus, NULL, NULL) >= 0) {
 
 487		INIT_WORK(&asus->kbd_led_work, kbd_led_update);
 488
 
 489		asus->kbd_led.name = "asus::kbd_backlight";
 490		asus->kbd_led.brightness_set = kbd_led_set;
 491		asus->kbd_led.brightness_get = kbd_led_get;
 492		asus->kbd_led.max_brightness = 3;
 493
 494		rv = led_classdev_register(&asus->platform_device->dev,
 495					   &asus->kbd_led);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 496	}
 497
 498error:
 499	if (rv)
 500		asus_wmi_led_exit(asus);
 501
 502	return rv;
 503}
 504
 505
 506/*
 507 * PCI hotplug (for wlan rfkill)
 508 */
 509static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus)
 510{
 511	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 512
 513	if (result < 0)
 514		return false;
 515	return !result;
 516}
 517
 518static void asus_rfkill_hotplug(struct asus_wmi *asus)
 519{
 520	struct pci_dev *dev;
 521	struct pci_bus *bus;
 522	bool blocked;
 523	bool absent;
 524	u32 l;
 525
 526	mutex_lock(&asus->wmi_lock);
 527	blocked = asus_wlan_rfkill_blocked(asus);
 528	mutex_unlock(&asus->wmi_lock);
 529
 530	mutex_lock(&asus->hotplug_lock);
 
 531
 532	if (asus->wlan.rfkill)
 533		rfkill_set_sw_state(asus->wlan.rfkill, blocked);
 534
 535	if (asus->hotplug_slot) {
 536		bus = pci_find_bus(0, 1);
 537		if (!bus) {
 538			pr_warn("Unable to find PCI bus 1?\n");
 539			goto out_unlock;
 540		}
 541
 542		if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
 543			pr_err("Unable to read PCI config space?\n");
 544			goto out_unlock;
 545		}
 546		absent = (l == 0xffffffff);
 547
 548		if (blocked != absent) {
 549			pr_warn("BIOS says wireless lan is %s, "
 550				"but the pci device is %s\n",
 551				blocked ? "blocked" : "unblocked",
 552				absent ? "absent" : "present");
 553			pr_warn("skipped wireless hotplug as probably "
 554				"inappropriate for this model\n");
 555			goto out_unlock;
 556		}
 557
 558		if (!blocked) {
 559			dev = pci_get_slot(bus, 0);
 560			if (dev) {
 561				/* Device already present */
 562				pci_dev_put(dev);
 563				goto out_unlock;
 564			}
 565			dev = pci_scan_single_device(bus, 0);
 566			if (dev) {
 567				pci_bus_assign_resources(bus);
 568				if (pci_bus_add_device(dev))
 569					pr_err("Unable to hotplug wifi\n");
 570			}
 571		} else {
 572			dev = pci_get_slot(bus, 0);
 573			if (dev) {
 574				pci_stop_and_remove_bus_device(dev);
 575				pci_dev_put(dev);
 576			}
 577		}
 578	}
 579
 580out_unlock:
 
 581	mutex_unlock(&asus->hotplug_lock);
 582}
 583
 584static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data)
 585{
 586	struct asus_wmi *asus = data;
 587
 588	if (event != ACPI_NOTIFY_BUS_CHECK)
 589		return;
 590
 591	/*
 592	 * We can't call directly asus_rfkill_hotplug because most
 593	 * of the time WMBC is still being executed and not reetrant.
 594	 * There is currently no way to tell ACPICA that  we want this
 595	 * method to be serialized, we schedule a asus_rfkill_hotplug
 596	 * call later, in a safer context.
 597	 */
 598	queue_work(asus->hotplug_workqueue, &asus->hotplug_work);
 599}
 600
 601static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node)
 602{
 603	acpi_status status;
 604	acpi_handle handle;
 605
 606	status = acpi_get_handle(NULL, node, &handle);
 607
 608	if (ACPI_SUCCESS(status)) {
 609		status = acpi_install_notify_handler(handle,
 610						     ACPI_SYSTEM_NOTIFY,
 611						     asus_rfkill_notify, asus);
 612		if (ACPI_FAILURE(status))
 613			pr_warn("Failed to register notify on %s\n", node);
 614	} else
 615		return -ENODEV;
 616
 617	return 0;
 618}
 619
 620static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node)
 621{
 622	acpi_status status = AE_OK;
 623	acpi_handle handle;
 624
 625	status = acpi_get_handle(NULL, node, &handle);
 626
 627	if (ACPI_SUCCESS(status)) {
 628		status = acpi_remove_notify_handler(handle,
 629						    ACPI_SYSTEM_NOTIFY,
 630						    asus_rfkill_notify);
 631		if (ACPI_FAILURE(status))
 632			pr_err("Error removing rfkill notify handler %s\n",
 633			       node);
 634	}
 635}
 636
 637static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot,
 638				   u8 *value)
 639{
 640	struct asus_wmi *asus = hotplug_slot->private;
 641	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 642
 643	if (result < 0)
 644		return result;
 645
 646	*value = !!result;
 647	return 0;
 648}
 649
 650static void asus_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot)
 651{
 652	kfree(hotplug_slot->info);
 653	kfree(hotplug_slot);
 654}
 655
 656static struct hotplug_slot_ops asus_hotplug_slot_ops = {
 657	.owner = THIS_MODULE,
 658	.get_adapter_status = asus_get_adapter_status,
 659	.get_power_status = asus_get_adapter_status,
 660};
 661
 662static void asus_hotplug_work(struct work_struct *work)
 663{
 664	struct asus_wmi *asus;
 665
 666	asus = container_of(work, struct asus_wmi, hotplug_work);
 667	asus_rfkill_hotplug(asus);
 668}
 669
 670static int asus_setup_pci_hotplug(struct asus_wmi *asus)
 671{
 672	int ret = -ENOMEM;
 673	struct pci_bus *bus = pci_find_bus(0, 1);
 674
 675	if (!bus) {
 676		pr_err("Unable to find wifi PCI bus\n");
 677		return -ENODEV;
 678	}
 679
 680	asus->hotplug_workqueue =
 681	    create_singlethread_workqueue("hotplug_workqueue");
 682	if (!asus->hotplug_workqueue)
 683		goto error_workqueue;
 684
 685	INIT_WORK(&asus->hotplug_work, asus_hotplug_work);
 686
 687	asus->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
 688	if (!asus->hotplug_slot)
 689		goto error_slot;
 690
 691	asus->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
 692					   GFP_KERNEL);
 693	if (!asus->hotplug_slot->info)
 694		goto error_info;
 695
 696	asus->hotplug_slot->private = asus;
 697	asus->hotplug_slot->release = &asus_cleanup_pci_hotplug;
 698	asus->hotplug_slot->ops = &asus_hotplug_slot_ops;
 699	asus_get_adapter_status(asus->hotplug_slot,
 700				&asus->hotplug_slot->info->adapter_status);
 701
 702	ret = pci_hp_register(asus->hotplug_slot, bus, 0, "asus-wifi");
 703	if (ret) {
 704		pr_err("Unable to register hotplug slot - %d\n", ret);
 705		goto error_register;
 706	}
 707
 708	return 0;
 709
 710error_register:
 711	kfree(asus->hotplug_slot->info);
 712error_info:
 713	kfree(asus->hotplug_slot);
 714	asus->hotplug_slot = NULL;
 715error_slot:
 716	destroy_workqueue(asus->hotplug_workqueue);
 717error_workqueue:
 718	return ret;
 719}
 720
 721/*
 722 * Rfkill devices
 723 */
 724static int asus_rfkill_set(void *data, bool blocked)
 725{
 726	struct asus_rfkill *priv = data;
 727	u32 ctrl_param = !blocked;
 
 728
 729	return asus_wmi_set_devstate(priv->dev_id, ctrl_param, NULL);
 
 
 
 
 
 
 
 
 
 
 
 
 730}
 731
 732static void asus_rfkill_query(struct rfkill *rfkill, void *data)
 733{
 734	struct asus_rfkill *priv = data;
 735	int result;
 736
 737	result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id);
 738
 739	if (result < 0)
 740		return;
 741
 742	rfkill_set_sw_state(priv->rfkill, !result);
 743}
 744
 745static int asus_rfkill_wlan_set(void *data, bool blocked)
 746{
 747	struct asus_rfkill *priv = data;
 748	struct asus_wmi *asus = priv->asus;
 749	int ret;
 750
 751	/*
 752	 * This handler is enabled only if hotplug is enabled.
 753	 * In this case, the asus_wmi_set_devstate() will
 754	 * trigger a wmi notification and we need to wait
 755	 * this call to finish before being able to call
 756	 * any wmi method
 757	 */
 758	mutex_lock(&asus->wmi_lock);
 759	ret = asus_rfkill_set(data, blocked);
 760	mutex_unlock(&asus->wmi_lock);
 761	return ret;
 762}
 763
 764static const struct rfkill_ops asus_rfkill_wlan_ops = {
 765	.set_block = asus_rfkill_wlan_set,
 766	.query = asus_rfkill_query,
 767};
 768
 769static const struct rfkill_ops asus_rfkill_ops = {
 770	.set_block = asus_rfkill_set,
 771	.query = asus_rfkill_query,
 772};
 773
 774static int asus_new_rfkill(struct asus_wmi *asus,
 775			   struct asus_rfkill *arfkill,
 776			   const char *name, enum rfkill_type type, int dev_id)
 777{
 778	int result = asus_wmi_get_devstate_simple(asus, dev_id);
 779	struct rfkill **rfkill = &arfkill->rfkill;
 780
 781	if (result < 0)
 782		return result;
 783
 784	arfkill->dev_id = dev_id;
 785	arfkill->asus = asus;
 786
 787	if (dev_id == ASUS_WMI_DEVID_WLAN &&
 788	    asus->driver->quirks->hotplug_wireless)
 789		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
 790				       &asus_rfkill_wlan_ops, arfkill);
 791	else
 792		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
 793				       &asus_rfkill_ops, arfkill);
 794
 795	if (!*rfkill)
 796		return -EINVAL;
 797
 
 
 
 
 798	rfkill_init_sw_state(*rfkill, !result);
 799	result = rfkill_register(*rfkill);
 800	if (result) {
 801		rfkill_destroy(*rfkill);
 802		*rfkill = NULL;
 803		return result;
 804	}
 805	return 0;
 806}
 807
 808static void asus_wmi_rfkill_exit(struct asus_wmi *asus)
 809{
 
 
 
 810	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
 811	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
 812	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
 813	if (asus->wlan.rfkill) {
 814		rfkill_unregister(asus->wlan.rfkill);
 815		rfkill_destroy(asus->wlan.rfkill);
 816		asus->wlan.rfkill = NULL;
 817	}
 818	/*
 819	 * Refresh pci hotplug in case the rfkill state was changed after
 820	 * asus_unregister_rfkill_notifier()
 821	 */
 822	asus_rfkill_hotplug(asus);
 823	if (asus->hotplug_slot)
 824		pci_hp_deregister(asus->hotplug_slot);
 825	if (asus->hotplug_workqueue)
 826		destroy_workqueue(asus->hotplug_workqueue);
 827
 828	if (asus->bluetooth.rfkill) {
 829		rfkill_unregister(asus->bluetooth.rfkill);
 830		rfkill_destroy(asus->bluetooth.rfkill);
 831		asus->bluetooth.rfkill = NULL;
 832	}
 833	if (asus->wimax.rfkill) {
 834		rfkill_unregister(asus->wimax.rfkill);
 835		rfkill_destroy(asus->wimax.rfkill);
 836		asus->wimax.rfkill = NULL;
 837	}
 838	if (asus->wwan3g.rfkill) {
 839		rfkill_unregister(asus->wwan3g.rfkill);
 840		rfkill_destroy(asus->wwan3g.rfkill);
 841		asus->wwan3g.rfkill = NULL;
 842	}
 843	if (asus->gps.rfkill) {
 844		rfkill_unregister(asus->gps.rfkill);
 845		rfkill_destroy(asus->gps.rfkill);
 846		asus->gps.rfkill = NULL;
 847	}
 848	if (asus->uwb.rfkill) {
 849		rfkill_unregister(asus->uwb.rfkill);
 850		rfkill_destroy(asus->uwb.rfkill);
 851		asus->uwb.rfkill = NULL;
 852	}
 853}
 854
 855static int asus_wmi_rfkill_init(struct asus_wmi *asus)
 856{
 857	int result = 0;
 858
 859	mutex_init(&asus->hotplug_lock);
 860	mutex_init(&asus->wmi_lock);
 861
 862	result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan",
 863				 RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN);
 864
 865	if (result && result != -ENODEV)
 866		goto exit;
 867
 868	result = asus_new_rfkill(asus, &asus->bluetooth,
 869				 "asus-bluetooth", RFKILL_TYPE_BLUETOOTH,
 870				 ASUS_WMI_DEVID_BLUETOOTH);
 871
 872	if (result && result != -ENODEV)
 873		goto exit;
 874
 875	result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax",
 876				 RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX);
 877
 878	if (result && result != -ENODEV)
 879		goto exit;
 880
 881	result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g",
 882				 RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G);
 883
 884	if (result && result != -ENODEV)
 885		goto exit;
 886
 887	result = asus_new_rfkill(asus, &asus->gps, "asus-gps",
 888				 RFKILL_TYPE_GPS, ASUS_WMI_DEVID_GPS);
 889
 890	if (result && result != -ENODEV)
 891		goto exit;
 892
 893	result = asus_new_rfkill(asus, &asus->uwb, "asus-uwb",
 894				 RFKILL_TYPE_UWB, ASUS_WMI_DEVID_UWB);
 895
 896	if (result && result != -ENODEV)
 897		goto exit;
 898
 899	if (!asus->driver->quirks->hotplug_wireless)
 900		goto exit;
 901
 902	result = asus_setup_pci_hotplug(asus);
 903	/*
 904	 * If we get -EBUSY then something else is handling the PCI hotplug -
 905	 * don't fail in this case
 906	 */
 907	if (result == -EBUSY)
 908		result = 0;
 909
 910	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
 911	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
 912	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
 913	/*
 914	 * Refresh pci hotplug in case the rfkill state was changed during
 915	 * setup.
 916	 */
 917	asus_rfkill_hotplug(asus);
 918
 919exit:
 920	if (result && result != -ENODEV)
 921		asus_wmi_rfkill_exit(asus);
 922
 923	if (result == -ENODEV)
 924		result = 0;
 925
 926	return result;
 927}
 928
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 929/*
 930 * Hwmon device
 931 */
 932static ssize_t asus_hwmon_pwm1(struct device *dev,
 933			       struct device_attribute *attr,
 934			       char *buf)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 935{
 936	struct asus_wmi *asus = dev_get_drvdata(dev);
 937	u32 value;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 938	int err;
 939
 940	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
 
 
 
 941
 
 942	if (err < 0)
 943		return err;
 944
 945	value &= 0xFF;
 946
 947	if (value == 1) /* Low Speed */
 948		value = 85;
 949	else if (value == 2)
 950		value = 170;
 951	else if (value == 3)
 952		value = 255;
 953	else if (value != 0) {
 954		pr_err("Unknown fan speed %#x", value);
 955		value = -1;
 956	}
 
 
 
 
 
 
 
 
 
 
 957
 958	return sprintf(buf, "%d\n", value);
 959}
 960
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 961static ssize_t asus_hwmon_temp1(struct device *dev,
 962				struct device_attribute *attr,
 963				char *buf)
 964{
 965	struct asus_wmi *asus = dev_get_drvdata(dev);
 966	u32 value;
 967	int err;
 968
 969	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_THERMAL_CTRL, &value);
 970
 971	if (err < 0)
 972		return err;
 973
 974	value = KELVIN_TO_CELSIUS((value & 0xFFFF)) * 1000;
 975
 976	return sprintf(buf, "%d\n", value);
 977}
 978
 979static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO, asus_hwmon_pwm1, NULL, 0);
 980static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, asus_hwmon_temp1, NULL, 0);
 
 
 
 981
 982static ssize_t
 983show_name(struct device *dev, struct device_attribute *attr, char *buf)
 984{
 985	return sprintf(buf, "asus\n");
 986}
 987static SENSOR_DEVICE_ATTR(name, S_IRUGO, show_name, NULL, 0);
 988
 989static struct attribute *hwmon_attributes[] = {
 990	&sensor_dev_attr_pwm1.dev_attr.attr,
 991	&sensor_dev_attr_temp1_input.dev_attr.attr,
 992	&sensor_dev_attr_name.dev_attr.attr,
 
 
 
 993	NULL
 994};
 995
 996static umode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
 997					  struct attribute *attr, int idx)
 998{
 999	struct device *dev = container_of(kobj, struct device, kobj);
1000	struct platform_device *pdev = to_platform_device(dev->parent);
1001	struct asus_wmi *asus = platform_get_drvdata(pdev);
1002	bool ok = true;
1003	int dev_id = -1;
 
1004	u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
 
1005
1006	if (attr == &sensor_dev_attr_pwm1.dev_attr.attr)
1007		dev_id = ASUS_WMI_DEVID_FAN_CTRL;
1008	else if (attr == &sensor_dev_attr_temp1_input.dev_attr.attr)
1009		dev_id = ASUS_WMI_DEVID_THERMAL_CTRL;
1010
 
 
 
 
 
 
 
 
1011	if (dev_id != -1) {
1012		int err = asus_wmi_get_devstate(asus, dev_id, &value);
1013
1014		if (err < 0)
1015			return 0; /* can't return negative here */
1016	}
1017
1018	if (dev_id == ASUS_WMI_DEVID_FAN_CTRL) {
1019		/*
1020		 * We need to find a better way, probably using sfun,
1021		 * bits or spec ...
1022		 * Currently we disable it if:
1023		 * - ASUS_WMI_UNSUPPORTED_METHOD is returned
1024		 * - reverved bits are non-zero
1025		 * - sfun and presence bit are not set
1026		 */
1027		if (value == ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
1028		    || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)))
1029			ok = false;
 
 
1030	} else if (dev_id == ASUS_WMI_DEVID_THERMAL_CTRL) {
1031		/* If value is zero, something is clearly wrong */
1032		if (value == 0)
1033			ok = false;
 
 
 
 
1034	}
1035
1036	return ok ? attr->mode : 0;
1037}
1038
1039static struct attribute_group hwmon_attribute_group = {
1040	.is_visible = asus_hwmon_sysfs_is_visible,
1041	.attrs = hwmon_attributes
1042};
1043
1044static void asus_wmi_hwmon_exit(struct asus_wmi *asus)
1045{
1046	struct device *hwmon;
1047
1048	hwmon = asus->hwmon_device;
1049	if (!hwmon)
1050		return;
1051	sysfs_remove_group(&hwmon->kobj, &hwmon_attribute_group);
1052	hwmon_device_unregister(hwmon);
1053	asus->hwmon_device = NULL;
1054}
1055
1056static int asus_wmi_hwmon_init(struct asus_wmi *asus)
1057{
1058	struct device *hwmon;
1059	int result;
1060
1061	hwmon = hwmon_device_register(&asus->platform_device->dev);
 
 
1062	if (IS_ERR(hwmon)) {
1063		pr_err("Could not register asus hwmon device\n");
1064		return PTR_ERR(hwmon);
1065	}
1066	dev_set_drvdata(hwmon, asus);
1067	asus->hwmon_device = hwmon;
1068	result = sysfs_create_group(&hwmon->kobj, &hwmon_attribute_group);
1069	if (result)
1070		asus_wmi_hwmon_exit(asus);
1071	return result;
1072}
1073
1074/*
1075 * Backlight
1076 */
1077static int read_backlight_power(struct asus_wmi *asus)
1078{
1079	int ret;
1080	if (asus->driver->quirks->store_backlight_power)
1081		ret = !asus->driver->panel_power;
1082	else
1083		ret = asus_wmi_get_devstate_simple(asus,
1084						   ASUS_WMI_DEVID_BACKLIGHT);
1085
1086	if (ret < 0)
1087		return ret;
1088
1089	return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
1090}
1091
1092static int read_brightness_max(struct asus_wmi *asus)
1093{
1094	u32 retval;
1095	int err;
1096
1097	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1098
1099	if (err < 0)
1100		return err;
1101
1102	retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
1103	retval >>= 8;
1104
1105	if (!retval)
1106		return -ENODEV;
1107
1108	return retval;
1109}
1110
1111static int read_brightness(struct backlight_device *bd)
1112{
1113	struct asus_wmi *asus = bl_get_data(bd);
1114	u32 retval;
1115	int err;
1116
1117	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1118
1119	if (err < 0)
1120		return err;
1121
1122	return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
1123}
1124
1125static u32 get_scalar_command(struct backlight_device *bd)
1126{
1127	struct asus_wmi *asus = bl_get_data(bd);
1128	u32 ctrl_param = 0;
1129
1130	if ((asus->driver->brightness < bd->props.brightness) ||
1131	    bd->props.brightness == bd->props.max_brightness)
1132		ctrl_param = 0x00008001;
1133	else if ((asus->driver->brightness > bd->props.brightness) ||
1134		 bd->props.brightness == 0)
1135		ctrl_param = 0x00008000;
1136
1137	asus->driver->brightness = bd->props.brightness;
1138
1139	return ctrl_param;
1140}
1141
1142static int update_bl_status(struct backlight_device *bd)
1143{
1144	struct asus_wmi *asus = bl_get_data(bd);
1145	u32 ctrl_param;
1146	int power, err = 0;
1147
1148	power = read_backlight_power(asus);
1149	if (power != -ENODEV && bd->props.power != power) {
1150		ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
1151		err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
1152					    ctrl_param, NULL);
1153		if (asus->driver->quirks->store_backlight_power)
1154			asus->driver->panel_power = bd->props.power;
1155
1156		/* When using scalar brightness, updating the brightness
1157		 * will mess with the backlight power */
1158		if (asus->driver->quirks->scalar_panel_brightness)
1159			return err;
1160	}
1161
1162	if (asus->driver->quirks->scalar_panel_brightness)
1163		ctrl_param = get_scalar_command(bd);
1164	else
1165		ctrl_param = bd->props.brightness;
1166
1167	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
1168				    ctrl_param, NULL);
1169
1170	return err;
1171}
1172
1173static const struct backlight_ops asus_wmi_bl_ops = {
1174	.get_brightness = read_brightness,
1175	.update_status = update_bl_status,
1176};
1177
1178static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
1179{
1180	struct backlight_device *bd = asus->backlight_device;
1181	int old = bd->props.brightness;
1182	int new = old;
1183
1184	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1185		new = code - NOTIFY_BRNUP_MIN + 1;
1186	else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
1187		new = code - NOTIFY_BRNDOWN_MIN;
1188
1189	bd->props.brightness = new;
1190	backlight_update_status(bd);
1191	backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1192
1193	return old;
1194}
1195
1196static int asus_wmi_backlight_init(struct asus_wmi *asus)
1197{
1198	struct backlight_device *bd;
1199	struct backlight_properties props;
1200	int max;
1201	int power;
1202
1203	max = read_brightness_max(asus);
1204
1205	if (max == -ENODEV)
1206		max = 0;
1207	else if (max < 0)
1208		return max;
1209
1210	power = read_backlight_power(asus);
1211
1212	if (power == -ENODEV)
1213		power = FB_BLANK_UNBLANK;
1214	else if (power < 0)
1215		return power;
1216
1217	memset(&props, 0, sizeof(struct backlight_properties));
1218	props.type = BACKLIGHT_PLATFORM;
1219	props.max_brightness = max;
1220	bd = backlight_device_register(asus->driver->name,
1221				       &asus->platform_device->dev, asus,
1222				       &asus_wmi_bl_ops, &props);
1223	if (IS_ERR(bd)) {
1224		pr_err("Could not register backlight device\n");
1225		return PTR_ERR(bd);
1226	}
1227
1228	asus->backlight_device = bd;
1229
1230	if (asus->driver->quirks->store_backlight_power)
1231		asus->driver->panel_power = power;
1232
1233	bd->props.brightness = read_brightness(bd);
1234	bd->props.power = power;
1235	backlight_update_status(bd);
1236
1237	asus->driver->brightness = bd->props.brightness;
1238
1239	return 0;
1240}
1241
1242static void asus_wmi_backlight_exit(struct asus_wmi *asus)
1243{
1244	if (asus->backlight_device)
1245		backlight_device_unregister(asus->backlight_device);
1246
1247	asus->backlight_device = NULL;
1248}
1249
 
 
 
 
 
 
 
 
 
 
 
 
1250static void asus_wmi_notify(u32 value, void *context)
1251{
1252	struct asus_wmi *asus = context;
1253	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
1254	union acpi_object *obj;
1255	acpi_status status;
1256	int code;
1257	int orig_code;
1258	unsigned int key_value = 1;
1259	bool autorelease = 1;
1260
1261	status = wmi_get_event_data(value, &response);
1262	if (status != AE_OK) {
1263		pr_err("bad event status 0x%x\n", status);
1264		return;
1265	}
1266
1267	obj = (union acpi_object *)response.pointer;
1268
1269	if (!obj || obj->type != ACPI_TYPE_INTEGER)
1270		goto exit;
1271
1272	code = obj->integer.value;
1273	orig_code = code;
1274
1275	if (asus->driver->key_filter) {
1276		asus->driver->key_filter(asus->driver, &code, &key_value,
1277					 &autorelease);
1278		if (code == ASUS_WMI_KEY_IGNORE)
1279			goto exit;
1280	}
1281
1282	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1283		code = NOTIFY_BRNUP_MIN;
1284	else if (code >= NOTIFY_BRNDOWN_MIN &&
1285		 code <= NOTIFY_BRNDOWN_MAX)
1286		code = NOTIFY_BRNDOWN_MIN;
1287
1288	if (code == NOTIFY_BRNUP_MIN || code == NOTIFY_BRNDOWN_MIN) {
1289		if (!acpi_video_backlight_support())
1290			asus_wmi_backlight_notify(asus, orig_code);
1291	} else if (!sparse_keymap_report_event(asus->inputdev, code,
1292					       key_value, autorelease))
 
 
 
 
 
 
 
 
1293		pr_info("Unknown key %x pressed\n", code);
1294
1295exit:
1296	kfree(obj);
1297}
1298
1299/*
1300 * Sys helpers
1301 */
1302static int parse_arg(const char *buf, unsigned long count, int *val)
1303{
1304	if (!count)
1305		return 0;
1306	if (sscanf(buf, "%i", val) != 1)
1307		return -EINVAL;
1308	return count;
1309}
1310
1311static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
1312			     const char *buf, size_t count)
1313{
1314	u32 retval;
1315	int rv, err, value;
1316
1317	value = asus_wmi_get_devstate_simple(asus, devid);
1318	if (value == -ENODEV)	/* Check device presence */
1319		return value;
1320
1321	rv = parse_arg(buf, count, &value);
1322	err = asus_wmi_set_devstate(devid, value, &retval);
1323
1324	if (err < 0)
1325		return err;
1326
1327	return rv;
1328}
1329
1330static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
1331{
1332	int value = asus_wmi_get_devstate_simple(asus, devid);
1333
1334	if (value < 0)
1335		return value;
1336
1337	return sprintf(buf, "%d\n", value);
1338}
1339
1340#define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)			\
1341	static ssize_t show_##_name(struct device *dev,			\
1342				    struct device_attribute *attr,	\
1343				    char *buf)				\
1344	{								\
1345		struct asus_wmi *asus = dev_get_drvdata(dev);		\
1346									\
1347		return show_sys_wmi(asus, _cm, buf);			\
1348	}								\
1349	static ssize_t store_##_name(struct device *dev,		\
1350				     struct device_attribute *attr,	\
1351				     const char *buf, size_t count)	\
1352	{								\
1353		struct asus_wmi *asus = dev_get_drvdata(dev);		\
1354									\
1355		return store_sys_wmi(asus, _cm, buf, count);		\
1356	}								\
1357	static struct device_attribute dev_attr_##_name = {		\
1358		.attr = {						\
1359			.name = __stringify(_name),			\
1360			.mode = _mode },				\
1361		.show   = show_##_name,					\
1362		.store  = store_##_name,				\
1363	}
1364
1365ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
1366ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
1367ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
 
 
1368
1369static ssize_t store_cpufv(struct device *dev, struct device_attribute *attr,
1370			   const char *buf, size_t count)
1371{
1372	int value, rv;
1373
1374	if (!count || sscanf(buf, "%i", &value) != 1)
1375		return -EINVAL;
1376	if (value < 0 || value > 2)
1377		return -EINVAL;
1378
1379	rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
1380	if (rv < 0)
1381		return rv;
1382
1383	return count;
1384}
1385
1386static DEVICE_ATTR(cpufv, S_IRUGO | S_IWUSR, NULL, store_cpufv);
1387
1388static struct attribute *platform_attributes[] = {
1389	&dev_attr_cpufv.attr,
1390	&dev_attr_camera.attr,
1391	&dev_attr_cardr.attr,
1392	&dev_attr_touchpad.attr,
 
 
1393	NULL
1394};
1395
1396static umode_t asus_sysfs_is_visible(struct kobject *kobj,
1397				    struct attribute *attr, int idx)
1398{
1399	struct device *dev = container_of(kobj, struct device, kobj);
1400	struct platform_device *pdev = to_platform_device(dev);
1401	struct asus_wmi *asus = platform_get_drvdata(pdev);
1402	bool ok = true;
1403	int devid = -1;
1404
1405	if (attr == &dev_attr_camera.attr)
1406		devid = ASUS_WMI_DEVID_CAMERA;
1407	else if (attr == &dev_attr_cardr.attr)
1408		devid = ASUS_WMI_DEVID_CARDREADER;
1409	else if (attr == &dev_attr_touchpad.attr)
1410		devid = ASUS_WMI_DEVID_TOUCHPAD;
 
 
 
 
1411
1412	if (devid != -1)
1413		ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
1414
1415	return ok ? attr->mode : 0;
1416}
1417
1418static struct attribute_group platform_attribute_group = {
1419	.is_visible = asus_sysfs_is_visible,
1420	.attrs = platform_attributes
1421};
1422
1423static void asus_wmi_sysfs_exit(struct platform_device *device)
1424{
1425	sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1426}
1427
1428static int asus_wmi_sysfs_init(struct platform_device *device)
1429{
1430	return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1431}
1432
1433/*
1434 * Platform device
1435 */
1436static int asus_wmi_platform_init(struct asus_wmi *asus)
1437{
1438	int rv;
1439
1440	/* INIT enable hotkeys on some models */
1441	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
1442		pr_info("Initialization: %#x", rv);
1443
1444	/* We don't know yet what to do with this version... */
1445	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
1446		pr_info("BIOS WMI version: %d.%d", rv >> 16, rv & 0xFF);
1447		asus->spec = rv;
1448	}
1449
1450	/*
1451	 * The SFUN method probably allows the original driver to get the list
1452	 * of features supported by a given model. For now, 0x0100 or 0x0800
1453	 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
1454	 * The significance of others is yet to be found.
1455	 */
1456	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
1457		pr_info("SFUN value: %#x", rv);
1458		asus->sfun = rv;
1459	}
1460
1461	/*
1462	 * Eee PC and Notebooks seems to have different method_id for DSTS,
1463	 * but it may also be related to the BIOS's SPEC.
1464	 * Note, on most Eeepc, there is no way to check if a method exist
1465	 * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
1466	 * but once again, SPEC may probably be used for that kind of things.
1467	 */
1468	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL))
1469		asus->dsts_id = ASUS_WMI_METHODID_DSTS;
1470	else
1471		asus->dsts_id = ASUS_WMI_METHODID_DSTS2;
1472
1473	/* CWAP allow to define the behavior of the Fn+F2 key,
1474	 * this method doesn't seems to be present on Eee PCs */
1475	if (asus->driver->quirks->wapf >= 0)
1476		asus_wmi_set_devstate(ASUS_WMI_DEVID_CWAP,
1477				      asus->driver->quirks->wapf, NULL);
1478
1479	return asus_wmi_sysfs_init(asus->platform_device);
1480}
1481
1482static void asus_wmi_platform_exit(struct asus_wmi *asus)
1483{
1484	asus_wmi_sysfs_exit(asus->platform_device);
1485}
1486
1487/*
1488 * debugfs
1489 */
1490struct asus_wmi_debugfs_node {
1491	struct asus_wmi *asus;
1492	char *name;
1493	int (*show) (struct seq_file *m, void *data);
1494};
1495
1496static int show_dsts(struct seq_file *m, void *data)
1497{
1498	struct asus_wmi *asus = m->private;
1499	int err;
1500	u32 retval = -1;
1501
1502	err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
1503
1504	if (err < 0)
1505		return err;
1506
1507	seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
1508
1509	return 0;
1510}
1511
1512static int show_devs(struct seq_file *m, void *data)
1513{
1514	struct asus_wmi *asus = m->private;
1515	int err;
1516	u32 retval = -1;
1517
1518	err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
1519				    &retval);
1520
1521	if (err < 0)
1522		return err;
1523
1524	seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
1525		   asus->debug.ctrl_param, retval);
1526
1527	return 0;
1528}
1529
1530static int show_call(struct seq_file *m, void *data)
1531{
1532	struct asus_wmi *asus = m->private;
1533	struct bios_args args = {
1534		.arg0 = asus->debug.dev_id,
1535		.arg1 = asus->debug.ctrl_param,
1536	};
1537	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1538	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
1539	union acpi_object *obj;
1540	acpi_status status;
1541
1542	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
1543				     1, asus->debug.method_id,
1544				     &input, &output);
1545
1546	if (ACPI_FAILURE(status))
1547		return -EIO;
1548
1549	obj = (union acpi_object *)output.pointer;
1550	if (obj && obj->type == ACPI_TYPE_INTEGER)
1551		seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
1552			   asus->debug.dev_id, asus->debug.ctrl_param,
1553			   (u32) obj->integer.value);
1554	else
1555		seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
1556			   asus->debug.dev_id, asus->debug.ctrl_param,
1557			   obj ? obj->type : -1);
1558
1559	kfree(obj);
1560
1561	return 0;
1562}
1563
1564static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
1565	{NULL, "devs", show_devs},
1566	{NULL, "dsts", show_dsts},
1567	{NULL, "call", show_call},
1568};
1569
1570static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
1571{
1572	struct asus_wmi_debugfs_node *node = inode->i_private;
1573
1574	return single_open(file, node->show, node->asus);
1575}
1576
1577static const struct file_operations asus_wmi_debugfs_io_ops = {
1578	.owner = THIS_MODULE,
1579	.open = asus_wmi_debugfs_open,
1580	.read = seq_read,
1581	.llseek = seq_lseek,
1582	.release = single_release,
1583};
1584
1585static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
1586{
1587	debugfs_remove_recursive(asus->debug.root);
1588}
1589
1590static int asus_wmi_debugfs_init(struct asus_wmi *asus)
1591{
1592	struct dentry *dent;
1593	int i;
1594
1595	asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
1596	if (!asus->debug.root) {
1597		pr_err("failed to create debugfs directory");
1598		goto error_debugfs;
1599	}
1600
1601	dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR,
1602				  asus->debug.root, &asus->debug.method_id);
1603	if (!dent)
1604		goto error_debugfs;
1605
1606	dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR,
1607				  asus->debug.root, &asus->debug.dev_id);
1608	if (!dent)
1609		goto error_debugfs;
1610
1611	dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR,
1612				  asus->debug.root, &asus->debug.ctrl_param);
1613	if (!dent)
1614		goto error_debugfs;
1615
1616	for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
1617		struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
1618
1619		node->asus = asus;
1620		dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO,
1621					   asus->debug.root, node,
1622					   &asus_wmi_debugfs_io_ops);
1623		if (!dent) {
1624			pr_err("failed to create debug file: %s\n", node->name);
1625			goto error_debugfs;
1626		}
1627	}
1628
1629	return 0;
1630
1631error_debugfs:
1632	asus_wmi_debugfs_exit(asus);
1633	return -ENOMEM;
1634}
1635
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1636/*
1637 * WMI Driver
1638 */
1639static int asus_wmi_add(struct platform_device *pdev)
1640{
1641	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1642	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1643	struct asus_wmi *asus;
 
1644	acpi_status status;
1645	int err;
 
1646
1647	asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
1648	if (!asus)
1649		return -ENOMEM;
1650
1651	asus->driver = wdrv;
1652	asus->platform_device = pdev;
1653	wdrv->platform_device = pdev;
1654	platform_set_drvdata(asus->platform_device, asus);
1655
1656	if (wdrv->detect_quirks)
1657		wdrv->detect_quirks(asus->driver);
1658
1659	err = asus_wmi_platform_init(asus);
1660	if (err)
1661		goto fail_platform;
1662
1663	err = asus_wmi_input_init(asus);
1664	if (err)
1665		goto fail_input;
1666
 
 
 
1667	err = asus_wmi_hwmon_init(asus);
1668	if (err)
1669		goto fail_hwmon;
1670
1671	err = asus_wmi_led_init(asus);
1672	if (err)
1673		goto fail_leds;
1674
1675	err = asus_wmi_rfkill_init(asus);
1676	if (err)
1677		goto fail_rfkill;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1678
1679	if (!acpi_video_backlight_support()) {
 
 
 
1680		err = asus_wmi_backlight_init(asus);
1681		if (err && err != -ENODEV)
1682			goto fail_backlight;
1683	} else
1684		pr_info("Backlight controlled by ACPI video driver\n");
1685
1686	status = wmi_install_notify_handler(asus->driver->event_guid,
1687					    asus_wmi_notify, asus);
1688	if (ACPI_FAILURE(status)) {
1689		pr_err("Unable to register notify handler - %d\n", status);
1690		err = -ENODEV;
1691		goto fail_wmi_handler;
1692	}
1693
1694	err = asus_wmi_debugfs_init(asus);
1695	if (err)
1696		goto fail_debugfs;
1697
1698	return 0;
1699
1700fail_debugfs:
1701	wmi_remove_notify_handler(asus->driver->event_guid);
1702fail_wmi_handler:
1703	asus_wmi_backlight_exit(asus);
1704fail_backlight:
1705	asus_wmi_rfkill_exit(asus);
1706fail_rfkill:
1707	asus_wmi_led_exit(asus);
1708fail_leds:
1709	asus_wmi_hwmon_exit(asus);
1710fail_hwmon:
1711	asus_wmi_input_exit(asus);
1712fail_input:
1713	asus_wmi_platform_exit(asus);
1714fail_platform:
1715	kfree(asus);
1716	return err;
1717}
1718
1719static int asus_wmi_remove(struct platform_device *device)
1720{
1721	struct asus_wmi *asus;
1722
1723	asus = platform_get_drvdata(device);
1724	wmi_remove_notify_handler(asus->driver->event_guid);
1725	asus_wmi_backlight_exit(asus);
1726	asus_wmi_input_exit(asus);
1727	asus_wmi_hwmon_exit(asus);
1728	asus_wmi_led_exit(asus);
1729	asus_wmi_rfkill_exit(asus);
1730	asus_wmi_debugfs_exit(asus);
1731	asus_wmi_platform_exit(asus);
 
1732
1733	kfree(asus);
1734	return 0;
1735}
1736
1737/*
1738 * Platform driver - hibernate/resume callbacks
1739 */
1740static int asus_hotk_thaw(struct device *device)
1741{
1742	struct asus_wmi *asus = dev_get_drvdata(device);
1743
1744	if (asus->wlan.rfkill) {
1745		bool wlan;
1746
1747		/*
1748		 * Work around bios bug - acpi _PTS turns off the wireless led
1749		 * during suspend.  Normally it restores it on resume, but
1750		 * we should kick it ourselves in case hibernation is aborted.
1751		 */
1752		wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
1753		asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
1754	}
1755
1756	return 0;
1757}
1758
 
 
 
 
 
 
 
 
 
 
1759static int asus_hotk_restore(struct device *device)
1760{
1761	struct asus_wmi *asus = dev_get_drvdata(device);
1762	int bl;
1763
1764	/* Refresh both wlan rfkill state and pci hotplug */
1765	if (asus->wlan.rfkill)
1766		asus_rfkill_hotplug(asus);
1767
1768	if (asus->bluetooth.rfkill) {
1769		bl = !asus_wmi_get_devstate_simple(asus,
1770						   ASUS_WMI_DEVID_BLUETOOTH);
1771		rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
1772	}
1773	if (asus->wimax.rfkill) {
1774		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
1775		rfkill_set_sw_state(asus->wimax.rfkill, bl);
1776	}
1777	if (asus->wwan3g.rfkill) {
1778		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
1779		rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
1780	}
1781	if (asus->gps.rfkill) {
1782		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_GPS);
1783		rfkill_set_sw_state(asus->gps.rfkill, bl);
1784	}
1785	if (asus->uwb.rfkill) {
1786		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_UWB);
1787		rfkill_set_sw_state(asus->uwb.rfkill, bl);
1788	}
 
 
1789
1790	return 0;
1791}
1792
1793static const struct dev_pm_ops asus_pm_ops = {
1794	.thaw = asus_hotk_thaw,
1795	.restore = asus_hotk_restore,
 
1796};
1797
1798static int asus_wmi_probe(struct platform_device *pdev)
1799{
1800	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1801	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1802	int ret;
1803
1804	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1805		pr_warn("Management GUID not found\n");
1806		return -ENODEV;
1807	}
1808
1809	if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
1810		pr_warn("Event GUID not found\n");
1811		return -ENODEV;
1812	}
1813
1814	if (wdrv->probe) {
1815		ret = wdrv->probe(pdev);
1816		if (ret)
1817			return ret;
1818	}
1819
1820	return asus_wmi_add(pdev);
1821}
1822
1823static bool used;
1824
1825int __init_or_module asus_wmi_register_driver(struct asus_wmi_driver *driver)
1826{
1827	struct platform_driver *platform_driver;
1828	struct platform_device *platform_device;
1829
1830	if (used)
1831		return -EBUSY;
1832
1833	platform_driver = &driver->platform_driver;
1834	platform_driver->remove = asus_wmi_remove;
1835	platform_driver->driver.owner = driver->owner;
1836	platform_driver->driver.name = driver->name;
1837	platform_driver->driver.pm = &asus_pm_ops;
1838
1839	platform_device = platform_create_bundle(platform_driver,
1840						 asus_wmi_probe,
1841						 NULL, 0, NULL, 0);
1842	if (IS_ERR(platform_device))
1843		return PTR_ERR(platform_device);
1844
1845	used = true;
1846	return 0;
1847}
1848EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
1849
1850void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
1851{
1852	platform_device_unregister(driver->platform_device);
1853	platform_driver_unregister(&driver->platform_driver);
1854	used = false;
1855}
1856EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
1857
1858static int __init asus_wmi_init(void)
1859{
1860	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1861		pr_info("Asus Management GUID not found");
1862		return -ENODEV;
1863	}
1864
1865	pr_info("ASUS WMI generic driver loaded");
1866	return 0;
1867}
1868
1869static void __exit asus_wmi_exit(void)
1870{
1871	pr_info("ASUS WMI generic driver unloaded");
1872}
1873
1874module_init(asus_wmi_init);
1875module_exit(asus_wmi_exit);
v4.17
   1/*
   2 * Asus PC WMI hotkey driver
   3 *
   4 * Copyright(C) 2010 Intel Corporation.
   5 * Copyright(C) 2010-2011 Corentin Chary <corentin.chary@gmail.com>
   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/types.h>
  33#include <linux/slab.h>
  34#include <linux/input.h>
  35#include <linux/input/sparse-keymap.h>
  36#include <linux/fb.h>
  37#include <linux/backlight.h>
  38#include <linux/leds.h>
  39#include <linux/rfkill.h>
  40#include <linux/pci.h>
  41#include <linux/pci_hotplug.h>
  42#include <linux/hwmon.h>
  43#include <linux/hwmon-sysfs.h>
  44#include <linux/debugfs.h>
  45#include <linux/seq_file.h>
  46#include <linux/platform_device.h>
  47#include <linux/thermal.h>
  48#include <linux/acpi.h>
  49#include <linux/dmi.h>
  50#include <acpi/video.h>
  51
  52#include "asus-wmi.h"
  53
  54MODULE_AUTHOR("Corentin Chary <corentin.chary@gmail.com>, "
  55	      "Yong Wang <yong.y.wang@intel.com>");
  56MODULE_DESCRIPTION("Asus Generic WMI Driver");
  57MODULE_LICENSE("GPL");
  58
 
 
 
  59#define to_asus_wmi_driver(pdrv)					\
  60	(container_of((pdrv), struct asus_wmi_driver, platform_driver))
  61
  62#define ASUS_WMI_MGMT_GUID	"97845ED0-4E6D-11DE-8A39-0800200C9A66"
  63
  64#define NOTIFY_BRNUP_MIN		0x11
  65#define NOTIFY_BRNUP_MAX		0x1f
  66#define NOTIFY_BRNDOWN_MIN		0x20
  67#define NOTIFY_BRNDOWN_MAX		0x2e
  68#define NOTIFY_KBD_BRTUP		0xc4
  69#define NOTIFY_KBD_BRTDWN		0xc5
  70
  71/* WMI Methods */
  72#define ASUS_WMI_METHODID_SPEC	        0x43455053 /* BIOS SPECification */
  73#define ASUS_WMI_METHODID_SFBD		0x44424653 /* Set First Boot Device */
  74#define ASUS_WMI_METHODID_GLCD		0x44434C47 /* Get LCD status */
  75#define ASUS_WMI_METHODID_GPID		0x44495047 /* Get Panel ID?? (Resol) */
  76#define ASUS_WMI_METHODID_QMOD		0x444F4D51 /* Quiet MODe */
  77#define ASUS_WMI_METHODID_SPLV		0x4C425053 /* Set Panel Light Value */
  78#define ASUS_WMI_METHODID_AGFN		0x4E464741 /* FaN? */
  79#define ASUS_WMI_METHODID_SFUN		0x4E554653 /* FUNCtionalities */
  80#define ASUS_WMI_METHODID_SDSP		0x50534453 /* Set DiSPlay output */
  81#define ASUS_WMI_METHODID_GDSP		0x50534447 /* Get DiSPlay output */
  82#define ASUS_WMI_METHODID_DEVP		0x50564544 /* DEVice Policy */
  83#define ASUS_WMI_METHODID_OSVR		0x5256534F /* OS VeRsion */
  84#define ASUS_WMI_METHODID_DSTS		0x53544344 /* Device STatuS */
  85#define ASUS_WMI_METHODID_DSTS2		0x53545344 /* Device STatuS #2*/
  86#define ASUS_WMI_METHODID_BSTS		0x53545342 /* Bios STatuS ? */
  87#define ASUS_WMI_METHODID_DEVS		0x53564544 /* DEVice Set */
  88#define ASUS_WMI_METHODID_CFVS		0x53564643 /* CPU Frequency Volt Set */
  89#define ASUS_WMI_METHODID_KBFT		0x5446424B /* KeyBoard FilTer */
  90#define ASUS_WMI_METHODID_INIT		0x54494E49 /* INITialize */
  91#define ASUS_WMI_METHODID_HKEY		0x59454B48 /* Hot KEY ?? */
  92
  93#define ASUS_WMI_UNSUPPORTED_METHOD	0xFFFFFFFE
  94
  95/* Wireless */
  96#define ASUS_WMI_DEVID_HW_SWITCH	0x00010001
  97#define ASUS_WMI_DEVID_WIRELESS_LED	0x00010002
  98#define ASUS_WMI_DEVID_CWAP		0x00010003
  99#define ASUS_WMI_DEVID_WLAN		0x00010011
 100#define ASUS_WMI_DEVID_WLAN_LED		0x00010012
 101#define ASUS_WMI_DEVID_BLUETOOTH	0x00010013
 102#define ASUS_WMI_DEVID_GPS		0x00010015
 103#define ASUS_WMI_DEVID_WIMAX		0x00010017
 104#define ASUS_WMI_DEVID_WWAN3G		0x00010019
 105#define ASUS_WMI_DEVID_UWB		0x00010021
 106
 107/* Leds */
 108/* 0x000200XX and 0x000400XX */
 109#define ASUS_WMI_DEVID_LED1		0x00020011
 110#define ASUS_WMI_DEVID_LED2		0x00020012
 111#define ASUS_WMI_DEVID_LED3		0x00020013
 112#define ASUS_WMI_DEVID_LED4		0x00020014
 113#define ASUS_WMI_DEVID_LED5		0x00020015
 114#define ASUS_WMI_DEVID_LED6		0x00020016
 115
 116/* Backlight and Brightness */
 117#define ASUS_WMI_DEVID_ALS_ENABLE	0x00050001 /* Ambient Light Sensor */
 118#define ASUS_WMI_DEVID_BACKLIGHT	0x00050011
 119#define ASUS_WMI_DEVID_BRIGHTNESS	0x00050012
 120#define ASUS_WMI_DEVID_KBD_BACKLIGHT	0x00050021
 121#define ASUS_WMI_DEVID_LIGHT_SENSOR	0x00050022 /* ?? */
 122#define ASUS_WMI_DEVID_LIGHTBAR		0x00050025
 123
 124/* Misc */
 125#define ASUS_WMI_DEVID_CAMERA		0x00060013
 126
 127/* Storage */
 128#define ASUS_WMI_DEVID_CARDREADER	0x00080013
 129
 130/* Input */
 131#define ASUS_WMI_DEVID_TOUCHPAD		0x00100011
 132#define ASUS_WMI_DEVID_TOUCHPAD_LED	0x00100012
 133
 134/* Fan, Thermal */
 135#define ASUS_WMI_DEVID_THERMAL_CTRL	0x00110011
 136#define ASUS_WMI_DEVID_FAN_CTRL		0x00110012
 137
 138/* Power */
 139#define ASUS_WMI_DEVID_PROCESSOR_STATE	0x00120012
 140
 141/* Deep S3 / Resume on LID open */
 142#define ASUS_WMI_DEVID_LID_RESUME	0x00120031
 143
 144/* DSTS masks */
 145#define ASUS_WMI_DSTS_STATUS_BIT	0x00000001
 146#define ASUS_WMI_DSTS_UNKNOWN_BIT	0x00000002
 147#define ASUS_WMI_DSTS_PRESENCE_BIT	0x00010000
 148#define ASUS_WMI_DSTS_USER_BIT		0x00020000
 149#define ASUS_WMI_DSTS_BIOS_BIT		0x00040000
 150#define ASUS_WMI_DSTS_BRIGHTNESS_MASK	0x000000FF
 151#define ASUS_WMI_DSTS_MAX_BRIGTH_MASK	0x0000FF00
 152#define ASUS_WMI_DSTS_LIGHTBAR_MASK	0x0000000F
 153
 154#define ASUS_FAN_DESC			"cpu_fan"
 155#define ASUS_FAN_MFUN			0x13
 156#define ASUS_FAN_SFUN_READ		0x06
 157#define ASUS_FAN_SFUN_WRITE		0x07
 158#define ASUS_FAN_CTRL_MANUAL		1
 159#define ASUS_FAN_CTRL_AUTO		2
 160
 161#define USB_INTEL_XUSB2PR		0xD0
 162#define PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI	0x9c31
 163
 164static const char * const ashs_ids[] = { "ATK4001", "ATK4002", NULL };
 165
 166static bool ashs_present(void)
 167{
 168	int i = 0;
 169	while (ashs_ids[i]) {
 170		if (acpi_dev_found(ashs_ids[i++]))
 171			return true;
 172	}
 173	return false;
 174}
 175
 176struct bios_args {
 177	u32 arg0;
 178	u32 arg1;
 179} __packed;
 180
 181/*
 182 * Struct that's used for all methods called via AGFN. Naming is
 183 * identically to the AML code.
 184 */
 185struct agfn_args {
 186	u16 mfun; /* probably "Multi-function" to be called */
 187	u16 sfun; /* probably "Sub-function" to be called */
 188	u16 len;  /* size of the hole struct, including subfunction fields */
 189	u8 stas;  /* not used by now */
 190	u8 err;   /* zero on success */
 191} __packed;
 192
 193/* struct used for calling fan read and write methods */
 194struct fan_args {
 195	struct agfn_args agfn;	/* common fields */
 196	u8 fan;			/* fan number: 0: set auto mode 1: 1st fan */
 197	u32 speed;		/* read: RPM/100 - write: 0-255 */
 198} __packed;
 199
 200/*
 201 * <platform>/    - debugfs root directory
 202 *   dev_id      - current dev_id
 203 *   ctrl_param  - current ctrl_param
 204 *   method_id   - current method_id
 205 *   devs        - call DEVS(dev_id, ctrl_param) and print result
 206 *   dsts        - call DSTS(dev_id)  and print result
 207 *   call        - call method_id(dev_id, ctrl_param) and print result
 208 */
 209struct asus_wmi_debug {
 210	struct dentry *root;
 211	u32 method_id;
 212	u32 dev_id;
 213	u32 ctrl_param;
 214};
 215
 216struct asus_rfkill {
 217	struct asus_wmi *asus;
 218	struct rfkill *rfkill;
 219	u32 dev_id;
 220};
 221
 222struct asus_wmi {
 223	int dsts_id;
 224	int spec;
 225	int sfun;
 226
 227	struct input_dev *inputdev;
 228	struct backlight_device *backlight_device;
 
 229	struct platform_device *platform_device;
 230
 231	struct led_classdev wlan_led;
 232	int wlan_led_wk;
 233	struct led_classdev tpd_led;
 234	int tpd_led_wk;
 235	struct led_classdev kbd_led;
 236	int kbd_led_wk;
 237	struct led_classdev lightbar_led;
 238	int lightbar_led_wk;
 239	struct workqueue_struct *led_workqueue;
 240	struct work_struct tpd_led_work;
 241	struct work_struct kbd_led_work;
 242	struct work_struct wlan_led_work;
 243	struct work_struct lightbar_led_work;
 244
 245	struct asus_rfkill wlan;
 246	struct asus_rfkill bluetooth;
 247	struct asus_rfkill wimax;
 248	struct asus_rfkill wwan3g;
 249	struct asus_rfkill gps;
 250	struct asus_rfkill uwb;
 251
 252	bool asus_hwmon_fan_manual_mode;
 253	int asus_hwmon_num_fans;
 254	int asus_hwmon_pwm;
 255
 256	struct hotplug_slot *hotplug_slot;
 257	struct mutex hotplug_lock;
 258	struct mutex wmi_lock;
 259	struct workqueue_struct *hotplug_workqueue;
 260	struct work_struct hotplug_work;
 261
 262	struct asus_wmi_debug debug;
 263
 264	struct asus_wmi_driver *driver;
 265};
 266
 267static int asus_wmi_input_init(struct asus_wmi *asus)
 268{
 269	int err;
 270
 271	asus->inputdev = input_allocate_device();
 272	if (!asus->inputdev)
 273		return -ENOMEM;
 274
 275	asus->inputdev->name = asus->driver->input_name;
 276	asus->inputdev->phys = asus->driver->input_phys;
 277	asus->inputdev->id.bustype = BUS_HOST;
 278	asus->inputdev->dev.parent = &asus->platform_device->dev;
 279	set_bit(EV_REP, asus->inputdev->evbit);
 280
 281	err = sparse_keymap_setup(asus->inputdev, asus->driver->keymap, NULL);
 282	if (err)
 283		goto err_free_dev;
 284
 285	err = input_register_device(asus->inputdev);
 286	if (err)
 287		goto err_free_dev;
 288
 289	return 0;
 290
 
 
 291err_free_dev:
 292	input_free_device(asus->inputdev);
 293	return err;
 294}
 295
 296static void asus_wmi_input_exit(struct asus_wmi *asus)
 297{
 298	if (asus->inputdev)
 
 299		input_unregister_device(asus->inputdev);
 
 300
 301	asus->inputdev = NULL;
 302}
 303
 304static int asus_wmi_evaluate_method(u32 method_id, u32 arg0, u32 arg1,
 305				    u32 *retval)
 306{
 307	struct bios_args args = {
 308		.arg0 = arg0,
 309		.arg1 = arg1,
 310	};
 311	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
 312	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
 313	acpi_status status;
 314	union acpi_object *obj;
 315	u32 tmp = 0;
 316
 317	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 0, method_id,
 318				     &input, &output);
 319
 320	if (ACPI_FAILURE(status))
 321		goto exit;
 322
 323	obj = (union acpi_object *)output.pointer;
 324	if (obj && obj->type == ACPI_TYPE_INTEGER)
 325		tmp = (u32) obj->integer.value;
 
 
 326
 327	if (retval)
 328		*retval = tmp;
 329
 330	kfree(obj);
 331
 332exit:
 333	if (ACPI_FAILURE(status))
 334		return -EIO;
 335
 336	if (tmp == ASUS_WMI_UNSUPPORTED_METHOD)
 337		return -ENODEV;
 338
 339	return 0;
 340}
 341
 342static int asus_wmi_evaluate_method_agfn(const struct acpi_buffer args)
 343{
 344	struct acpi_buffer input;
 345	u64 phys_addr;
 346	u32 retval;
 347	u32 status = -1;
 348
 349	/*
 350	 * Copy to dma capable address otherwise memory corruption occurs as
 351	 * bios has to be able to access it.
 352	 */
 353	input.pointer = kzalloc(args.length, GFP_DMA | GFP_KERNEL);
 354	input.length = args.length;
 355	if (!input.pointer)
 356		return -ENOMEM;
 357	phys_addr = virt_to_phys(input.pointer);
 358	memcpy(input.pointer, args.pointer, args.length);
 359
 360	status = asus_wmi_evaluate_method(ASUS_WMI_METHODID_AGFN,
 361					phys_addr, 0, &retval);
 362	if (!status)
 363		memcpy(args.pointer, input.pointer, args.length);
 364
 365	kfree(input.pointer);
 366	if (status)
 367		return -ENXIO;
 368
 369	return retval;
 370}
 371
 372static int asus_wmi_get_devstate(struct asus_wmi *asus, u32 dev_id, u32 *retval)
 373{
 374	return asus_wmi_evaluate_method(asus->dsts_id, dev_id, 0, retval);
 375}
 376
 377static int asus_wmi_set_devstate(u32 dev_id, u32 ctrl_param,
 378				 u32 *retval)
 379{
 380	return asus_wmi_evaluate_method(ASUS_WMI_METHODID_DEVS, dev_id,
 381					ctrl_param, retval);
 382}
 383
 384/* Helper for special devices with magic return codes */
 385static int asus_wmi_get_devstate_bits(struct asus_wmi *asus,
 386				      u32 dev_id, u32 mask)
 387{
 388	u32 retval = 0;
 389	int err;
 390
 391	err = asus_wmi_get_devstate(asus, dev_id, &retval);
 392
 393	if (err < 0)
 394		return err;
 395
 396	if (!(retval & ASUS_WMI_DSTS_PRESENCE_BIT))
 397		return -ENODEV;
 398
 399	if (mask == ASUS_WMI_DSTS_STATUS_BIT) {
 400		if (retval & ASUS_WMI_DSTS_UNKNOWN_BIT)
 401			return -ENODEV;
 402	}
 403
 404	return retval & mask;
 405}
 406
 407static int asus_wmi_get_devstate_simple(struct asus_wmi *asus, u32 dev_id)
 408{
 409	return asus_wmi_get_devstate_bits(asus, dev_id,
 410					  ASUS_WMI_DSTS_STATUS_BIT);
 411}
 412
 413/*
 414 * LEDs
 415 */
 416/*
 417 * These functions actually update the LED's, and are called from a
 418 * workqueue. By doing this as separate work rather than when the LED
 419 * subsystem asks, we avoid messing with the Asus ACPI stuff during a
 420 * potentially bad time, such as a timer interrupt.
 421 */
 422static void tpd_led_update(struct work_struct *work)
 423{
 424	int ctrl_param;
 425	struct asus_wmi *asus;
 426
 427	asus = container_of(work, struct asus_wmi, tpd_led_work);
 428
 429	ctrl_param = asus->tpd_led_wk;
 430	asus_wmi_set_devstate(ASUS_WMI_DEVID_TOUCHPAD_LED, ctrl_param, NULL);
 431}
 432
 433static void tpd_led_set(struct led_classdev *led_cdev,
 434			enum led_brightness value)
 435{
 436	struct asus_wmi *asus;
 437
 438	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 439
 440	asus->tpd_led_wk = !!value;
 441	queue_work(asus->led_workqueue, &asus->tpd_led_work);
 442}
 443
 444static int read_tpd_led_state(struct asus_wmi *asus)
 445{
 446	return asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_TOUCHPAD_LED);
 447}
 448
 449static enum led_brightness tpd_led_get(struct led_classdev *led_cdev)
 450{
 451	struct asus_wmi *asus;
 452
 453	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 454
 455	return read_tpd_led_state(asus);
 456}
 457
 458static void kbd_led_update(struct work_struct *work)
 459{
 460	int ctrl_param = 0;
 461	struct asus_wmi *asus;
 462
 463	asus = container_of(work, struct asus_wmi, kbd_led_work);
 464
 465	/*
 466	 * bits 0-2: level
 467	 * bit 7: light on/off
 468	 */
 469	if (asus->kbd_led_wk > 0)
 470		ctrl_param = 0x80 | (asus->kbd_led_wk & 0x7F);
 471
 472	asus_wmi_set_devstate(ASUS_WMI_DEVID_KBD_BACKLIGHT, ctrl_param, NULL);
 473}
 474
 475static int kbd_led_read(struct asus_wmi *asus, int *level, int *env)
 476{
 477	int retval;
 478
 479	/*
 480	 * bits 0-2: level
 481	 * bit 7: light on/off
 482	 * bit 8-10: environment (0: dark, 1: normal, 2: light)
 483	 * bit 17: status unknown
 484	 */
 485	retval = asus_wmi_get_devstate_bits(asus, ASUS_WMI_DEVID_KBD_BACKLIGHT,
 486					    0xFFFF);
 487
 488	/* Unknown status is considered as off */
 489	if (retval == 0x8000)
 490		retval = 0;
 491
 492	if (retval >= 0) {
 493		if (level)
 494			*level = retval & 0x7F;
 495		if (env)
 496			*env = (retval >> 8) & 0x7F;
 497		retval = 0;
 498	}
 499
 500	return retval;
 501}
 502
 503static void kbd_led_set(struct led_classdev *led_cdev,
 504			enum led_brightness value)
 505{
 506	struct asus_wmi *asus;
 507
 508	asus = container_of(led_cdev, struct asus_wmi, kbd_led);
 509
 510	if (value > asus->kbd_led.max_brightness)
 511		value = asus->kbd_led.max_brightness;
 512	else if (value < 0)
 513		value = 0;
 514
 515	asus->kbd_led_wk = value;
 516	queue_work(asus->led_workqueue, &asus->kbd_led_work);
 517}
 518
 519static enum led_brightness kbd_led_get(struct led_classdev *led_cdev)
 520{
 521	struct asus_wmi *asus;
 522	int retval, value;
 523
 524	asus = container_of(led_cdev, struct asus_wmi, kbd_led);
 525
 526	retval = kbd_led_read(asus, &value, NULL);
 527
 528	if (retval < 0)
 529		return retval;
 530
 531	return value;
 532}
 533
 534static int wlan_led_unknown_state(struct asus_wmi *asus)
 535{
 536	u32 result;
 537
 538	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
 539
 540	return result & ASUS_WMI_DSTS_UNKNOWN_BIT;
 541}
 542
 543static int wlan_led_presence(struct asus_wmi *asus)
 544{
 545	u32 result;
 546
 547	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
 548
 549	return result & ASUS_WMI_DSTS_PRESENCE_BIT;
 550}
 551
 552static void wlan_led_update(struct work_struct *work)
 553{
 554	int ctrl_param;
 555	struct asus_wmi *asus;
 556
 557	asus = container_of(work, struct asus_wmi, wlan_led_work);
 558
 559	ctrl_param = asus->wlan_led_wk;
 560	asus_wmi_set_devstate(ASUS_WMI_DEVID_WIRELESS_LED, ctrl_param, NULL);
 561}
 562
 563static void wlan_led_set(struct led_classdev *led_cdev,
 564			 enum led_brightness value)
 565{
 566	struct asus_wmi *asus;
 567
 568	asus = container_of(led_cdev, struct asus_wmi, wlan_led);
 569
 570	asus->wlan_led_wk = !!value;
 571	queue_work(asus->led_workqueue, &asus->wlan_led_work);
 572}
 573
 574static enum led_brightness wlan_led_get(struct led_classdev *led_cdev)
 575{
 576	struct asus_wmi *asus;
 577	u32 result;
 578
 579	asus = container_of(led_cdev, struct asus_wmi, wlan_led);
 580	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
 581
 582	return result & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
 583}
 584
 585static void lightbar_led_update(struct work_struct *work)
 586{
 587	struct asus_wmi *asus;
 588	int ctrl_param;
 589
 590	asus = container_of(work, struct asus_wmi, lightbar_led_work);
 591
 592	ctrl_param = asus->lightbar_led_wk;
 593	asus_wmi_set_devstate(ASUS_WMI_DEVID_LIGHTBAR, ctrl_param, NULL);
 594}
 595
 596static void lightbar_led_set(struct led_classdev *led_cdev,
 597			     enum led_brightness value)
 598{
 599	struct asus_wmi *asus;
 600
 601	asus = container_of(led_cdev, struct asus_wmi, lightbar_led);
 602
 603	asus->lightbar_led_wk = !!value;
 604	queue_work(asus->led_workqueue, &asus->lightbar_led_work);
 605}
 606
 607static enum led_brightness lightbar_led_get(struct led_classdev *led_cdev)
 608{
 609	struct asus_wmi *asus;
 610	u32 result;
 611
 612	asus = container_of(led_cdev, struct asus_wmi, lightbar_led);
 613	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_LIGHTBAR, &result);
 614
 615	return result & ASUS_WMI_DSTS_LIGHTBAR_MASK;
 616}
 617
 618static int lightbar_led_presence(struct asus_wmi *asus)
 619{
 620	u32 result;
 621
 622	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_LIGHTBAR, &result);
 623
 624	return result & ASUS_WMI_DSTS_PRESENCE_BIT;
 625}
 626
 627static void asus_wmi_led_exit(struct asus_wmi *asus)
 628{
 629	if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
 630		led_classdev_unregister(&asus->kbd_led);
 631	if (!IS_ERR_OR_NULL(asus->tpd_led.dev))
 632		led_classdev_unregister(&asus->tpd_led);
 633	if (!IS_ERR_OR_NULL(asus->wlan_led.dev))
 634		led_classdev_unregister(&asus->wlan_led);
 635	if (!IS_ERR_OR_NULL(asus->lightbar_led.dev))
 636		led_classdev_unregister(&asus->lightbar_led);
 637	if (asus->led_workqueue)
 638		destroy_workqueue(asus->led_workqueue);
 639}
 640
 641static int asus_wmi_led_init(struct asus_wmi *asus)
 642{
 643	int rv = 0, led_val;
 644
 645	asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
 646	if (!asus->led_workqueue)
 647		return -ENOMEM;
 648
 649	if (read_tpd_led_state(asus) >= 0) {
 650		INIT_WORK(&asus->tpd_led_work, tpd_led_update);
 651
 652		asus->tpd_led.name = "asus::touchpad";
 653		asus->tpd_led.brightness_set = tpd_led_set;
 654		asus->tpd_led.brightness_get = tpd_led_get;
 655		asus->tpd_led.max_brightness = 1;
 656
 657		rv = led_classdev_register(&asus->platform_device->dev,
 658					   &asus->tpd_led);
 659		if (rv)
 660			goto error;
 661	}
 662
 663	led_val = kbd_led_read(asus, NULL, NULL);
 664	if (led_val >= 0) {
 665		INIT_WORK(&asus->kbd_led_work, kbd_led_update);
 666
 667		asus->kbd_led_wk = led_val;
 668		asus->kbd_led.name = "asus::kbd_backlight";
 669		asus->kbd_led.brightness_set = kbd_led_set;
 670		asus->kbd_led.brightness_get = kbd_led_get;
 671		asus->kbd_led.max_brightness = 3;
 672
 673		rv = led_classdev_register(&asus->platform_device->dev,
 674					   &asus->kbd_led);
 675		if (rv)
 676			goto error;
 677	}
 678
 679	if (wlan_led_presence(asus) && (asus->driver->quirks->wapf > 0)) {
 680		INIT_WORK(&asus->wlan_led_work, wlan_led_update);
 681
 682		asus->wlan_led.name = "asus::wlan";
 683		asus->wlan_led.brightness_set = wlan_led_set;
 684		if (!wlan_led_unknown_state(asus))
 685			asus->wlan_led.brightness_get = wlan_led_get;
 686		asus->wlan_led.flags = LED_CORE_SUSPENDRESUME;
 687		asus->wlan_led.max_brightness = 1;
 688		asus->wlan_led.default_trigger = "asus-wlan";
 689
 690		rv = led_classdev_register(&asus->platform_device->dev,
 691					   &asus->wlan_led);
 692		if (rv)
 693			goto error;
 694	}
 695
 696	if (lightbar_led_presence(asus)) {
 697		INIT_WORK(&asus->lightbar_led_work, lightbar_led_update);
 698
 699		asus->lightbar_led.name = "asus::lightbar";
 700		asus->lightbar_led.brightness_set = lightbar_led_set;
 701		asus->lightbar_led.brightness_get = lightbar_led_get;
 702		asus->lightbar_led.max_brightness = 1;
 703
 704		rv = led_classdev_register(&asus->platform_device->dev,
 705					   &asus->lightbar_led);
 706	}
 707
 708error:
 709	if (rv)
 710		asus_wmi_led_exit(asus);
 711
 712	return rv;
 713}
 714
 715
 716/*
 717 * PCI hotplug (for wlan rfkill)
 718 */
 719static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus)
 720{
 721	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 722
 723	if (result < 0)
 724		return false;
 725	return !result;
 726}
 727
 728static void asus_rfkill_hotplug(struct asus_wmi *asus)
 729{
 730	struct pci_dev *dev;
 731	struct pci_bus *bus;
 732	bool blocked;
 733	bool absent;
 734	u32 l;
 735
 736	mutex_lock(&asus->wmi_lock);
 737	blocked = asus_wlan_rfkill_blocked(asus);
 738	mutex_unlock(&asus->wmi_lock);
 739
 740	mutex_lock(&asus->hotplug_lock);
 741	pci_lock_rescan_remove();
 742
 743	if (asus->wlan.rfkill)
 744		rfkill_set_sw_state(asus->wlan.rfkill, blocked);
 745
 746	if (asus->hotplug_slot) {
 747		bus = pci_find_bus(0, 1);
 748		if (!bus) {
 749			pr_warn("Unable to find PCI bus 1?\n");
 750			goto out_unlock;
 751		}
 752
 753		if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
 754			pr_err("Unable to read PCI config space?\n");
 755			goto out_unlock;
 756		}
 757		absent = (l == 0xffffffff);
 758
 759		if (blocked != absent) {
 760			pr_warn("BIOS says wireless lan is %s, "
 761				"but the pci device is %s\n",
 762				blocked ? "blocked" : "unblocked",
 763				absent ? "absent" : "present");
 764			pr_warn("skipped wireless hotplug as probably "
 765				"inappropriate for this model\n");
 766			goto out_unlock;
 767		}
 768
 769		if (!blocked) {
 770			dev = pci_get_slot(bus, 0);
 771			if (dev) {
 772				/* Device already present */
 773				pci_dev_put(dev);
 774				goto out_unlock;
 775			}
 776			dev = pci_scan_single_device(bus, 0);
 777			if (dev) {
 778				pci_bus_assign_resources(bus);
 779				pci_bus_add_device(dev);
 
 780			}
 781		} else {
 782			dev = pci_get_slot(bus, 0);
 783			if (dev) {
 784				pci_stop_and_remove_bus_device(dev);
 785				pci_dev_put(dev);
 786			}
 787		}
 788	}
 789
 790out_unlock:
 791	pci_unlock_rescan_remove();
 792	mutex_unlock(&asus->hotplug_lock);
 793}
 794
 795static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data)
 796{
 797	struct asus_wmi *asus = data;
 798
 799	if (event != ACPI_NOTIFY_BUS_CHECK)
 800		return;
 801
 802	/*
 803	 * We can't call directly asus_rfkill_hotplug because most
 804	 * of the time WMBC is still being executed and not reetrant.
 805	 * There is currently no way to tell ACPICA that  we want this
 806	 * method to be serialized, we schedule a asus_rfkill_hotplug
 807	 * call later, in a safer context.
 808	 */
 809	queue_work(asus->hotplug_workqueue, &asus->hotplug_work);
 810}
 811
 812static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node)
 813{
 814	acpi_status status;
 815	acpi_handle handle;
 816
 817	status = acpi_get_handle(NULL, node, &handle);
 818
 819	if (ACPI_SUCCESS(status)) {
 820		status = acpi_install_notify_handler(handle,
 821						     ACPI_SYSTEM_NOTIFY,
 822						     asus_rfkill_notify, asus);
 823		if (ACPI_FAILURE(status))
 824			pr_warn("Failed to register notify on %s\n", node);
 825	} else
 826		return -ENODEV;
 827
 828	return 0;
 829}
 830
 831static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node)
 832{
 833	acpi_status status = AE_OK;
 834	acpi_handle handle;
 835
 836	status = acpi_get_handle(NULL, node, &handle);
 837
 838	if (ACPI_SUCCESS(status)) {
 839		status = acpi_remove_notify_handler(handle,
 840						    ACPI_SYSTEM_NOTIFY,
 841						    asus_rfkill_notify);
 842		if (ACPI_FAILURE(status))
 843			pr_err("Error removing rfkill notify handler %s\n",
 844			       node);
 845	}
 846}
 847
 848static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot,
 849				   u8 *value)
 850{
 851	struct asus_wmi *asus = hotplug_slot->private;
 852	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 853
 854	if (result < 0)
 855		return result;
 856
 857	*value = !!result;
 858	return 0;
 859}
 860
 861static void asus_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot)
 862{
 863	kfree(hotplug_slot->info);
 864	kfree(hotplug_slot);
 865}
 866
 867static struct hotplug_slot_ops asus_hotplug_slot_ops = {
 868	.owner = THIS_MODULE,
 869	.get_adapter_status = asus_get_adapter_status,
 870	.get_power_status = asus_get_adapter_status,
 871};
 872
 873static void asus_hotplug_work(struct work_struct *work)
 874{
 875	struct asus_wmi *asus;
 876
 877	asus = container_of(work, struct asus_wmi, hotplug_work);
 878	asus_rfkill_hotplug(asus);
 879}
 880
 881static int asus_setup_pci_hotplug(struct asus_wmi *asus)
 882{
 883	int ret = -ENOMEM;
 884	struct pci_bus *bus = pci_find_bus(0, 1);
 885
 886	if (!bus) {
 887		pr_err("Unable to find wifi PCI bus\n");
 888		return -ENODEV;
 889	}
 890
 891	asus->hotplug_workqueue =
 892	    create_singlethread_workqueue("hotplug_workqueue");
 893	if (!asus->hotplug_workqueue)
 894		goto error_workqueue;
 895
 896	INIT_WORK(&asus->hotplug_work, asus_hotplug_work);
 897
 898	asus->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
 899	if (!asus->hotplug_slot)
 900		goto error_slot;
 901
 902	asus->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
 903					   GFP_KERNEL);
 904	if (!asus->hotplug_slot->info)
 905		goto error_info;
 906
 907	asus->hotplug_slot->private = asus;
 908	asus->hotplug_slot->release = &asus_cleanup_pci_hotplug;
 909	asus->hotplug_slot->ops = &asus_hotplug_slot_ops;
 910	asus_get_adapter_status(asus->hotplug_slot,
 911				&asus->hotplug_slot->info->adapter_status);
 912
 913	ret = pci_hp_register(asus->hotplug_slot, bus, 0, "asus-wifi");
 914	if (ret) {
 915		pr_err("Unable to register hotplug slot - %d\n", ret);
 916		goto error_register;
 917	}
 918
 919	return 0;
 920
 921error_register:
 922	kfree(asus->hotplug_slot->info);
 923error_info:
 924	kfree(asus->hotplug_slot);
 925	asus->hotplug_slot = NULL;
 926error_slot:
 927	destroy_workqueue(asus->hotplug_workqueue);
 928error_workqueue:
 929	return ret;
 930}
 931
 932/*
 933 * Rfkill devices
 934 */
 935static int asus_rfkill_set(void *data, bool blocked)
 936{
 937	struct asus_rfkill *priv = data;
 938	u32 ctrl_param = !blocked;
 939	u32 dev_id = priv->dev_id;
 940
 941	/*
 942	 * If the user bit is set, BIOS can't set and record the wlan status,
 943	 * it will report the value read from id ASUS_WMI_DEVID_WLAN_LED
 944	 * while we query the wlan status through WMI(ASUS_WMI_DEVID_WLAN).
 945	 * So, we have to record wlan status in id ASUS_WMI_DEVID_WLAN_LED
 946	 * while setting the wlan status through WMI.
 947	 * This is also the behavior that windows app will do.
 948	 */
 949	if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
 950	     priv->asus->driver->wlan_ctrl_by_user)
 951		dev_id = ASUS_WMI_DEVID_WLAN_LED;
 952
 953	return asus_wmi_set_devstate(dev_id, ctrl_param, NULL);
 954}
 955
 956static void asus_rfkill_query(struct rfkill *rfkill, void *data)
 957{
 958	struct asus_rfkill *priv = data;
 959	int result;
 960
 961	result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id);
 962
 963	if (result < 0)
 964		return;
 965
 966	rfkill_set_sw_state(priv->rfkill, !result);
 967}
 968
 969static int asus_rfkill_wlan_set(void *data, bool blocked)
 970{
 971	struct asus_rfkill *priv = data;
 972	struct asus_wmi *asus = priv->asus;
 973	int ret;
 974
 975	/*
 976	 * This handler is enabled only if hotplug is enabled.
 977	 * In this case, the asus_wmi_set_devstate() will
 978	 * trigger a wmi notification and we need to wait
 979	 * this call to finish before being able to call
 980	 * any wmi method
 981	 */
 982	mutex_lock(&asus->wmi_lock);
 983	ret = asus_rfkill_set(data, blocked);
 984	mutex_unlock(&asus->wmi_lock);
 985	return ret;
 986}
 987
 988static const struct rfkill_ops asus_rfkill_wlan_ops = {
 989	.set_block = asus_rfkill_wlan_set,
 990	.query = asus_rfkill_query,
 991};
 992
 993static const struct rfkill_ops asus_rfkill_ops = {
 994	.set_block = asus_rfkill_set,
 995	.query = asus_rfkill_query,
 996};
 997
 998static int asus_new_rfkill(struct asus_wmi *asus,
 999			   struct asus_rfkill *arfkill,
1000			   const char *name, enum rfkill_type type, int dev_id)
1001{
1002	int result = asus_wmi_get_devstate_simple(asus, dev_id);
1003	struct rfkill **rfkill = &arfkill->rfkill;
1004
1005	if (result < 0)
1006		return result;
1007
1008	arfkill->dev_id = dev_id;
1009	arfkill->asus = asus;
1010
1011	if (dev_id == ASUS_WMI_DEVID_WLAN &&
1012	    asus->driver->quirks->hotplug_wireless)
1013		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
1014				       &asus_rfkill_wlan_ops, arfkill);
1015	else
1016		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
1017				       &asus_rfkill_ops, arfkill);
1018
1019	if (!*rfkill)
1020		return -EINVAL;
1021
1022	if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
1023			(asus->driver->quirks->wapf > 0))
1024		rfkill_set_led_trigger_name(*rfkill, "asus-wlan");
1025
1026	rfkill_init_sw_state(*rfkill, !result);
1027	result = rfkill_register(*rfkill);
1028	if (result) {
1029		rfkill_destroy(*rfkill);
1030		*rfkill = NULL;
1031		return result;
1032	}
1033	return 0;
1034}
1035
1036static void asus_wmi_rfkill_exit(struct asus_wmi *asus)
1037{
1038	if (asus->driver->wlan_ctrl_by_user && ashs_present())
1039		return;
1040
1041	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
1042	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
1043	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
1044	if (asus->wlan.rfkill) {
1045		rfkill_unregister(asus->wlan.rfkill);
1046		rfkill_destroy(asus->wlan.rfkill);
1047		asus->wlan.rfkill = NULL;
1048	}
1049	/*
1050	 * Refresh pci hotplug in case the rfkill state was changed after
1051	 * asus_unregister_rfkill_notifier()
1052	 */
1053	asus_rfkill_hotplug(asus);
1054	if (asus->hotplug_slot)
1055		pci_hp_deregister(asus->hotplug_slot);
1056	if (asus->hotplug_workqueue)
1057		destroy_workqueue(asus->hotplug_workqueue);
1058
1059	if (asus->bluetooth.rfkill) {
1060		rfkill_unregister(asus->bluetooth.rfkill);
1061		rfkill_destroy(asus->bluetooth.rfkill);
1062		asus->bluetooth.rfkill = NULL;
1063	}
1064	if (asus->wimax.rfkill) {
1065		rfkill_unregister(asus->wimax.rfkill);
1066		rfkill_destroy(asus->wimax.rfkill);
1067		asus->wimax.rfkill = NULL;
1068	}
1069	if (asus->wwan3g.rfkill) {
1070		rfkill_unregister(asus->wwan3g.rfkill);
1071		rfkill_destroy(asus->wwan3g.rfkill);
1072		asus->wwan3g.rfkill = NULL;
1073	}
1074	if (asus->gps.rfkill) {
1075		rfkill_unregister(asus->gps.rfkill);
1076		rfkill_destroy(asus->gps.rfkill);
1077		asus->gps.rfkill = NULL;
1078	}
1079	if (asus->uwb.rfkill) {
1080		rfkill_unregister(asus->uwb.rfkill);
1081		rfkill_destroy(asus->uwb.rfkill);
1082		asus->uwb.rfkill = NULL;
1083	}
1084}
1085
1086static int asus_wmi_rfkill_init(struct asus_wmi *asus)
1087{
1088	int result = 0;
1089
1090	mutex_init(&asus->hotplug_lock);
1091	mutex_init(&asus->wmi_lock);
1092
1093	result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan",
1094				 RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN);
1095
1096	if (result && result != -ENODEV)
1097		goto exit;
1098
1099	result = asus_new_rfkill(asus, &asus->bluetooth,
1100				 "asus-bluetooth", RFKILL_TYPE_BLUETOOTH,
1101				 ASUS_WMI_DEVID_BLUETOOTH);
1102
1103	if (result && result != -ENODEV)
1104		goto exit;
1105
1106	result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax",
1107				 RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX);
1108
1109	if (result && result != -ENODEV)
1110		goto exit;
1111
1112	result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g",
1113				 RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G);
1114
1115	if (result && result != -ENODEV)
1116		goto exit;
1117
1118	result = asus_new_rfkill(asus, &asus->gps, "asus-gps",
1119				 RFKILL_TYPE_GPS, ASUS_WMI_DEVID_GPS);
1120
1121	if (result && result != -ENODEV)
1122		goto exit;
1123
1124	result = asus_new_rfkill(asus, &asus->uwb, "asus-uwb",
1125				 RFKILL_TYPE_UWB, ASUS_WMI_DEVID_UWB);
1126
1127	if (result && result != -ENODEV)
1128		goto exit;
1129
1130	if (!asus->driver->quirks->hotplug_wireless)
1131		goto exit;
1132
1133	result = asus_setup_pci_hotplug(asus);
1134	/*
1135	 * If we get -EBUSY then something else is handling the PCI hotplug -
1136	 * don't fail in this case
1137	 */
1138	if (result == -EBUSY)
1139		result = 0;
1140
1141	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
1142	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
1143	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
1144	/*
1145	 * Refresh pci hotplug in case the rfkill state was changed during
1146	 * setup.
1147	 */
1148	asus_rfkill_hotplug(asus);
1149
1150exit:
1151	if (result && result != -ENODEV)
1152		asus_wmi_rfkill_exit(asus);
1153
1154	if (result == -ENODEV)
1155		result = 0;
1156
1157	return result;
1158}
1159
1160static void asus_wmi_set_xusb2pr(struct asus_wmi *asus)
1161{
1162	struct pci_dev *xhci_pdev;
1163	u32 orig_ports_available;
1164	u32 ports_available = asus->driver->quirks->xusb2pr;
1165
1166	xhci_pdev = pci_get_device(PCI_VENDOR_ID_INTEL,
1167			PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI,
1168			NULL);
1169
1170	if (!xhci_pdev)
1171		return;
1172
1173	pci_read_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
1174				&orig_ports_available);
1175
1176	pci_write_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
1177				cpu_to_le32(ports_available));
1178
1179	pr_info("set USB_INTEL_XUSB2PR old: 0x%04x, new: 0x%04x\n",
1180			orig_ports_available, ports_available);
1181}
1182
1183/*
1184 * Some devices dont support or have borcken get_als method
1185 * but still support set method.
1186 */
1187static void asus_wmi_set_als(void)
1188{
1189	asus_wmi_set_devstate(ASUS_WMI_DEVID_ALS_ENABLE, 1, NULL);
1190}
1191
1192/*
1193 * Hwmon device
1194 */
1195static int asus_hwmon_agfn_fan_speed_read(struct asus_wmi *asus, int fan,
1196					  int *speed)
1197{
1198	struct fan_args args = {
1199		.agfn.len = sizeof(args),
1200		.agfn.mfun = ASUS_FAN_MFUN,
1201		.agfn.sfun = ASUS_FAN_SFUN_READ,
1202		.fan = fan,
1203		.speed = 0,
1204	};
1205	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1206	int status;
1207
1208	if (fan != 1)
1209		return -EINVAL;
1210
1211	status = asus_wmi_evaluate_method_agfn(input);
1212
1213	if (status || args.agfn.err)
1214		return -ENXIO;
1215
1216	if (speed)
1217		*speed = args.speed;
1218
1219	return 0;
1220}
1221
1222static int asus_hwmon_agfn_fan_speed_write(struct asus_wmi *asus, int fan,
1223				     int *speed)
1224{
1225	struct fan_args args = {
1226		.agfn.len = sizeof(args),
1227		.agfn.mfun = ASUS_FAN_MFUN,
1228		.agfn.sfun = ASUS_FAN_SFUN_WRITE,
1229		.fan = fan,
1230		.speed = speed ?  *speed : 0,
1231	};
1232	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1233	int status;
1234
1235	/* 1: for setting 1st fan's speed 0: setting auto mode */
1236	if (fan != 1 && fan != 0)
1237		return -EINVAL;
1238
1239	status = asus_wmi_evaluate_method_agfn(input);
1240
1241	if (status || args.agfn.err)
1242		return -ENXIO;
1243
1244	if (speed && fan == 1)
1245		asus->asus_hwmon_pwm = *speed;
1246
1247	return 0;
1248}
1249
1250/*
1251 * Check if we can read the speed of one fan. If true we assume we can also
1252 * control it.
1253 */
1254static int asus_hwmon_get_fan_number(struct asus_wmi *asus, int *num_fans)
1255{
1256	int status;
1257	int speed = 0;
1258
1259	*num_fans = 0;
1260
1261	status = asus_hwmon_agfn_fan_speed_read(asus, 1, &speed);
1262	if (!status)
1263		*num_fans = 1;
1264
1265	return 0;
1266}
1267
1268static int asus_hwmon_fan_set_auto(struct asus_wmi *asus)
1269{
1270	int status;
1271
1272	status = asus_hwmon_agfn_fan_speed_write(asus, 0, NULL);
1273	if (status)
1274		return -ENXIO;
1275
1276	asus->asus_hwmon_fan_manual_mode = false;
1277
1278	return 0;
1279}
1280
1281static int asus_hwmon_fan_rpm_show(struct device *dev, int fan)
1282{
1283	struct asus_wmi *asus = dev_get_drvdata(dev);
1284	int value;
1285	int ret;
1286
1287	/* no speed readable on manual mode */
1288	if (asus->asus_hwmon_fan_manual_mode)
1289		return -ENXIO;
1290
1291	ret = asus_hwmon_agfn_fan_speed_read(asus, fan+1, &value);
1292	if (ret) {
1293		pr_warn("reading fan speed failed: %d\n", ret);
1294		return -ENXIO;
1295	}
1296
1297	return value;
1298}
1299
1300static void asus_hwmon_pwm_show(struct asus_wmi *asus, int fan, int *value)
1301{
1302	int err;
1303
1304	if (asus->asus_hwmon_pwm >= 0) {
1305		*value = asus->asus_hwmon_pwm;
1306		return;
1307	}
1308
1309	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, value);
1310	if (err < 0)
1311		return;
1312
1313	*value &= 0xFF;
1314
1315	if (*value == 1) /* Low Speed */
1316		*value = 85;
1317	else if (*value == 2)
1318		*value = 170;
1319	else if (*value == 3)
1320		*value = 255;
1321	else if (*value) {
1322		pr_err("Unknown fan speed %#x\n", *value);
1323		*value = -1;
1324	}
1325}
1326
1327static ssize_t pwm1_show(struct device *dev,
1328			       struct device_attribute *attr,
1329			       char *buf)
1330{
1331	struct asus_wmi *asus = dev_get_drvdata(dev);
1332	int value;
1333
1334	asus_hwmon_pwm_show(asus, 0, &value);
1335
1336	return sprintf(buf, "%d\n", value);
1337}
1338
1339static ssize_t pwm1_store(struct device *dev,
1340				     struct device_attribute *attr,
1341				     const char *buf, size_t count) {
1342	struct asus_wmi *asus = dev_get_drvdata(dev);
1343	int value;
1344	int state;
1345	int ret;
1346
1347	ret = kstrtouint(buf, 10, &value);
1348
1349	if (ret)
1350		return ret;
1351
1352	value = clamp(value, 0, 255);
1353
1354	state = asus_hwmon_agfn_fan_speed_write(asus, 1, &value);
1355	if (state)
1356		pr_warn("Setting fan speed failed: %d\n", state);
1357	else
1358		asus->asus_hwmon_fan_manual_mode = true;
1359
1360	return count;
1361}
1362
1363static ssize_t fan1_input_show(struct device *dev,
1364					struct device_attribute *attr,
1365					char *buf)
1366{
1367	int value = asus_hwmon_fan_rpm_show(dev, 0);
1368
1369	return sprintf(buf, "%d\n", value < 0 ? -1 : value*100);
1370
1371}
1372
1373static ssize_t pwm1_enable_show(struct device *dev,
1374						 struct device_attribute *attr,
1375						 char *buf)
1376{
1377	struct asus_wmi *asus = dev_get_drvdata(dev);
1378
1379	if (asus->asus_hwmon_fan_manual_mode)
1380		return sprintf(buf, "%d\n", ASUS_FAN_CTRL_MANUAL);
1381
1382	return sprintf(buf, "%d\n", ASUS_FAN_CTRL_AUTO);
1383}
1384
1385static ssize_t pwm1_enable_store(struct device *dev,
1386						  struct device_attribute *attr,
1387						  const char *buf, size_t count)
1388{
1389	struct asus_wmi *asus = dev_get_drvdata(dev);
1390	int status = 0;
1391	int state;
1392	int ret;
1393
1394	ret = kstrtouint(buf, 10, &state);
1395
1396	if (ret)
1397		return ret;
1398
1399	if (state == ASUS_FAN_CTRL_MANUAL)
1400		asus->asus_hwmon_fan_manual_mode = true;
1401	else
1402		status = asus_hwmon_fan_set_auto(asus);
1403
1404	if (status)
1405		return status;
1406
1407	return count;
1408}
1409
1410static ssize_t fan1_label_show(struct device *dev,
1411					  struct device_attribute *attr,
1412					  char *buf)
1413{
1414	return sprintf(buf, "%s\n", ASUS_FAN_DESC);
1415}
1416
1417static ssize_t asus_hwmon_temp1(struct device *dev,
1418				struct device_attribute *attr,
1419				char *buf)
1420{
1421	struct asus_wmi *asus = dev_get_drvdata(dev);
1422	u32 value;
1423	int err;
1424
1425	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_THERMAL_CTRL, &value);
1426
1427	if (err < 0)
1428		return err;
1429
1430	value = DECI_KELVIN_TO_CELSIUS((value & 0xFFFF)) * 1000;
1431
1432	return sprintf(buf, "%d\n", value);
1433}
1434
1435/* Fan1 */
1436static DEVICE_ATTR_RW(pwm1);
1437static DEVICE_ATTR_RW(pwm1_enable);
1438static DEVICE_ATTR_RO(fan1_input);
1439static DEVICE_ATTR_RO(fan1_label);
1440
1441/* Temperature */
1442static DEVICE_ATTR(temp1_input, S_IRUGO, asus_hwmon_temp1, NULL);
 
 
 
 
1443
1444static struct attribute *hwmon_attributes[] = {
1445	&dev_attr_pwm1.attr,
1446	&dev_attr_pwm1_enable.attr,
1447	&dev_attr_fan1_input.attr,
1448	&dev_attr_fan1_label.attr,
1449
1450	&dev_attr_temp1_input.attr,
1451	NULL
1452};
1453
1454static umode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
1455					  struct attribute *attr, int idx)
1456{
1457	struct device *dev = container_of(kobj, struct device, kobj);
1458	struct platform_device *pdev = to_platform_device(dev->parent);
1459	struct asus_wmi *asus = platform_get_drvdata(pdev);
 
1460	int dev_id = -1;
1461	int fan_attr = -1;
1462	u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
1463	bool ok = true;
1464
1465	if (attr == &dev_attr_pwm1.attr)
1466		dev_id = ASUS_WMI_DEVID_FAN_CTRL;
1467	else if (attr == &dev_attr_temp1_input.attr)
1468		dev_id = ASUS_WMI_DEVID_THERMAL_CTRL;
1469
1470
1471	if (attr == &dev_attr_fan1_input.attr
1472	    || attr == &dev_attr_fan1_label.attr
1473	    || attr == &dev_attr_pwm1.attr
1474	    || attr == &dev_attr_pwm1_enable.attr) {
1475		fan_attr = 1;
1476	}
1477
1478	if (dev_id != -1) {
1479		int err = asus_wmi_get_devstate(asus, dev_id, &value);
1480
1481		if (err < 0 && fan_attr == -1)
1482			return 0; /* can't return negative here */
1483	}
1484
1485	if (dev_id == ASUS_WMI_DEVID_FAN_CTRL) {
1486		/*
1487		 * We need to find a better way, probably using sfun,
1488		 * bits or spec ...
1489		 * Currently we disable it if:
1490		 * - ASUS_WMI_UNSUPPORTED_METHOD is returned
1491		 * - reverved bits are non-zero
1492		 * - sfun and presence bit are not set
1493		 */
1494		if (value == ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
1495		    || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)))
1496			ok = false;
1497		else
1498			ok = fan_attr <= asus->asus_hwmon_num_fans;
1499	} else if (dev_id == ASUS_WMI_DEVID_THERMAL_CTRL) {
1500		/* If value is zero, something is clearly wrong */
1501		if (!value)
1502			ok = false;
1503	} else if (fan_attr <= asus->asus_hwmon_num_fans && fan_attr != -1) {
1504		ok = true;
1505	} else {
1506		ok = false;
1507	}
1508
1509	return ok ? attr->mode : 0;
1510}
1511
1512static const struct attribute_group hwmon_attribute_group = {
1513	.is_visible = asus_hwmon_sysfs_is_visible,
1514	.attrs = hwmon_attributes
1515};
1516__ATTRIBUTE_GROUPS(hwmon_attribute);
 
 
 
 
 
 
 
 
 
 
 
1517
1518static int asus_wmi_hwmon_init(struct asus_wmi *asus)
1519{
1520	struct device *hwmon;
 
1521
1522	hwmon = hwmon_device_register_with_groups(&asus->platform_device->dev,
1523						  "asus", asus,
1524						  hwmon_attribute_groups);
1525	if (IS_ERR(hwmon)) {
1526		pr_err("Could not register asus hwmon device\n");
1527		return PTR_ERR(hwmon);
1528	}
1529	return 0;
 
 
 
 
 
1530}
1531
1532/*
1533 * Backlight
1534 */
1535static int read_backlight_power(struct asus_wmi *asus)
1536{
1537	int ret;
1538	if (asus->driver->quirks->store_backlight_power)
1539		ret = !asus->driver->panel_power;
1540	else
1541		ret = asus_wmi_get_devstate_simple(asus,
1542						   ASUS_WMI_DEVID_BACKLIGHT);
1543
1544	if (ret < 0)
1545		return ret;
1546
1547	return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
1548}
1549
1550static int read_brightness_max(struct asus_wmi *asus)
1551{
1552	u32 retval;
1553	int err;
1554
1555	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1556
1557	if (err < 0)
1558		return err;
1559
1560	retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
1561	retval >>= 8;
1562
1563	if (!retval)
1564		return -ENODEV;
1565
1566	return retval;
1567}
1568
1569static int read_brightness(struct backlight_device *bd)
1570{
1571	struct asus_wmi *asus = bl_get_data(bd);
1572	u32 retval;
1573	int err;
1574
1575	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1576
1577	if (err < 0)
1578		return err;
1579
1580	return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
1581}
1582
1583static u32 get_scalar_command(struct backlight_device *bd)
1584{
1585	struct asus_wmi *asus = bl_get_data(bd);
1586	u32 ctrl_param = 0;
1587
1588	if ((asus->driver->brightness < bd->props.brightness) ||
1589	    bd->props.brightness == bd->props.max_brightness)
1590		ctrl_param = 0x00008001;
1591	else if ((asus->driver->brightness > bd->props.brightness) ||
1592		 bd->props.brightness == 0)
1593		ctrl_param = 0x00008000;
1594
1595	asus->driver->brightness = bd->props.brightness;
1596
1597	return ctrl_param;
1598}
1599
1600static int update_bl_status(struct backlight_device *bd)
1601{
1602	struct asus_wmi *asus = bl_get_data(bd);
1603	u32 ctrl_param;
1604	int power, err = 0;
1605
1606	power = read_backlight_power(asus);
1607	if (power != -ENODEV && bd->props.power != power) {
1608		ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
1609		err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
1610					    ctrl_param, NULL);
1611		if (asus->driver->quirks->store_backlight_power)
1612			asus->driver->panel_power = bd->props.power;
1613
1614		/* When using scalar brightness, updating the brightness
1615		 * will mess with the backlight power */
1616		if (asus->driver->quirks->scalar_panel_brightness)
1617			return err;
1618	}
1619
1620	if (asus->driver->quirks->scalar_panel_brightness)
1621		ctrl_param = get_scalar_command(bd);
1622	else
1623		ctrl_param = bd->props.brightness;
1624
1625	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
1626				    ctrl_param, NULL);
1627
1628	return err;
1629}
1630
1631static const struct backlight_ops asus_wmi_bl_ops = {
1632	.get_brightness = read_brightness,
1633	.update_status = update_bl_status,
1634};
1635
1636static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
1637{
1638	struct backlight_device *bd = asus->backlight_device;
1639	int old = bd->props.brightness;
1640	int new = old;
1641
1642	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1643		new = code - NOTIFY_BRNUP_MIN + 1;
1644	else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
1645		new = code - NOTIFY_BRNDOWN_MIN;
1646
1647	bd->props.brightness = new;
1648	backlight_update_status(bd);
1649	backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1650
1651	return old;
1652}
1653
1654static int asus_wmi_backlight_init(struct asus_wmi *asus)
1655{
1656	struct backlight_device *bd;
1657	struct backlight_properties props;
1658	int max;
1659	int power;
1660
1661	max = read_brightness_max(asus);
1662	if (max < 0)
 
 
 
1663		return max;
1664
1665	power = read_backlight_power(asus);
1666
1667	if (power == -ENODEV)
1668		power = FB_BLANK_UNBLANK;
1669	else if (power < 0)
1670		return power;
1671
1672	memset(&props, 0, sizeof(struct backlight_properties));
1673	props.type = BACKLIGHT_PLATFORM;
1674	props.max_brightness = max;
1675	bd = backlight_device_register(asus->driver->name,
1676				       &asus->platform_device->dev, asus,
1677				       &asus_wmi_bl_ops, &props);
1678	if (IS_ERR(bd)) {
1679		pr_err("Could not register backlight device\n");
1680		return PTR_ERR(bd);
1681	}
1682
1683	asus->backlight_device = bd;
1684
1685	if (asus->driver->quirks->store_backlight_power)
1686		asus->driver->panel_power = power;
1687
1688	bd->props.brightness = read_brightness(bd);
1689	bd->props.power = power;
1690	backlight_update_status(bd);
1691
1692	asus->driver->brightness = bd->props.brightness;
1693
1694	return 0;
1695}
1696
1697static void asus_wmi_backlight_exit(struct asus_wmi *asus)
1698{
1699	backlight_device_unregister(asus->backlight_device);
 
1700
1701	asus->backlight_device = NULL;
1702}
1703
1704static int is_display_toggle(int code)
1705{
1706	/* display toggle keys */
1707	if ((code >= 0x61 && code <= 0x67) ||
1708	    (code >= 0x8c && code <= 0x93) ||
1709	    (code >= 0xa0 && code <= 0xa7) ||
1710	    (code >= 0xd0 && code <= 0xd5))
1711		return 1;
1712
1713	return 0;
1714}
1715
1716static void asus_wmi_notify(u32 value, void *context)
1717{
1718	struct asus_wmi *asus = context;
1719	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
1720	union acpi_object *obj;
1721	acpi_status status;
1722	int code;
1723	int orig_code;
1724	unsigned int key_value = 1;
1725	bool autorelease = 1;
1726
1727	status = wmi_get_event_data(value, &response);
1728	if (status != AE_OK) {
1729		pr_err("bad event status 0x%x\n", status);
1730		return;
1731	}
1732
1733	obj = (union acpi_object *)response.pointer;
1734
1735	if (!obj || obj->type != ACPI_TYPE_INTEGER)
1736		goto exit;
1737
1738	code = obj->integer.value;
1739	orig_code = code;
1740
1741	if (asus->driver->key_filter) {
1742		asus->driver->key_filter(asus->driver, &code, &key_value,
1743					 &autorelease);
1744		if (code == ASUS_WMI_KEY_IGNORE)
1745			goto exit;
1746	}
1747
1748	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1749		code = ASUS_WMI_BRN_UP;
1750	else if (code >= NOTIFY_BRNDOWN_MIN &&
1751		 code <= NOTIFY_BRNDOWN_MAX)
1752		code = ASUS_WMI_BRN_DOWN;
1753
1754	if (code == ASUS_WMI_BRN_DOWN || code == ASUS_WMI_BRN_UP) {
1755		if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
1756			asus_wmi_backlight_notify(asus, orig_code);
1757			goto exit;
1758		}
1759	}
1760
1761	if (is_display_toggle(code) &&
1762	    asus->driver->quirks->no_display_toggle)
1763		goto exit;
1764
1765	if (!sparse_keymap_report_event(asus->inputdev, code,
1766					key_value, autorelease))
1767		pr_info("Unknown key %x pressed\n", code);
1768
1769exit:
1770	kfree(obj);
1771}
1772
1773/*
1774 * Sys helpers
1775 */
1776static int parse_arg(const char *buf, unsigned long count, int *val)
1777{
1778	if (!count)
1779		return 0;
1780	if (sscanf(buf, "%i", val) != 1)
1781		return -EINVAL;
1782	return count;
1783}
1784
1785static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
1786			     const char *buf, size_t count)
1787{
1788	u32 retval;
1789	int rv, err, value;
1790
1791	value = asus_wmi_get_devstate_simple(asus, devid);
1792	if (value < 0)
1793		return value;
1794
1795	rv = parse_arg(buf, count, &value);
1796	err = asus_wmi_set_devstate(devid, value, &retval);
1797
1798	if (err < 0)
1799		return err;
1800
1801	return rv;
1802}
1803
1804static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
1805{
1806	int value = asus_wmi_get_devstate_simple(asus, devid);
1807
1808	if (value < 0)
1809		return value;
1810
1811	return sprintf(buf, "%d\n", value);
1812}
1813
1814#define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)			\
1815	static ssize_t show_##_name(struct device *dev,			\
1816				    struct device_attribute *attr,	\
1817				    char *buf)				\
1818	{								\
1819		struct asus_wmi *asus = dev_get_drvdata(dev);		\
1820									\
1821		return show_sys_wmi(asus, _cm, buf);			\
1822	}								\
1823	static ssize_t store_##_name(struct device *dev,		\
1824				     struct device_attribute *attr,	\
1825				     const char *buf, size_t count)	\
1826	{								\
1827		struct asus_wmi *asus = dev_get_drvdata(dev);		\
1828									\
1829		return store_sys_wmi(asus, _cm, buf, count);		\
1830	}								\
1831	static struct device_attribute dev_attr_##_name = {		\
1832		.attr = {						\
1833			.name = __stringify(_name),			\
1834			.mode = _mode },				\
1835		.show   = show_##_name,					\
1836		.store  = store_##_name,				\
1837	}
1838
1839ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
1840ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
1841ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
1842ASUS_WMI_CREATE_DEVICE_ATTR(lid_resume, 0644, ASUS_WMI_DEVID_LID_RESUME);
1843ASUS_WMI_CREATE_DEVICE_ATTR(als_enable, 0644, ASUS_WMI_DEVID_ALS_ENABLE);
1844
1845static ssize_t cpufv_store(struct device *dev, struct device_attribute *attr,
1846			   const char *buf, size_t count)
1847{
1848	int value, rv;
1849
1850	if (!count || sscanf(buf, "%i", &value) != 1)
1851		return -EINVAL;
1852	if (value < 0 || value > 2)
1853		return -EINVAL;
1854
1855	rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
1856	if (rv < 0)
1857		return rv;
1858
1859	return count;
1860}
1861
1862static DEVICE_ATTR_WO(cpufv);
1863
1864static struct attribute *platform_attributes[] = {
1865	&dev_attr_cpufv.attr,
1866	&dev_attr_camera.attr,
1867	&dev_attr_cardr.attr,
1868	&dev_attr_touchpad.attr,
1869	&dev_attr_lid_resume.attr,
1870	&dev_attr_als_enable.attr,
1871	NULL
1872};
1873
1874static umode_t asus_sysfs_is_visible(struct kobject *kobj,
1875				    struct attribute *attr, int idx)
1876{
1877	struct device *dev = container_of(kobj, struct device, kobj);
1878	struct platform_device *pdev = to_platform_device(dev);
1879	struct asus_wmi *asus = platform_get_drvdata(pdev);
1880	bool ok = true;
1881	int devid = -1;
1882
1883	if (attr == &dev_attr_camera.attr)
1884		devid = ASUS_WMI_DEVID_CAMERA;
1885	else if (attr == &dev_attr_cardr.attr)
1886		devid = ASUS_WMI_DEVID_CARDREADER;
1887	else if (attr == &dev_attr_touchpad.attr)
1888		devid = ASUS_WMI_DEVID_TOUCHPAD;
1889	else if (attr == &dev_attr_lid_resume.attr)
1890		devid = ASUS_WMI_DEVID_LID_RESUME;
1891	else if (attr == &dev_attr_als_enable.attr)
1892		devid = ASUS_WMI_DEVID_ALS_ENABLE;
1893
1894	if (devid != -1)
1895		ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
1896
1897	return ok ? attr->mode : 0;
1898}
1899
1900static const struct attribute_group platform_attribute_group = {
1901	.is_visible = asus_sysfs_is_visible,
1902	.attrs = platform_attributes
1903};
1904
1905static void asus_wmi_sysfs_exit(struct platform_device *device)
1906{
1907	sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1908}
1909
1910static int asus_wmi_sysfs_init(struct platform_device *device)
1911{
1912	return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1913}
1914
1915/*
1916 * Platform device
1917 */
1918static int asus_wmi_platform_init(struct asus_wmi *asus)
1919{
1920	int rv;
1921
1922	/* INIT enable hotkeys on some models */
1923	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
1924		pr_info("Initialization: %#x\n", rv);
1925
1926	/* We don't know yet what to do with this version... */
1927	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
1928		pr_info("BIOS WMI version: %d.%d\n", rv >> 16, rv & 0xFF);
1929		asus->spec = rv;
1930	}
1931
1932	/*
1933	 * The SFUN method probably allows the original driver to get the list
1934	 * of features supported by a given model. For now, 0x0100 or 0x0800
1935	 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
1936	 * The significance of others is yet to be found.
1937	 */
1938	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
1939		pr_info("SFUN value: %#x\n", rv);
1940		asus->sfun = rv;
1941	}
1942
1943	/*
1944	 * Eee PC and Notebooks seems to have different method_id for DSTS,
1945	 * but it may also be related to the BIOS's SPEC.
1946	 * Note, on most Eeepc, there is no way to check if a method exist
1947	 * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
1948	 * but once again, SPEC may probably be used for that kind of things.
1949	 */
1950	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL))
1951		asus->dsts_id = ASUS_WMI_METHODID_DSTS;
1952	else
1953		asus->dsts_id = ASUS_WMI_METHODID_DSTS2;
1954
1955	/* CWAP allow to define the behavior of the Fn+F2 key,
1956	 * this method doesn't seems to be present on Eee PCs */
1957	if (asus->driver->quirks->wapf >= 0)
1958		asus_wmi_set_devstate(ASUS_WMI_DEVID_CWAP,
1959				      asus->driver->quirks->wapf, NULL);
1960
1961	return asus_wmi_sysfs_init(asus->platform_device);
1962}
1963
1964static void asus_wmi_platform_exit(struct asus_wmi *asus)
1965{
1966	asus_wmi_sysfs_exit(asus->platform_device);
1967}
1968
1969/*
1970 * debugfs
1971 */
1972struct asus_wmi_debugfs_node {
1973	struct asus_wmi *asus;
1974	char *name;
1975	int (*show) (struct seq_file *m, void *data);
1976};
1977
1978static int show_dsts(struct seq_file *m, void *data)
1979{
1980	struct asus_wmi *asus = m->private;
1981	int err;
1982	u32 retval = -1;
1983
1984	err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
1985
1986	if (err < 0)
1987		return err;
1988
1989	seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
1990
1991	return 0;
1992}
1993
1994static int show_devs(struct seq_file *m, void *data)
1995{
1996	struct asus_wmi *asus = m->private;
1997	int err;
1998	u32 retval = -1;
1999
2000	err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
2001				    &retval);
2002
2003	if (err < 0)
2004		return err;
2005
2006	seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
2007		   asus->debug.ctrl_param, retval);
2008
2009	return 0;
2010}
2011
2012static int show_call(struct seq_file *m, void *data)
2013{
2014	struct asus_wmi *asus = m->private;
2015	struct bios_args args = {
2016		.arg0 = asus->debug.dev_id,
2017		.arg1 = asus->debug.ctrl_param,
2018	};
2019	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
2020	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
2021	union acpi_object *obj;
2022	acpi_status status;
2023
2024	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
2025				     0, asus->debug.method_id,
2026				     &input, &output);
2027
2028	if (ACPI_FAILURE(status))
2029		return -EIO;
2030
2031	obj = (union acpi_object *)output.pointer;
2032	if (obj && obj->type == ACPI_TYPE_INTEGER)
2033		seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
2034			   asus->debug.dev_id, asus->debug.ctrl_param,
2035			   (u32) obj->integer.value);
2036	else
2037		seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
2038			   asus->debug.dev_id, asus->debug.ctrl_param,
2039			   obj ? obj->type : -1);
2040
2041	kfree(obj);
2042
2043	return 0;
2044}
2045
2046static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
2047	{NULL, "devs", show_devs},
2048	{NULL, "dsts", show_dsts},
2049	{NULL, "call", show_call},
2050};
2051
2052static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
2053{
2054	struct asus_wmi_debugfs_node *node = inode->i_private;
2055
2056	return single_open(file, node->show, node->asus);
2057}
2058
2059static const struct file_operations asus_wmi_debugfs_io_ops = {
2060	.owner = THIS_MODULE,
2061	.open = asus_wmi_debugfs_open,
2062	.read = seq_read,
2063	.llseek = seq_lseek,
2064	.release = single_release,
2065};
2066
2067static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
2068{
2069	debugfs_remove_recursive(asus->debug.root);
2070}
2071
2072static int asus_wmi_debugfs_init(struct asus_wmi *asus)
2073{
2074	struct dentry *dent;
2075	int i;
2076
2077	asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
2078	if (!asus->debug.root) {
2079		pr_err("failed to create debugfs directory\n");
2080		goto error_debugfs;
2081	}
2082
2083	dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR,
2084				  asus->debug.root, &asus->debug.method_id);
2085	if (!dent)
2086		goto error_debugfs;
2087
2088	dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR,
2089				  asus->debug.root, &asus->debug.dev_id);
2090	if (!dent)
2091		goto error_debugfs;
2092
2093	dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR,
2094				  asus->debug.root, &asus->debug.ctrl_param);
2095	if (!dent)
2096		goto error_debugfs;
2097
2098	for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
2099		struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
2100
2101		node->asus = asus;
2102		dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO,
2103					   asus->debug.root, node,
2104					   &asus_wmi_debugfs_io_ops);
2105		if (!dent) {
2106			pr_err("failed to create debug file: %s\n", node->name);
2107			goto error_debugfs;
2108		}
2109	}
2110
2111	return 0;
2112
2113error_debugfs:
2114	asus_wmi_debugfs_exit(asus);
2115	return -ENOMEM;
2116}
2117
2118static int asus_wmi_fan_init(struct asus_wmi *asus)
2119{
2120	int status;
2121
2122	asus->asus_hwmon_pwm = -1;
2123	asus->asus_hwmon_num_fans = -1;
2124	asus->asus_hwmon_fan_manual_mode = false;
2125
2126	status = asus_hwmon_get_fan_number(asus, &asus->asus_hwmon_num_fans);
2127	if (status) {
2128		asus->asus_hwmon_num_fans = 0;
2129		pr_warn("Could not determine number of fans: %d\n", status);
2130		return -ENXIO;
2131	}
2132
2133	pr_info("Number of fans: %d\n", asus->asus_hwmon_num_fans);
2134	return 0;
2135}
2136
2137/*
2138 * WMI Driver
2139 */
2140static int asus_wmi_add(struct platform_device *pdev)
2141{
2142	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2143	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2144	struct asus_wmi *asus;
2145	const char *chassis_type;
2146	acpi_status status;
2147	int err;
2148	u32 result;
2149
2150	asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
2151	if (!asus)
2152		return -ENOMEM;
2153
2154	asus->driver = wdrv;
2155	asus->platform_device = pdev;
2156	wdrv->platform_device = pdev;
2157	platform_set_drvdata(asus->platform_device, asus);
2158
2159	if (wdrv->detect_quirks)
2160		wdrv->detect_quirks(asus->driver);
2161
2162	err = asus_wmi_platform_init(asus);
2163	if (err)
2164		goto fail_platform;
2165
2166	err = asus_wmi_input_init(asus);
2167	if (err)
2168		goto fail_input;
2169
2170	err = asus_wmi_fan_init(asus); /* probably no problems on error */
2171	asus_hwmon_fan_set_auto(asus);
2172
2173	err = asus_wmi_hwmon_init(asus);
2174	if (err)
2175		goto fail_hwmon;
2176
2177	err = asus_wmi_led_init(asus);
2178	if (err)
2179		goto fail_leds;
2180
2181	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WLAN, &result);
2182	if (result & (ASUS_WMI_DSTS_PRESENCE_BIT | ASUS_WMI_DSTS_USER_BIT))
2183		asus->driver->wlan_ctrl_by_user = 1;
2184
2185	if (!(asus->driver->wlan_ctrl_by_user && ashs_present())) {
2186		err = asus_wmi_rfkill_init(asus);
2187		if (err)
2188			goto fail_rfkill;
2189	}
2190
2191	if (asus->driver->quirks->wmi_force_als_set)
2192		asus_wmi_set_als();
2193
2194	/* Some Asus desktop boards export an acpi-video backlight interface,
2195	   stop this from showing up */
2196	chassis_type = dmi_get_system_info(DMI_CHASSIS_TYPE);
2197	if (chassis_type && !strcmp(chassis_type, "3"))
2198		acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2199
2200	if (asus->driver->quirks->wmi_backlight_power)
2201		acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2202
2203	if (asus->driver->quirks->wmi_backlight_native)
2204		acpi_video_set_dmi_backlight_type(acpi_backlight_native);
2205
2206	if (asus->driver->quirks->xusb2pr)
2207		asus_wmi_set_xusb2pr(asus);
2208
2209	if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
2210		err = asus_wmi_backlight_init(asus);
2211		if (err && err != -ENODEV)
2212			goto fail_backlight;
2213	}
 
2214
2215	status = wmi_install_notify_handler(asus->driver->event_guid,
2216					    asus_wmi_notify, asus);
2217	if (ACPI_FAILURE(status)) {
2218		pr_err("Unable to register notify handler - %d\n", status);
2219		err = -ENODEV;
2220		goto fail_wmi_handler;
2221	}
2222
2223	err = asus_wmi_debugfs_init(asus);
2224	if (err)
2225		goto fail_debugfs;
2226
2227	return 0;
2228
2229fail_debugfs:
2230	wmi_remove_notify_handler(asus->driver->event_guid);
2231fail_wmi_handler:
2232	asus_wmi_backlight_exit(asus);
2233fail_backlight:
2234	asus_wmi_rfkill_exit(asus);
2235fail_rfkill:
2236	asus_wmi_led_exit(asus);
2237fail_leds:
 
2238fail_hwmon:
2239	asus_wmi_input_exit(asus);
2240fail_input:
2241	asus_wmi_platform_exit(asus);
2242fail_platform:
2243	kfree(asus);
2244	return err;
2245}
2246
2247static int asus_wmi_remove(struct platform_device *device)
2248{
2249	struct asus_wmi *asus;
2250
2251	asus = platform_get_drvdata(device);
2252	wmi_remove_notify_handler(asus->driver->event_guid);
2253	asus_wmi_backlight_exit(asus);
2254	asus_wmi_input_exit(asus);
 
2255	asus_wmi_led_exit(asus);
2256	asus_wmi_rfkill_exit(asus);
2257	asus_wmi_debugfs_exit(asus);
2258	asus_wmi_platform_exit(asus);
2259	asus_hwmon_fan_set_auto(asus);
2260
2261	kfree(asus);
2262	return 0;
2263}
2264
2265/*
2266 * Platform driver - hibernate/resume callbacks
2267 */
2268static int asus_hotk_thaw(struct device *device)
2269{
2270	struct asus_wmi *asus = dev_get_drvdata(device);
2271
2272	if (asus->wlan.rfkill) {
2273		bool wlan;
2274
2275		/*
2276		 * Work around bios bug - acpi _PTS turns off the wireless led
2277		 * during suspend.  Normally it restores it on resume, but
2278		 * we should kick it ourselves in case hibernation is aborted.
2279		 */
2280		wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
2281		asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
2282	}
2283
2284	return 0;
2285}
2286
2287static int asus_hotk_resume(struct device *device)
2288{
2289	struct asus_wmi *asus = dev_get_drvdata(device);
2290
2291	if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2292		queue_work(asus->led_workqueue, &asus->kbd_led_work);
2293
2294	return 0;
2295}
2296
2297static int asus_hotk_restore(struct device *device)
2298{
2299	struct asus_wmi *asus = dev_get_drvdata(device);
2300	int bl;
2301
2302	/* Refresh both wlan rfkill state and pci hotplug */
2303	if (asus->wlan.rfkill)
2304		asus_rfkill_hotplug(asus);
2305
2306	if (asus->bluetooth.rfkill) {
2307		bl = !asus_wmi_get_devstate_simple(asus,
2308						   ASUS_WMI_DEVID_BLUETOOTH);
2309		rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
2310	}
2311	if (asus->wimax.rfkill) {
2312		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
2313		rfkill_set_sw_state(asus->wimax.rfkill, bl);
2314	}
2315	if (asus->wwan3g.rfkill) {
2316		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
2317		rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
2318	}
2319	if (asus->gps.rfkill) {
2320		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_GPS);
2321		rfkill_set_sw_state(asus->gps.rfkill, bl);
2322	}
2323	if (asus->uwb.rfkill) {
2324		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_UWB);
2325		rfkill_set_sw_state(asus->uwb.rfkill, bl);
2326	}
2327	if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2328		queue_work(asus->led_workqueue, &asus->kbd_led_work);
2329
2330	return 0;
2331}
2332
2333static const struct dev_pm_ops asus_pm_ops = {
2334	.thaw = asus_hotk_thaw,
2335	.restore = asus_hotk_restore,
2336	.resume = asus_hotk_resume,
2337};
2338
2339static int asus_wmi_probe(struct platform_device *pdev)
2340{
2341	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2342	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2343	int ret;
2344
2345	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
2346		pr_warn("Management GUID not found\n");
2347		return -ENODEV;
2348	}
2349
2350	if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
2351		pr_warn("Event GUID not found\n");
2352		return -ENODEV;
2353	}
2354
2355	if (wdrv->probe) {
2356		ret = wdrv->probe(pdev);
2357		if (ret)
2358			return ret;
2359	}
2360
2361	return asus_wmi_add(pdev);
2362}
2363
2364static bool used;
2365
2366int __init_or_module asus_wmi_register_driver(struct asus_wmi_driver *driver)
2367{
2368	struct platform_driver *platform_driver;
2369	struct platform_device *platform_device;
2370
2371	if (used)
2372		return -EBUSY;
2373
2374	platform_driver = &driver->platform_driver;
2375	platform_driver->remove = asus_wmi_remove;
2376	platform_driver->driver.owner = driver->owner;
2377	platform_driver->driver.name = driver->name;
2378	platform_driver->driver.pm = &asus_pm_ops;
2379
2380	platform_device = platform_create_bundle(platform_driver,
2381						 asus_wmi_probe,
2382						 NULL, 0, NULL, 0);
2383	if (IS_ERR(platform_device))
2384		return PTR_ERR(platform_device);
2385
2386	used = true;
2387	return 0;
2388}
2389EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
2390
2391void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
2392{
2393	platform_device_unregister(driver->platform_device);
2394	platform_driver_unregister(&driver->platform_driver);
2395	used = false;
2396}
2397EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
2398
2399static int __init asus_wmi_init(void)
2400{
2401	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
2402		pr_info("Asus Management GUID not found\n");
2403		return -ENODEV;
2404	}
2405
2406	pr_info("ASUS WMI generic driver loaded\n");
2407	return 0;
2408}
2409
2410static void __exit asus_wmi_exit(void)
2411{
2412	pr_info("ASUS WMI generic driver unloaded\n");
2413}
2414
2415module_init(asus_wmi_init);
2416module_exit(asus_wmi_exit);