eeepc-laptop.c 34.0 KB
Newer Older
E
Eric Cooper 已提交
1
/*
A
Alan Jenkins 已提交
2
 *  eeepc-laptop.c - Asus Eee PC extras
E
Eric Cooper 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
 *
 *  Based on asus_acpi.c as patched for the Eee PC by Asus:
 *  ftp://ftp.asus.com/pub/ASUS/EeePC/701/ASUS_ACPI_071126.rar
 *  Based on eee.c from eeepc-linux
 *
 *  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.
 */

19 20
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

E
Eric Cooper 已提交
21 22 23 24 25
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/platform_device.h>
C
Corentin Chary 已提交
26 27
#include <linux/backlight.h>
#include <linux/fb.h>
28 29
#include <linux/hwmon.h>
#include <linux/hwmon-sysfs.h>
E
Eric Cooper 已提交
30 31 32
#include <acpi/acpi_drivers.h>
#include <acpi/acpi_bus.h>
#include <linux/uaccess.h>
33 34
#include <linux/input.h>
#include <linux/rfkill.h>
35
#include <linux/pci.h>
36
#include <linux/pci_hotplug.h>
C
Corentin Chary 已提交
37
#include <linux/leds.h>
E
Eric Cooper 已提交
38 39

#define EEEPC_LAPTOP_VERSION	"0.1"
A
Alan Jenkins 已提交
40 41
#define EEEPC_LAPTOP_NAME	"Eee PC Hotkey Driver"
#define EEEPC_LAPTOP_FILE	"eeepc"
E
Eric Cooper 已提交
42

A
Alan Jenkins 已提交
43 44 45
#define EEEPC_ACPI_CLASS	"hotkey"
#define EEEPC_ACPI_DEVICE_NAME	"Hotkey"
#define EEEPC_ACPI_HID		"ASUS010"
E
Eric Cooper 已提交
46

A
Alan Jenkins 已提交
47
MODULE_AUTHOR("Corentin Chary, Eric Cooper");
A
Alan Jenkins 已提交
48
MODULE_DESCRIPTION(EEEPC_LAPTOP_NAME);
A
Alan Jenkins 已提交
49
MODULE_LICENSE("GPL");
E
Eric Cooper 已提交
50 51 52 53

/*
 * Definitions for Asus EeePC
 */
C
Corentin Chary 已提交
54 55
#define NOTIFY_BRN_MIN	0x20
#define NOTIFY_BRN_MAX	0x2f
E
Eric Cooper 已提交
56 57 58 59 60 61 62 63 64 65

enum {
	DISABLE_ASL_WLAN = 0x0001,
	DISABLE_ASL_BLUETOOTH = 0x0002,
	DISABLE_ASL_IRDA = 0x0004,
	DISABLE_ASL_CAMERA = 0x0008,
	DISABLE_ASL_TV = 0x0010,
	DISABLE_ASL_GPS = 0x0020,
	DISABLE_ASL_DISPLAYSWITCH = 0x0040,
	DISABLE_ASL_MODEM = 0x0080,
66 67 68 69
	DISABLE_ASL_CARDREADER = 0x0100,
	DISABLE_ASL_3G = 0x0200,
	DISABLE_ASL_WIMAX = 0x0400,
	DISABLE_ASL_HWCF = 0x0800
E
Eric Cooper 已提交
70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93
};

enum {
	CM_ASL_WLAN = 0,
	CM_ASL_BLUETOOTH,
	CM_ASL_IRDA,
	CM_ASL_1394,
	CM_ASL_CAMERA,
	CM_ASL_TV,
	CM_ASL_GPS,
	CM_ASL_DVDROM,
	CM_ASL_DISPLAYSWITCH,
	CM_ASL_PANELBRIGHT,
	CM_ASL_BIOSFLASH,
	CM_ASL_ACPIFLASH,
	CM_ASL_CPUFV,
	CM_ASL_CPUTEMPERATURE,
	CM_ASL_FANCPU,
	CM_ASL_FANCHASSIS,
	CM_ASL_USBPORT1,
	CM_ASL_USBPORT2,
	CM_ASL_USBPORT3,
	CM_ASL_MODEM,
	CM_ASL_CARDREADER,
94 95 96 97 98 99 100
	CM_ASL_3G,
	CM_ASL_WIMAX,
	CM_ASL_HWCF,
	CM_ASL_LID,
	CM_ASL_TYPE,
	CM_ASL_PANELPOWER,	/*P901*/
	CM_ASL_TPD
E
Eric Cooper 已提交
101 102
};

A
Adrian Bunk 已提交
103
static const char *cm_getv[] = {
104
	"WLDG", "BTHG", NULL, NULL,
E
Eric Cooper 已提交
105 106 107 108
	"CAMG", NULL, NULL, NULL,
	NULL, "PBLG", NULL, NULL,
	"CFVG", NULL, NULL, NULL,
	"USBG", NULL, NULL, "MODG",
109 110
	"CRDG", "M3GG", "WIMG", "HWCF",
	"LIDG",	"TYPE", "PBPG",	"TPDG"
E
Eric Cooper 已提交
111 112
};

A
Adrian Bunk 已提交
113
static const char *cm_setv[] = {
114
	"WLDS", "BTHS", NULL, NULL,
E
Eric Cooper 已提交
115 116 117 118
	"CAMS", NULL, NULL, NULL,
	"SDSP", "PBLS", "HDPS", NULL,
	"CFVS", NULL, NULL, NULL,
	"USBG", NULL, NULL, "MODS",
119 120
	"CRDS", "M3GS", "WIMS", NULL,
	NULL, NULL, "PBPS", "TPDS"
E
Eric Cooper 已提交
121 122
};

123 124 125 126 127 128 129 130
struct key_entry {
	char type;
	u8 code;
	u16 keycode;
};

enum { KE_KEY, KE_END };

131
static const struct key_entry eeepc_keymap[] = {
132 133
	/* Sleep already handled via generic ACPI code */
	{KE_KEY, 0x10, KEY_WLAN },
134
	{KE_KEY, 0x11, KEY_WLAN },
135 136 137 138
	{KE_KEY, 0x12, KEY_PROG1 },
	{KE_KEY, 0x13, KEY_MUTE },
	{KE_KEY, 0x14, KEY_VOLUMEDOWN },
	{KE_KEY, 0x15, KEY_VOLUMEUP },
139 140 141 142
	{KE_KEY, 0x1a, KEY_COFFEE },
	{KE_KEY, 0x1b, KEY_ZOOM },
	{KE_KEY, 0x1c, KEY_PROG2 },
	{KE_KEY, 0x1d, KEY_PROG3 },
A
Alan Jenkins 已提交
143 144
	{KE_KEY, NOTIFY_BRN_MIN, KEY_BRIGHTNESSDOWN },
	{KE_KEY, NOTIFY_BRN_MAX, KEY_BRIGHTNESSUP },
145 146 147 148 149 150
	{KE_KEY, 0x30, KEY_SWITCHVIDEOMODE },
	{KE_KEY, 0x31, KEY_SWITCHVIDEOMODE },
	{KE_KEY, 0x32, KEY_SWITCHVIDEOMODE },
	{KE_END, 0},
};

A
Alan Jenkins 已提交
151

E
Eric Cooper 已提交
152
/*
A
Alan Jenkins 已提交
153
 * This is the main structure, we can use it to store useful information
E
Eric Cooper 已提交
154
 */
A
Alan Jenkins 已提交
155
struct eeepc_laptop {
156
	acpi_handle handle;		/* the handle of the acpi device */
A
Alan Jenkins 已提交
157 158 159
	u32 cm_supported;		/* the control methods supported
					   by this BIOS */
	u16 event_count[128];		/* count for each event */
160 161 162 163 164

