video.c 49.4 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2
 *  video.c - ACPI Video Driver
L
Linus Torvalds 已提交
3 4 5
 *
 *  Copyright (C) 2004 Luming Yu <luming.yu@intel.com>
 *  Copyright (C) 2004 Bruno Ducrot <ducrot@poupinou.org>
6
 *  Copyright (C) 2006 Thomas Tuttle <linux-kernel@ttuttle.net>
L
Linus Torvalds 已提交
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or (at
 *  your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful, but
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *  General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/list.h>
32
#include <linux/mutex.h>
33
#include <linux/input.h>
34
#include <linux/backlight.h>
35
#include <linux/thermal.h>
36
#include <linux/sort.h>
37 38
#include <linux/pci.h>
#include <linux/pci_ids.h>
39
#include <linux/slab.h>
L
Linus Torvalds 已提交
40
#include <asm/uaccess.h>
41
#include <linux/dmi.h>
L
Linus Torvalds 已提交
42 43
#include <acpi/acpi_bus.h>
#include <acpi/acpi_drivers.h>
44
#include <linux/suspend.h>
45
#include <acpi/video.h>
L
Linus Torvalds 已提交
46

47 48
#include "internal.h"

49 50
#define PREFIX "ACPI: "

L
Linus Torvalds 已提交
51 52 53 54 55 56 57 58
#define ACPI_VIDEO_BUS_NAME		"Video Bus"
#define ACPI_VIDEO_DEVICE_NAME		"Video Device"
#define ACPI_VIDEO_NOTIFY_SWITCH	0x80
#define ACPI_VIDEO_NOTIFY_PROBE		0x81
#define ACPI_VIDEO_NOTIFY_CYCLE		0x82
#define ACPI_VIDEO_NOTIFY_NEXT_OUTPUT	0x83
#define ACPI_VIDEO_NOTIFY_PREV_OUTPUT	0x84

59 60 61 62 63
#define ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS	0x85
#define	ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS	0x86
#define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS	0x87
#define ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS	0x88
#define ACPI_VIDEO_NOTIFY_DISPLAY_OFF		0x89
L
Linus Torvalds 已提交
64

65
#define MAX_NAME_LEN	20
L
Linus Torvalds 已提交
66 67

#define _COMPONENT		ACPI_VIDEO_COMPONENT
68
ACPI_MODULE_NAME("video");
L
Linus Torvalds 已提交
69

70
MODULE_AUTHOR("Bruno Ducrot");
71
MODULE_DESCRIPTION("ACPI Video Driver");
L
Linus Torvalds 已提交
72 73
MODULE_LICENSE("GPL");

74
static bool brightness_switch_enabled = 1;
75 76
module_param(brightness_switch_enabled, bool, 0644);

77 78 79 80
/*
 * By default, we don't allow duplicate ACPI video bus devices
 * under the same VGA controller
 */
81
static bool allow_duplicates;
82 83
module_param(allow_duplicates, bool, 0644);

84 85 86 87
/*
 * Some BIOSes claim they use minimum backlight at boot,
 * and this may bring dimming screen after boot
 */
88
static bool use_bios_initial_backlight = 1;
89 90
module_param(use_bios_initial_backlight, bool, 0644);

91
static int register_count;
L
Len Brown 已提交
92
static int acpi_video_bus_add(struct acpi_device *device);
93
static int acpi_video_bus_remove(struct acpi_device *device);
94
static void acpi_video_bus_notify(struct acpi_device *device, u32 event);
L
Linus Torvalds 已提交
95

96 97 98 99 100 101
static const struct acpi_device_id video_device_ids[] = {
	{ACPI_VIDEO_HID, 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, video_device_ids);

L
Linus Torvalds 已提交
102
static struct acpi_driver acpi_video_bus = {
L
Len Brown 已提交
103
	.name = "video",
L
Linus Torvalds 已提交
104
	.class = ACPI_VIDEO_CLASS,
105
	.ids = video_device_ids,
L
Linus Torvalds 已提交
106 107 108
	.ops = {
		.add = acpi_video_bus_add,
		.remove = acpi_video_bus_remove,
109
		.notify = acpi_video_bus_notify,
L
Len Brown 已提交
110
		},
L
Linus Torvalds 已提交
111 112 113
};

struct acpi_video_bus_flags {
L
Len Brown 已提交
114 115 116 117
	u8 multihead:1;		/* can switch video heads */
	u8 rom:1;		/* can retrieve a video rom */
	u8 post:1;		/* can configure the head to */
	u8 reserved:5;
L
Linus Torvalds 已提交
118 119 120
};

struct acpi_video_bus_cap {
121 122 123 124 125 126
	u8 _DOS:1;		/* Enable/Disable output switching */
	u8 _DOD:1;		/* Enumerate all devices attached to display adapter */
	u8 _ROM:1;		/* Get ROM Data */
	u8 _GPD:1;		/* Get POST Device */
	u8 _SPD:1;		/* Set POST Device */
	u8 _VPO:1;		/* Video POST Options */
L
Len Brown 已提交
127
	u8 reserved:2;
L
Linus Torvalds 已提交
128 129
};

L
Len Brown 已提交
130 131
struct acpi_video_device_attrib {
	u32 display_index:4;	/* A zero-based instance of the Display */
132 133 134 135 136
	u32 display_port_attachment:4;	/* This field differentiates the display type */
	u32 display_type:4;	/* Describe the specific type in use */
	u32 vendor_specific:4;	/* Chipset Vendor Specific */
	u32 bios_can_detect:1;	/* BIOS can detect the device */
	u32 depend_on_vga:1;	/* Non-VGA output device whose power is related to
L
Len Brown 已提交
137
				   the VGA device. */
138 139 140
	u32 pipe_id:3;		/* For VGA multiple-head devices. */
	u32 reserved:10;	/* Must be 0 */
	u32 device_id_scheme:1;	/* Device ID Scheme */
L
Linus Torvalds 已提交
141 142 143 144 145
};

struct acpi_video_enumerated_device {
	union {
		u32 int_val;
L
Len Brown 已提交
146
		struct acpi_video_device_attrib attrib;
L
Linus Torvalds 已提交
147 148 149 150 151
	} value;
	struct acpi_video_device *bind_info;
};

struct acpi_video_bus {
152
	struct acpi_device *device;
L
Len Brown 已提交
153
	u8 dos_setting;
L
Linus Torvalds 已提交
154
	struct acpi_video_enumerated_device *attached_array;
L
Len Brown 已提交
155 156
	u8 attached_count;
	struct acpi_video_bus_cap cap;
L
Linus Torvalds 已提交
157
	struct acpi_video_bus_flags flags;
L
Len Brown 已提交
158
	struct list_head video_device_list;
159
	struct mutex device_list_lock;	/* protects video_device_list */
160 161
	struct input_dev *input;
	char phys[32];	/* for input device */
162
	struct notifier_block pm_nb;
L
Linus Torvalds 已提交
163 164 165
};

struct acpi_video_device_flags {
L
Len Brown 已提交
166 167 168
	u8 crt:1;
	u8 lcd:1;
	u8 tvout:1;
169
	u8 dvi:1;
L
Len Brown 已提交
170 171
	u8 bios:1;
	u8 unknown:1;
172 173
	u8 notify:1;
	u8 reserved:1;
L
Linus Torvalds 已提交
174 175 176
};

struct acpi_video_device_cap {
177 178 179
	u8 _ADR:1;		/* Return the unique ID */
	u8 _BCL:1;		/* Query list of brightness control levels supported */
	u8 _BCM:1;		/* Set the brightness level */
180
	u8 _BQC:1;		/* Get current brightness level */
181
	u8 _BCQ:1;		/* Some buggy BIOS uses _BCQ instead of _BQC */
182
	u8 _DDC:1;		/* Return the EDID for this device */
L
Linus Torvalds 已提交
183 184
};

185 186
struct acpi_video_brightness_flags {
	u8 _BCL_no_ac_battery_levels:1;	/* no AC/Battery levels in _BCL */
187
	u8 _BCL_reversed:1;		/* _BCL package is in a reversed order */
188 189 190
	u8 _BCL_use_index:1;		/* levels in _BCL are index values */
	u8 _BCM_use_index:1;		/* input of _BCM is an index value */
	u8 _BQC_use_index:1;		/* _BQC returns an index value */
191 192
};

L
Linus Torvalds 已提交
193
struct acpi_video_device_brightness {
L
Len Brown 已提交
194 195 196
	int curr;
	int count;
	int *levels;
197
	struct acpi_video_brightness_flags flags;
L
Linus Torvalds 已提交
198 199 200
};

struct acpi_video_device {
L
Len Brown 已提交
201 202 203 204 205 206
	unsigned long device_id;
	struct acpi_video_device_flags flags;
	struct acpi_video_device_cap cap;
	struct list_head entry;
	struct acpi_video_bus *video;
	struct acpi_device *dev;
L
Linus Torvalds 已提交
207
	struct acpi_video_device_brightness *brightness;
208
	struct backlight_device *backlight;
209
	struct thermal_cooling_device *cooling_dev;
L
Linus Torvalds 已提交
210 211
};

J
Jan Engelhardt 已提交
212
static const char device_decode[][30] = {
L
Linus Torvalds 已提交
213 214 215 216 217 218
	"motherboard VGA device",
	"PCI VGA device",
	"AGP VGA device",
	"UNKNOWN",
};

L
Len Brown 已提交
219 220 221 222
static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data);
static void acpi_video_device_rebind(struct acpi_video_bus *video);
static void acpi_video_device_bind(struct acpi_video_bus *video,
				   struct acpi_video_device *device);
L
Linus Torvalds 已提交
223
static int acpi_video_device_enumerate(struct acpi_video_bus *video);
224 225 226 227
static int acpi_video_device_lcd_set_level(struct acpi_video_device *device,
			int level);
static int acpi_video_device_lcd_get_level_current(
			struct acpi_video_device *device,
228
			unsigned long long *level, bool raw);
L
Len Brown 已提交
229 230
static int acpi_video_get_next_level(struct acpi_video_device *device,
				     u32 level_current, u32 event);
231
static int acpi_video_switch_brightness(struct acpi_video_device *device,
L
Len Brown 已提交
232
					 int event);
L
Linus Torvalds 已提交
233

234
/* backlight device sysfs support */
235 236
static int acpi_video_get_brightness(struct backlight_device *bd)
{
237
	unsigned long long cur_level;
238
	int i;
239
	struct acpi_video_device *vd = bl_get_data(bd);
240

241
	if (acpi_video_device_lcd_get_level_current(vd, &cur_level, false))
242
		return -EINVAL;
243 244
	for (i = 2; i < vd->brightness->count; i++) {
		if (vd->brightness->levels[i] == cur_level)
245 246 247 248
			/*
			 * The first two entries are special - see page 575
			 * of the ACPI spec 3.0
			 */
249
			return i - 2;
250 251
	}
	return 0;
252 253 254 255
}

static int acpi_video_set_brightness(struct backlight_device *bd)
{
256
	int request_level = bd->props.brightness + 2;
257
	struct acpi_video_device *vd = bl_get_data(bd);
258 259 260

	return acpi_video_device_lcd_set_level(vd,
				vd->brightness->levels[request_level]);
261 262
}

L
Lionel Debroux 已提交
263
static const struct backlight_ops acpi_backlight_ops = {
264 265 266 267
	.get_brightness = acpi_video_get_brightness,
	.update_status  = acpi_video_set_brightness,
};

268
/* thermal cooling device callbacks */
269
static int video_get_max_state(struct thermal_cooling_device *cooling_dev, unsigned
270
			       long *state)
271
{
272
	struct acpi_device *device = cooling_dev->devdata;
273 274
	struct acpi_video_device *video = acpi_driver_data(device);

275 276
	*state = video->brightness->count - 3;
	return 0;
277 278
}

279
static int video_get_cur_state(struct thermal_cooling_device *cooling_dev, unsigned
280
			       long *state)
281
{
282
	struct acpi_device *device = cooling_dev->devdata;
283
	struct acpi_video_device *video = acpi_driver_data(device);
284
	unsigned long long level;
285
	int offset;
286

287
	if (acpi_video_device_lcd_get_level_current(video, &level, false))
288
		return -EINVAL;
289 290 291 292 293
	for (offset = 2; offset < video->brightness->count; offset++)
		if (level == video->brightness->levels[offset]) {
			*state = video->brightness->count - offset - 1;
			return 0;
		}
294 295 296 297 298

	return -EINVAL;
}

static int
299
video_set_cur_state(struct thermal_cooling_device *cooling_dev, unsigned long state)
300
{
301
	struct acpi_device *device = cooling_dev->devdata;
302 303 304
	struct acpi_video_device *video = acpi_driver_data(device);
	int level;

305
	if (state >= video->brightness->count - 2)
306 307 308
		return -EINVAL;

	state = video->brightness->count - state;
309
	level = video->brightness->levels[state - 1];
310 311 312
	return acpi_video_device_lcd_set_level(video, level);
}

V
Vasiliy Kulikov 已提交
313
static const struct thermal_cooling_device_ops video_cooling_ops = {
314 315 316 317 318
	.get_max_state = video_get_max_state,
	.get_cur_state = video_get_cur_state,
	.set_cur_state = video_set_cur_state,
};

319 320 321 322 323
/*
 * --------------------------------------------------------------------------
 *                             Video Management
 * --------------------------------------------------------------------------
 */
L
Linus Torvalds 已提交
324 325

static int
L
Len Brown 已提交
326 327
acpi_video_device_lcd_query_levels(struct acpi_video_device *device,
				   union acpi_object **levels)
L
Linus Torvalds 已提交
328
{
L
Len Brown 已提交
329 330 331
	int status;
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
L
Linus Torvalds 已提交
332 333 334 335


	*levels = NULL;

336
	status = acpi_evaluate_object(device->dev->handle, "_BCL", NULL, &buffer);
L
Linus Torvalds 已提交
337
	if (!ACPI_SUCCESS(status))
338
		return status;
L
Len Brown 已提交
339
	obj = (union acpi_object *)buffer.pointer;
340
	if (!obj || (obj->type != ACPI_TYPE_PACKAGE)) {
341
		printk(KERN_ERR PREFIX "Invalid _BCL data\n");
L
Linus Torvalds 已提交
342 343 344 345 346 347
		status = -EFAULT;
		goto err;
	}

	*levels = obj;

348
	return 0;
L
Linus Torvalds 已提交
349

350
err:
351
	kfree(buffer.pointer);
L
Linus Torvalds 已提交
352

353
	return status;
L
Linus Torvalds 已提交
354 355 356
}

static int
L
Len Brown 已提交
357
acpi_video_device_lcd_set_level(struct acpi_video_device *device, int level)
L
Linus Torvalds 已提交
358
{
359
	int status;
L
Len Brown 已提交
360 361
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
362
	int state;
L
Linus Torvalds 已提交
363 364 365

	arg0.integer.value = level;

366 367 368 369 370 371 372
	status = acpi_evaluate_object(device->dev->handle, "_BCM",
				      &args, NULL);
	if (ACPI_FAILURE(status)) {
		ACPI_ERROR((AE_INFO, "Evaluating _BCM failed"));
		return -EIO;
	}

373
	device->brightness->curr = level;
374
	for (state = 2; state < device->brightness->count; state++)
375
		if (level == device->brightness->levels[state]) {
376 377
			if (device->backlight)
				device->backlight->props.brightness = state - 2;
378 379
			return 0;
		}
380

381 382
	ACPI_ERROR((AE_INFO, "Current brightness invalid"));
	return -EINVAL;
L
Linus Torvalds 已提交
383 384
}

385 386 387 388 389 390 391 392 393 394 395 396
/*
 * For some buggy _BQC methods, we need to add a constant value to
 * the _BQC return value to get the actual current brightness level
 */

static int bqc_offset_aml_bug_workaround;
static int __init video_set_bqc_offset(const struct dmi_system_id *d)
{
	bqc_offset_aml_bug_workaround = 9;
	return 0;
}

397 398 399 400 401 402
static int video_ignore_initial_backlight(const struct dmi_system_id *d)
{
	use_bios_initial_backlight = 0;
	return 0;
}

403 404 405 406 407 408 409 410 411 412 413 414
static struct dmi_system_id video_dmi_table[] __initdata = {
	/*
	 * Broken _BQC workaround http://bugzilla.kernel.org/show_bug.cgi?id=13121
	 */
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 5720",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5720"),
		},
	},
