video.c 46.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 *  video.c - ACPI Video Driver ($Revision:$)
 *
 *  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
#define PREFIX "ACPI: "

L
Linus Torvalds 已提交
49 50 51 52 53 54 55 56
#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

57 58 59 60 61
#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 已提交
62

63
#define MAX_NAME_LEN	20
L
Linus Torvalds 已提交
64 65

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

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

72
static bool brightness_switch_enabled = 1;
73 74
module_param(brightness_switch_enabled, bool, 0644);

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

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

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

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

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

struct acpi_video_bus_flags {
L
Len Brown 已提交
112 113 114 115
	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 已提交
116 117 118
};

struct acpi_video_bus_cap {
L
Len Brown 已提交
119 120 121 122 123 124 125
	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 */
	u8 reserved:2;
L
Linus Torvalds 已提交
126 127
};

L
Len Brown 已提交
128 129
struct acpi_video_device_attrib {
	u32 display_index:4;	/* A zero-based instance of the Display */
130
	u32 display_port_attachment:4;	/*This field differentiates the display type */
L
Len Brown 已提交
131
	u32 display_type:4;	/*Describe the specific type in use */
132
	u32 vendor_specific:4;	/*Chipset Vendor Specific */
L
Len Brown 已提交
133 134 135 136 137 138
	u32 bios_can_detect:1;	/*BIOS can detect the device */
	u32 depend_on_vga:1;	/*Non-VGA output device whose power is related to 
				   the VGA device. */
	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 已提交
139 140 141 142 143
};

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

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

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

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

182 183
struct acpi_video_brightness_flags {
	u8 _BCL_no_ac_battery_levels:1;	/* no AC/Battery levels in _BCL */
184
	u8 _BCL_reversed:1;		/* _BCL package is in a reversed order*/
185 186 187
	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 */
188 189
};

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

struct acpi_video_device {
L
Len Brown 已提交
198 199 200 201 202 203
	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 已提交
204
	struct acpi_video_device_brightness *brightness;
205
	struct backlight_device *backlight;
206
	struct thermal_cooling_device *cooling_dev;
L
Linus Torvalds 已提交
207 208
};

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

L
Len Brown 已提交
216 217 218 219
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 已提交
220
static int acpi_video_device_enumerate(struct acpi_video_bus *video);
221 222 223 224
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,
225
			unsigned long long *level, int init);
L
Len Brown 已提交
226 227
static int acpi_video_get_next_level(struct acpi_video_device *device,
				     u32 level_current, u32 event);
228
static int acpi_video_switch_brightness(struct acpi_video_device *device,
L
Len Brown 已提交
229
					 int event);
L
Linus Torvalds 已提交
230

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

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

static int acpi_video_set_brightness(struct backlight_device *bd)
{
252
	int request_level = bd->props.brightness + 2;
253
	struct acpi_video_device *vd =
254
		(struct acpi_video_device *)bl_get_data(bd);
255 256 257

	return acpi_video_device_lcd_set_level(vd,
				vd->brightness->levels[request_level]);
258 259
}

L
Lionel Debroux 已提交
260
static const struct backlight_ops acpi_backlight_ops = {
261 262 263 264
	.get_brightness = acpi_video_get_brightness,
	.update_status  = acpi_video_set_brightness,
};

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

272 273
	*state = video->brightness->count - 3;
	return 0;
274 275
}

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

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

	return -EINVAL;
}

static int
296
video_set_cur_state(struct thermal_cooling_device *cooling_dev, unsigned long state)
297
{
298
	struct acpi_device *device = cooling_dev->devdata;
299 300 301 302 303 304 305 306 307 308 309
	struct acpi_video_device *video = acpi_driver_data(device);
	int level;

	if ( state >= video->brightness->count - 2)
		return -EINVAL;

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

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

L
Linus Torvalds 已提交
316 317 318 319 320
/* --------------------------------------------------------------------------
                               Video Management
   -------------------------------------------------------------------------- */

static int
L
Len Brown 已提交
321 322
acpi_video_device_lcd_query_levels(struct acpi_video_device *device,
				   union acpi_object **levels)
L
Linus Torvalds 已提交
323
{
L
Len Brown 已提交
324 325 326
	int status;
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
L
Linus Torvalds 已提交
327 328 329 330


	*levels = NULL;

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

	*levels = obj;

343
	return 0;
L
Linus Torvalds 已提交
344

L
Len Brown 已提交
345
      err:
346
	kfree(buffer.pointer);
L
Linus Torvalds 已提交
347

348
	return status;
L
Linus Torvalds 已提交
349 350 351
}

static int
L
Len Brown 已提交
352
acpi_video_device_lcd_set_level(struct acpi_video_device *device, int level)
L
Linus Torvalds 已提交
353
{
354
	int status;
L
Len Brown 已提交
355 356
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
357
	int state;
L
Linus Torvalds 已提交
358 359 360

	arg0.integer.value = level;

361 362 363 364 365 366 367
	status = acpi_evaluate_object(device->dev->handle, "_BCM",
				      &args, NULL);
	if (ACPI_FAILURE(status)) {
		ACPI_ERROR((AE_INFO, "Evaluating _BCM failed"));
		return -EIO;
	}

368
	device->brightness->curr = level;
369
	for (state = 2; state < device->brightness->count; state++)
370
		if (level == device->brightness->levels[state]) {
371 372
			if (device->backlight)
				device->backlight->props.brightness = state - 2;
373 374
			return 0;
		}
375

376 377
	ACPI_ERROR((AE_INFO, "Current brightness invalid"));
	return -EINVAL;
L
Linus Torvalds 已提交
378 379
}

380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403
/*
 * 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;
}

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"),
		},
	},
404 405 406 407 408 409 410 411
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 5710Z",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5710Z"),
		},
	},
412 413 414 415 416 417 418 419
	{
	 .callback = video_set_bqc_offset,
	 .ident = "eMachines E510",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "EMACHINES"),
		DMI_MATCH(DMI_PRODUCT_NAME, "eMachines E510"),
		},
	},
420 421 422 423 424 425 426 427
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 5315",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5315"),
		},
	},
428 429 430 431 432 433 434 435
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 7720",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 7720"),
		},
	},
436 437 438
	{}
};

L
Linus Torvalds 已提交
439
static int
L
Len Brown 已提交
440
acpi_video_device_lcd_get_level_current(struct acpi_video_device *device,
441
					unsigned long long *level, int init)
L
Linus Torvalds 已提交
442
{
443
	acpi_status status = AE_OK;
444
	int i;
445

446 447 448 449
	if (device->cap._BQC || device->cap._BCQ) {
		char *buf = device->cap._BQC ? "_BQC" : "_BCQ";

		status = acpi_evaluate_integer(device->dev->handle, buf,
450 451
						NULL, level);
		if (ACPI_SUCCESS(status)) {
452 453 454 455 456 457 458
			if (device->brightness->flags._BQC_use_index) {
				if (device->brightness->flags._BCL_reversed)
					*level = device->brightness->count
								 - 3 - (*level);
				*level = device->brightness->levels[*level + 2];

			}
459
			*level += bqc_offset_aml_bug_workaround;
460 461 462 463 464
			for (i = 2; i < device->brightness->count; i++)
				if (device->brightness->levels[i] == *level) {
					device->brightness->curr = *level;
					return 0;
			}
465 466 467 468 469 470 471 472 473 474
			if (!init) {
				/*
				 * 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;
			}
475 476 477 478 479 480 481 482
		} else {
			/* Fixme:
			 * 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
			 */
483 484
			ACPI_WARNING((AE_INFO, "Evaluating %s failed", buf));
			device->cap._BQC = device->cap._BCQ = 0;
485 486 487
		}
	}

