ideapad-laptop.c 20.2 KB
Newer Older
D
David Woodhouse 已提交
1
/*
2
 *  ideapad-laptop.c - Lenovo IdeaPad ACPI Extras
D
David Woodhouse 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
 *
 *  Copyright © 2010 Intel Corporation
 *  Copyright © 2010 David Woodhouse <dwmw2@infradead.org>
 *
 *  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., 51 Franklin Street, Fifth Floor, Boston, MA
 *  02110-1301, USA.
 */

J
Joe Perches 已提交
23 24
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

D
David Woodhouse 已提交
25 26 27 28 29 30 31
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <acpi/acpi_bus.h>
#include <acpi/acpi_drivers.h>
#include <linux/rfkill.h>
32
#include <linux/platform_device.h>
I
Ike Panhc 已提交
33 34
#include <linux/input.h>
#include <linux/input/sparse-keymap.h>
I
Ike Panhc 已提交
35 36
#include <linux/backlight.h>
#include <linux/fb.h>
I
Ike Panhc 已提交
37 38
#include <linux/debugfs.h>
#include <linux/seq_file.h>
D
David Woodhouse 已提交
39

40
#define IDEAPAD_RFKILL_DEV_NUM	(3)
D
David Woodhouse 已提交
41

42 43 44
#define CFG_BT_BIT	(16)
#define CFG_3G_BIT	(17)
#define CFG_WIFI_BIT	(18)
45
#define CFG_CAMERA_BIT	(19)
46

I
Ike Panhc 已提交
47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67
enum {
	VPCCMD_R_VPC1 = 0x10,
	VPCCMD_R_BL_MAX,
	VPCCMD_R_BL,
	VPCCMD_W_BL,
	VPCCMD_R_WIFI,
	VPCCMD_W_WIFI,
	VPCCMD_R_BT,
	VPCCMD_W_BT,
	VPCCMD_R_BL_POWER,
	VPCCMD_R_NOVO,
	VPCCMD_R_VPC2,
	VPCCMD_R_TOUCHPAD,
	VPCCMD_W_TOUCHPAD,
	VPCCMD_R_CAMERA,
	VPCCMD_W_CAMERA,
	VPCCMD_R_3G,
	VPCCMD_W_3G,
	VPCCMD_R_ODD, /* 0x21 */
	VPCCMD_R_RF = 0x23,
	VPCCMD_W_RF,
68
	VPCCMD_R_SPECIAL_BUTTONS = 0x31,
I
Ike Panhc 已提交
69 70 71
	VPCCMD_W_BL_POWER = 0x33,
};

72
struct ideapad_private {
73
	struct rfkill *rfk[IDEAPAD_RFKILL_DEV_NUM];
74
	struct platform_device *platform_device;
I
Ike Panhc 已提交
75
	struct input_dev *inputdev;
I
Ike Panhc 已提交
76
	struct backlight_device *blightdev;
I
Ike Panhc 已提交
77
	struct dentry *debug;
78
	unsigned long cfg;
D
David Woodhouse 已提交
79 80
};

81
static acpi_handle ideapad_handle;
I
Ike Panhc 已提交
82
static struct ideapad_private *ideapad_priv;
I
Ike Panhc 已提交
83 84 85 86
static bool no_bt_rfkill;
module_param(no_bt_rfkill, bool, 0444);
MODULE_PARM_DESC(no_bt_rfkill, "No rfkill for bluetooth.");

I
Ike Panhc 已提交
87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194
/*
 * ACPI Helpers
 */
#define IDEAPAD_EC_TIMEOUT (100) /* in ms */

