Linux Audio

Check our new training course

Loading...
v3.1
 
   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 & 0x80 ? retval & 0x7F : 0;
 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 (asus->tpd_led.dev)
 457		led_classdev_unregister(&asus->tpd_led);
 
 
 
 458	if (asus->led_workqueue)
 459		destroy_workqueue(asus->led_workqueue);
 460}
 461
 462static int asus_wmi_led_init(struct asus_wmi *asus)
 463{
 464	int rv = 0;
 465
 466	asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
 467	if (!asus->led_workqueue)
 468		return -ENOMEM;
 469
 470	if (read_tpd_led_state(asus) >= 0) {
 471		INIT_WORK(&asus->tpd_led_work, tpd_led_update);
 472
 473		asus->tpd_led.name = "asus::touchpad";
 474		asus->tpd_led.brightness_set = tpd_led_set;
 475		asus->tpd_led.brightness_get = tpd_led_get;
 476		asus->tpd_led.max_brightness = 1;
 477
 478		rv = led_classdev_register(&asus->platform_device->dev,
 479					   &asus->tpd_led);
 480		if (rv)
 481			goto error;
 482	}
 483
 484	if (kbd_led_read(asus, NULL, NULL) >= 0) {
 485		INIT_WORK(&asus->kbd_led_work, kbd_led_update);
 486
 487		asus->kbd_led.name = "asus::kbd_backlight";
 
 488		asus->kbd_led.brightness_set = kbd_led_set;
 489		asus->kbd_led.brightness_get = kbd_led_get;
 490		asus->kbd_led.max_brightness = 3;
 491
 492		rv = led_classdev_register(&asus->platform_device->dev,
 493					   &asus->kbd_led);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 494	}
 495
 496error:
 497	if (rv)
 498		asus_wmi_led_exit(asus);
 499
 500	return rv;
 501}
 502
 
 503
 504/*
 505 * PCI hotplug (for wlan rfkill)
 506 */
 507static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus)
 508{
 509	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 510
 511	if (result < 0)
 512		return false;
 513	return !result;
 514}
 515
 516static void asus_rfkill_hotplug(struct asus_wmi *asus)
 517{
 518	struct pci_dev *dev;
 519	struct pci_bus *bus;
 520	bool blocked;
 521	bool absent;
 522	u32 l;
 523
 524	mutex_lock(&asus->wmi_lock);
 525	blocked = asus_wlan_rfkill_blocked(asus);
 526	mutex_unlock(&asus->wmi_lock);
 527
 528	mutex_lock(&asus->hotplug_lock);
 
 529
 530	if (asus->wlan.rfkill)
 531		rfkill_set_sw_state(asus->wlan.rfkill, blocked);
 532
 533	if (asus->hotplug_slot) {
 534		bus = pci_find_bus(0, 1);
 535		if (!bus) {
 536			pr_warn("Unable to find PCI bus 1?\n");
 537			goto out_unlock;
 538		}
 539
 540		if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
 541			pr_err("Unable to read PCI config space?\n");
 542			goto out_unlock;
 543		}
 544		absent = (l == 0xffffffff);
 545
 546		if (blocked != absent) {
 547			pr_warn("BIOS says wireless lan is %s, "
 548				"but the pci device is %s\n",
 549				blocked ? "blocked" : "unblocked",
 550				absent ? "absent" : "present");
 551			pr_warn("skipped wireless hotplug as probably "
 552				"inappropriate for this model\n");
 553			goto out_unlock;
 554		}
 555
 556		if (!blocked) {
 557			dev = pci_get_slot(bus, 0);
 558			if (dev) {
 559				/* Device already present */
 560				pci_dev_put(dev);
 561				goto out_unlock;
 562			}
 563			dev = pci_scan_single_device(bus, 0);
 564			if (dev) {
 565				pci_bus_assign_resources(bus);
 566				if (pci_bus_add_device(dev))
 567					pr_err("Unable to hotplug wifi\n");
 568			}
 569		} else {
 570			dev = pci_get_slot(bus, 0);
 571			if (dev) {
 572				pci_remove_bus_device(dev);
 573				pci_dev_put(dev);
 574			}
 575		}
 576	}
 577
 578out_unlock:
 
 579	mutex_unlock(&asus->hotplug_lock);
 580}
 581
 582static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data)
 583{
 584	struct asus_wmi *asus = data;
 585
 586	if (event != ACPI_NOTIFY_BUS_CHECK)
 587		return;
 588
 589	/*
 590	 * We can't call directly asus_rfkill_hotplug because most
 591	 * of the time WMBC is still being executed and not reetrant.
 592	 * There is currently no way to tell ACPICA that  we want this
 593	 * method to be serialized, we schedule a asus_rfkill_hotplug
 594	 * call later, in a safer context.
 595	 */
 596	queue_work(asus->hotplug_workqueue, &asus->hotplug_work);
 597}
 598
 599static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node)
 600{
 601	acpi_status status;
 602	acpi_handle handle;
 603
 604	status = acpi_get_handle(NULL, node, &handle);
 605
 606	if (ACPI_SUCCESS(status)) {
 607		status = acpi_install_notify_handler(handle,
 608						     ACPI_SYSTEM_NOTIFY,
 609						     asus_rfkill_notify, asus);
 610		if (ACPI_FAILURE(status))
 611			pr_warn("Failed to register notify on %s\n", node);
 612	} else
 613		return -ENODEV;
 614
 
 
 
 
 
 615	return 0;
 616}
 617
 618static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node)
 619{
 620	acpi_status status = AE_OK;
 621	acpi_handle handle;
 622
 623	status = acpi_get_handle(NULL, node, &handle);
 
 
 624
 625	if (ACPI_SUCCESS(status)) {
 626		status = acpi_remove_notify_handler(handle,
 627						    ACPI_SYSTEM_NOTIFY,
 628						    asus_rfkill_notify);
 629		if (ACPI_FAILURE(status))
 630			pr_err("Error removing rfkill notify handler %s\n",
 631			       node);
 632	}
 633}
 634
 635static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot,
 636				   u8 *value)
 637{
 638	struct asus_wmi *asus = hotplug_slot->private;
 
 639	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 640
 641	if (result < 0)
 642		return result;
 643
 644	*value = !!result;
 645	return 0;
 646}
 647
 648static void asus_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot)
 649{
 650	kfree(hotplug_slot->info);
 651	kfree(hotplug_slot);
 652}
 653
 654static struct hotplug_slot_ops asus_hotplug_slot_ops = {
 655	.owner = THIS_MODULE,
 656	.get_adapter_status = asus_get_adapter_status,
 657	.get_power_status = asus_get_adapter_status,
 658};
 659
 660static void asus_hotplug_work(struct work_struct *work)
 661{
 662	struct asus_wmi *asus;
 663
 664	asus = container_of(work, struct asus_wmi, hotplug_work);
 665	asus_rfkill_hotplug(asus);
 666}
 667
 668static int asus_setup_pci_hotplug(struct asus_wmi *asus)
 669{
 670	int ret = -ENOMEM;
 671	struct pci_bus *bus = pci_find_bus(0, 1);
 672
 673	if (!bus) {
 674		pr_err("Unable to find wifi PCI bus\n");
 675		return -ENODEV;
 676	}
 677
 678	asus->hotplug_workqueue =
 679	    create_singlethread_workqueue("hotplug_workqueue");
 680	if (!asus->hotplug_workqueue)
 681		goto error_workqueue;
 682
 683	INIT_WORK(&asus->hotplug_work, asus_hotplug_work);
 684
 685	asus->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
 686	if (!asus->hotplug_slot)
 687		goto error_slot;
 688
 689	asus->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
 690					   GFP_KERNEL);
 691	if (!asus->hotplug_slot->info)
 692		goto error_info;
 693
 694	asus->hotplug_slot->private = asus;
 695	asus->hotplug_slot->release = &asus_cleanup_pci_hotplug;
 696	asus->hotplug_slot->ops = &asus_hotplug_slot_ops;
 697	asus_get_adapter_status(asus->hotplug_slot,
 698				&asus->hotplug_slot->info->adapter_status);
 699
 700	ret = pci_hp_register(asus->hotplug_slot, bus, 0, "asus-wifi");
 701	if (ret) {
 702		pr_err("Unable to register hotplug slot - %d\n", ret);
 703		goto error_register;
 704	}
 705
 706	return 0;
 707
 708error_register:
 709	kfree(asus->hotplug_slot->info);
 710error_info:
 711	kfree(asus->hotplug_slot);
 712	asus->hotplug_slot = NULL;
 713error_slot:
 714	destroy_workqueue(asus->hotplug_workqueue);
 715error_workqueue:
 716	return ret;
 717}
 718
 719/*
 720 * Rfkill devices
 721 */
 722static int asus_rfkill_set(void *data, bool blocked)
 723{
 724	struct asus_rfkill *priv = data;
 725	u32 ctrl_param = !blocked;
 
 726
 727	return asus_wmi_set_devstate(priv->dev_id, ctrl_param, NULL);
 
 
 
 
 
 
 
 
 
 
 
 
 728}
 729
 730static void asus_rfkill_query(struct rfkill *rfkill, void *data)
 731{
 732	struct asus_rfkill *priv = data;
 733	int result;
 734
 735	result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id);
 736
 737	if (result < 0)
 738		return;
 739
 740	rfkill_set_sw_state(priv->rfkill, !result);
 741}
 742
 743static int asus_rfkill_wlan_set(void *data, bool blocked)
 744{
 745	struct asus_rfkill *priv = data;
 746	struct asus_wmi *asus = priv->asus;
 747	int ret;
 748
 749	/*
 750	 * This handler is enabled only if hotplug is enabled.
 751	 * In this case, the asus_wmi_set_devstate() will
 752	 * trigger a wmi notification and we need to wait
 753	 * this call to finish before being able to call
 754	 * any wmi method
 755	 */
 756	mutex_lock(&asus->wmi_lock);
 757	ret = asus_rfkill_set(data, blocked);
 758	mutex_unlock(&asus->wmi_lock);
 759	return ret;
 760}
 761
 762static const struct rfkill_ops asus_rfkill_wlan_ops = {
 763	.set_block = asus_rfkill_wlan_set,
 764	.query = asus_rfkill_query,
 765};
 766
 767static const struct rfkill_ops asus_rfkill_ops = {
 768	.set_block = asus_rfkill_set,
 769	.query = asus_rfkill_query,
 770};
 771
 772static int asus_new_rfkill(struct asus_wmi *asus,
 773			   struct asus_rfkill *arfkill,
 774			   const char *name, enum rfkill_type type, int dev_id)
 775{
 776	int result = asus_wmi_get_devstate_simple(asus, dev_id);
 777	struct rfkill **rfkill = &arfkill->rfkill;
 778
 779	if (result < 0)
 780		return result;
 781
 782	arfkill->dev_id = dev_id;
 783	arfkill->asus = asus;
 784
 785	if (dev_id == ASUS_WMI_DEVID_WLAN && asus->driver->hotplug_wireless)
 
 786		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
 787				       &asus_rfkill_wlan_ops, arfkill);
 788	else
 789		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
 790				       &asus_rfkill_ops, arfkill);
 791
 792	if (!*rfkill)
 793		return -EINVAL;
 794
 
 
 
 
 795	rfkill_init_sw_state(*rfkill, !result);
 796	result = rfkill_register(*rfkill);
 797	if (result) {
 798		rfkill_destroy(*rfkill);
 799		*rfkill = NULL;
 800		return result;
 801	}
 802	return 0;
 803}
 804
 805static void asus_wmi_rfkill_exit(struct asus_wmi *asus)
 806{
 
 
 
 807	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
 808	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
 809	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
 810	if (asus->wlan.rfkill) {
 811		rfkill_unregister(asus->wlan.rfkill);
 812		rfkill_destroy(asus->wlan.rfkill);
 813		asus->wlan.rfkill = NULL;
 814	}
 815	/*
 816	 * Refresh pci hotplug in case the rfkill state was changed after
 817	 * asus_unregister_rfkill_notifier()
 818	 */
 819	asus_rfkill_hotplug(asus);
 820	if (asus->hotplug_slot)
 821		pci_hp_deregister(asus->hotplug_slot);
 822	if (asus->hotplug_workqueue)
 823		destroy_workqueue(asus->hotplug_workqueue);
 824
 825	if (asus->bluetooth.rfkill) {
 826		rfkill_unregister(asus->bluetooth.rfkill);
 827		rfkill_destroy(asus->bluetooth.rfkill);
 828		asus->bluetooth.rfkill = NULL;
 829	}
 830	if (asus->wimax.rfkill) {
 831		rfkill_unregister(asus->wimax.rfkill);
 832		rfkill_destroy(asus->wimax.rfkill);
 833		asus->wimax.rfkill = NULL;
 834	}
 835	if (asus->wwan3g.rfkill) {
 836		rfkill_unregister(asus->wwan3g.rfkill);
 837		rfkill_destroy(asus->wwan3g.rfkill);
 838		asus->wwan3g.rfkill = NULL;
 839	}
 840	if (asus->gps.rfkill) {
 841		rfkill_unregister(asus->gps.rfkill);
 842		rfkill_destroy(asus->gps.rfkill);
 843		asus->gps.rfkill = NULL;
 844	}
 845	if (asus->uwb.rfkill) {
 846		rfkill_unregister(asus->uwb.rfkill);
 847		rfkill_destroy(asus->uwb.rfkill);
 848		asus->uwb.rfkill = NULL;
 849	}
 850}
 851
 852static int asus_wmi_rfkill_init(struct asus_wmi *asus)
 853{
 854	int result = 0;
 855
 856	mutex_init(&asus->hotplug_lock);
 857	mutex_init(&asus->wmi_lock);
 858
 859	result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan",
 860				 RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN);
 861
 862	if (result && result != -ENODEV)
 863		goto exit;
 864
 865	result = asus_new_rfkill(asus, &asus->bluetooth,
 866				 "asus-bluetooth", RFKILL_TYPE_BLUETOOTH,
 867				 ASUS_WMI_DEVID_BLUETOOTH);
 868
 869	if (result && result != -ENODEV)
 870		goto exit;
 871
 872	result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax",
 873				 RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX);
 874
 875	if (result && result != -ENODEV)
 876		goto exit;
 877
 878	result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g",
 879				 RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G);
 880
 881	if (result && result != -ENODEV)
 882		goto exit;
 883
 884	result = asus_new_rfkill(asus, &asus->gps, "asus-gps",
 885				 RFKILL_TYPE_GPS, ASUS_WMI_DEVID_GPS);
 886
 887	if (result && result != -ENODEV)
 888		goto exit;
 889
 890	result = asus_new_rfkill(asus, &asus->uwb, "asus-uwb",
 891				 RFKILL_TYPE_UWB, ASUS_WMI_DEVID_UWB);
 892
 893	if (result && result != -ENODEV)
 894		goto exit;
 895
 896	if (!asus->driver->hotplug_wireless)
 897		goto exit;
 898
 899	result = asus_setup_pci_hotplug(asus);
 900	/*
 901	 * If we get -EBUSY then something else is handling the PCI hotplug -
 902	 * don't fail in this case
 903	 */
 904	if (result == -EBUSY)
 905		result = 0;
 906
 907	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
 908	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
 909	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
 910	/*
 911	 * Refresh pci hotplug in case the rfkill state was changed during
 912	 * setup.
 913	 */
 914	asus_rfkill_hotplug(asus);
 915
 916exit:
 917	if (result && result != -ENODEV)
 918		asus_wmi_rfkill_exit(asus);
 919
 920	if (result == -ENODEV)
 921		result = 0;
 922
 923	return result;
 924}
 925
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 926/*
 927 * Hwmon device
 
 928 */
 929static ssize_t asus_hwmon_pwm1(struct device *dev,
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 930			       struct device_attribute *attr,
 931			       char *buf)
 932{
 933	struct asus_wmi *asus = dev_get_drvdata(dev);
 934	u32 value;
 935	int err;
 
 936
 937	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
 
 
 938
 
 
 
 
 
 939	if (err < 0)
 940		return err;
 941
 942	value &= 0xFF;
 943
 944	if (value == 1) /* Low Speed */
 945		value = 85;
 946	else if (value == 2)
 947		value = 170;
 948	else if (value == 3)
 949		value = 255;
 950	else if (value != 0) {
 951		pr_err("Unknown fan speed %#x", value);
 952		value = -1;
 953	}
 954
 955	return sprintf(buf, "%d\n", value);
 956}
 957
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 958static ssize_t asus_hwmon_temp1(struct device *dev,
 959				struct device_attribute *attr,
 960				char *buf)
 961{
 962	struct asus_wmi *asus = dev_get_drvdata(dev);
 963	u32 value;
 964	int err;
 965
 966	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_THERMAL_CTRL, &value);
 967
 968	if (err < 0)
 969		return err;
 970
 971	value = KELVIN_TO_CELSIUS((value & 0xFFFF)) * 1000;
 972
 973	return sprintf(buf, "%d\n", value);
 974}
 975
 976static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO, asus_hwmon_pwm1, NULL, 0);
 977static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, asus_hwmon_temp1, NULL, 0);
 
 
 
 978
 979static ssize_t
 980show_name(struct device *dev, struct device_attribute *attr, char *buf)
 981{
 982	return sprintf(buf, "asus\n");
 983}
 984static SENSOR_DEVICE_ATTR(name, S_IRUGO, show_name, NULL, 0);
 985
 986static struct attribute *hwmon_attributes[] = {
 987	&sensor_dev_attr_pwm1.dev_attr.attr,
 988	&sensor_dev_attr_temp1_input.dev_attr.attr,
 989	&sensor_dev_attr_name.dev_attr.attr,
 
 
 
 990	NULL
 991};
 992
 993static mode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
 994					  struct attribute *attr, int idx)
 995{
 996	struct device *dev = container_of(kobj, struct device, kobj);
 997	struct platform_device *pdev = to_platform_device(dev->parent);
 998	struct asus_wmi *asus = platform_get_drvdata(pdev);
 999	bool ok = true;
1000	int dev_id = -1;
1001	u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
1002
1003	if (attr == &sensor_dev_attr_pwm1.dev_attr.attr)
1004		dev_id = ASUS_WMI_DEVID_FAN_CTRL;
1005	else if (attr == &sensor_dev_attr_temp1_input.dev_attr.attr)
1006		dev_id = ASUS_WMI_DEVID_THERMAL_CTRL;
1007
1008	if (dev_id != -1) {
1009		int err = asus_wmi_get_devstate(asus, dev_id, &value);
 
 
 
 
 
1010
1011		if (err < 0)
1012			return 0; /* can't return negative here */
1013	}
1014
1015	if (dev_id == ASUS_WMI_DEVID_FAN_CTRL) {
1016		/*
1017		 * We need to find a better way, probably using sfun,
1018		 * bits or spec ...
1019		 * Currently we disable it if:
1020		 * - ASUS_WMI_UNSUPPORTED_METHOD is returned
1021		 * - reverved bits are non-zero
1022		 * - sfun and presence bit are not set
1023		 */
1024		if (value == ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
1025		    || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)))
1026			ok = false;
1027	} else if (dev_id == ASUS_WMI_DEVID_THERMAL_CTRL) {
1028		/* If value is zero, something is clearly wrong */
1029		if (value == 0)
1030			ok = false;
1031	}
1032
1033	return ok ? attr->mode : 0;
1034}
1035
1036static struct attribute_group hwmon_attribute_group = {
1037	.is_visible = asus_hwmon_sysfs_is_visible,
1038	.attrs = hwmon_attributes
1039};
 
