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

27 28
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

29 30 31 32
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
T
Tejun Heo 已提交
33
#include <linux/slab.h>
34 35
#include <linux/input.h>
#include <linux/input/sparse-keymap.h>
Y
Yong Wang 已提交
36 37
#include <linux/fb.h>
#include <linux/backlight.h>
38
#include <linux/leds.h>
39
#include <linux/rfkill.h>
40 41
#include <linux/pci.h>
#include <linux/pci_hotplug.h>
42 43
#include <linux/hwmon.h>
#include <linux/hwmon-sysfs.h>
C
Corentin Chary 已提交
44 45
#include <linux/debugfs.h>
#include <linux/seq_file.h>
46
#include <linux/platform_device.h>
C
Corentin Chary 已提交
47
#include <linux/thermal.h>
48
#include <linux/acpi.h>
49
#include <linux/dmi.h>
50
#include <acpi/video.h>
51

52
#include "asus-wmi.h"
53

C
Corentin Chary 已提交
54
MODULE_AUTHOR("Corentin Chary <corentin.chary@gmail.com>, "
55 56
	      "Yong Wang <yong.y.wang@intel.com>");
MODULE_DESCRIPTION("Asus Generic WMI Driver");
57 58
MODULE_LICENSE("GPL");

59 60
#define to_platform_driver(drv)					\
	(container_of((drv), struct platform_driver, driver))
61

62 63
#define to_asus_wmi_driver(pdrv)					\
	(container_of((pdrv), struct asus_wmi_driver, platform_driver))
64

65
#define ASUS_WMI_MGMT_GUID	"97845ED0-4E6D-11DE-8A39-0800200C9A66"
66

C
Corentin Chary 已提交
67 68 69 70
#define NOTIFY_BRNUP_MIN		0x11
#define NOTIFY_BRNUP_MAX		0x1f
#define NOTIFY_BRNDOWN_MIN		0x20
#define NOTIFY_BRNDOWN_MAX		0x2e
71 72
#define NOTIFY_KBD_BRTUP		0xc4
#define NOTIFY_KBD_BRTDWN		0xc5
73

C
Corentin Chary 已提交
74
/* WMI Methods */
75 76 77 78 79 80
#define ASUS_WMI_METHODID_SPEC	        0x43455053 /* BIOS SPECification */
#define ASUS_WMI_METHODID_SFBD		0x44424653 /* Set First Boot Device */
#define ASUS_WMI_METHODID_GLCD		0x44434C47 /* Get LCD status */
#define ASUS_WMI_METHODID_GPID		0x44495047 /* Get Panel ID?? (Resol) */
#define ASUS_WMI_METHODID_QMOD		0x444F4D51 /* Quiet MODe */
#define ASUS_WMI_METHODID_SPLV		0x4C425053 /* Set Panel Light Value */
K
Kast Bernd 已提交
81
#define ASUS_WMI_METHODID_AGFN		0x4E464741 /* FaN? */
82 83 84 85 86 87 88 89 90 91 92 93 94
#define ASUS_WMI_METHODID_SFUN		0x4E554653 /* FUNCtionalities */
#define ASUS_WMI_METHODID_SDSP		0x50534453 /* Set DiSPlay output */
#define ASUS_WMI_METHODID_GDSP		0x50534447 /* Get DiSPlay output */
#define ASUS_WMI_METHODID_DEVP		0x50564544 /* DEVice Policy */
#define ASUS_WMI_METHODID_OSVR		0x5256534F /* OS VeRsion */
#define ASUS_WMI_METHODID_DSTS		0x53544344 /* Device STatuS */
#define ASUS_WMI_METHODID_DSTS2		0x53545344 /* Device STatuS #2*/
#define ASUS_WMI_METHODID_BSTS		0x53545342 /* Bios STatuS ? */
#define ASUS_WMI_METHODID_DEVS		0x53564544 /* DEVice Set */
#define ASUS_WMI_METHODID_CFVS		0x53564643 /* CPU Frequency Volt Set */
#define ASUS_WMI_METHODID_KBFT		0x5446424B /* KeyBoard FilTer */
#define ASUS_WMI_METHODID_INIT		0x54494E49 /* INITialize */
#define ASUS_WMI_METHODID_HKEY		0x59454B48 /* Hot KEY ?? */
Y
Yong Wang 已提交
95

96 97
#define ASUS_WMI_UNSUPPORTED_METHOD	0xFFFFFFFE

C
Corentin Chary 已提交
98
/* Wireless */
99 100
#define ASUS_WMI_DEVID_HW_SWITCH	0x00010001
#define ASUS_WMI_DEVID_WIRELESS_LED	0x00010002
C
Corentin Chary 已提交
101
#define ASUS_WMI_DEVID_CWAP		0x00010003
102
#define ASUS_WMI_DEVID_WLAN		0x00010011
103
#define ASUS_WMI_DEVID_WLAN_LED		0x00010012
104
#define ASUS_WMI_DEVID_BLUETOOTH	0x00010013
105
#define ASUS_WMI_DEVID_GPS		0x00010015
106 107
#define ASUS_WMI_DEVID_WIMAX		0x00010017
#define ASUS_WMI_DEVID_WWAN3G		0x00010019
108 109 110 111
#define ASUS_WMI_DEVID_UWB		0x00010021

/* Leds */
/* 0x000200XX and 0x000400XX */
C
Corentin Chary 已提交
112 113 114 115 116 117
#define ASUS_WMI_DEVID_LED1		0x00020011
#define ASUS_WMI_DEVID_LED2		0x00020012
#define ASUS_WMI_DEVID_LED3		0x00020013
#define ASUS_WMI_DEVID_LED4		0x00020014
#define ASUS_WMI_DEVID_LED5		0x00020015
#define ASUS_WMI_DEVID_LED6		0x00020016
C
Corentin Chary 已提交
118 119

/* Backlight and Brightness */
120 121
#define ASUS_WMI_DEVID_BACKLIGHT	0x00050011
#define ASUS_WMI_DEVID_BRIGHTNESS	0x00050012
122 123
#define ASUS_WMI_DEVID_KBD_BACKLIGHT	0x00050021
#define ASUS_WMI_DEVID_LIGHT_SENSOR	0x00050022 /* ?? */
C
Corentin Chary 已提交
124 125

/* Misc */
126
#define ASUS_WMI_DEVID_CAMERA		0x00060013
C
Corentin Chary 已提交
127 128

/* Storage */
129
#define ASUS_WMI_DEVID_CARDREADER	0x00080013
C
Corentin Chary 已提交
130 131

/* Input */
C
Corentin Chary 已提交
132
#define ASUS_WMI_DEVID_TOUCHPAD		0x00100011
133
#define ASUS_WMI_DEVID_TOUCHPAD_LED	0x00100012
Y
Yong Wang 已提交
134

135 136 137 138 139 140 141
/* Fan, Thermal */
#define ASUS_WMI_DEVID_THERMAL_CTRL	0x00110011
#define ASUS_WMI_DEVID_FAN_CTRL		0x00110012

/* Power */
#define ASUS_WMI_DEVID_PROCESSOR_STATE	0x00120012

A
AceLan Kao 已提交
142 143 144
/* Deep S3 / Resume on LID open */
#define ASUS_WMI_DEVID_LID_RESUME	0x00120031

C
Corentin Chary 已提交
145
/* DSTS masks */
146
#define ASUS_WMI_DSTS_STATUS_BIT	0x00000001
147
#define ASUS_WMI_DSTS_UNKNOWN_BIT	0x00000002
148
#define ASUS_WMI_DSTS_PRESENCE_BIT	0x00010000
149 150
#define ASUS_WMI_DSTS_USER_BIT		0x00020000
#define ASUS_WMI_DSTS_BIOS_BIT		0x00040000
151 152
#define ASUS_WMI_DSTS_BRIGHTNESS_MASK	0x000000FF
#define ASUS_WMI_DSTS_MAX_BRIGTH_MASK	0x0000FF00
153

K
Kast Bernd 已提交
154 155 156 157 158 159 160
#define ASUS_FAN_DESC			"cpu_fan"
#define ASUS_FAN_MFUN			0x13
#define ASUS_FAN_SFUN_READ		0x06
#define ASUS_FAN_SFUN_WRITE		0x07
#define ASUS_FAN_CTRL_MANUAL		1
#define ASUS_FAN_CTRL_AUTO		2

Y
Yong Wang 已提交
161
struct bios_args {
162 163 164
	u32 arg0;
	u32 arg1;
} __packed;
Y
Yong Wang 已提交
165

K
Kast Bernd 已提交
166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184
/*
 * Struct that's used for all methods called via AGFN. Naming is
 * identically to the AML code.
 */
struct agfn_args {
	u16 mfun; /* probably "Multi-function" to be called */
	u16 sfun; /* probably "Sub-function" to be called */
	u16 len;  /* size of the hole struct, including subfunction fields */
	u8 stas;  /* not used by now */
	u8 err;   /* zero on success */
} __packed;

/* struct used for calling fan read and write methods */
struct fan_args {
	struct agfn_args agfn;	/* common fields */
	u8 fan;			/* fan number: 0: set auto mode 1: 1st fan */
	u32 speed;		/* read: RPM/100 - write: 0-255 */
} __packed;

C
Corentin Chary 已提交
185
/*
186
 * <platform>/    - debugfs root directory
C
Corentin Chary 已提交
187 188
 *   dev_id      - current dev_id
 *   ctrl_param  - current ctrl_param
189
 *   method_id   - current method_id
C
Corentin Chary 已提交
190 191
 *   devs        - call DEVS(dev_id, ctrl_param) and print result
 *   dsts        - call DSTS(dev_id)  and print result
192
 *   call        - call method_id(dev_id, ctrl_param) and print result
C
Corentin Chary 已提交
193
 */
194
struct asus_wmi_debug {
C
Corentin Chary 已提交
195
	struct dentry *root;
196
	u32 method_id;
C
Corentin Chary 已提交
197 198 199 200
	u32 dev_id;
	u32 ctrl_param;
};