static int read_method_int(acpi_handle handle, const char *method, int *val)
{
	acpi_status status;
	unsigned long long result;

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

static int method_vpcr(acpi_handle handle, int cmd, int *ret)
{
	acpi_status status;
	unsigned long long result;
	struct acpi_object_list params;
	union acpi_object in_obj;

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

	status = acpi_evaluate_integer(handle, "VPCR", &params, &result);

	if (ACPI_FAILURE(status)) {
		*ret = -1;
		return -1;
	} else {
		*ret = result;
		return 0;
	}
}

static int method_vpcw(acpi_handle handle, int cmd, int data)
{
	struct acpi_object_list params;
	union acpi_object in_obj[2];
	acpi_status status;

	params.count = 2;
	params.pointer = in_obj;
	in_obj[0].type = ACPI_TYPE_INTEGER;
	in_obj[0].integer.value = cmd;
	in_obj[1].type = ACPI_TYPE_INTEGER;
	in_obj[1].integer.value = data;

	status = acpi_evaluate_object(handle, "VPCW", &params, NULL);
	if (status != AE_OK)
		return -1;
	return 0;
}

static int read_ec_data(acpi_handle handle, int cmd, unsigned long *data)
{
	int val;
	unsigned long int end_jiffies;

	if (method_vpcw(handle, 1, cmd))
		return -1;

	for (end_jiffies = jiffies+(HZ)*IDEAPAD_EC_TIMEOUT/1000+1;
	     time_before(jiffies, end_jiffies);) {
		schedule();
		if (method_vpcr(handle, 1, &val))
			return -1;
		if (val == 0) {
			if (method_vpcr(handle, 0, &val))
				return -1;
			*data = val;
			return 0;
		}
	}
	pr_err("timeout in read_ec_cmd\n");
	return -1;
}

static int write_ec_cmd(acpi_handle handle, int cmd, unsigned long data)
{
	int val;
	unsigned long int end_jiffies;

	if (method_vpcw(handle, 0, data))
		return -1;
	if (method_vpcw(handle, 1, cmd))
		return -1;

	for (end_jiffies = jiffies+(HZ)*IDEAPAD_EC_TIMEOUT/1000+1;
	     time_before(jiffies, end_jiffies);) {
		schedule();
		if (method_vpcr(handle, 1, &val))
			return -1;
		if (val == 0)
			return 0;
	}
	pr_err("timeout in write_ec_cmd\n");
	return -1;
}

I
Ike Panhc 已提交
195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317
/*
 * debugfs
 */
static int debugfs_status_show(struct seq_file *s, void *data)
{
	unsigned long value;

	if (!read_ec_data(ideapad_handle, VPCCMD_R_BL_MAX, &value))
		seq_printf(s, "Backlight max:\t%lu\n", value);
	if (!read_ec_data(ideapad_handle, VPCCMD_R_BL, &value))
		seq_printf(s, "Backlight now:\t%lu\n", value);
	if (!read_ec_data(ideapad_handle, VPCCMD_R_BL_POWER, &value))
		seq_printf(s, "BL power value:\t%s\n", value ? "On" : "Off");
	seq_printf(s, "=====================\n");

	if (!read_ec_data(ideapad_handle, VPCCMD_R_RF, &value))
		seq_printf(s, "Radio status:\t%s(%lu)\n",
			   value ? "On" : "Off", value);
	if (!read_ec_data(ideapad_handle, VPCCMD_R_WIFI, &value))
		seq_printf(s, "Wifi status:\t%s(%lu)\n",
			   value ? "On" : "Off", value);
	if (!read_ec_data(ideapad_handle, VPCCMD_R_BT, &value))
		seq_printf(s, "BT status:\t%s(%lu)\n",
			   value ? "On" : "Off", value);
	if (!read_ec_data(ideapad_handle, VPCCMD_R_3G, &value))
		seq_printf(s, "3G status:\t%s(%lu)\n",
			   value ? "On" : "Off", value);
	seq_printf(s, "=====================\n");

	if (!read_ec_data(ideapad_handle, VPCCMD_R_TOUCHPAD, &value))
		seq_printf(s, "Touchpad status:%s(%lu)\n",
			   value ? "On" : "Off", value);
	if (!read_ec_data(ideapad_handle, VPCCMD_R_CAMERA, &value))
		seq_printf(s, "Camera status:\t%s(%lu)\n",
			   value ? "On" : "Off", value);

	return 0;
}

static int debugfs_status_open(struct inode *inode, struct file *file)
{
	return single_open(file, debugfs_status_show, NULL);
}

static const struct file_operations debugfs_status_fops = {
	.owner = THIS_MODULE,
	.open = debugfs_status_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
};

static int debugfs_cfg_show(struct seq_file *s, void *data)
{
	if (!ideapad_priv) {
		seq_printf(s, "cfg: N/A\n");
	} else {
		seq_printf(s, "cfg: 0x%.8lX\n\nCapability: ",
			   ideapad_priv->cfg);
		if (test_bit(CFG_BT_BIT, &ideapad_priv->cfg))
			seq_printf(s, "Bluetooth ");
		if (test_bit(CFG_3G_BIT, &ideapad_priv->cfg))
			seq_printf(s, "3G ");
		if (test_bit(CFG_WIFI_BIT, &ideapad_priv->cfg))
			seq_printf(s, "Wireless ");
		if (test_bit(CFG_CAMERA_BIT, &ideapad_priv->cfg))
			seq_printf(s, "Camera ");
		seq_printf(s, "\nGraphic: ");
		switch ((ideapad_priv->cfg)&0x700) {
		case 0x100:
			seq_printf(s, "Intel");
			break;
		case 0x200:
			seq_printf(s, "ATI");
			break;
		case 0x300:
			seq_printf(s, "Nvidia");
			break;
		case 0x400:
			seq_printf(s, "Intel and ATI");
			break;
		case 0x500:
			seq_printf(s, "Intel and Nvidia");
			break;
		}
		seq_printf(s, "\n");
	}
	return 0;
}

static int debugfs_cfg_open(struct inode *inode, struct file *file)
{
	return single_open(file, debugfs_cfg_show, NULL);
}

static const struct file_operations debugfs_cfg_fops = {
	.owner = THIS_MODULE,
	.open = debugfs_cfg_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
};

static int __devinit ideapad_debugfs_init(struct ideapad_private *priv)
{
	struct dentry *node;

	priv->debug = debugfs_create_dir("ideapad", NULL);
	if (priv->debug == NULL) {
		pr_err("failed to create debugfs directory");
		goto errout;
	}

	node = debugfs_create_file("cfg", S_IRUGO, priv->debug, NULL,
				   &debugfs_cfg_fops);
	if (!node) {
		pr_err("failed to create cfg in debugfs");
		goto errout;
	}

	node = debugfs_create_file("status", S_IRUGO, priv->debug, NULL,
				   &debugfs_status_fops);
	if (!node) {
318
		pr_err("failed to create status in debugfs");
I
Ike Panhc 已提交
319 320 321 322 323 324 325 326 327 328 329 330 331 332 333
		goto errout;
	}

	return 0;

errout:
	return -ENOMEM;
}

static void ideapad_debugfs_exit(struct ideapad_private *priv)
{
	debugfs_remove_recursive(priv->debug);
	priv->debug = NULL;
}

334
/*
335
 * sysfs
336
 */
D
David Woodhouse 已提交
337 338 339 340
static ssize_t show_ideapad_cam(struct device *dev,
				struct device_attribute *attr,
				char *buf)
{
341
	unsigned long result;
D
David Woodhouse 已提交
342

I
Ike Panhc 已提交
343
	if (read_ec_data(ideapad_handle, VPCCMD_R_CAMERA, &result))
344 345
		return sprintf(buf, "-1\n");
	return sprintf(buf, "%lu\n", result);
D
David Woodhouse 已提交
346 347 348 349 350 351 352 353 354 355 356 357
}

static ssize_t store_ideapad_cam(struct device *dev,
				 struct device_attribute *attr,
				 const char *buf, size_t count)
{
	int ret, state;

	if (!count)
		return 0;
	if (sscanf(buf, "%i", &state) != 1)
		return -EINVAL;
I
Ike Panhc 已提交
358
	ret = write_ec_cmd(ideapad_handle, VPCCMD_W_CAMERA, state);
D
David Woodhouse 已提交
359 360 361 362 363 364 365
	if (ret < 0)
		return ret;
	return count;
}

static DEVICE_ATTR(camera_power, 0644, show_ideapad_cam, store_ideapad_cam);

366 367 368 369 370
static struct attribute *ideapad_attributes[] = {
	&dev_attr_camera_power.attr,
	NULL
};

371
static umode_t ideapad_is_visible(struct kobject *kobj,
372 373 374 375 376 377 378 379 380 381 382 383 384 385 386
				 struct attribute *attr,
				 int idx)
{
	struct device *dev = container_of(kobj, struct device, kobj);
	struct ideapad_private *priv = dev_get_drvdata(dev);
	bool supported;

	if (attr == &dev_attr_camera_power.attr)
		supported = test_bit(CFG_CAMERA_BIT, &(priv->cfg));
	else
		supported = true;

	return supported ? attr->mode : 0;
}

387
static struct attribute_group ideapad_attribute_group = {
388
	.is_visible = ideapad_is_visible,
389 390 391
	.attrs = ideapad_attributes
};

392 393 394
/*
 * Rfkill
 */
395 396 397 398 399 400 401 402
struct ideapad_rfk_data {
	char *name;
	int cfgbit;
	int opcode;
	int type;
};

const struct ideapad_rfk_data ideapad_rfk_data[] = {
I
Ike Panhc 已提交
403 404 405
	{ "ideapad_wlan",    CFG_WIFI_BIT, VPCCMD_W_WIFI, RFKILL_TYPE_WLAN },
	{ "ideapad_bluetooth", CFG_BT_BIT, VPCCMD_W_BT, RFKILL_TYPE_BLUETOOTH },
	{ "ideapad_3g",        CFG_3G_BIT, VPCCMD_W_3G, RFKILL_TYPE_WWAN },
406 407
};

D
David Woodhouse 已提交
408 409
static int ideapad_rfk_set(void *data, bool blocked)
{
410
	unsigned long opcode = (unsigned long)data;
I
Ike Panhc 已提交
411

412
	return write_ec_cmd(ideapad_handle, opcode, !blocked);
D
David Woodhouse 已提交
413 414 415 416 417 418
}

static struct rfkill_ops ideapad_rfk_ops = {
	.set_block = ideapad_rfk_set,
};

419
static void ideapad_sync_rfk_state(struct ideapad_private *priv)
D
David Woodhouse 已提交
420
{
I
Ike Panhc 已提交
421
	unsigned long hw_blocked;
D
David Woodhouse 已提交
422 423
	int i;

I
Ike Panhc 已提交
424
	if (read_ec_data(ideapad_handle, VPCCMD_R_RF, &hw_blocked))
D
David Woodhouse 已提交
425
		return;
I
Ike Panhc 已提交
426
	hw_blocked = !hw_blocked;
D
David Woodhouse 已提交
427

428
	for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++)
429
		if (priv->rfk[i])
I
Ike Panhc 已提交
430
			rfkill_set_hw_state(priv->rfk[i], hw_blocked);
D
David Woodhouse 已提交
431 432
}