488
	*level = device->brightness->curr;
489
	return 0;
L
Linus Torvalds 已提交
490 491 492
}

static int
L
Len Brown 已提交
493 494
acpi_video_device_EDID(struct acpi_video_device *device,
		       union acpi_object **edid, ssize_t length)
L
Linus Torvalds 已提交
495
{
L
Len Brown 已提交
496 497 498 499 500
	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 已提交
501 502 503 504 505


	*edid = NULL;

	if (!device)
506
		return -ENODEV;
L
Linus Torvalds 已提交
507 508 509 510 511
	if (length == 128)
		arg0.integer.value = 1;
	else if (length == 256)
		arg0.integer.value = 2;
	else
512
		return -EINVAL;
L
Linus Torvalds 已提交
513

514
	status = acpi_evaluate_object(device->dev->handle, "_DDC", &args, &buffer);
L
Linus Torvalds 已提交
515
	if (ACPI_FAILURE(status))
516
		return -ENODEV;
L
Linus Torvalds 已提交
517

518
	obj = buffer.pointer;
L
Linus Torvalds 已提交
519 520 521 522

	if (obj && obj->type == ACPI_TYPE_BUFFER)
		*edid = obj;
	else {
523
		printk(KERN_ERR PREFIX "Invalid _DDC data\n");
L
Linus Torvalds 已提交
524 525 526 527
		status = -EFAULT;
		kfree(obj);
	}

528
	return status;
L
Linus Torvalds 已提交
529 530 531 532 533 534 535 536 537 538 539
}

/* bus */

/*
 *  Arg:
 *  	video		: video bus device pointer
 *	bios_flag	: 
 *		0.	The system BIOS should NOT automatically switch(toggle)
 *			the active display output.
 *		1.	The system BIOS should automatically switch (toggle) the
540
 *			active display output. No switch event.
L
Linus Torvalds 已提交
541 542 543 544 545 546
 *		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
547
 *			of the LCD when the power changes from AC to DC
L
Linus Torvalds 已提交
548
 *		1. 	The system BIOS should NOT automatically control the brightness 
549
 *			level of the LCD when the power changes from AC to DC.
L
Linus Torvalds 已提交
550
 * Return Value:
551
 *		-EINVAL	wrong arg.
L
Linus Torvalds 已提交
552 553 554
 */

static int
L
Len Brown 已提交
555
acpi_video_bus_DOS(struct acpi_video_bus *video, int bios_flag, int lcd_flag)
L
Linus Torvalds 已提交
556
{
557
	acpi_status status;
L
Len Brown 已提交
558 559
	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
	struct acpi_object_list args = { 1, &arg0 };
L
Linus Torvalds 已提交
560

561 562
	if (!video->cap._DOS)
		return 0;
L
Linus Torvalds 已提交
563

564 565
	if (bios_flag < 0 || bios_flag > 3 || lcd_flag < 0 || lcd_flag > 1)
		return -EINVAL;
L
Linus Torvalds 已提交
566 567
	arg0.integer.value = (lcd_flag << 2) | bios_flag;
	video->dos_setting = arg0.integer.value;
568 569 570 571
	status = acpi_evaluate_object(video->device->handle, "_DOS",
		&args, NULL);
	if (ACPI_FAILURE(status))
		return -EIO;
L
Linus Torvalds 已提交
572

573
	return 0;
L
Linus Torvalds 已提交
574 575
}

