ideapad-laptop.c 19.5 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 68 69 70
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,
	VPCCMD_W_BL_POWER = 0x33,
};

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

80
static acpi_handle ideapad_handle;
I
Ike Panhc 已提交
81
static struct ideapad_private *ideapad_priv;
I
Ike Panhc 已提交
82 83 84 85
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 已提交
86 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
/*
 * 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 已提交
194 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 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333
/*
 * debugfs
 */
#define DEBUGFS_EVENT_LEN (4096)
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) {
		pr_err("failed to create event in debugfs");
		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 522 523 524
	{ KE_KEY, 6,  { KEY_SWITCHVIDEOMODE } },
	{ KE_KEY, 13, { KEY_WLAN } },
	{ KE_KEY, 16, { KEY_PROG1 } },
	{ KE_KEY, 17, { KEY_PROG2 } },
I
Ike Panhc 已提交
525 526 527
	{ KE_END, 0 },
};

528
static int __devinit ideapad_input_init(struct ideapad_private *priv)
I
Ike Panhc 已提交
529 530 531 532 533 534 535 536 537 538 539 540 541
{
	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;
542
	inputdev->dev.parent = &priv->platform_device->dev;
I
Ike Panhc 已提交
543 544 545 546 547 548 549 550 551 552 553 554 555

	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;
	}

556
	priv->inputdev = inputdev;
I
Ike Panhc 已提交
557 558 559 560 561 562 563 564 565
	return 0;

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

566
static void ideapad_input_exit(struct ideapad_private *priv)
I
Ike Panhc 已提交
567
{
568 569 570
	sparse_keymap_free(priv->inputdev);
	input_unregister_device(priv->inputdev);
	priv->inputdev = NULL;
I
Ike Panhc 已提交
571 572
}

573 574
static void ideapad_input_report(struct ideapad_private *priv,
				 unsigned long scancode)
I
Ike Panhc 已提交
575
{
576
	sparse_keymap_report_event(priv->inputdev, scancode, 1, true);
I
Ike Panhc 已提交
577 578
}

I
Ike Panhc 已提交
579 580 581 582 583 584 585 586 587 588 589 590
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);
}

I
Ike Panhc 已提交
591 592 593 594 595 596 597
/*
 * backlight
 */
static int ideapad_backlight_get_brightness(struct backlight_device *blightdev)
{
	unsigned long now;

I
Ike Panhc 已提交
598
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL, &now))
I
Ike Panhc 已提交
599 600 601 602 603 604
		return -EIO;
	return now;
}

static int ideapad_backlight_update_status(struct backlight_device *blightdev)
{
I
Ike Panhc 已提交
605 606
	if (write_ec_cmd(ideapad_handle, VPCCMD_W_BL,
			 blightdev->props.brightness))
I
Ike Panhc 已提交
607
		return -EIO;
I
Ike Panhc 已提交
608
	if (write_ec_cmd(ideapad_handle, VPCCMD_W_BL_POWER,
I
Ike Panhc 已提交
609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625
			 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 已提交
626
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL_MAX, &max))
I
Ike Panhc 已提交
627
		return -EIO;
I
Ike Panhc 已提交
628
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL, &now))
I
Ike Panhc 已提交
629
		return -EIO;
I
Ike Panhc 已提交
630
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL_POWER, &power))
I
Ike Panhc 已提交
631 632 633 634 635 636 637 638 639 640 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
		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;

666 667
	if (!blightdev)
		return;
I
Ike Panhc 已提交
668
	if (read_ec_data(ideapad_handle, VPCCMD_R_BL_POWER, &power))
I
Ike Panhc 已提交
669 670 671 672 673 674 675 676 677 678
		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 已提交
679
		read_ec_data(ideapad_handle, VPCCMD_R_BL, &now);
I
Ike Panhc 已提交
680 681 682 683 684 685
		return;
	}

	backlight_force_update(priv->blightdev, BACKLIGHT_UPDATE_HOTKEY);
}

686 687 688
/*
 * module init/exit
 */
D
David Woodhouse 已提交
689 690 691 692 693 694
static const struct acpi_device_id ideapad_device_ids[] = {
	{ "VPC2004", 0},
	{ "", 0},
};
MODULE_DEVICE_TABLE(acpi, ideapad_device_ids);