433 434
static int __devinit ideapad_register_rfkill(struct acpi_device *adevice,
					     int dev)
D
David Woodhouse 已提交
435
{
436
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
D
David Woodhouse 已提交
437
	int ret;
I
Ike Panhc 已提交
438
	unsigned long sw_blocked;
D
David Woodhouse 已提交
439

I
Ike Panhc 已提交
440 441 442
	if (no_bt_rfkill &&
	    (ideapad_rfk_data[dev].type == RFKILL_TYPE_BLUETOOTH)) {
		/* Force to enable bluetooth when no_bt_rfkill=1 */
443
		write_ec_cmd(ideapad_handle,
I
Ike Panhc 已提交
444 445 446 447
			     ideapad_rfk_data[dev].opcode, 1);
		return 0;
	}

I
Ike Panhc 已提交
448 449
	priv->rfk[dev] = rfkill_alloc(ideapad_rfk_data[dev].name, &adevice->dev,
				      ideapad_rfk_data[dev].type, &ideapad_rfk_ops,
450 451
				      (void *)(long)dev);
	if (!priv->rfk[dev])
D
David Woodhouse 已提交
452 453
		return -ENOMEM;

454
	if (read_ec_data(ideapad_handle, ideapad_rfk_data[dev].opcode-1,
I
Ike Panhc 已提交
455 456 457 458 459 460 461
			 &sw_blocked)) {
		rfkill_init_sw_state(priv->rfk[dev], 0);
	} else {
		sw_blocked = !sw_blocked;
		rfkill_init_sw_state(priv->rfk[dev], sw_blocked);
	}

462
	ret = rfkill_register(priv->rfk[dev]);
D
David Woodhouse 已提交
463
	if (ret) {
464
		rfkill_destroy(priv->rfk[dev]);
D
David Woodhouse 已提交
465 466 467 468 469
		return ret;
	}
	return 0;
}