1040
1041static void asus_wmi_hwmon_exit(struct asus_wmi *asus)
1042{
 
1043	struct device *hwmon;
1044
1045	hwmon = asus->hwmon_device;
1046	if (!hwmon)
1047		return;
1048	sysfs_remove_group(&hwmon->kobj, &hwmon_attribute_group);
1049	hwmon_device_unregister(hwmon);
1050	asus->hwmon_device = NULL;
 
 
1051}
1052
1053static int asus_wmi_hwmon_init(struct asus_wmi *asus)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1054{
1055	struct device *hwmon;
1056	int result;
 
 
 
1057
1058	hwmon = hwmon_device_register(&asus->platform_device->dev);
1059	if (IS_ERR(hwmon)) {
1060		pr_err("Could not register asus hwmon device\n");
1061		return PTR_ERR(hwmon);
1062	}
1063	dev_set_drvdata(hwmon, asus);
1064	asus->hwmon_device = hwmon;
1065	result = sysfs_create_group(&hwmon->kobj, &hwmon_attribute_group);
1066	if (result)
1067		asus_wmi_hwmon_exit(asus);
1068	return result;
 
 
 
 
 
 
 
 
 
1069}
1070
1071/*
1072 * Backlight
1073 */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1074static int read_backlight_power(struct asus_wmi *asus)
1075{
1076	int ret = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_BACKLIGHT);
 
 
 
 
 
 
1077
1078	if (ret < 0)
1079		return ret;
1080
1081	return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
1082}
1083
1084static int read_brightness_max(struct asus_wmi *asus)
1085{
1086	u32 retval;
1087	int err;
1088
1089	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1090
1091	if (err < 0)
1092		return err;
1093
1094	retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
1095	retval >>= 8;
1096
1097	if (!retval)
1098		return -ENODEV;
1099
1100	return retval;
1101}
1102
1103static int read_brightness(struct backlight_device *bd)
1104{
1105	struct asus_wmi *asus = bl_get_data(bd);
1106	u32 retval;
1107	int err;
1108
1109	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1110
1111	if (err < 0)
1112		return err;
1113
1114	return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
1115}
1116
1117static int update_bl_status(struct backlight_device *bd)
1118{
1119	struct asus_wmi *asus = bl_get_data(bd);
1120	u32 ctrl_param;
1121	int power, err;
1122
1123	ctrl_param = bd->props.brightness;
 
 
 
 
 
1124
1125	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
1126				    ctrl_param, NULL);
1127
1128	if (err < 0)
1129		return err;
 
 
 
 
 
 
1130
1131	power = read_backlight_power(asus);
1132	if (power != -ENODEV && bd->props.power != power) {
1133		ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
1134		err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
1135					    ctrl_param, NULL);
 
 
 
 
 
 
 
1136	}
 
 
 
 
 
 
 
 
 
