asus-laptop.c 32.2 KB
Newer Older
C
Corentin Chary 已提交
1 2 3 4 5
/*
 *  asus-laptop.c - Asus Laptop Support
 *
 *
 *  Copyright (C) 2002-2005 Julien Lerouge, 2003-2006 Karol Kozimor
C
Corentin Chary 已提交
6
 *  Copyright (C) 2006-2007 Corentin Chary
C
Corentin Chary 已提交
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
 *
 *  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
 *
 *
 *  The development page for this driver is located at
 *  http://sourceforge.net/projects/acpi4asus/
 *
 *  Credits:
 *  Pontus Fuchs   - Helper functions, cleanup
 *  Johann Wiesner - Small compile fixes
 *  John Belmonte  - ACPI code for Toshiba laptop was a good starting point.
 *  Eric Burghard  - LED display support for W1N
 *  Josh Green     - Light Sens support
 *  Thomas Tuttle  - His first patch for led support was very helpfull
C
Corentin Chary 已提交
33
 *  Sam Lin        - GPS support
C
Corentin Chary 已提交
34 35 36 37 38 39 40 41 42
 */

#include <linux/autoconf.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/err.h>
#include <linux/proc_fs.h>
43 44
#include <linux/backlight.h>
#include <linux/fb.h>
C
Corentin Chary 已提交
45
#include <linux/leds.h>
C
Corentin Chary 已提交
46 47 48 49 50
#include <linux/platform_device.h>
#include <acpi/acpi_drivers.h>
#include <acpi/acpi_bus.h>
#include <asm/uaccess.h>

51
#define ASUS_LAPTOP_VERSION "0.42"
C
Corentin Chary 已提交
52 53 54 55 56 57 58

#define ASUS_HOTK_NAME          "Asus Laptop Support"
#define ASUS_HOTK_CLASS         "hotkey"
#define ASUS_HOTK_DEVICE_NAME   "Hotkey"
#define ASUS_HOTK_FILE          "asus-laptop"
#define ASUS_HOTK_PREFIX        "\\_SB.ATKD."

59 60 61 62 63 64 65 66
/*
 * Some events we use, same for all Asus
 */
#define ATKD_BR_UP       0x10
#define ATKD_BR_DOWN     0x20
#define ATKD_LCD_ON      0x33
#define ATKD_LCD_OFF     0x34

67 68 69 70 71 72
/*
 * Known bits returned by \_SB.ATKD.HWRS
 */
#define WL_HWRS     0x80
#define BT_HWRS     0x100

C
Corentin Chary 已提交
73 74
/*
 * Flags for hotk status
75
 * WL_ON and BT_ON are also used for wireless_status()
C
Corentin Chary 已提交
76
 */
77 78
#define WL_ON       0x01	//internal Wifi
#define BT_ON       0x02	//internal Bluetooth
C
Corentin Chary 已提交
79 80
#define MLED_ON     0x04	//mail LED
#define TLED_ON     0x08	//touchpad LED
L
Len Brown 已提交
81 82
#define RLED_ON     0x10	//Record LED
#define PLED_ON     0x20	//Phone LED
C
Corentin Chary 已提交
83 84
#define GLED_ON     0x40	//Gaming LED
#define LCD_ON      0x80	//LCD backlight
85
#define GPS_ON      0x100	//GPS
C
Corentin Chary 已提交
86

C
Corentin Chary 已提交
87 88 89 90 91 92 93 94 95 96 97
#define ASUS_LOG    ASUS_HOTK_FILE ": "
#define ASUS_ERR    KERN_ERR    ASUS_LOG
#define ASUS_WARNING    KERN_WARNING    ASUS_LOG
#define ASUS_NOTICE KERN_NOTICE ASUS_LOG
#define ASUS_INFO   KERN_INFO   ASUS_LOG
#define ASUS_DEBUG  KERN_DEBUG  ASUS_LOG

MODULE_AUTHOR("Julien Lerouge, Karol Kozimor, Corentin Chary");
MODULE_DESCRIPTION(ASUS_HOTK_NAME);
MODULE_LICENSE("GPL");

C
Corentin Chary 已提交
98 99 100 101 102 103 104 105 106 107 108 109 110
/* WAPF defines the behavior of the Fn+Fx wlan key
 * The significance of values is yet to be found, but
 * most of the time:
 * 0x0 will do nothing
 * 0x1 will allow to control the device with Fn+Fx key.
 * 0x4 will send an ACPI event (0x88) while pressing the Fn+Fx key
 * 0x5 like 0x1 or 0x4
 * So, if something doesn't work as you want, just try other values =)
 */
static uint wapf = 1;
module_param(wapf, uint, 0644);
MODULE_PARM_DESC(wapf, "WAPF value");

C
Corentin Chary 已提交
111 112 113 114
#define ASUS_HANDLE(object, paths...)					\
	static acpi_handle  object##_handle = NULL;			\
	static char *object##_paths[] = { paths }

C
Corentin Chary 已提交
115 116 117
/* LED */
ASUS_HANDLE(mled_set, ASUS_HOTK_PREFIX "MLED");
ASUS_HANDLE(tled_set, ASUS_HOTK_PREFIX "TLED");
L
Len Brown 已提交
118 119
ASUS_HANDLE(rled_set, ASUS_HOTK_PREFIX "RLED");	/* W1JC */
ASUS_HANDLE(pled_set, ASUS_HOTK_PREFIX "PLED");	/* A7J */
C
Corentin Chary 已提交
120
ASUS_HANDLE(gled_set, ASUS_HOTK_PREFIX "GLED");	/* G1, G2 (probably) */
C
Corentin Chary 已提交
121

C
Corentin Chary 已提交
122 123 124
/* LEDD */
ASUS_HANDLE(ledd_set, ASUS_HOTK_PREFIX "SLCM");

125 126 127 128 129 130
/* Bluetooth and WLAN
 * WLED and BLED are not handled like other XLED, because in some dsdt
 * they also control the WLAN/Bluetooth device.
 */
ASUS_HANDLE(wl_switch, ASUS_HOTK_PREFIX "WLED");
ASUS_HANDLE(bt_switch, ASUS_HOTK_PREFIX "BLED");
L
Len Brown 已提交
131
ASUS_HANDLE(wireless_status, ASUS_HOTK_PREFIX "RSTS");	/* All new models */
132

133 134 135 136 137
/* Brightness */
ASUS_HANDLE(brightness_set, ASUS_HOTK_PREFIX "SPLV");
ASUS_HANDLE(brightness_get, ASUS_HOTK_PREFIX "GPLV");