I
Ike Panhc 已提交
470
static void ideapad_unregister_rfkill(struct acpi_device *adevice, int dev)
D
David Woodhouse 已提交
471
{
472 473 474
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);

	if (!priv->rfk[dev])
D
David Woodhouse 已提交
475 476
		return;

477 478
	rfkill_unregister(priv->rfk[dev]);
	rfkill_destroy(priv->rfk[dev]);
D
David Woodhouse 已提交
479 480
}

481 482 483
/*
 * Platform device
 */
484
static int __devinit ideapad_platform_init(struct ideapad_private *priv)
485 486 487
{
	int result;

488 489
	priv->platform_device = platform_device_alloc("ideapad", -1);
	if (!priv->platform_device)
490
		return -ENOMEM;
491
	platform_set_drvdata(priv->platform_device, priv);
492

493
	result = platform_device_add(priv->platform_device);
494 495 496
	if (result)
		goto fail_platform_device;

497
	result = sysfs_create_group(&priv->platform_device->dev.kobj,
498 499 500
				    &ideapad_attribute_group);
	if (result)
		goto fail_sysfs;
501 502
	return 0;

503
fail_sysfs:
504
	platform_device_del(priv->platform_device);
505
fail_platform_device:
506
	platform_device_put(priv->platform_device);
507 508 509
	return result;
}