1137	return err;
1138}
1139
1140static const struct backlight_ops asus_wmi_bl_ops = {
1141	.get_brightness = read_brightness,
1142	.update_status = update_bl_status,
1143};
1144
1145static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
1146{
1147	struct backlight_device *bd = asus->backlight_device;
1148	int old = bd->props.brightness;
1149	int new = old;
1150
1151	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1152		new = code - NOTIFY_BRNUP_MIN + 1;
1153	else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
1154		new = code - NOTIFY_BRNDOWN_MIN;
1155
1156	bd->props.brightness = new;
1157	backlight_update_status(bd);
1158	backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1159
1160	return old;
1161}
1162
1163static int asus_wmi_backlight_init(struct asus_wmi *asus)
1164{
1165	struct backlight_device *bd;
1166	struct backlight_properties props;
1167	int max;
1168	int power;
1169
1170	max = read_brightness_max(asus);
1171
1172	if (max == -ENODEV)
1173		max = 0;
1174	else if (max < 0)
1175		return max;
1176
1177	power = read_backlight_power(asus);
1178
1179	if (power == -ENODEV)
1180		power = FB_BLANK_UNBLANK;
1181	else if (power < 0)
1182		return power;
1183
1184	memset(&props, 0, sizeof(struct backlight_properties));
1185	props.type = BACKLIGHT_PLATFORM;
1186	props.max_brightness = max;
1187	bd = backlight_device_register(asus->driver->name,
1188				       &asus->platform_device->dev, asus,
1189				       &asus_wmi_bl_ops, &props);
1190	if (IS_ERR(bd)) {
1191		pr_err("Could not register backlight device\n");
1192		return PTR_ERR(bd);
1193	}
1194
1195	asus->backlight_device = bd;
1196
 
 
 
1197	bd->props.brightness = read_brightness(bd);
1198	bd->props.power = power;
1199	backlight_update_status(bd);
1200
 
 
1201	return 0;
1202}
1203
1204static void asus_wmi_backlight_exit(struct asus_wmi *asus)
1205{
1206	if (asus->backlight_device)
1207		backlight_device_unregister(asus->backlight_device);
1208
1209	asus->backlight_device = NULL;
1210}
1211
1212static void asus_wmi_notify(u32 value, void *context)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1213{
1214	struct asus_wmi *asus = context;
1215	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
1216	union acpi_object *obj;
1217	acpi_status status;
1218	int code;
1219	int orig_code;
1220	unsigned int key_value = 1;
1221	bool autorelease = 1;
1222
1223	status = wmi_get_event_data(value, &response);
1224	if (status != AE_OK) {
1225		pr_err("bad event status 0x%x\n", status);
1226		return;
 
1227	}
1228
1229	obj = (union acpi_object *)response.pointer;
1230
1231	if (!obj || obj->type != ACPI_TYPE_INTEGER)
1232		goto exit;
 
 
 
 
 
 
 
 
 
 
 
 
1233
1234	code = obj->integer.value;
1235	orig_code = code;
1236
1237	if (asus->driver->key_filter) {
1238		asus->driver->key_filter(asus->driver, &code, &key_value,
1239					 &autorelease);
1240		if (code == ASUS_WMI_KEY_IGNORE)
1241			goto exit;
1242	}
1243
1244	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1245		code = NOTIFY_BRNUP_MIN;
1246	else if (code >= NOTIFY_BRNDOWN_MIN &&
1247		 code <= NOTIFY_BRNDOWN_MAX)
1248		code = NOTIFY_BRNDOWN_MIN;
1249
1250	if (code == NOTIFY_BRNUP_MIN || code == NOTIFY_BRNDOWN_MIN) {
1251		if (!acpi_video_backlight_support())
1252			asus_wmi_backlight_notify(asus, orig_code);
1253	} else if (!sparse_keymap_report_event(asus->inputdev, code,
1254					       key_value, autorelease))
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1255		pr_info("Unknown key %x pressed\n", code);
 
1256
1257exit:
1258	kfree(obj);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1259}
1260
1261/*
1262 * Sys helpers
1263 */
1264static int parse_arg(const char *buf, unsigned long count, int *val)
1265{
1266	if (!count)
1267		return 0;
1268	if (sscanf(buf, "%i", val) != 1)
1269		return -EINVAL;
1270	return count;
 
 
 
 
 
 
 
 
 
 
 
1271}
1272
 
 
1273static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
1274			     const char *buf, size_t count)
1275{
1276	u32 retval;
1277	int rv, err, value;
1278
1279	value = asus_wmi_get_devstate_simple(asus, devid);
1280	if (value == -ENODEV)	/* Check device presence */
1281		return value;
1282
1283	rv = parse_arg(buf, count, &value);
1284	err = asus_wmi_set_devstate(devid, value, &retval);
 
1285
 
1286	if (err < 0)
1287		return err;
1288
1289	return rv;
1290}
1291
1292static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
1293{
1294	int value = asus_wmi_get_devstate_simple(asus, devid);
1295
1296	if (value < 0)
1297		return value;
1298
1299	return sprintf(buf, "%d\n", value);
1300}
1301
1302#define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)			\
1303	static ssize_t show_##_name(struct device *dev,			\
1304				    struct device_attribute *attr,	\
1305				    char *buf)				\
1306	{								\
1307		struct asus_wmi *asus = dev_get_drvdata(dev);		\
1308									\
1309		return show_sys_wmi(asus, _cm, buf);			\
1310	}								\
1311	static ssize_t store_##_name(struct device *dev,		\
1312				     struct device_attribute *attr,	\
1313				     const char *buf, size_t count)	\
1314	{								\
1315		struct asus_wmi *asus = dev_get_drvdata(dev);		\
1316									\
1317		return store_sys_wmi(asus, _cm, buf, count);		\
1318	}								\
1319	static struct device_attribute dev_attr_##_name = {		\
1320		.attr = {						\
1321			.name = __stringify(_name),			\
1322			.mode = _mode },				\
1323		.show   = show_##_name,					\
1324		.store  = store_##_name,				\
1325	}
1326
1327ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
1328ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
1329ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
 
 
1330
1331static ssize_t store_cpufv(struct device *dev, struct device_attribute *attr,
1332			   const char *buf, size_t count)
1333{
1334	int value, rv;
1335
1336	if (!count || sscanf(buf, "%i", &value) != 1)
1337		return -EINVAL;
 
 
1338	if (value < 0 || value > 2)
1339		return -EINVAL;
1340
1341	rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
1342	if (rv < 0)
1343		return rv;
1344
1345	return count;
1346}
1347
1348static DEVICE_ATTR(cpufv, S_IRUGO | S_IWUSR, NULL, store_cpufv);
1349
1350static struct attribute *platform_attributes[] = {
1351	&dev_attr_cpufv.attr,
1352	&dev_attr_camera.attr,
1353	&dev_attr_cardr.attr,
1354	&dev_attr_touchpad.attr,
 
 
 
 
1355	NULL
1356};
1357
1358static mode_t asus_sysfs_is_visible(struct kobject *kobj,
1359				    struct attribute *attr, int idx)
1360{
1361	struct device *dev = container_of(kobj, struct device, kobj);
1362	struct platform_device *pdev = to_platform_device(dev);
1363	struct asus_wmi *asus = platform_get_drvdata(pdev);
1364	bool ok = true;
1365	int devid = -1;
1366
1367	if (attr == &dev_attr_camera.attr)
1368		devid = ASUS_WMI_DEVID_CAMERA;
1369	else if (attr == &dev_attr_cardr.attr)
1370		devid = ASUS_WMI_DEVID_CARDREADER;
1371	else if (attr == &dev_attr_touchpad.attr)
1372		devid = ASUS_WMI_DEVID_TOUCHPAD;
 
 
 
 
 
 
 
 
1373
1374	if (devid != -1)
1375		ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
1376
1377	return ok ? attr->mode : 0;
1378}
1379
1380static struct attribute_group platform_attribute_group = {
1381	.is_visible = asus_sysfs_is_visible,
1382	.attrs = platform_attributes
1383};
1384
1385static void asus_wmi_sysfs_exit(struct platform_device *device)
1386{
1387	sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1388}
1389
1390static int asus_wmi_sysfs_init(struct platform_device *device)
1391{
1392	return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1393}
1394
1395/*
1396 * Platform device
1397 */
1398static int asus_wmi_platform_init(struct asus_wmi *asus)
1399{
 
 
1400	int rv;
1401
1402	/* INIT enable hotkeys on some models */
1403	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
1404		pr_info("Initialization: %#x", rv);
1405
1406	/* We don't know yet what to do with this version... */
1407	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
1408		pr_info("BIOS WMI version: %d.%d", rv >> 16, rv & 0xFF);
1409		asus->spec = rv;
1410	}
1411
1412	/*
1413	 * The SFUN method probably allows the original driver to get the list
1414	 * of features supported by a given model. For now, 0x0100 or 0x0800
1415	 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
1416	 * The significance of others is yet to be found.
1417	 */
1418	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
1419		pr_info("SFUN value: %#x", rv);
1420		asus->sfun = rv;
1421	}
1422
1423	/*
1424	 * Eee PC and Notebooks seems to have different method_id for DSTS,
1425	 * but it may also be related to the BIOS's SPEC.
1426	 * Note, on most Eeepc, there is no way to check if a method exist
1427	 * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
1428	 * but once again, SPEC may probably be used for that kind of things.
 
 
 
 
 
 
1429	 */
1430	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL))
 
 
 
 
 
 
 
 
1431		asus->dsts_id = ASUS_WMI_METHODID_DSTS;
1432	else if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS2, 0, 0, NULL))
1433		asus->dsts_id = ASUS_WMI_METHODID_DSTS2;
1434
1435	if (!asus->dsts_id) {
1436		pr_err("Can't find DSTS");
1437		return -ENODEV;
 
 
 
 
 
 
 
 
 
 
 
 
1438	}
1439
1440	/* CWAP allow to define the behavior of the Fn+F2 key,
1441	 * this method doesn't seems to be present on Eee PCs */
1442	if (asus->driver->wapf >= 0)
1443		asus_wmi_set_devstate(ASUS_WMI_DEVID_CWAP,
1444				      asus->driver->wapf, NULL);
1445
1446	return asus_wmi_sysfs_init(asus->platform_device);
1447}
1448
1449static void asus_wmi_platform_exit(struct asus_wmi *asus)
1450{
1451	asus_wmi_sysfs_exit(asus->platform_device);
1452}
1453
1454/*
1455 * debugfs
1456 */
1457struct asus_wmi_debugfs_node {
1458	struct asus_wmi *asus;
1459	char *name;
1460	int (*show) (struct seq_file *m, void *data);
1461};
1462
1463static int show_dsts(struct seq_file *m, void *data)
1464{
1465	struct asus_wmi *asus = m->private;
1466	int err;
1467	u32 retval = -1;
1468
1469	err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
1470
1471	if (err < 0)
1472		return err;
1473
1474	seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
1475
1476	return 0;
1477}
1478
1479static int show_devs(struct seq_file *m, void *data)
1480{
1481	struct asus_wmi *asus = m->private;
1482	int err;
1483	u32 retval = -1;
1484
1485	err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
1486				    &retval);
1487
1488	if (err < 0)
1489		return err;
1490
1491	seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
1492		   asus->debug.ctrl_param, retval);
1493
1494	return 0;
1495}
1496
1497static int show_call(struct seq_file *m, void *data)
1498{
1499	struct asus_wmi *asus = m->private;
1500	struct bios_args args = {
1501		.arg0 = asus->debug.dev_id,
1502		.arg1 = asus->debug.ctrl_param,
1503	};
1504	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1505	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
1506	union acpi_object *obj;
1507	acpi_status status;
1508
1509	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
1510				     1, asus->debug.method_id,
1511				     &input, &output);
1512
1513	if (ACPI_FAILURE(status))
1514		return -EIO;
1515
1516	obj = (union acpi_object *)output.pointer;
1517	if (obj && obj->type == ACPI_TYPE_INTEGER)
1518		seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
1519			   asus->debug.dev_id, asus->debug.ctrl_param,
1520			   (u32) obj->integer.value);
1521	else
1522		seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
1523			   asus->debug.dev_id, asus->debug.ctrl_param,
1524			   obj ? obj->type : -1);
1525
1526	kfree(obj);
1527
1528	return 0;
1529}
1530
1531static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
1532	{NULL, "devs", show_devs},
1533	{NULL, "dsts", show_dsts},
1534	{NULL, "call", show_call},
1535};
1536
1537static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
1538{
1539	struct asus_wmi_debugfs_node *node = inode->i_private;
1540
1541	return single_open(file, node->show, node->asus);
1542}
1543
1544static const struct file_operations asus_wmi_debugfs_io_ops = {
1545	.owner = THIS_MODULE,
1546	.open = asus_wmi_debugfs_open,
1547	.read = seq_read,
1548	.llseek = seq_lseek,
1549	.release = single_release,
1550};
1551
1552static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
1553{
1554	debugfs_remove_recursive(asus->debug.root);
1555}
1556
1557static int asus_wmi_debugfs_init(struct asus_wmi *asus)
1558{
1559	struct dentry *dent;
1560	int i;
1561
1562	asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
1563	if (!asus->debug.root) {
1564		pr_err("failed to create debugfs directory");
1565		goto error_debugfs;
1566	}
1567
1568	dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR,
1569				  asus->debug.root, &asus->debug.method_id);
1570	if (!dent)
1571		goto error_debugfs;
1572
1573	dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR,
1574				  asus->debug.root, &asus->debug.dev_id);
1575	if (!dent)
1576		goto error_debugfs;
1577
1578	dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR,
1579				  asus->debug.root, &asus->debug.ctrl_param);
1580	if (!dent)
1581		goto error_debugfs;
1582
1583	for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
1584		struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
1585
1586		node->asus = asus;
1587		dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO,
1588					   asus->debug.root, node,
1589					   &asus_wmi_debugfs_io_ops);
1590		if (!dent) {
1591			pr_err("failed to create debug file: %s\n", node->name);
1592			goto error_debugfs;
1593		}
1594	}
1595
1596	return 0;
1597
1598error_debugfs:
1599	asus_wmi_debugfs_exit(asus);
1600	return -ENOMEM;
1601}
1602
1603/*
1604 * WMI Driver
1605 */
1606static int asus_wmi_add(struct platform_device *pdev)
1607{
1608	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1609	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1610	struct asus_wmi *asus;
 
1611	acpi_status status;
1612	int err;
 
1613
1614	asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
1615	if (!asus)
1616		return -ENOMEM;
1617
1618	asus->driver = wdrv;
1619	asus->platform_device = pdev;
1620	wdrv->platform_device = pdev;
1621	platform_set_drvdata(asus->platform_device, asus);
1622
1623	if (wdrv->quirks)
1624		wdrv->quirks(asus->driver);
1625
1626	err = asus_wmi_platform_init(asus);
1627	if (err)
1628		goto fail_platform;
1629
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1630	err = asus_wmi_input_init(asus);
1631	if (err)
1632		goto fail_input;
1633
 
 
1634	err = asus_wmi_hwmon_init(asus);
1635	if (err)
1636		goto fail_hwmon;
1637
1638	err = asus_wmi_led_init(asus);
1639	if (err)
1640		goto fail_leds;
1641
1642	err = asus_wmi_rfkill_init(asus);
1643	if (err)
1644		goto fail_rfkill;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1645
1646	if (!acpi_video_backlight_support()) {
1647		err = asus_wmi_backlight_init(asus);
1648		if (err && err != -ENODEV)
1649			goto fail_backlight;
1650	} else
1651		pr_info("Backlight controlled by ACPI video driver\n");
 
 
 
 
 
1652
1653	status = wmi_install_notify_handler(asus->driver->event_guid,
1654					    asus_wmi_notify, asus);
1655	if (ACPI_FAILURE(status)) {
1656		pr_err("Unable to register notify handler - %d\n", status);
1657		err = -ENODEV;
1658		goto fail_wmi_handler;
1659	}
1660
1661	err = asus_wmi_debugfs_init(asus);
1662	if (err)
1663		goto fail_debugfs;
1664
1665	return 0;
1666
1667fail_debugfs:
1668	wmi_remove_notify_handler(asus->driver->event_guid);
1669fail_wmi_handler:
1670	asus_wmi_backlight_exit(asus);
1671fail_backlight:
1672	asus_wmi_rfkill_exit(asus);
1673fail_rfkill:
1674	asus_wmi_led_exit(asus);
1675fail_leds:
1676	asus_wmi_hwmon_exit(asus);
1677fail_hwmon:
1678	asus_wmi_input_exit(asus);
1679fail_input:
1680	asus_wmi_platform_exit(asus);
 
 
 
1681fail_platform:
1682	kfree(asus);
1683	return err;
1684}
1685
1686static int asus_wmi_remove(struct platform_device *device)
1687{
1688	struct asus_wmi *asus;
1689
1690	asus = platform_get_drvdata(device);
1691	wmi_remove_notify_handler(asus->driver->event_guid);
1692	asus_wmi_backlight_exit(asus);
1693	asus_wmi_input_exit(asus);
1694	asus_wmi_hwmon_exit(asus);
1695	asus_wmi_led_exit(asus);
1696	asus_wmi_rfkill_exit(asus);
1697	asus_wmi_debugfs_exit(asus);
1698	asus_wmi_platform_exit(asus);
 
 
1699
1700	kfree(asus);
1701	return 0;
1702}
1703
1704/*
1705 * Platform driver - hibernate/resume callbacks
1706 */
1707static int asus_hotk_thaw(struct device *device)
1708{
1709	struct asus_wmi *asus = dev_get_drvdata(device);
1710
1711	if (asus->wlan.rfkill) {
1712		bool wlan;
1713
1714		/*
1715		 * Work around bios bug - acpi _PTS turns off the wireless led
1716		 * during suspend.  Normally it restores it on resume, but
1717		 * we should kick it ourselves in case hibernation is aborted.
1718		 */
1719		wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
1720		asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
1721	}
1722
1723	return 0;
1724}
1725
 
 
 
 
 
 
 
 
 
 
 
 
1726static int asus_hotk_restore(struct device *device)
1727{
1728	struct asus_wmi *asus = dev_get_drvdata(device);
1729	int bl;
1730
1731	/* Refresh both wlan rfkill state and pci hotplug */
1732	if (asus->wlan.rfkill)
1733		asus_rfkill_hotplug(asus);
1734
1735	if (asus->bluetooth.rfkill) {
1736		bl = !asus_wmi_get_devstate_simple(asus,
1737						   ASUS_WMI_DEVID_BLUETOOTH);
1738		rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
1739	}
1740	if (asus->wimax.rfkill) {
1741		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
1742		rfkill_set_sw_state(asus->wimax.rfkill, bl);
1743	}
1744	if (asus->wwan3g.rfkill) {
1745		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
1746		rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
1747	}
1748	if (asus->gps.rfkill) {
1749		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_GPS);
1750		rfkill_set_sw_state(asus->gps.rfkill, bl);
1751	}
1752	if (asus->uwb.rfkill) {
1753		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_UWB);
1754		rfkill_set_sw_state(asus->uwb.rfkill, bl);
1755	}
 
 
1756
 
 
1757	return 0;
1758}
1759
1760static const struct dev_pm_ops asus_pm_ops = {
1761	.thaw = asus_hotk_thaw,
1762	.restore = asus_hotk_restore,
 
1763};
1764
 
 
1765static int asus_wmi_probe(struct platform_device *pdev)
1766{
1767	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1768	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1769	int ret;
1770
1771	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1772		pr_warn("Management GUID not found\n");
1773		return -ENODEV;
1774	}
1775
1776	if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
1777		pr_warn("Event GUID not found\n");
1778		return -ENODEV;
1779	}
1780
1781	if (wdrv->probe) {
1782		ret = wdrv->probe(pdev);
1783		if (ret)
1784			return ret;
1785	}
1786
1787	return asus_wmi_add(pdev);
1788}
1789
1790static bool used;
1791
1792int __init_or_module asus_wmi_register_driver(struct asus_wmi_driver *driver)
1793{
1794	struct platform_driver *platform_driver;
1795	struct platform_device *platform_device;
1796
1797	if (used)
1798		return -EBUSY;
1799
1800	platform_driver = &driver->platform_driver;
1801	platform_driver->remove = asus_wmi_remove;
1802	platform_driver->driver.owner = driver->owner;
1803	platform_driver->driver.name = driver->name;
1804	platform_driver->driver.pm = &asus_pm_ops;
1805
1806	platform_device = platform_create_bundle(platform_driver,
1807						 asus_wmi_probe,
1808						 NULL, 0, NULL, 0);
1809	if (IS_ERR(platform_device))
1810		return PTR_ERR(platform_device);
1811
1812	used = true;
1813	return 0;
1814}
1815EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
1816
1817void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
1818{
1819	platform_device_unregister(driver->platform_device);
1820	platform_driver_unregister(&driver->platform_driver);
1821	used = false;
1822}
1823EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
1824
1825static int __init asus_wmi_init(void)
1826{
1827	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1828		pr_info("Asus Management GUID not found");
1829		return -ENODEV;
1830	}
1831
1832	pr_info("ASUS WMI generic driver loaded");
1833	return 0;
1834}
1835
1836static void __exit asus_wmi_exit(void)
1837{
1838	pr_info("ASUS WMI generic driver unloaded");
1839}
1840
1841module_init(asus_wmi_init);
1842module_exit(asus_wmi_exit);
v5.9
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 * Asus PC WMI hotkey driver
   4 *
   5 * Copyright(C) 2010 Intel Corporation.
   6 * Copyright(C) 2010-2011 Corentin Chary <corentin.chary@gmail.com>
   7 *
   8 * Portions based on wistron_btns.c:
   9 * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
  10 * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
  11 * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  12 */
  13
  14#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  15
  16#include <linux/kernel.h>
  17#include <linux/module.h>
  18#include <linux/init.h>
  19#include <linux/types.h>
  20#include <linux/slab.h>
  21#include <linux/input.h>
  22#include <linux/input/sparse-keymap.h>
  23#include <linux/fb.h>
  24#include <linux/backlight.h>
  25#include <linux/leds.h>
  26#include <linux/rfkill.h>
  27#include <linux/pci.h>
  28#include <linux/pci_hotplug.h>
  29#include <linux/power_supply.h>
  30#include <linux/hwmon.h>
  31#include <linux/hwmon-sysfs.h>
  32#include <linux/debugfs.h>
  33#include <linux/seq_file.h>
  34#include <linux/platform_data/x86/asus-wmi.h>
  35#include <linux/platform_device.h>
  36#include <linux/acpi.h>
  37#include <linux/dmi.h>
  38#include <linux/units.h>
  39
  40#include <acpi/battery.h>
  41#include <acpi/video.h>
  42
  43#include "asus-wmi.h"
  44
  45MODULE_AUTHOR("Corentin Chary <corentin.chary@gmail.com>, "
  46	      "Yong Wang <yong.y.wang@intel.com>");
  47MODULE_DESCRIPTION("Asus Generic WMI Driver");
  48MODULE_LICENSE("GPL");
  49
 
 
 
  50#define to_asus_wmi_driver(pdrv)					\
  51	(container_of((pdrv), struct asus_wmi_driver, platform_driver))
  52
  53#define ASUS_WMI_MGMT_GUID	"97845ED0-4E6D-11DE-8A39-0800200C9A66"
  54
  55#define NOTIFY_BRNUP_MIN		0x11
  56#define NOTIFY_BRNUP_MAX		0x1f
  57#define NOTIFY_BRNDOWN_MIN		0x20
  58#define NOTIFY_BRNDOWN_MAX		0x2e
  59#define NOTIFY_FNLOCK_TOGGLE		0x4e
  60#define NOTIFY_KBD_DOCK_CHANGE		0x75
  61#define NOTIFY_KBD_BRTUP		0xc4
  62#define NOTIFY_KBD_BRTDWN		0xc5
  63#define NOTIFY_KBD_BRTTOGGLE		0xc7
  64#define NOTIFY_KBD_FBM			0x99
  65#define NOTIFY_KBD_TTP			0xae
  66
  67#define ASUS_WMI_FNLOCK_BIOS_DISABLED	BIT(0)
  68
  69#define ASUS_FAN_DESC			"cpu_fan"
  70#define ASUS_FAN_MFUN			0x13
  71#define ASUS_FAN_SFUN_READ		0x06
  72#define ASUS_FAN_SFUN_WRITE		0x07
  73
  74/* Based on standard hwmon pwmX_enable values */
  75#define ASUS_FAN_CTRL_FULLSPEED		0
  76#define ASUS_FAN_CTRL_MANUAL		1
  77#define ASUS_FAN_CTRL_AUTO		2
  78
  79#define ASUS_FAN_BOOST_MODE_NORMAL		0
  80#define ASUS_FAN_BOOST_MODE_OVERBOOST		1
  81#define ASUS_FAN_BOOST_MODE_OVERBOOST_MASK	0x01
  82#define ASUS_FAN_BOOST_MODE_SILENT		2
  83#define ASUS_FAN_BOOST_MODE_SILENT_MASK		0x02
  84#define ASUS_FAN_BOOST_MODES_MASK		0x03
  85
  86#define ASUS_THROTTLE_THERMAL_POLICY_DEFAULT	0
  87#define ASUS_THROTTLE_THERMAL_POLICY_OVERBOOST	1
  88#define ASUS_THROTTLE_THERMAL_POLICY_SILENT	2
  89
  90#define USB_INTEL_XUSB2PR		0xD0
  91#define PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI	0x9c31
  92
  93#define ASUS_ACPI_UID_ASUSWMI		"ASUSWMI"
  94#define ASUS_ACPI_UID_ATK		"ATK"
  95
  96#define WMI_EVENT_QUEUE_SIZE		0x10
  97#define WMI_EVENT_QUEUE_END		0x1
  98#define WMI_EVENT_MASK			0xFFFF
  99/* The WMI hotkey event value is always the same. */
 100#define WMI_EVENT_VALUE_ATK		0xFF
 101
 102#define WMI_EVENT_MASK			0xFFFF
 103
 104static const char * const ashs_ids[] = { "ATK4001", "ATK4002", NULL };
 105
 106static bool ashs_present(void)
 107{
 108	int i = 0;
 109	while (ashs_ids[i]) {
 110		if (acpi_dev_found(ashs_ids[i++]))
 111			return true;
 112	}
 113	return false;
 114}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 115
 116struct bios_args {
 117	u32 arg0;
 118	u32 arg1;
 119	u32 arg2; /* At least TUF Gaming series uses 3 dword input buffer. */
 120	u32 arg4;
 121	u32 arg5;
 122} __packed;
 123
 124/*
 125 * Struct that's used for all methods called via AGFN. Naming is
 126 * identically to the AML code.
 127 */
 128struct agfn_args {
 129	u16 mfun; /* probably "Multi-function" to be called */
 130	u16 sfun; /* probably "Sub-function" to be called */
 131	u16 len;  /* size of the hole struct, including subfunction fields */
 132	u8 stas;  /* not used by now */
 133	u8 err;   /* zero on success */
 134} __packed;
 135
 136/* struct used for calling fan read and write methods */
 137struct agfn_fan_args {
 138	struct agfn_args agfn;	/* common fields */
 139	u8 fan;			/* fan number: 0: set auto mode 1: 1st fan */
 140	u32 speed;		/* read: RPM/100 - write: 0-255 */
 141} __packed;
 142
 143/*
 144 * <platform>/    - debugfs root directory
 145 *   dev_id      - current dev_id
 146 *   ctrl_param  - current ctrl_param
 147 *   method_id   - current method_id
 148 *   devs        - call DEVS(dev_id, ctrl_param) and print result
 149 *   dsts        - call DSTS(dev_id)  and print result
 150 *   call        - call method_id(dev_id, ctrl_param) and print result
 151 */
 152struct asus_wmi_debug {
 153	struct dentry *root;
 154	u32 method_id;
 155	u32 dev_id;
 156	u32 ctrl_param;
 157};
 158
 159struct asus_rfkill {
 160	struct asus_wmi *asus;
 161	struct rfkill *rfkill;
 162	u32 dev_id;
 163};
 164
 165enum fan_type {
 166	FAN_TYPE_NONE = 0,
 167	FAN_TYPE_AGFN,		/* deprecated on newer platforms */
 168	FAN_TYPE_SPEC83,	/* starting in Spec 8.3, use CPU_FAN_CTRL */
 169};
 170
 171struct asus_wmi {
 172	int dsts_id;
 173	int spec;
 174	int sfun;
 175	bool wmi_event_queue;
 176
 177	struct input_dev *inputdev;
 178	struct backlight_device *backlight_device;
 
 179	struct platform_device *platform_device;
 180
 181	struct led_classdev wlan_led;
 182	int wlan_led_wk;
 183	struct led_classdev tpd_led;
 184	int tpd_led_wk;
 185	struct led_classdev kbd_led;
 186	int kbd_led_wk;
 187	struct led_classdev lightbar_led;
 188	int lightbar_led_wk;
 189	struct workqueue_struct *led_workqueue;
 190	struct work_struct tpd_led_work;
 191	struct work_struct wlan_led_work;
 192	struct work_struct lightbar_led_work;
 193
 194	struct asus_rfkill wlan;
 195	struct asus_rfkill bluetooth;
 196	struct asus_rfkill wimax;
 197	struct asus_rfkill wwan3g;
 198	struct asus_rfkill gps;
 199	struct asus_rfkill uwb;
 200
 201	enum fan_type fan_type;
 202	int fan_pwm_mode;
 203	int agfn_pwm;
 204
 205	bool fan_boost_mode_available;
 206	u8 fan_boost_mode_mask;
 207	u8 fan_boost_mode;
 208
 209	bool throttle_thermal_policy_available;
 210	u8 throttle_thermal_policy_mode;
 211
 212	// The RSOC controls the maximum charging percentage.
 213	bool battery_rsoc_available;
 214
 215	struct hotplug_slot hotplug_slot;
 216	struct mutex hotplug_lock;
 217	struct mutex wmi_lock;
 218	struct workqueue_struct *hotplug_workqueue;
 219	struct work_struct hotplug_work;
 220
 221	bool fnlock_locked;
 222
 223	struct asus_wmi_debug debug;
 224
 225	struct asus_wmi_driver *driver;
 226};
 227
 228/* WMI ************************************************************************/
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 229
 230static int asus_wmi_evaluate_method3(u32 method_id,
 231		u32 arg0, u32 arg1, u32 arg2, u32 *retval)
 
 
 
 
 
 
 
 
 
 
 232{
 233	struct bios_args args = {
 234		.arg0 = arg0,
 235		.arg1 = arg1,
 236		.arg2 = arg2,
 237	};
 238	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
 239	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
 240	acpi_status status;
 241	union acpi_object *obj;
 242	u32 tmp = 0;
 243
 244	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 0, method_id,
 245				     &input, &output);
 246
 247	if (ACPI_FAILURE(status))
 248		return -EIO;
 249
 250	obj = (union acpi_object *)output.pointer;
 251	if (obj && obj->type == ACPI_TYPE_INTEGER)
 252		tmp = (u32) obj->integer.value;
 
 
 253
 254	if (retval)
 255		*retval = tmp;
 256
 257	kfree(obj);
 258
 
 
 
 
 259	if (tmp == ASUS_WMI_UNSUPPORTED_METHOD)
 260		return -ENODEV;
 261
 262	return 0;
 263}
 264
 265int asus_wmi_evaluate_method(u32 method_id, u32 arg0, u32 arg1, u32 *retval)
 266{
 267	return asus_wmi_evaluate_method3(method_id, arg0, arg1, 0, retval);
 268}
 269EXPORT_SYMBOL_GPL(asus_wmi_evaluate_method);
 270
 271static int asus_wmi_evaluate_method_agfn(const struct acpi_buffer args)
 272{
 273	struct acpi_buffer input;
 274	u64 phys_addr;
 275	u32 retval;
 276	u32 status;
 277
 278	/*
 279	 * Copy to dma capable address otherwise memory corruption occurs as
 280	 * bios has to be able to access it.
 281	 */
 282	input.pointer = kmemdup(args.pointer, args.length, GFP_DMA | GFP_KERNEL);
 283	input.length = args.length;
 284	if (!input.pointer)
 285		return -ENOMEM;
 286	phys_addr = virt_to_phys(input.pointer);
 287
 288	status = asus_wmi_evaluate_method(ASUS_WMI_METHODID_AGFN,
 289					phys_addr, 0, &retval);
 290	if (!status)
 291		memcpy(args.pointer, input.pointer, args.length);
 292
 293	kfree(input.pointer);
 294	if (status)
 295		return -ENXIO;
 296
 297	return retval;
 298}
 299
 300static int asus_wmi_get_devstate(struct asus_wmi *asus, u32 dev_id, u32 *retval)
 301{
 302	return asus_wmi_evaluate_method(asus->dsts_id, dev_id, 0, retval);
 303}
 304
 305static int asus_wmi_set_devstate(u32 dev_id, u32 ctrl_param,
 306				 u32 *retval)
 307{
 308	return asus_wmi_evaluate_method(ASUS_WMI_METHODID_DEVS, dev_id,
 309					ctrl_param, retval);
 310}
 311
 312/* Helper for special devices with magic return codes */
 313static int asus_wmi_get_devstate_bits(struct asus_wmi *asus,
 314				      u32 dev_id, u32 mask)
 315{
 316	u32 retval = 0;
 317	int err;
 318
 319	err = asus_wmi_get_devstate(asus, dev_id, &retval);
 
 320	if (err < 0)
 321		return err;
 322
 323	if (!(retval & ASUS_WMI_DSTS_PRESENCE_BIT))
 324		return -ENODEV;
 325
 326	if (mask == ASUS_WMI_DSTS_STATUS_BIT) {
 327		if (retval & ASUS_WMI_DSTS_UNKNOWN_BIT)
 328			return -ENODEV;
 329	}
 330
 331	return retval & mask;
 332}
 333
 334static int asus_wmi_get_devstate_simple(struct asus_wmi *asus, u32 dev_id)
 335{
 336	return asus_wmi_get_devstate_bits(asus, dev_id,
 337					  ASUS_WMI_DSTS_STATUS_BIT);
 338}
 339
 340static bool asus_wmi_dev_is_present(struct asus_wmi *asus, u32 dev_id)
 341{
 342	u32 retval;
 343	int status = asus_wmi_get_devstate(asus, dev_id, &retval);
 344
 345	return status == 0 && (retval & ASUS_WMI_DSTS_PRESENCE_BIT);
 346}
 347
 348/* Input **********************************************************************/
 349
 350static int asus_wmi_input_init(struct asus_wmi *asus)
 351{
 352	int err, result;
 353
 354	asus->inputdev = input_allocate_device();
 355	if (!asus->inputdev)
 356		return -ENOMEM;
 357
 358	asus->inputdev->name = asus->driver->input_name;
 359	asus->inputdev->phys = asus->driver->input_phys;
 360	asus->inputdev->id.bustype = BUS_HOST;
 361	asus->inputdev->dev.parent = &asus->platform_device->dev;
 362	set_bit(EV_REP, asus->inputdev->evbit);
 363
 364	err = sparse_keymap_setup(asus->inputdev, asus->driver->keymap, NULL);
 365	if (err)
 366		goto err_free_dev;
 367
 368	if (asus->driver->quirks->use_kbd_dock_devid) {
 369		result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_KBD_DOCK);
 370		if (result >= 0) {
 371			input_set_capability(asus->inputdev, EV_SW, SW_TABLET_MODE);
 372			input_report_switch(asus->inputdev, SW_TABLET_MODE, !result);
 373		} else if (result != -ENODEV) {
 374			pr_err("Error checking for keyboard-dock: %d\n", result);
 375		}
 376	}
 377
 378	err = input_register_device(asus->inputdev);
 379	if (err)
 380		goto err_free_dev;
 381
 382	return 0;
 383
 384err_free_dev:
 385	input_free_device(asus->inputdev);
 386	return err;
 387}
 388
 389static void asus_wmi_input_exit(struct asus_wmi *asus)
 390{
 391	if (asus->inputdev)
 392		input_unregister_device(asus->inputdev);
 393
 394	asus->inputdev = NULL;
 395}
 396
 397/* Battery ********************************************************************/
 398
 399/* The battery maximum charging percentage */
 400static int charge_end_threshold;
 401
 402static ssize_t charge_control_end_threshold_store(struct device *dev,
 403						  struct device_attribute *attr,
 404						  const char *buf, size_t count)
 405{
 406	int value, ret, rv;
 407
 408	ret = kstrtouint(buf, 10, &value);
 409	if (ret)
 410		return ret;
 411
 412	if (value < 0 || value > 100)
 413		return -EINVAL;
 414
 415	ret = asus_wmi_set_devstate(ASUS_WMI_DEVID_RSOC, value, &rv);
 416	if (ret)
 417		return ret;
 418
 419	if (rv != 1)
 420		return -EIO;
 421
 422	/* There isn't any method in the DSDT to read the threshold, so we
 423	 * save the threshold.
 424	 */
 425	charge_end_threshold = value;
 426	return count;
 427}
 428
 429static ssize_t charge_control_end_threshold_show(struct device *device,
 430						 struct device_attribute *attr,
 431						 char *buf)
 432{
 433	return sprintf(buf, "%d\n", charge_end_threshold);
 434}
 435
 436static DEVICE_ATTR_RW(charge_control_end_threshold);
 437
 438static int asus_wmi_battery_add(struct power_supply *battery)
 439{
 440	/* The WMI method does not provide a way to specific a battery, so we
 441	 * just assume it is the first battery.
 442	 * Note: On some newer ASUS laptops (Zenbook UM431DA), the primary/first
 443	 * battery is named BATT.
 444	 */
 445	if (strcmp(battery->desc->name, "BAT0") != 0 &&
 446	    strcmp(battery->desc->name, "BAT1") != 0 &&
 447	    strcmp(battery->desc->name, "BATC") != 0 &&
 448	    strcmp(battery->desc->name, "BATT") != 0)
 449		return -ENODEV;
 450
 451	if (device_create_file(&battery->dev,
 452	    &dev_attr_charge_control_end_threshold))
 453		return -ENODEV;
 454
 455	/* The charge threshold is only reset when the system is power cycled,
 456	 * and we can't get the current threshold so let set it to 100% when
 457	 * a battery is added.
 458	 */
 459	asus_wmi_set_devstate(ASUS_WMI_DEVID_RSOC, 100, NULL);
 460	charge_end_threshold = 100;
 461
 462	return 0;
 463}
 464
 465static int asus_wmi_battery_remove(struct power_supply *battery)
 466{
 467	device_remove_file(&battery->dev,
 468			   &dev_attr_charge_control_end_threshold);
 469	return 0;
 470}
 471
 472static struct acpi_battery_hook battery_hook = {
 473	.add_battery = asus_wmi_battery_add,
 474	.remove_battery = asus_wmi_battery_remove,
 475	.name = "ASUS Battery Extension",
 476};
 477
 478static void asus_wmi_battery_init(struct asus_wmi *asus)
 479{
 480	asus->battery_rsoc_available = false;
 481	if (asus_wmi_dev_is_present(asus, ASUS_WMI_DEVID_RSOC)) {
 482		asus->battery_rsoc_available = true;
 483		battery_hook_register(&battery_hook);
 484	}
 485}
 486
 487static void asus_wmi_battery_exit(struct asus_wmi *asus)
 488{
 489	if (asus->battery_rsoc_available)
 490		battery_hook_unregister(&battery_hook);
 491}
 492
 493/* LEDs ***********************************************************************/
 494
 495/*
 496 * These functions actually update the LED's, and are called from a
 497 * workqueue. By doing this as separate work rather than when the LED
 498 * subsystem asks, we avoid messing with the Asus ACPI stuff during a
 499 * potentially bad time, such as a timer interrupt.
 500 */
 501static void tpd_led_update(struct work_struct *work)
 502{
 503	int ctrl_param;
 504	struct asus_wmi *asus;
 505
 506	asus = container_of(work, struct asus_wmi, tpd_led_work);
 507
 508	ctrl_param = asus->tpd_led_wk;
 509	asus_wmi_set_devstate(ASUS_WMI_DEVID_TOUCHPAD_LED, ctrl_param, NULL);
 510}
 511
 512static void tpd_led_set(struct led_classdev *led_cdev,
 513			enum led_brightness value)
 514{
 515	struct asus_wmi *asus;
 516
 517	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 518
 519	asus->tpd_led_wk = !!value;
 520	queue_work(asus->led_workqueue, &asus->tpd_led_work);
 521}
 522
 523static int read_tpd_led_state(struct asus_wmi *asus)
 524{
 525	return asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_TOUCHPAD_LED);
 526}
 527
 528static enum led_brightness tpd_led_get(struct led_classdev *led_cdev)
 529{
 530	struct asus_wmi *asus;
 531
 532	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 533
 534	return read_tpd_led_state(asus);
 535}
 536
 537static void kbd_led_update(struct asus_wmi *asus)
 538{
 539	int ctrl_param = 0;
 
 
 
 
 
 
 
 
 
 
 540
 541	ctrl_param = 0x80 | (asus->kbd_led_wk & 0x7F);
 542	asus_wmi_set_devstate(ASUS_WMI_DEVID_KBD_BACKLIGHT, ctrl_param, NULL);
 543}
 544
 545static int kbd_led_read(struct asus_wmi *asus, int *level, int *env)
 546{
 547	int retval;
 548
 549	/*
 550	 * bits 0-2: level
 551	 * bit 7: light on/off
 552	 * bit 8-10: environment (0: dark, 1: normal, 2: light)
 553	 * bit 17: status unknown
 554	 */
 555	retval = asus_wmi_get_devstate_bits(asus, ASUS_WMI_DEVID_KBD_BACKLIGHT,
 556					    0xFFFF);
 557
 558	/* Unknown status is considered as off */
 559	if (retval == 0x8000)
 560		retval = 0;
 561
 562	if (retval < 0)
 563		return retval;
 
 
 
 
 
 564
 565	if (level)
 566		*level = retval & 0x7F;
 567	if (env)
 568		*env = (retval >> 8) & 0x7F;
 569	return 0;
 570}
 571
 572static void do_kbd_led_set(struct led_classdev *led_cdev, int value)
 
 573{
 574	struct asus_wmi *asus;
 575	int max_level;
 576
 577	asus = container_of(led_cdev, struct asus_wmi, kbd_led);
 578	max_level = asus->kbd_led.max_brightness;
 579
 580	asus->kbd_led_wk = clamp_val(value, 0, max_level);
 581	kbd_led_update(asus);
 582}
 
 583
 584static void kbd_led_set(struct led_classdev *led_cdev,
 585			enum led_brightness value)
 586{
 587	/* Prevent disabling keyboard backlight on module unregister */
 588	if (led_cdev->flags & LED_UNREGISTERING)
 589		return;
 590
 591	do_kbd_led_set(led_cdev, value);
 592}
 593
 594static void kbd_led_set_by_kbd(struct asus_wmi *asus, enum led_brightness value)
 595{
 596	struct led_classdev *led_cdev = &asus->kbd_led;
 597
 598	do_kbd_led_set(led_cdev, value);
 599	led_classdev_notify_brightness_hw_changed(led_cdev, asus->kbd_led_wk);
 600}
 601
 602static enum led_brightness kbd_led_get(struct led_classdev *led_cdev)
 603{
 604	struct asus_wmi *asus;
 605	int retval, value;
 606
 607	asus = container_of(led_cdev, struct asus_wmi, kbd_led);
 608
 609	retval = kbd_led_read(asus, &value, NULL);
 
 610	if (retval < 0)
 611		return retval;
 612
 613	return value;
 614}
 615
 616static int wlan_led_unknown_state(struct asus_wmi *asus)
 617{
 618	u32 result;
 619
 620	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
 621
 622	return result & ASUS_WMI_DSTS_UNKNOWN_BIT;
 623}
 624
 625static void wlan_led_update(struct work_struct *work)
 626{
 627	int ctrl_param;
 628	struct asus_wmi *asus;
 629
 630	asus = container_of(work, struct asus_wmi, wlan_led_work);
 631
 632	ctrl_param = asus->wlan_led_wk;
 633	asus_wmi_set_devstate(ASUS_WMI_DEVID_WIRELESS_LED, ctrl_param, NULL);
 634}
 635
 636static void wlan_led_set(struct led_classdev *led_cdev,
 637			 enum led_brightness value)
 638{
 639	struct asus_wmi *asus;
 640
 641	asus = container_of(led_cdev, struct asus_wmi, wlan_led);
 642
 643	asus->wlan_led_wk = !!value;
 644	queue_work(asus->led_workqueue, &asus->wlan_led_work);
 645}
 646
 647static enum led_brightness wlan_led_get(struct led_classdev *led_cdev)
 648{
 649	struct asus_wmi *asus;
 650	u32 result;
 651
 652	asus = container_of(led_cdev, struct asus_wmi, wlan_led);
 653	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
 654
 655	return result & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
 656}
 657
 658static void lightbar_led_update(struct work_struct *work)
 659{
 660	struct asus_wmi *asus;
 661	int ctrl_param;
 662
 663	asus = container_of(work, struct asus_wmi, lightbar_led_work);
 664
 665	ctrl_param = asus->lightbar_led_wk;
 666	asus_wmi_set_devstate(ASUS_WMI_DEVID_LIGHTBAR, ctrl_param, NULL);
 667}
 668
 669static void lightbar_led_set(struct led_classdev *led_cdev,
 670			     enum led_brightness value)
 671{
 672	struct asus_wmi *asus;
 673
 674	asus = container_of(led_cdev, struct asus_wmi, lightbar_led);
 675
 676	asus->lightbar_led_wk = !!value;
 677	queue_work(asus->led_workqueue, &asus->lightbar_led_work);
 678}
 679
 680static enum led_brightness lightbar_led_get(struct led_classdev *led_cdev)
 681{
 682	struct asus_wmi *asus;
 683	u32 result;
 684
 685	asus = container_of(led_cdev, struct asus_wmi, lightbar_led);
 686	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_LIGHTBAR, &result);
 687
 688	return result & ASUS_WMI_DSTS_LIGHTBAR_MASK;
 689}
 690
 691static void asus_wmi_led_exit(struct asus_wmi *asus)
 692{
 693	led_classdev_unregister(&asus->kbd_led);
 694	led_classdev_unregister(&asus->tpd_led);
 695	led_classdev_unregister(&asus->wlan_led);
 696	led_classdev_unregister(&asus->lightbar_led);
 697
 698	if (asus->led_workqueue)
 699		destroy_workqueue(asus->led_workqueue);
 700}
 701
 702static int asus_wmi_led_init(struct asus_wmi *asus)
 703{
 704	int rv = 0, led_val;
 705
 706	asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
 707	if (!asus->led_workqueue)
 708		return -ENOMEM;
 709
 710	if (read_tpd_led_state(asus) >= 0) {
 711		INIT_WORK(&asus->tpd_led_work, tpd_led_update);
 712
 713		asus->tpd_led.name = "asus::touchpad";
 714		asus->tpd_led.brightness_set = tpd_led_set;
 715		asus->tpd_led.brightness_get = tpd_led_get;
 716		asus->tpd_led.max_brightness = 1;
 717
 718		rv = led_classdev_register(&asus->platform_device->dev,
 719					   &asus->tpd_led);
 720		if (rv)
 721			goto error;
 722	}
 723
 724	if (!kbd_led_read(asus, &led_val, NULL)) {
 725		asus->kbd_led_wk = led_val;
 
 726		asus->kbd_led.name = "asus::kbd_backlight";
 727		asus->kbd_led.flags = LED_BRIGHT_HW_CHANGED;
 728		asus->kbd_led.brightness_set = kbd_led_set;
 729		asus->kbd_led.brightness_get = kbd_led_get;
 730		asus->kbd_led.max_brightness = 3;
 731
 732		rv = led_classdev_register(&asus->platform_device->dev,
 733					   &asus->kbd_led);
 734		if (rv)
 735			goto error;
 736	}
 737
 738	if (asus_wmi_dev_is_present(asus, ASUS_WMI_DEVID_WIRELESS_LED)
 739			&& (asus->driver->quirks->wapf > 0)) {
 740		INIT_WORK(&asus->wlan_led_work, wlan_led_update);
 741
 742		asus->wlan_led.name = "asus::wlan";
 743		asus->wlan_led.brightness_set = wlan_led_set;
 744		if (!wlan_led_unknown_state(asus))
 745			asus->wlan_led.brightness_get = wlan_led_get;
 746		asus->wlan_led.flags = LED_CORE_SUSPENDRESUME;
 747		asus->wlan_led.max_brightness = 1;
 748		asus->wlan_led.default_trigger = "asus-wlan";
 749
 750		rv = led_classdev_register(&asus->platform_device->dev,
 751					   &asus->wlan_led);
 752		if (rv)
 753			goto error;
 754	}
 755
 756	if (asus_wmi_dev_is_present(asus, ASUS_WMI_DEVID_LIGHTBAR)) {
 757		INIT_WORK(&asus->lightbar_led_work, lightbar_led_update);
 758
 759		asus->lightbar_led.name = "asus::lightbar";
 760		asus->lightbar_led.brightness_set = lightbar_led_set;
 761		asus->lightbar_led.brightness_get = lightbar_led_get;
 762		asus->lightbar_led.max_brightness = 1;
 763
 764		rv = led_classdev_register(&asus->platform_device->dev,
 765					   &asus->lightbar_led);
 766	}
 767
 768error:
 769	if (rv)
 770		asus_wmi_led_exit(asus);
 771
 772	return rv;
 773}
 774
 775/* RF *************************************************************************/
 776
 777/*
 778 * PCI hotplug (for wlan rfkill)
 779 */
 780static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus)
 781{
 782	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 783
 784	if (result < 0)
 785		return false;
 786	return !result;
 787}
 788
 789static void asus_rfkill_hotplug(struct asus_wmi *asus)
 790{
 791	struct pci_dev *dev;
 792	struct pci_bus *bus;
 793	bool blocked;
 794	bool absent;
 795	u32 l;
 796
 797	mutex_lock(&asus->wmi_lock);
 798	blocked = asus_wlan_rfkill_blocked(asus);
 799	mutex_unlock(&asus->wmi_lock);
 800
 801	mutex_lock(&asus->hotplug_lock);
 802	pci_lock_rescan_remove();
 803
 804	if (asus->wlan.rfkill)
 805		rfkill_set_sw_state(asus->wlan.rfkill, blocked);
 806
 807	if (asus->hotplug_slot.ops) {
 808		bus = pci_find_bus(0, 1);
 809		if (!bus) {
 810			pr_warn("Unable to find PCI bus 1?\n");
 811			goto out_unlock;
 812		}
 813
 814		if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
 815			pr_err("Unable to read PCI config space?\n");
 816			goto out_unlock;
 817		}
 818		absent = (l == 0xffffffff);
 819
 820		if (blocked != absent) {
 821			pr_warn("BIOS says wireless lan is %s, "
 822				"but the pci device is %s\n",
 823				blocked ? "blocked" : "unblocked",
 824				absent ? "absent" : "present");
 825			pr_warn("skipped wireless hotplug as probably "
 826				"inappropriate for this model\n");
 827			goto out_unlock;
 828		}
 829
 830		if (!blocked) {
 831			dev = pci_get_slot(bus, 0);
 832			if (dev) {
 833				/* Device already present */
 834				pci_dev_put(dev);
 835				goto out_unlock;
 836			}
 837			dev = pci_scan_single_device(bus, 0);
 838			if (dev) {
 839				pci_bus_assign_resources(bus);
 840				pci_bus_add_device(dev);
 
 841			}
 842		} else {
 843			dev = pci_get_slot(bus, 0);
 844			if (dev) {
 845				pci_stop_and_remove_bus_device(dev);
 846				pci_dev_put(dev);
 847			}
 848		}
 849	}
 850
 851out_unlock:
 852	pci_unlock_rescan_remove();
 853	mutex_unlock(&asus->hotplug_lock);
 854}
 855
 856static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data)
 857{
 858	struct asus_wmi *asus = data;
 859
 860	if (event != ACPI_NOTIFY_BUS_CHECK)
 861		return;
 862
 863	/*
 864	 * We can't call directly asus_rfkill_hotplug because most
 865	 * of the time WMBC is still being executed and not reetrant.
 866	 * There is currently no way to tell ACPICA that  we want this
 867	 * method to be serialized, we schedule a asus_rfkill_hotplug
 868	 * call later, in a safer context.
 869	 */
 870	queue_work(asus->hotplug_workqueue, &asus->hotplug_work);
 871}
 872
 873static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node)
 874{
 875	acpi_status status;
 876	acpi_handle handle;
 877
 878	status = acpi_get_handle(NULL, node, &handle);
 879	if (ACPI_FAILURE(status))
 
 
 
 
 
 
 
 880		return -ENODEV;
 881
 882	status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
 883					     asus_rfkill_notify, asus);
 884	if (ACPI_FAILURE(status))
 885		pr_warn("Failed to register notify on %s\n", node);
 886
 887	return 0;
 888}
 889
 890static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node)
 891{
 892	acpi_status status = AE_OK;
 893	acpi_handle handle;
 894
 895	status = acpi_get_handle(NULL, node, &handle);
 896	if (ACPI_FAILURE(status))
 897		return;
 898
 899	status = acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
 900					    asus_rfkill_notify);
 901	if (ACPI_FAILURE(status))
 902		pr_err("Error removing rfkill notify handler %s\n", node);
 
 
 
 
 903}
 904
 905static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot,
 906				   u8 *value)
 907{
 908	struct asus_wmi *asus = container_of(hotplug_slot,
 909					     struct asus_wmi, hotplug_slot);
 910	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 911
 912	if (result < 0)
 913		return result;
 914
 915	*value = !!result;
 916	return 0;
 917}
 918
 919static const struct hotplug_slot_ops asus_hotplug_slot_ops = {
 
 
 
 
 
 
 
 920	.get_adapter_status = asus_get_adapter_status,
 921	.get_power_status = asus_get_adapter_status,
 922};
 923
 924static void asus_hotplug_work(struct work_struct *work)
 925{
 926	struct asus_wmi *asus;
 927
 928	asus = container_of(work, struct asus_wmi, hotplug_work);
 929	asus_rfkill_hotplug(asus);
 930}
 931
 932static int asus_setup_pci_hotplug(struct asus_wmi *asus)
 933{
 934	int ret = -ENOMEM;
 935	struct pci_bus *bus = pci_find_bus(0, 1);
 936
 937	if (!bus) {
 938		pr_err("Unable to find wifi PCI bus\n");
 939		return -ENODEV;
 940	}
 941
 942	asus->hotplug_workqueue =
 943	    create_singlethread_workqueue("hotplug_workqueue");
 944	if (!asus->hotplug_workqueue)
 945		goto error_workqueue;
 946
 947	INIT_WORK(&asus->hotplug_work, asus_hotplug_work);
 948
 949	asus->hotplug_slot.ops = &asus_hotplug_slot_ops;
 
 
 
 
 
 
 
 
 
 
 
 
 
 950
 951	ret = pci_hp_register(&asus->hotplug_slot, bus, 0, "asus-wifi");
 952	if (ret) {
 953		pr_err("Unable to register hotplug slot - %d\n", ret);
 954		goto error_register;
 955	}
 956
 957	return 0;
 958
 959error_register:
 960	asus->hotplug_slot.ops = NULL;
 
 
 
 
 961	destroy_workqueue(asus->hotplug_workqueue);
 962error_workqueue:
 963	return ret;
 964}
 965
 966/*
 967 * Rfkill devices
 968 */
 969static int asus_rfkill_set(void *data, bool blocked)
 970{
 971	struct asus_rfkill *priv = data;
 972	u32 ctrl_param = !blocked;
 973	u32 dev_id = priv->dev_id;
 974
 975	/*
 976	 * If the user bit is set, BIOS can't set and record the wlan status,
 977	 * it will report the value read from id ASUS_WMI_DEVID_WLAN_LED
 978	 * while we query the wlan status through WMI(ASUS_WMI_DEVID_WLAN).
 979	 * So, we have to record wlan status in id ASUS_WMI_DEVID_WLAN_LED
 980	 * while setting the wlan status through WMI.
 981	 * This is also the behavior that windows app will do.
 982	 */
 983	if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
 984	     priv->asus->driver->wlan_ctrl_by_user)
 985		dev_id = ASUS_WMI_DEVID_WLAN_LED;
 986
 987	return asus_wmi_set_devstate(dev_id, ctrl_param, NULL);
 988}
 989
 990static void asus_rfkill_query(struct rfkill *rfkill, void *data)
 991{
 992	struct asus_rfkill *priv = data;
 993	int result;
 994
 995	result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id);
 996
 997	if (result < 0)
 998		return;
 999