415 416 417 418 419 420 421 422
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 5710Z",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5710Z"),
		},
	},
423 424 425 426 427 428 429 430
	{
	 .callback = video_set_bqc_offset,
	 .ident = "eMachines E510",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "EMACHINES"),
		DMI_MATCH(DMI_PRODUCT_NAME, "eMachines E510"),
		},
	},
431 432 433 434 435 436 437 438
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 5315",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5315"),
		},
	},
439 440 441 442 443 444 445 446
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 7720",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 7720"),
		},
	},
447 448 449 450 451 452 453 454
	{
	 .callback = video_ignore_initial_backlight,
	 .ident = "HP Folio 13-2000",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
		DMI_MATCH(DMI_PRODUCT_NAME, "HP Folio 13 - 2000 Notebook PC"),
		},
	},
455 456 457 458 459 460 461 462
	{
	 .callback = video_ignore_initial_backlight,
	 .ident = "Fujitsu E753",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "FUJITSU"),
		DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK E753"),
		},
	},
463 464 465 466 467 468 469 470
	{
	 .callback = video_ignore_initial_backlight,
	 .ident = "HP Pavilion dm4",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
		DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion dm4 Notebook PC"),
		},
	},
471 472 473 474 475 476 477 478
	{
	 .callback = video_ignore_initial_backlight,
	 .ident = "HP Pavilion g6 Notebook PC",
	 .matches = {
		 DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
		 DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion g6 Notebook PC"),
		},
	},