201 202 203 204 205 206
struct asus_rfkill {
	struct asus_wmi *asus;
	struct rfkill *rfkill;
	u32 dev_id;
};

207
struct asus_wmi {
208
	int dsts_id;
209 210
	int spec;
	int sfun;
211

212
	struct input_dev *inputdev;
Y
Yong Wang 已提交
213
	struct backlight_device *backlight_device;
214
	struct platform_device *platform_device;
215

216 217
	struct led_classdev wlan_led;
	int wlan_led_wk;
218 219
	struct led_classdev tpd_led;
	int tpd_led_wk;
220 221
	struct led_classdev kbd_led;
	int kbd_led_wk;
222 223
	struct workqueue_struct *led_workqueue;
	struct work_struct tpd_led_work;
224
	struct work_struct kbd_led_work;
225
	struct work_struct wlan_led_work;
226

227 228 229 230
	struct asus_rfkill wlan;
	struct asus_rfkill bluetooth;
	struct asus_rfkill wimax;
	struct asus_rfkill wwan3g;
231
	struct asus_rfkill gps;
232
	struct asus_rfkill uwb;
C
Corentin Chary 已提交
233

K
Kast Bernd 已提交
234 235 236 237
	bool asus_hwmon_fan_manual_mode;
	int asus_hwmon_num_fans;
	int asus_hwmon_pwm;

238 239
	struct hotplug_slot *hotplug_slot;
	struct mutex hotplug_lock;
240 241 242
	struct mutex wmi_lock;
	struct workqueue_struct *hotplug_workqueue;
	struct work_struct hotplug_work;
243

244 245 246
	struct asus_wmi_debug debug;

	struct asus_wmi_driver *driver;
247 248
};

249
static int asus_wmi_input_init(struct asus_wmi *asus)
250 251 252
{
	int err;

253 254
	asus->inputdev = input_allocate_device();
	if (!asus->inputdev)
255 256
		return -ENOMEM;

257 258
	asus->inputdev->name = asus->driver->input_name;
	asus->inputdev->phys = asus->driver->input_phys;
259 260
	asus->inputdev->id.bustype = BUS_HOST;
	asus->inputdev->dev.parent = &asus->platform_device->dev;
261
	set_bit(EV_REP, asus->inputdev->evbit);
262

263
	err = sparse_keymap_setup(asus->inputdev, asus->driver->keymap, NULL);
264 265 266
	if (err)
		goto err_free_dev;

267
	err = input_register_device(asus->inputdev);
268 269 270 271 272 273
	if (err)
		goto err_free_keymap;

	return 0;

err_free_keymap:
274
	sparse_keymap_free(asus->inputdev);
275
err_free_dev:
276
	input_free_device(asus->inputdev);
277 278 279
	return err;
}

280
static void asus_wmi_input_exit(struct asus_wmi *asus)
281
{
282 283 284
	if (asus->inputdev) {
		sparse_keymap_free(asus->inputdev);
		input_unregister_device(asus->inputdev);
285 286
	}

287
	asus->inputdev = NULL;
288 289
}

290 291
static int asus_wmi_evaluate_method(u32 method_id, u32 arg0, u32 arg1,
				    u32 *retval)
Y
Yong Wang 已提交
292
{
293 294 295 296 297
	struct bios_args args = {
		.arg0 = arg0,
		.arg1 = arg1,
	};
	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
Y
Yong Wang 已提交
298 299
	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
	acpi_status status;
300
	union acpi_object *obj;
301
	u32 tmp = 0;
Y
Yong Wang 已提交
302

303
	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 1, method_id,
304
				     &input, &output);
Y
Yong Wang 已提交
305 306

	if (ACPI_FAILURE(status))
307
		goto exit;
Y
Yong Wang 已提交
308 309 310

	obj = (union acpi_object *)output.pointer;
	if (obj && obj->type == ACPI_TYPE_INTEGER)
311
		tmp = (u32) obj->integer.value;
Y
Yong Wang 已提交
312

313 314
	if (retval)
		*retval = tmp;
Y
Yong Wang 已提交
315 316 317

	kfree(obj);

318 319 320 321 322 323
exit:
	if (ACPI_FAILURE(status))
		return -EIO;

	if (tmp == ASUS_WMI_UNSUPPORTED_METHOD)
		return -ENODEV;
Y
Yong Wang 已提交
324

325
	return 0;
Y
Yong Wang 已提交
326 327
}

K
Kast Bernd 已提交
328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357
static int asus_wmi_evaluate_method_agfn(const struct acpi_buffer args)
{
	struct acpi_buffer input;
	u64 phys_addr;
	u32 retval;
	u32 status = -1;

	/*
	 * Copy to dma capable address otherwise memory corruption occurs as
	 * bios has to be able to access it.
	 */
	input.pointer = kzalloc(args.length, GFP_DMA | GFP_KERNEL);
	input.length = args.length;
	if (!input.pointer)
		return -ENOMEM;
	phys_addr = virt_to_phys(input.pointer);
	memcpy(input.pointer, args.pointer, args.length);

	status = asus_wmi_evaluate_method(ASUS_WMI_METHODID_AGFN,
					phys_addr, 0, &retval);
	if (!status)
		memcpy(args.pointer, input.pointer, args.length);

	kfree(input.pointer);
	if (status)
		return -ENXIO;

	return retval;
}

358
static int asus_wmi_get_devstate(struct asus_wmi *asus, u32 dev_id, u32 *retval)
Y
Yong Wang 已提交
359
{
360
	return asus_wmi_evaluate_method(asus->dsts_id, dev_id, 0, retval);
361
}
Y
Yong Wang 已提交
362

363
static int asus_wmi_set_devstate(u32 dev_id, u32 ctrl_param,
364
				 u32 *retval)
365 366 367
{
	return asus_wmi_evaluate_method(ASUS_WMI_METHODID_DEVS, dev_id,
					ctrl_param, retval);
Y
Yong Wang 已提交
368 369
}

370
/* Helper for special devices with magic return codes */
371 372
static int asus_wmi_get_devstate_bits(struct asus_wmi *asus,
				      u32 dev_id, u32 mask)
373 374
{
	u32 retval = 0;
375
	int err;
376

377
	err = asus_wmi_get_devstate(asus, dev_id, &retval);
378

379 380
	if (err < 0)
		return err;
381

382
	if (!(retval & ASUS_WMI_DSTS_PRESENCE_BIT))
383 384
		return -ENODEV;

385 386 387 388 389
	if (mask == ASUS_WMI_DSTS_STATUS_BIT) {
		if (retval & ASUS_WMI_DSTS_UNKNOWN_BIT)
			return -ENODEV;
	}

390 391 392
	return retval & mask;
}

393
static int asus_wmi_get_devstate_simple(struct asus_wmi *asus, u32 dev_id)
394
{
395 396
	return asus_wmi_get_devstate_bits(asus, dev_id,
					  ASUS_WMI_DSTS_STATUS_BIT);
397 398
}

399 400 401 402 403 404
/*
 * LEDs
 */
/*
 * These functions actually update the LED's, and are called from a
 * workqueue. By doing this as separate work rather than when the LED
405
 * subsystem asks, we avoid messing with the Asus ACPI stuff during a
406 407 408 409 410
 * potentially bad time, such as a timer interrupt.
 */
static void tpd_led_update(struct work_struct *work)
{
	int ctrl_param;
411
	struct asus_wmi *asus;
412

413
	asus = container_of(work, struct asus_wmi, tpd_led_work);
414

415 416
	ctrl_param = asus->tpd_led_wk;
	asus_wmi_set_devstate(ASUS_WMI_DEVID_TOUCHPAD_LED, ctrl_param, NULL);
417 418 419 420 421
}

static void tpd_led_set(struct led_classdev *led_cdev,
			enum led_brightness value)
{
422
	struct asus_wmi *asus;
423

424
	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
425

426 427
	asus->tpd_led_wk = !!value;
	queue_work(asus->led_workqueue, &asus->tpd_led_work);
428 429
}

430
static int read_tpd_led_state(struct asus_wmi *asus)
431
{
432
	return asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_TOUCHPAD_LED);
433 434 435 436
}

static enum led_brightness tpd_led_get(struct led_classdev *led_cdev)
{
437
	struct asus_wmi *asus;
438

439
	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
440

441
	return read_tpd_led_state(asus);
442 443
}

444
static void kbd_led_update(struct work_struct *work)
445
{
446 447
	int ctrl_param = 0;
	struct asus_wmi *asus;
448

449
	asus = container_of(work, struct asus_wmi, kbd_led_work);
450

451 452 453 454 455 456
	/*
	 * bits 0-2: level
	 * bit 7: light on/off
	 */
	if (asus->kbd_led_wk > 0)
		ctrl_param = 0x80 | (asus->kbd_led_wk & 0x7F);
457

458 459
	asus_wmi_set_devstate(ASUS_WMI_DEVID_KBD_BACKLIGHT, ctrl_param, NULL);
}
460

461 462 463 464 465 466 467 468 469 470 471 472 473
static int kbd_led_read(struct asus_wmi *asus, int *level, int *env)
{
	int retval;

	/*
	 * bits 0-2: level
	 * bit 7: light on/off
	 * bit 8-10: environment (0: dark, 1: normal, 2: light)
	 * bit 17: status unknown
	 */
	retval = asus_wmi_get_devstate_bits(asus, ASUS_WMI_DEVID_KBD_BACKLIGHT,
					    0xFFFF);

474
	/* Unknown status is considered as off */
475
	if (retval == 0x8000)
476
		retval = 0;
477 478 479

	if (retval >= 0) {
		if (level)
480
			*level = retval & 0x7F;
481 482 483
		if (env)
			*env = (retval >> 8) & 0x7F;
		retval = 0;
484 485
	}

486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517
	return retval;
}

static void kbd_led_set(struct led_classdev *led_cdev,
			enum led_brightness value)
{
	struct asus_wmi *asus;

	asus = container_of(led_cdev, struct asus_wmi, kbd_led);