576 577 578 579 580 581 582 583 584 585
/*
 * 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;
}

L
Linus Torvalds 已提交
586 587 588 589 590
/*
 *  Arg:	
 *  	device	: video output device (LCD, CRT, ..)
 *
 *  Return Value:
591 592 593 594 595 596 597 598 599
 *	Maximum brightness level
 *
 *  Allocate and initialize device->brightness.
 */

static int
acpi_video_init_brightness(struct acpi_video_device *device)
{
	union acpi_object *obj = NULL;
600
	int i, max_level = 0, count = 0, level_ac_battery = 0;
601
	unsigned long long level, level_old;
602 603
	union acpi_object *o;
	struct acpi_video_device_brightness *br = NULL;
604
	int result = -EINVAL;
605 606 607 608 609 610 611 612 613 614 615 616 617

	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");
618
		result = -ENOMEM;
619 620 621
		goto out;
	}

622
	br->levels = kmalloc((obj->package.count + 2) * sizeof *(br->levels),
623
				GFP_KERNEL);
624 625
	if (!br->levels) {
		result = -ENOMEM;
626
		goto out_free;
627
	}
628 629 630 631 632 633 634 635 636 637 638 639 640 641

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

642 643 644 645 646 647
	/*
	 * 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.
	 */
648 649
	for (i = 2; i < count; i++) {
		if (br->levels[i] == br->levels[0])
650
			level_ac_battery++;
651 652 653
		if (br->levels[i] == br->levels[1])
			level_ac_battery++;
	}
654 655 656 657 658 659 660 661 662 663

	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)
		ACPI_ERROR((AE_INFO, "Too many duplicates in _BCL package\n"));

664 665 666 667 668 669 670 671
	/* 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,
			    "Found unordered _BCL package\n"));
672 673 674

	br->count = count;
	device->brightness = br;
675 676 677 678 679 680 681 682 683 684 685 686

	/* 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 */
687
	br->curr = level = max_level;
688 689 690 691

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

692
	result = acpi_video_device_lcd_get_level_current(device, &level_old, 1);
693 694 695
	if (result)
		goto out_free_levels;

696 697 698 699
	/*
	 * Set the level to maximum and check if _BQC uses indexed value
	 */
	result = acpi_video_device_lcd_set_level(device, max_level);
700 701 702
	if (result)
		goto out_free_levels;

703
	result = acpi_video_device_lcd_get_level_current(device, &level, 0);
704 705 706
	if (result)
		goto out_free_levels;

707 708
	br->flags._BQC_use_index = (level == max_level ? 0 : 1);

709 710 711 712 713 714 715
	if (!br->flags._BQC_use_index) {
		/*
		 * Set the backlight to the initial state.
		 * On some buggy laptops, _BQC returns an uninitialized value
		 * when invoked for the first time, i.e. level_old is invalid.
		 * set the backlight to max_level in this case
		 */
716 717 718 719 720
		if (use_bios_initial_backlight) {
			for (i = 2; i < br->count; i++)
				if (level_old == br->levels[i])
					level = level_old;
		}
721
		goto set_level;
722
	}
723 724 725

	if (br->flags._BCL_reversed)
		level_old = (br->count - 1) - level_old;
726
	level = br->levels[level_old];
727 728

set_level:
729
	result = acpi_video_device_lcd_set_level(device, level);
730 731
	if (result)
		goto out_free_levels;
732

733 734
	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
			  "found %d brightness levels\n", count - 2));
735
	kfree(obj);
736
	return result;
737 738 739 740 741 742 743 744

out_free_levels:
	kfree(br->levels);
out_free:
	kfree(br);
out:
	device->brightness = NULL;
	kfree(obj);
745
	return result;
746 747 748 749 750 751 752
}

/*
 *  Arg:
 *	device	: video output device (LCD, CRT, ..)
 *
 *  Return Value:
L
Linus Torvalds 已提交
753 754
 *  	None
 *
755
 *  Find out all required AML methods defined under the output
L
Linus Torvalds 已提交
756 757 758
 *  device.
 */

L
Len Brown 已提交
759
static void acpi_video_device_find_cap(struct acpi_video_device *device)
L
Linus Torvalds 已提交
760 761 762
{
	acpi_handle h_dummy1;

763
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_ADR", &h_dummy1))) {
L
Linus Torvalds 已提交
764 765
		device->cap._ADR = 1;
	}
766
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCL", &h_dummy1))) {
L
Len Brown 已提交
767
		device->cap._BCL = 1;
L
Linus Torvalds 已提交
768
	}
769
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCM", &h_dummy1))) {
L
Len Brown 已提交
770
		device->cap._BCM = 1;
L
Linus Torvalds 已提交
771
	}
772 773
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle,"_BQC",&h_dummy1)))
		device->cap._BQC = 1;
774 775 776 777 778 779
	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;
	}

780
	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DDC", &h_dummy1))) {
L
Len Brown 已提交
781
		device->cap._DDC = 1;
L
Linus Torvalds 已提交
782 783
	}