479 480 481 482 483 484 485 486
	{
	 .callback = video_ignore_initial_backlight,
	 .ident = "HP 1000 Notebook PC",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
		DMI_MATCH(DMI_PRODUCT_NAME, "HP 1000 Notebook PC"),
		},
	},
487 488 489 490 491 492 493 494
	{
	 .callback = video_ignore_initial_backlight,
	 .ident = "HP Pavilion m4",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
		DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion m4 Notebook PC"),
		},
	},
495 496 497
	{}
};

498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522
static unsigned long long
acpi_video_bqc_value_to_level(struct acpi_video_device *device,
			      unsigned long long bqc_value)
{
	unsigned long long level;

	if (device->brightness->flags._BQC_use_index) {
		/*
		 * _BQC returns an index that doesn't account for
		 * the first 2 items with special meaning, so we need
		 * to compensate for that by offsetting ourselves
		 */
		if (device->brightness->flags._BCL_reversed)
			bqc_value = device->brightness->count - 3 - bqc_value;

		level = device->brightness->levels[bqc_value + 2];
	} else {
		level = bqc_value;
	}

	level += bqc_offset_aml_bug_workaround;

	return level;
}

L
Linus Torvalds 已提交
523
static int
L
Len Brown 已提交
524
acpi_video_device_lcd_get_level_current(struct acpi_video_device *device,
525
					unsigned long long *level, bool raw)
L
Linus Torvalds 已提交
526
{
527
	acpi_status status = AE_OK;
528
	int i;
529

530 531 532 533
	if (device->cap._BQC || device->cap._BCQ) {
		char *buf = device->cap._BQC ? "_BQC" : "_BCQ";

		status = acpi_evaluate_integer(device->dev->handle, buf,
534 535
						NULL, level);
		if (ACPI_SUCCESS(status)) {
536 537 538 539 540 541 542 543 544
			if (raw) {
				/*
				 * Caller has indicated he wants the raw
				 * value returned by _BQC, so don't furtherly
				 * mess with the value.
				 */
				return 0;
			}

545
			*level = acpi_video_bqc_value_to_level(device, *level);
546

547 548 549 550
			for (i = 2; i < device->brightness->count; i++)
				if (device->brightness->levels[i] == *level) {
					device->brightness->curr = *level;
					return 0;
551
				}
552 553 554 555 556 557 558 559
			/*
			 * BQC returned an invalid level.
			 * Stop using it.
			 */
			ACPI_WARNING((AE_INFO,
				      "%s returned an invalid level",
				      buf));
			device->cap._BQC = device->cap._BCQ = 0;
560
		} else {
561 562
			/*
			 * Fixme:
563 564 565 566 567 568
			 * should we return an error or ignore this failure?
			 * dev->brightness->curr is a cached value which stores
			 * the correct current backlight level in most cases.
			 * ACPI video backlight still works w/ buggy _BQC.
			 * http://bugzilla.kernel.org/show_bug.cgi?id=12233
			 */
569 570
			ACPI_WARNING((AE_INFO, "Evaluating %s failed", buf));
			device->cap._BQC = device->cap._BCQ = 0;
571 572 573
		}
	}

574
	*level = device->brightness->curr;
575
	return 0;
L
Linus Torvalds 已提交
576 577 578
}

static int
L
Len Brown 已提交
579 580
acpi_video_device_EDID(struct acpi_video_device *device,
		       union acpi_object **edid, ssize_t length)
L
Linus Torvalds 已提交
581
{
L
Len Brown 已提交
582 583 584 585 586
	int status;
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
L
Linus Torvalds 已提交
587 588 589 590 591


	*edid = NULL;

	if (!device)
592
		return -ENODEV;
L
Linus Torvalds 已提交
593 594 595 596 597
	if (length == 128)
		arg0.integer.value = 1;
	else if (length == 256)
		arg0.integer.value = 2;
	else
598
		return -EINVAL;
L
Linus Torvalds 已提交
599

600
	status = acpi_evaluate_object(device->dev->handle, "_DDC", &args, &buffer);
L
Linus Torvalds 已提交
601
	if (ACPI_FAILURE(status))
602
		return -ENODEV;
L
Linus Torvalds 已提交
603

604
	obj = buffer.pointer;
L
Linus Torvalds 已提交
605 606 607 608

	if (obj && obj->type == ACPI_TYPE_BUFFER)
		*edid = obj;
	else {
609
		printk(KERN_ERR PREFIX "Invalid _DDC data\n");
L
Linus Torvalds 已提交
610 611 612 613
		status = -EFAULT;
		kfree(obj);
	}

614
	return status;
L
Linus Torvalds 已提交
615 616 617 618 619 620
}

/* bus */

/*
 *  Arg:
621 622
 *	video		: video bus device pointer
 *	bios_flag	:
L
Linus Torvalds 已提交
623 624 625
 *		0.	The system BIOS should NOT automatically switch(toggle)
 *			the active display output.
 *		1.	The system BIOS should automatically switch (toggle) the
626
 *			active display output. No switch event.
L
Linus Torvalds 已提交
627 628 629 630 631 632
 *		2.	The _DGS value should be locked.
 *		3.	The system BIOS should not automatically switch (toggle) the
 *			active display output, but instead generate the display switch
 *			event notify code.
 *	lcd_flag	:
 *		0.	The system BIOS should automatically control the brightness level
633
 *			of the LCD when the power changes from AC to DC
634
 *		1.	The system BIOS should NOT automatically control the brightness
635
 *			level of the LCD when the power changes from AC to DC.
636
 *  Return Value:
637
 *		-EINVAL	wrong arg.
L
Linus Torvalds 已提交
638 639 640
 */

static int
L
Len Brown 已提交
641
acpi_video_bus_DOS(struct acpi_video_bus *video, int bios_flag, int lcd_flag)
L
Linus Torvalds 已提交
642
{
643
	acpi_status status;
L
Len Brown 已提交
644 645
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
L
Linus Torvalds 已提交
646

647 648
	if (!video->cap._DOS)
		return 0;
L
Linus Torvalds 已提交
649

650 651
	if (bios_flag < 0 || bios_flag > 3 || lcd_flag < 0 || lcd_flag > 1)
		return -EINVAL;
L
Linus Torvalds 已提交
652 653
	arg0.integer.value = (lcd_flag << 2) | bios_flag;
	video->dos_setting = arg0.integer.value;
654 655 656 657
	status = acpi_evaluate_object(video->device->handle, "_DOS",
		&args, NULL);
	if (ACPI_FAILURE(status))
		return -EIO;
L
Linus Torvalds 已提交
658

659
	return 0;
L
Linus Torvalds 已提交
660 661
}

662 663 664 665 666 667 668 669 670 671
/*
 * Simple comparison function used to sort backlight levels.
 */

static int
acpi_video_cmp_level(const void *a, const void *b)
{
	return *(int *)a - *(int *)b;
}

672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721
/*
 * Decides if _BQC/_BCQ for this system is usable
 *
 * We do this by changing the level first and then read out the current
 * brightness level, if the value does not match, find out if it is using
 * index. If not, clear the _BQC/_BCQ capability.
 */
static int acpi_video_bqc_quirk(struct acpi_video_device *device,
				int max_level, int current_level)
{
	struct acpi_video_device_brightness *br = device->brightness;
	int result;
	unsigned long long level;
	int test_level;

	/* don't mess with existing known broken systems */
	if (bqc_offset_aml_bug_workaround)
		return 0;

	/*
	 * Some systems always report current brightness level as maximum
	 * through _BQC, we need to test another value for them.
	 */
	test_level = current_level == max_level ? br->levels[2] : max_level;

	result = acpi_video_device_lcd_set_level(device, test_level);
	if (result)
		return result;

	result = acpi_video_device_lcd_get_level_current(device, &level, true);
	if (result)
		return result;

	if (level != test_level) {
		/* buggy _BQC found, need to find out if it uses index */
		if (level < br->count) {
			if (br->flags._BCL_reversed)
				level = br->count - 3 - level;
			if (br->levels[level + 2] == test_level)
				br->flags._BQC_use_index = 1;
		}

		if (!br->flags._BQC_use_index)
			device->cap._BQC = device->cap._BCQ = 0;
	}

	return 0;
}


L
Linus Torvalds 已提交
722
/*
723 724
 *  Arg:
 *	device	: video output device (LCD, CRT, ..)
L
Linus Torvalds 已提交
725 726
 *
 *  Return Value:
727 728 729 730 731 732 733 734 735
 *	Maximum brightness level
 *
 *  Allocate and initialize device->brightness.
 */

static int
acpi_video_init_brightness(struct acpi_video_device *device)
{
	union acpi_object *obj = NULL;
736
	int i, max_level = 0, count = 0, level_ac_battery = 0;
737
	unsigned long long level, level_old;
738 739
	union acpi_object *o;
	struct acpi_video_device_brightness *br = NULL;
740
	int result = -EINVAL;
741 742 743 744 745 746 747 748 749 750 751 752 753

	if (!ACPI_SUCCESS(acpi_video_device_lcd_query_levels(device, &obj))) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Could not query available "
						"LCD brightness level\n"));
		goto out;
	}

	if (obj->package.count < 2)
		goto out;

	br = kzalloc(sizeof(*br), GFP_KERNEL);
	if (!br) {
		printk(KERN_ERR "can't allocate memory\n");
754
		result = -ENOMEM;
755 756 757
		goto out;
	}