1000	rfkill_set_sw_state(priv->rfkill, !result);
1001}
1002
1003static int asus_rfkill_wlan_set(void *data, bool blocked)
1004{
1005	struct asus_rfkill *priv = data;
1006	struct asus_wmi *asus = priv->asus;
1007	int ret;
1008
1009	/*
1010	 * This handler is enabled only if hotplug is enabled.
1011	 * In this case, the asus_wmi_set_devstate() will
1012	 * trigger a wmi notification and we need to wait
1013	 * this call to finish before being able to call
1014	 * any wmi method
1015	 */
1016	mutex_lock(&asus->wmi_lock);
1017	ret = asus_rfkill_set(data, blocked);
1018	mutex_unlock(&asus->wmi_lock);
1019	return ret;
1020}
1021
1022static const struct rfkill_ops asus_rfkill_wlan_ops = {
1023	.set_block = asus_rfkill_wlan_set,
1024	.query = asus_rfkill_query,
1025};
1026
1027static const struct rfkill_ops asus_rfkill_ops = {
1028	.set_block = asus_rfkill_set,
1029	.query = asus_rfkill_query,
1030};
1031
1032static int asus_new_rfkill(struct asus_wmi *asus,
1033			   struct asus_rfkill *arfkill,
1034			   const char *name, enum rfkill_type type, int dev_id)
1035{
1036	int result = asus_wmi_get_devstate_simple(asus, dev_id);
1037	struct rfkill **rfkill = &arfkill->rfkill;
1038
1039	if (result < 0)
1040		return result;
1041
1042	arfkill->dev_id = dev_id;
1043	arfkill->asus = asus;
1044
1045	if (dev_id == ASUS_WMI_DEVID_WLAN &&
1046	    asus->driver->quirks->hotplug_wireless)
1047		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
1048				       &asus_rfkill_wlan_ops, arfkill);
1049	else
1050		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
1051				       &asus_rfkill_ops, arfkill);
1052
1053	if (!*rfkill)
1054		return -EINVAL;
1055
1056	if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
1057			(asus->driver->quirks->wapf > 0))
1058		rfkill_set_led_trigger_name(*rfkill, "asus-wlan");
1059
1060	rfkill_init_sw_state(*rfkill, !result);
1061	result = rfkill_register(*rfkill);
1062	if (result) {
1063		rfkill_destroy(*rfkill);
1064		*rfkill = NULL;
1065		return result;
1066	}
1067	return 0;
1068}
1069
1070static void asus_wmi_rfkill_exit(struct asus_wmi *asus)
1071{
1072	if (asus->driver->wlan_ctrl_by_user && ashs_present())
1073		return;
1074
1075	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
1076	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
1077	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
1078	if (asus->wlan.rfkill) {
1079		rfkill_unregister(asus->wlan.rfkill);
1080		rfkill_destroy(asus->wlan.rfkill);
1081		asus->wlan.rfkill = NULL;
1082	}
1083	/*
1084	 * Refresh pci hotplug in case the rfkill state was changed after
1085	 * asus_unregister_rfkill_notifier()
1086	 */
1087	asus_rfkill_hotplug(asus);
1088	if (asus->hotplug_slot.ops)
1089		pci_hp_deregister(&asus->hotplug_slot);
1090	if (asus->hotplug_workqueue)
1091		destroy_workqueue(asus->hotplug_workqueue);
1092
1093	if (asus->bluetooth.rfkill) {
1094		rfkill_unregister(asus->bluetooth.rfkill);
1095		rfkill_destroy(asus->bluetooth.rfkill);
1096		asus->bluetooth.rfkill = NULL;
1097	}
1098	if (asus->wimax.rfkill) {
1099		rfkill_unregister(asus->wimax.rfkill);
1100		rfkill_destroy(asus->wimax.rfkill);
1101		asus->wimax.rfkill = NULL;
1102	}
1103	if (asus->wwan3g.rfkill) {
1104		rfkill_unregister(asus->wwan3g.rfkill);
1105		rfkill_destroy(asus->wwan3g.rfkill);
1106		asus->wwan3g.rfkill = NULL;
1107	}
1108	if (asus->gps.rfkill) {
1109		rfkill_unregister(asus->gps.rfkill);
1110		rfkill_destroy(asus->gps.rfkill);
1111		asus->gps.rfkill = NULL;
1112	}
1113	if (asus->uwb.rfkill) {
1114		rfkill_unregister(asus->uwb.rfkill);
1115		rfkill_destroy(asus->uwb.rfkill);
1116		asus->uwb.rfkill = NULL;
1117	}
1118}
1119
1120static int asus_wmi_rfkill_init(struct asus_wmi *asus)
1121{
1122	int result = 0;
1123
1124	mutex_init(&asus->hotplug_lock);
1125	mutex_init(&asus->wmi_lock);
1126
1127	result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan",
1128				 RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN);
1129
1130	if (result && result != -ENODEV)
1131		goto exit;
1132
1133	result = asus_new_rfkill(asus, &asus->bluetooth,
1134				 "asus-bluetooth", RFKILL_TYPE_BLUETOOTH,
1135				 ASUS_WMI_DEVID_BLUETOOTH);
1136
1137	if (result && result != -ENODEV)
1138		goto exit;
1139
1140	result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax",
1141				 RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX);
1142
1143	if (result && result != -ENODEV)
1144		goto exit;
1145
1146	result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g",
1147				 RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G);
1148
1149	if (result && result != -ENODEV)
1150		goto exit;
1151
1152	result = asus_new_rfkill(asus, &asus->gps, "asus-gps",
1153				 RFKILL_TYPE_GPS, ASUS_WMI_DEVID_GPS);
1154
1155	if (result && result != -ENODEV)
1156		goto exit;
1157
1158	result = asus_new_rfkill(asus, &asus->uwb, "asus-uwb",
1159				 RFKILL_TYPE_UWB, ASUS_WMI_DEVID_UWB);
1160
1161	if (result && result != -ENODEV)
1162		goto exit;
1163
1164	if (!asus->driver->quirks->hotplug_wireless)
1165		goto exit;
1166
1167	result = asus_setup_pci_hotplug(asus);
1168	/*
1169	 * If we get -EBUSY then something else is handling the PCI hotplug -
1170	 * don't fail in this case
1171	 */
1172	if (result == -EBUSY)
1173		result = 0;
1174
1175	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
1176	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
1177	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
1178	/*
1179	 * Refresh pci hotplug in case the rfkill state was changed during
1180	 * setup.
1181	 */
1182	asus_rfkill_hotplug(asus);
1183
1184exit:
1185	if (result && result != -ENODEV)
1186		asus_wmi_rfkill_exit(asus);
1187
1188	if (result == -ENODEV)
1189		result = 0;
1190
1191	return result;
1192}
1193
1194/* Quirks *********************************************************************/
1195
1196static void asus_wmi_set_xusb2pr(struct asus_wmi *asus)
1197{
1198	struct pci_dev *xhci_pdev;
1199	u32 orig_ports_available;
1200	u32 ports_available = asus->driver->quirks->xusb2pr;
1201
1202	xhci_pdev = pci_get_device(PCI_VENDOR_ID_INTEL,
1203			PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI,
1204			NULL);
1205
1206	if (!xhci_pdev)
1207		return;
1208
1209	pci_read_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
1210				&orig_ports_available);
1211
1212	pci_write_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
1213				cpu_to_le32(ports_available));
1214
1215	pr_info("set USB_INTEL_XUSB2PR old: 0x%04x, new: 0x%04x\n",
1216			orig_ports_available, ports_available);
1217}
1218
1219/*
1220 * Some devices dont support or have borcken get_als method
1221 * but still support set method.
1222 */
1223static void asus_wmi_set_als(void)
1224{
1225	asus_wmi_set_devstate(ASUS_WMI_DEVID_ALS_ENABLE, 1, NULL);
1226}
1227
1228/* Hwmon device ***************************************************************/
1229
1230static int asus_agfn_fan_speed_read(struct asus_wmi *asus, int fan,
1231					  int *speed)
1232{
1233	struct agfn_fan_args args = {
1234		.agfn.len = sizeof(args),
1235		.agfn.mfun = ASUS_FAN_MFUN,
1236		.agfn.sfun = ASUS_FAN_SFUN_READ,
1237		.fan = fan,
1238		.speed = 0,
1239	};
1240	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1241	int status;
1242
1243	if (fan != 1)
1244		return -EINVAL;
1245
1246	status = asus_wmi_evaluate_method_agfn(input);
1247
1248	if (status || args.agfn.err)
1249		return -ENXIO;
1250
1251	if (speed)
1252		*speed = args.speed;
1253
1254	return 0;
1255}
1256
1257static int asus_agfn_fan_speed_write(struct asus_wmi *asus, int fan,
1258				     int *speed)
1259{
1260	struct agfn_fan_args args = {
1261		.agfn.len = sizeof(args),
1262		.agfn.mfun = ASUS_FAN_MFUN,
1263		.agfn.sfun = ASUS_FAN_SFUN_WRITE,
1264		.fan = fan,
1265		.speed = speed ?  *speed : 0,
1266	};
1267	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1268	int status;
1269
1270	/* 1: for setting 1st fan's speed 0: setting auto mode */
1271	if (fan != 1 && fan != 0)
1272		return -EINVAL;
1273
1274	status = asus_wmi_evaluate_method_agfn(input);
1275
1276	if (status || args.agfn.err)
1277		return -ENXIO;
1278
1279	if (speed && fan == 1)
1280		asus->agfn_pwm = *speed;
1281
1282	return 0;
1283}
1284
1285/*
1286 * Check if we can read the speed of one fan. If true we assume we can also
1287 * control it.
1288 */
1289static bool asus_wmi_has_agfn_fan(struct asus_wmi *asus)
1290{
1291	int status;
1292	int speed;
1293	u32 value;
1294
1295	status = asus_agfn_fan_speed_read(asus, 1, &speed);
1296	if (status != 0)
1297		return false;
1298
1299	status = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
1300	if (status != 0)
1301		return false;
1302
1303	/*
1304	 * We need to find a better way, probably using sfun,
1305	 * bits or spec ...
1306	 * Currently we disable it if:
1307	 * - ASUS_WMI_UNSUPPORTED_METHOD is returned
1308	 * - reverved bits are non-zero
1309	 * - sfun and presence bit are not set
1310	 */
1311	return !(value == ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
1312		 || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)));
1313}
1314
1315static int asus_fan_set_auto(struct asus_wmi *asus)
1316{
1317	int status;
1318	u32 retval;
1319
1320	switch (asus->fan_type) {
1321	case FAN_TYPE_SPEC83:
1322		status = asus_wmi_set_devstate(ASUS_WMI_DEVID_CPU_FAN_CTRL,
1323					       0, &retval);
1324		if (status)
1325			return status;
1326
1327		if (retval != 1)
1328			return -EIO;
1329		break;
1330
1331	case FAN_TYPE_AGFN:
1332		status = asus_agfn_fan_speed_write(asus, 0, NULL);
1333		if (status)
1334			return -ENXIO;
1335		break;
1336
1337	default:
1338		return -ENXIO;
1339	}
1340
1341
1342	return 0;
1343}
1344
1345static ssize_t pwm1_show(struct device *dev,
1346			       struct device_attribute *attr,
1347			       char *buf)
1348{
1349	struct asus_wmi *asus = dev_get_drvdata(dev);
 
1350	int err;
1351	int value;
1352
1353	/* If we already set a value then just return it */
1354	if (asus->agfn_pwm >= 0)
1355		return sprintf(buf, "%d\n", asus->agfn_pwm);
1356
1357	/*
1358	 * If we haven't set already set a value through the AGFN interface,
1359	 * we read a current value through the (now-deprecated) FAN_CTRL device.
1360	 */
1361	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
1362	if (err < 0)
1363		return err;
1364
1365	value &= 0xFF;
1366
1367	if (value == 1) /* Low Speed */
1368		value = 85;
1369	else if (value == 2)
1370		value = 170;
1371	else if (value == 3)
1372		value = 255;
1373	else if (value) {
1374		pr_err("Unknown fan speed %#x\n", value);
1375		value = -1;
1376	}
1377
1378	return sprintf(buf, "%d\n", value);
1379}
1380
1381static ssize_t pwm1_store(struct device *dev,
1382				     struct device_attribute *attr,
1383				     const char *buf, size_t count) {
1384	struct asus_wmi *asus = dev_get_drvdata(dev);
1385	int value;
1386	int state;
1387	int ret;
1388
1389	ret = kstrtouint(buf, 10, &value);
1390	if (ret)
1391		return ret;
1392
1393	value = clamp(value, 0, 255);
1394
1395	state = asus_agfn_fan_speed_write(asus, 1, &value);
1396	if (state)
1397		pr_warn("Setting fan speed failed: %d\n", state);
1398	else
1399		asus->fan_pwm_mode = ASUS_FAN_CTRL_MANUAL;
1400
1401	return count;
1402}
1403
1404static ssize_t fan1_input_show(struct device *dev,
1405					struct device_attribute *attr,
1406					char *buf)
1407{
1408	struct asus_wmi *asus = dev_get_drvdata(dev);
1409	int value;
1410	int ret;
1411
1412	switch (asus->fan_type) {
1413	case FAN_TYPE_SPEC83:
1414		ret = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_CPU_FAN_CTRL,
1415					    &value);
1416		if (ret < 0)
1417			return ret;
1418
1419		value &= 0xffff;
1420		break;
1421
1422	case FAN_TYPE_AGFN:
1423		/* no speed readable on manual mode */
1424		if (asus->fan_pwm_mode == ASUS_FAN_CTRL_MANUAL)
1425			return -ENXIO;
1426
1427		ret = asus_agfn_fan_speed_read(asus, 1, &value);
1428		if (ret) {
1429			pr_warn("reading fan speed failed: %d\n", ret);
1430			return -ENXIO;
1431		}
1432		break;
1433
1434	default:
1435		return -ENXIO;
1436	}
1437
1438	return sprintf(buf, "%d\n", value < 0 ? -1 : value*100);
1439}
1440
1441static ssize_t pwm1_enable_show(struct device *dev,
1442						 struct device_attribute *attr,
1443						 char *buf)
1444{
1445	struct asus_wmi *asus = dev_get_drvdata(dev);
1446
1447	/*
1448	 * Just read back the cached pwm mode.
1449	 *
1450	 * For the CPU_FAN device, the spec indicates that we should be
1451	 * able to read the device status and consult bit 19 to see if we
1452	 * are in Full On or Automatic mode. However, this does not work
1453	 * in practice on X532FL at least (the bit is always 0) and there's
1454	 * also nothing in the DSDT to indicate that this behaviour exists.
1455	 */
1456	return sprintf(buf, "%d\n", asus->fan_pwm_mode);
1457}
1458
1459static ssize_t pwm1_enable_store(struct device *dev,
1460						  struct device_attribute *attr,
1461						  const char *buf, size_t count)
1462{
1463	struct asus_wmi *asus = dev_get_drvdata(dev);
1464	int status = 0;
1465	int state;
1466	int value;
1467	int ret;
1468	u32 retval;
1469
1470	ret = kstrtouint(buf, 10, &state);
1471	if (ret)
1472		return ret;
1473
1474	if (asus->fan_type == FAN_TYPE_SPEC83) {
1475		switch (state) { /* standard documented hwmon values */
1476		case ASUS_FAN_CTRL_FULLSPEED:
1477			value = 1;
1478			break;
1479		case ASUS_FAN_CTRL_AUTO:
1480			value = 0;
1481			break;
1482		default:
1483			return -EINVAL;
1484		}
1485
1486		ret = asus_wmi_set_devstate(ASUS_WMI_DEVID_CPU_FAN_CTRL,
1487					    value, &retval);
1488		if (ret)
1489			return ret;
1490
1491		if (retval != 1)
1492			return -EIO;
1493	} else if (asus->fan_type == FAN_TYPE_AGFN) {
1494		switch (state) {
1495		case ASUS_FAN_CTRL_MANUAL:
1496			break;
1497
1498		case ASUS_FAN_CTRL_AUTO:
1499			status = asus_fan_set_auto(asus);
1500			if (status)
1501				return status;
1502			break;
1503
1504		default:
1505			return -EINVAL;
1506		}
1507	}
1508
1509	asus->fan_pwm_mode = state;
1510	return count;
1511}
1512
1513static ssize_t fan1_label_show(struct device *dev,
1514					  struct device_attribute *attr,
1515					  char *buf)
1516{
1517	return sprintf(buf, "%s\n", ASUS_FAN_DESC);
1518}
1519
1520static ssize_t asus_hwmon_temp1(struct device *dev,
1521				struct device_attribute *attr,
1522				char *buf)
1523{
1524	struct asus_wmi *asus = dev_get_drvdata(dev);
1525	u32 value;
1526	int err;
1527
1528	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_THERMAL_CTRL, &value);
 