784
	if (acpi_video_backlight_support()) {
785
		struct backlight_properties props;
786 787 788
		struct pci_dev *pdev;
		acpi_handle acpi_parent;
		struct device *parent = NULL;
789
		int result;
790 791
		static int count = 0;
		char *name;
792 793 794 795

		result = acpi_video_init_brightness(device);
		if (result)
			return;
J
Julia Lawall 已提交
796
		name = kasprintf(GFP_KERNEL, "acpi_video%d", count);
797 798
		if (!name)
			return;
J
Julia Lawall 已提交
799
		count++;
800

801 802 803 804 805 806 807 808
		acpi_get_parent(device->dev->handle, &acpi_parent);

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

809
		memset(&props, 0, sizeof(struct backlight_properties));
M
Matthew Garrett 已提交
810
		props.type = BACKLIGHT_FIRMWARE;
811
		props.max_brightness = device->brightness->count - 3;
812 813 814
		device->backlight = backlight_device_register(name,
							      parent,
							      device,
815 816
							      &acpi_backlight_ops,
							      &props);
817
		kfree(name);
818 819
		if (IS_ERR(device->backlight))
			return;
820

821 822 823 824 825 826
		/*
		 * 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);
827

828
		device->cooling_dev = thermal_cooling_device_register("LCD",
829
					device->dev, &video_cooling_ops);
830
		if (IS_ERR(device->cooling_dev)) {
831
			/*
832
			 * Set cooling_dev to NULL so we don't crash trying to
833 834 835 836 837 838
			 * free it.
			 * Also, why the hell we are returning early and
			 * not attempt to register video output if cooling
			 * device registration failed?
			 * -- dtor
			 */
839
			device->cooling_dev = NULL;
840
			return;
841
		}
842

843
		dev_info(&device->dev->dev, "registered as cooling_device%d\n",
844
			 device->cooling_dev->id);
845
		result = sysfs_create_link(&device->dev->dev.kobj,
846
				&device->cooling_dev->device.kobj,
847 848 849
				"thermal_cooling");
		if (result)
			printk(KERN_ERR PREFIX "Create sysfs link\n");
850
		result = sysfs_create_link(&device->cooling_dev->device.kobj,
851 852 853 854
				&device->dev->dev.kobj, "device");
		if (result)
			printk(KERN_ERR PREFIX "Create sysfs link\n");

855
	}
L
Linus Torvalds 已提交
856 857 858 859 860 861 862 863 864
}

/*
 *  Arg:	
 *  	device	: video output device (VGA)
 *
 *  Return Value:
 *  	None
 *
865
 *  Find out all required AML methods defined under the video bus device.
L
Linus Torvalds 已提交
866 867
 */

L
Len Brown 已提交
868
static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
869
{
L
Len Brown 已提交
870
	acpi_handle h_dummy1;
L
Linus Torvalds 已提交
871

872
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOS", &h_dummy1))) {
L
Linus Torvalds 已提交
873 874
		video->cap._DOS = 1;
	}
875
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOD", &h_dummy1))) {
L
Linus Torvalds 已提交
876 877
		video->cap._DOD = 1;
	}
878
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_ROM", &h_dummy1))) {
L
Linus Torvalds 已提交
879 880
		video->cap._ROM = 1;
	}
881
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_GPD", &h_dummy1))) {
L
Linus Torvalds 已提交
882 883
		video->cap._GPD = 1;
	}
884
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_SPD", &h_dummy1))) {
L
Linus Torvalds 已提交
885 886
		video->cap._SPD = 1;
	}
887
	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_VPO", &h_dummy1))) {
L
Linus Torvalds 已提交
888 889 890 891 892 893 894 895 896
		video->cap._VPO = 1;
	}
}

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

L
Len Brown 已提交
897
static int acpi_video_bus_check(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
898
{
L
Len Brown 已提交
899
	acpi_status status = -ENOENT;
900
	struct pci_dev *dev;
L
Linus Torvalds 已提交
901 902

	if (!video)
903
		return -EINVAL;
L
Linus Torvalds 已提交
904

905
	dev = acpi_get_pci_dev(video->device->handle);
906 907
	if (!dev)
		return -ENODEV;
908
	pci_dev_put(dev);
909

L
Linus Torvalds 已提交
910 911 912 913
	/* Since there is no HID, CID and so on for VGA driver, we have
	 * to check well known required nodes.
	 */

914
	/* Does this device support video switching? */
915 916 917 918 919 920
	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 已提交
921 922 923 924
		video->flags.multihead = 1;
		status = 0;
	}

925
	/* Does this device support retrieving a video ROM? */
L
Len Brown 已提交
926
	if (video->cap._ROM) {
L
Linus Torvalds 已提交
927 928 929 930
		video->flags.rom = 1;
		status = 0;
	}

931
	/* Does this device support configuring which video device to POST? */
L
Len Brown 已提交
932
	if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
L
Linus Torvalds 已提交
933 934 935 936
		video->flags.post = 1;
		status = 0;
	}

937
	return status;
L
Linus Torvalds 已提交
938 939 940 941 942 943 944
}

/* --------------------------------------------------------------------------
                                 Driver Interface
   -------------------------------------------------------------------------- */

/* device interface */
945 946 947
static struct acpi_video_device_attrib*
acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
{
948 949 950 951 952 953 954 955
	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;
	}
956 957 958

	return NULL;
}
L
Linus Torvalds 已提交
959

960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975
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 已提交
976
static int
L
Len Brown 已提交
977 978
acpi_video_bus_get_one_device(struct acpi_device *device,
			      struct acpi_video_bus *video)
L
Linus Torvalds 已提交
979
{
980
	unsigned long long device_id;
981
	int status, device_type;
L
Len Brown 已提交
982
	struct acpi_video_device *data;
983
	struct acpi_video_device_attrib* attribute;
L
Linus Torvalds 已提交
984 985

	if (!device || !video)
986
		return -EINVAL;
L
Linus Torvalds 已提交
987

L
Len Brown 已提交
988 989
	status =
	    acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
L
Linus Torvalds 已提交
990 991
	if (ACPI_SUCCESS(status)) {

992
		data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
L
Linus Torvalds 已提交
993
		if (!data)
994
			return -ENOMEM;
L
Linus Torvalds 已提交
995 996 997

		strcpy(acpi_device_name(device), ACPI_VIDEO_DEVICE_NAME);
		strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
998
		device->driver_data = data;
L
Linus Torvalds 已提交
999 1000 1001 1002 1003

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

1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025
		attribute = acpi_video_get_device_attr(video, device_id);

		if((attribute != NULL) && attribute->device_id_scheme) {
			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;
			}
			if(attribute->bios_can_detect)
				data->flags.bios = 1;
1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044
		} 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) {
			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;
			}
		}