	struct platform_device *platform_device;
	struct device *hwmon_device;
	struct backlight_device *backlight_device;

A
Alan Jenkins 已提交
165
	struct input_dev *inputdev;
166 167
	struct key_entry *keymap;

A
Alan Jenkins 已提交
168 169 170 171
	struct rfkill *wlan_rfkill;
	struct rfkill *bluetooth_rfkill;
	struct rfkill *wwan3g_rfkill;
	struct rfkill *wimax_rfkill;
172

A
Alan Jenkins 已提交
173 174
	struct hotplug_slot *hotplug_slot;
	struct mutex hotplug_lock;
175

176 177 178 179 180
	struct led_classdev tpd_led;
	int tpd_led_wk;
	struct workqueue_struct *led_workqueue;
	struct work_struct tpd_led_work;
};
E
Eric Cooper 已提交
181 182 183 184

/*
 * ACPI Helpers
 */
185
static int write_acpi_int(acpi_handle handle, const char *method, int val)
E
Eric Cooper 已提交
186 187 188 189 190 191 192 193 194 195
{
	struct acpi_object_list params;
	union acpi_object in_obj;
	acpi_status status;

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

196
	status = acpi_evaluate_object(handle, (char *)method, &params, NULL);
E
Eric Cooper 已提交
197 198 199 200 201 202
	return (status == AE_OK ? 0 : -1);
}

static int read_acpi_int(acpi_handle handle, const char *method, int *val)
{
	acpi_status status;
203
	unsigned long long result;
E
Eric Cooper 已提交
204 205 206 207 208 209 210 211 212 213 214

	status = acpi_evaluate_integer(handle, (char *)method, NULL, &result);
	if (ACPI_FAILURE(status)) {
		*val = -1;
		return -1;
	} else {
		*val = result;
		return 0;
	}
}

215
static int set_acpi(struct eeepc_laptop *eeepc, int cm, int value)
E
Eric Cooper 已提交
216
{
217 218 219 220
	const char *method = cm_setv[cm];

	if (method == NULL)
		return -ENODEV;
A
Alan Jenkins 已提交
221
	if ((eeepc->cm_supported & (0x1 << cm)) == 0)
222 223
		return -ENODEV;

A
Alan Jenkins 已提交
224
	if (write_acpi_int(eeepc->handle, method, value))
225
		pr_warning("Error writing %s\n", method);
E
Eric Cooper 已提交
226 227 228
	return 0;
}

229
static int get_acpi(struct eeepc_laptop *eeepc, int cm)
E
Eric Cooper 已提交
230
{
231 232 233 234 235
	const char *method = cm_getv[cm];
	int value;

	if (method == NULL)
		return -ENODEV;
A
Alan Jenkins 已提交
236
	if ((eeepc->cm_supported & (0x1 << cm)) == 0)
237 238
		return -ENODEV;

A
Alan Jenkins 已提交
239
	if (read_acpi_int(eeepc->handle, method, &value))
240
		pr_warning("Error reading %s\n", method);
E
Eric Cooper 已提交
241 242 243
	return value;
}

244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263
static int acpi_setter_handle(struct eeepc_laptop *eeepc, int cm, acpi_handle *handle)
{
	const char *method = cm_setv[cm];
	acpi_status status;

	if (method == NULL)
		return -ENODEV;
	if ((eeepc->cm_supported & (0x1 << cm)) == 0)
		return -ENODEV;

	status = acpi_get_handle(eeepc->handle, (char *)method,
			         handle);
	if (status != AE_OK) {
		pr_warning("Error finding %s\n", method);
		return -ENODEV;
	}
	return 0;
}


E
Eric Cooper 已提交
264 265 266 267 268 269 270 271 272 273 274 275
/*
 * 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;
}

276 277
static ssize_t store_sys_acpi(struct device *dev, int cm,
			      const char *buf, size_t count)
E
Eric Cooper 已提交
278
{
279
	struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
E
Eric Cooper 已提交
280 281 282 283
	int rv, value;

	rv = parse_arg(buf, count, &value);
	if (rv > 0)
284
		value = set_acpi(eeepc, cm, value);
285
	if (value < 0)
286
		return -EIO;
E
Eric Cooper 已提交
287 288 289
	return rv;
}

290
static ssize_t show_sys_acpi(struct device *dev, int cm, char *buf)
E
Eric Cooper 已提交
291
{
292 293
	struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
	int value = get_acpi(eeepc, cm);
294 295

	if (value < 0)
296
		return -EIO;
297
	return sprintf(buf, "%d\n", value);
E
Eric Cooper 已提交
298 299
}

300
#define EEEPC_CREATE_DEVICE_ATTR(_name, _mode, _cm)			\
E
Eric Cooper 已提交
301 302 303 304
	static ssize_t show_##_name(struct device *dev,			\
				    struct device_attribute *attr,	\
				    char *buf)				\
	{								\
305
		return show_sys_acpi(dev, _cm, buf);			\
E
Eric Cooper 已提交
306 307 308 309 310
	}								\
	static ssize_t store_##_name(struct device *dev,		\
				     struct device_attribute *attr,	\
				     const char *buf, size_t count)	\
	{								\
311
		return store_sys_acpi(dev, _cm, buf, count);		\
E
Eric Cooper 已提交
312 313 314 315
	}								\
	static struct device_attribute dev_attr_##_name = {		\
		.attr = {						\
			.name = __stringify(_name),			\
316
			.mode = _mode },				\
E
Eric Cooper 已提交
317 318 319 320
		.show   = show_##_name,					\
		.store  = store_##_name,				\
	}

321 322 323
EEEPC_CREATE_DEVICE_ATTR(camera, 0644, CM_ASL_CAMERA);
EEEPC_CREATE_DEVICE_ATTR(cardr, 0644, CM_ASL_CARDREADER);
EEEPC_CREATE_DEVICE_ATTR(disp, 0200, CM_ASL_DISPLAYSWITCH);
C
Corentin Chary 已提交
324 325 326 327 328 329

struct eeepc_cpufv {
	int num;
	int cur;
};

330
static int get_cpufv(struct eeepc_laptop *eeepc, struct eeepc_cpufv *c)
C
Corentin Chary 已提交
331
{
332
	c->cur = get_acpi(eeepc, CM_ASL_CPUFV);
C
Corentin Chary 已提交
333 334 335 336 337 338 339 340 341 342 343
	c->num = (c->cur >> 8) & 0xff;
	c->cur &= 0xff;
	if (c->cur < 0 || c->num <= 0 || c->num > 12)
		return -ENODEV;
	return 0;
}

static ssize_t show_available_cpufv(struct device *dev,
				    struct device_attribute *attr,
				    char *buf)
{
344
	struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
C
Corentin Chary 已提交
345 346 347 348
	struct eeepc_cpufv c;
	int i;
	ssize_t len = 0;

349
	if (get_cpufv(eeepc, &c))
C
Corentin Chary 已提交
350 351 352 353 354 355 356 357 358 359 360
		return -ENODEV;
	for (i = 0; i < c.num; i++)
		len += sprintf(buf + len, "%d ", i);
	len += sprintf(buf + len, "\n");
	return len;
}

static ssize_t show_cpufv(struct device *dev,
			  struct device_attribute *attr,
			  char *buf)
{
361
	struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
C
Corentin Chary 已提交
362 363
	struct eeepc_cpufv c;

364
	if (get_cpufv(eeepc, &c))
C
Corentin Chary 已提交
365 366 367 368 369 370 371 372
		return -ENODEV;
	return sprintf(buf, "%#x\n", (c.num << 8) | c.cur);
}

static ssize_t store_cpufv(struct device *dev,
			   struct device_attribute *attr,
			   const char *buf, size_t count)
{
373
	struct eeepc_laptop *eeepc = dev_get_drvdata(dev);
C
Corentin Chary 已提交
374 375 376
	struct eeepc_cpufv c;
	int rv, value;

377
	if (get_cpufv(eeepc, &c))
C
Corentin Chary 已提交
378 379 380 381 382 383
		return -ENODEV;
	rv = parse_arg(buf, count, &value);
	if (rv < 0)
		return rv;
	if (!rv || value < 0 || value >= c.num)
		return -EINVAL;
384
	set_acpi(eeepc, CM_ASL_CPUFV, value);
C
Corentin Chary 已提交
385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401
	return rv;
}

static struct device_attribute dev_attr_cpufv = {
	.attr = {
		.name = "cpufv",
		.mode = 0644 },
	.show   = show_cpufv,
	.store  = store_cpufv
};

static struct device_attribute dev_attr_available_cpufv = {
	.attr = {
		.name = "available_cpufv",
		.mode = 0444 },
	.show   = show_available_cpufv
};
E
Eric Cooper 已提交
402 403 404 405 406

static struct attribute *platform_attributes[] = {
	&dev_attr_camera.attr,
	&dev_attr_cardr.attr,
	&dev_attr_disp.attr,
407
	&dev_attr_cpufv.attr,
C
Corentin Chary 已提交
408
	&dev_attr_available_cpufv.attr,
E
Eric Cooper 已提交
409 410 411 412 413 414 415
	NULL
};

static struct attribute_group platform_attribute_group = {
	.attrs = platform_attributes
};

416
static int eeepc_platform_init(struct eeepc_laptop *eeepc)
417 418 419
{
	int result;

420 421
	eeepc->platform_device = platform_device_alloc(EEEPC_LAPTOP_FILE, -1);
	if (!eeepc->platform_device)
422
		return -ENOMEM;
423
	platform_set_drvdata(eeepc->platform_device, eeepc);
424

425
	result = platform_device_add(eeepc->platform_device);
426 427 428
	if (result)
		goto fail_platform_device;

429
	result = sysfs_create_group(&eeepc->platform_device->dev.kobj,
430 431 432 433 434 435
				    &platform_attribute_group);
	if (result)
		goto fail_sysfs;
	return 0;

fail_sysfs:
436
	platform_device_del(eeepc->platform_device);
437
fail_platform_device:
438
	platform_device_put(eeepc->platform_device);
439 440 441
	return result;
}

442
static void eeepc_platform_exit(struct eeepc_laptop *eeepc)
443
{
444
	sysfs_remove_group(&eeepc->platform_device->dev.kobj,
445
			   &platform_attribute_group);
446
	platform_device_unregister(eeepc->platform_device);
447 448
}

C
Corentin Chary 已提交
449 450 451 452 453 454 455 456 457
/*
 * 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
 * subsystem asks, we avoid messing with the Asus ACPI stuff during a
 * potentially bad time, such as a timer interrupt.
 */