	if (value > asus->kbd_led.max_brightness)
		value = asus->kbd_led.max_brightness;
	else if (value < 0)
		value = 0;

	asus->kbd_led_wk = value;
	queue_work(asus->led_workqueue, &asus->kbd_led_work);
}

static enum led_brightness kbd_led_get(struct led_classdev *led_cdev)
{
	struct asus_wmi *asus;
	int retval, value;

	asus = container_of(led_cdev, struct asus_wmi, kbd_led);

	retval = kbd_led_read(asus, &value, NULL);

	if (retval < 0)
		return retval;

	return value;
518 519
}

520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570
static int wlan_led_unknown_state(struct asus_wmi *asus)
{
	u32 result;

	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);

	return result & ASUS_WMI_DSTS_UNKNOWN_BIT;
}

static int wlan_led_presence(struct asus_wmi *asus)
{
	u32 result;

	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);

	return result & ASUS_WMI_DSTS_PRESENCE_BIT;
}

static void wlan_led_update(struct work_struct *work)
{
	int ctrl_param;
	struct asus_wmi *asus;

	asus = container_of(work, struct asus_wmi, wlan_led_work);

	ctrl_param = asus->wlan_led_wk;
	asus_wmi_set_devstate(ASUS_WMI_DEVID_WIRELESS_LED, ctrl_param, NULL);
}

static void wlan_led_set(struct led_classdev *led_cdev,
			 enum led_brightness value)
{
	struct asus_wmi *asus;

	asus = container_of(led_cdev, struct asus_wmi, wlan_led);

	asus->wlan_led_wk = !!value;
	queue_work(asus->led_workqueue, &asus->wlan_led_work);
}

static enum led_brightness wlan_led_get(struct led_classdev *led_cdev)
{
	struct asus_wmi *asus;
	u32 result;

	asus = container_of(led_cdev, struct asus_wmi, wlan_led);
	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);

	return result & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
}

571
static void asus_wmi_led_exit(struct asus_wmi *asus)
572
{
573 574 575
	if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
		led_classdev_unregister(&asus->kbd_led);
	if (!IS_ERR_OR_NULL(asus->tpd_led.dev))
576
		led_classdev_unregister(&asus->tpd_led);
577 578
	if (!IS_ERR_OR_NULL(asus->wlan_led.dev))
		led_classdev_unregister(&asus->wlan_led);
579 580
	if (asus->led_workqueue)
		destroy_workqueue(asus->led_workqueue);
581 582
}

583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614
static int asus_wmi_led_init(struct asus_wmi *asus)
{
	int rv = 0;

	asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
	if (!asus->led_workqueue)
		return -ENOMEM;

	if (read_tpd_led_state(asus) >= 0) {
		INIT_WORK(&asus->tpd_led_work, tpd_led_update);

		asus->tpd_led.name = "asus::touchpad";
		asus->tpd_led.brightness_set = tpd_led_set;
		asus->tpd_led.brightness_get = tpd_led_get;
		asus->tpd_led.max_brightness = 1;

		rv = led_classdev_register(&asus->platform_device->dev,
					   &asus->tpd_led);
		if (rv)
			goto error;
	}

	if (kbd_led_read(asus, NULL, NULL) >= 0) {
		INIT_WORK(&asus->kbd_led_work, kbd_led_update);

		asus->kbd_led.name = "asus::kbd_backlight";
		asus->kbd_led.brightness_set = kbd_led_set;
		asus->kbd_led.brightness_get = kbd_led_get;
		asus->kbd_led.max_brightness = 3;

		rv = led_classdev_register(&asus->platform_device->dev,
					   &asus->kbd_led);
615 616 617 618
		if (rv)
			goto error;
	}

619
	if (wlan_led_presence(asus) && (asus->driver->quirks->wapf > 0)) {
620 621 622 623 624 625 626 627 628 629 630 631
		INIT_WORK(&asus->wlan_led_work, wlan_led_update);

		asus->wlan_led.name = "asus::wlan";
		asus->wlan_led.brightness_set = wlan_led_set;
		if (!wlan_led_unknown_state(asus))
			asus->wlan_led.brightness_get = wlan_led_get;
		asus->wlan_led.flags = LED_CORE_SUSPENDRESUME;
		asus->wlan_led.max_brightness = 1;
		asus->wlan_led.default_trigger = "asus-wlan";

		rv = led_classdev_register(&asus->platform_device->dev,
					   &asus->wlan_led);
632 633 634 635 636 637 638 639 640 641
	}

error:
	if (rv)
		asus_wmi_led_exit(asus);

	return rv;
}


642 643 644
/*
 * PCI hotplug (for wlan rfkill)
 */
645
static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus)
646
{
647
	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
648

649
	if (result < 0)
650
		return false;
651
	return !result;
652 653
}

654
static void asus_rfkill_hotplug(struct asus_wmi *asus)
655 656 657
{
	struct pci_dev *dev;
	struct pci_bus *bus;
658
	bool blocked;
659 660 661
	bool absent;
	u32 l;

662 663 664
	mutex_lock(&asus->wmi_lock);
	blocked = asus_wlan_rfkill_blocked(asus);
	mutex_unlock(&asus->wmi_lock);
665

666
	mutex_lock(&asus->hotplug_lock);
667
	pci_lock_rescan_remove();
668

669 670
	if (asus->wlan.rfkill)
		rfkill_set_sw_state(asus->wlan.rfkill, blocked);
671

672
	if (asus->hotplug_slot) {
673 674
		bus = pci_find_bus(0, 1);
		if (!bus) {
675
			pr_warn("Unable to find PCI bus 1?\n");
676 677 678 679 680 681 682 683 684 685
			goto out_unlock;
		}

		if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
			pr_err("Unable to read PCI config space?\n");
			goto out_unlock;
		}
		absent = (l == 0xffffffff);

		if (blocked != absent) {
686 687 688 689 690 691
			pr_warn("BIOS says wireless lan is %s, "
				"but the pci device is %s\n",
				blocked ? "blocked" : "unblocked",
				absent ? "absent" : "present");
			pr_warn("skipped wireless hotplug as probably "
				"inappropriate for this model\n");
692 693 694 695 696 697 698 699 700 701 702 703 704
			goto out_unlock;
		}

		if (!blocked) {
			dev = pci_get_slot(bus, 0);
			if (dev) {
				/* Device already present */
				pci_dev_put(dev);
				goto out_unlock;
			}
			dev = pci_scan_single_device(bus, 0);
			if (dev) {
				pci_bus_assign_resources(bus);
705
				pci_bus_add_device(dev);
706 707 708 709
			}
		} else {
			dev = pci_get_slot(bus, 0);
			if (dev) {
710
				pci_stop_and_remove_bus_device(dev);
711 712 713 714 715 716
				pci_dev_put(dev);
			}
		}
	}

out_unlock:
717
	pci_unlock_rescan_remove();
718
	mutex_unlock(&asus->hotplug_lock);
719 720
}

721
static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data)
722
{
723
	struct asus_wmi *asus = data;
724 725 726 727

	if (event != ACPI_NOTIFY_BUS_CHECK)
		return;

728
	/*
729
	 * We can't call directly asus_rfkill_hotplug because most
730 731
	 * of the time WMBC is still being executed and not reetrant.
	 * There is currently no way to tell ACPICA that  we want this
732
	 * method to be serialized, we schedule a asus_rfkill_hotplug
733 734
	 * call later, in a safer context.
	 */
735
	queue_work(asus->hotplug_workqueue, &asus->hotplug_work);
736 737
}

738
static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node)
739 740 741 742 743 744 745 746 747
{
	acpi_status status;
	acpi_handle handle;

	status = acpi_get_handle(NULL, node, &handle);

	if (ACPI_SUCCESS(status)) {
		status = acpi_install_notify_handler(handle,
						     ACPI_SYSTEM_NOTIFY,
748
						     asus_rfkill_notify, asus);
749
		if (ACPI_FAILURE(status))
750
			pr_warn("Failed to register notify on %s\n", node);
751 752 753 754 755 756
	} else
		return -ENODEV;

	return 0;
}

757
static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node)
758 759 760 761 762 763 764 765
{
	acpi_status status = AE_OK;
	acpi_handle handle;

	status = acpi_get_handle(NULL, node, &handle);

	if (ACPI_SUCCESS(status)) {
		status = acpi_remove_notify_handler(handle,
766 767
						    ACPI_SYSTEM_NOTIFY,
						    asus_rfkill_notify);
768 769
		if (ACPI_FAILURE(status))
			pr_err("Error removing rfkill notify handler %s\n",
770
			       node);
771 772 773
	}
}

774 775
static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot,
				   u8 *value)
776
{
777 778
	struct asus_wmi *asus = hotplug_slot->private;
	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
779

780 781
	if (result < 0)
		return result;
782

783
	*value = !!result;
784 785 786
	return 0;
}

787
static void asus_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot)
788 789 790 791 792
{
	kfree(hotplug_slot->info);
	kfree(hotplug_slot);
}

793
static struct hotplug_slot_ops asus_hotplug_slot_ops = {
794
	.owner = THIS_MODULE,
795 796
	.get_adapter_status = asus_get_adapter_status,
	.get_power_status = asus_get_adapter_status,
797 798
};

799
static void asus_hotplug_work(struct work_struct *work)
800
{
801
	struct asus_wmi *asus;
802

803 804
	asus = container_of(work, struct asus_wmi, hotplug_work);
	asus_rfkill_hotplug(asus);
805 806
}

807
static int asus_setup_pci_hotplug(struct asus_wmi *asus)
808 809 810 811 812 813 814 815 816
{
	int ret = -ENOMEM;
	struct pci_bus *bus = pci_find_bus(0, 1);

	if (!bus) {
		pr_err("Unable to find wifi PCI bus\n");
		return -ENODEV;
	}

817 818 819
	asus->hotplug_workqueue =
	    create_singlethread_workqueue("hotplug_workqueue");
	if (!asus->hotplug_workqueue)
820 821
		goto error_workqueue;

822
	INIT_WORK(&asus->hotplug_work, asus_hotplug_work);
823

824 825
	asus->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
	if (!asus->hotplug_slot)
826 827
		goto error_slot;

828 829 830
	asus->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
					   GFP_KERNEL);
	if (!asus->hotplug_slot->info)