L
Len Brown 已提交
1045

L
Linus Torvalds 已提交
1046 1047 1048
		acpi_video_device_bind(video, data);
		acpi_video_device_find_cap(data);

1049
		status = acpi_install_notify_handler(device->handle,
L
Len Brown 已提交
1050 1051 1052
						     ACPI_DEVICE_NOTIFY,
						     acpi_video_device_notify,
						     data);
L
Linus Torvalds 已提交
1053
		if (ACPI_FAILURE(status)) {
1054 1055
			printk(KERN_ERR PREFIX
					  "Error installing notify handler\n");
1056 1057 1058 1059 1060
			if(data->brightness)
				kfree(data->brightness->levels);
			kfree(data->brightness);
			kfree(data);
			return -ENODEV;
L
Linus Torvalds 已提交
1061 1062
		}

1063
		mutex_lock(&video->device_list_lock);
L
Linus Torvalds 已提交
1064
		list_add_tail(&data->entry, &video->video_device_list);
1065
		mutex_unlock(&video->device_list_lock);
L
Linus Torvalds 已提交
1066

1067
		return 0;
L
Linus Torvalds 已提交
1068 1069
	}

1070
	return -ENOENT;
L
Linus Torvalds 已提交
1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
}

/*
 *  Arg:
 *  	video	: video bus device 
 *
 *  Return:
 *  	none
 *  
 *  Enumerate the video device list of the video bus, 
 *  bind the ids with the corresponding video devices
 *  under the video bus.
L
Len Brown 已提交
1083
 */
L
Linus Torvalds 已提交
1084

L
Len Brown 已提交
1085
static void acpi_video_device_rebind(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1086
{
1087 1088
	struct acpi_video_device *dev;

1089
	mutex_lock(&video->device_list_lock);
1090 1091

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

1094
	mutex_unlock(&video->device_list_lock);
L
Linus Torvalds 已提交
1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107
}

/*
 *  Arg:
 *  	video	: video bus device 
 *  	device	: video output device under the video 
 *  		bus
 *
 *  Return:
 *  	none
 *  
 *  Bind the ids with the corresponding video devices
 *  under the video bus.
L
Len Brown 已提交
1108
 */
L
Linus Torvalds 已提交
1109 1110

static void
L
Len Brown 已提交
1111 1112
acpi_video_device_bind(struct acpi_video_bus *video,
		       struct acpi_video_device *device)
L
Linus Torvalds 已提交
1113
{
1114
	struct acpi_video_enumerated_device *ids;
L
Len Brown 已提交
1115
	int i;
L
Linus Torvalds 已提交
1116

1117 1118 1119 1120
	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 已提交
1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134
			ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
		}
	}
}

/*
 *  Arg:
 *  	video	: video bus device 
 *
 *  Return:
 *  	< 0	: error
 *  
 *  Call _DOD to enumerate all devices attached to display adapter
 *
L
Len Brown 已提交
1135
 */
L
Linus Torvalds 已提交
1136 1137 1138

static int acpi_video_device_enumerate(struct acpi_video_bus *video)
{
L
Len Brown 已提交
1139 1140 1141
	int status;
	int count;
	int i;
1142
	struct acpi_video_enumerated_device *active_list;
L
Len Brown 已提交
1143 1144 1145
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *dod = NULL;
	union acpi_object *obj;
L
Linus Torvalds 已提交
1146

1147
	status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
L
Linus Torvalds 已提交
1148
	if (!ACPI_SUCCESS(status)) {
1149
		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1150
		return status;
L
Linus Torvalds 已提交
1151 1152
	}

1153
	dod = buffer.pointer;
L
Linus Torvalds 已提交
1154
	if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1155
		ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
L
Linus Torvalds 已提交
1156 1157 1158 1159 1160
		status = -EFAULT;
		goto out;
	}

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

1163 1164 1165 1166
	active_list = kcalloc(1 + dod->package.count,
			      sizeof(struct acpi_video_enumerated_device),
			      GFP_KERNEL);
	if (!active_list) {
L
Linus Torvalds 已提交
1167 1168 1169 1170 1171 1172
		status = -ENOMEM;
		goto out;
	}

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

		if (obj->type != ACPI_TYPE_INTEGER) {
1176 1177 1178
			printk(KERN_ERR PREFIX
				"Invalid _DOD data in element %d\n", i);
			continue;
L
Linus Torvalds 已提交
1179
		}
1180 1181 1182

		active_list[count].value.int_val = obj->integer.value;
		active_list[count].bind_info = NULL;
L
Len Brown 已提交
1183 1184
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
				  (int)obj->integer.value));
L
Linus Torvalds 已提交
1185 1186 1187
		count++;
	}

1188
	kfree(video->attached_array);
L
Len Brown 已提交
1189

1190
	video->attached_array = active_list;
L
Linus Torvalds 已提交
1191
	video->attached_count = count;
1192 1193

 out:
1194
	kfree(buffer.pointer);
1195
	return status;
L
Linus Torvalds 已提交
1196 1197
}

L
Len Brown 已提交
1198 1199 1200
static int
acpi_video_get_next_level(struct acpi_video_device *device,
			  u32 level_current, u32 event)