/* Backlight */
L
Len Brown 已提交
138 139 140 141 142 143 144
ASUS_HANDLE(lcd_switch, "\\_SB.PCI0.SBRG.EC0._Q10",	/* All new models */
	    "\\_SB.PCI0.ISA.EC0._Q10",	/* A1x */
	    "\\_SB.PCI0.PX40.ECD0._Q10",	/* L3C */
	    "\\_SB.PCI0.PX40.EC0.Q10",	/* M1A */
	    "\\_SB.PCI0.LPCB.EC0._Q10",	/* P30 */
	    "\\_SB.PCI0.PX40.Q10",	/* S1x */
	    "\\Q10");		/* A2x, L2D, L3D, M2E */
145

146 147
/* Display */
ASUS_HANDLE(display_set, ASUS_HOTK_PREFIX "SDSP");
L
Len Brown 已提交
148 149 150
ASUS_HANDLE(display_get, "\\_SB.PCI0.P0P1.VGA.GETD",	/*  A6B, A6K A6R A7D F3JM L4R M6R A3G
							   M6A M6V VX-1 V6J V6V W3Z */
	    "\\_SB.PCI0.P0P2.VGA.GETD",	/* A3E A4K, A4D A4L A6J A7J A8J Z71V M9V
151
					   S5A M5A z33A W1Jc W2V G1 */
L
Len Brown 已提交
152 153 154 155 156 157 158 159 160 161 162 163
	    "\\_SB.PCI0.P0P3.VGA.GETD",	/* A6V A6Q */
	    "\\_SB.PCI0.P0PA.VGA.GETD",	/* A6T, A6M */
	    "\\_SB.PCI0.PCI1.VGAC.NMAP",	/* L3C */
	    "\\_SB.PCI0.VGA.GETD",	/* Z96F */
	    "\\ACTD",		/* A2D */
	    "\\ADVG",		/* A4G Z71A W1N W5A W5F M2N M3N M5N M6N S1N S5N */
	    "\\DNXT",		/* P30 */
	    "\\INFB",		/* A2H D1 L2D L3D L3H L2E L5D L5C M1A M2E L4L W3V */
	    "\\SSTE");		/* A3F A6F A3N A3L M6N W3N W6A */

ASUS_HANDLE(ls_switch, ASUS_HOTK_PREFIX "ALSC");	/* Z71A Z71V */
ASUS_HANDLE(ls_level, ASUS_HOTK_PREFIX "ALSL");	/* Z71A Z71V */
164

C
Corentin Chary 已提交
165 166
/* GPS */
/* R2H use different handle for GPS on/off */
167 168
ASUS_HANDLE(gps_on, ASUS_HOTK_PREFIX "SDON");	/* R2H */
ASUS_HANDLE(gps_off, ASUS_HOTK_PREFIX "SDOF");	/* R2H */
C
Corentin Chary 已提交
169 170
ASUS_HANDLE(gps_status, ASUS_HOTK_PREFIX "GPST");

C
Corentin Chary 已提交
171 172 173 174 175
/*
 * This is the main structure, we can use it to store anything interesting
 * about the hotk device
 */
struct asus_hotk {
L
Len Brown 已提交
176
	char *name;		//laptop name
C
Corentin Chary 已提交
177 178 179
	struct acpi_device *device;	//the device we are in
	acpi_handle handle;	//the handle of the hotk device
	char status;		//status of the hotk, for LEDs, ...
C
Corentin Chary 已提交
180
	u32 ledd_status;	//status of the LED display
L
Len Brown 已提交
181 182
	u8 light_level;		//light sensor level
	u8 light_switch;	//light sensor switch value
C
Corentin Chary 已提交
183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198
	u16 event_count[128];	//count for each event TODO make this better
};

/*
 * This header is made available to allow proper configuration given model,
 * revision number , ... this info cannot go in struct asus_hotk because it is
 * available before the hotk
 */
static struct acpi_table_header *asus_info;

/* The actual device the driver binds to */
static struct asus_hotk *hotk;

/*
 * The hotkey driver declaration
 */
199 200 201 202 203 204
static const struct acpi_device_id asus_device_ids[] = {
	{"ATK0100", 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, asus_device_ids);

C
Corentin Chary 已提交
205 206 207 208 209
static int asus_hotk_add(struct acpi_device *device);
static int asus_hotk_remove(struct acpi_device *device, int type);
static struct acpi_driver asus_hotk_driver = {
	.name = ASUS_HOTK_NAME,
	.class = ASUS_HOTK_CLASS,
210
	.ids = asus_device_ids,
C
Corentin Chary 已提交
211 212 213 214 215 216
	.ops = {
		.add = asus_hotk_add,
		.remove = asus_hotk_remove,
		},
};

217 218 219 220 221 222 223 224
/* The backlight device /sys/class/backlight */
static struct backlight_device *asus_backlight_device;

/*
 * The backlight class declaration
 */
static int read_brightness(struct backlight_device *bd);
static int update_bl_status(struct backlight_device *bd);
225
static struct backlight_ops asusbl_ops = {
L
Len Brown 已提交
226 227
	.get_brightness = read_brightness,
	.update_status = update_bl_status,
228 229
};

C
Corentin Chary 已提交
230 231 232 233 234 235 236 237 238 239 240
/* These functions actually update the LED's, and are called from a
 * workqueue. By doing this as separate work rather than when the LED
 * subsystem asks, we avoid messing with the Asus ACPI stuff during a
 * potentially bad time, such as a timer interrupt. */
static struct workqueue_struct *led_workqueue;

#define ASUS_LED(object, ledname)					\
	static void object##_led_set(struct led_classdev *led_cdev,	\
				     enum led_brightness value);	\
	static void object##_led_update(struct work_struct *ignored);	\
	static int object##_led_wk;					\
A
Adrian Bunk 已提交
241
	static DECLARE_WORK(object##_led_work, object##_led_update);	\
C
Corentin Chary 已提交
242 243 244 245 246 247 248 249 250
	static struct led_classdev object##_led = {			\
		.name           = "asus:" ledname,			\
		.brightness_set = object##_led_set,			\
	}

ASUS_LED(mled, "mail");
ASUS_LED(tled, "touchpad");
ASUS_LED(rled, "record");
ASUS_LED(pled, "phone");
C
Corentin Chary 已提交
251
ASUS_LED(gled, "gaming");
C
Corentin Chary 已提交
252