458 459 460
static void tpd_led_update(struct work_struct *work)
 {
	struct eeepc_laptop *eeepc;
C
Corentin Chary 已提交
461

462
	eeepc = container_of(work, struct eeepc_laptop, tpd_led_work);
C
Corentin Chary 已提交
463

464 465
	set_acpi(eeepc, CM_ASL_TPD, eeepc->tpd_led_wk);
}
C
Corentin Chary 已提交
466 467 468 469

static void tpd_led_set(struct led_classdev *led_cdev,
			enum led_brightness value)
{
470
	struct eeepc_laptop *eeepc;
C
Corentin Chary 已提交
471

472
	eeepc = container_of(led_cdev, struct eeepc_laptop, tpd_led);
C
Corentin Chary 已提交
473

474 475 476 477 478
	eeepc->tpd_led_wk = (value > 0) ? 1 : 0;
	queue_work(eeepc->led_workqueue, &eeepc->tpd_led_work);
}

static int eeepc_led_init(struct eeepc_laptop *eeepc)
479
{
A
Alan Jenkins 已提交
480
	int rv;
481

482
	if (get_acpi(eeepc, CM_ASL_TPD) == -ENODEV)
A
Alan Jenkins 已提交
483
		return 0;
484

485 486
	eeepc->led_workqueue = create_singlethread_workqueue("led_workqueue");
	if (!eeepc->led_workqueue)
A
Alan Jenkins 已提交
487
		return -ENOMEM;
488 489 490 491 492
	INIT_WORK(&eeepc->tpd_led_work, tpd_led_update);

	eeepc->tpd_led.name = "eeepc::touchpad";
	eeepc->tpd_led.brightness_set = tpd_led_set;
	eeepc->tpd_led.max_brightness = 1;
493

494 495
	rv = led_classdev_register(&eeepc->platform_device->dev,
				   &eeepc->tpd_led);
A
Alan Jenkins 已提交
496
	if (rv) {
497
		destroy_workqueue(eeepc->led_workqueue);
A
Alan Jenkins 已提交
498 499
		return rv;
	}
500

A
Alan Jenkins 已提交
501
	return 0;
502 503
}

504
static void eeepc_led_exit(struct eeepc_laptop *eeepc)
505
{
506 507 508 509
	if (eeepc->tpd_led.dev)
		led_classdev_unregister(&eeepc->tpd_led);
	if (eeepc->led_workqueue)
		destroy_workqueue(eeepc->led_workqueue);
A
Alan Jenkins 已提交
510
}
511 512


A
Alan Jenkins 已提交
513 514 515
/*
 * PCI hotplug (for wlan rfkill)
 */
516
static bool eeepc_wlan_rfkill_blocked(struct eeepc_laptop *eeepc)
A
Alan Jenkins 已提交
517
{
518
	if (get_acpi(eeepc, CM_ASL_WLAN) == 1)
A
Alan Jenkins 已提交
519 520
		return false;
	return true;
521 522
}

523
static void eeepc_rfkill_hotplug(struct eeepc_laptop *eeepc)
524
{
A
Alan Jenkins 已提交
525 526
	struct pci_dev *dev;
	struct pci_bus *bus;
527
	bool blocked = eeepc_wlan_rfkill_blocked(eeepc);
528

A
Alan Jenkins 已提交
529 530
	if (eeepc->wlan_rfkill)
		rfkill_set_sw_state(eeepc->wlan_rfkill, blocked);
531

A
Alan Jenkins 已提交
532
	mutex_lock(&eeepc->hotplug_lock);
A
Alan Jenkins 已提交
533

A
Alan Jenkins 已提交
534
	if (eeepc->hotplug_slot) {
A
Alan Jenkins 已提交
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
		bus = pci_find_bus(0, 1);
		if (!bus) {
			pr_warning("Unable to find PCI bus 1?\n");
			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);
				if (pci_bus_add_device(dev))
					pr_err("Unable to hotplug wifi\n");
			}
		} else {
			dev = pci_get_slot(bus, 0);
			if (dev) {
				pci_remove_bus_device(dev);
				pci_dev_put(dev);
			}
		}
561 562
	}

A
Alan Jenkins 已提交
563
out_unlock:
A
Alan Jenkins 已提交
564
	mutex_unlock(&eeepc->hotplug_lock);
565 566
}

A
Alan Jenkins 已提交
567
static void eeepc_rfkill_notify(acpi_handle handle, u32 event, void *data)
568
{
569 570
	struct eeepc_laptop *eeepc = data;

A
Alan Jenkins 已提交
571 572
	if (event != ACPI_NOTIFY_BUS_CHECK)
		return;
573

574
	eeepc_rfkill_hotplug(eeepc);
575 576
}

577 578
static int eeepc_register_rfkill_notifier(struct eeepc_laptop *eeepc,
					  char *node)