L
Linus Torvalds 已提交
1201
{
1202
	int min, max, min_above, max_below, i, l, delta = 255;
1203 1204
	max = max_below = 0;
	min = min_above = 255;
1205
	/* Find closest level to level_current */
1206
	for (i = 2; i < device->brightness->count; i++) {
1207 1208 1209 1210 1211 1212 1213 1214 1215
		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;
1216
	for (i = 2; i < device->brightness->count; i++) {
1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240
		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 已提交
1241 1242
}

1243
static int
L
Len Brown 已提交
1244
acpi_video_switch_brightness(struct acpi_video_device *device, int event)
L
Linus Torvalds 已提交
1245
{
1246
	unsigned long long level_current, level_next;
1247 1248
	int result = -EINVAL;

1249 1250 1251 1252
	/* no warning message if acpi_backlight=vendor is used */
	if (!acpi_video_backlight_support())
		return 0;

1253
	if (!device->brightness)
1254 1255 1256
		goto out;

	result = acpi_video_device_lcd_get_level_current(device,
1257
							 &level_current, 0);
1258 1259 1260
	if (result)
		goto out;

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

1263
	result = acpi_video_device_lcd_set_level(device, level_next);
1264

1265 1266 1267 1268
	if (!result)
		backlight_force_update(device->backlight,
				       BACKLIGHT_UPDATE_HOTKEY);

1269 1270 1271 1272 1273
out:
	if (result)
		printk(KERN_ERR PREFIX "Failed to switch the brightness\n");

	return result;
L
Linus Torvalds 已提交
1274 1275
}

1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296
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;

1297 1298 1299
		if (!video_device->cap._DDC)
			continue;

1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343
		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 已提交
1344
static int
L
Len Brown 已提交
1345 1346
acpi_video_bus_get_devices(struct acpi_video_bus *video,
			   struct acpi_device *device)
L
Linus Torvalds 已提交
1347
{
1348
	int status;
1349
	struct acpi_device *dev;
L
Linus Torvalds 已提交
1350

1351 1352 1353
	status = acpi_video_device_enumerate(video);
	if (status)
		return status;
L
Linus Torvalds 已提交
1354

1355
	list_for_each_entry(dev, &device->children, node) {
L
Linus Torvalds 已提交
1356 1357

		status = acpi_video_bus_get_one_device(dev, video);
1358
		if (status) {
1359
			printk(KERN_WARNING PREFIX
L
Lucas De Marchi 已提交
1360
					"Can't attach device\n");
L
Linus Torvalds 已提交
1361 1362 1363
			continue;
		}
	}
1364
	return status;
L
Linus Torvalds 已提交
1365 1366
}

L
Len Brown 已提交
1367
static int acpi_video_bus_put_one_device(struct acpi_video_device *device)
L
Linus Torvalds 已提交
1368
{
1369
	acpi_status status;
L
Linus Torvalds 已提交
1370 1371

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

1374
	status = acpi_remove_notify_handler(device->dev->handle,
L
Len Brown 已提交
1375 1376
					    ACPI_DEVICE_NOTIFY,
					    acpi_video_device_notify);
1377 1378
	if (ACPI_FAILURE(status)) {
		printk(KERN_WARNING PREFIX
L
Lucas De Marchi 已提交
1379
		       "Can't remove video notify handler\n");
1380
	}
1381 1382 1383 1384
	if (device->backlight) {
		backlight_device_unregister(device->backlight);
		device->backlight = NULL;
	}
1385
	if (device->cooling_dev) {
1386 1387
		sysfs_remove_link(&device->dev->dev.kobj,
				  "thermal_cooling");
1388
		sysfs_remove_link(&device->cooling_dev->device.kobj,
1389
				  "device");
1390 1391
		thermal_cooling_device_unregister(device->cooling_dev);
		device->cooling_dev = NULL;
1392
	}
1393

1394
	return 0;
L
Linus Torvalds 已提交
1395 1396
}

L
Len Brown 已提交
1397
static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1398
{
L
Len Brown 已提交
1399
	int status;
1400
	struct acpi_video_device *dev, *next;
L
Linus Torvalds 已提交
1401

1402
	mutex_lock(&video->device_list_lock);
L
Linus Torvalds 已提交
1403

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

1406
		status = acpi_video_bus_put_one_device(dev);
L
Len Brown 已提交
1407 1408 1409
		if (ACPI_FAILURE(status))
			printk(KERN_WARNING PREFIX
			       "hhuuhhuu bug in acpi video driver.\n");
L
Linus Torvalds 已提交
1410

1411 1412 1413 1414 1415 1416
		if (dev->brightness) {
			kfree(dev->brightness->levels);
			kfree(dev->brightness);
		}
		list_del(&dev->entry);
		kfree(dev);
L
Linus Torvalds 已提交
1417 1418
	}

1419
	mutex_unlock(&video->device_list_lock);
1420

1421
	return 0;
L
Linus Torvalds 已提交
1422 1423 1424 1425
}

/* acpi_video interface */

L
Len Brown 已提交
1426
static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1427
{
1428
	return acpi_video_bus_DOS(video, 0, 0);
L
Linus Torvalds 已提交
1429 1430
}

L
Len Brown 已提交
1431
static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1432 1433 1434 1435
{
	return acpi_video_bus_DOS(video, 0, 1);
}

1436
static void acpi_video_bus_notify(struct acpi_device *device, u32 event)
L
Linus Torvalds 已提交
1437
{
1438
	struct acpi_video_bus *video = acpi_driver_data(device);
1439
	struct input_dev *input;
1440
	int keycode = 0;
1441

L
Linus Torvalds 已提交
1442
	if (!video)
1443
		return;
L
Linus Torvalds 已提交
1444

1445
	input = video->input;
L
Linus Torvalds 已提交
1446 1447

	switch (event) {
1448
	case ACPI_VIDEO_NOTIFY_SWITCH:	/* User requested a switch,
L
Linus Torvalds 已提交
1449
					 * most likely via hotkey. */
1450
		acpi_bus_generate_proc_event(device, event, 0);
1451 1452
		if (!acpi_notifier_call_chain(device, event, 0))
			keycode = KEY_SWITCHVIDEOMODE;
L
Linus Torvalds 已提交
1453 1454
		break;

1455
	case ACPI_VIDEO_NOTIFY_PROBE:	/* User plugged in or removed a video
L
Linus Torvalds 已提交
1456 1457 1458
					 * connector. */
		acpi_video_device_enumerate(video);
		acpi_video_device_rebind(video);
1459
		acpi_bus_generate_proc_event(device, event, 0);
1460
		keycode = KEY_SWITCHVIDEOMODE;
L
Linus Torvalds 已提交
1461 1462
		break;

L
Len Brown 已提交
1463
	case ACPI_VIDEO_NOTIFY_CYCLE:	/* Cycle Display output hotkey pressed. */
L
Len Brown 已提交
1464
		acpi_bus_generate_proc_event(device, event, 0);
1465 1466
		keycode = KEY_SWITCHVIDEOMODE;
		break;
L
Len Brown 已提交
1467
	case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:	/* Next Display output hotkey pressed. */
L
Len Brown 已提交
1468
		acpi_bus_generate_proc_event(device, event, 0);
1469 1470
		keycode = KEY_VIDEO_NEXT;
		break;
L
Len Brown 已提交
1471
	case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:	/* previous Display output hotkey pressed. */
1472
		acpi_bus_generate_proc_event(device, event, 0);
1473
		keycode = KEY_VIDEO_PREV;
L
Linus Torvalds 已提交
1474 1475 1476 1477
		break;

	default:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
1478
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
1479 1480 1481
		break;
	}

1482 1483
	if (event != ACPI_VIDEO_NOTIFY_SWITCH)
		acpi_notifier_call_chain(device, event, 0);
1484 1485 1486 1487 1488 1489 1490

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

1492
	return;
L
Linus Torvalds 已提交
1493 1494
}

L
Len Brown 已提交
1495
static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
L
Linus Torvalds 已提交
1496
{
1497
	struct acpi_video_device *video_device = data;
L
Len Brown 已提交
1498
	struct acpi_device *device = NULL;
1499 1500
	struct acpi_video_bus *bus;
	struct input_dev *input;
1501
	int keycode = 0;
L
Linus Torvalds 已提交
1502 1503

	if (!video_device)
1504
		return;
L
Linus Torvalds 已提交
1505

1506
	device = video_device->dev;
1507 1508
	bus = video_device->video;
	input = bus->input;
L
Linus Torvalds 已提交
1509 1510

	switch (event) {
L
Len Brown 已提交
1511
	case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:	/* Cycle brightness */
1512 1513
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
1514
		acpi_bus_generate_proc_event(device, event, 0);
1515 1516
		keycode = KEY_BRIGHTNESS_CYCLE;
		break;
L
Len Brown 已提交
1517
	case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:	/* Increase brightness */
1518 1519
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
L
Len Brown 已提交
1520
		acpi_bus_generate_proc_event(device, event, 0);
1521 1522
		keycode = KEY_BRIGHTNESSUP;
		break;
L
Len Brown 已提交
1523
	case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:	/* Decrease brightness */
1524 1525
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
L
Len Brown 已提交
1526
		acpi_bus_generate_proc_event(device, event, 0);
1527 1528
		keycode = KEY_BRIGHTNESSDOWN;
		break;
1529
	case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:	/* zero brightness */
1530 1531
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
L
Len Brown 已提交
1532
		acpi_bus_generate_proc_event(device, event, 0);
1533 1534
		keycode = KEY_BRIGHTNESS_ZERO;
		break;
L
Len Brown 已提交
1535
	case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:	/* display device off */
1536 1537
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
1538
		acpi_bus_generate_proc_event(device, event, 0);
1539
		keycode = KEY_DISPLAY_OFF;
L
Linus Torvalds 已提交
1540 1541 1542
		break;
	default:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
1543
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
1544 1545
		break;
	}
1546

1547
	acpi_notifier_call_chain(device, event, 0);
1548 1549 1550 1551 1552 1553 1554

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

1556
	return;
L
Linus Torvalds 已提交
1557 1558
}

1559 1560
static int acpi_video_resume(struct notifier_block *nb,
				unsigned long val, void *ign)
1561 1562 1563 1564 1565
{
	struct acpi_video_bus *video;
	struct acpi_video_device *video_device;
	int i;

1566 1567 1568 1569 1570 1571
	switch (val) {
	case PM_HIBERNATION_PREPARE:
	case PM_SUSPEND_PREPARE:
	case PM_RESTORE_PREPARE:
		return NOTIFY_DONE;
	}
1572

1573 1574 1575
	video = container_of(nb, struct acpi_video_bus, pm_nb);

	dev_info(&video->device->dev, "Restoring backlight state\n");
1576 1577 1578 1579 1580 1581

	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);
	}