1529	if (err < 0)
1530		return err;
1531
1532	return sprintf(buf, "%ld\n",
1533		       deci_kelvin_to_millicelsius(value & 0xFFFF));
 
1534}
1535
1536/* Fan1 */
1537static DEVICE_ATTR_RW(pwm1);
1538static DEVICE_ATTR_RW(pwm1_enable);
1539static DEVICE_ATTR_RO(fan1_input);
1540static DEVICE_ATTR_RO(fan1_label);
1541
1542/* Temperature */
1543static DEVICE_ATTR(temp1_input, S_IRUGO, asus_hwmon_temp1, NULL);
 
 
 
 
1544
1545static struct attribute *hwmon_attributes[] = {
1546	&dev_attr_pwm1.attr,
1547	&dev_attr_pwm1_enable.attr,
1548	&dev_attr_fan1_input.attr,
1549	&dev_attr_fan1_label.attr,
1550
1551	&dev_attr_temp1_input.attr,
1552	NULL
1553};
1554
1555static umode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
1556					  struct attribute *attr, int idx)
1557{
1558	struct device *dev = container_of(kobj, struct device, kobj);
1559	struct asus_wmi *asus = dev_get_drvdata(dev->parent);
 
 
 
1560	u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
1561
1562	if (attr == &dev_attr_pwm1.attr) {
1563		if (asus->fan_type != FAN_TYPE_AGFN)
1564			return 0;
1565	} else if (attr == &dev_attr_fan1_input.attr
1566	    || attr == &dev_attr_fan1_label.attr
1567	    || attr == &dev_attr_pwm1_enable.attr) {
1568		if (asus->fan_type == FAN_TYPE_NONE)
1569			return 0;
1570	} else if (attr == &dev_attr_temp1_input.attr) {
1571		int err = asus_wmi_get_devstate(asus,
1572						ASUS_WMI_DEVID_THERMAL_CTRL,
1573						&value);
1574
1575		if (err < 0)
1576			return 0; /* can't return negative here */
 
1577
 
1578		/*
1579		 * If the temperature value in deci-Kelvin is near the absolute
1580		 * zero temperature, something is clearly wrong
 
 
 
 
1581		 */
1582		if (value == 0 || value == 1)
1583			return 0;
 
 
 
 
 
1584	}
1585
1586	return attr->mode;
1587}
1588
1589static const struct attribute_group hwmon_attribute_group = {
1590	.is_visible = asus_hwmon_sysfs_is_visible,
1591	.attrs = hwmon_attributes
1592};
1593__ATTRIBUTE_GROUPS(hwmon_attribute);
1594
1595static int asus_wmi_hwmon_init(struct asus_wmi *asus)
1596{
1597	struct device *dev = &asus->platform_device->dev;
1598	struct device *hwmon;
1599
1600	hwmon = devm_hwmon_device_register_with_groups(dev, "asus", asus,
1601			hwmon_attribute_groups);
1602
1603	if (IS_ERR(hwmon)) {
1604		pr_err("Could not register asus hwmon device\n");
1605		return PTR_ERR(hwmon);
1606	}
1607	return 0;
1608}
1609
1610static int asus_wmi_fan_init(struct asus_wmi *asus)
1611{
1612	asus->fan_type = FAN_TYPE_NONE;
1613	asus->agfn_pwm = -1;
1614
1615	if (asus_wmi_dev_is_present(asus, ASUS_WMI_DEVID_CPU_FAN_CTRL))
1616		asus->fan_type = FAN_TYPE_SPEC83;
1617	else if (asus_wmi_has_agfn_fan(asus))
1618		asus->fan_type = FAN_TYPE_AGFN;
1619
1620	if (asus->fan_type == FAN_TYPE_NONE)
1621		return -ENODEV;
1622
1623	asus_fan_set_auto(asus);
1624	asus->fan_pwm_mode = ASUS_FAN_CTRL_AUTO;
1625	return 0;
1626}
1627
1628/* Fan mode *******************************************************************/
1629
1630static int fan_boost_mode_check_present(struct asus_wmi *asus)
1631{
1632	u32 result;
1633	int err;
1634
1635	asus->fan_boost_mode_available = false;
1636
1637	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_BOOST_MODE,
1638				    &result);
1639	if (err) {
1640		if (err == -ENODEV)
1641			return 0;
1642		else
1643			return err;
1644	}
1645
1646	if ((result & ASUS_WMI_DSTS_PRESENCE_BIT) &&
1647			(result & ASUS_FAN_BOOST_MODES_MASK)) {
1648		asus->fan_boost_mode_available = true;
1649		asus->fan_boost_mode_mask = result & ASUS_FAN_BOOST_MODES_MASK;
1650	}
1651
1652	return 0;
1653}
1654
1655static int fan_boost_mode_write(struct asus_wmi *asus)
1656{
1657	int err;
1658	u8 value;
1659	u32 retval;
1660
1661	value = asus->fan_boost_mode;
1662
1663	pr_info("Set fan boost mode: %u\n", value);
1664	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_FAN_BOOST_MODE, value,
1665				    &retval);
1666	if (err) {
1667		pr_warn("Failed to set fan boost mode: %d\n", err);
1668		return err;
1669	}
1670
1671	if (retval != 1) {
1672		pr_warn("Failed to set fan boost mode (retval): 0x%x\n",
1673			retval);
1674		return -EIO;
1675	}
1676
1677	return 0;
1678}
1679
1680static int fan_boost_mode_switch_next(struct asus_wmi *asus)
1681{
1682	u8 mask = asus->fan_boost_mode_mask;
1683
1684	if (asus->fan_boost_mode == ASUS_FAN_BOOST_MODE_NORMAL) {
1685		if (mask & ASUS_FAN_BOOST_MODE_OVERBOOST_MASK)
1686			asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_OVERBOOST;
1687		else if (mask & ASUS_FAN_BOOST_MODE_SILENT_MASK)
1688			asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_SILENT;
1689	} else if (asus->fan_boost_mode == ASUS_FAN_BOOST_MODE_OVERBOOST) {
1690		if (mask & ASUS_FAN_BOOST_MODE_SILENT_MASK)
1691			asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_SILENT;
1692		else
1693			asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_NORMAL;
1694	} else {
1695		asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_NORMAL;
1696	}
1697
1698	return fan_boost_mode_write(asus);
1699}
1700
1701static ssize_t fan_boost_mode_show(struct device *dev,
1702				   struct device_attribute *attr, char *buf)
1703{
1704	struct asus_wmi *asus = dev_get_drvdata(dev);
1705
1706	return scnprintf(buf, PAGE_SIZE, "%d\n", asus->fan_boost_mode);
1707}
1708
1709static ssize_t fan_boost_mode_store(struct device *dev,
1710				    struct device_attribute *attr,
1711				    const char *buf, size_t count)
1712{
 
1713	int result;
1714	u8 new_mode;
1715	struct asus_wmi *asus = dev_get_drvdata(dev);
1716	u8 mask = asus->fan_boost_mode_mask;
1717
1718	result = kstrtou8(buf, 10, &new_mode);
1719	if (result < 0) {
1720		pr_warn("Trying to store invalid value\n");
1721		return result;
1722	}
1723
1724	if (new_mode == ASUS_FAN_BOOST_MODE_OVERBOOST) {
1725		if (!(mask & ASUS_FAN_BOOST_MODE_OVERBOOST_MASK))
1726			return -EINVAL;
1727	} else if (new_mode == ASUS_FAN_BOOST_MODE_SILENT) {
1728		if (!(mask & ASUS_FAN_BOOST_MODE_SILENT_MASK))
1729			return -EINVAL;
1730	} else if (new_mode != ASUS_FAN_BOOST_MODE_NORMAL) {
1731		return -EINVAL;
1732	}
1733
1734	asus->fan_boost_mode = new_mode;
1735	fan_boost_mode_write(asus);
1736
1737	return count;
1738}
1739
1740// Fan boost mode: 0 - normal, 1 - overboost, 2 - silent
1741static DEVICE_ATTR_RW(fan_boost_mode);
1742
1743/* Throttle thermal policy ****************************************************/
1744
1745static int throttle_thermal_policy_check_present(struct asus_wmi *asus)
1746{
1747	u32 result;
1748	int err;
1749
1750	asus->throttle_thermal_policy_available = false;
1751
1752	err = asus_wmi_get_devstate(asus,
1753				    ASUS_WMI_DEVID_THROTTLE_THERMAL_POLICY,
1754				    &result);
1755	if (err) {
1756		if (err == -ENODEV)
1757			return 0;
1758		return err;
1759	}
1760
1761	if (result & ASUS_WMI_DSTS_PRESENCE_BIT)
1762		asus->throttle_thermal_policy_available = true;
1763
1764	return 0;
1765}
1766
1767static int throttle_thermal_policy_write(struct asus_wmi *asus)
1768{
1769	int err;
1770	u8 value;
1771	u32 retval;
1772
1773	value = asus->throttle_thermal_policy_mode;
1774
1775	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_THROTTLE_THERMAL_POLICY,
1776				    value, &retval);
1777	if (err) {
1778		pr_warn("Failed to set throttle thermal policy: %d\n", err);
1779		return err;
1780	}
1781
1782	if (retval != 1) {
1783		pr_warn("Failed to set throttle thermal policy (retval): 0x%x\n",
1784			retval);
1785		return -EIO;
1786	}
1787
1788	return 0;
1789}
1790
1791static int throttle_thermal_policy_set_default(struct asus_wmi *asus)
1792{
1793	if (!asus->throttle_thermal_policy_available)
1794		return 0;
1795
1796	asus->throttle_thermal_policy_mode = ASUS_THROTTLE_THERMAL_POLICY_DEFAULT;
1797	return throttle_thermal_policy_write(asus);
1798}
1799
1800static int throttle_thermal_policy_switch_next(struct asus_wmi *asus)
1801{
1802	u8 new_mode = asus->throttle_thermal_policy_mode + 1;
1803
1804	if (new_mode > ASUS_THROTTLE_THERMAL_POLICY_SILENT)
1805		new_mode = ASUS_THROTTLE_THERMAL_POLICY_DEFAULT;
1806
1807	asus->throttle_thermal_policy_mode = new_mode;
1808	return throttle_thermal_policy_write(asus);
1809}
1810
1811static ssize_t throttle_thermal_policy_show(struct device *dev,
1812				   struct device_attribute *attr, char *buf)
1813{
1814	struct asus_wmi *asus = dev_get_drvdata(dev);
1815	u8 mode = asus->throttle_thermal_policy_mode;
1816
1817	return scnprintf(buf, PAGE_SIZE, "%d\n", mode);
1818}
1819
1820static ssize_t throttle_thermal_policy_store(struct device *dev,
1821				    struct device_attribute *attr,
1822				    const char *buf, size_t count)
1823{
1824	int result;
1825	u8 new_mode;
1826	struct asus_wmi *asus = dev_get_drvdata(dev);
1827
1828	result = kstrtou8(buf, 10, &new_mode);
1829	if (result < 0)
1830		return result;
1831
1832	if (new_mode > ASUS_THROTTLE_THERMAL_POLICY_SILENT)
1833		return -EINVAL;
1834
1835	asus->throttle_thermal_policy_mode = new_mode;
1836	throttle_thermal_policy_write(asus);
1837
1838	return count;
1839}
1840
1841// Throttle thermal policy: 0 - default, 1 - overboost, 2 - silent
1842static DEVICE_ATTR_RW(throttle_thermal_policy);
1843
1844/* Backlight ******************************************************************/
1845
1846static int read_backlight_power(struct asus_wmi *asus)
1847{
1848	int ret;
1849
1850	if (asus->driver->quirks->store_backlight_power)
1851		ret = !asus->driver->panel_power;
1852	else
1853		ret = asus_wmi_get_devstate_simple(asus,
1854						   ASUS_WMI_DEVID_BACKLIGHT);
1855
1856	if (ret < 0)
1857		return ret;
1858
1859	return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
1860}
1861
1862static int read_brightness_max(struct asus_wmi *asus)
1863{
1864	u32 retval;
1865	int err;
1866
1867	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
 
1868	if (err < 0)
1869		return err;
1870
1871	retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
1872	retval >>= 8;
1873
1874	if (!retval)
1875		return -ENODEV;
1876
1877	return retval;
1878}
1879
1880static int read_brightness(struct backlight_device *bd)
1881{
1882	struct asus_wmi *asus = bl_get_data(bd);
1883	u32 retval;
1884	int err;
1885
1886	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
 
1887	if (err < 0)
1888		return err;
1889
1890	return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
1891}
1892
1893static u32 get_scalar_command(struct backlight_device *bd)
1894{
1895	struct asus_wmi *asus = bl_get_data(bd);
1896	u32 ctrl_param = 0;
 
1897
1898	if ((asus->driver->brightness < bd->props.brightness) ||
1899	    bd->props.brightness == bd->props.max_brightness)
1900		ctrl_param = 0x00008001;
1901	else if ((asus->driver->brightness > bd->props.brightness) ||
1902		 bd->props.brightness == 0)
1903		ctrl_param = 0x00008000;
1904
1905	asus->driver->brightness = bd->props.brightness;
 
1906
1907	return ctrl_param;
1908}
1909
1910static int update_bl_status(struct backlight_device *bd)
1911{
1912	struct asus_wmi *asus = bl_get_data(bd);
1913	u32 ctrl_param;
1914	int power, err = 0;
1915
1916	power = read_backlight_power(asus);
1917	if (power != -ENODEV && bd->props.power != power) {
1918		ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
1919		err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
1920					    ctrl_param, NULL);
1921		if (asus->driver->quirks->store_backlight_power)
1922			asus->driver->panel_power = bd->props.power;
1923
1924		/* When using scalar brightness, updating the brightness
1925		 * will mess with the backlight power */
1926		if (asus->driver->quirks->scalar_panel_brightness)
1927			return err;
1928	}
1929
1930	if (asus->driver->quirks->scalar_panel_brightness)
1931		ctrl_param = get_scalar_command(bd);
1932	else
1933		ctrl_param = bd->props.brightness;
1934
1935	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
1936				    ctrl_param, NULL);
1937
1938	return err;
1939}
1940
1941static const struct backlight_ops asus_wmi_bl_ops = {
1942	.get_brightness = read_brightness,
1943	.update_status = update_bl_status,
1944};
1945
1946static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
1947{
1948	struct backlight_device *bd = asus->backlight_device;
1949	int old = bd->props.brightness;
1950	int new = old;
1951
1952	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1953		new = code - NOTIFY_BRNUP_MIN + 1;
1954	else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
1955		new = code - NOTIFY_BRNDOWN_MIN;
1956
1957	bd->props.brightness = new;
1958	backlight_update_status(bd);
1959	backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1960
1961	return old;
1962}
1963
1964static int asus_wmi_backlight_init(struct asus_wmi *asus)
1965{
1966	struct backlight_device *bd;
1967	struct backlight_properties props;
1968	int max;
1969	int power;
1970
1971	max = read_brightness_max(asus);
1972	if (max < 0)
 
 
 
1973		return max;
1974
1975	power = read_backlight_power(asus);
 
1976	if (power == -ENODEV)
1977		power = FB_BLANK_UNBLANK;
1978	else if (power < 0)
1979		return power;
1980
1981	memset(&props, 0, sizeof(struct backlight_properties));
1982	props.type = BACKLIGHT_PLATFORM;
1983	props.max_brightness = max;
1984	bd = backlight_device_register(asus->driver->name,
1985				       &asus->platform_device->dev, asus,
1986				       &asus_wmi_bl_ops, &props);
1987	if (IS_ERR(bd)) {
1988		pr_err("Could not register backlight device\n");
1989		return PTR_ERR(bd);
1990	}
1991
1992	asus->backlight_device = bd;
1993
1994	if (asus->driver->quirks->store_backlight_power)
1995		asus->driver->panel_power = power;
1996
1997	bd->props.brightness = read_brightness(bd);
1998	bd->props.power = power;
1999	backlight_update_status(bd);
2000
2001	asus->driver->brightness = bd->props.brightness;
2002
2003	return 0;
2004}
2005
2006static void asus_wmi_backlight_exit(struct asus_wmi *asus)
2007{
2008	backlight_device_unregister(asus->backlight_device);
 
2009
2010	asus->backlight_device = NULL;
2011}
2012
2013static int is_display_toggle(int code)
2014{
2015	/* display toggle keys */
2016	if ((code >= 0x61 && code <= 0x67) ||
2017	    (code >= 0x8c && code <= 0x93) ||
2018	    (code >= 0xa0 && code <= 0xa7) ||
2019	    (code >= 0xd0 && code <= 0xd5))
2020		return 1;
2021
2022	return 0;
2023}
2024
2025/* Fn-lock ********************************************************************/
2026
2027static bool asus_wmi_has_fnlock_key(struct asus_wmi *asus)
2028{
2029	u32 result;
2030
2031	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FNLOCK, &result);
2032
2033	return (result & ASUS_WMI_DSTS_PRESENCE_BIT) &&
2034		!(result & ASUS_WMI_FNLOCK_BIOS_DISABLED);
2035}
2036
2037static void asus_wmi_fnlock_update(struct asus_wmi *asus)
2038{
2039	int mode = asus->fnlock_locked;
2040
2041	asus_wmi_set_devstate(ASUS_WMI_DEVID_FNLOCK, mode, NULL);
2042}
2043
2044/* WMI events *****************************************************************/
2045
2046static int asus_wmi_get_event_code(u32 value)
2047{
 
2048	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
2049	union acpi_object *obj;
2050	acpi_status status;
2051	int code;
 
 
 
2052
2053	status = wmi_get_event_data(value, &response);
2054	if (ACPI_FAILURE(status)) {
2055		pr_warn("Failed to get WMI notify code: %s\n",
2056				acpi_format_exception(status));
2057		return -EIO;
2058	}
2059
2060	obj = (union acpi_object *)response.pointer;
2061
2062	if (obj && obj->type == ACPI_TYPE_INTEGER)
2063		code = (int)(obj->integer.value & WMI_EVENT_MASK);
2064	else
2065		code = -EIO;
2066
2067	kfree(obj);
2068	return code;
2069}
2070
2071static void asus_wmi_handle_event_code(int code, struct asus_wmi *asus)
2072{
2073	unsigned int key_value = 1;
2074	bool autorelease = 1;
2075	int result, orig_code;
2076
 
2077	orig_code = code;
2078
2079	if (asus->driver->key_filter) {
2080		asus->driver->key_filter(asus->driver, &code, &key_value,
2081					 &autorelease);
2082		if (code == ASUS_WMI_KEY_IGNORE)
2083			return;
2084	}
2085
2086	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
2087		code = ASUS_WMI_BRN_UP;
2088	else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
2089		code = ASUS_WMI_BRN_DOWN;
 
2090
2091	if (code == ASUS_WMI_BRN_DOWN || code == ASUS_WMI_BRN_UP) {
2092		if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
2093			asus_wmi_backlight_notify(asus, orig_code);
2094			return;
2095		}
2096	}
2097
2098	if (code == NOTIFY_KBD_BRTUP) {
2099		kbd_led_set_by_kbd(asus, asus->kbd_led_wk + 1);
2100		return;
2101	}
2102	if (code == NOTIFY_KBD_BRTDWN) {
2103		kbd_led_set_by_kbd(asus, asus->kbd_led_wk - 1);
2104		return;
2105	}
2106	if (code == NOTIFY_KBD_BRTTOGGLE) {
2107		if (asus->kbd_led_wk == asus->kbd_led.max_brightness)
2108			kbd_led_set_by_kbd(asus, 0);
2109		else
2110			kbd_led_set_by_kbd(asus, asus->kbd_led_wk + 1);
2111		return;
2112	}
2113
2114	if (code == NOTIFY_FNLOCK_TOGGLE) {
2115		asus->fnlock_locked = !asus->fnlock_locked;
2116		asus_wmi_fnlock_update(asus);
2117		return;
2118	}
2119
2120	if (asus->driver->quirks->use_kbd_dock_devid && code == NOTIFY_KBD_DOCK_CHANGE) {
2121		result = asus_wmi_get_devstate_simple(asus,
2122						      ASUS_WMI_DEVID_KBD_DOCK);
2123		if (result >= 0) {
2124			input_report_switch(asus->inputdev, SW_TABLET_MODE,
2125					    !result);
2126			input_sync(asus->inputdev);
2127		}
2128		return;
2129	}
2130
2131	if (asus->fan_boost_mode_available && code == NOTIFY_KBD_FBM) {
2132		fan_boost_mode_switch_next(asus);
2133		return;
2134	}
2135
2136	if (asus->throttle_thermal_policy_available && code == NOTIFY_KBD_TTP) {
2137		throttle_thermal_policy_switch_next(asus);
2138		return;
2139	}
2140
2141	if (is_display_toggle(code) && asus->driver->quirks->no_display_toggle)
2142		return;
2143
2144	if (!sparse_keymap_report_event(asus->inputdev, code,
2145					key_value, autorelease))
2146		pr_info("Unknown key %x pressed\n", code);
2147}
2148
2149static void asus_wmi_notify(u32 value, void *context)
2150{
2151	struct asus_wmi *asus = context;
2152	int code;
2153	int i;
2154
2155	for (i = 0; i < WMI_EVENT_QUEUE_SIZE + 1; i++) {
2156		code = asus_wmi_get_event_code(value);
2157		if (code < 0) {
2158			pr_warn("Failed to get notify code: %d\n", code);
2159			return;
2160		}
2161
2162		if (code == WMI_EVENT_QUEUE_END || code == WMI_EVENT_MASK)
2163			return;
2164
2165		asus_wmi_handle_event_code(code, asus);
2166
2167		/*
2168		 * Double check that queue is present:
2169		 * ATK (with queue) uses 0xff, ASUSWMI (without) 0xd2.
2170		 */
2171		if (!asus->wmi_event_queue || value != WMI_EVENT_VALUE_ATK)
2172			return;
2173	}
2174
2175	pr_warn("Failed to process event queue, last code: 0x%x\n", code);
2176}
2177
2178static int asus_wmi_notify_queue_flush(struct asus_wmi *asus)
 
 
 