579
{
580
	acpi_status status;
581 582 583 584 585 586 587 588
	acpi_handle handle;

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

	if (ACPI_SUCCESS(status)) {
		status = acpi_install_notify_handler(handle,
						     ACPI_SYSTEM_NOTIFY,
						     eeepc_rfkill_notify,
589
						     eeepc);
590
		if (ACPI_FAILURE(status))
591
			pr_warning("Failed to register notify on %s\n", node);
592 593 594 595 596 597
	} else
		return -ENODEV;

	return 0;
}

598 599
static void eeepc_unregister_rfkill_notifier(struct eeepc_laptop *eeepc,
					     char *node)
600 601 602 603 604 605 606 607 608 609 610
{
	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,
						     ACPI_SYSTEM_NOTIFY,
						     eeepc_rfkill_notify);
		if (ACPI_FAILURE(status))
611
			pr_err("Error removing rfkill notify handler %s\n",
612 613 614 615
				node);
	}
}

A
Alan Jenkins 已提交
616 617 618
static int eeepc_get_adapter_status(struct hotplug_slot *hotplug_slot,
				    u8 *value)
{
619 620
	struct eeepc_laptop *eeepc = hotplug_slot->private;
	int val = get_acpi(eeepc, CM_ASL_WLAN);
A
Alan Jenkins 已提交
621 622 623 624 625 626 627 628 629

	if (val == 1 || val == 0)
		*value = val;
	else
		return -EINVAL;

	return 0;
}

630 631 632 633 634 635
static void eeepc_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot)
{
	kfree(hotplug_slot->info);
	kfree(hotplug_slot);
}

A
Alan Jenkins 已提交
636 637 638 639 640 641
static struct hotplug_slot_ops eeepc_hotplug_slot_ops = {
	.owner = THIS_MODULE,
	.get_adapter_status = eeepc_get_adapter_status,
	.get_power_status = eeepc_get_adapter_status,
};

642
static int eeepc_setup_pci_hotplug(struct eeepc_laptop *eeepc)
643 644 645 646 647
{
	int ret = -ENOMEM;
	struct pci_bus *bus = pci_find_bus(0, 1);

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

A
Alan Jenkins 已提交
652 653
	eeepc->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
	if (!eeepc->hotplug_slot)
654 655
		goto error_slot;

A
Alan Jenkins 已提交
656
	eeepc->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
657
					    GFP_KERNEL);
A
Alan Jenkins 已提交
658
	if (!eeepc->hotplug_slot->info)
659 660
		goto error_info;

A
Alan Jenkins 已提交
661 662 663 664 665
	eeepc->hotplug_slot->private = eeepc;
	eeepc->hotplug_slot->release = &eeepc_cleanup_pci_hotplug;
	eeepc->hotplug_slot->ops = &eeepc_hotplug_slot_ops;
	eeepc_get_adapter_status(eeepc->hotplug_slot,
				 &eeepc->hotplug_slot->info->adapter_status);
666

A
Alan Jenkins 已提交
667
	ret = pci_hp_register(eeepc->hotplug_slot, bus, 0, "eeepc-wifi");
668
	if (ret) {
669
		pr_err("Unable to register hotplug slot - %d\n", ret);
670 671 672 673 674 675
		goto error_register;
	}

	return 0;

error_register:
A
Alan Jenkins 已提交
676
	kfree(eeepc->hotplug_slot->info);
677
error_info:
A
Alan Jenkins 已提交
678 679
	kfree(eeepc->hotplug_slot);
	eeepc->hotplug_slot = NULL;
680 681 682 683
error_slot:
	return ret;
}

A
Alan Jenkins 已提交
684 685 686 687 688
/*
 * Rfkill devices
 */
static int eeepc_rfkill_set(void *data, bool blocked)
{
689 690 691
	acpi_handle handle = data;

	return write_acpi_int(handle, NULL, !blocked);
A
Alan Jenkins 已提交
692 693 694 695 696 697
}

static const struct rfkill_ops eeepc_rfkill_ops = {
	.set_block = eeepc_rfkill_set,
};

698 699 700
static int eeepc_new_rfkill(struct eeepc_laptop *eeepc,
			    struct rfkill **rfkill,
			    const char *name,
A
Alan Jenkins 已提交
701 702
			    enum rfkill_type type, int cm)
{
703
	acpi_handle handle;
A
Alan Jenkins 已提交
704 705
	int result;

706
	result = acpi_setter_handle(eeepc, cm, &handle);
A
Alan Jenkins 已提交
707 708 709
	if (result < 0)
		return result;

710 711
	*rfkill = rfkill_alloc(name, &eeepc->platform_device->dev, type,
			       &eeepc_rfkill_ops, handle);
A
Alan Jenkins 已提交
712 713 714 715

	if (!*rfkill)
		return -EINVAL;

716
	rfkill_init_sw_state(*rfkill, get_acpi(eeepc, cm) != 1);
A
Alan Jenkins 已提交
717 718 719 720 721 722 723 724 725
	result = rfkill_register(*rfkill);
	if (result) {
		rfkill_destroy(*rfkill);
		*rfkill = NULL;
		return result;
	}
	return 0;
}

726
static void eeepc_rfkill_exit(struct eeepc_laptop *eeepc)
A
Alan Jenkins 已提交
727
{
728 729 730
	eeepc_unregister_rfkill_notifier(eeepc, "\\_SB.PCI0.P0P5");
	eeepc_unregister_rfkill_notifier(eeepc, "\\_SB.PCI0.P0P6");
	eeepc_unregister_rfkill_notifier(eeepc, "\\_SB.PCI0.P0P7");
A
Alan Jenkins 已提交
731 732 733 734
	if (eeepc->wlan_rfkill) {
		rfkill_unregister(eeepc->wlan_rfkill);
		rfkill_destroy(eeepc->wlan_rfkill);
		eeepc->wlan_rfkill = NULL;
A
Alan Jenkins 已提交
735 736 737 738 739
	}
	/*
	 * Refresh pci hotplug in case the rfkill state was changed after
	 * eeepc_unregister_rfkill_notifier()
	 */
740
	eeepc_rfkill_hotplug(eeepc);
A
Alan Jenkins 已提交
741 742
	if (eeepc->hotplug_slot)
		pci_hp_deregister(eeepc->hotplug_slot);
A
Alan Jenkins 已提交
743

A
Alan Jenkins 已提交
744 745 746 747
	if (eeepc->bluetooth_rfkill) {
		rfkill_unregister(eeepc->bluetooth_rfkill);
		rfkill_destroy(eeepc->bluetooth_rfkill);
		eeepc->bluetooth_rfkill = NULL;
A
Alan Jenkins 已提交
748
	}
A
Alan Jenkins 已提交
749 750 751 752
	if (eeepc->wwan3g_rfkill) {
		rfkill_unregister(eeepc->wwan3g_rfkill);
		rfkill_destroy(eeepc->wwan3g_rfkill);
		eeepc->wwan3g_rfkill = NULL;
A
Alan Jenkins 已提交
753
	}
A
Alan Jenkins 已提交
754 755 756 757
	if (eeepc->wimax_rfkill) {
		rfkill_unregister(eeepc->wimax_rfkill);
		rfkill_destroy(eeepc->wimax_rfkill);
		eeepc->wimax_rfkill = NULL;
A
Alan Jenkins 已提交
758 759 760
	}
}