1582 1583

	return NOTIFY_OK;
1584 1585
}

1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606
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;
}

1607 1608
static int instance;

L
Len Brown 已提交
1609
static int acpi_video_bus_add(struct acpi_device *device)
L
Linus Torvalds 已提交
1610
{
1611
	struct acpi_video_bus *video;
1612
	struct input_dev *input;
1613
	int error;
1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628
	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 已提交
1629

1630
	video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
L
Linus Torvalds 已提交
1631
	if (!video)
1632
		return -ENOMEM;
L
Linus Torvalds 已提交
1633

1634 1635 1636 1637 1638 1639
	/* 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;
		instance ++;
	}
1640 1641 1642 1643 1644 1645
	/* 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++;
	}
1646

1647
	video->device = device;
L
Linus Torvalds 已提交
1648 1649
	strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
	strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1650
	device->driver_data = video;
L
Linus Torvalds 已提交
1651 1652

	acpi_video_bus_find_cap(video);
1653 1654 1655
	error = acpi_video_bus_check(video);
	if (error)
		goto err_free_video;
L
Linus Torvalds 已提交
1656

1657
	mutex_init(&video->device_list_lock);
L
Linus Torvalds 已提交
1658 1659
	INIT_LIST_HEAD(&video->video_device_list);

1660 1661 1662
	error = acpi_video_bus_get_devices(video, device);
	if (error)
		goto err_free_video;
L
Linus Torvalds 已提交
1663

1664
	video->input = input = input_allocate_device();
1665 1666
	if (!input) {
		error = -ENOMEM;
1667
		goto err_put_video;
1668
	}
1669

1670 1671 1672 1673
	error = acpi_video_bus_start_devices(video);
	if (error)
		goto err_free_input_dev;

1674 1675 1676 1677 1678 1679 1680
	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;
1681
	input->dev.parent = &device->dev;
1682 1683 1684 1685 1686 1687 1688 1689 1690 1691
	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 已提交
1692
	printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
L
Len Brown 已提交
1693 1694 1695 1696
	       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 已提交
1697

1698 1699
	video->pm_nb.notifier_call = acpi_video_resume;
	video->pm_nb.priority = 0;
1700 1701
	error = register_pm_notifier(&video->pm_nb);
	if (error)
1702 1703 1704 1705 1706
		goto err_stop_video;

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

1708 1709
	return 0;

1710 1711
 err_unregister_pm_notifier:
	unregister_pm_notifier(&video->pm_nb);
1712 1713
 err_stop_video:
	acpi_video_bus_stop_devices(video);
1714 1715
 err_free_input_dev:
	input_free_device(input);
1716
 err_put_video:
1717 1718 1719 1720
	acpi_video_bus_put_devices(video);
	kfree(video->attached_array);
 err_free_video:
	kfree(video);
1721
	device->driver_data = NULL;
L
Linus Torvalds 已提交
1722

1723
	return error;
L
Linus Torvalds 已提交
1724 1725
}

L
Len Brown 已提交
1726
static int acpi_video_bus_remove(struct acpi_device *device, int type)
L
Linus Torvalds 已提交
1727
{
L
Len Brown 已提交
1728
	struct acpi_video_bus *video = NULL;
L
Linus Torvalds 已提交
1729 1730 1731


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

1734
	video = acpi_driver_data(device);
L
Linus Torvalds 已提交
1735

1736 1737
	unregister_pm_notifier(&video->pm_nb);

L
Linus Torvalds 已提交
1738 1739 1740
	acpi_video_bus_stop_devices(video);
	acpi_video_bus_put_devices(video);

1741
	input_unregister_device(video->input);
1742
	kfree(video->attached_array);
L
Linus Torvalds 已提交
1743 1744
	kfree(video);

1745
	return 0;
L
Linus Torvalds 已提交
1746 1747
}

1748 1749 1750 1751 1752 1753 1754 1755 1756
static int __init is_i740(struct pci_dev *dev)
{
	if (dev->device == 0x00D1)
		return 1;
	if (dev->device == 0x7000)
		return 1;
	return 0;
}

1757 1758
static int __init intel_opregion_present(void)
{
1759
	int opregion = 0;
1760 1761 1762 1763 1764 1765 1766 1767
	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;
1768 1769 1770
		/* We don't want to poke around undefined i740 registers */
		if (is_i740(dev))
			continue;
1771 1772 1773
		pci_read_config_dword(dev, 0xfc, &address);
		if (!address)
			continue;
1774
		opregion = 1;
1775
	}