C
Corentin Chary 已提交
253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275
/*
 * This function evaluates an ACPI method, given an int as parameter, the
 * method is searched within the scope of the handle, can be NULL. The output
 * of the method is written is output, which can also be NULL
 *
 * returns 1 if write is successful, 0 else.
 */
static int write_acpi_int(acpi_handle handle, const char *method, int val,
			  struct acpi_buffer *output)
{
	struct acpi_object_list params;	//list of input parameters (an int here)
	union acpi_object in_obj;	//the only param we use
	acpi_status status;

	params.count = 1;
	params.pointer = &in_obj;
	in_obj.type = ACPI_TYPE_INTEGER;
	in_obj.integer.value = val;

	status = acpi_evaluate_object(handle, (char *)method, &params, output);
	return (status == AE_OK);
}

L
Len Brown 已提交
276 277
static int read_wireless_status(int mask)
{
278 279
	ulong status;
	acpi_status rv = AE_OK;
280 281 282 283

	if (!wireless_status_handle)
		return (hotk->status & mask) ? 1 : 0;

284 285
	rv = acpi_evaluate_integer(wireless_status_handle, NULL, NULL, &status);
	if (ACPI_FAILURE(rv))
286
		printk(ASUS_WARNING "Error reading Wireless status\n");
287 288
	else
		return (status & mask) ? 1 : 0;
289 290 291 292

	return (hotk->status & mask) ? 1 : 0;
}

293 294 295
static int read_gps_status(void)
{
	ulong status;
C
Corentin Chary 已提交
296 297 298 299
	acpi_status rv = AE_OK;

	rv = acpi_evaluate_integer(gps_status_handle, NULL, NULL, &status);
	if (ACPI_FAILURE(rv))
300
		printk(ASUS_WARNING "Error reading GPS status\n");
C
Corentin Chary 已提交
301
	else
302
		return status ? 1 : 0;
C
Corentin Chary 已提交
303

304
	return (hotk->status & GPS_ON) ? 1 : 0;
C
Corentin Chary 已提交
305 306
}

C
Corentin Chary 已提交
307 308 309
/* Generic LED functions */
static int read_status(int mask)
{
310 311 312
	/* There is a special method for both wireless devices */
	if (mask == BT_ON || mask == WL_ON)
		return read_wireless_status(mask);
313 314
	else if (mask == GPS_ON)
		return read_gps_status();
315

C
Corentin Chary 已提交
316 317 318
	return (hotk->status & mask) ? 1 : 0;
}

C
Corentin Chary 已提交
319
static void write_status(acpi_handle handle, int out, int mask)
C
Corentin Chary 已提交
320 321 322
{
	hotk->status = (out) ? (hotk->status | mask) : (hotk->status & ~mask);

C
Corentin Chary 已提交
323 324
	switch (mask) {
	case MLED_ON:
C
Corentin Chary 已提交
325
		out = !out & 0x1;
C
Corentin Chary 已提交
326
		break;
C
Corentin Chary 已提交
327 328 329
	case GLED_ON:
		out = (out & 0x1) + 1;
		break;
C
Corentin Chary 已提交
330 331 332 333
	case GPS_ON:
		handle = (out) ? gps_on_handle : gps_off_handle;
		out = 0x02;
		break;
C
Corentin Chary 已提交
334 335 336 337
	default:
		out &= 0x1;
		break;
	}
C
Corentin Chary 已提交
338 339

	if (handle && !write_acpi_int(handle, NULL, out, NULL))
C
Corentin Chary 已提交
340
		printk(ASUS_WARNING " write failed %x\n", mask);
C
Corentin Chary 已提交
341 342 343
}