761
static int eeepc_rfkill_init(struct eeepc_laptop *eeepc)
A
Alan Jenkins 已提交
762 763 764
{
	int result = 0;

A
Alan Jenkins 已提交
765
	mutex_init(&eeepc->hotplug_lock);
A
Alan Jenkins 已提交
766

767 768 769
	result = eeepc_new_rfkill(eeepc, &eeepc->wlan_rfkill,
				  "eeepc-wlan", RFKILL_TYPE_WLAN,
				  CM_ASL_WLAN);
A
Alan Jenkins 已提交
770 771 772 773

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

774 775 776
	result = eeepc_new_rfkill(eeepc, &eeepc->bluetooth_rfkill,
				  "eeepc-bluetooth", RFKILL_TYPE_BLUETOOTH,
				  CM_ASL_BLUETOOTH);
A
Alan Jenkins 已提交
777 778 779 780

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

781 782 783
	result = eeepc_new_rfkill(eeepc, &eeepc->wwan3g_rfkill,
				  "eeepc-wwan3g", RFKILL_TYPE_WWAN,
				  CM_ASL_3G);
A
Alan Jenkins 已提交
784 785 786 787

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

788 789 790
	result = eeepc_new_rfkill(eeepc, &eeepc->wimax_rfkill,
				  "eeepc-wimax", RFKILL_TYPE_WIMAX,
				  CM_ASL_WIMAX);
A
Alan Jenkins 已提交
791 792 793 794

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

795
	result = eeepc_setup_pci_hotplug(eeepc);
A
Alan Jenkins 已提交
796 797 798 799 800 801 802
	/*
	 * If we get -EBUSY then something else is handling the PCI hotplug -
	 * don't fail in this case
	 */
	if (result == -EBUSY)
		result = 0;

803 804 805
	eeepc_register_rfkill_notifier(eeepc, "\\_SB.PCI0.P0P5");
	eeepc_register_rfkill_notifier(eeepc, "\\_SB.PCI0.P0P6");
	eeepc_register_rfkill_notifier(eeepc, "\\_SB.PCI0.P0P7");
A
Alan Jenkins 已提交
806 807 808 809
	/*
	 * Refresh pci hotplug in case the rfkill state was changed during
	 * setup.
	 */
810
	eeepc_rfkill_hotplug(eeepc);
A
Alan Jenkins 已提交
811 812 813

exit:
	if (result && result != -ENODEV)
814
		eeepc_rfkill_exit(eeepc);
A
Alan Jenkins 已提交
815 816 817 818 819 820
	return result;
}

/*
 * Platform driver - hibernate/resume callbacks
 */
821
static int eeepc_hotk_thaw(struct device *device)
822
{
823 824
	struct eeepc_laptop *eeepc = dev_get_drvdata(device);

A
Alan Jenkins 已提交
825
	if (eeepc->wlan_rfkill) {
826 827
		bool wlan;

828 829 830
		/*
		 * Work around bios bug - acpi _PTS turns off the wireless led
		 * during suspend.  Normally it restores it on resume, but
831
		 * we should kick it ourselves in case hibernation is aborted.
832
		 */
833 834
		wlan = get_acpi(eeepc, CM_ASL_WLAN);
		set_acpi(eeepc, CM_ASL_WLAN, wlan);
835 836 837 838
	}

	return 0;
}
839

840
static int eeepc_hotk_restore(struct device *device)
841
{
842 843
	struct eeepc_laptop *eeepc = dev_get_drvdata(device);

844
	/* Refresh both wlan rfkill state and pci hotplug */
A
Alan Jenkins 已提交
845
	if (eeepc->wlan_rfkill)
846
		eeepc_rfkill_hotplug(eeepc);
847

A
Alan Jenkins 已提交
848 849
	if (eeepc->bluetooth_rfkill)
		rfkill_set_sw_state(eeepc->bluetooth_rfkill,
850
				    get_acpi(eeepc, CM_ASL_BLUETOOTH) != 1);
A
Alan Jenkins 已提交
851 852
	if (eeepc->wwan3g_rfkill)
		rfkill_set_sw_state(eeepc->wwan3g_rfkill,
853
				    get_acpi(eeepc, CM_ASL_3G) != 1);
A
Alan Jenkins 已提交
854 855
	if (eeepc->wimax_rfkill)
		rfkill_set_sw_state(eeepc->wimax_rfkill,
856
				    get_acpi(eeepc, CM_ASL_WIMAX) != 1);
857 858 859 860

	return 0;
}

A
Alan Jenkins 已提交
861
static struct dev_pm_ops eeepc_pm_ops = {
862 863
	.thaw = eeepc_hotk_thaw,
	.restore = eeepc_hotk_restore,
A
Alan Jenkins 已提交
864 865 866 867
};

static struct platform_driver platform_driver = {
	.driver = {
A
Alan Jenkins 已提交
868
		.name = EEEPC_LAPTOP_FILE,
A
Alan Jenkins 已提交
869 870 871 872 873
		.owner = THIS_MODULE,
		.pm = &eeepc_pm_ops,
	}
};

874
/*
A
Alan Jenkins 已提交
875
 * Hwmon device
876
 */
A
Alan Jenkins 已提交
877 878 879 880 881 882 883 884 885

#define EEEPC_EC_SC00      0x61
#define EEEPC_EC_FAN_PWM   (EEEPC_EC_SC00 + 2) /* Fan PWM duty cycle (%) */
#define EEEPC_EC_FAN_HRPM  (EEEPC_EC_SC00 + 5) /* High byte, fan speed (RPM) */
#define EEEPC_EC_FAN_LRPM  (EEEPC_EC_SC00 + 6) /* Low byte, fan speed (RPM) */

#define EEEPC_EC_SFB0      0xD0
#define EEEPC_EC_FAN_CTRL  (EEEPC_EC_SFB0 + 3) /* Byte containing SF25  */

886 887
static int eeepc_get_fan_pwm(void)
{
888
	u8 value = 0;
889

890 891
	ec_read(EEEPC_EC_FAN_PWM, &value);
	return value * 255 / 100;
892 893 894 895
}

static void eeepc_set_fan_pwm(int value)
{
C
Corentin Chary 已提交
896 897
	value = SENSORS_LIMIT(value, 0, 255);
	value = value * 100 / 255;
898
	ec_write(EEEPC_EC_FAN_PWM, value);
899 900 901 902
}

static int eeepc_get_fan_rpm(void)
{
903 904
	u8 high = 0;
	u8 low = 0;
905

906 907 908
	ec_read(EEEPC_EC_FAN_HRPM, &high);
	ec_read(EEEPC_EC_FAN_LRPM, &low);
	return high << 8 | low;
909 910 911 912
}

static int eeepc_get_fan_ctrl(void)
{
913
	u8 value = 0;
914

915
	ec_read(EEEPC_EC_FAN_CTRL, &value);
916 917 918 919
	if (value & 0x02)
		return 1; /* manual */
	else
		return 2; /* automatic */
920 921 922 923
}

static void eeepc_set_fan_ctrl(int manual)
{
924
	u8 value = 0;
925

926
	ec_read(EEEPC_EC_FAN_CTRL, &value);
927
	if (manual == 1)
928 929 930
		value |= 0x02;
	else
		value &= ~0x02;
931
	ec_write(EEEPC_EC_FAN_CTRL, value);
932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964
}