510
static void ideapad_platform_exit(struct ideapad_private *priv)
511
{
512
	sysfs_remove_group(&priv->platform_device->dev.kobj,
513
			   &ideapad_attribute_group);
514
	platform_device_unregister(priv->platform_device);
515 516
}

I
Ike Panhc 已提交
517 518 519 520
/*
 * input device
 */
static const struct key_entry ideapad_keymap[] = {
I
Ike Panhc 已提交
521
	{ KE_KEY, 6,  { KEY_SWITCHVIDEOMODE } },
522 523
	{ KE_KEY, 7,  { KEY_CAMERA } },
	{ KE_KEY, 11, { KEY_F16 } },
I
Ike Panhc 已提交
524 525 526
	{ KE_KEY, 13, { KEY_WLAN } },
	{ KE_KEY, 16, { KEY_PROG1 } },
	{ KE_KEY, 17, { KEY_PROG2 } },
527 528
	{ KE_KEY, 64, { KEY_PROG3 } },
	{ KE_KEY, 65, { KEY_PROG4 } },
I
Ike Panhc 已提交
529 530 531
	{ KE_END, 0 },
};

532
static int __devinit ideapad_input_init(struct ideapad_private *priv)
I
Ike Panhc 已提交
533 534 535 536 537 538 539 540 541 542 543 544 545
{
	struct input_dev *inputdev;
	int error;

	inputdev = input_allocate_device();
	if (!inputdev) {
		pr_info("Unable to allocate input device\n");
		return -ENOMEM;
	}

	inputdev->name = "Ideapad extra buttons";
	inputdev->phys = "ideapad/input0";
	inputdev->id.bustype = BUS_HOST;
546
	inputdev->dev.parent = &priv->platform_device->dev;
I
Ike Panhc 已提交
547 548 549 550 551 552 553 554 555 556 557 558 559

	error = sparse_keymap_setup(inputdev, ideapad_keymap, NULL);
	if (error) {
		pr_err("Unable to setup input device keymap\n");
		goto err_free_dev;
	}

	error = input_register_device(inputdev);
	if (error) {
		pr_err("Unable to register input device\n");
		goto err_free_keymap;
	}

560
	priv->inputdev = inputdev;
I
Ike Panhc 已提交
561 562 563 564 565 566 567 568 569
	return 0;

err_free_keymap:
	sparse_keymap_free(inputdev);
err_free_dev:
	input_free_device(inputdev);
	return error;
}