/* /sys/class/led handlers */
C
Corentin Chary 已提交
344
#define ASUS_LED_HANDLER(object, mask)					\
C
Corentin Chary 已提交
345 346 347 348 349 350 351 352 353
	static void object##_led_set(struct led_classdev *led_cdev,	\
				     enum led_brightness value)		\
	{								\
		object##_led_wk = value;				\
		queue_work(led_workqueue, &object##_led_work);		\
	}								\
	static void object##_led_update(struct work_struct *ignored)	\
	{								\
		int value = object##_led_wk;				\
C
Corentin Chary 已提交
354
		write_status(object##_set_handle, value, (mask));	\
C
Corentin Chary 已提交
355 356
	}

C
Corentin Chary 已提交
357 358 359 360
ASUS_LED_HANDLER(mled, MLED_ON);
ASUS_LED_HANDLER(pled, PLED_ON);
ASUS_LED_HANDLER(rled, RLED_ON);
ASUS_LED_HANDLER(tled, TLED_ON);
C
Corentin Chary 已提交
361
ASUS_LED_HANDLER(gled, GLED_ON);
C
Corentin Chary 已提交
362

363 364 365 366 367 368 369 370 371 372 373 374 375 376 377
static int get_lcd_state(void)
{
	return read_status(LCD_ON);
}

static int set_lcd_state(int value)
{
	int lcd = 0;
	acpi_status status = 0;

	lcd = value ? 1 : 0;

	if (lcd == get_lcd_state())
		return 0;

L
Len Brown 已提交
378
	if (lcd_switch_handle) {
379 380 381 382 383 384 385
		status = acpi_evaluate_object(lcd_switch_handle,
					      NULL, NULL, NULL);

		if (ACPI_FAILURE(status))
			printk(ASUS_WARNING "Error switching LCD\n");
	}

C
Corentin Chary 已提交
386
	write_status(NULL, lcd, LCD_ON);
387 388 389 390 391 392 393
	return 0;
}

static void lcd_blank(int blank)
{
	struct backlight_device *bd = asus_backlight_device;

L
Len Brown 已提交
394
	if (bd) {
395
		bd->props.power = blank;
396
		backlight_update_status(bd);
397 398 399 400 401
	}
}

static int read_brightness(struct backlight_device *bd)
{
402 403
	ulong value;
	acpi_status rv = AE_OK;
404

405 406
	rv = acpi_evaluate_integer(brightness_get_handle, NULL, NULL, &value);
	if (ACPI_FAILURE(rv))
407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429
		printk(ASUS_WARNING "Error reading brightness\n");

	return value;
}

static int set_brightness(struct backlight_device *bd, int value)
{
	int ret = 0;

	value = (0 < value) ? ((15 < value) ? 15 : value) : 0;
	/* 0 <= value <= 15 */

	if (!write_acpi_int(brightness_set_handle, NULL, value, NULL)) {
		printk(ASUS_WARNING "Error changing brightness\n");
		ret = -EIO;
	}

	return ret;
}

static int update_bl_status(struct backlight_device *bd)
{
	int rv;
430
	int value = bd->props.brightness;
431 432

	rv = set_brightness(bd, value);
L
Len Brown 已提交
433
	if (rv)
434 435
		return rv;

436
	value = (bd->props.power == FB_BLANK_UNBLANK) ? 1 : 0;
437 438 439
	return set_lcd_state(value);
}

C
Corentin Chary 已提交
440 441 442 443 444 445 446 447 448 449
/*
 * Platform device handlers
 */

/*
 * We write our info in page, we begin at offset off and cannot write more
 * than count bytes. We set eof to 1 if we handle those 2 values. We return the
 * number of bytes written in page
 */
static ssize_t show_infos(struct device *dev,
L
Len Brown 已提交
450
			  struct device_attribute *attr, char *page)
C
Corentin Chary 已提交
451 452
{
	int len = 0;
453
	ulong temp;
C
Corentin Chary 已提交
454
	char buf[16];		//enough for all info
455 456
	acpi_status rv = AE_OK;

C
Corentin Chary 已提交
457 458 459 460 461 462 463 464 465 466 467 468 469
	/*
	 * We use the easy way, we don't care of off and count, so we don't set eof
	 * to 1
	 */

	len += sprintf(page, ASUS_HOTK_NAME " " ASUS_LAPTOP_VERSION "\n");
	len += sprintf(page + len, "Model reference    : %s\n", hotk->name);
	/*
	 * 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.
	 */
470 471 472 473
	rv = acpi_evaluate_integer(hotk->handle, "SFUN", NULL, &temp);
	if (!ACPI_FAILURE(rv))
		len += sprintf(page + len, "SFUN value         : 0x%04x\n",
			       (uint) temp);
C
Corentin Chary 已提交
474 475 476 477 478 479 480
	/*
	 * Another value for userspace: the ASYM method returns 0x02 for
	 * battery low and 0x04 for battery critical, its readings tend to be
	 * more accurate than those provided by _BST.
	 * Note: since not all the laptops provide this method, errors are
	 * silently ignored.
	 */
481 482 483 484
	rv = acpi_evaluate_integer(hotk->handle, "ASYM", NULL, &temp);
	if (!ACPI_FAILURE(rv))
		len += sprintf(page + len, "ASYM value         : 0x%04x\n",
			       (uint) temp);
C
Corentin Chary 已提交
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
	if (asus_info) {
		snprintf(buf, 16, "%d", asus_info->length);
		len += sprintf(page + len, "DSDT length        : %s\n", buf);
		snprintf(buf, 16, "%d", asus_info->checksum);
		len += sprintf(page + len, "DSDT checksum      : %s\n", buf);
		snprintf(buf, 16, "%d", asus_info->revision);
		len += sprintf(page + len, "DSDT revision      : %s\n", buf);
		snprintf(buf, 7, "%s", asus_info->oem_id);
		len += sprintf(page + len, "OEM id             : %s\n", buf);
		snprintf(buf, 9, "%s", asus_info->oem_table_id);
		len += sprintf(page + len, "OEM table id       : %s\n", buf);
		snprintf(buf, 16, "%x", asus_info->oem_revision);
		len += sprintf(page + len, "OEM revision       : 0x%s\n", buf);
		snprintf(buf, 5, "%s", asus_info->asl_compiler_id);
		len += sprintf(page + len, "ASL comp vendor id : %s\n", buf);
		snprintf(buf, 16, "%x", asus_info->asl_compiler_revision);
		len += sprintf(page + len, "ASL comp revision  : 0x%s\n", buf);
	}

	return len;
}

static int parse_arg(const char *buf, unsigned long count, int *val)
{
	if (!count)
		return 0;
	if (count > 31)
		return -EINVAL;
	if (sscanf(buf, "%i", val) != 1)
		return -EINVAL;
	return count;
}

518
static ssize_t store_status(const char *buf, size_t count,
C
Corentin Chary 已提交
519
			    acpi_handle handle, int mask)
520 521 522 523 524 525 526 527
{
	int rv, value;
	int out = 0;

	rv = parse_arg(buf, count, &value);
	if (rv > 0)
		out = value ? 1 : 0;

C
Corentin Chary 已提交
528
	write_status(handle, out, mask);
529 530 531 532

	return rv;
}

C
Corentin Chary 已提交
533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556
/*
 * LEDD display
 */
static ssize_t show_ledd(struct device *dev,
			 struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "0x%08x\n", hotk->ledd_status);
}

static ssize_t store_ledd(struct device *dev, struct device_attribute *attr,
			  const char *buf, size_t count)
{
	int rv, value;

	rv = parse_arg(buf, count, &value);
	if (rv > 0) {
		if (!write_acpi_int(ledd_set_handle, NULL, value, NULL))
			printk(ASUS_WARNING "LED display write failed\n");
		else
			hotk->ledd_status = (u32) value;
	}
	return rv;
}

557 558 559 560 561 562 563 564 565 566 567 568
/*
 * WLAN
 */
static ssize_t show_wlan(struct device *dev,
			 struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "%d\n", read_status(WL_ON));
}

static ssize_t store_wlan(struct device *dev, struct device_attribute *attr,
			  const char *buf, size_t count)
{
C
Corentin Chary 已提交
569
	return store_status(buf, count, wl_switch_handle, WL_ON);
570 571 572 573 574 575 576 577 578 579 580
}

/*
 * Bluetooth
 */
static ssize_t show_bluetooth(struct device *dev,
			      struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "%d\n", read_status(BT_ON));
}

L
Len Brown 已提交
581 582 583
static ssize_t store_bluetooth(struct device *dev,
			       struct device_attribute *attr, const char *buf,
			       size_t count)
584
{
C
Corentin Chary 已提交
585
	return store_status(buf, count, bt_switch_handle, BT_ON);
586 587
}

588 589 590 591 592 593 594 595 596 597 598 599 600
/*
 * Display
 */
static void set_display(int value)
{
	/* no sanity check needed for now */
	if (!write_acpi_int(display_set_handle, NULL, value, NULL))
		printk(ASUS_WARNING "Error setting display\n");
	return;
}

static int read_display(void)
{
601 602
	ulong value = 0;
	acpi_status rv = AE_OK;
603 604 605

	/* In most of the case, we know how to set the display, but sometime
	   we can't read it */
L
Len Brown 已提交
606
	if (display_get_handle) {
607 608 609
		rv = acpi_evaluate_integer(display_get_handle, NULL,
					   NULL, &value);
		if (ACPI_FAILURE(rv))
610 611 612 613 614 615 616
			printk(ASUS_WARNING "Error reading display status\n");
	}

	value &= 0x0F;		/* needed for some models, shouldn't hurt others */

	return value;
}
L
Len Brown 已提交
617