static ssize_t store_sys_hwmon(void (*set)(int), const char *buf, size_t count)
{
	int rv, value;

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

static ssize_t show_sys_hwmon(int (*get)(void), char *buf)
{
	return sprintf(buf, "%d\n", get());
}

#define EEEPC_CREATE_SENSOR_ATTR(_name, _mode, _set, _get)		\
	static ssize_t show_##_name(struct device *dev,			\
				    struct device_attribute *attr,	\
				    char *buf)				\
	{								\
		return show_sys_hwmon(_set, buf);			\
	}								\
	static ssize_t store_##_name(struct device *dev,		\
				     struct device_attribute *attr,	\
				     const char *buf, size_t count)	\
	{								\
		return store_sys_hwmon(_get, buf, count);		\
	}								\
	static SENSOR_DEVICE_ATTR(_name, _mode, show_##_name, store_##_name, 0);

EEEPC_CREATE_SENSOR_ATTR(fan1_input, S_IRUGO, eeepc_get_fan_rpm, NULL);
C
Corentin Chary 已提交
965
EEEPC_CREATE_SENSOR_ATTR(pwm1, S_IRUGO | S_IWUSR,
966 967 968 969
			 eeepc_get_fan_pwm, eeepc_set_fan_pwm);
EEEPC_CREATE_SENSOR_ATTR(pwm1_enable, S_IRUGO | S_IWUSR,
			 eeepc_get_fan_ctrl, eeepc_set_fan_ctrl);

C
Corentin Chary 已提交
970 971 972 973 974 975 976
static ssize_t
show_name(struct device *dev, struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "eeepc\n");
}
static SENSOR_DEVICE_ATTR(name, S_IRUGO, show_name, NULL, 0);

977
static struct attribute *hwmon_attributes[] = {
C
Corentin Chary 已提交
978
	&sensor_dev_attr_pwm1.dev_attr.attr,
979 980
	&sensor_dev_attr_fan1_input.dev_attr.attr,
	&sensor_dev_attr_pwm1_enable.dev_attr.attr,
C
Corentin Chary 已提交
981
	&sensor_dev_attr_name.dev_attr.attr,
982 983 984 985 986 987 988
	NULL
};

static struct attribute_group hwmon_attribute_group = {
	.attrs = hwmon_attributes
};

989
static void eeepc_hwmon_exit(struct eeepc_laptop *eeepc)
990 991 992
{
	struct device *hwmon;

993
	hwmon = eeepc->hwmon_device;
994
	if (!hwmon)
995
		return;
996 997
	sysfs_remove_group(&hwmon->kobj,
			   &hwmon_attribute_group);
998
	hwmon_device_unregister(hwmon);
999
	eeepc->hwmon_device = NULL;
1000 1001
}

1002
static int eeepc_hwmon_init(struct eeepc_laptop *eeepc)
1003
{
A
Alan Jenkins 已提交
1004
	struct device *hwmon;
1005 1006
	int result;

1007
	hwmon = hwmon_device_register(&eeepc->platform_device->dev);
A
Alan Jenkins 已提交
1008 1009
	if (IS_ERR(hwmon)) {
		pr_err("Could not register eeepc hwmon device\n");
1010
		eeepc->hwmon_device = NULL;
A
Alan Jenkins 已提交
1011
		return PTR_ERR(hwmon);
1012
	}
1013
	eeepc->hwmon_device = hwmon;
A
Alan Jenkins 已提交
1014 1015 1016
	result = sysfs_create_group(&hwmon->kobj,
				    &hwmon_attribute_group);
	if (result)
1017
		eeepc_hwmon_exit(eeepc);
A
Alan Jenkins 已提交
1018
	return result;
1019 1020
}

A
Alan Jenkins 已提交
1021 1022 1023 1024
/*
 * Backlight device
 */
static int read_brightness(struct backlight_device *bd)
1025
{
1026 1027 1028
	struct eeepc_laptop *eeepc = bl_get_data(bd);

	return get_acpi(eeepc, CM_ASL_PANELBRIGHT);
A
Alan Jenkins 已提交
1029
}
1030

A
Alan Jenkins 已提交
1031 1032
static int set_brightness(struct backlight_device *bd, int value)
{
1033 1034 1035
	struct eeepc_laptop *eeepc = bl_get_data(bd);

	return set_acpi(eeepc, CM_ASL_PANELBRIGHT, value);
A
Alan Jenkins 已提交
1036
}
1037

A
Alan Jenkins 已提交
1038 1039 1040 1041
static int update_bl_status(struct backlight_device *bd)
{
	return set_brightness(bd, bd->props.brightness);
}
1042

A
Alan Jenkins 已提交
1043 1044 1045 1046
static struct backlight_ops eeepcbl_ops = {
	.get_brightness = read_brightness,
	.update_status = update_bl_status,
};
1047

1048
static int eeepc_backlight_notify(struct eeepc_laptop *eeepc)
A
Alan Jenkins 已提交
1049
{
1050
	struct backlight_device *bd = eeepc->backlight_device;
A
Alan Jenkins 已提交
1051
	int old = bd->props.brightness;
1052

A
Alan Jenkins 已提交
1053
	backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1054

A
Alan Jenkins 已提交
1055
	return old;
1056 1057
}

1058
static int eeepc_backlight_init(struct eeepc_laptop *eeepc)
C
Corentin Chary 已提交
1059 1060 1061
{
	struct backlight_device *bd;

1062 1063 1064
	bd = backlight_device_register(EEEPC_LAPTOP_FILE,
				       &eeepc->platform_device->dev,
				       eeepc, &eeepcbl_ops);
C
Corentin Chary 已提交
1065
	if (IS_ERR(bd)) {
1066
		pr_err("Could not register eeepc backlight device\n");
1067
		eeepc->backlight_device = NULL;
C
Corentin Chary 已提交
1068 1069
		return PTR_ERR(bd);
	}
1070
	eeepc->backlight_device = bd;
C
Corentin Chary 已提交
1071
	bd->props.max_brightness = 15;
1072
	bd->props.brightness = read_brightness(bd);
C
Corentin Chary 已提交
1073 1074 1075 1076 1077
	bd->props.power = FB_BLANK_UNBLANK;
	backlight_update_status(bd);
	return 0;
}

1078
static void eeepc_backlight_exit(struct eeepc_laptop *eeepc)
1079
{
1080 1081 1082
	if (eeepc->backlight_device)
		backlight_device_unregister(eeepc->backlight_device);
	eeepc->backlight_device = NULL;
A
Alan Jenkins 已提交
1083
}
1084

A
Alan Jenkins 已提交
1085 1086 1087 1088

/*
 * Input device (i.e. hotkeys)
 */
1089 1090 1091
static struct key_entry *eeepc_get_entry_by_scancode(
	struct eeepc_laptop *eeepc,
	int code)
A
Alan Jenkins 已提交
1092 1093 1094
{
	struct key_entry *key;

1095
	for (key = eeepc->keymap; key->type != KE_END; key++)
A
Alan Jenkins 已提交
1096 1097 1098 1099 1100 1101
		if (code == key->code)
			return key;

	return NULL;
}

1102
static void eeepc_input_notify(struct eeepc_laptop *eeepc, int event)
A
Alan Jenkins 已提交
1103 1104 1105
{
	static struct key_entry *key;

1106
	key = eeepc_get_entry_by_scancode(eeepc, event);
A
Alan Jenkins 已提交
1107 1108 1109
	if (key) {
		switch (key->type) {
		case KE_KEY:
A
Alan Jenkins 已提交
1110
			input_report_key(eeepc->inputdev, key->keycode,
A
Alan Jenkins 已提交
1111
						1);
A
Alan Jenkins 已提交
1112 1113
			input_sync(eeepc->inputdev);
			input_report_key(eeepc->inputdev, key->keycode,
A
Alan Jenkins 已提交
1114
						0);
A
Alan Jenkins 已提交
1115
			input_sync(eeepc->inputdev);
A
Alan Jenkins 已提交
1116 1117
			break;
		}
1118
	}
A
Alan Jenkins 已提交
1119 1120
}

1121 1122
static struct key_entry *eeepc_get_entry_by_keycode(
	struct eeepc_laptop *eeepc, int code)
A
Alan Jenkins 已提交
1123 1124 1125
{
	struct key_entry *key;

1126
	for (key = eeepc->keymap; key->type != KE_END; key++)
A
Alan Jenkins 已提交
1127 1128 1129 1130 1131 1132 1133 1134
		if (code == key->keycode && key->type == KE_KEY)
			return key;

	return NULL;
}