758
	br->levels = kmalloc((obj->package.count + 2) * sizeof *(br->levels),
759
				GFP_KERNEL);
760 761
	if (!br->levels) {
		result = -ENOMEM;
762
		goto out_free;
763
	}
764 765 766 767 768 769 770 771 772 773 774 775 776 777

	for (i = 0; i < obj->package.count; i++) {
		o = (union acpi_object *)&obj->package.elements[i];
		if (o->type != ACPI_TYPE_INTEGER) {
			printk(KERN_ERR PREFIX "Invalid data\n");
			continue;
		}
		br->levels[count] = (u32) o->integer.value;

		if (br->levels[count] > max_level)
			max_level = br->levels[count];
		count++;
	}

778 779 780 781 782 783
	/*
	 * some buggy BIOS don't export the levels
	 * when machine is on AC/Battery in _BCL package.
	 * In this case, the first two elements in _BCL packages
	 * are also supported brightness levels that OS should take care of.
	 */
784 785
	for (i = 2; i < count; i++) {
		if (br->levels[i] == br->levels[0])
786
			level_ac_battery++;
787 788 789
		if (br->levels[i] == br->levels[1])
			level_ac_battery++;
	}
790 791 792 793 794 795 796 797

	if (level_ac_battery < 2) {
		level_ac_battery = 2 - level_ac_battery;
		br->flags._BCL_no_ac_battery_levels = 1;
		for (i = (count - 1 + level_ac_battery); i >= 2; i--)
			br->levels[i] = br->levels[i - level_ac_battery];
		count += level_ac_battery;
	} else if (level_ac_battery > 2)
798
		ACPI_ERROR((AE_INFO, "Too many duplicates in _BCL package"));
799

800 801 802 803 804 805 806
	/* Check if the _BCL package is in a reversed order */
	if (max_level == br->levels[2]) {
		br->flags._BCL_reversed = 1;
		sort(&br->levels[2], count - 2, sizeof(br->levels[2]),
			acpi_video_cmp_level, NULL);
	} else if (max_level != br->levels[count - 1])
		ACPI_ERROR((AE_INFO,
807
			    "Found unordered _BCL package"));
808 809 810

	br->count = count;
	device->brightness = br;
811 812 813 814 815 816 817 818 819 820 821 822

	/* Check the input/output of _BQC/_BCL/_BCM */
	if ((max_level < 100) && (max_level <= (count - 2)))
		br->flags._BCL_use_index = 1;

	/*
	 * _BCM is always consistent with _BCL,
	 * at least for all the laptops we have ever seen.
	 */
	br->flags._BCM_use_index = br->flags._BCL_use_index;

	/* _BQC uses INDEX while _BCL uses VALUE in some laptops */
823
	br->curr = level = max_level;
824 825 826 827

	if (!device->cap._BQC)
		goto set_level;

828 829
	result = acpi_video_device_lcd_get_level_current(device,
							 &level_old, true);
830 831 832
	if (result)
		goto out_free_levels;

833
	result = acpi_video_bqc_quirk(device, max_level, level_old);
834 835
	if (result)
		goto out_free_levels;
836 837 838 839 840 841
	/*
	 * cap._BQC may get cleared due to _BQC is found to be broken
	 * in acpi_video_bqc_quirk, so check again here.
	 */
	if (!device->cap._BQC)
		goto set_level;
842

843 844
	if (use_bios_initial_backlight) {
		level = acpi_video_bqc_value_to_level(device, level_old);
845
		/*
846 847 848 849
		 * On some buggy laptops, _BQC returns an uninitialized
		 * value when invoked for the first time, i.e.
		 * level_old is invalid (no matter whether it's a level
		 * or an index). Set the backlight to max_level in this case.
850
		 */
851 852 853 854 855
		for (i = 2; i < br->count; i++)
			if (level_old == br->levels[i])
				break;
		if (i == br->count)
			level = max_level;
856
	}
857 858

set_level:
859
	result = acpi_video_device_lcd_set_level(device, level);
860 861
	if (result)
		goto out_free_levels;
862

863 864
	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
			  "found %d brightness levels\n", count - 2));
865
	kfree(obj);
866
	return result;
867 868 869 870 871 872 873 874

out_free_levels:
	kfree(br->levels);
out_free:
	kfree(br);
out:
	device->brightness = NULL;
	kfree(obj);
875
	return result;
876 877 878 879 880 881 882
}

/*
 *  Arg:
 *	device	: video output device (LCD, CRT, ..)
 *
 *  Return Value:
883
 *	None
L
Linus Torvalds 已提交
884
 *
885
 *  Find out all required AML methods defined under the output
L
Linus Torvalds 已提交
886 887 888
 *  device.
 */

L
Len Brown 已提交
889
static void acpi_video_device_find_cap(struct acpi_video_device *device)
L
Linus Torvalds 已提交
890 891 892
{
	acpi_handle h_dummy1;

893
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_ADR", &h_dummy1)))
L
Linus Torvalds 已提交
894
		device->cap._ADR = 1;
895
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCL", &h_dummy1)))
L
Len Brown 已提交
896
		device->cap._BCL = 1;
897
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCM", &h_dummy1)))
L
Len Brown 已提交
898
		device->cap._BCM = 1;
899
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BQC", &h_dummy1)))
900
		device->cap._BQC = 1;
901 902 903 904 905 906
	else if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCQ",
				&h_dummy1))) {
		printk(KERN_WARNING FW_BUG "_BCQ is used instead of _BQC\n");
		device->cap._BCQ = 1;
	}

907
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DDC", &h_dummy1)))
L
Len Brown 已提交
908
		device->cap._DDC = 1;
L
Linus Torvalds 已提交
909

910 911 912
	if (acpi_video_init_brightness(device))
		return;

913
	if (acpi_video_backlight_support()) {
914
		struct backlight_properties props;
915 916 917
		struct pci_dev *pdev;
		acpi_handle acpi_parent;
		struct device *parent = NULL;
918
		int result;
919
		static int count;
920
		char *name;
921

J
Julia Lawall 已提交
922
		name = kasprintf(GFP_KERNEL, "acpi_video%d", count);
923 924
		if (!name)
			return;
J
Julia Lawall 已提交
925
		count++;
926

927 928 929 930 931 932 933 934
		acpi_get_parent(device->dev->handle, &acpi_parent);

		pdev = acpi_get_pci_dev(acpi_parent);
		if (pdev) {
			parent = &pdev->dev;
			pci_dev_put(pdev);
		}

935
		memset(&props, 0, sizeof(struct backlight_properties));
M
Matthew Garrett 已提交
936
		props.type = BACKLIGHT_FIRMWARE;
937
		props.max_brightness = device->brightness->count - 3;
938 939 940
		device->backlight = backlight_device_register(name,
							      parent,
							      device,
941 942
							      &acpi_backlight_ops,
							      &props);
943
		kfree(name);
944 945
		if (IS_ERR(device->backlight))
			return;
946

947 948 949 950 951 952
		/*
		 * Save current brightness level in case we have to restore it
		 * before acpi_video_device_lcd_set_level() is called next time.
		 */
		device->backlight->props.brightness =
				acpi_video_get_brightness(device->backlight);
953

954
		device->cooling_dev = thermal_cooling_device_register("LCD",
955
					device->dev, &video_cooling_ops);
956
		if (IS_ERR(device->cooling_dev)) {
957
			/*
958
			 * Set cooling_dev to NULL so we don't crash trying to
959 960 961 962 963 964
			 * free it.
			 * Also, why the hell we are returning early and
			 * not attempt to register video output if cooling
			 * device registration failed?
			 * -- dtor
			 */
965
			device->cooling_dev = NULL;
966
			return;
967
		}
968

969
		dev_info(&device->dev->dev, "registered as cooling_device%d\n",
970
			 device->cooling_dev->id);
971
		result = sysfs_create_link(&device->dev->dev.kobj,
972
				&device->cooling_dev->device.kobj,
973 974 975
				"thermal_cooling");
		if (result)
			printk(KERN_ERR PREFIX "Create sysfs link\n");
976
		result = sysfs_create_link(&device->cooling_dev->device.kobj,
977 978 979 980
				&device->dev->dev.kobj, "device");
		if (result)
			printk(KERN_ERR PREFIX "Create sysfs link\n");

981 982 983 984 985
	} else {
		/* Remove the brightness object. */
		kfree(device->brightness->levels);
		kfree(device->brightness);
		device->brightness = NULL;
986
	}
L
Linus Torvalds 已提交
987 988 989
}

/*
990 991
 *  Arg:
 *	device	: video output device (VGA)
L
Linus Torvalds 已提交
992 993
 *
 *  Return Value:
994
 *	None
L
Linus Torvalds 已提交
995
 *
996
 *  Find out all required AML methods defined under the video bus device.
L
Linus Torvalds 已提交
997 998
 */