831 832
		goto error_info;

833 834 835 836 837
	asus->hotplug_slot->private = asus;
	asus->hotplug_slot->release = &asus_cleanup_pci_hotplug;
	asus->hotplug_slot->ops = &asus_hotplug_slot_ops;
	asus_get_adapter_status(asus->hotplug_slot,
				&asus->hotplug_slot->info->adapter_status);
838

839
	ret = pci_hp_register(asus->hotplug_slot, bus, 0, "asus-wifi");
840 841 842 843 844 845 846 847
	if (ret) {
		pr_err("Unable to register hotplug slot - %d\n", ret);
		goto error_register;
	}

	return 0;

error_register:
848
	kfree(asus->hotplug_slot->info);
849
error_info:
850 851
	kfree(asus->hotplug_slot);
	asus->hotplug_slot = NULL;
852
error_slot:
853
	destroy_workqueue(asus->hotplug_workqueue);
854
error_workqueue:
855 856 857
	return ret;
}

858 859 860
/*
 * Rfkill devices
 */
861
static int asus_rfkill_set(void *data, bool blocked)
862
{
863
	struct asus_rfkill *priv = data;
864
	u32 ctrl_param = !blocked;
865
	u32 dev_id = priv->dev_id;
866

867 868 869 870 871 872 873 874 875 876 877 878 879
	/*
	 * If the user bit is set, BIOS can't set and record the wlan status,
	 * it will report the value read from id ASUS_WMI_DEVID_WLAN_LED
	 * while we query the wlan status through WMI(ASUS_WMI_DEVID_WLAN).
	 * So, we have to record wlan status in id ASUS_WMI_DEVID_WLAN_LED
	 * while setting the wlan status through WMI.
	 * This is also the behavior that windows app will do.
	 */
	if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
	     priv->asus->driver->wlan_ctrl_by_user)
		dev_id = ASUS_WMI_DEVID_WLAN_LED;

	return asus_wmi_set_devstate(dev_id, ctrl_param, NULL);
880 881
}

882
static void asus_rfkill_query(struct rfkill *rfkill, void *data)
883
{
884
	struct asus_rfkill *priv = data;
885
	int result;
886

887
	result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id);
888

889
	if (result < 0)
890
		return;
891

892
	rfkill_set_sw_state(priv->rfkill, !result);
893 894
}

895
static int asus_rfkill_wlan_set(void *data, bool blocked)
896
{
897 898
	struct asus_rfkill *priv = data;
	struct asus_wmi *asus = priv->asus;
899 900 901 902
	int ret;

	/*
	 * This handler is enabled only if hotplug is enabled.
903
	 * In this case, the asus_wmi_set_devstate() will
904 905 906 907
	 * trigger a wmi notification and we need to wait
	 * this call to finish before being able to call
	 * any wmi method
	 */
908
	mutex_lock(&asus->wmi_lock);
909
	ret = asus_rfkill_set(data, blocked);
910
	mutex_unlock(&asus->wmi_lock);
911 912 913
	return ret;
}

914 915
static const struct rfkill_ops asus_rfkill_wlan_ops = {
	.set_block = asus_rfkill_wlan_set,
916
	.query = asus_rfkill_query,
917 918
};

919 920 921
static const struct rfkill_ops asus_rfkill_ops = {
	.set_block = asus_rfkill_set,
	.query = asus_rfkill_query,
922 923
};

924
static int asus_new_rfkill(struct asus_wmi *asus,
925
			   struct asus_rfkill *arfkill,
926
			   const char *name, enum rfkill_type type, int dev_id)
927
{
928
	int result = asus_wmi_get_devstate_simple(asus, dev_id);
929
	struct rfkill **rfkill = &arfkill->rfkill;
930

931 932
	if (result < 0)
		return result;
933

934 935 936
	arfkill->dev_id = dev_id;
	arfkill->asus = asus;

937 938
	if (dev_id == ASUS_WMI_DEVID_WLAN &&
	    asus->driver->quirks->hotplug_wireless)
939
		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
940
				       &asus_rfkill_wlan_ops, arfkill);
941
	else
942
		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
943
				       &asus_rfkill_ops, arfkill);
944 945 946 947

	if (!*rfkill)
		return -EINVAL;

948
	if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
949
			(asus->driver->quirks->wapf > 0))
950 951
		rfkill_set_led_trigger_name(*rfkill, "asus-wlan");

952
	rfkill_init_sw_state(*rfkill, !result);
953 954 955 956 957 958 959 960 961
	result = rfkill_register(*rfkill);
	if (result) {
		rfkill_destroy(*rfkill);
		*rfkill = NULL;
		return result;
	}
	return 0;
}

962
static void asus_wmi_rfkill_exit(struct asus_wmi *asus)
963
{
964 965 966
	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
967 968 969 970
	if (asus->wlan.rfkill) {
		rfkill_unregister(asus->wlan.rfkill);
		rfkill_destroy(asus->wlan.rfkill);
		asus->wlan.rfkill = NULL;
971
	}
972 973
	/*
	 * Refresh pci hotplug in case the rfkill state was changed after
974
	 * asus_unregister_rfkill_notifier()
975
	 */
976 977 978 979 980 981
	asus_rfkill_hotplug(asus);
	if (asus->hotplug_slot)
		pci_hp_deregister(asus->hotplug_slot);
	if (asus->hotplug_workqueue)
		destroy_workqueue(asus->hotplug_workqueue);

982 983 984 985
	if (asus->bluetooth.rfkill) {
		rfkill_unregister(asus->bluetooth.rfkill);
		rfkill_destroy(asus->bluetooth.rfkill);
		asus->bluetooth.rfkill = NULL;
986
	}
987 988 989 990
	if (asus->wimax.rfkill) {
		rfkill_unregister(asus->wimax.rfkill);
		rfkill_destroy(asus->wimax.rfkill);
		asus->wimax.rfkill = NULL;
C
Corentin Chary 已提交
991
	}
992 993 994 995
	if (asus->wwan3g.rfkill) {
		rfkill_unregister(asus->wwan3g.rfkill);
		rfkill_destroy(asus->wwan3g.rfkill);
		asus->wwan3g.rfkill = NULL;
996
	}
997 998 999 1000 1001
	if (asus->gps.rfkill) {
		rfkill_unregister(asus->gps.rfkill);
		rfkill_destroy(asus->gps.rfkill);
		asus->gps.rfkill = NULL;
	}
1002 1003 1004 1005 1006
	if (asus->uwb.rfkill) {
		rfkill_unregister(asus->uwb.rfkill);
		rfkill_destroy(asus->uwb.rfkill);
		asus->uwb.rfkill = NULL;
	}
1007 1008
}

1009
static int asus_wmi_rfkill_init(struct asus_wmi *asus)
1010 1011 1012
{
	int result = 0;

1013 1014
	mutex_init(&asus->hotplug_lock);
	mutex_init(&asus->wmi_lock);
1015

1016 1017
	result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan",
				 RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN);
1018 1019 1020 1021

	if (result && result != -ENODEV)
		goto exit;

1022
	result = asus_new_rfkill(asus, &asus->bluetooth,
1023 1024
				 "asus-bluetooth", RFKILL_TYPE_BLUETOOTH,
				 ASUS_WMI_DEVID_BLUETOOTH);
1025 1026 1027 1028

	if (result && result != -ENODEV)
		goto exit;

1029 1030
	result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax",
				 RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX);
C
Corentin Chary 已提交
1031 1032 1033 1034

	if (result && result != -ENODEV)
		goto exit;

1035 1036
	result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g",
				 RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G);
1037 1038 1039 1040

	if (result && result != -ENODEV)
		goto exit;

1041 1042 1043 1044 1045 1046
	result = asus_new_rfkill(asus, &asus->gps, "asus-gps",
				 RFKILL_TYPE_GPS, ASUS_WMI_DEVID_GPS);

	if (result && result != -ENODEV)
		goto exit;

1047 1048 1049 1050 1051 1052
	result = asus_new_rfkill(asus, &asus->uwb, "asus-uwb",
				 RFKILL_TYPE_UWB, ASUS_WMI_DEVID_UWB);

	if (result && result != -ENODEV)
		goto exit;

1053
	if (!asus->driver->quirks->hotplug_wireless)
1054 1055
		goto exit;

1056
	result = asus_setup_pci_hotplug(asus);
1057 1058 1059 1060 1061 1062 1063
	/*
	 * If we get -EBUSY then something else is handling the PCI hotplug -
	 * don't fail in this case
	 */
	if (result == -EBUSY)
		result = 0;

1064 1065 1066
	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
1067 1068 1069 1070
	/*
	 * Refresh pci hotplug in case the rfkill state was changed during
	 * setup.
	 */
1071
	asus_rfkill_hotplug(asus);
1072

1073 1074
exit:
	if (result && result != -ENODEV)
1075
		asus_wmi_rfkill_exit(asus);
1076 1077 1078 1079 1080 1081 1082

	if (result == -ENODEV)
		result = 0;

	return result;
}

1083 1084 1085
/*
 * Hwmon device
 */
K
Kast Bernd 已提交
1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172
static int asus_hwmon_agfn_fan_speed_read(struct asus_wmi *asus, int fan,
					  int *speed)
{
	struct fan_args args = {
		.agfn.len = sizeof(args),
		.agfn.mfun = ASUS_FAN_MFUN,
		.agfn.sfun = ASUS_FAN_SFUN_READ,
		.fan = fan,
		.speed = 0,
	};
	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
	int status;

	if (fan != 1)
		return -EINVAL;

	status = asus_wmi_evaluate_method_agfn(input);

	if (status || args.agfn.err)
		return -ENXIO;

	if (speed)
		*speed = args.speed;

	return 0;
}