static int eeepc_getkeycode(struct input_dev *dev, int scancode, int *keycode)
{
1135 1136
	struct eeepc_laptop *eeepc = input_get_drvdata(dev);
	struct key_entry *key = eeepc_get_entry_by_scancode(eeepc, scancode);
A
Alan Jenkins 已提交
1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147

	if (key && key->type == KE_KEY) {
		*keycode = key->keycode;
		return 0;
	}

	return -EINVAL;
}

static int eeepc_setkeycode(struct input_dev *dev, int scancode, int keycode)
{
1148
	struct eeepc_laptop *eeepc = input_get_drvdata(dev);
A
Alan Jenkins 已提交
1149 1150 1151 1152 1153 1154
	struct key_entry *key;
	int old_keycode;

	if (keycode < 0 || keycode > KEY_MAX)
		return -EINVAL;

1155
	key = eeepc_get_entry_by_scancode(eeepc, scancode);
A
Alan Jenkins 已提交
1156 1157 1158 1159
	if (key && key->type == KE_KEY) {
		old_keycode = key->keycode;
		key->keycode = keycode;
		set_bit(keycode, dev->keybit);
1160
		if (!eeepc_get_entry_by_keycode(eeepc, old_keycode))
A
Alan Jenkins 已提交
1161 1162 1163 1164 1165
			clear_bit(old_keycode, dev->keybit);
		return 0;
	}

	return -EINVAL;
1166 1167
}

1168
static int eeepc_input_init(struct eeepc_laptop *eeepc)
1169 1170 1171 1172
{
	const struct key_entry *key;
	int result;

A
Alan Jenkins 已提交
1173 1174
	eeepc->inputdev = input_allocate_device();
	if (!eeepc->inputdev) {
1175 1176 1177
		pr_info("Unable to allocate input device\n");
		return -ENOMEM;
	}
A
Alan Jenkins 已提交
1178
	eeepc->inputdev->name = "Asus EeePC extra buttons";
1179
	eeepc->inputdev->dev.parent = &eeepc->platform_device->dev;
A
Alan Jenkins 已提交
1180 1181 1182 1183
	eeepc->inputdev->phys = EEEPC_LAPTOP_FILE "/input0";
	eeepc->inputdev->id.bustype = BUS_HOST;
	eeepc->inputdev->getkeycode = eeepc_getkeycode;
	eeepc->inputdev->setkeycode = eeepc_setkeycode;
1184
	input_set_drvdata(eeepc->inputdev, eeepc);
1185

1186 1187
	eeepc->keymap = kmemdup(eeepc_keymap, sizeof(eeepc_keymap),
				GFP_KERNEL);
1188 1189 1190
	for (key = eeepc_keymap; key->type != KE_END; key++) {
		switch (key->type) {
		case KE_KEY:
A
Alan Jenkins 已提交
1191 1192
			set_bit(EV_KEY, eeepc->inputdev->evbit);
			set_bit(key->keycode, eeepc->inputdev->keybit);
1193 1194 1195
			break;
		}
	}
A
Alan Jenkins 已提交
1196
	result = input_register_device(eeepc->inputdev);
1197 1198
	if (result) {
		pr_info("Unable to register input device\n");
A
Alan Jenkins 已提交
1199
		input_free_device(eeepc->inputdev);
1200 1201 1202 1203 1204
		return result;
	}
	return 0;
}

1205
static void eeepc_input_exit(struct eeepc_laptop *eeepc)
C
Corentin Chary 已提交
1206
{
1207
	if (eeepc->inputdev) {
A
Alan Jenkins 已提交
1208
		input_unregister_device(eeepc->inputdev);
1209 1210
		kfree(eeepc->keymap);
	}
A
Alan Jenkins 已提交
1211
}
C
Corentin Chary 已提交
1212

A
Alan Jenkins 已提交
1213 1214 1215
/*
 * ACPI driver
 */
A
Alan Jenkins 已提交
1216
static void eeepc_acpi_notify(struct acpi_device *device, u32 event)
A
Alan Jenkins 已提交
1217
{
1218
	struct eeepc_laptop *eeepc = acpi_driver_data(device);
A
Alan Jenkins 已提交
1219
	u16 count;
C
Corentin Chary 已提交
1220

A
Alan Jenkins 已提交
1221 1222
	if (event > ACPI_MAX_SYS_NOTIFY)
		return;
A
Alan Jenkins 已提交
1223
	count = eeepc->event_count[event % 128]++;
1224 1225 1226
	acpi_bus_generate_proc_event(device, event, count);
	acpi_bus_generate_netlink_event(device->pnp.device_class,
					dev_name(&device->dev), event,
A
Alan Jenkins 已提交
1227
					count);
C
Corentin Chary 已提交
1228

A
Alan Jenkins 已提交
1229 1230 1231 1232
	if (event >= NOTIFY_BRN_MIN && event <= NOTIFY_BRN_MAX) {
		int old_brightness, new_brightness;

		/* Update backlight device. */
1233
		old_brightness = eeepc_backlight_notify(eeepc);
A
Alan Jenkins 已提交
1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248

		/* Convert brightness event to keypress (obsolescent hack). */
		new_brightness = event - NOTIFY_BRN_MIN;

		if (new_brightness < old_brightness) {
			event = NOTIFY_BRN_MIN; /* brightness down */
		} else if (new_brightness > old_brightness) {
			event = NOTIFY_BRN_MAX; /* brightness up */
		} else {
			/*
			 * no change in brightness - already at min/max,
			 * event will be desired value (or else ignored).
			 */
		}
	}
1249
	eeepc_input_notify(eeepc, event);
A
Alan Jenkins 已提交
1250 1251
}

1252
static void cmsg_quirk(struct eeepc_laptop *eeepc, int cm, const char *name)
A
Alan Jenkins 已提交
1253 1254 1255 1256 1257
{
	int dummy;

	/* Some BIOSes do not report cm although it is avaliable.
	   Check if cm_getv[cm] works and, if yes, assume cm should be set. */
A
Alan Jenkins 已提交
1258 1259
	if (!(eeepc->cm_supported & (1 << cm))
	    && !read_acpi_int(eeepc->handle, cm_getv[cm], &dummy)) {
A
Alan Jenkins 已提交
1260 1261
		pr_info("%s (%x) not reported by BIOS,"
			" enabling anyway\n", name, 1 << cm);
A
Alan Jenkins 已提交
1262
		eeepc->cm_supported |= 1 << cm;
A
Alan Jenkins 已提交
1263 1264 1265
	}
}

1266
static void cmsg_quirks(struct eeepc_laptop *eeepc)
A
Alan Jenkins 已提交
1267
{
1268 1269 1270 1271
	cmsg_quirk(eeepc, CM_ASL_LID, "LID");
	cmsg_quirk(eeepc, CM_ASL_TYPE, "TYPE");
	cmsg_quirk(eeepc, CM_ASL_PANELPOWER, "PANELPOWER");
	cmsg_quirk(eeepc, CM_ASL_TPD, "TPD");
A
Alan Jenkins 已提交
1272 1273
}