618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645
/*
 * Now, *this* one could be more user-friendly, but so far, no-one has
 * complained. The significance of bits is the same as in store_disp()
 */
static ssize_t show_disp(struct device *dev,
			 struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "%d\n", read_display());
}

/*
 * Experimental support for display switching. As of now: 1 should activate
 * the LCD output, 2 should do for CRT, 4 for TV-Out and 8 for DVI.
 * Any combination (bitwise) of these will suffice. I never actually tested 4
 * displays hooked up simultaneously, so be warned. See the acpi4asus README
 * for more info.
 */
static ssize_t store_disp(struct device *dev, struct device_attribute *attr,
			  const char *buf, size_t count)
{
	int rv, value;

	rv = parse_arg(buf, count, &value);
	if (rv > 0)
		set_display(value);
	return rv;
}

646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701
/*
 * Light Sens
 */
static void set_light_sens_switch(int value)
{
	if (!write_acpi_int(ls_switch_handle, NULL, value, NULL))
		printk(ASUS_WARNING "Error setting light sensor switch\n");
	hotk->light_switch = value;
}

static ssize_t show_lssw(struct device *dev,
			 struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "%d\n", hotk->light_switch);
}

static ssize_t store_lssw(struct device *dev, struct device_attribute *attr,
			  const char *buf, size_t count)
{
	int rv, value;

	rv = parse_arg(buf, count, &value);
	if (rv > 0)
		set_light_sens_switch(value ? 1 : 0);

	return rv;
}

static void set_light_sens_level(int value)
{
	if (!write_acpi_int(ls_level_handle, NULL, value, NULL))
		printk(ASUS_WARNING "Error setting light sensor level\n");
	hotk->light_level = value;
}

static ssize_t show_lslvl(struct device *dev,
			  struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "%d\n", hotk->light_level);
}

static ssize_t store_lslvl(struct device *dev, struct device_attribute *attr,
			   const char *buf, size_t count)
{
	int rv, value;

	rv = parse_arg(buf, count, &value);
	if (rv > 0) {
		value = (0 < value) ? ((15 < value) ? 15 : value) : 0;
		/* 0 <= value <= 15 */
		set_light_sens_level(value);
	}

	return rv;
}

C
Corentin Chary 已提交
702 703 704 705 706 707 708 709 710 711 712 713
/*
 * GPS
 */
static ssize_t show_gps(struct device *dev,
			struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "%d\n", read_status(GPS_ON));
}

static ssize_t store_gps(struct device *dev, struct device_attribute *attr,
			 const char *buf, size_t count)
{
714
	return store_status(buf, count, NULL, GPS_ON);
C
Corentin Chary 已提交
715 716
}

C
Corentin Chary 已提交
717 718 719 720 721 722
static void asus_hotk_notify(acpi_handle handle, u32 event, void *data)
{
	/* TODO Find a better way to handle events count. */
	if (!hotk)
		return;

723 724 725 726 727
	/*
	 * We need to tell the backlight device when the backlight power is
	 * switched
	 */
	if (event == ATKD_LCD_ON) {
C
Corentin Chary 已提交
728
		write_status(NULL, 1, LCD_ON);
729
		lcd_blank(FB_BLANK_UNBLANK);
L
Len Brown 已提交
730
	} else if (event == ATKD_LCD_OFF) {
C
Corentin Chary 已提交
731
		write_status(NULL, 0, LCD_ON);
732 733 734
		lcd_blank(FB_BLANK_POWERDOWN);
	}

C
Corentin Chary 已提交
735 736 737 738 739 740 741 742 743 744
	acpi_bus_generate_event(hotk->device, event,
				hotk->event_count[event % 128]++);

	return;
}

#define ASUS_CREATE_DEVICE_ATTR(_name)					\
	struct device_attribute dev_attr_##_name = {			\
		.attr = {						\
			.name = __stringify(_name),			\
745
			.mode = 0 },					\
C
Corentin Chary 已提交
746 747 748 749 750 751 752 753 754 755 756 757
		.show   = NULL,						\
		.store  = NULL,						\
	}

#define ASUS_SET_DEVICE_ATTR(_name, _mode, _show, _store)		\
	do {								\
		dev_attr_##_name.attr.mode = _mode;			\
		dev_attr_##_name.show = _show;				\
		dev_attr_##_name.store = _store;			\
	} while(0)

static ASUS_CREATE_DEVICE_ATTR(infos);
758 759
static ASUS_CREATE_DEVICE_ATTR(wlan);
static ASUS_CREATE_DEVICE_ATTR(bluetooth);
760
static ASUS_CREATE_DEVICE_ATTR(display);
C
Corentin Chary 已提交
761
static ASUS_CREATE_DEVICE_ATTR(ledd);
762 763
static ASUS_CREATE_DEVICE_ATTR(ls_switch);
static ASUS_CREATE_DEVICE_ATTR(ls_level);
C
Corentin Chary 已提交
764
static ASUS_CREATE_DEVICE_ATTR(gps);
C
Corentin Chary 已提交
765 766

static struct attribute *asuspf_attributes[] = {
L
Len Brown 已提交
767 768 769 770 771 772 773
	&dev_attr_infos.attr,
	&dev_attr_wlan.attr,
	&dev_attr_bluetooth.attr,
	&dev_attr_display.attr,
	&dev_attr_ledd.attr,
	&dev_attr_ls_switch.attr,
	&dev_attr_ls_level.attr,
C
Corentin Chary 已提交
774
	&dev_attr_gps.attr,
L
Len Brown 已提交
775
	NULL
C
Corentin Chary 已提交
776 777 778
};

static struct attribute_group asuspf_attribute_group = {
L
Len Brown 已提交
779
	.attrs = asuspf_attributes
C
Corentin Chary 已提交
780 781 782
};

static struct platform_driver asuspf_driver = {
L
Len Brown 已提交
783 784 785 786
	.driver = {
		   .name = ASUS_HOTK_FILE,
		   .owner = THIS_MODULE,
		   }
C
Corentin Chary 已提交
787 788 789 790 791 792 793
};

static struct platform_device *asuspf_device;