static int asus_hwmon_agfn_fan_speed_write(struct asus_wmi *asus, int fan,
				     int *speed)
{
	struct fan_args args = {
		.agfn.len = sizeof(args),
		.agfn.mfun = ASUS_FAN_MFUN,
		.agfn.sfun = ASUS_FAN_SFUN_WRITE,
		.fan = fan,
		.speed = speed ?  *speed : 0,
	};
	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
	int status;

	/* 1: for setting 1st fan's speed 0: setting auto mode */
	if (fan != 1 && fan != 0)
		return -EINVAL;

	status = asus_wmi_evaluate_method_agfn(input);

	if (status || args.agfn.err)
		return -ENXIO;

	if (speed && fan == 1)
		asus->asus_hwmon_pwm = *speed;

	return 0;
}

/*
 * Check if we can read the speed of one fan. If true we assume we can also
 * control it.
 */
static int asus_hwmon_get_fan_number(struct asus_wmi *asus, int *num_fans)
{
	int status;
	int speed = 0;

	*num_fans = 0;

	status = asus_hwmon_agfn_fan_speed_read(asus, 1, &speed);
	if (!status)
		*num_fans = 1;

	return 0;
}

static int asus_hwmon_fan_set_auto(struct asus_wmi *asus)
{
	int status;

	status = asus_hwmon_agfn_fan_speed_write(asus, 0, NULL);
	if (status)
		return -ENXIO;

	asus->asus_hwmon_fan_manual_mode = false;

	return 0;
}

static int asus_hwmon_fan_rpm_show(struct device *dev, int fan)
1173 1174
{
	struct asus_wmi *asus = dev_get_drvdata(dev);
K
Kast Bernd 已提交
1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192
	int value;
	int ret;

	/* no speed readable on manual mode */
	if (asus->asus_hwmon_fan_manual_mode)
		return -ENXIO;

	ret = asus_hwmon_agfn_fan_speed_read(asus, fan+1, &value);
	if (ret) {
		pr_warn("reading fan speed failed: %d\n", ret);
		return -ENXIO;
	}

	return value;
}

static void asus_hwmon_pwm_show(struct asus_wmi *asus, int fan, int *value)
{
1193 1194
	int err;

K
Kast Bernd 已提交
1195 1196 1197 1198
	if (asus->asus_hwmon_pwm >= 0) {
		*value = asus->asus_hwmon_pwm;
		return;
	}
1199

K
Kast Bernd 已提交
1200
	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, value);
1201
	if (err < 0)
K
Kast Bernd 已提交
1202
		return;
1203

K
Kast Bernd 已提交
1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214
	*value &= 0xFF;

	if (*value == 1) /* Low Speed */
		*value = 85;
	else if (*value == 2)
		*value = 170;
	else if (*value == 3)
		*value = 255;
	else if (*value) {
		pr_err("Unknown fan speed %#x\n", *value);
		*value = -1;
1215
	}
K
Kast Bernd 已提交
1216 1217 1218 1219 1220 1221 1222 1223 1224 1225
}

static ssize_t pwm1_show(struct device *dev,
			       struct device_attribute *attr,
			       char *buf)
{
	struct asus_wmi *asus = dev_get_drvdata(dev);
	int value;

	asus_hwmon_pwm_show(asus, 0, &value);
1226 1227 1228 1229

	return sprintf(buf, "%d\n", value);
}

K
Kast Bernd 已提交
1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307
static ssize_t pwm1_store(struct device *dev,
				     struct device_attribute *attr,
				     const char *buf, size_t count) {
	struct asus_wmi *asus = dev_get_drvdata(dev);
	int value;
	int state;
	int ret;

	ret = kstrtouint(buf, 10, &value);

	if (ret)
		return ret;

	value = clamp(value, 0, 255);

	state = asus_hwmon_agfn_fan_speed_write(asus, 1, &value);
	if (state)
		pr_warn("Setting fan speed failed: %d\n", state);
	else
		asus->asus_hwmon_fan_manual_mode = true;

	return count;
}

static ssize_t fan1_input_show(struct device *dev,
					struct device_attribute *attr,
					char *buf)
{
	int value = asus_hwmon_fan_rpm_show(dev, 0);

	return sprintf(buf, "%d\n", value < 0 ? -1 : value*100);

}

static ssize_t pwm1_enable_show(struct device *dev,
						 struct device_attribute *attr,
						 char *buf)
{
	struct asus_wmi *asus = dev_get_drvdata(dev);

	if (asus->asus_hwmon_fan_manual_mode)
		return sprintf(buf, "%d\n", ASUS_FAN_CTRL_MANUAL);

	return sprintf(buf, "%d\n", ASUS_FAN_CTRL_AUTO);
}

static ssize_t pwm1_enable_store(struct device *dev,
						  struct device_attribute *attr,
						  const char *buf, size_t count)
{
	struct asus_wmi *asus = dev_get_drvdata(dev);
	int status = 0;
	int state;
	int ret;

	ret = kstrtouint(buf, 10, &state);

	if (ret)
		return ret;

	if (state == ASUS_FAN_CTRL_MANUAL)
		asus->asus_hwmon_fan_manual_mode = true;
	else
		status = asus_hwmon_fan_set_auto(asus);

	if (status)
		return status;

	return count;
}

static ssize_t fan1_label_show(struct device *dev,
					  struct device_attribute *attr,
					  char *buf)
{
	return sprintf(buf, "%s\n", ASUS_FAN_DESC);
}

C
Corentin Chary 已提交
1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320
static ssize_t asus_hwmon_temp1(struct device *dev,
				struct device_attribute *attr,
				char *buf)
{
	struct asus_wmi *asus = dev_get_drvdata(dev);
	u32 value;
	int err;

	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_THERMAL_CTRL, &value);

	if (err < 0)
		return err;

1321
	value = DECI_KELVIN_TO_CELSIUS((value & 0xFFFF)) * 1000;
C
Corentin Chary 已提交
1322 1323 1324 1325

	return sprintf(buf, "%d\n", value);
}

K
Kast Bernd 已提交
1326 1327 1328 1329 1330 1331 1332
/* Fan1 */
static DEVICE_ATTR_RW(pwm1);
static DEVICE_ATTR_RW(pwm1_enable);
static DEVICE_ATTR_RO(fan1_input);
static DEVICE_ATTR_RO(fan1_label);

/* Temperature */
1333
static DEVICE_ATTR(temp1_input, S_IRUGO, asus_hwmon_temp1, NULL);
1334 1335

static struct attribute *hwmon_attributes[] = {
1336
	&dev_attr_pwm1.attr,
K
Kast Bernd 已提交
1337 1338 1339 1340
	&dev_attr_pwm1_enable.attr,
	&dev_attr_fan1_input.attr,
	&dev_attr_fan1_label.attr,

1341
	&dev_attr_temp1_input.attr,
1342 1343 1344
	NULL
};

1345
static umode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
1346
					  struct attribute *attr, int idx)
1347 1348 1349 1350 1351
{
	struct device *dev = container_of(kobj, struct device, kobj);
	struct platform_device *pdev = to_platform_device(dev->parent);
	struct asus_wmi *asus = platform_get_drvdata(pdev);
	int dev_id = -1;
K
Kast Bernd 已提交
1352
	int fan_attr = -1;
1353
	u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
K
Kast Bernd 已提交
1354
	bool ok = true;
1355

1356
	if (attr == &dev_attr_pwm1.attr)
1357
		dev_id = ASUS_WMI_DEVID_FAN_CTRL;
1358
	else if (attr == &dev_attr_temp1_input.attr)
1359
		dev_id = ASUS_WMI_DEVID_THERMAL_CTRL;
1360

K
Kast Bernd 已提交
1361 1362 1363 1364 1365 1366 1367 1368

	if (attr == &dev_attr_fan1_input.attr
	    || attr == &dev_attr_fan1_label.attr
	    || attr == &dev_attr_pwm1.attr
	    || attr == &dev_attr_pwm1_enable.attr) {
		fan_attr = 1;
	}

1369 1370 1371
	if (dev_id != -1) {
		int err = asus_wmi_get_devstate(asus, dev_id, &value);

K
Kast Bernd 已提交
1372
		if (err < 0 && fan_attr == -1)
1373
			return 0; /* can't return negative here */
1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384
	}

	if (dev_id == ASUS_WMI_DEVID_FAN_CTRL) {
		/*
		 * We need to find a better way, probably using sfun,
		 * bits or spec ...
		 * Currently we disable it if:
		 * - ASUS_WMI_UNSUPPORTED_METHOD is returned
		 * - reverved bits are non-zero
		 * - sfun and presence bit are not set
		 */
C
Corentin Chary 已提交
1385
		if (value == ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
1386 1387
		    || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)))
			ok = false;
K
Kast Bernd 已提交
1388 1389
		else
			ok = fan_attr <= asus->asus_hwmon_num_fans;
1390 1391
	} else if (dev_id == ASUS_WMI_DEVID_THERMAL_CTRL) {
		/* If value is zero, something is clearly wrong */
K
Kast Bernd 已提交
1392
		if (!value)
1393
			ok = false;
K
Kast Bernd 已提交
1394 1395 1396 1397
	} else if (fan_attr <= asus->asus_hwmon_num_fans && fan_attr != -1) {
		ok = true;
	} else {
		ok = false;
1398 1399 1400 1401 1402 1403 1404 1405 1406
	}

	return ok ? attr->mode : 0;
}

static struct attribute_group hwmon_attribute_group = {
	.is_visible = asus_hwmon_sysfs_is_visible,
	.attrs = hwmon_attributes
};
1407
__ATTRIBUTE_GROUPS(hwmon_attribute);
1408 1409 1410 1411 1412

static int asus_wmi_hwmon_init(struct asus_wmi *asus)
{
	struct device *hwmon;

1413 1414 1415
	hwmon = hwmon_device_register_with_groups(&asus->platform_device->dev,
						  "asus", asus,
						  hwmon_attribute_groups);
1416 1417 1418 1419
	if (IS_ERR(hwmon)) {
		pr_err("Could not register asus hwmon device\n");
		return PTR_ERR(hwmon);
	}
1420
	return 0;
1421 1422
}

