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