asus-laptop.c 32.0 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 59

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

60 61 62 63 64 65 66 67
/*
 * 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

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

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

C
Corentin Chary 已提交
88 89 90 91 92 93 94 95 96 97 98
#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 已提交
99 100 101 102 103 104 105 106 107 108 109 110 111
/* 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 已提交
112 113 114 115
#define ASUS_HANDLE(object, paths...)					\
	static acpi_handle  object##_handle = NULL;			\
	static char *object##_paths[] = { paths }

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

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

126 127 128 129 130 131
/* 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 已提交
132
ASUS_HANDLE(wireless_status, ASUS_HOTK_PREFIX "RSTS");	/* All new models */
133

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

/* Backlight */
L
Len Brown 已提交
139 140 141 142 143 144 145
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 */
146

147 148
/* Display */
ASUS_HANDLE(display_set, ASUS_HOTK_PREFIX "SDSP");
L
Len Brown 已提交
149 150 151
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
152
					   S5A M5A z33A W1Jc W2V G1 */
L
Len Brown 已提交
153 154 155 156 157 158 159 160 161 162 163 164
	    "\\_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 */
165

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

C
Corentin Chary 已提交
172 173 174 175 176
/*
 * This is the main structure, we can use it to store anything interesting
 * about the hotk device
 */
struct asus_hotk {
L
Len Brown 已提交
177
	char *name;		//laptop name
C
Corentin Chary 已提交
178 179 180
	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 已提交
181
	u32 ledd_status;	//status of the LED display
L
Len Brown 已提交
182 183
	u8 light_level;		//light sensor level
	u8 light_switch;	//light sensor switch value
C
Corentin Chary 已提交
184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211
	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
 */
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,
	.ids = ASUS_HOTK_HID,
	.ops = {
		.add = asus_hotk_add,
		.remove = asus_hotk_remove,
		},
};

212 213 214 215 216 217 218 219
/* 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);
220
static struct backlight_ops asusbl_ops = {
L
Len Brown 已提交
221 222
	.get_brightness = read_brightness,
	.update_status = update_bl_status,
223 224
};

C
Corentin Chary 已提交
225 226 227 228 229 230 231 232 233 234 235
/* 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 已提交
236
	static DECLARE_WORK(object##_led_work, object##_led_update);	\
C
Corentin Chary 已提交
237 238 239 240 241 242 243 244 245
	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 已提交
246
ASUS_LED(gled, "gaming");
C
Corentin Chary 已提交
247

C
Corentin Chary 已提交
248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270
/*
 * 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 已提交
271 272
static int read_wireless_status(int mask)
{
273 274
	ulong status;
	acpi_status rv = AE_OK;
275 276 277 278

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

279 280
	rv = acpi_evaluate_integer(wireless_status_handle, NULL, NULL, &status);
	if (ACPI_FAILURE(rv))
281
		printk(ASUS_WARNING "Error reading Wireless status\n");
282 283
	else
		return (status & mask) ? 1 : 0;
284 285 286 287

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

288 289 290
static int read_gps_status(void)
{
	ulong status;
C
Corentin Chary 已提交
291 292 293 294
	acpi_status rv = AE_OK;

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

299
	return (hotk->status & GPS_ON) ? 1 : 0;
C
Corentin Chary 已提交
300 301
}

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

C
Corentin Chary 已提交
311 312 313
	return (hotk->status & mask) ? 1 : 0;
}

C
Corentin Chary 已提交
314
static void write_status(acpi_handle handle, int out, int mask)
C
Corentin Chary 已提交
315 316 317
{
	hotk->status = (out) ? (hotk->status | mask) : (hotk->status & ~mask);

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

	if (handle && !write_acpi_int(handle, NULL, out, NULL))
C
Corentin Chary 已提交
335
		printk(ASUS_WARNING " write failed %x\n", mask);
C
Corentin Chary 已提交
336 337 338
}

/* /sys/class/led handlers */
C
Corentin Chary 已提交
339
#define ASUS_LED_HANDLER(object, mask)					\
C
Corentin Chary 已提交
340 341 342 343 344 345 346 347 348
	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 已提交
349
		write_status(object##_set_handle, value, (mask));	\
C
Corentin Chary 已提交
350 351
	}