1423 1424 1425
/*
 * Backlight
 */
1426
static int read_backlight_power(struct asus_wmi *asus)
1427
{
1428 1429 1430 1431 1432 1433
	int ret;
	if (asus->driver->quirks->store_backlight_power)
		ret = !asus->driver->panel_power;
	else
		ret = asus_wmi_get_devstate_simple(asus,
						   ASUS_WMI_DEVID_BACKLIGHT);
1434 1435 1436 1437 1438 1439 1440

	if (ret < 0)
		return ret;

	return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
}

1441
static int read_brightness_max(struct asus_wmi *asus)
Y
Yong Wang 已提交
1442
{
1443
	u32 retval;
1444
	int err;
Y
Yong Wang 已提交
1445

1446
	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
Y
Yong Wang 已提交
1447

1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462
	if (err < 0)
		return err;

	retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
	retval >>= 8;

	if (!retval)
		return -ENODEV;

	return retval;
}

static int read_brightness(struct backlight_device *bd)
{
	struct asus_wmi *asus = bl_get_data(bd);
1463 1464
	u32 retval;
	int err;
1465 1466 1467

	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);

1468 1469 1470 1471
	if (err < 0)
		return err;

	return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
Y
Yong Wang 已提交
1472 1473
}

1474
static u32 get_scalar_command(struct backlight_device *bd)
Y
Yong Wang 已提交
1475
{
1476
	struct asus_wmi *asus = bl_get_data(bd);
1477
	u32 ctrl_param = 0;
Y
Yong Wang 已提交
1478

1479 1480 1481 1482 1483 1484
	if ((asus->driver->brightness < bd->props.brightness) ||
	    bd->props.brightness == bd->props.max_brightness)
		ctrl_param = 0x00008001;
	else if ((asus->driver->brightness > bd->props.brightness) ||
		 bd->props.brightness == 0)
		ctrl_param = 0x00008000;
Y
Yong Wang 已提交
1485

1486
	asus->driver->brightness = bd->props.brightness;
Y
Yong Wang 已提交
1487

1488 1489 1490
	return ctrl_param;
}

Y
Yong Wang 已提交
1491 1492
static int update_bl_status(struct backlight_device *bd)
{
1493
	struct asus_wmi *asus = bl_get_data(bd);
1494
	u32 ctrl_param;
1495
	int power, err = 0;
1496

1497
	power = read_backlight_power(asus);
1498 1499
	if (power != -ENODEV && bd->props.power != power) {
		ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
1500 1501
		err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
					    ctrl_param, NULL);
1502 1503 1504
		if (asus->driver->quirks->store_backlight_power)
			asus->driver->panel_power = bd->props.power;

1505 1506 1507 1508
		/* When using scalar brightness, updating the brightness
		 * will mess with the backlight power */
		if (asus->driver->quirks->scalar_panel_brightness)
			return err;
1509
	}
1510 1511 1512 1513 1514 1515 1516 1517 1518

	if (asus->driver->quirks->scalar_panel_brightness)
		ctrl_param = get_scalar_command(bd);
	else
		ctrl_param = bd->props.brightness;

	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
				    ctrl_param, NULL);

1519
	return err;
Y
Yong Wang 已提交
1520 1521
}

1522
static const struct backlight_ops asus_wmi_bl_ops = {
Y
Yong Wang 已提交
1523 1524 1525 1526
	.get_brightness = read_brightness,
	.update_status = update_bl_status,
};

1527
static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
Y
Yong Wang 已提交
1528
{
1529
	struct backlight_device *bd = asus->backlight_device;
Y
Yong Wang 已提交
1530
	int old = bd->props.brightness;
1531
	int new = old;
Y
Yong Wang 已提交
1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544

	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
		new = code - NOTIFY_BRNUP_MIN + 1;
	else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
		new = code - NOTIFY_BRNDOWN_MIN;

	bd->props.brightness = new;
	backlight_update_status(bd);
	backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);

	return old;
}

1545
static int asus_wmi_backlight_init(struct asus_wmi *asus)
Y
Yong Wang 已提交
1546 1547 1548
{
	struct backlight_device *bd;
	struct backlight_properties props;
1549 1550 1551
	int max;
	int power;

1552
	max = read_brightness_max(asus);
1553
	if (max < 0)
1554 1555 1556 1557
		return max;

	power = read_backlight_power(asus);

1558 1559
	if (power == -ENODEV)
		power = FB_BLANK_UNBLANK;
1560 1561
	else if (power < 0)
		return power;
Y
Yong Wang 已提交
1562 1563

	memset(&props, 0, sizeof(struct backlight_properties));
1564
	props.type = BACKLIGHT_PLATFORM;
1565
	props.max_brightness = max;
1566 1567 1568
	bd = backlight_device_register(asus->driver->name,
				       &asus->platform_device->dev, asus,
				       &asus_wmi_bl_ops, &props);
Y
Yong Wang 已提交
1569 1570 1571 1572 1573
	if (IS_ERR(bd)) {
		pr_err("Could not register backlight device\n");
		return PTR_ERR(bd);
	}

1574
	asus->backlight_device = bd;
Y
Yong Wang 已提交
1575

1576 1577 1578
	if (asus->driver->quirks->store_backlight_power)
		asus->driver->panel_power = power;

Y
Yong Wang 已提交
1579
	bd->props.brightness = read_brightness(bd);
1580
	bd->props.power = power;
Y
Yong Wang 已提交
1581 1582
	backlight_update_status(bd);

1583 1584
	asus->driver->brightness = bd->props.brightness;

Y
Yong Wang 已提交
1585 1586 1587
	return 0;
}

1588
static void asus_wmi_backlight_exit(struct asus_wmi *asus)
Y
Yong Wang 已提交
1589
{
1590
	backlight_device_unregister(asus->backlight_device);
Y
Yong Wang 已提交
1591

1592
	asus->backlight_device = NULL;
Y
Yong Wang 已提交
1593 1594
}

A
AceLan Kao 已提交
1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606
static int is_display_toggle(int code)
{
	/* display toggle keys */
	if ((code >= 0x61 && code <= 0x67) ||
	    (code >= 0x8c && code <= 0x93) ||
	    (code >= 0xa0 && code <= 0xa7) ||
	    (code >= 0xd0 && code <= 0xd5))
		return 1;

	return 0;
}

1607
static void asus_wmi_notify(u32 value, void *context)
Y
Yong Wang 已提交
1608
{
1609
	struct asus_wmi *asus = context;
Y
Yong Wang 已提交
1610 1611 1612 1613 1614
	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
	acpi_status status;
	int code;
	int orig_code;
1615 1616
	unsigned int key_value = 1;
	bool autorelease = 1;
Y
Yong Wang 已提交
1617 1618 1619 1620 1621 1622 1623 1624 1625

	status = wmi_get_event_data(value, &response);
	if (status != AE_OK) {
		pr_err("bad event status 0x%x\n", status);
		return;
	}

	obj = (union acpi_object *)response.pointer;

C
Corentin Chary 已提交
1626 1627
	if (!obj || obj->type != ACPI_TYPE_INTEGER)
		goto exit;
Y
Yong Wang 已提交
1628

C
Corentin Chary 已提交
1629 1630
	code = obj->integer.value;
	orig_code = code;
Y
Yong Wang 已提交
1631

1632 1633 1634 1635 1636 1637 1638
	if (asus->driver->key_filter) {
		asus->driver->key_filter(asus->driver, &code, &key_value,
					 &autorelease);
		if (code == ASUS_WMI_KEY_IGNORE)
			goto exit;
	}

C
Corentin Chary 已提交
1639
	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1640
		code = ASUS_WMI_BRN_UP;
C
Corentin Chary 已提交
1641 1642
	else if (code >= NOTIFY_BRNDOWN_MIN &&
		 code <= NOTIFY_BRNDOWN_MAX)
1643
		code = ASUS_WMI_BRN_DOWN;
Y
Yong Wang 已提交
1644

1645
	if (code == ASUS_WMI_BRN_DOWN || code == ASUS_WMI_BRN_UP) {
1646
		if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
C
Corentin Chary 已提交
1647
			asus_wmi_backlight_notify(asus, orig_code);
1648
			goto exit;
A
AceLan Kao 已提交
1649 1650 1651 1652 1653 1654 1655 1656 1657
		}
	}

	if (is_display_toggle(code) &&
	    asus->driver->quirks->no_display_toggle)
		goto exit;

	if (!sparse_keymap_report_event(asus->inputdev, code,
					key_value, autorelease))
C
Corentin Chary 已提交
1658
		pr_info("Unknown key %x pressed\n", code);
Y
Yong Wang 已提交
1659

C
Corentin Chary 已提交
1660
exit:
Y
Yong Wang 已提交
1661 1662 1663
	kfree(obj);
}

1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675
/*
 * Sys helpers
 */
static int parse_arg(const char *buf, unsigned long count, int *val)
{
	if (!count)
		return 0;
	if (sscanf(buf, "%i", val) != 1)
		return -EINVAL;
	return count;
}

1676 1677
static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
			     const char *buf, size_t count)
1678 1679
{
	u32 retval;
1680
	int rv, err, value;
1681

1682
	value = asus_wmi_get_devstate_simple(asus, devid);
1683
	if (value == -ENODEV)	/* Check device presence */
1684 1685 1686
		return value;

	rv = parse_arg(buf, count, &value);
1687 1688 1689 1690
	err = asus_wmi_set_devstate(devid, value, &retval);

	if (err < 0)
		return err;
1691 1692 1693 1694

	return rv;
}

1695
static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
1696
{
1697
	int value = asus_wmi_get_devstate_simple(asus, devid);
1698 1699 1700 1701 1702 1703 1704

	if (value < 0)
		return value;

	return sprintf(buf, "%d\n", value);
}