2179{
2180	int code;
2181	int i;
2182
2183	for (i = 0; i < WMI_EVENT_QUEUE_SIZE + 1; i++) {
2184		code = asus_wmi_get_event_code(WMI_EVENT_VALUE_ATK);
2185		if (code < 0) {
2186			pr_warn("Failed to get event during flush: %d\n", code);
2187			return code;
2188		}
2189
2190		if (code == WMI_EVENT_QUEUE_END || code == WMI_EVENT_MASK)
2191			return 0;
2192	}
2193
2194	pr_warn("Failed to flush event queue\n");
2195	return -EIO;
2196}
2197
2198/* Sysfs **********************************************************************/
2199
2200static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
2201			     const char *buf, size_t count)
2202{
2203	u32 retval;
2204	int err, value;
2205
2206	value = asus_wmi_get_devstate_simple(asus, devid);
2207	if (value < 0)
2208		return value;
2209
2210	err = kstrtoint(buf, 0, &value);
2211	if (err)
2212		return err;
2213
2214	err = asus_wmi_set_devstate(devid, value, &retval);
2215	if (err < 0)
2216		return err;
2217
2218	return count;
2219}
2220
2221static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
2222{
2223	int value = asus_wmi_get_devstate_simple(asus, devid);
2224
2225	if (value < 0)
2226		return value;
2227
2228	return sprintf(buf, "%d\n", value);
2229}
2230
2231#define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)			\
2232	static ssize_t show_##_name(struct device *dev,			\
2233				    struct device_attribute *attr,	\
2234				    char *buf)				\
2235	{								\
2236		struct asus_wmi *asus = dev_get_drvdata(dev);		\
2237									\
2238		return show_sys_wmi(asus, _cm, buf);			\
2239	}								\
2240	static ssize_t store_##_name(struct device *dev,		\
2241				     struct device_attribute *attr,	\
2242				     const char *buf, size_t count)	\
2243	{								\
2244		struct asus_wmi *asus = dev_get_drvdata(dev);		\
2245									\
2246		return store_sys_wmi(asus, _cm, buf, count);		\
2247	}								\
2248	static struct device_attribute dev_attr_##_name = {		\
2249		.attr = {						\
2250			.name = __stringify(_name),			\
2251			.mode = _mode },				\
2252		.show   = show_##_name,					\
2253		.store  = store_##_name,				\
2254	}
2255
2256ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
2257ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
2258ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
2259ASUS_WMI_CREATE_DEVICE_ATTR(lid_resume, 0644, ASUS_WMI_DEVID_LID_RESUME);
2260ASUS_WMI_CREATE_DEVICE_ATTR(als_enable, 0644, ASUS_WMI_DEVID_ALS_ENABLE);
2261
2262static ssize_t cpufv_store(struct device *dev, struct device_attribute *attr,
2263			   const char *buf, size_t count)
2264{
2265	int value, rv;
2266
2267	rv = kstrtoint(buf, 0, &value);
2268	if (rv)
2269		return rv;
2270
2271	if (value < 0 || value > 2)
2272		return -EINVAL;
2273
2274	rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
2275	if (rv < 0)
2276		return rv;
2277
2278	return count;
2279}
2280
2281static DEVICE_ATTR_WO(cpufv);
2282
2283static struct attribute *platform_attributes[] = {
2284	&dev_attr_cpufv.attr,
2285	&dev_attr_camera.attr,
2286	&dev_attr_cardr.attr,
2287	&dev_attr_touchpad.attr,
2288	&dev_attr_lid_resume.attr,
2289	&dev_attr_als_enable.attr,
2290	&dev_attr_fan_boost_mode.attr,
2291	&dev_attr_throttle_thermal_policy.attr,
2292	NULL
2293};
2294
2295static umode_t asus_sysfs_is_visible(struct kobject *kobj,
2296				    struct attribute *attr, int idx)
2297{
2298	struct device *dev = container_of(kobj, struct device, kobj);
2299	struct asus_wmi *asus = dev_get_drvdata(dev);
 
2300	bool ok = true;
2301	int devid = -1;
2302
2303	if (attr == &dev_attr_camera.attr)
2304		devid = ASUS_WMI_DEVID_CAMERA;
2305	else if (attr == &dev_attr_cardr.attr)
2306		devid = ASUS_WMI_DEVID_CARDREADER;
2307	else if (attr == &dev_attr_touchpad.attr)
2308		devid = ASUS_WMI_DEVID_TOUCHPAD;
2309	else if (attr == &dev_attr_lid_resume.attr)
2310		devid = ASUS_WMI_DEVID_LID_RESUME;
2311	else if (attr == &dev_attr_als_enable.attr)
2312		devid = ASUS_WMI_DEVID_ALS_ENABLE;
2313	else if (attr == &dev_attr_fan_boost_mode.attr)
2314		ok = asus->fan_boost_mode_available;
2315	else if (attr == &dev_attr_throttle_thermal_policy.attr)
2316		ok = asus->throttle_thermal_policy_available;
2317
2318	if (devid != -1)
2319		ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
2320
2321	return ok ? attr->mode : 0;
2322}
2323
2324static const struct attribute_group platform_attribute_group = {
2325	.is_visible = asus_sysfs_is_visible,
2326	.attrs = platform_attributes
2327};
2328
2329static void asus_wmi_sysfs_exit(struct platform_device *device)
2330{
2331	sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
2332}
2333
2334static int asus_wmi_sysfs_init(struct platform_device *device)
2335{
2336	return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
2337}
2338
2339/* Platform device ************************************************************/
2340
 