L
Len Brown 已提交
999
static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1000
{
L
Len Brown 已提交
1001
	acpi_handle h_dummy1;
L
Linus Torvalds 已提交
1002

1003
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOS", &h_dummy1)))
L
Linus Torvalds 已提交
1004
		video->cap._DOS = 1;
1005
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOD", &h_dummy1)))
L
Linus Torvalds 已提交
1006
		video->cap._DOD = 1;
1007
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_ROM", &h_dummy1)))
L
Linus Torvalds 已提交
1008
		video->cap._ROM = 1;
1009
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_GPD", &h_dummy1)))
L
Linus Torvalds 已提交
1010
		video->cap._GPD = 1;
1011
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_SPD", &h_dummy1)))
L
Linus Torvalds 已提交
1012
		video->cap._SPD = 1;
1013
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_VPO", &h_dummy1)))
L
Linus Torvalds 已提交
1014 1015 1016 1017 1018 1019 1020 1021
		video->cap._VPO = 1;
}

/*
 * Check whether the video bus device has required AML method to
 * support the desired features
 */

L
Len Brown 已提交
1022
static int acpi_video_bus_check(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1023
{
L
Len Brown 已提交
1024
	acpi_status status = -ENOENT;
1025
	struct pci_dev *dev;
L
Linus Torvalds 已提交
1026 1027

	if (!video)
1028
		return -EINVAL;
L
Linus Torvalds 已提交
1029

1030
	dev = acpi_get_pci_dev(video->device->handle);
1031 1032
	if (!dev)
		return -ENODEV;
1033
	pci_dev_put(dev);
1034

1035 1036
	/*
	 * Since there is no HID, CID and so on for VGA driver, we have
L
Linus Torvalds 已提交
1037 1038 1039
	 * to check well known required nodes.
	 */

1040
	/* Does this device support video switching? */
1041 1042 1043 1044 1045 1046
	if (video->cap._DOS || video->cap._DOD) {
		if (!video->cap._DOS) {
			printk(KERN_WARNING FW_BUG
				"ACPI(%s) defines _DOD but not _DOS\n",
				acpi_device_bid(video->device));
		}
L
Linus Torvalds 已提交
1047 1048 1049 1050
		video->flags.multihead = 1;
		status = 0;
	}

1051
	/* Does this device support retrieving a video ROM? */
L
Len Brown 已提交
1052
	if (video->cap._ROM) {
L
Linus Torvalds 已提交
1053 1054 1055 1056
		video->flags.rom = 1;
		status = 0;
	}

1057
	/* Does this device support configuring which video device to POST? */
L
Len Brown 已提交
1058
	if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
L
Linus Torvalds 已提交
1059 1060 1061 1062
		video->flags.post = 1;
		status = 0;
	}

1063
	return status;
L
Linus Torvalds 已提交
1064 1065
}

1066 1067 1068 1069 1070
/*
 * --------------------------------------------------------------------------
 *                               Driver Interface
 * --------------------------------------------------------------------------
 */
L
Linus Torvalds 已提交
1071 1072

/* device interface */
1073
static struct acpi_video_device_attrib *
1074 1075
acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
{
1076 1077 1078 1079 1080 1081 1082 1083
	struct acpi_video_enumerated_device *ids;
	int i;

	for (i = 0; i < video->attached_count; i++) {
		ids = &video->attached_array[i];
		if ((ids->value.int_val & 0xffff) == device_id)
			return &ids->value.attrib;
	}
1084 1085 1086

	return NULL;
}
L
Linus Torvalds 已提交
1087

1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103
static int
acpi_video_get_device_type(struct acpi_video_bus *video,
			   unsigned long device_id)
{
	struct acpi_video_enumerated_device *ids;
	int i;

	for (i = 0; i < video->attached_count; i++) {
		ids = &video->attached_array[i];
		if ((ids->value.int_val & 0xffff) == device_id)
			return ids->value.int_val;
	}

	return 0;
}

L
Linus Torvalds 已提交
1104
static int
L
Len Brown 已提交
1105 1106
acpi_video_bus_get_one_device(struct acpi_device *device,
			      struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1107
{
1108
	unsigned long long device_id;
1109
	int status, device_type;
L
Len Brown 已提交
1110
	struct acpi_video_device *data;
1111
	struct acpi_video_device_attrib *attribute;
L
Linus Torvalds 已提交
1112

L
Len Brown 已提交
1113 1114
	status =
	    acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
1115 1116 1117
	/* Some device omits _ADR, we skip them instead of fail */
	if (ACPI_FAILURE(status))
		return 0;
L
Linus Torvalds 已提交
1118

1119 1120 1121
	data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
	if (!data)
		return -ENOMEM;
1122

1123 1124 1125 1126 1127 1128 1129 1130 1131 1132
	strcpy(acpi_device_name(device), ACPI_VIDEO_DEVICE_NAME);
	strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
	device->driver_data = data;

	data->device_id = device_id;
	data->video = video;
	data->dev = device;

	attribute = acpi_video_get_device_attr(video, device_id);

1133
	if (attribute && attribute->device_id_scheme) {
1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150
		switch (attribute->display_type) {
		case ACPI_VIDEO_DISPLAY_CRT:
			data->flags.crt = 1;
			break;
		case ACPI_VIDEO_DISPLAY_TV:
			data->flags.tvout = 1;
			break;
		case ACPI_VIDEO_DISPLAY_DVI:
			data->flags.dvi = 1;
			break;
		case ACPI_VIDEO_DISPLAY_LCD:
			data->flags.lcd = 1;
			break;
		default:
			data->flags.unknown = 1;
			break;
		}
1151
		if (attribute->bios_can_detect)
1152 1153 1154 1155 1156 1157
			data->flags.bios = 1;
	} else {
		/* Check for legacy IDs */
		device_type = acpi_video_get_device_type(video, device_id);
		/* Ignore bits 16 and 18-20 */
		switch (device_type & 0xffe2ffff) {
1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168
		case ACPI_VIDEO_DISPLAY_LEGACY_MONITOR:
			data->flags.crt = 1;
			break;
		case ACPI_VIDEO_DISPLAY_LEGACY_PANEL:
			data->flags.lcd = 1;
			break;
		case ACPI_VIDEO_DISPLAY_LEGACY_TV:
			data->flags.tvout = 1;
			break;
		default:
			data->flags.unknown = 1;
1169
		}
1170
	}
L
Len Brown 已提交
1171

1172 1173
	acpi_video_device_bind(video, data);
	acpi_video_device_find_cap(data);
L
Linus Torvalds 已提交
1174

1175 1176 1177 1178 1179 1180
	status = acpi_install_notify_handler(device->handle, ACPI_DEVICE_NOTIFY,
					     acpi_video_device_notify, data);
	if (ACPI_FAILURE(status))
		dev_err(&device->dev, "Error installing notify handler\n");
	else
		data->flags.notify = 1;
L
Linus Torvalds 已提交
1181

1182 1183 1184
	mutex_lock(&video->device_list_lock);
	list_add_tail(&data->entry, &video->video_device_list);
	mutex_unlock(&video->device_list_lock);
L
Linus Torvalds 已提交
1185

1186
	return status;
L
Linus Torvalds 已提交
1187 1188 1189 1190
}

/*
 *  Arg:
1191
 *	video	: video bus device
L
Linus Torvalds 已提交
1192 1193
 *
 *  Return:
1194 1195 1196
 *	none
 *
 *  Enumerate the video device list of the video bus,
L
Linus Torvalds 已提交
1197 1198
 *  bind the ids with the corresponding video devices
 *  under the video bus.
L
Len Brown 已提交
1199
 */
L
Linus Torvalds 已提交
1200

L
Len Brown 已提交
1201
static void acpi_video_device_rebind(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1202
{
1203 1204
	struct acpi_video_device *dev;

1205
	mutex_lock(&video->device_list_lock);
1206 1207

	list_for_each_entry(dev, &video->video_device_list, entry)
L
Len Brown 已提交
1208
		acpi_video_device_bind(video, dev);
1209

1210
	mutex_unlock(&video->device_list_lock);
L
Linus Torvalds 已提交
1211 1212 1213 1214
}

/*
 *  Arg:
1215 1216 1217
 *	video	: video bus device
 *	device	: video output device under the video
 *		bus
L
Linus Torvalds 已提交
1218 1219
 *
 *  Return:
1220 1221
 *	none
 *
L
Linus Torvalds 已提交
1222 1223
 *  Bind the ids with the corresponding video devices
 *  under the video bus.
L
Len Brown 已提交
1224
 */
L
Linus Torvalds 已提交
1225 1226

static void
L
Len Brown 已提交
1227 1228
acpi_video_device_bind(struct acpi_video_bus *video,
		       struct acpi_video_device *device)
L
Linus Torvalds 已提交
1229
{
1230
	struct acpi_video_enumerated_device *ids;
L
Len Brown 已提交
1231
	int i;
L
Linus Torvalds 已提交
1232

1233 1234 1235 1236
	for (i = 0; i < video->attached_count; i++) {
		ids = &video->attached_array[i];
		if (device->device_id == (ids->value.int_val & 0xffff)) {
			ids->bind_info = device;
L
Linus Torvalds 已提交
1237 1238 1239 1240 1241 1242 1243
			ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
		}
	}
}

/*
 *  Arg:
1244
 *	video	: video bus device
L
Linus Torvalds 已提交
1245 1246
 *
 *  Return:
1247 1248
 *	< 0	: error
 *
L
Linus Torvalds 已提交
1249 1250
 *  Call _DOD to enumerate all devices attached to display adapter
 *
L
Len Brown 已提交
1251
 */
L
Linus Torvalds 已提交
1252 1253 1254

static int acpi_video_device_enumerate(struct acpi_video_bus *video)
{
L
Len Brown 已提交
1255 1256 1257
	int status;
	int count;
	int i;
1258
	struct acpi_video_enumerated_device *active_list;
L
Len Brown 已提交
1259 1260 1261
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *dod = NULL;
	union acpi_object *obj;
L
Linus Torvalds 已提交
1262

1263
	status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
L
Linus Torvalds 已提交
1264
	if (!ACPI_SUCCESS(status)) {
1265
		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1266
		return status;
L
Linus Torvalds 已提交
1267 1268
	}

1269
	dod = buffer.pointer;
L
Linus Torvalds 已提交
1270
	if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1271
		ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
L
Linus Torvalds 已提交
1272 1273 1274 1275 1276
		status = -EFAULT;
		goto out;
	}

	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d video heads in _DOD\n",
L
Len Brown 已提交
1277
			  dod->package.count));