static void asus_hotk_add_fs(void)
{
	ASUS_SET_DEVICE_ATTR(infos, 0444, show_infos, NULL);
794 795 796 797 798 799 800

	if (wl_switch_handle)
		ASUS_SET_DEVICE_ATTR(wlan, 0644, show_wlan, store_wlan);

	if (bt_switch_handle)
		ASUS_SET_DEVICE_ATTR(bluetooth, 0644,
				     show_bluetooth, store_bluetooth);
801 802 803

	if (display_set_handle && display_get_handle)
		ASUS_SET_DEVICE_ATTR(display, 0644, show_disp, store_disp);
L
Len Brown 已提交
804
	else if (display_set_handle)
805 806
		ASUS_SET_DEVICE_ATTR(display, 0200, NULL, store_disp);

C
Corentin Chary 已提交
807 808 809
	if (ledd_set_handle)
		ASUS_SET_DEVICE_ATTR(ledd, 0644, show_ledd, store_ledd);

810 811 812 813
	if (ls_switch_handle && ls_level_handle) {
		ASUS_SET_DEVICE_ATTR(ls_level, 0644, show_lslvl, store_lslvl);
		ASUS_SET_DEVICE_ATTR(ls_switch, 0644, show_lssw, store_lssw);
	}
C
Corentin Chary 已提交
814

815
	if (gps_status_handle && gps_on_handle && gps_off_handle)
C
Corentin Chary 已提交
816
		ASUS_SET_DEVICE_ATTR(gps, 0644, show_gps, store_gps);
C
Corentin Chary 已提交
817 818
}

L
Len Brown 已提交
819
static int asus_handle_init(char *name, acpi_handle * handle,
C
Corentin Chary 已提交
820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846
			    char **paths, int num_paths)
{
	int i;
	acpi_status status;

	for (i = 0; i < num_paths; i++) {
		status = acpi_get_handle(NULL, paths[i], handle);
		if (ACPI_SUCCESS(status))
			return 0;
	}

	*handle = NULL;
	return -ENODEV;
}