C
Corentin Chary 已提交
352 353 354 355
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 已提交
356
ASUS_LED_HANDLER(gled, GLED_ON);
C
Corentin Chary 已提交
357

358 359 360 361 362 363 364 365 366 367 368 369 370 371 372
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 已提交
373
	if (lcd_switch_handle) {
374 375 376 377 378 379 380
		status = acpi_evaluate_object(lcd_switch_handle,
					      NULL, NULL, NULL);

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

C
Corentin Chary 已提交
381
	write_status(NULL, lcd, LCD_ON);
382 383 384 385 386 387 388
	return 0;
}

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

L
Len Brown 已提交
389
	if (bd) {
390
		bd->props.power = blank;
391
		backlight_update_status(bd);
392 393 394 395 396
	}
}

static int read_brightness(struct backlight_device *bd)
{
397 398
	ulong value;
	acpi_status rv = AE_OK;
399

400 401
	rv = acpi_evaluate_integer(brightness_get_handle, NULL, NULL, &value);
	if (ACPI_FAILURE(rv))
402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424
		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;
425
	int value = bd->props.brightness;
426 427

	rv = set_brightness(bd, value);
L
Len Brown 已提交
428
	if (rv)
429 430
		return rv;

431
	value = (bd->props.power == FB_BLANK_UNBLANK) ? 1 : 0;
432 433 434
	return set_lcd_state(value);
}

C
Corentin Chary 已提交
435 436 437 438 439 440 441 442 443 444
/*
 * 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 已提交
445
			  struct device_attribute *attr, char *page)
C
Corentin Chary 已提交
446 447
{
	int len = 0;
448
	ulong temp;
C
Corentin Chary 已提交
449
	char buf[16];		//enough for all info
450 451
	acpi_status rv = AE_OK;

C
Corentin Chary 已提交
452 453 454 455 456 457 458 459 460 461 462 463 464
	/*
	 * 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.
	 */
465 466 467 468
	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 已提交
469 470 471 472 473 474 475
	/*
	 * 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.
	 */
476 477 478 479
	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 已提交
480 481 482 483 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
	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;
}

513
static ssize_t store_status(const char *buf, size_t count,
C
Corentin Chary 已提交
514
			    acpi_handle handle, int mask)
515 516 517 518 519 520 521 522
{
	int rv, value;
	int out = 0;

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

C
Corentin Chary 已提交
523
	write_status(handle, out, mask);
524 525 526 527

	return rv;
}

C
Corentin Chary 已提交
528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551
/*
 * 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;
}

552 553 554 555 556 557 558 559 560 561 562 563
/*
 * 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 已提交
564
	return store_status(buf, count, wl_switch_handle, WL_ON);
565 566 567 568 569 570 571 572 573 574 575
}

/*
 * 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 已提交
576 577 578
static ssize_t store_bluetooth(struct device *dev,
			       struct device_attribute *attr, const char *buf,
			       size_t count)
579
{
C
Corentin Chary 已提交
580
	return store_status(buf, count, bt_switch_handle, BT_ON);
581 582
}

583 584 585 586 587 588 589 590 591 592 593 594 595
/*
 * 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)
{
596 597
	ulong value = 0;
	acpi_status rv = AE_OK;
598 599 600

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

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

	return value;
}
L
Len Brown 已提交
612

613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640
/*
 * 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;
}

641 642 643 644 645 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
/*
 * 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 已提交
697 698 699 700 701 702 703 704 705 706 707 708
/*
 * 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)
{
709
	return store_status(buf, count, NULL, GPS_ON);
C
Corentin Chary 已提交
710 711
}

C
Corentin Chary 已提交
712 713 714 715 716 717
static void asus_hotk_notify(acpi_handle handle, u32 event, void *data)
{
	/* TODO Find a better way to handle events count. */
	if (!hotk)
		return;

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

C
Corentin Chary 已提交
730 731 732 733 734 735 736 737 738 739
	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),			\
740
			.mode = 0 },					\
C
Corentin Chary 已提交
741 742 743 744 745 746 747 748 749 750 751 752
		.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);