695
static int __devinit ideapad_acpi_add(struct acpi_device *adevice)
D
David Woodhouse 已提交
696
{
697 698
	int ret, i;
	unsigned long cfg;
699
	struct ideapad_private *priv;
D
David Woodhouse 已提交
700

701
	if (read_method_int(adevice->handle, "_CFG", (int *)&cfg))
702 703
		return -ENODEV;

704 705 706
	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;
707
	dev_set_drvdata(&adevice->dev, priv);
I
Ike Panhc 已提交
708
	ideapad_priv = priv;
709
	ideapad_handle = adevice->handle;
710
	priv->cfg = cfg;
711

712
	ret = ideapad_platform_init(priv);
713 714
	if (ret)
		goto platform_failed;
715

I
Ike Panhc 已提交
716 717 718 719
	ret = ideapad_debugfs_init(priv);
	if (ret)
		goto debugfs_failed;

720
	ret = ideapad_input_init(priv);
I
Ike Panhc 已提交
721 722 723
	if (ret)
		goto input_failed;

724
	for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++) {
725
		if (test_bit(ideapad_rfk_data[i].cfgbit, &cfg))
726
			ideapad_register_rfkill(adevice, i);
727 728
		else
			priv->rfk[i] = NULL;
D
David Woodhouse 已提交
729
	}
730
	ideapad_sync_rfk_state(priv);
731

I
Ike Panhc 已提交
732 733 734 735 736 737
	if (!acpi_video_backlight_support()) {
		ret = ideapad_backlight_init(priv);
		if (ret && ret != -ENODEV)
			goto backlight_failed;
	}

D
David Woodhouse 已提交
738
	return 0;
739

I
Ike Panhc 已提交
740 741 742
backlight_failed:
	for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++)
		ideapad_unregister_rfkill(adevice, i);
743
	ideapad_input_exit(priv);
I
Ike Panhc 已提交
744
input_failed:
I
Ike Panhc 已提交
745 746
	ideapad_debugfs_exit(priv);
debugfs_failed:
747
	ideapad_platform_exit(priv);
748 749 750
platform_failed:
	kfree(priv);
	return ret;
D
David Woodhouse 已提交
751 752
}

753
static int __devexit ideapad_acpi_remove(struct acpi_device *adevice, int type)
D
David Woodhouse 已提交
754
{
755
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
D
David Woodhouse 已提交
756
	int i;
757

I
Ike Panhc 已提交
758
	ideapad_backlight_exit(priv);
759
	for (i = 0; i < IDEAPAD_RFKILL_DEV_NUM; i++)
760
		ideapad_unregister_rfkill(adevice, i);
761
	ideapad_input_exit(priv);
I
Ike Panhc 已提交
762
	ideapad_debugfs_exit(priv);
763
	ideapad_platform_exit(priv);
764 765
	dev_set_drvdata(&adevice->dev, NULL);
	kfree(priv);
766

D
David Woodhouse 已提交
767 768 769
	return 0;
}

770
static void ideapad_acpi_notify(struct acpi_device *adevice, u32 event)
D
David Woodhouse 已提交
771
{
772
	struct ideapad_private *priv = dev_get_drvdata(&adevice->dev);
773 774 775
	acpi_handle handle = adevice->handle;
	unsigned long vpc1, vpc2, vpc_bit;

I
Ike Panhc 已提交
776
	if (read_ec_data(handle, VPCCMD_R_VPC1, &vpc1))
777
		return;
I
Ike Panhc 已提交
778
	if (read_ec_data(handle, VPCCMD_R_VPC2, &vpc2))
779 780 781 782 783
		return;

	vpc1 = (vpc2 << 8) | vpc1;
	for (vpc_bit = 0; vpc_bit < 16; vpc_bit++) {
		if (test_bit(vpc_bit, &vpc1)) {
I
Ike Panhc 已提交
784 785
			switch (vpc_bit) {
			case 9:
786
				ideapad_sync_rfk_state(priv);
I
Ike Panhc 已提交
787 788 789 790
				break;
			case 4:
				ideapad_backlight_notify_brightness(priv);
				break;
I
Ike Panhc 已提交
791 792 793
			case 3:
				ideapad_input_novokey(priv);
				break;
I
Ike Panhc 已提交
794 795 796 797
			case 2:
				ideapad_backlight_notify_power(priv);
				break;
			default:
798
				ideapad_input_report(priv, vpc_bit);
I
Ike Panhc 已提交
799
			}
800 801
		}
	}
D
David Woodhouse 已提交
802 803 804 805 806 807 808 809 810 811 812 813 814 815
}

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)
{
816
	return acpi_bus_register_driver(&ideapad_acpi_driver);
D
David Woodhouse 已提交
817 818 819 820 821 822 823 824 825 826 827 828 829
}

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);