L
Linus Torvalds 已提交
1278

1279 1280 1281 1282
	active_list = kcalloc(1 + dod->package.count,
			      sizeof(struct acpi_video_enumerated_device),
			      GFP_KERNEL);
	if (!active_list) {
L
Linus Torvalds 已提交
1283 1284 1285 1286 1287 1288
		status = -ENOMEM;
		goto out;
	}

	count = 0;
	for (i = 0; i < dod->package.count; i++) {
1289
		obj = &dod->package.elements[i];
L
Linus Torvalds 已提交
1290 1291

		if (obj->type != ACPI_TYPE_INTEGER) {
1292 1293 1294
			printk(KERN_ERR PREFIX
				"Invalid _DOD data in element %d\n", i);
			continue;
L
Linus Torvalds 已提交
1295
		}
1296 1297 1298

		active_list[count].value.int_val = obj->integer.value;
		active_list[count].bind_info = NULL;
L
Len Brown 已提交
1299 1300
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
				  (int)obj->integer.value));
L
Linus Torvalds 已提交
1301 1302 1303
		count++;
	}

1304
	kfree(video->attached_array);
L
Len Brown 已提交
1305

1306
	video->attached_array = active_list;
L
Linus Torvalds 已提交
1307
	video->attached_count = count;
1308

1309
out:
1310
	kfree(buffer.pointer);
1311
	return status;
L
Linus Torvalds 已提交
1312 1313
}

L
Len Brown 已提交
1314 1315 1316
static int
acpi_video_get_next_level(struct acpi_video_device *device,
			  u32 level_current, u32 event)
L
Linus Torvalds 已提交
1317
{
1318
	int min, max, min_above, max_below, i, l, delta = 255;
1319 1320
	max = max_below = 0;
	min = min_above = 255;
1321
	/* Find closest level to level_current */
1322
	for (i = 2; i < device->brightness->count; i++) {
1323 1324 1325 1326 1327 1328 1329 1330 1331
		l = device->brightness->levels[i];
		if (abs(l - level_current) < abs(delta)) {
			delta = l - level_current;
			if (!delta)
				break;
		}
	}
	/* Ajust level_current to closest available level */
	level_current += delta;
1332
	for (i = 2; i < device->brightness->count; i++) {
1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356
		l = device->brightness->levels[i];
		if (l < min)
			min = l;
		if (l > max)
			max = l;
		if (l < min_above && l > level_current)
			min_above = l;
		if (l > max_below && l < level_current)
			max_below = l;
	}

	switch (event) {
	case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:
		return (level_current < max) ? min_above : min;
	case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:
		return (level_current < max) ? min_above : max;
	case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:
		return (level_current > min) ? max_below : min;
	case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:
	case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:
		return 0;
	default:
		return level_current;
	}
L
Linus Torvalds 已提交
1357 1358
}

1359
static int
L
Len Brown 已提交
1360
acpi_video_switch_brightness(struct acpi_video_device *device, int event)
L
Linus Torvalds 已提交
1361
{
1362
	unsigned long long level_current, level_next;
1363 1364
	int result = -EINVAL;

1365 1366
	/* no warning message if acpi_backlight=vendor is used */
	if (!acpi_video_backlight_support())
1367 1368
		return 0;

1369
	if (!device->brightness)
1370 1371 1372
		goto out;

	result = acpi_video_device_lcd_get_level_current(device,
1373 1374
							 &level_current,
							 false);
1375 1376 1377
	if (result)
		goto out;

L
Linus Torvalds 已提交
1378
	level_next = acpi_video_get_next_level(device, level_current, event);
1379

1380
	result = acpi_video_device_lcd_set_level(device, level_next);
1381

1382 1383 1384 1385
	if (!result)
		backlight_force_update(device->backlight,
				       BACKLIGHT_UPDATE_HOTKEY);

1386 1387 1388 1389 1390
out:
	if (result)
		printk(KERN_ERR PREFIX "Failed to switch the brightness\n");

	return result;
L
Linus Torvalds 已提交
1391 1392
}

1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413
int acpi_video_get_edid(struct acpi_device *device, int type, int device_id,
			void **edid)
{
	struct acpi_video_bus *video;
	struct acpi_video_device *video_device;
	union acpi_object *buffer = NULL;
	acpi_status status;
	int i, length;

	if (!device || !acpi_driver_data(device))
		return -EINVAL;

	video = acpi_driver_data(device);

	for (i = 0; i < video->attached_count; i++) {
		video_device = video->attached_array[i].bind_info;
		length = 256;

		if (!video_device)
			continue;

1414 1415 1416
		if (!video_device->cap._DDC)
			continue;

1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460
		if (type) {
			switch (type) {
			case ACPI_VIDEO_DISPLAY_CRT:
				if (!video_device->flags.crt)
					continue;
				break;
			case ACPI_VIDEO_DISPLAY_TV:
				if (!video_device->flags.tvout)
					continue;
				break;
			case ACPI_VIDEO_DISPLAY_DVI:
				if (!video_device->flags.dvi)
					continue;
				break;
			case ACPI_VIDEO_DISPLAY_LCD:
				if (!video_device->flags.lcd)
					continue;
				break;
			}
		} else if (video_device->device_id != device_id) {
			continue;
		}

		status = acpi_video_device_EDID(video_device, &buffer, length);

		if (ACPI_FAILURE(status) || !buffer ||
		    buffer->type != ACPI_TYPE_BUFFER) {
			length = 128;
			status = acpi_video_device_EDID(video_device, &buffer,
							length);
			if (ACPI_FAILURE(status) || !buffer ||
			    buffer->type != ACPI_TYPE_BUFFER) {
				continue;
			}
		}

		*edid = buffer->buffer.pointer;
		return length;
	}

	return -ENODEV;
}
EXPORT_SYMBOL(acpi_video_get_edid);

L
Linus Torvalds 已提交
1461
static int
L
Len Brown 已提交
1462 1463
acpi_video_bus_get_devices(struct acpi_video_bus *video,
			   struct acpi_device *device)
L
Linus Torvalds 已提交
1464
{
1465
	int status = 0;
1466
	struct acpi_device *dev;
L
Linus Torvalds 已提交
1467

1468 1469 1470 1471 1472 1473
	/*
	 * There are systems where video module known to work fine regardless
	 * of broken _DOD and ignoring returned value here doesn't cause
	 * any issues later.
	 */
	acpi_video_device_enumerate(video);
L
Linus Torvalds 已提交
1474

1475
	list_for_each_entry(dev, &device->children, node) {
L
Linus Torvalds 已提交
1476 1477

		status = acpi_video_bus_get_one_device(dev, video);
1478
		if (status) {
1479 1480
			dev_err(&dev->dev, "Can't attach device\n");
			break;
L
Linus Torvalds 已提交
1481 1482
		}
	}
1483
	return status;
L
Linus Torvalds 已提交
1484 1485
}

L
Len Brown 已提交
1486
static int acpi_video_bus_put_one_device(struct acpi_video_device *device)
L
Linus Torvalds 已提交
1487
{
1488
	acpi_status status;
L
Linus Torvalds 已提交
1489 1490

	if (!device || !device->video)
1491
		return -ENOENT;
L
Linus Torvalds 已提交
1492

1493 1494 1495 1496 1497 1498
	if (device->flags.notify) {
		status = acpi_remove_notify_handler(device->dev->handle,
				ACPI_DEVICE_NOTIFY, acpi_video_device_notify);
		if (ACPI_FAILURE(status))
			dev_err(&device->dev->dev,
					"Can't remove video notify handler\n");
1499
	}
1500

1501 1502 1503 1504
	if (device->backlight) {
		backlight_device_unregister(device->backlight);
		device->backlight = NULL;
	}
1505
	if (device->cooling_dev) {
1506 1507
		sysfs_remove_link(&device->dev->dev.kobj,
				  "thermal_cooling");
1508
		sysfs_remove_link(&device->cooling_dev->device.kobj,
1509
				  "device");
1510 1511
		thermal_cooling_device_unregister(device->cooling_dev);
		device->cooling_dev = NULL;
1512
	}
1513

1514
	return 0;
L
Linus Torvalds 已提交
1515 1516
}

