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
/*
 * 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) {
317
		pr_err("failed to create status in debugfs");
I
Ike Panhc 已提交
318 319 320 321 322 323 324 325 326 327 328 329 330 331 332
		goto errout;
	}

	return 0;

errout:
	return -ENOMEM;
}

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

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

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

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 已提交
357
	ret = write_ec_cmd(ideapad_handle, VPCCMD_W_CAMERA, state);
D
David Woodhouse 已提交
358 359 360 361 362 363 364
	if (ret < 0)
		return ret;
	return count;
}

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

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

370
static umode_t ideapad_is_visible(struct kobject *kobj,
371 372 373 374 375 376 377 378 379 380 381 382 383 384 385
				 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;
}

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

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

const struct ideapad_rfk_data ideapad_rfk_data[] = {
I
Ike Panhc 已提交
402 403 404
	{ "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 },
405 406
};

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

I
Ike Panhc 已提交
516 517 518 519
/*
 * input device
 */
static const struct key_entry ideapad_keymap[] = {
I
Ike Panhc 已提交
520 521 522 523
	{ KE_KEY, 6,  { KEY_SWITCHVIDEOMODE } },
	{ KE_KEY, 13, { KEY_WLAN } },
	{ KE_KEY, 16, { KEY_PROG1 } },
	{ KE_KEY, 17, { KEY_PROG2 } },
I
Ike Panhc 已提交
524 525 526
	{ KE_END, 0 },
};

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

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

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

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

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

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

I
Ike Panhc 已提交
578 579 580 581 582 583 584 585 586 587 588 589
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 已提交
590 591 592 593 594 595 596
/*
 * backlight
 */
static int ideapad_backlight_get_brightness(struct backlight_device *blightdev)
{
	unsigned long now;

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

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

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

	backlight_force_update(priv->blightdev, BACKLIGHT_UPDATE_HOTKEY);
}

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

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

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

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

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

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

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

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

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

D
David Woodhouse 已提交
737
	return 0;
738

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

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

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

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

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

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

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

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

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