753 754
static ASUS_CREATE_DEVICE_ATTR(wlan);
static ASUS_CREATE_DEVICE_ATTR(bluetooth);
755
static ASUS_CREATE_DEVICE_ATTR(display);
C
Corentin Chary 已提交
756
static ASUS_CREATE_DEVICE_ATTR(ledd);
757 758
static ASUS_CREATE_DEVICE_ATTR(ls_switch);
static ASUS_CREATE_DEVICE_ATTR(ls_level);
C
Corentin Chary 已提交
759
static ASUS_CREATE_DEVICE_ATTR(gps);
C
Corentin Chary 已提交
760 761

static struct attribute *asuspf_attributes[] = {
L
Len Brown 已提交
762 763 764 765 766 767 768
	&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 已提交
769
	&dev_attr_gps.attr,
L
Len Brown 已提交
770
	NULL
C
Corentin Chary 已提交
771 772 773
};

static struct attribute_group asuspf_attribute_group = {
L
Len Brown 已提交
774
	.attrs = asuspf_attributes
C
Corentin Chary 已提交
775 776 777
};

static struct platform_driver asuspf_driver = {
L
Len Brown 已提交
778 779 780 781
	.driver = {
		   .name = ASUS_HOTK_FILE,
		   .owner = THIS_MODULE,
		   }
C
Corentin Chary 已提交
782 783 784 785 786 787 788
};

static struct platform_device *asuspf_device;

static void asus_hotk_add_fs(void)
{
	ASUS_SET_DEVICE_ATTR(infos, 0444, show_infos, NULL);
789 790 791 792 793 794 795

	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);
796 797 798

	if (display_set_handle && display_get_handle)
		ASUS_SET_DEVICE_ATTR(display, 0644, show_disp, store_disp);
L
Len Brown 已提交
799
	else if (display_set_handle)
800 801
		ASUS_SET_DEVICE_ATTR(display, 0200, NULL, store_disp);

C
Corentin Chary 已提交
802 803 804
	if (ledd_set_handle)
		ASUS_SET_DEVICE_ATTR(ledd, 0644, show_ledd, store_ledd);

805 806 807 808
	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 已提交
809

810
	if (gps_status_handle && gps_on_handle && gps_off_handle)
C
Corentin Chary 已提交
811
		ASUS_SET_DEVICE_ATTR(gps, 0644, show_gps, store_gps);
C
Corentin Chary 已提交
812 813
}

L
Len Brown 已提交
814
static int asus_handle_init(char *name, acpi_handle * handle,
C
Corentin Chary 已提交
815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841
			    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;
842
	ulong bsts_result, hwrs_result;
C
Corentin Chary 已提交
843 844 845 846 847 848 849 850 851 852 853
	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.
	 */
854
	status = acpi_get_table(ACPI_SIG_DSDT, 1, &asus_info);
C
Corentin Chary 已提交
855 856 857 858 859 860 861 862 863 864
	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 */
865 866 867
	status =
	    acpi_evaluate_integer(hotk->handle, "BSTS", NULL, &bsts_result);
	if (ACPI_FAILURE(status))
C
Corentin Chary 已提交
868 869 870
		printk(ASUS_WARNING "Error calling BSTS\n");
	else if (bsts_result)
		printk(ASUS_NOTICE "BSTS called, 0x%02x returned\n",
871
		       (uint) bsts_result);
C
Corentin Chary 已提交
872

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

C
Corentin Chary 已提交
876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899
	/*
	 * 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 已提交
900
	if (*string)
C
Corentin Chary 已提交
901 902
		printk(ASUS_NOTICE "  %s model detected\n", string);

C
Corentin Chary 已提交
903 904 905 906
	ASUS_HANDLE_INIT(mled_set);
	ASUS_HANDLE_INIT(tled_set);
	ASUS_HANDLE_INIT(rled_set);
	ASUS_HANDLE_INIT(pled_set);
C
Corentin Chary 已提交
907
	ASUS_HANDLE_INIT(gled_set);
C
Corentin Chary 已提交
908

C
Corentin Chary 已提交
909 910
	ASUS_HANDLE_INIT(ledd_set);

911 912 913 914 915 916
	/*
	 * 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.
	 */
917 918 919
	status =
	    acpi_evaluate_integer(hotk->handle, "HRWS", NULL, &hwrs_result);
	if (ACPI_FAILURE(status))
920 921
		hwrs_result = WL_HWRS | BT_HWRS;

L
Len Brown 已提交
922
	if (hwrs_result & WL_HWRS)
923
		ASUS_HANDLE_INIT(wl_switch);
L
Len Brown 已提交
924
	if (hwrs_result & BT_HWRS)
925 926 927 928
		ASUS_HANDLE_INIT(bt_switch);

	ASUS_HANDLE_INIT(wireless_status);

929 930 931 932 933
	ASUS_HANDLE_INIT(brightness_set);
	ASUS_HANDLE_INIT(brightness_get);

	ASUS_HANDLE_INIT(lcd_switch);

934 935 936
	ASUS_HANDLE_INIT(display_set);
	ASUS_HANDLE_INIT(display_get);

937 938
	/* There is a lot of models with "ALSL", but a few get
	   a real light sens, so we need to check it. */
939
	if (!ASUS_HANDLE_INIT(ls_switch))
940 941
		ASUS_HANDLE_INIT(ls_level);

C
Corentin Chary 已提交
942 943 944 945
	ASUS_HANDLE_INIT(gps_on);
	ASUS_HANDLE_INIT(gps_off);
	ASUS_HANDLE_INIT(gps_status);

C
Corentin Chary 已提交
946 947 948 949 950 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
	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);