#define ASUS_HANDLE_INIT(object)					\
	asus_handle_init(#object, &object##_handle, object##_paths,	\
			 ARRAY_SIZE(object##_paths))

/*
 * This function is used to initialize the hotk with right values. In this
 * method, we can make all the detection we want, and modify the hotk struct
 */
static int asus_hotk_get_info(void)
{
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *model = NULL;
847
	ulong bsts_result, hwrs_result;
C
Corentin Chary 已提交
848 849 850 851 852 853 854 855 856 857 858
	char *string = NULL;
	acpi_status status;

	/*
	 * Get DSDT headers early enough to allow for differentiating between
	 * models, but late enough to allow acpi_bus_register_driver() to fail
	 * before doing anything ACPI-specific. Should we encounter a machine,
	 * which needs special handling (i.e. its hotkey device has a different
	 * HID), this bit will be moved. A global variable asus_info contains
	 * the DSDT header.
	 */
859
	status = acpi_get_table(ACPI_SIG_DSDT, 1, &asus_info);
C
Corentin Chary 已提交
860 861 862 863 864 865 866 867 868 869
	if (ACPI_FAILURE(status))
		printk(ASUS_WARNING "Couldn't get the DSDT table header\n");

	/* We have to write 0 on init this far for all ASUS models */
	if (!write_acpi_int(hotk->handle, "INIT", 0, &buffer)) {
		printk(ASUS_ERR "Hotkey initialization failed\n");
		return -ENODEV;
	}

	/* This needs to be called for some laptops to init properly */
870 871 872
	status =
	    acpi_evaluate_integer(hotk->handle, "BSTS", NULL, &bsts_result);
	if (ACPI_FAILURE(status))
C
Corentin Chary 已提交
873 874 875
		printk(ASUS_WARNING "Error calling BSTS\n");
	else if (bsts_result)
		printk(ASUS_NOTICE "BSTS called, 0x%02x returned\n",
876
		       (uint) bsts_result);
C
Corentin Chary 已提交
877

C
Corentin Chary 已提交
878 879 880
	/* This too ... */
	write_acpi_int(hotk->handle, "CWAP", wapf, NULL);

C
Corentin Chary 已提交
881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904
	/*
	 * Try to match the object returned by INIT to the specific model.
	 * Handle every possible object (or the lack of thereof) the DSDT
	 * writers might throw at us. When in trouble, we pass NULL to
	 * asus_model_match() and try something completely different.
	 */
	if (buffer.pointer) {
		model = buffer.pointer;
		switch (model->type) {
		case ACPI_TYPE_STRING:
			string = model->string.pointer;
			break;
		case ACPI_TYPE_BUFFER:
			string = model->buffer.pointer;
			break;
		default:
			string = "";
			break;
		}
	}
	hotk->name = kstrdup(string, GFP_KERNEL);
	if (!hotk->name)
		return -ENOMEM;

L
Len Brown 已提交
905
	if (*string)
C
Corentin Chary 已提交
906 907
		printk(ASUS_NOTICE "  %s model detected\n", string);

C
Corentin Chary 已提交
908 909 910 911
	ASUS_HANDLE_INIT(mled_set);
	ASUS_HANDLE_INIT(tled_set);
	ASUS_HANDLE_INIT(rled_set);
	ASUS_HANDLE_INIT(pled_set);
C
Corentin Chary 已提交
912
	ASUS_HANDLE_INIT(gled_set);
C
Corentin Chary 已提交
913

C
Corentin Chary 已提交
914 915
	ASUS_HANDLE_INIT(ledd_set);

916 917 918 919 920 921
	/*
	 * The HWRS method return informations about the hardware.
	 * 0x80 bit is for WLAN, 0x100 for Bluetooth.
	 * The significance of others is yet to be found.
	 * If we don't find the method, we assume the device are present.
	 */
922 923 924
	status =
	    acpi_evaluate_integer(hotk->handle, "HRWS", NULL, &hwrs_result);
	if (ACPI_FAILURE(status))
925 926
		hwrs_result = WL_HWRS | BT_HWRS;

L
Len Brown 已提交
927
	if (hwrs_result & WL_HWRS)
928
		ASUS_HANDLE_INIT(wl_switch);
L
Len Brown 已提交
929
	if (hwrs_result & BT_HWRS)
930 931 932 933
		ASUS_HANDLE_INIT(bt_switch);

	ASUS_HANDLE_INIT(wireless_status);

934 935 936 937 938
	ASUS_HANDLE_INIT(brightness_set);
	ASUS_HANDLE_INIT(brightness_get);

	ASUS_HANDLE_INIT(lcd_switch);

939 940 941
	ASUS_HANDLE_INIT(display_set);
	ASUS_HANDLE_INIT(display_get);

942 943
	/* There is a lot of models with "ALSL", but a few get
	   a real light sens, so we need to check it. */
944
	if (!ASUS_HANDLE_INIT(ls_switch))
945 946
		ASUS_HANDLE_INIT(ls_level);

C
Corentin Chary 已提交
947 948 949 950
	ASUS_HANDLE_INIT(gps_on);
	ASUS_HANDLE_INIT(gps_off);
	ASUS_HANDLE_INIT(gps_status);

C
Corentin Chary 已提交
951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986
	kfree(model);

	return AE_OK;
}

static int asus_hotk_check(void)
{
	int result = 0;

	result = acpi_bus_get_status(hotk->device);
	if (result)
		return result;

	if (hotk->device->status.present) {
		result = asus_hotk_get_info();
	} else {
		printk(ASUS_ERR "Hotkey device not present, aborting\n");
		return -EINVAL;
	}

	return result;
}

static int asus_hotk_found;

static int asus_hotk_add(struct acpi_device *device)
{
	acpi_status status = AE_OK;
	int result;

	if (!device)
		return -EINVAL;

	printk(ASUS_NOTICE "Asus Laptop Support version %s\n",
	       ASUS_LAPTOP_VERSION);

987
	hotk = kzalloc(sizeof(struct asus_hotk), GFP_KERNEL);
C
Corentin Chary 已提交
988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006
	if (!hotk)
		return -ENOMEM;

	hotk->handle = device->handle;
	strcpy(acpi_device_name(device), ASUS_HOTK_DEVICE_NAME);
	strcpy(acpi_device_class(device), ASUS_HOTK_CLASS);
	acpi_driver_data(device) = hotk;
	hotk->device = device;

	result = asus_hotk_check();
	if (result)
		goto end;

	asus_hotk_add_fs();

	/*
	 * We install the handler, it will receive the hotk in parameter, so, we
	 * could add other data to the hotk struct
	 */
C
Corentin Chary 已提交
1007
	status = acpi_install_notify_handler(hotk->handle, ACPI_ALL_NOTIFY,
C
Corentin Chary 已提交
1008 1009 1010 1011 1012 1013
					     asus_hotk_notify, hotk);
	if (ACPI_FAILURE(status))
		printk(ASUS_ERR "Error installing notify handler\n");

	asus_hotk_found = 1;

1014
	/* WLED and BLED are on by default */
C
Corentin Chary 已提交
1015 1016 1017 1018 1019 1020
	write_status(bt_switch_handle, 1, BT_ON);
	write_status(wl_switch_handle, 1, WL_ON);

	/* If the h/w switch is off, we need to check the real status */
	write_status(NULL, read_status(BT_ON), BT_ON);
	write_status(NULL, read_status(WL_ON), WL_ON);
1021

1022
	/* LCD Backlight is on by default */
C
Corentin Chary 已提交
1023
	write_status(NULL, 1, LCD_ON);
1024

C
Corentin Chary 已提交
1025 1026 1027
	/* LED display is off by default */
	hotk->ledd_status = 0xFFF;

L
Len Brown 已提交
1028 1029 1030
	/* Set initial values of light sensor and level */
	hotk->light_switch = 1;	/* Default to light sensor disabled */
	hotk->light_level = 0;	/* level 5 for sensor sensitivity */
1031

L
Len Brown 已提交
1032 1033
	if (ls_switch_handle)
		set_light_sens_switch(hotk->light_switch);
1034

L
Len Brown 已提交
1035 1036
	if (ls_level_handle)
		set_light_sens_level(hotk->light_level);
1037

C
Corentin Chary 已提交
1038 1039 1040
	/* GPS is on by default */
	write_status(NULL, 1, GPS_ON);

C
Corentin Chary 已提交
1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056
      end:
	if (result) {
		kfree(hotk->name);
		kfree(hotk);
	}

	return result;
}

static int asus_hotk_remove(struct acpi_device *device, int type)
{
	acpi_status status = 0;

	if (!device || !acpi_driver_data(device))
		return -EINVAL;

C
Corentin Chary 已提交
1057
	status = acpi_remove_notify_handler(hotk->handle, ACPI_ALL_NOTIFY,
C
Corentin Chary 已提交
1058 1059 1060 1061 1062 1063 1064 1065 1066 1067
					    asus_hotk_notify);
	if (ACPI_FAILURE(status))
		printk(ASUS_ERR "Error removing notify handler\n");

	kfree(hotk->name);
	kfree(hotk);

	return 0;
}

1068 1069
static void asus_backlight_exit(void)
{
L
Len Brown 已提交
1070
	if (asus_backlight_device)
1071 1072 1073
		backlight_device_unregister(asus_backlight_device);
}

C
Corentin Chary 已提交
1074
#define  ASUS_LED_UNREGISTER(object)				\
A
Al Viro 已提交
1075
	led_classdev_unregister(&object##_led)
C
Corentin Chary 已提交
1076 1077 1078

static void asus_led_exit(void)
{
A
Al Viro 已提交
1079
	destroy_workqueue(led_workqueue);
C
Corentin Chary 已提交
1080 1081 1082 1083
	ASUS_LED_UNREGISTER(mled);
	ASUS_LED_UNREGISTER(tled);
	ASUS_LED_UNREGISTER(pled);
	ASUS_LED_UNREGISTER(rled);
C
Corentin Chary 已提交
1084
	ASUS_LED_UNREGISTER(gled);
C
Corentin Chary 已提交
1085 1086
}

C
Corentin Chary 已提交
1087 1088
static void __exit asus_laptop_exit(void)
{
1089
	asus_backlight_exit();
C
Corentin Chary 已提交
1090 1091
	asus_led_exit();

C
Corentin Chary 已提交
1092
	acpi_bus_unregister_driver(&asus_hotk_driver);
L
Len Brown 已提交
1093 1094 1095
	sysfs_remove_group(&asuspf_device->dev.kobj, &asuspf_attribute_group);
	platform_device_unregister(asuspf_device);
	platform_driver_unregister(&asuspf_driver);
C
Corentin Chary 已提交
1096 1097
}

L
Len Brown 已提交
1098
static int asus_backlight_init(struct device *dev)
1099 1100 1101
{
	struct backlight_device *bd;

L
Len Brown 已提交
1102 1103
	if (brightness_set_handle && lcd_switch_handle) {
		bd = backlight_device_register(ASUS_HOTK_FILE, dev,
1104
					       NULL, &asusbl_ops);
L
Len Brown 已提交
1105
		if (IS_ERR(bd)) {
1106 1107 1108 1109 1110 1111 1112 1113
			printk(ASUS_ERR
			       "Could not register asus backlight device\n");
			asus_backlight_device = NULL;
			return PTR_ERR(bd);
		}

		asus_backlight_device = bd;

1114 1115 1116
		bd->props.max_brightness = 15;
		bd->props.brightness = read_brightness(NULL);
		bd->props.power = FB_BLANK_UNBLANK;
1117
		backlight_update_status(bd);
1118 1119 1120 1121
	}
	return 0;
}

C
Corentin Chary 已提交
1122
static int asus_led_register(acpi_handle handle,
L
Len Brown 已提交
1123
			     struct led_classdev *ldev, struct device *dev)
C
Corentin Chary 已提交
1124
{
L
Len Brown 已提交
1125
	if (!handle)
C
Corentin Chary 已提交
1126 1127 1128 1129
		return 0;

	return led_classdev_register(dev, ldev);
}
L
Len Brown 已提交
1130

C
Corentin Chary 已提交
1131 1132 1133
#define ASUS_LED_REGISTER(object, device)				\
	asus_led_register(object##_set_handle, &object##_led, device)

L
Len Brown 已提交
1134
static int asus_led_init(struct device *dev)
C
Corentin Chary 已提交
1135 1136 1137 1138
{
	int rv;

	rv = ASUS_LED_REGISTER(mled, dev);
L
Len Brown 已提交
1139
	if (rv)
A
Al Viro 已提交
1140
		goto out;
C
Corentin Chary 已提交
1141 1142

	rv = ASUS_LED_REGISTER(tled, dev);
L
Len Brown 已提交
1143
	if (rv)
A
Al Viro 已提交
1144
		goto out1;
C
Corentin Chary 已提交
1145 1146

	rv = ASUS_LED_REGISTER(rled, dev);
L
Len Brown 已提交
1147
	if (rv)
A
Al Viro 已提交
1148
		goto out2;
C
Corentin Chary 已提交
1149 1150

	rv = ASUS_LED_REGISTER(pled, dev);
L
Len Brown 已提交
1151
	if (rv)
A
Al Viro 已提交
1152
		goto out3;
C
Corentin Chary 已提交
1153

C
Corentin Chary 已提交
1154 1155
	rv = ASUS_LED_REGISTER(gled, dev);
	if (rv)
A
Al Viro 已提交
1156
		goto out4;
C
Corentin Chary 已提交
1157

C
Corentin Chary 已提交
1158
	led_workqueue = create_singlethread_workqueue("led_workqueue");
L
Len Brown 已提交
1159
	if (!led_workqueue)
A
Al Viro 已提交
1160
		goto out5;
C
Corentin Chary 已提交
1161 1162

	return 0;
A
Al Viro 已提交
1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175
out5:
	rv = -ENOMEM;
	ASUS_LED_UNREGISTER(gled);
out4:
	ASUS_LED_UNREGISTER(pled);
out3:
	ASUS_LED_UNREGISTER(rled);
out2:
	ASUS_LED_UNREGISTER(tled);
out1:
	ASUS_LED_UNREGISTER(mled);
out:
	return rv;
C
Corentin Chary 已提交
1176 1177
}

C
Corentin Chary 已提交
1178 1179
static int __init asus_laptop_init(void)
{
C
Corentin Chary 已提交
1180
	struct device *dev;
C
Corentin Chary 已提交
1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201
	int result;

	if (acpi_disabled)
		return -ENODEV;

	result = acpi_bus_register_driver(&asus_hotk_driver);
	if (result < 0)
		return result;

	/*
	 * This is a bit of a kludge.  We only want this module loaded
	 * for ASUS systems, but there's currently no way to probe the
	 * ACPI namespace for ASUS HIDs.  So we just return failure if
	 * we didn't find one, which will cause the module to be
	 * unloaded.
	 */
	if (!asus_hotk_found) {
		acpi_bus_unregister_driver(&asus_hotk_driver);
		return -ENODEV;
	}

C
Corentin Chary 已提交
1202 1203
	dev = acpi_get_physical_device(hotk->device->handle);

1204
	result = asus_backlight_init(dev);
L
Len Brown 已提交
1205
	if (result)
1206 1207
		goto fail_backlight;

C
Corentin Chary 已提交
1208
	result = asus_led_init(dev);
L
Len Brown 已提交
1209
	if (result)
C
Corentin Chary 已提交
1210 1211
		goto fail_led;

L
Len Brown 已提交
1212
	/* Register platform stuff */
C
Corentin Chary 已提交
1213
	result = platform_driver_register(&asuspf_driver);
L
Len Brown 已提交
1214 1215
	if (result)
		goto fail_platform_driver;
C
Corentin Chary 已提交
1216

L
Len Brown 已提交
1217 1218 1219 1220 1221
	asuspf_device = platform_device_alloc(ASUS_HOTK_FILE, -1);
	if (!asuspf_device) {
		result = -ENOMEM;
		goto fail_platform_device1;
	}
C
Corentin Chary 已提交
1222

L
Len Brown 已提交
1223 1224 1225
	result = platform_device_add(asuspf_device);
	if (result)
		goto fail_platform_device2;
C
Corentin Chary 已提交
1226

L
Len Brown 已提交
1227
	result = sysfs_create_group(&asuspf_device->dev.kobj,
C
Corentin Chary 已提交
1228
				    &asuspf_attribute_group);
L
Len Brown 已提交
1229 1230
	if (result)
		goto fail_sysfs;
C
Corentin Chary 已提交
1231

L
Len Brown 已提交
1232
	return 0;
C
Corentin Chary 已提交
1233

L
Len Brown 已提交
1234 1235
      fail_sysfs:
	platform_device_del(asuspf_device);
C
Corentin Chary 已提交
1236

L
Len Brown 已提交
1237
      fail_platform_device2:
C
Corentin Chary 已提交
1238 1239
	platform_device_put(asuspf_device);

L
Len Brown 已提交
1240 1241
      fail_platform_device1:
	platform_driver_unregister(&asuspf_driver);
C
Corentin Chary 已提交
1242

L
Len Brown 已提交
1243
      fail_platform_driver:
C
Corentin Chary 已提交
1244 1245
	asus_led_exit();

L
Len Brown 已提交
1246
      fail_led:
1247 1248
	asus_backlight_exit();

L
Len Brown 已提交
1249
      fail_backlight:
C
Corentin Chary 已提交
1250 1251 1252 1253 1254 1255

	return result;
}

module_init(asus_laptop_init);
module_exit(asus_laptop_exit);