2341static int asus_wmi_platform_init(struct asus_wmi *asus)
2342{
2343	struct device *dev = &asus->platform_device->dev;
2344	char *wmi_uid;
2345	int rv;
2346
2347	/* INIT enable hotkeys on some models */
2348	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
2349		pr_info("Initialization: %#x\n", rv);
2350
2351	/* We don't know yet what to do with this version... */
2352	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
2353		pr_info("BIOS WMI version: %d.%d\n", rv >> 16, rv & 0xFF);
2354		asus->spec = rv;
2355	}
2356
2357	/*
2358	 * The SFUN method probably allows the original driver to get the list
2359	 * of features supported by a given model. For now, 0x0100 or 0x0800
2360	 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
2361	 * The significance of others is yet to be found.
2362	 */
2363	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
2364		pr_info("SFUN value: %#x\n", rv);
2365		asus->sfun = rv;
2366	}
2367
2368	/*
2369	 * Eee PC and Notebooks seems to have different method_id for DSTS,
2370	 * but it may also be related to the BIOS's SPEC.
2371	 * Note, on most Eeepc, there is no way to check if a method exist
2372	 * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
2373	 * but once again, SPEC may probably be used for that kind of things.
2374	 *
2375	 * Additionally at least TUF Gaming series laptops return nothing for
2376	 * unknown methods, so the detection in this way is not possible.
2377	 *
2378	 * There is strong indication that only ACPI WMI devices that have _UID
2379	 * equal to "ASUSWMI" use DCTS whereas those with "ATK" use DSTS.
2380	 */
2381	wmi_uid = wmi_get_acpi_device_uid(ASUS_WMI_MGMT_GUID);
2382	if (!wmi_uid)
2383		return -ENODEV;
2384
2385	if (!strcmp(wmi_uid, ASUS_ACPI_UID_ASUSWMI)) {
2386		dev_info(dev, "Detected ASUSWMI, use DCTS\n");
2387		asus->dsts_id = ASUS_WMI_METHODID_DCTS;
2388	} else {
2389		dev_info(dev, "Detected %s, not ASUSWMI, use DSTS\n", wmi_uid);
2390		asus->dsts_id = ASUS_WMI_METHODID_DSTS;
2391	}
 