570
static void ideapad_input_exit(struct ideapad_private *priv)
I
Ike Panhc 已提交
571
{
572 573 574
	sparse_keymap_free(priv->inputdev);
	input_unregister_device(priv->inputdev);
	priv->inputdev = NULL;
I
Ike Panhc 已提交
575 576
}

577 578
static void ideapad_input_report(struct ideapad_private *priv,
				 unsigned long scancode)
I
Ike Panhc 已提交
579
{
580
	sparse_keymap_report_event(priv->inputdev, scancode, 1, true);
I
Ike Panhc 已提交
581 582
}

I
Ike Panhc 已提交
583 584 585 586 587 588 589 590 591 592 593 594
static void ideapad_input_novokey(struct ideapad_private *priv)
{
	unsigned long long_pressed;

	if (read_ec_data(ideapad_handle, VPCCMD_R_NOVO, &long_pressed))
		return;
	if (long_pressed)
		ideapad_input_report(priv, 17);
	else
		ideapad_input_report(priv, 16);
}

595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616
static void ideapad_check_special_buttons(struct ideapad_private *priv)
{
	unsigned long bit, value;

	read_ec_data(ideapad_handle, VPCCMD_R_SPECIAL_BUTTONS, &value);

	for (bit = 0; bit < 16; bit++) {
		if (test_bit(bit, &value)) {
			switch (bit) {
			case 6:
				/* Thermal Management button */
				ideapad_input_report(priv, 65);
				break;
			case 1:
				/* OneKey Theater button */
				ideapad_input_report(priv, 64);
				break;
			}
		}
	}
}

I
Ike Panhc 已提交
617 618 619 620 621 622 623
/*
 * backlight
 */
static int ideapad_backlight_get_brightness(struct backlight_device *blightdev)
{
	unsigned long now;

I
Ike Panhc 已提交
624
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL, &now))
I
Ike Panhc 已提交
625 626 627 628 629 630
		return -EIO;
	return now;
}

static int ideapad_backlight_update_status(struct backlight_device *blightdev)
{
I
Ike Panhc 已提交
631 632
	if (write_ec_cmd(ideapad_handle, VPCCMD_W_BL,
			 blightdev->props.brightness))
I
Ike Panhc 已提交
633
		return -EIO;
I
Ike Panhc 已提交
634
	if (write_ec_cmd(ideapad_handle, VPCCMD_W_BL_POWER,
I
Ike Panhc 已提交
635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651
			 blightdev->props.power == FB_BLANK_POWERDOWN ? 0 : 1))
		return -EIO;

	return 0;
}

static const struct backlight_ops ideapad_backlight_ops = {
	.get_brightness = ideapad_backlight_get_brightness,
	.update_status = ideapad_backlight_update_status,
};

static int ideapad_backlight_init(struct ideapad_private *priv)
{
	struct backlight_device *blightdev;
	struct backlight_properties props;
	unsigned long max, now, power;

I
Ike Panhc 已提交
652
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL_MAX, &max))
I
Ike Panhc 已提交
653
		return -EIO;