1705
#define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)			\
1706 1707 1708 1709
	static ssize_t show_##_name(struct device *dev,			\
				    struct device_attribute *attr,	\
				    char *buf)				\
	{								\
1710 1711 1712
		struct asus_wmi *asus = dev_get_drvdata(dev);		\
									\
		return show_sys_wmi(asus, _cm, buf);			\
1713 1714 1715 1716 1717
	}								\
	static ssize_t store_##_name(struct device *dev,		\
				     struct device_attribute *attr,	\
				     const char *buf, size_t count)	\
	{								\
1718 1719 1720
		struct asus_wmi *asus = dev_get_drvdata(dev);		\
									\
		return store_sys_wmi(asus, _cm, buf, count);		\
1721 1722 1723 1724 1725 1726 1727 1728 1729
	}								\
	static struct device_attribute dev_attr_##_name = {		\
		.attr = {						\
			.name = __stringify(_name),			\
			.mode = _mode },				\
		.show   = show_##_name,					\
		.store  = store_##_name,				\
	}

1730 1731 1732
ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
A
AceLan Kao 已提交
1733
ASUS_WMI_CREATE_DEVICE_ATTR(lid_resume, 0644, ASUS_WMI_DEVID_LID_RESUME);
1734

D
Dmitry Torokhov 已提交
1735 1736
static ssize_t store_cpufv(struct device *dev, struct device_attribute *attr,
			   const char *buf, size_t count)
1737
{
1738
	int value, rv;
1739 1740 1741 1742 1743 1744

	if (!count || sscanf(buf, "%i", &value) != 1)
		return -EINVAL;
	if (value < 0 || value > 2)
		return -EINVAL;

1745 1746 1747 1748 1749
	rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
	if (rv < 0)
		return rv;

	return count;
1750 1751 1752 1753
}

static DEVICE_ATTR(cpufv, S_IRUGO | S_IWUSR, NULL, store_cpufv);

1754 1755
static struct attribute *platform_attributes[] = {
	&dev_attr_cpufv.attr,
1756 1757
	&dev_attr_camera.attr,
	&dev_attr_cardr.attr,
1758
	&dev_attr_touchpad.attr,
A
AceLan Kao 已提交
1759
	&dev_attr_lid_resume.attr,
1760 1761 1762
	NULL
};

1763
static umode_t asus_sysfs_is_visible(struct kobject *kobj,
1764
				    struct attribute *attr, int idx)
1765
{
1766 1767 1768 1769
	struct device *dev = container_of(kobj, struct device, kobj);
	struct platform_device *pdev = to_platform_device(dev);
	struct asus_wmi *asus = platform_get_drvdata(pdev);
	bool ok = true;
1770 1771 1772
	int devid = -1;

	if (attr == &dev_attr_camera.attr)
1773
		devid = ASUS_WMI_DEVID_CAMERA;
1774
	else if (attr == &dev_attr_cardr.attr)
1775
		devid = ASUS_WMI_DEVID_CARDREADER;
1776
	else if (attr == &dev_attr_touchpad.attr)
1777
		devid = ASUS_WMI_DEVID_TOUCHPAD;
A
AceLan Kao 已提交
1778 1779
	else if (attr == &dev_attr_lid_resume.attr)
		devid = ASUS_WMI_DEVID_LID_RESUME;
1780 1781

	if (devid != -1)
1782
		ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
1783

1784
	return ok ? attr->mode : 0;
1785 1786
}

1787
static struct attribute_group platform_attribute_group = {
1788 1789
	.is_visible = asus_sysfs_is_visible,
	.attrs = platform_attributes
1790 1791
};

1792
static void asus_wmi_sysfs_exit(struct platform_device *device)
1793
{
1794
	sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1795 1796
}

1797
static int asus_wmi_sysfs_init(struct platform_device *device)
1798
{
1799
	return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1800 1801
}

1802 1803 1804
/*
 * Platform device
 */
1805
static int asus_wmi_platform_init(struct asus_wmi *asus)
1806
{
1807 1808 1809 1810
	int rv;

	/* INIT enable hotkeys on some models */
	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
V
vic 已提交
1811
		pr_info("Initialization: %#x\n", rv);
1812 1813 1814

	/* We don't know yet what to do with this version... */
	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
V
vic 已提交
1815
		pr_info("BIOS WMI version: %d.%d\n", rv >> 16, rv & 0xFF);
1816 1817 1818 1819 1820 1821 1822 1823 1824 1825
		asus->spec = rv;
	}

	/*
	 * The SFUN method probably allows the original driver to get the list
	 * of features supported by a given model. For now, 0x0100 or 0x0800
	 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
	 * The significance of others is yet to be found.
	 */
	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
V
vic 已提交
1826
		pr_info("SFUN value: %#x\n", rv);
1827 1828 1829
		asus->sfun = rv;
	}

1830 1831 1832 1833 1834 1835 1836 1837 1838
	/*
	 * Eee PC and Notebooks seems to have different method_id for DSTS,
	 * but it may also be related to the BIOS's SPEC.
	 * Note, on most Eeepc, there is no way to check if a method exist
	 * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
	 * but once again, SPEC may probably be used for that kind of things.
	 */
	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL))
		asus->dsts_id = ASUS_WMI_METHODID_DSTS;
1839
	else
1840 1841
		asus->dsts_id = ASUS_WMI_METHODID_DSTS2;

1842 1843
	/* CWAP allow to define the behavior of the Fn+F2 key,
	 * this method doesn't seems to be present on Eee PCs */
1844
	if (asus->driver->quirks->wapf >= 0)
1845
		asus_wmi_set_devstate(ASUS_WMI_DEVID_CWAP,
1846
				      asus->driver->quirks->wapf, NULL);
1847

1848
	return asus_wmi_sysfs_init(asus->platform_device);
1849 1850
}

1851
static void asus_wmi_platform_exit(struct asus_wmi *asus)
1852
{
1853
	asus_wmi_sysfs_exit(asus->platform_device);
1854 1855
}

C
Corentin Chary 已提交
1856 1857 1858
/*
 * debugfs
 */
1859 1860
struct asus_wmi_debugfs_node {
	struct asus_wmi *asus;
C
Corentin Chary 已提交
1861
	char *name;
1862
	int (*show) (struct seq_file *m, void *data);
C
Corentin Chary 已提交
1863 1864 1865 1866
};

static int show_dsts(struct seq_file *m, void *data)
{
1867
	struct asus_wmi *asus = m->private;
1868
	int err;
C
Corentin Chary 已提交
1869 1870
	u32 retval = -1;

1871
	err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
C
Corentin Chary 已提交
1872

1873 1874
	if (err < 0)
		return err;
C
Corentin Chary 已提交
1875

1876
	seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
C
Corentin Chary 已提交
1877 1878 1879 1880 1881 1882

	return 0;
}

static int show_devs(struct seq_file *m, void *data)
{
1883
	struct asus_wmi *asus = m->private;
1884
	int err;
C
Corentin Chary 已提交
1885 1886
	u32 retval = -1;

1887 1888 1889 1890 1891
	err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
				    &retval);

	if (err < 0)
		return err;
C
Corentin Chary 已提交
1892

1893
	seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
1894
		   asus->debug.ctrl_param, retval);
C
Corentin Chary 已提交
1895 1896 1897 1898

	return 0;
}

1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925
static int show_call(struct seq_file *m, void *data)
{
	struct asus_wmi *asus = m->private;
	struct bios_args args = {
		.arg0 = asus->debug.dev_id,
		.arg1 = asus->debug.ctrl_param,
	};
	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
	acpi_status status;

	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
				     1, asus->debug.method_id,
				     &input, &output);

	if (ACPI_FAILURE(status))
		return -EIO;

	obj = (union acpi_object *)output.pointer;
	if (obj && obj->type == ACPI_TYPE_INTEGER)
		seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
			   asus->debug.dev_id, asus->debug.ctrl_param,
			   (u32) obj->integer.value);
	else
		seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
			   asus->debug.dev_id, asus->debug.ctrl_param,
1926
			   obj ? obj->type : -1);
1927 1928 1929 1930 1931 1932

	kfree(obj);

	return 0;
}

1933 1934 1935
static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
	{NULL, "devs", show_devs},
	{NULL, "dsts", show_dsts},
1936
	{NULL, "call", show_call},
C
Corentin Chary 已提交
1937 1938
};

1939
static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
C
Corentin Chary 已提交
1940
{
1941
	struct asus_wmi_debugfs_node *node = inode->i_private;
C
Corentin Chary 已提交
1942

1943
	return single_open(file, node->show, node->asus);
C
Corentin Chary 已提交
1944 1945
}

1946
static const struct file_operations asus_wmi_debugfs_io_ops = {
C
Corentin Chary 已提交
1947
	.owner = THIS_MODULE,
1948
	.open = asus_wmi_debugfs_open,
C
Corentin Chary 已提交
1949 1950 1951 1952 1953
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
};

1954
static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
C
Corentin Chary 已提交
1955
{
1956
	debugfs_remove_recursive(asus->debug.root);
C
Corentin Chary 已提交
1957 1958
}

1959
static int asus_wmi_debugfs_init(struct asus_wmi *asus)
C
Corentin Chary 已提交
1960 1961 1962 1963
{
	struct dentry *dent;
	int i;

1964 1965
	asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
	if (!asus->debug.root) {
V
vic 已提交
1966
		pr_err("failed to create debugfs directory\n");
C
Corentin Chary 已提交
1967 1968 1969
		goto error_debugfs;
	}

1970 1971 1972 1973 1974
	dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR,
				  asus->debug.root, &asus->debug.method_id);
	if (!dent)
		goto error_debugfs;

1975 1976
	dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR,
				  asus->debug.root, &asus->debug.dev_id);
C
Corentin Chary 已提交
1977 1978 1979
	if (!dent)
		goto error_debugfs;

1980 1981
	dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR,
				  asus->debug.root, &asus->debug.ctrl_param);