2392
2393	/*
2394	 * Some devices can have multiple event codes stored in a queue before
2395	 * the module load if it was unloaded intermittently after calling
2396	 * the INIT method (enables event handling). The WMI notify handler is
2397	 * expected to retrieve all event codes until a retrieved code equals
2398	 * queue end marker (One or Ones). Old codes are flushed from the queue
2399	 * upon module load. Not enabling this when it should be has minimal
2400	 * visible impact so fall back if anything goes wrong.
2401	 */
2402	wmi_uid = wmi_get_acpi_device_uid(asus->driver->event_guid);
2403	if (wmi_uid && !strcmp(wmi_uid, ASUS_ACPI_UID_ATK)) {
2404		dev_info(dev, "Detected ATK, enable event queue\n");
2405
2406		if (!asus_wmi_notify_queue_flush(asus))
2407			asus->wmi_event_queue = true;
2408	}
2409
2410	/* CWAP allow to define the behavior of the Fn+F2 key,
2411	 * this method doesn't seems to be present on Eee PCs */
2412	if (asus->driver->quirks->wapf >= 0)
2413		asus_wmi_set_devstate(ASUS_WMI_DEVID_CWAP,
2414				      asus->driver->quirks->wapf, NULL);
2415
2416	return 0;
2417}
2418
2419/* debugfs ********************************************************************/
 
 
 
2420
 
 
 
2421struct asus_wmi_debugfs_node {
2422	struct asus_wmi *asus;
2423	char *name;
2424	int (*show) (struct seq_file *m, void *data);
2425};
2426
2427static int show_dsts(struct seq_file *m, void *data)
2428{
2429	struct asus_wmi *asus = m->private;
2430	int err;
2431	u32 retval = -1;
2432
2433	err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
 
2434	if (err < 0)
2435		return err;
2436
2437	seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
2438
2439	return 0;
2440}
2441
2442static int show_devs(struct seq_file *m, void *data)
2443{
2444	struct asus_wmi *asus = m->private;
2445	int err;
2446	u32 retval = -1;
2447
2448	err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
2449				    &retval);
 
2450	if (err < 0)
2451		return err;
2452
2453	seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
2454		   asus->debug.ctrl_param, retval);
2455
2456	return 0;
2457}
2458
2459static int show_call(struct seq_file *m, void *data)
2460{
2461	struct asus_wmi *asus = m->private;
2462	struct bios_args args = {
2463		.arg0 = asus->debug.dev_id,
2464		.arg1 = asus->debug.ctrl_param,
2465	};
2466	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
2467	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
2468	union acpi_object *obj;
2469	acpi_status status;
2470
2471	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
2472				     0, asus->debug.method_id,
2473				     &input, &output);
2474
2475	if (ACPI_FAILURE(status))
2476		return -EIO;
2477
2478	obj = (union acpi_object *)output.pointer;
2479	if (obj && obj->type == ACPI_TYPE_INTEGER)
2480		seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
2481			   asus->debug.dev_id, asus->debug.ctrl_param,
2482			   (u32) obj->integer.value);
2483	else
2484		seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
2485			   asus->debug.dev_id, asus->debug.ctrl_param,
2486			   obj ? obj->type : -1);
2487
2488	kfree(obj);
2489
2490	return 0;
2491}
2492
2493static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
2494	{NULL, "devs", show_devs},
2495	{NULL, "dsts", show_dsts},
2496	{NULL, "call", show_call},
2497};
2498
2499static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
2500{
2501	struct asus_wmi_debugfs_node *node = inode->i_private;
2502
2503	return single_open(file, node->show, node->asus);
2504}
2505
2506static const struct file_operations asus_wmi_debugfs_io_ops = {
2507	.owner = THIS_MODULE,
2508	.open = asus_wmi_debugfs_open,
2509	.read = seq_read,
2510	.llseek = seq_lseek,
2511	.release = single_release,
2512};
2513
2514static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
2515{
2516	debugfs_remove_recursive(asus->debug.root);
2517}
2518
2519static void asus_wmi_debugfs_init(struct asus_wmi *asus)
2520{
 
2521	int i;
2522
2523	asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
2524
2525	debugfs_create_x32("method_id", S_IRUGO | S_IWUSR, asus->debug.root,
2526			   &asus->debug.method_id);
2527
2528	debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR, asus->debug.root,
2529			   &asus->debug.dev_id);
2530
2531	debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR, asus->debug.root,
2532			   &asus->debug.ctrl_param);
 
 
 
 
 
 
 
 
 
 
2533
2534	for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
2535		struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
2536
2537		node->asus = asus;
2538		debugfs_create_file(node->name, S_IFREG | S_IRUGO,
2539				    asus->debug.root, node,
2540				    &asus_wmi_debugfs_io_ops);
 
 
 
 
2541	}
 
 
 
 
 
 
2542}
2543
2544/* Init / exit ****************************************************************/
2545
 
2546static int asus_wmi_add(struct platform_device *pdev)
2547{
2548	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2549	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2550	struct asus_wmi *asus;
2551	const char *chassis_type;
2552	acpi_status status;
2553	int err;
2554	u32 result;
2555
2556	asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
2557	if (!asus)
2558		return -ENOMEM;
2559
2560	asus->driver = wdrv;
2561	asus->platform_device = pdev;
2562	wdrv->platform_device = pdev;
2563	platform_set_drvdata(asus->platform_device, asus);
2564
2565	if (wdrv->detect_quirks)
2566		wdrv->detect_quirks(asus->driver);
2567
2568	err = asus_wmi_platform_init(asus);
2569	if (err)
2570		goto fail_platform;
2571
2572	err = fan_boost_mode_check_present(asus);
2573	if (err)
2574		goto fail_fan_boost_mode;
2575
2576	err = throttle_thermal_policy_check_present(asus);
2577	if (err)
2578		goto fail_throttle_thermal_policy;
2579	else
2580		throttle_thermal_policy_set_default(asus);
2581
2582	err = asus_wmi_sysfs_init(asus->platform_device);
2583	if (err)
2584		goto fail_sysfs;
2585
2586	err = asus_wmi_input_init(asus);
2587	if (err)
2588		goto fail_input;
2589
2590	err = asus_wmi_fan_init(asus); /* probably no problems on error */
2591
2592	err = asus_wmi_hwmon_init(asus);
2593	if (err)
2594		goto fail_hwmon;
2595
2596	err = asus_wmi_led_init(asus);
2597	if (err)
2598		goto fail_leds;
2599
2600	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WLAN, &result);
2601	if (result & (ASUS_WMI_DSTS_PRESENCE_BIT | ASUS_WMI_DSTS_USER_BIT))
2602		asus->driver->wlan_ctrl_by_user = 1;
2603
2604	if (!(asus->driver->wlan_ctrl_by_user && ashs_present())) {
2605		err = asus_wmi_rfkill_init(asus);
2606		if (err)
2607			goto fail_rfkill;
2608	}
2609
2610	if (asus->driver->quirks->wmi_force_als_set)
2611		asus_wmi_set_als();
2612
2613	/* Some Asus desktop boards export an acpi-video backlight interface,
2614	   stop this from showing up */
2615	chassis_type = dmi_get_system_info(DMI_CHASSIS_TYPE);
2616	if (chassis_type && !strcmp(chassis_type, "3"))
2617		acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2618
2619	if (asus->driver->quirks->wmi_backlight_power)
2620		acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2621
2622	if (asus->driver->quirks->wmi_backlight_native)
2623		acpi_video_set_dmi_backlight_type(acpi_backlight_native);
2624
2625	if (asus->driver->quirks->xusb2pr)
2626		asus_wmi_set_xusb2pr(asus);
2627
2628	if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
2629		err = asus_wmi_backlight_init(asus);
2630		if (err && err != -ENODEV)
2631			goto fail_backlight;
2632	} else if (asus->driver->quirks->wmi_backlight_set_devstate)
2633		err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT, 2, NULL);
2634
2635	if (asus_wmi_has_fnlock_key(asus)) {
2636		asus->fnlock_locked = true;
2637		asus_wmi_fnlock_update(asus);
2638	}
2639
2640	status = wmi_install_notify_handler(asus->driver->event_guid,
2641					    asus_wmi_notify, asus);
2642	if (ACPI_FAILURE(status)) {
2643		pr_err("Unable to register notify handler - %d\n", status);
2644		err = -ENODEV;
2645		goto fail_wmi_handler;
2646	}
2647
2648	asus_wmi_battery_init(asus);
2649
2650	asus_wmi_debugfs_init(asus);
2651
2652	return 0;
2653
 
 
2654fail_wmi_handler:
2655	asus_wmi_backlight_exit(asus);
2656fail_backlight:
2657	asus_wmi_rfkill_exit(asus);
2658fail_rfkill:
2659	asus_wmi_led_exit(asus);
2660fail_leds:
 
2661fail_hwmon:
2662	asus_wmi_input_exit(asus);
2663fail_input:
2664	asus_wmi_sysfs_exit(asus->platform_device);
2665fail_sysfs:
2666fail_throttle_thermal_policy:
2667fail_fan_boost_mode:
2668fail_platform:
2669	kfree(asus);
2670	return err;
2671}
2672
2673static int asus_wmi_remove(struct platform_device *device)
2674{
2675	struct asus_wmi *asus;
2676
2677	asus = platform_get_drvdata(device);
2678	wmi_remove_notify_handler(asus->driver->event_guid);
2679	asus_wmi_backlight_exit(asus);
2680	asus_wmi_input_exit(asus);
 
2681	asus_wmi_led_exit(asus);
2682	asus_wmi_rfkill_exit(asus);
2683	asus_wmi_debugfs_exit(asus);
2684	asus_wmi_sysfs_exit(asus->platform_device);
2685	asus_fan_set_auto(asus);
2686	asus_wmi_battery_exit(asus);
2687
2688	kfree(asus);
2689	return 0;
2690}
2691
2692/* Platform driver - hibernate/resume callbacks *******************************/
2693
 
2694static int asus_hotk_thaw(struct device *device)
2695{
2696	struct asus_wmi *asus = dev_get_drvdata(device);
2697
2698	if (asus->wlan.rfkill) {
2699		bool wlan;
2700
2701		/*
2702		 * Work around bios bug - acpi _PTS turns off the wireless led
2703		 * during suspend.  Normally it restores it on resume, but
2704		 * we should kick it ourselves in case hibernation is aborted.
2705		 */
2706		wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
2707		asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
2708	}
2709
2710	return 0;
2711}
2712
2713static int asus_hotk_resume(struct device *device)
2714{
2715	struct asus_wmi *asus = dev_get_drvdata(device);
2716
2717	if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2718		kbd_led_update(asus);
2719
2720	if (asus_wmi_has_fnlock_key(asus))
2721		asus_wmi_fnlock_update(asus);
2722	return 0;
2723}
2724
2725static int asus_hotk_restore(struct device *device)
2726{
2727	struct asus_wmi *asus = dev_get_drvdata(device);
2728	int bl;
2729
2730	/* Refresh both wlan rfkill state and pci hotplug */
2731	if (asus->wlan.rfkill)
2732		asus_rfkill_hotplug(asus);
2733
2734	if (asus->bluetooth.rfkill) {
2735		bl = !asus_wmi_get_devstate_simple(asus,
2736						   ASUS_WMI_DEVID_BLUETOOTH);
2737		rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
2738	}
2739	if (asus->wimax.rfkill) {
2740		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
2741		rfkill_set_sw_state(asus->wimax.rfkill, bl);
2742	}
2743	if (asus->wwan3g.rfkill) {
2744		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
2745		rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
2746	}
2747	if (asus->gps.rfkill) {
2748		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_GPS);
2749		rfkill_set_sw_state(asus->gps.rfkill, bl);
2750	}
2751	if (asus->uwb.rfkill) {
2752		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_UWB);
2753		rfkill_set_sw_state(asus->uwb.rfkill, bl);
2754	}
2755	if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2756		kbd_led_update(asus);
2757
2758	if (asus_wmi_has_fnlock_key(asus))
2759		asus_wmi_fnlock_update(asus);
2760	return 0;
2761}
2762
2763static const struct dev_pm_ops asus_pm_ops = {
2764	.thaw = asus_hotk_thaw,
2765	.restore = asus_hotk_restore,
2766	.resume = asus_hotk_resume,
2767};
2768
2769/* Registration ***************************************************************/
2770
2771static int asus_wmi_probe(struct platform_device *pdev)
2772{
2773	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2774	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2775	int ret;
2776
2777	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
2778		pr_warn("ASUS Management GUID not found\n");
2779		return -ENODEV;
2780	}
2781
2782	if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
2783		pr_warn("ASUS Event GUID not found\n");
2784		return -ENODEV;
2785	}
2786
2787	if (wdrv->probe) {
2788		ret = wdrv->probe(pdev);
2789		if (ret)
2790			return ret;
2791	}
2792
2793	return asus_wmi_add(pdev);
2794}
2795
2796static bool used;
2797
2798int __init_or_module asus_wmi_register_driver(struct asus_wmi_driver *driver)
2799{
2800	struct platform_driver *platform_driver;
2801	struct platform_device *platform_device;
2802
2803	if (used)
2804		return -EBUSY;
2805
2806	platform_driver = &driver->platform_driver;
2807	platform_driver->remove = asus_wmi_remove;
2808	platform_driver->driver.owner = driver->owner;
2809	platform_driver->driver.name = driver->name;
2810	platform_driver->driver.pm = &asus_pm_ops;
2811
2812	platform_device = platform_create_bundle(platform_driver,
2813						 asus_wmi_probe,
2814						 NULL, 0, NULL, 0);
2815	if (IS_ERR(platform_device))
2816		return PTR_ERR(platform_device);
2817
2818	used = true;
2819	return 0;
2820}
2821EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
2822
2823void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
2824{
2825	platform_device_unregister(driver->platform_device);
2826	platform_driver_unregister(&driver->platform_driver);
2827	used = false;
2828}
2829EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
2830
2831static int __init asus_wmi_init(void)
2832{
2833	pr_info("ASUS WMI generic driver loaded\n");
 
 
 
 
 
2834	return 0;
2835}
2836
2837static void __exit asus_wmi_exit(void)
2838{
2839	pr_info("ASUS WMI generic driver unloaded\n");
2840}
2841
2842module_init(asus_wmi_init);
2843module_exit(asus_wmi_exit);