I
Ike Panhc 已提交
654
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL, &now))
I
Ike Panhc 已提交
655
		return -EIO;
I
Ike Panhc 已提交
656
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL_POWER, &power))
I
Ike Panhc 已提交
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
		return -EIO;

	memset(&props, 0, sizeof(struct backlight_properties));
	props.max_brightness = max;
	props.type = BACKLIGHT_PLATFORM;
	blightdev = backlight_device_register("ideapad",
					      &priv->platform_device->dev,
					      priv,
					      &ideapad_backlight_ops,
					      &props);
	if (IS_ERR(blightdev)) {
		pr_err("Could not register backlight device\n");
		return PTR_ERR(blightdev);
	}

	priv->blightdev = blightdev;
	blightdev->props.brightness = now;
	blightdev->props.power = power ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
	backlight_update_status(blightdev);

	return 0;
}

static void ideapad_backlight_exit(struct ideapad_private *priv)
{
	if (priv->blightdev)
		backlight_device_unregister(priv->blightdev);
	priv->blightdev = NULL;
}

static void ideapad_backlight_notify_power(struct ideapad_private *priv)
{
	unsigned long power;
	struct backlight_device *blightdev = priv->blightdev;

692 693
	if (!blightdev)
		return;
I
Ike Panhc 已提交
694
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL_POWER, &power))
I
Ike Panhc 已提交
695 696 697 698 699 700 701 702 703 704
		return;
	blightdev->props.power = power ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
}

static void ideapad_backlight_notify_brightness(struct ideapad_private *priv)
{
	unsigned long now;

	/* if we control brightness via acpi video driver */
	if (priv->blightdev == NULL) {
I
Ike Panhc 已提交
705
		read_ec_data(ideapad_handle, VPCCMD_R_BL, &now);
I
Ike Panhc 已提交
706 707 708 709 710 711
		return;
	}

	backlight_force_update(priv->blightdev, BACKLIGHT_UPDATE_HOTKEY);
}

712 713 714
/*
 * module init/exit
 */
D
David Woodhouse 已提交
715 716 717 718 719 720
static const struct acpi_device_id ideapad_device_ids[] = {
	{ "VPC2004", 0},
	{ "", 0},
};
MODULE_DEVICE_TABLE(acpi, ideapad_device_ids);

721
static int __devinit ideapad_acpi_add(struct acpi_device *adevice)
D
David Woodhouse 已提交
722
{
723
	int ret, i;
724
	int cfg;
725
	struct ideapad_private *priv;
D
David Woodhouse 已提交
726

727
	if (read_method_int(adevice->handle, "_CFG", &cfg))
728 729
		return -ENODEV;

730 731 732
	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;
733
	dev_set_drvdata(&adevice->dev, priv);
I
Ike Panhc 已提交
734
	ideapad_priv = priv;
735
	ideapad_handle = adevice->handle;
736
	priv->cfg = cfg;
737

738
	ret = ideapad_platform_init(priv);
739 740
	if (ret)
		goto platform_failed;
741

I
Ike Panhc 已提交
742 743 744 745
	ret = ideapad_debugfs_init(priv);
	if (ret)
		goto debugfs_failed;

746
	ret = ideapad_input_init(priv);
I
Ike Panhc 已提交
747 748 749
	if (ret)
		goto input_failed;

750
	for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++) {
751
		if (test_bit(ideapad_rfk_data[i].cfgbit, &priv->cfg))
752
			ideapad_register_rfkill(adevice, i);
753 754
		else
			priv->rfk[i] = NULL;
D
David Woodhouse 已提交
755
	}
756
	ideapad_sync_rfk_state(priv);
757

I
Ike Panhc 已提交
758 759 760 761 762 763
	if (!acpi_video_backlight_support()) {
		ret = ideapad_backlight_init(priv);
		if (ret && ret != -ENODEV)
			goto backlight_failed;
	}

D
David Woodhouse 已提交
764
	return 0;
765

I
Ike Panhc 已提交
766 767 768
backlight_failed:
	for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++)
		ideapad_unregister_rfkill(adevice, i);