L
Len Brown 已提交
1517
static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1518
{
L
Len Brown 已提交
1519
	int status;
1520
	struct acpi_video_device *dev, *next;
L
Linus Torvalds 已提交
1521

1522
	mutex_lock(&video->device_list_lock);
L
Linus Torvalds 已提交
1523

1524
	list_for_each_entry_safe(dev, next, &video->video_device_list, entry) {
L
Linus Torvalds 已提交
1525

1526
		status = acpi_video_bus_put_one_device(dev);
L
Len Brown 已提交
1527 1528 1529
		if (ACPI_FAILURE(status))
			printk(KERN_WARNING PREFIX
			       "hhuuhhuu bug in acpi video driver.\n");
L
Linus Torvalds 已提交
1530

1531 1532 1533 1534 1535 1536
		if (dev->brightness) {
			kfree(dev->brightness->levels);
			kfree(dev->brightness);
		}
		list_del(&dev->entry);
		kfree(dev);
L
Linus Torvalds 已提交
1537 1538
	}

1539
	mutex_unlock(&video->device_list_lock);
1540

1541
	return 0;
L
Linus Torvalds 已提交
1542 1543 1544 1545
}

/* acpi_video interface */

1546 1547 1548 1549
/*
 * Win8 requires setting bit2 of _DOS to let firmware know it shouldn't
 * preform any automatic brightness change on receiving a notification.
 */
L
Len Brown 已提交
1550
static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1551
{
1552 1553
	return acpi_video_bus_DOS(video, 0,
				  acpi_video_backlight_quirks() ? 1 : 0);
L
Linus Torvalds 已提交
1554 1555
}

L
Len Brown 已提交
1556
static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1557
{
1558 1559
	return acpi_video_bus_DOS(video, 0,
				  acpi_video_backlight_quirks() ? 0 : 1);
L
Linus Torvalds 已提交
1560 1561
}

1562
static void acpi_video_bus_notify(struct acpi_device *device, u32 event)
L
Linus Torvalds 已提交
1563
{
1564
	struct acpi_video_bus *video = acpi_driver_data(device);
1565
	struct input_dev *input;
1566
	int keycode = 0;
1567

L
Linus Torvalds 已提交
1568
	if (!video)
1569
		return;
L
Linus Torvalds 已提交
1570

1571
	input = video->input;
L
Linus Torvalds 已提交
1572 1573

	switch (event) {
1574
	case ACPI_VIDEO_NOTIFY_SWITCH:	/* User requested a switch,
L
Linus Torvalds 已提交
1575
					 * most likely via hotkey. */
1576
		acpi_bus_generate_proc_event(device, event, 0);
1577
		keycode = KEY_SWITCHVIDEOMODE;
L
Linus Torvalds 已提交
1578 1579
		break;

1580
	case ACPI_VIDEO_NOTIFY_PROBE:	/* User plugged in or removed a video
L
Linus Torvalds 已提交
1581 1582 1583
					 * connector. */
		acpi_video_device_enumerate(video);
		acpi_video_device_rebind(video);
1584
		acpi_bus_generate_proc_event(device, event, 0);
1585
		keycode = KEY_SWITCHVIDEOMODE;
L
Linus Torvalds 已提交
1586 1587
		break;

L
Len Brown 已提交
1588
	case ACPI_VIDEO_NOTIFY_CYCLE:	/* Cycle Display output hotkey pressed. */
L
Len Brown 已提交
1589
		acpi_bus_generate_proc_event(device, event, 0);
1590 1591
		keycode = KEY_SWITCHVIDEOMODE;
		break;
L
Len Brown 已提交
1592
	case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:	/* Next Display output hotkey pressed. */
L
Len Brown 已提交
1593
		acpi_bus_generate_proc_event(device, event, 0);
1594 1595
		keycode = KEY_VIDEO_NEXT;
		break;
L
Len Brown 已提交
1596
	case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:	/* previous Display output hotkey pressed. */
1597
		acpi_bus_generate_proc_event(device, event, 0);
1598
		keycode = KEY_VIDEO_PREV;
L
Linus Torvalds 已提交
1599 1600 1601 1602
		break;

	default:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
1603
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
1604 1605 1606
		break;
	}

1607 1608 1609
	if (acpi_notifier_call_chain(device, event, 0))
		/* Something vetoed the keypress. */
		keycode = 0;
1610 1611 1612 1613 1614 1615 1616

	if (keycode) {
		input_report_key(input, keycode, 1);
		input_sync(input);
		input_report_key(input, keycode, 0);
		input_sync(input);
	}
1617

1618
	return;
L
Linus Torvalds 已提交
1619 1620
}

L
Len Brown 已提交
1621
static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
L
Linus Torvalds 已提交
1622
{
1623
	struct acpi_video_device *video_device = data;
L
Len Brown 已提交
1624
	struct acpi_device *device = NULL;
1625 1626
	struct acpi_video_bus *bus;
	struct input_dev *input;
1627
	int keycode = 0;
L
Linus Torvalds 已提交
1628 1629

	if (!video_device)
1630
		return;
L
Linus Torvalds 已提交
1631

1632
	device = video_device->dev;
1633 1634
	bus = video_device->video;
	input = bus->input;
L
Linus Torvalds 已提交
1635 1636

	switch (event) {
L
Len Brown 已提交
1637
	case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:	/* Cycle brightness */
1638 1639
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
1640
		acpi_bus_generate_proc_event(device, event, 0);
1641 1642
		keycode = KEY_BRIGHTNESS_CYCLE;
		break;
L
Len Brown 已提交
1643
	case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:	/* Increase brightness */
1644 1645
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
L
Len Brown 已提交
1646
		acpi_bus_generate_proc_event(device, event, 0);
1647 1648
		keycode = KEY_BRIGHTNESSUP;
		break;
L
Len Brown 已提交
1649
	case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:	/* Decrease brightness */
1650 1651
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
L
Len Brown 已提交
1652
		acpi_bus_generate_proc_event(device, event, 0);
1653 1654
		keycode = KEY_BRIGHTNESSDOWN;
		break;
1655
	case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:	/* zero brightness */
1656 1657
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
L
Len Brown 已提交
1658
		acpi_bus_generate_proc_event(device, event, 0);
1659 1660
		keycode = KEY_BRIGHTNESS_ZERO;
		break;
L
Len Brown 已提交
1661
	case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:	/* display device off */
1662 1663
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
1664
		acpi_bus_generate_proc_event(device, event, 0);
1665
		keycode = KEY_DISPLAY_OFF;
L
Linus Torvalds 已提交
1666 1667 1668
		break;
	default:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
1669
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
1670 1671
		break;
	}
1672

1673
	acpi_notifier_call_chain(device, event, 0);
1674 1675 1676 1677 1678 1679 1680

	if (keycode) {
		input_report_key(input, keycode, 1);
		input_sync(input);
		input_report_key(input, keycode, 0);
		input_sync(input);
	}
1681

1682
	return;
L
Linus Torvalds 已提交
1683 1684
}

1685 1686
static int acpi_video_resume(struct notifier_block *nb,
				unsigned long val, void *ign)
1687 1688 1689 1690 1691
{
	struct acpi_video_bus *video;
	struct acpi_video_device *video_device;
	int i;

1692 1693 1694 1695 1696 1697
	switch (val) {
	case PM_HIBERNATION_PREPARE:
	case PM_SUSPEND_PREPARE:
	case PM_RESTORE_PREPARE:
		return NOTIFY_DONE;
	}
1698

1699 1700 1701
	video = container_of(nb, struct acpi_video_bus, pm_nb);

	dev_info(&video->device->dev, "Restoring backlight state\n");
1702 1703 1704 1705 1706 1707

	for (i = 0; i < video->attached_count; i++) {
		video_device = video->attached_array[i].bind_info;
		if (video_device && video_device->backlight)
			acpi_video_set_brightness(video_device->backlight);
	}
1708 1709

	return NOTIFY_OK;
1710 1711
}

1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732
static acpi_status
acpi_video_bus_match(acpi_handle handle, u32 level, void *context,
			void **return_value)
{
	struct acpi_device *device = context;
	struct acpi_device *sibling;
	int result;

	if (handle == device->handle)
		return AE_CTRL_TERMINATE;

	result = acpi_bus_get_device(handle, &sibling);
	if (result)
		return AE_OK;

	if (!strcmp(acpi_device_name(sibling), ACPI_VIDEO_BUS_NAME))
			return AE_ALREADY_EXISTS;

	return AE_OK;
}