982
	hotk = kzalloc(sizeof(struct asus_hotk), GFP_KERNEL);
C
Corentin Chary 已提交
983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001
	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 已提交
1002
	status = acpi_install_notify_handler(hotk->handle, ACPI_ALL_NOTIFY,
C
Corentin Chary 已提交
1003 1004 1005 1006 1007 1008
					     asus_hotk_notify, hotk);
	if (ACPI_FAILURE(status))
		printk(ASUS_ERR "Error installing notify handler\n");

	asus_hotk_found = 1;

1009
	/* WLED and BLED are on by default */
C
Corentin Chary 已提交
1010 1011 1012 1013 1014 1015
	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);
1016

1017
	/* LCD Backlight is on by default */
C
Corentin Chary 已提交
1018
	write_status(NULL, 1, LCD_ON);
1019

C
Corentin Chary 已提交
1020 1021 1022
	/* LED display is off by default */
	hotk->ledd_status = 0xFFF;

L
Len Brown 已提交
1023 1024 1025
	/* 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 */
1026

L
Len Brown 已提交
1027 1028
	if (ls_switch_handle)
		set_light_sens_switch(hotk->light_switch);
1029

L
Len Brown 已提交
1030 1031
	if (ls_level_handle)
		set_light_sens_level(hotk->light_level);
1032

C
Corentin Chary 已提交
1033 1034 1035
	/* GPS is on by default */
	write_status(NULL, 1, GPS_ON);

C
Corentin Chary 已提交
1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051
      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 已提交
1052
	status = acpi_remove_notify_handler(hotk->handle, ACPI_ALL_NOTIFY,
C
Corentin Chary 已提交
1053 1054 1055 1056 1057 1058 1059 1060 1061 1062
					    asus_hotk_notify);
	if (ACPI_FAILURE(status))
		printk(ASUS_ERR "Error removing notify handler\n");

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

	return 0;
}

1063 1064
static void asus_backlight_exit(void)
{
L
Len Brown 已提交
1065
	if (asus_backlight_device)
1066 1067 1068
		backlight_device_unregister(asus_backlight_device);
}