769
	ideapad_input_exit(priv);
I
Ike Panhc 已提交
770
input_failed:
I
Ike Panhc 已提交
771 772
	ideapad_debugfs_exit(priv);
debugfs_failed:
773
	ideapad_platform_exit(priv);
774 775 776
platform_failed:
	kfree(priv);
	return ret;
D
David Woodhouse 已提交
777 778
}

779
static int __devexit ideapad_acpi_remove(struct acpi_device *adevice, int type)
D
David Woodhouse 已提交
780
{
781
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
D
David Woodhouse 已提交
782
	int i;
783

I
Ike Panhc 已提交
784
	ideapad_backlight_exit(priv);
785
	for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++)
786
		ideapad_unregister_rfkill(adevice, i);
787
	ideapad_input_exit(priv);
I
Ike Panhc 已提交
788
	ideapad_debugfs_exit(priv);
789
	ideapad_platform_exit(priv);
790 791
	dev_set_drvdata(&adevice->dev, NULL);
	kfree(priv);
792

D
David Woodhouse 已提交
793 794 795
	return 0;
}

796
static void ideapad_acpi_notify(struct acpi_device *adevice, u32 event)
D
David Woodhouse 已提交
797
{
798
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
799 800 801
	acpi_handle handle = adevice->handle;
	unsigned long vpc1, vpc2, vpc_bit;

I
Ike Panhc 已提交
802
	if (read_ec_data(handle, VPCCMD_R_VPC1, &vpc1))
803
		return;
I
Ike Panhc 已提交
804
	if (read_ec_data(handle, VPCCMD_R_VPC2, &vpc2))
805 806 807 808 809
		return;

	vpc1 = (vpc2 << 8) | vpc1;
	for (vpc_bit = 0; vpc_bit < 16; vpc_bit++) {
		if (test_bit(vpc_bit, &vpc1)) {
I
Ike Panhc 已提交
810 811
			switch (vpc_bit) {
			case 9:
812
				ideapad_sync_rfk_state(priv);
I
Ike Panhc 已提交
813
				break;
814
			case 13:
815 816
			case 11:
			case 7:
817 818 819
			case 6:
				ideapad_input_report(priv, vpc_bit);
				break;
I
Ike Panhc 已提交
820 821 822
			case 4:
				ideapad_backlight_notify_brightness(priv);
				break;
I
Ike Panhc 已提交
823 824 825
			case 3:
				ideapad_input_novokey(priv);
				break;
I
Ike Panhc 已提交
826 827 828
			case 2:
				ideapad_backlight_notify_power(priv);
				break;
829 830 831
			case 0:
				ideapad_check_special_buttons(priv);
				break;
I
Ike Panhc 已提交
832
			default:
833
				pr_info("Unknown event: %lu\n", vpc_bit);
I
Ike Panhc 已提交
834
			}
835 836
		}
	}
D
David Woodhouse 已提交
837 838 839 840 841 842 843 844 845 846 847 848 849 850
}

static struct acpi_driver ideapad_acpi_driver = {
	.name = "ideapad_acpi",
	.class = "IdeaPad",
	.ids = ideapad_device_ids,
	.ops.add = ideapad_acpi_add,
	.ops.remove = ideapad_acpi_remove,
	.ops.notify = ideapad_acpi_notify,
	.owner = THIS_MODULE,
};

static int __init ideapad_acpi_module_init(void)
{
851
	return acpi_bus_register_driver(&ideapad_acpi_driver);
D
David Woodhouse 已提交
852 853 854 855 856 857 858 859 860 861 862 863 864
}

static void __exit ideapad_acpi_module_exit(void)
{
	acpi_bus_unregister_driver(&ideapad_acpi_driver);
}

MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
MODULE_DESCRIPTION("IdeaPad ACPI Extras");
MODULE_LICENSE("GPL");

module_init(ideapad_acpi_module_init);
module_exit(ideapad_acpi_module_exit);