1776
	return opregion;
1777 1778 1779
}

int acpi_video_register(void)
L
Linus Torvalds 已提交
1780
{
L
Len Brown 已提交
1781
	int result = 0;
1782 1783 1784 1785 1786 1787 1788
	if (register_count) {
		/*
		 * if the function of acpi_video_register is already called,
		 * don't register the acpi_vide_bus again and return no error.
		 */
		return 0;
	}
L
Linus Torvalds 已提交
1789 1790

	result = acpi_bus_register_driver(&acpi_video_bus);
1791
	if (result < 0)
1792
		return -ENODEV;
L
Linus Torvalds 已提交
1793

1794 1795 1796 1797 1798 1799
	/*
	 * When the acpi_video_bus is loaded successfully, increase
	 * the counter reference.
	 */
	register_count = 1;

1800
	return 0;
L
Linus Torvalds 已提交
1801
}
1802 1803
EXPORT_SYMBOL(acpi_video_register);

1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820
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);

1821 1822 1823 1824 1825 1826 1827 1828 1829
/*
 * 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)
{
1830 1831
	dmi_check_system(video_dmi_table);

1832 1833 1834 1835 1836
	if (intel_opregion_present())
		return 0;

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

1838
static void __exit acpi_video_exit(void)
L
Linus Torvalds 已提交
1839
{
1840
	acpi_video_unregister();
L
Linus Torvalds 已提交
1841

1842
	return;
L
Linus Torvalds 已提交
1843 1844 1845 1846
}

module_init(acpi_video_init);
module_exit(acpi_video_exit);