1733 1734
static int instance;

L
Len Brown 已提交
1735
static int acpi_video_bus_add(struct acpi_device *device)
L
Linus Torvalds 已提交
1736
{
1737
	struct acpi_video_bus *video;
1738
	struct input_dev *input;
1739
	int error;
1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754
	acpi_status status;

	status = acpi_walk_namespace(ACPI_TYPE_DEVICE,
				device->parent->handle, 1,
				acpi_video_bus_match, NULL,
				device, NULL);
	if (status == AE_ALREADY_EXISTS) {
		printk(KERN_WARNING FW_BUG
			"Duplicate ACPI video bus devices for the"
			" same VGA controller, please try module "
			"parameter \"video.allow_duplicates=1\""
			"if the current driver doesn't work.\n");
		if (!allow_duplicates)
			return -ENODEV;
	}
L
Linus Torvalds 已提交
1755

1756
	video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
L
Linus Torvalds 已提交
1757
	if (!video)
1758
		return -ENOMEM;
L
Linus Torvalds 已提交
1759

1760 1761 1762 1763
	/* a hack to fix the duplicate name "VID" problem on T61 */
	if (!strcmp(device->pnp.bus_id, "VID")) {
		if (instance)
			device->pnp.bus_id[3] = '0' + instance;
1764
		instance++;
1765
	}
1766 1767 1768 1769 1770 1771
	/* a hack to fix the duplicate name "VGA" problem on Pa 3553 */
	if (!strcmp(device->pnp.bus_id, "VGA")) {
		if (instance)
			device->pnp.bus_id[3] = '0' + instance;
		instance++;
	}
1772

1773
	video->device = device;
L
Linus Torvalds 已提交
1774 1775
	strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
	strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1776
	device->driver_data = video;
L
Linus Torvalds 已提交
1777 1778

	acpi_video_bus_find_cap(video);
1779 1780 1781
	error = acpi_video_bus_check(video);
	if (error)
		goto err_free_video;
L
Linus Torvalds 已提交
1782

1783
	mutex_init(&video->device_list_lock);
L
Linus Torvalds 已提交
1784 1785
	INIT_LIST_HEAD(&video->video_device_list);

1786 1787
	error = acpi_video_bus_get_devices(video, device);
	if (error)
1788
		goto err_put_video;
L
Linus Torvalds 已提交
1789

1790
	video->input = input = input_allocate_device();
1791 1792
	if (!input) {
		error = -ENOMEM;
1793
		goto err_put_video;
1794
	}
1795

1796 1797 1798 1799
	error = acpi_video_bus_start_devices(video);
	if (error)
		goto err_free_input_dev;

1800 1801 1802 1803 1804 1805 1806
	snprintf(video->phys, sizeof(video->phys),
		"%s/video/input0", acpi_device_hid(video->device));

	input->name = acpi_device_name(video->device);
	input->phys = video->phys;
	input->id.bustype = BUS_HOST;
	input->id.product = 0x06;
1807
	input->dev.parent = &device->dev;
1808 1809 1810 1811 1812 1813 1814 1815 1816 1817
	input->evbit[0] = BIT(EV_KEY);
	set_bit(KEY_SWITCHVIDEOMODE, input->keybit);
	set_bit(KEY_VIDEO_NEXT, input->keybit);
	set_bit(KEY_VIDEO_PREV, input->keybit);
	set_bit(KEY_BRIGHTNESS_CYCLE, input->keybit);
	set_bit(KEY_BRIGHTNESSUP, input->keybit);
	set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
	set_bit(KEY_BRIGHTNESS_ZERO, input->keybit);
	set_bit(KEY_DISPLAY_OFF, input->keybit);

L
Linus Torvalds 已提交
1818
	printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
L
Len Brown 已提交
1819 1820 1821 1822
	       ACPI_VIDEO_DEVICE_NAME, acpi_device_bid(device),
	       video->flags.multihead ? "yes" : "no",
	       video->flags.rom ? "yes" : "no",
	       video->flags.post ? "yes" : "no");
L
Linus Torvalds 已提交
1823

1824 1825
	video->pm_nb.notifier_call = acpi_video_resume;
	video->pm_nb.priority = 0;
1826 1827
	error = register_pm_notifier(&video->pm_nb);
	if (error)
1828 1829 1830 1831 1832
		goto err_stop_video;

	error = input_register_device(input);
	if (error)
		goto err_unregister_pm_notifier;
1833

1834 1835
	return 0;

1836 1837
 err_unregister_pm_notifier:
	unregister_pm_notifier(&video->pm_nb);
1838 1839
 err_stop_video:
	acpi_video_bus_stop_devices(video);
1840 1841
 err_free_input_dev:
	input_free_device(input);
1842
 err_put_video:
1843 1844 1845 1846
	acpi_video_bus_put_devices(video);
	kfree(video->attached_array);
 err_free_video:
	kfree(video);
1847
	device->driver_data = NULL;
L
Linus Torvalds 已提交
1848

1849
	return error;
L
Linus Torvalds 已提交
1850 1851
}

1852
static int acpi_video_bus_remove(struct acpi_device *device)
L
Linus Torvalds 已提交
1853
{
L
Len Brown 已提交
1854
	struct acpi_video_bus *video = NULL;
L
Linus Torvalds 已提交
1855 1856 1857


	if (!device || !acpi_driver_data(device))
1858
		return -EINVAL;
L
Linus Torvalds 已提交
1859

1860
	video = acpi_driver_data(device);
L
Linus Torvalds 已提交
1861

1862 1863
	unregister_pm_notifier(&video->pm_nb);

L
Linus Torvalds 已提交
1864 1865 1866
	acpi_video_bus_stop_devices(video);
	acpi_video_bus_put_devices(video);

1867
	input_unregister_device(video->input);
1868
	kfree(video->attached_array);
L
Linus Torvalds 已提交
1869 1870
	kfree(video);

1871
	return 0;
L
Linus Torvalds 已提交
1872 1873
}

1874 1875 1876 1877 1878 1879 1880 1881 1882
static int __init is_i740(struct pci_dev *dev)
{
	if (dev->device == 0x00D1)
		return 1;
	if (dev->device == 0x7000)
		return 1;
	return 0;
}

1883 1884
static int __init intel_opregion_present(void)
{
1885
	int opregion = 0;
1886 1887 1888 1889 1890 1891 1892 1893
	struct pci_dev *dev = NULL;
	u32 address;

	for_each_pci_dev(dev) {
		if ((dev->class >> 8) != PCI_CLASS_DISPLAY_VGA)
			continue;
		if (dev->vendor != PCI_VENDOR_ID_INTEL)
			continue;
1894 1895 1896
		/* We don't want to poke around undefined i740 registers */
		if (is_i740(dev))
			continue;
1897 1898 1899
		pci_read_config_dword(dev, 0xfc, &address);
		if (!address)
			continue;
1900
		opregion = 1;
1901
	}
1902
	return opregion;
1903 1904
}

1905
int acpi_video_register(void)
L
Linus Torvalds 已提交
1906
{
1907
	int result = 0;
1908 1909
	if (register_count) {
		/*
1910 1911
		 * if the function of acpi_video_register is already called,
		 * don't register the acpi_vide_bus again and return no error.
1912 1913 1914
		 */
		return 0;
	}
L
Linus Torvalds 已提交
1915 1916

	result = acpi_bus_register_driver(&acpi_video_bus);
1917
	if (result < 0)
1918
		return -ENODEV;
L
Linus Torvalds 已提交
1919

1920 1921 1922 1923 1924 1925
	/*
	 * When the acpi_video_bus is loaded successfully, increase
	 * the counter reference.
	 */
	register_count = 1;

1926
	return 0;
L
Linus Torvalds 已提交
1927
}
1928
EXPORT_SYMBOL(acpi_video_register);
1929

1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946
void acpi_video_unregister(void)
{
	if (!register_count) {
		/*
		 * If the acpi video bus is already unloaded, don't
		 * unload it again and return directly.
		 */
		return;
	}
	acpi_bus_unregister_driver(&acpi_video_bus);

	register_count = 0;

	return;
}
EXPORT_SYMBOL(acpi_video_unregister);

1947 1948 1949 1950 1951 1952 1953 1954 1955
/*
 * This is kind of nasty. Hardware using Intel chipsets may require
 * the video opregion code to be run first in order to initialise
 * state before any ACPI video calls are made. To handle this we defer
 * registration of the video class until the opregion code has run.
 */

static int __init acpi_video_init(void)
{
1956 1957
	dmi_check_system(video_dmi_table);

1958 1959 1960 1961 1962
	if (intel_opregion_present())
		return 0;

	return acpi_video_register();
}
L
Linus Torvalds 已提交
1963

1964
static void __exit acpi_video_exit(void)
L
Linus Torvalds 已提交
1965
{
1966
	acpi_video_unregister();
L
Linus Torvalds 已提交
1967

1968
	return;
L
Linus Torvalds 已提交
1969 1970 1971 1972
}

module_init(acpi_video_init);
module_exit(acpi_video_exit);