1274
static int eeepc_acpi_init(struct eeepc_laptop *eeepc, struct acpi_device *device)
A
Alan Jenkins 已提交
1275 1276 1277 1278
{
	unsigned int init_flags;
	int result;

1279
	result = acpi_bus_get_status(device);
A
Alan Jenkins 已提交
1280 1281
	if (result)
		return result;
1282
	if (!device->status.present) {
A
Alan Jenkins 已提交
1283 1284 1285 1286 1287 1288 1289
		pr_err("Hotkey device not present, aborting\n");
		return -ENODEV;
	}

	init_flags = DISABLE_ASL_WLAN | DISABLE_ASL_DISPLAYSWITCH;
	pr_notice("Hotkey init flags 0x%x\n", init_flags);

A
Alan Jenkins 已提交
1290
	if (write_acpi_int(eeepc->handle, "INIT", init_flags)) {
A
Alan Jenkins 已提交
1291 1292 1293 1294 1295
		pr_err("Hotkey initialization failed\n");
		return -ENODEV;
	}

	/* get control methods supported */
A
Alan Jenkins 已提交
1296
	if (read_acpi_int(eeepc->handle, "CMSG", &eeepc->cm_supported)) {
A
Alan Jenkins 已提交
1297 1298
		pr_err("Get control methods supported failed\n");
		return -ENODEV;
1299
	}
1300
	cmsg_quirks(eeepc);
A
Alan Jenkins 已提交
1301
	pr_info("Get control methods supported: 0x%x\n", eeepc->cm_supported);
1302

C
Corentin Chary 已提交
1303 1304 1305
	return 0;
}

1306
static void __devinit eeepc_enable_camera(struct eeepc_laptop *eeepc)
A
Alan Jenkins 已提交
1307 1308 1309 1310 1311
{
	/*
	 * If the following call to set_acpi() fails, it's because there's no
	 * camera so we can ignore the error.
	 */
1312 1313
	if (get_acpi(eeepc, CM_ASL_CAMERA) == 0)
		set_acpi(eeepc, CM_ASL_CAMERA, 1);
A
Alan Jenkins 已提交
1314 1315
}

1316 1317
static bool eeepc_device_present;

A
Alan Jenkins 已提交
1318
static int __devinit eeepc_acpi_add(struct acpi_device *device)
E
Eric Cooper 已提交
1319
{
1320
	struct eeepc_laptop *eeepc;
E
Eric Cooper 已提交
1321 1322
	int result;

A
Alan Jenkins 已提交
1323 1324 1325
	pr_notice(EEEPC_LAPTOP_NAME "\n");
	eeepc = kzalloc(sizeof(struct eeepc_laptop), GFP_KERNEL);
	if (!eeepc)
1326
		return -ENOMEM;
A
Alan Jenkins 已提交
1327 1328 1329 1330
	eeepc->handle = device->handle;
	strcpy(acpi_device_name(device), EEEPC_ACPI_DEVICE_NAME);
	strcpy(acpi_device_class(device), EEEPC_ACPI_CLASS);
	device->driver_data = eeepc;
1331

1332
	result = eeepc_acpi_init(eeepc, device);
1333
	if (result)
1334
		goto fail_platform;
1335
	eeepc_enable_camera(eeepc);
1336

1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349
	/*
	 * Register the platform device first.  It is used as a parent for the
	 * sub-devices below.
	 *
	 * Note that if there are multiple instances of this ACPI device it
	 * will bail out, because the platform device is registered with a
	 * fixed name.  Of course it doesn't make sense to have more than one,
	 * and machine-specific scripts find the fixed name convenient.  But
	 * It's also good for us to exclude multiple instances because both
	 * our hwmon and our wlan rfkill subdevice use global ACPI objects
	 * (the EC and the wlan PCI slot respectively).
	 */
	result = eeepc_platform_init(eeepc);
E
Eric Cooper 已提交
1350
	if (result)
1351
		goto fail_platform;
1352 1353

	if (!acpi_video_backlight_support()) {
1354
		result = eeepc_backlight_init(eeepc);
1355 1356 1357
		if (result)
			goto fail_backlight;
	} else
1358
		pr_info("Backlight controlled by ACPI video driver\n");
1359

1360
	result = eeepc_input_init(eeepc);
1361 1362 1363
	if (result)
		goto fail_input;

1364
	result = eeepc_hwmon_init(eeepc);
1365 1366 1367
	if (result)
		goto fail_hwmon;

1368
	result = eeepc_led_init(eeepc);
C
Corentin Chary 已提交
1369 1370 1371
	if (result)
		goto fail_led;

1372
	result = eeepc_rfkill_init(eeepc);
1373 1374 1375
	if (result)
		goto fail_rfkill;

1376
	eeepc_device_present = true;
E
Eric Cooper 已提交
1377
	return 0;
1378

1379
fail_rfkill:
1380
	eeepc_led_exit(eeepc);
C
Corentin Chary 已提交
1381
fail_led:
1382
	eeepc_hwmon_exit(eeepc);
1383
fail_hwmon:
1384
	eeepc_input_exit(eeepc);
1385
fail_input:
1386
	eeepc_backlight_exit(eeepc);
1387
fail_backlight:
1388
	eeepc_platform_exit(eeepc);
1389
fail_platform:
A
Alan Jenkins 已提交
1390
	kfree(eeepc);
1391

E
Eric Cooper 已提交
1392 1393 1394
	return result;
}

A
Alan Jenkins 已提交
1395
static int eeepc_acpi_remove(struct acpi_device *device, int type)
1396
{
1397 1398 1399 1400 1401 1402 1403 1404
	struct eeepc_laptop *eeepc = acpi_driver_data(device);

	eeepc_backlight_exit(eeepc);
	eeepc_rfkill_exit(eeepc);
	eeepc_input_exit(eeepc);
	eeepc_hwmon_exit(eeepc);
	eeepc_led_exit(eeepc);
	eeepc_platform_exit(eeepc);
1405

A
Alan Jenkins 已提交
1406
	kfree(eeepc);
1407 1408 1409
	return 0;
}

A
Alan Jenkins 已提交
1410 1411

static const struct acpi_device_id eeepc_device_ids[] = {
A
Alan Jenkins 已提交
1412
	{EEEPC_ACPI_HID, 0},
A
Alan Jenkins 已提交
1413 1414 1415 1416
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, eeepc_device_ids);

A
Alan Jenkins 已提交
1417 1418 1419
static struct acpi_driver eeepc_acpi_driver = {
	.name = EEEPC_LAPTOP_NAME,
	.class = EEEPC_ACPI_CLASS,
A
Alan Jenkins 已提交
1420 1421 1422 1423
	.owner = THIS_MODULE,
	.ids = eeepc_device_ids,
	.flags = ACPI_DRIVER_ALL_NOTIFY_EVENTS,
	.ops = {
A
Alan Jenkins 已提交
1424 1425 1426
		.add = eeepc_acpi_add,
		.remove = eeepc_acpi_remove,
		.notify = eeepc_acpi_notify,
A
Alan Jenkins 已提交
1427 1428 1429 1430
	},
};


1431 1432 1433 1434
static int __init eeepc_laptop_init(void)
{
	int result;

1435
	result = platform_driver_register(&platform_driver);
1436 1437
	if (result < 0)
		return result;
1438

A
Alan Jenkins 已提交
1439
	result = acpi_bus_register_driver(&eeepc_acpi_driver);
1440 1441
	if (result < 0)
		goto fail_acpi_driver;
1442
	if (!eeepc_device_present) {
1443 1444
		result = -ENODEV;
		goto fail_no_device;
1445 1446
	}
	return 0;
1447 1448

fail_no_device:
A
Alan Jenkins 已提交
1449
	acpi_bus_unregister_driver(&eeepc_acpi_driver);
1450 1451 1452
fail_acpi_driver:
	platform_driver_unregister(&platform_driver);
	return result;
1453 1454 1455 1456
}

static void __exit eeepc_laptop_exit(void)
{
A
Alan Jenkins 已提交
1457
	acpi_bus_unregister_driver(&eeepc_acpi_driver);
1458
	platform_driver_unregister(&platform_driver);
1459 1460
}

E
Eric Cooper 已提交
1461 1462
module_init(eeepc_laptop_init);
module_exit(eeepc_laptop_exit);