C
Corentin Chary 已提交
1982 1983 1984
	if (!dent)
		goto error_debugfs;

1985 1986
	for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
		struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
C
Corentin Chary 已提交
1987

1988
		node->asus = asus;
C
Corentin Chary 已提交
1989
		dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO,
1990 1991
					   asus->debug.root, node,
					   &asus_wmi_debugfs_io_ops);
C
Corentin Chary 已提交
1992 1993 1994 1995 1996 1997 1998 1999 2000
		if (!dent) {
			pr_err("failed to create debug file: %s\n", node->name);
			goto error_debugfs;
		}
	}

	return 0;

error_debugfs:
2001
	asus_wmi_debugfs_exit(asus);
C
Corentin Chary 已提交
2002 2003 2004
	return -ENOMEM;
}

K
Kast Bernd 已提交
2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023
static int asus_wmi_fan_init(struct asus_wmi *asus)
{
	int status;

	asus->asus_hwmon_pwm = -1;
	asus->asus_hwmon_num_fans = -1;
	asus->asus_hwmon_fan_manual_mode = false;

	status = asus_hwmon_get_fan_number(asus, &asus->asus_hwmon_num_fans);
	if (status) {
		asus->asus_hwmon_num_fans = 0;
		pr_warn("Could not determine number of fans: %d\n", status);
		return -ENXIO;
	}

	pr_info("Number of fans: %d\n", asus->asus_hwmon_num_fans);
	return 0;
}

2024 2025 2026
/*
 * WMI Driver
 */
2027
static int asus_wmi_add(struct platform_device *pdev)
2028
{
2029 2030 2031
	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
	struct asus_wmi *asus;
2032
	const char *chassis_type;
2033
	acpi_status status;
2034
	int err;
2035
	u32 result;
2036

2037 2038
	asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
	if (!asus)
2039 2040
		return -ENOMEM;

2041 2042 2043 2044
	asus->driver = wdrv;
	asus->platform_device = pdev;
	wdrv->platform_device = pdev;
	platform_set_drvdata(asus->platform_device, asus);
2045

2046 2047
	if (wdrv->detect_quirks)
		wdrv->detect_quirks(asus->driver);
2048

2049
	err = asus_wmi_platform_init(asus);
2050 2051
	if (err)
		goto fail_platform;
2052

2053
	err = asus_wmi_input_init(asus);
2054
	if (err)
2055
		goto fail_input;
Y
Yong Wang 已提交
2056

K
Kast Bernd 已提交
2057 2058 2059
	err = asus_wmi_fan_init(asus); /* probably no problems on error */
	asus_hwmon_fan_set_auto(asus);

2060 2061 2062 2063
	err = asus_wmi_hwmon_init(asus);
	if (err)
		goto fail_hwmon;

2064
	err = asus_wmi_led_init(asus);
2065 2066 2067
	if (err)
		goto fail_leds;

2068
	err = asus_wmi_rfkill_init(asus);
2069 2070 2071
	if (err)
		goto fail_rfkill;

2072 2073 2074 2075
	/* Some Asus desktop boards export an acpi-video backlight interface,
	   stop this from showing up */
	chassis_type = dmi_get_system_info(DMI_CHASSIS_TYPE);
	if (chassis_type && !strcmp(chassis_type, "3"))
2076 2077
		acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);

2078
	if (asus->driver->quirks->wmi_backlight_power)
2079 2080 2081
		acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);

	if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
2082
		err = asus_wmi_backlight_init(asus);
2083
		if (err && err != -ENODEV)
2084
			goto fail_backlight;
2085
	}
2086

2087 2088
	status = wmi_install_notify_handler(asus->driver->event_guid,
					    asus_wmi_notify, asus);
2089
	if (ACPI_FAILURE(status)) {
2090
		pr_err("Unable to register notify handler - %d\n", status);
2091
		err = -ENODEV;
2092
		goto fail_wmi_handler;
2093 2094
	}

2095
	err = asus_wmi_debugfs_init(asus);
C
Corentin Chary 已提交
2096 2097 2098
	if (err)
		goto fail_debugfs;

2099 2100 2101 2102
	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WLAN, &result);
	if (result & (ASUS_WMI_DSTS_PRESENCE_BIT | ASUS_WMI_DSTS_USER_BIT))
		asus->driver->wlan_ctrl_by_user = 1;

2103
	return 0;
2104

C
Corentin Chary 已提交
2105
fail_debugfs:
2106
	wmi_remove_notify_handler(asus->driver->event_guid);
2107
fail_wmi_handler:
2108
	asus_wmi_backlight_exit(asus);
2109
fail_backlight:
2110
	asus_wmi_rfkill_exit(asus);
2111
fail_rfkill:
2112
	asus_wmi_led_exit(asus);
2113
fail_leds:
2114
fail_hwmon:
2115
	asus_wmi_input_exit(asus);
2116
fail_input:
2117
	asus_wmi_platform_exit(asus);
2118
fail_platform:
2119
	kfree(asus);
2120
	return err;
2121 2122
}

2123
static int asus_wmi_remove(struct platform_device *device)
2124
{
2125 2126 2127 2128 2129 2130 2131 2132 2133 2134
	struct asus_wmi *asus;

	asus = platform_get_drvdata(device);
	wmi_remove_notify_handler(asus->driver->event_guid);
	asus_wmi_backlight_exit(asus);
	asus_wmi_input_exit(asus);
	asus_wmi_led_exit(asus);
	asus_wmi_rfkill_exit(asus);
	asus_wmi_debugfs_exit(asus);
	asus_wmi_platform_exit(asus);
K
Kast Bernd 已提交
2135
	asus_hwmon_fan_set_auto(asus);
2136 2137

	kfree(asus);
2138 2139 2140
	return 0;
}

2141 2142 2143
/*
 * Platform driver - hibernate/resume callbacks
 */
2144
static int asus_hotk_thaw(struct device *device)
2145
{
2146
	struct asus_wmi *asus = dev_get_drvdata(device);
2147

2148
	if (asus->wlan.rfkill) {
2149 2150 2151 2152 2153 2154 2155
		bool wlan;

		/*
		 * Work around bios bug - acpi _PTS turns off the wireless led
		 * during suspend.  Normally it restores it on resume, but
		 * we should kick it ourselves in case hibernation is aborted.
		 */
2156
		wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
2157
		asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
2158 2159 2160 2161 2162
	}

	return 0;
}

2163
static int asus_hotk_restore(struct device *device)
2164
{
2165
	struct asus_wmi *asus = dev_get_drvdata(device);
2166 2167 2168
	int bl;

	/* Refresh both wlan rfkill state and pci hotplug */
2169
	if (asus->wlan.rfkill)
2170
		asus_rfkill_hotplug(asus);
2171

2172
	if (asus->bluetooth.rfkill) {
2173 2174
		bl = !asus_wmi_get_devstate_simple(asus,
						   ASUS_WMI_DEVID_BLUETOOTH);
2175
		rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
C
Corentin Chary 已提交
2176
	}
2177
	if (asus->wimax.rfkill) {
2178
		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
2179
		rfkill_set_sw_state(asus->wimax.rfkill, bl);
C
Corentin Chary 已提交
2180
	}
2181
	if (asus->wwan3g.rfkill) {
2182
		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
2183
		rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
2184
	}
2185 2186 2187 2188
	if (asus->gps.rfkill) {
		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_GPS);
		rfkill_set_sw_state(asus->gps.rfkill, bl);
	}
2189 2190 2191 2192
	if (asus->uwb.rfkill) {
		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_UWB);
		rfkill_set_sw_state(asus->uwb.rfkill, bl);
	}
2193 2194 2195 2196

	return 0;
}

2197 2198 2199
static const struct dev_pm_ops asus_pm_ops = {
	.thaw = asus_hotk_thaw,
	.restore = asus_hotk_restore,
2200 2201
};

2202
static int asus_wmi_probe(struct platform_device *pdev)
2203
{
2204 2205 2206
	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
	int ret;
2207

2208
	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
2209
		pr_warn("Management GUID not found\n");
2210 2211 2212
		return -ENODEV;
	}

2213
	if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
2214
		pr_warn("Event GUID not found\n");
2215 2216 2217
		return -ENODEV;
	}

2218 2219 2220 2221 2222 2223 2224
	if (wdrv->probe) {
		ret = wdrv->probe(pdev);
		if (ret)
			return ret;
	}

	return asus_wmi_add(pdev);
2225
}
2226

2227
static bool used;
2228

C
Corentin Chary 已提交
2229
int __init_or_module asus_wmi_register_driver(struct asus_wmi_driver *driver)
2230
{
2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244
	struct platform_driver *platform_driver;
	struct platform_device *platform_device;

	if (used)
		return -EBUSY;

	platform_driver = &driver->platform_driver;
	platform_driver->remove = asus_wmi_remove;
	platform_driver->driver.owner = driver->owner;
	platform_driver->driver.name = driver->name;
	platform_driver->driver.pm = &asus_pm_ops;

	platform_device = platform_create_bundle(platform_driver,
						 asus_wmi_probe,
2245 2246 2247
						 NULL, 0, NULL, 0);
	if (IS_ERR(platform_device))
		return PTR_ERR(platform_device);
2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264

	used = true;
	return 0;
}
EXPORT_SYMBOL_GPL(asus_wmi_register_driver);

void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
{
	platform_device_unregister(driver->platform_device);
	platform_driver_unregister(&driver->platform_driver);
	used = false;
}
EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);

static int __init asus_wmi_init(void)
{
	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
V
vic 已提交
2265
		pr_info("Asus Management GUID not found\n");
2266 2267 2268
		return -ENODEV;
	}

V
vic 已提交
2269
	pr_info("ASUS WMI generic driver loaded\n");
2270 2271 2272
	return 0;
}

2273
static void __exit asus_wmi_exit(void)
2274
{
V
vic 已提交
2275
	pr_info("ASUS WMI generic driver unloaded\n");
2276 2277
}

2278 2279
module_init(asus_wmi_init);
module_exit(asus_wmi_exit);