C
Corentin Chary 已提交
1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079
#define  ASUS_LED_UNREGISTER(object)				\
	if(object##_led.class_dev				\
	   && !IS_ERR(object##_led.class_dev))			\
		led_classdev_unregister(&object##_led)

static void asus_led_exit(void)
{
	ASUS_LED_UNREGISTER(mled);
	ASUS_LED_UNREGISTER(tled);
	ASUS_LED_UNREGISTER(pled);
	ASUS_LED_UNREGISTER(rled);
C
Corentin Chary 已提交
1080
	ASUS_LED_UNREGISTER(gled);
C
Corentin Chary 已提交
1081 1082 1083 1084

	destroy_workqueue(led_workqueue);
}

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

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

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

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

		asus_backlight_device = bd;

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

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

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

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

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

	rv = ASUS_LED_REGISTER(mled, dev);
L
Len Brown 已提交
1137
	if (rv)
C
Corentin Chary 已提交
1138 1139 1140
		return rv;

	rv = ASUS_LED_REGISTER(tled, dev);
L
Len Brown 已提交
1141
	if (rv)
C
Corentin Chary 已提交
1142 1143 1144
		return rv;

	rv = ASUS_LED_REGISTER(rled, dev);
L
Len Brown 已提交
1145
	if (rv)
C
Corentin Chary 已提交
1146 1147 1148
		return rv;

	rv = ASUS_LED_REGISTER(pled, dev);
L
Len Brown 已提交
1149
	if (rv)
C
Corentin Chary 已提交
1150 1151
		return rv;

C
Corentin Chary 已提交
1152 1153 1154 1155
	rv = ASUS_LED_REGISTER(gled, dev);
	if (rv)
		return rv;

C
Corentin Chary 已提交
1156
	led_workqueue = create_singlethread_workqueue("led_workqueue");
L
Len Brown 已提交
1157
	if (!led_workqueue)
C
Corentin Chary 已提交
1158 1159 1160 1161 1162
		return -ENOMEM;

	return 0;
}

C
Corentin Chary 已提交
1163 1164
static int __init asus_laptop_init(void)
{
C
Corentin Chary 已提交
1165
	struct device *dev;
C
Corentin Chary 已提交
1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186
	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 已提交
1187 1188
	dev = acpi_get_physical_device(hotk->device->handle);

1189
	result = asus_backlight_init(dev);
L
Len Brown 已提交
1190
	if (result)
1191 1192
		goto fail_backlight;

C
Corentin Chary 已提交
1193
	result = asus_led_init(dev);
L
Len Brown 已提交
1194
	if (result)
C
Corentin Chary 已提交
1195 1196
		goto fail_led;

L
Len Brown 已提交
1197
	/* Register platform stuff */
C
Corentin Chary 已提交
1198
	result = platform_driver_register(&asuspf_driver);
L
Len Brown 已提交
1199 1200
	if (result)
		goto fail_platform_driver;
C
Corentin Chary 已提交
1201

L
Len Brown 已提交
1202 1203 1204 1205 1206
	asuspf_device = platform_device_alloc(ASUS_HOTK_FILE, -1);
	if (!asuspf_device) {
		result = -ENOMEM;
		goto fail_platform_device1;
	}
C
Corentin Chary 已提交
1207

L
Len Brown 已提交
1208 1209 1210
	result = platform_device_add(asuspf_device);
	if (result)
		goto fail_platform_device2;
C
Corentin Chary 已提交
1211

L
Len Brown 已提交
1212
	result = sysfs_create_group(&asuspf_device->dev.kobj,
C
Corentin Chary 已提交
1213
				    &asuspf_attribute_group);
L
Len Brown 已提交
1214 1215
	if (result)
		goto fail_sysfs;
C
Corentin Chary 已提交
1216

L
Len Brown 已提交
1217
	return 0;
C
Corentin Chary 已提交
1218

L
Len Brown 已提交
1219 1220
      fail_sysfs:
	platform_device_del(asuspf_device);
C
Corentin Chary 已提交
1221

L
Len Brown 已提交
1222
      fail_platform_device2:
C
Corentin Chary 已提交
1223 1224
	platform_device_put(asuspf_device);

L
Len Brown 已提交
1225 1226
      fail_platform_device1:
	platform_driver_unregister(&asuspf_driver);
C
Corentin Chary 已提交
1227

L
Len Brown 已提交
1228
      fail_platform_driver:
C
Corentin Chary 已提交
1229 1230
	asus_led_exit();

L
Len Brown 已提交
1231
      fail_led:
1232 1233
	asus_backlight_exit();

L
Len Brown 已提交
1234
      fail_backlight:
C
Corentin Chary 已提交
1235 1236 1237 1238 1239 1240

	return result;
}

module_init(asus_laptop_init);
module_exit(asus_laptop_exit);