video.c 49.5 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;
92 93
static struct mutex video_list_lock;
static struct list_head video_bus_head;
L
Len Brown 已提交
94
static int acpi_video_bus_add(struct acpi_device *device);
95
static int acpi_video_bus_remove(struct acpi_device *device);
96
static void acpi_video_bus_notify(struct acpi_device *device, u32 event);
L
Linus Torvalds 已提交
97

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

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

struct acpi_video_bus_flags {
L
Len Brown 已提交
116 117 118 119
	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 已提交
120 121 122
};

struct acpi_video_bus_cap {
123 124 125 126 127 128
	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 已提交
129
	u8 reserved:2;
L
Linus Torvalds 已提交
130 131
};

L
Len Brown 已提交
132 133
struct acpi_video_device_attrib {
	u32 display_index:4;	/* A zero-based instance of the Display */
134 135 136 137 138
	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 已提交
139
				   the VGA device. */
140 141 142
	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 已提交
143 144 145 146 147
};

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

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

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

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

188 189
struct acpi_video_brightness_flags {
	u8 _BCL_no_ac_battery_levels:1;	/* no AC/Battery levels in _BCL */
190
	u8 _BCL_reversed:1;		/* _BCL package is in a reversed order */
191
	u8 _BQC_use_index:1;		/* _BQC returns an index value */
192 193
};

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

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

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

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

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

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

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

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

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

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

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

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

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

	return -EINVAL;
}

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

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

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

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

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

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


	*levels = NULL;

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

	*levels = obj;

349
	return 0;
L
Linus Torvalds 已提交
350

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

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

static int
L
Len Brown 已提交
358
acpi_video_device_lcd_set_level(struct acpi_video_device *device, int level)
L
Linus Torvalds 已提交
359
{
360
	int status;
361
	int state;
L
Linus Torvalds 已提交
362

363 364
	status = acpi_execute_simple_method(device->dev->handle,
					    "_BCM", level);
365 366 367 368 369
	if (ACPI_FAILURE(status)) {
		ACPI_ERROR((AE_INFO, "Evaluating _BCM failed"));
		return -EIO;
	}

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

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

382 383 384 385 386 387 388 389 390 391 392 393
/*
 * 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;
}

394 395 396 397 398 399
static int video_ignore_initial_backlight(const struct dmi_system_id *d)
{
	use_bios_initial_backlight = 0;
	return 0;
}

400 401 402 403 404 405 406 407 408 409 410 411
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"),
		},
	},
412 413 414 415 416 417 418 419
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 5710Z",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5710Z"),
		},
	},
420 421 422 423 424 425 426 427
	{
	 .callback = video_set_bqc_offset,
	 .ident = "eMachines E510",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "EMACHINES"),
		DMI_MATCH(DMI_PRODUCT_NAME, "eMachines E510"),
		},
	},
428 429 430 431 432 433 434 435
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 5315",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5315"),
		},
	},
436 437 438 439 440 441 442 443
	{
	 .callback = video_set_bqc_offset,
	 .ident = "Acer Aspire 7720",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 7720"),
		},
	},
444 445 446 447 448 449 450 451
	{
	 .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"),
		},
	},
452 453 454 455 456 457 458 459
	{
	 .callback = video_ignore_initial_backlight,
	 .ident = "Fujitsu E753",
	 .matches = {
		DMI_MATCH(DMI_BOARD_VENDOR, "FUJITSU"),
		DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK E753"),
		},
	},
460 461 462 463 464 465 466 467
	{
	 .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"),
		},
	},
468 469 470 471 472 473 474 475
	{
	 .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"),
		},
	},
476 477 478 479 480 481 482 483
	{
	 .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"),
		},
	},
484 485 486 487 488 489 490 491
	{
	 .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"),
		},
	},
492 493 494
	{}
};

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
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 已提交
520
static int
L
Len Brown 已提交
521
acpi_video_device_lcd_get_level_current(struct acpi_video_device *device,
522
					unsigned long long *level, bool raw)
L
Linus Torvalds 已提交
523
{
524
	acpi_status status = AE_OK;
525
	int i;
526

527 528 529 530
	if (device->cap._BQC || device->cap._BCQ) {
		char *buf = device->cap._BQC ? "_BQC" : "_BCQ";

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

542
			*level = acpi_video_bqc_value_to_level(device, *level);
543

544 545 546 547
			for (i = 2; i < device->brightness->count; i++)
				if (device->brightness->levels[i] == *level) {
					device->brightness->curr = *level;
					return 0;
548
				}
549 550 551 552 553 554 555 556
			/*
			 * 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;
557
		} else {
558 559
			/*
			 * Fixme:
560 561 562 563 564 565
			 * 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
			 */
566 567
			ACPI_WARNING((AE_INFO, "Evaluating %s failed", buf));
			device->cap._BQC = device->cap._BCQ = 0;
568 569 570
		}
	}

571
	*level = device->brightness->curr;
572
	return 0;
L
Linus Torvalds 已提交
573 574 575
}

static int
L
Len Brown 已提交
576 577
acpi_video_device_EDID(struct acpi_video_device *device,
		       union acpi_object **edid, ssize_t length)
L
Linus Torvalds 已提交
578
{
L
Len Brown 已提交
579 580 581 582 583
	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 已提交
584 585 586 587 588


	*edid = NULL;

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

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

601
	obj = buffer.pointer;
L
Linus Torvalds 已提交
602 603 604 605

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

611
	return status;
L
Linus Torvalds 已提交
612 613 614 615 616 617
}

/* bus */

/*
 *  Arg:
618 619
 *	video		: video bus device pointer
 *	bios_flag	:
L
Linus Torvalds 已提交
620 621 622
 *		0.	The system BIOS should NOT automatically switch(toggle)
 *			the active display output.
 *		1.	The system BIOS should automatically switch (toggle) the
623
 *			active display output. No switch event.
L
Linus Torvalds 已提交
624 625 626 627 628 629
 *		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
630
 *			of the LCD when the power changes from AC to DC
631
 *		1.	The system BIOS should NOT automatically control the brightness
632
 *			level of the LCD when the power changes from AC to DC.
633
 *  Return Value:
634
 *		-EINVAL	wrong arg.
L
Linus Torvalds 已提交
635 636 637
 */

static int
L
Len Brown 已提交
638
acpi_video_bus_DOS(struct acpi_video_bus *video, int bios_flag, int lcd_flag)
L
Linus Torvalds 已提交
639
{
640
	acpi_status status;
L
Linus Torvalds 已提交
641

642 643
	if (!video->cap._DOS)
		return 0;
L
Linus Torvalds 已提交
644

645 646
	if (bios_flag < 0 || bios_flag > 3 || lcd_flag < 0 || lcd_flag > 1)
		return -EINVAL;
647 648 649
	video->dos_setting = (lcd_flag << 2) | bios_flag;
	status = acpi_execute_simple_method(video->device->handle, "_DOS",
					    (lcd_flag << 2) | bios_flag);
650 651
	if (ACPI_FAILURE(status))
		return -EIO;
L
Linus Torvalds 已提交
652

653
	return 0;
L
Linus Torvalds 已提交
654 655
}

656 657 658 659 660 661 662 663 664 665
/*
 * 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;
}

666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688
/*
 * 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.
	 */
689
	test_level = current_level == max_level ? br->levels[3] : max_level;
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

	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 已提交
716
/*
717 718
 *  Arg:
 *	device	: video output device (LCD, CRT, ..)
L
Linus Torvalds 已提交
719 720
 *
 *  Return Value:
721 722 723 724 725 726 727 728 729
 *	Maximum brightness level
 *
 *  Allocate and initialize device->brightness.
 */

static int
acpi_video_init_brightness(struct acpi_video_device *device)
{
	union acpi_object *obj = NULL;
730
	int i, max_level = 0, count = 0, level_ac_battery = 0;
731
	unsigned long long level, level_old;
732 733
	union acpi_object *o;
	struct acpi_video_device_brightness *br = NULL;
734
	int result = -EINVAL;
735 736 737 738 739 740 741 742 743 744 745 746 747

	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");
748
		result = -ENOMEM;
749 750 751
		goto out;
	}

752
	br->levels = kmalloc((obj->package.count + 2) * sizeof *(br->levels),
753
				GFP_KERNEL);
754 755
	if (!br->levels) {
		result = -ENOMEM;
756
		goto out_free;
757
	}
758 759 760 761 762 763 764 765 766 767 768 769 770 771

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

772 773 774 775 776 777
	/*
	 * 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.
	 */
778 779
	for (i = 2; i < count; i++) {
		if (br->levels[i] == br->levels[0])
780
			level_ac_battery++;
781 782 783
		if (br->levels[i] == br->levels[1])
			level_ac_battery++;
	}
784 785 786 787 788 789 790 791

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

794 795 796 797 798 799 800
	/* 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,
801
			    "Found unordered _BCL package"));
802 803 804

	br->count = count;
	device->brightness = br;
805 806

	/* _BQC uses INDEX while _BCL uses VALUE in some laptops */
807
	br->curr = level = max_level;
808 809 810 811

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

812 813
	result = acpi_video_device_lcd_get_level_current(device,
							 &level_old, true);
814 815 816
	if (result)
		goto out_free_levels;

817
	result = acpi_video_bqc_quirk(device, max_level, level_old);
818 819
	if (result)
		goto out_free_levels;
820 821 822 823 824 825
	/*
	 * 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;
826

827 828
	if (use_bios_initial_backlight) {
		level = acpi_video_bqc_value_to_level(device, level_old);
829
		/*
830 831 832 833
		 * 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.
834
		 */
835 836 837 838 839
		for (i = 2; i < br->count; i++)
			if (level_old == br->levels[i])
				break;
		if (i == br->count)
			level = max_level;
840
	}
841 842

set_level:
843
	result = acpi_video_device_lcd_set_level(device, level);
844 845
	if (result)
		goto out_free_levels;
846

847 848
	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
			  "found %d brightness levels\n", count - 2));
849
	kfree(obj);
850
	return result;
851 852 853 854 855 856 857 858

out_free_levels:
	kfree(br->levels);
out_free:
	kfree(br);
out:
	device->brightness = NULL;
	kfree(obj);
859
	return result;
860 861 862 863 864 865 866
}

/*
 *  Arg:
 *	device	: video output device (LCD, CRT, ..)
 *
 *  Return Value:
867
 *	None
L
Linus Torvalds 已提交
868
 *
869
 *  Find out all required AML methods defined under the output
L
Linus Torvalds 已提交
870 871 872
 *  device.
 */

L
Len Brown 已提交
873
static void acpi_video_device_find_cap(struct acpi_video_device *device)
L
Linus Torvalds 已提交
874
{
875
	if (acpi_has_method(device->dev->handle, "_ADR"))
L
Linus Torvalds 已提交
876
		device->cap._ADR = 1;
877
	if (acpi_has_method(device->dev->handle, "_BCL"))
L
Len Brown 已提交
878
		device->cap._BCL = 1;
879
	if (acpi_has_method(device->dev->handle, "_BCM"))
L
Len Brown 已提交
880
		device->cap._BCM = 1;
881
	if (acpi_has_method(device->dev->handle, "_BQC")) {
882
		device->cap._BQC = 1;
883
	} else if (acpi_has_method(device->dev->handle, "_BCQ")) {
884 885 886 887
		printk(KERN_WARNING FW_BUG "_BCQ is used instead of _BQC\n");
		device->cap._BCQ = 1;
	}

888
	if (acpi_has_method(device->dev->handle, "_DDC"))
L
Len Brown 已提交
889
		device->cap._DDC = 1;
L
Linus Torvalds 已提交
890 891 892
}

/*
893 894
 *  Arg:
 *	device	: video output device (VGA)
L
Linus Torvalds 已提交
895 896
 *
 *  Return Value:
897
 *	None
L
Linus Torvalds 已提交
898
 *
899
 *  Find out all required AML methods defined under the video bus device.
L
Linus Torvalds 已提交
900 901
 */

L
Len Brown 已提交
902
static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
903
{
904
	if (acpi_has_method(video->device->handle, "_DOS"))
L
Linus Torvalds 已提交
905
		video->cap._DOS = 1;
906
	if (acpi_has_method(video->device->handle, "_DOD"))
L
Linus Torvalds 已提交
907
		video->cap._DOD = 1;
908
	if (acpi_has_method(video->device->handle, "_ROM"))
L
Linus Torvalds 已提交
909
		video->cap._ROM = 1;
910
	if (acpi_has_method(video->device->handle, "_GPD"))
L
Linus Torvalds 已提交
911
		video->cap._GPD = 1;
912
	if (acpi_has_method(video->device->handle, "_SPD"))
L
Linus Torvalds 已提交
913
		video->cap._SPD = 1;
914
	if (acpi_has_method(video->device->handle, "_VPO"))
L
Linus Torvalds 已提交
915 916 917 918 919 920 921 922
		video->cap._VPO = 1;
}

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

L
Len Brown 已提交
923
static int acpi_video_bus_check(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
924
{
L
Len Brown 已提交
925
	acpi_status status = -ENOENT;
926
	struct pci_dev *dev;
L
Linus Torvalds 已提交
927 928

	if (!video)
929
		return -EINVAL;
L
Linus Torvalds 已提交
930

931
	dev = acpi_get_pci_dev(video->device->handle);
932 933
	if (!dev)
		return -ENODEV;
934
	pci_dev_put(dev);
935

936 937
	/*
	 * Since there is no HID, CID and so on for VGA driver, we have
L
Linus Torvalds 已提交
938 939 940
	 * to check well known required nodes.
	 */

941
	/* Does this device support video switching? */
942 943 944 945 946 947
	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 已提交
948 949 950 951
		video->flags.multihead = 1;
		status = 0;
	}

952
	/* Does this device support retrieving a video ROM? */
L
Len Brown 已提交
953
	if (video->cap._ROM) {
L
Linus Torvalds 已提交
954 955 956 957
		video->flags.rom = 1;
		status = 0;
	}

958
	/* Does this device support configuring which video device to POST? */
L
Len Brown 已提交
959
	if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
L
Linus Torvalds 已提交
960 961 962 963
		video->flags.post = 1;
		status = 0;
	}

964
	return status;
L
Linus Torvalds 已提交
965 966
}

967 968 969 970 971
/*
 * --------------------------------------------------------------------------
 *                               Driver Interface
 * --------------------------------------------------------------------------
 */
L
Linus Torvalds 已提交
972 973

/* device interface */
974
static struct acpi_video_device_attrib *
975 976
acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
{
977 978 979 980 981 982 983 984
	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;
	}
985 986 987

	return NULL;
}
L
Linus Torvalds 已提交
988

989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004
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 已提交
1005
static int
L
Len Brown 已提交
1006 1007
acpi_video_bus_get_one_device(struct acpi_device *device,
			      struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1008
{
1009
	unsigned long long device_id;
1010
	int status, device_type;
L
Len Brown 已提交
1011
	struct acpi_video_device *data;
1012
	struct acpi_video_device_attrib *attribute;
L
Linus Torvalds 已提交
1013

L
Len Brown 已提交
1014 1015
	status =
	    acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
1016 1017 1018
	/* Some device omits _ADR, we skip them instead of fail */
	if (ACPI_FAILURE(status))
		return 0;
L
Linus Torvalds 已提交
1019

1020 1021 1022
	data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
	if (!data)
		return -ENOMEM;
1023

1024 1025 1026 1027 1028 1029 1030 1031 1032 1033
	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);

1034
	if (attribute && attribute->device_id_scheme) {
1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051
		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;
		}
1052
		if (attribute->bios_can_detect)
1053 1054 1055 1056 1057 1058
			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) {
1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069
		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;
1070
		}
1071
	}
L
Len Brown 已提交
1072

1073 1074
	acpi_video_device_bind(video, data);
	acpi_video_device_find_cap(data);
L
Linus Torvalds 已提交
1075

1076 1077 1078
	mutex_lock(&video->device_list_lock);
	list_add_tail(&data->entry, &video->video_device_list);
	mutex_unlock(&video->device_list_lock);
L
Linus Torvalds 已提交
1079

1080
	return status;
L
Linus Torvalds 已提交
1081 1082 1083 1084
}

/*
 *  Arg:
1085
 *	video	: video bus device
L
Linus Torvalds 已提交
1086 1087
 *
 *  Return:
1088 1089 1090
 *	none
 *
 *  Enumerate the video device list of the video bus,
L
Linus Torvalds 已提交
1091 1092
 *  bind the ids with the corresponding video devices
 *  under the video bus.
L
Len Brown 已提交
1093
 */
L
Linus Torvalds 已提交
1094

L
Len Brown 已提交
1095
static void acpi_video_device_rebind(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1096
{
1097 1098
	struct acpi_video_device *dev;

1099
	mutex_lock(&video->device_list_lock);
1100 1101

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

1104
	mutex_unlock(&video->device_list_lock);
L
Linus Torvalds 已提交
1105 1106 1107 1108
}

/*
 *  Arg:
1109 1110 1111
 *	video	: video bus device
 *	device	: video output device under the video
 *		bus
L
Linus Torvalds 已提交
1112 1113
 *
 *  Return:
1114 1115
 *	none
 *
L
Linus Torvalds 已提交
1116 1117
 *  Bind the ids with the corresponding video devices
 *  under the video bus.
L
Len Brown 已提交
1118
 */
L
Linus Torvalds 已提交
1119 1120

static void
L
Len Brown 已提交
1121 1122
acpi_video_device_bind(struct acpi_video_bus *video,
		       struct acpi_video_device *device)
L
Linus Torvalds 已提交
1123
{
1124
	struct acpi_video_enumerated_device *ids;
L
Len Brown 已提交
1125
	int i;
L
Linus Torvalds 已提交
1126

1127 1128 1129 1130
	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 已提交
1131 1132 1133 1134 1135 1136 1137
			ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
		}
	}
}

/*
 *  Arg:
1138
 *	video	: video bus device
L
Linus Torvalds 已提交
1139 1140
 *
 *  Return:
1141 1142
 *	< 0	: error
 *
L
Linus Torvalds 已提交
1143 1144
 *  Call _DOD to enumerate all devices attached to display adapter
 *
L
Len Brown 已提交
1145
 */
L
Linus Torvalds 已提交
1146 1147 1148

static int acpi_video_device_enumerate(struct acpi_video_bus *video)
{
L
Len Brown 已提交
1149 1150 1151
	int status;
	int count;
	int i;
1152
	struct acpi_video_enumerated_device *active_list;
L
Len Brown 已提交
1153 1154 1155
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *dod = NULL;
	union acpi_object *obj;
L
Linus Torvalds 已提交
1156

1157
	status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
L
Linus Torvalds 已提交
1158
	if (!ACPI_SUCCESS(status)) {
1159
		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1160
		return status;
L
Linus Torvalds 已提交
1161 1162
	}

1163
	dod = buffer.pointer;
L
Linus Torvalds 已提交
1164
	if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1165
		ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
L
Linus Torvalds 已提交
1166 1167 1168 1169 1170
		status = -EFAULT;
		goto out;
	}

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

1173 1174 1175 1176
	active_list = kcalloc(1 + dod->package.count,
			      sizeof(struct acpi_video_enumerated_device),
			      GFP_KERNEL);
	if (!active_list) {
L
Linus Torvalds 已提交
1177 1178 1179 1180 1181 1182
		status = -ENOMEM;
		goto out;
	}

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

		if (obj->type != ACPI_TYPE_INTEGER) {
1186 1187 1188
			printk(KERN_ERR PREFIX
				"Invalid _DOD data in element %d\n", i);
			continue;
L
Linus Torvalds 已提交
1189
		}
1190 1191 1192

		active_list[count].value.int_val = obj->integer.value;
		active_list[count].bind_info = NULL;
L
Len Brown 已提交
1193 1194
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
				  (int)obj->integer.value));
L
Linus Torvalds 已提交
1195 1196 1197
		count++;
	}

1198
	kfree(video->attached_array);
L
Len Brown 已提交
1199

1200
	video->attached_array = active_list;
L
Linus Torvalds 已提交
1201
	video->attached_count = count;
1202

1203
out:
1204
	kfree(buffer.pointer);
1205
	return status;
L
Linus Torvalds 已提交
1206 1207
}

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

1253
static int
L
Len Brown 已提交
1254
acpi_video_switch_brightness(struct acpi_video_device *device, int event)
L
Linus Torvalds 已提交
1255
{
1256
	unsigned long long level_current, level_next;
1257 1258
	int result = -EINVAL;

1259 1260
	/* no warning message if acpi_backlight=vendor is used */
	if (!acpi_video_backlight_support())
1261 1262
		return 0;

1263
	if (!device->brightness)
1264 1265 1266
		goto out;

	result = acpi_video_device_lcd_get_level_current(device,
1267 1268
							 &level_current,
							 false);
1269 1270 1271
	if (result)
		goto out;

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

1274
	result = acpi_video_device_lcd_set_level(device, level_next);
1275

1276 1277 1278 1279
	if (!result)
		backlight_force_update(device->backlight,
				       BACKLIGHT_UPDATE_HOTKEY);

1280 1281 1282 1283 1284
out:
	if (result)
		printk(KERN_ERR PREFIX "Failed to switch the brightness\n");

	return result;
L
Linus Torvalds 已提交
1285 1286
}

1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307
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;

1308 1309 1310
		if (!video_device->cap._DDC)
			continue;

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 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354
		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 已提交
1355
static int
L
Len Brown 已提交
1356 1357
acpi_video_bus_get_devices(struct acpi_video_bus *video,
			   struct acpi_device *device)
L
Linus Torvalds 已提交
1358
{
1359
	int status = 0;
1360
	struct acpi_device *dev;
L
Linus Torvalds 已提交
1361

1362 1363 1364 1365 1366 1367
	/*
	 * 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 已提交
1368

1369
	list_for_each_entry(dev, &device->children, node) {
L
Linus Torvalds 已提交
1370 1371

		status = acpi_video_bus_get_one_device(dev, video);
1372
		if (status) {
1373 1374
			dev_err(&dev->dev, "Can't attach device\n");
			break;
L
Linus Torvalds 已提交
1375 1376
		}
	}
1377
	return status;
L
Linus Torvalds 已提交
1378 1379 1380 1381
}

/* acpi_video interface */

1382 1383 1384 1385
/*
 * 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 已提交
1386
static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1387
{
1388 1389
	return acpi_video_bus_DOS(video, 0,
				  acpi_video_backlight_quirks() ? 1 : 0);
L
Linus Torvalds 已提交
1390 1391
}

L
Len Brown 已提交
1392
static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
L
Linus Torvalds 已提交
1393
{
1394 1395
	return acpi_video_bus_DOS(video, 0,
				  acpi_video_backlight_quirks() ? 0 : 1);
L
Linus Torvalds 已提交
1396 1397
}

1398
static void acpi_video_bus_notify(struct acpi_device *device, u32 event)
L
Linus Torvalds 已提交
1399
{
1400
	struct acpi_video_bus *video = acpi_driver_data(device);
1401
	struct input_dev *input;
1402
	int keycode = 0;
1403

1404
	if (!video || !video->input)
1405
		return;
L
Linus Torvalds 已提交
1406

1407
	input = video->input;
L
Linus Torvalds 已提交
1408 1409

	switch (event) {
1410
	case ACPI_VIDEO_NOTIFY_SWITCH:	/* User requested a switch,
L
Linus Torvalds 已提交
1411
					 * most likely via hotkey. */
1412
		keycode = KEY_SWITCHVIDEOMODE;
L
Linus Torvalds 已提交
1413 1414
		break;

1415
	case ACPI_VIDEO_NOTIFY_PROBE:	/* User plugged in or removed a video
L
Linus Torvalds 已提交
1416 1417 1418
					 * connector. */
		acpi_video_device_enumerate(video);
		acpi_video_device_rebind(video);
1419
		keycode = KEY_SWITCHVIDEOMODE;
L
Linus Torvalds 已提交
1420 1421
		break;

L
Len Brown 已提交
1422
	case ACPI_VIDEO_NOTIFY_CYCLE:	/* Cycle Display output hotkey pressed. */
1423 1424
		keycode = KEY_SWITCHVIDEOMODE;
		break;
L
Len Brown 已提交
1425
	case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:	/* Next Display output hotkey pressed. */
1426 1427
		keycode = KEY_VIDEO_NEXT;
		break;
L
Len Brown 已提交
1428
	case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:	/* previous Display output hotkey pressed. */
1429
		keycode = KEY_VIDEO_PREV;
L
Linus Torvalds 已提交
1430 1431 1432 1433
		break;

	default:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
1434
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
1435 1436 1437
		break;
	}

1438 1439 1440
	if (acpi_notifier_call_chain(device, event, 0))
		/* Something vetoed the keypress. */
		keycode = 0;
1441 1442 1443 1444 1445 1446 1447

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

1449
	return;
L
Linus Torvalds 已提交
1450 1451
}

L
Len Brown 已提交
1452
static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
L
Linus Torvalds 已提交
1453
{
1454
	struct acpi_video_device *video_device = data;
L
Len Brown 已提交
1455
	struct acpi_device *device = NULL;
1456 1457
	struct acpi_video_bus *bus;
	struct input_dev *input;
1458
	int keycode = 0;
L
Linus Torvalds 已提交
1459 1460

	if (!video_device)
1461
		return;
L
Linus Torvalds 已提交
1462

1463
	device = video_device->dev;
1464 1465
	bus = video_device->video;
	input = bus->input;
L
Linus Torvalds 已提交
1466 1467

	switch (event) {
L
Len Brown 已提交
1468
	case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:	/* Cycle brightness */
1469 1470
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
1471 1472
		keycode = KEY_BRIGHTNESS_CYCLE;
		break;
L
Len Brown 已提交
1473
	case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:	/* Increase brightness */
1474 1475
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
1476 1477
		keycode = KEY_BRIGHTNESSUP;
		break;
L
Len Brown 已提交
1478
	case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:	/* Decrease brightness */
1479 1480
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
1481 1482
		keycode = KEY_BRIGHTNESSDOWN;
		break;
1483
	case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:	/* zero brightness */
1484 1485
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
1486 1487
		keycode = KEY_BRIGHTNESS_ZERO;
		break;
L
Len Brown 已提交
1488
	case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:	/* display device off */
1489 1490
		if (brightness_switch_enabled)
			acpi_video_switch_brightness(video_device, event);
1491
		keycode = KEY_DISPLAY_OFF;
L
Linus Torvalds 已提交
1492 1493 1494
		break;
	default:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
1495
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
1496 1497
		break;
	}
1498

1499
	acpi_notifier_call_chain(device, event, 0);
1500 1501 1502 1503 1504 1505 1506

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

1508
	return;
L
Linus Torvalds 已提交
1509 1510
}

1511 1512
static int acpi_video_resume(struct notifier_block *nb,
				unsigned long val, void *ign)
1513 1514 1515 1516 1517
{
	struct acpi_video_bus *video;
	struct acpi_video_device *video_device;
	int i;

1518 1519 1520 1521 1522 1523
	switch (val) {
	case PM_HIBERNATION_PREPARE:
	case PM_SUSPEND_PREPARE:
	case PM_RESTORE_PREPARE:
		return NOTIFY_DONE;
	}
1524

1525 1526 1527
	video = container_of(nb, struct acpi_video_bus, pm_nb);

	dev_info(&video->device->dev, "Restoring backlight state\n");
1528 1529 1530 1531 1532 1533

	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);
	}
1534 1535

	return NOTIFY_OK;
1536 1537
}

1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558
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;
}

1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783
static void acpi_video_dev_register_backlight(struct acpi_video_device *device)
{
	if (acpi_video_backlight_support()) {
		struct backlight_properties props;
		struct pci_dev *pdev;
		acpi_handle acpi_parent;
		struct device *parent = NULL;
		int result;
		static int count;
		char *name;

		result = acpi_video_init_brightness(device);
		if (result)
			return;
		name = kasprintf(GFP_KERNEL, "acpi_video%d", count);
		if (!name)
			return;
		count++;

		acpi_get_parent(device->dev->handle, &acpi_parent);

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

		memset(&props, 0, sizeof(struct backlight_properties));
		props.type = BACKLIGHT_FIRMWARE;
		props.max_brightness = device->brightness->count - 3;
		device->backlight = backlight_device_register(name,
							      parent,
							      device,
							      &acpi_backlight_ops,
							      &props);
		kfree(name);
		if (IS_ERR(device->backlight))
			return;

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

		device->cooling_dev = thermal_cooling_device_register("LCD",
					device->dev, &video_cooling_ops);
		if (IS_ERR(device->cooling_dev)) {
			/*
			 * Set cooling_dev to NULL so we don't crash trying to
			 * free it.
			 * Also, why the hell we are returning early and
			 * not attempt to register video output if cooling
			 * device registration failed?
			 * -- dtor
			 */
			device->cooling_dev = NULL;
			return;
		}

		dev_info(&device->dev->dev, "registered as cooling_device%d\n",
			 device->cooling_dev->id);
		result = sysfs_create_link(&device->dev->dev.kobj,
				&device->cooling_dev->device.kobj,
				"thermal_cooling");
		if (result)
			printk(KERN_ERR PREFIX "Create sysfs link\n");
		result = sysfs_create_link(&device->cooling_dev->device.kobj,
				&device->dev->dev.kobj, "device");
		if (result)
			printk(KERN_ERR PREFIX "Create sysfs link\n");
	}
}

static int acpi_video_bus_register_backlight(struct acpi_video_bus *video)
{
	struct acpi_video_device *dev;

	mutex_lock(&video->device_list_lock);
	list_for_each_entry(dev, &video->video_device_list, entry)
		acpi_video_dev_register_backlight(dev);
	mutex_unlock(&video->device_list_lock);

	video->pm_nb.notifier_call = acpi_video_resume;
	video->pm_nb.priority = 0;
	return register_pm_notifier(&video->pm_nb);
}

static void acpi_video_dev_unregister_backlight(struct acpi_video_device *device)
{
	if (device->backlight) {
		backlight_device_unregister(device->backlight);
		device->backlight = NULL;
	}
	if (device->brightness) {
		kfree(device->brightness->levels);
		kfree(device->brightness);
		device->brightness = NULL;
	}
	if (device->cooling_dev) {
		sysfs_remove_link(&device->dev->dev.kobj, "thermal_cooling");
		sysfs_remove_link(&device->cooling_dev->device.kobj, "device");
		thermal_cooling_device_unregister(device->cooling_dev);
		device->cooling_dev = NULL;
	}
}

static int acpi_video_bus_unregister_backlight(struct acpi_video_bus *video)
{
	struct acpi_video_device *dev;
	int error = unregister_pm_notifier(&video->pm_nb);

	mutex_lock(&video->device_list_lock);
	list_for_each_entry(dev, &video->video_device_list, entry)
		acpi_video_dev_unregister_backlight(dev);
	mutex_unlock(&video->device_list_lock);

	return error;
}

static void acpi_video_dev_add_notify_handler(struct acpi_video_device *device)
{
	acpi_status status;
	struct acpi_device *adev = device->dev;

	status = acpi_install_notify_handler(adev->handle, ACPI_DEVICE_NOTIFY,
					     acpi_video_device_notify, device);
	if (ACPI_FAILURE(status))
		dev_err(&adev->dev, "Error installing notify handler\n");
	else
		device->flags.notify = 1;
}

static int acpi_video_bus_add_notify_handler(struct acpi_video_bus *video)
{
	struct input_dev *input;
	struct acpi_video_device *dev;
	int error;

	video->input = input = input_allocate_device();
	if (!input) {
		error = -ENOMEM;
		goto out;
	}

	error = acpi_video_bus_start_devices(video);
	if (error)
		goto err_free_input;

	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;
	input->dev.parent = &video->device->dev;
	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);

	error = input_register_device(input);
	if (error)
		goto err_stop_dev;

	mutex_lock(&video->device_list_lock);
	list_for_each_entry(dev, &video->video_device_list, entry)
		acpi_video_dev_add_notify_handler(dev);
	mutex_unlock(&video->device_list_lock);

	return 0;

err_stop_dev:
	acpi_video_bus_stop_devices(video);
err_free_input:
	input_free_device(input);
	video->input = NULL;
out:
	return error;
}

static void acpi_video_dev_remove_notify_handler(struct acpi_video_device *dev)
{
	if (dev->flags.notify) {
		acpi_remove_notify_handler(dev->dev->handle, ACPI_DEVICE_NOTIFY,
					   acpi_video_device_notify);
		dev->flags.notify = 0;
	}
}

static void acpi_video_bus_remove_notify_handler(struct acpi_video_bus *video)
{
	struct acpi_video_device *dev;

	mutex_lock(&video->device_list_lock);
	list_for_each_entry(dev, &video->video_device_list, entry)
		acpi_video_dev_remove_notify_handler(dev);
	mutex_unlock(&video->device_list_lock);

	acpi_video_bus_stop_devices(video);
	input_unregister_device(video->input);
	video->input = NULL;
}

static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
{
	struct acpi_video_device *dev, *next;

	mutex_lock(&video->device_list_lock);
	list_for_each_entry_safe(dev, next, &video->video_device_list, entry) {
		list_del(&dev->entry);
		kfree(dev);
	}
	mutex_unlock(&video->device_list_lock);

	return 0;
}

1784 1785
static int instance;

L
Len Brown 已提交
1786
static int acpi_video_bus_add(struct acpi_device *device)
L
Linus Torvalds 已提交
1787
{
1788 1789
	struct acpi_video_bus *video;
	int error;
1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804
	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 已提交
1805

1806
	video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
L
Linus Torvalds 已提交
1807
	if (!video)
1808
		return -ENOMEM;
L
Linus Torvalds 已提交
1809

1810 1811 1812 1813
	/* 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;
1814
		instance++;
1815
	}
1816 1817 1818 1819 1820 1821
	/* 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++;
	}
1822

1823
	video->device = device;
L
Linus Torvalds 已提交
1824 1825
	strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
	strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1826
	device->driver_data = video;
L
Linus Torvalds 已提交
1827 1828

	acpi_video_bus_find_cap(video);
1829 1830 1831
	error = acpi_video_bus_check(video);
	if (error)
		goto err_free_video;
L
Linus Torvalds 已提交
1832

1833
	mutex_init(&video->device_list_lock);
L
Linus Torvalds 已提交
1834 1835
	INIT_LIST_HEAD(&video->video_device_list);

1836 1837
	error = acpi_video_bus_get_devices(video, device);
	if (error)
1838
		goto err_put_video;
L
Linus Torvalds 已提交
1839 1840

	printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
L
Len Brown 已提交
1841 1842 1843 1844
	       ACPI_VIDEO_DEVICE_NAME, acpi_device_bid(device),
	       video->flags.multihead ? "yes" : "no",
	       video->flags.rom ? "yes" : "no",
	       video->flags.post ? "yes" : "no");
1845 1846 1847
	mutex_lock(&video_list_lock);
	list_add_tail(&video->entry, &video_bus_head);
	mutex_unlock(&video_list_lock);
L
Linus Torvalds 已提交
1848

1849 1850
	acpi_video_bus_register_backlight(video);
	acpi_video_bus_add_notify_handler(video);
1851

1852 1853
	return 0;

1854
err_put_video:
1855 1856
	acpi_video_bus_put_devices(video);
	kfree(video->attached_array);
1857
err_free_video:
1858
	kfree(video);
1859
	device->driver_data = NULL;
L
Linus Torvalds 已提交
1860

1861
	return error;
L
Linus Torvalds 已提交
1862 1863
}

1864
static int acpi_video_bus_remove(struct acpi_device *device)
L
Linus Torvalds 已提交
1865
{
L
Len Brown 已提交
1866
	struct acpi_video_bus *video = NULL;
L
Linus Torvalds 已提交
1867 1868 1869


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

1872
	video = acpi_driver_data(device);
L
Linus Torvalds 已提交
1873

1874 1875
	acpi_video_bus_remove_notify_handler(video);
	acpi_video_bus_unregister_backlight(video);
L
Linus Torvalds 已提交
1876 1877
	acpi_video_bus_put_devices(video);

1878 1879 1880 1881
	mutex_lock(&video_list_lock);
	list_del(&video->entry);
	mutex_unlock(&video_list_lock);

1882
	kfree(video->attached_array);
L
Linus Torvalds 已提交
1883 1884
	kfree(video);

1885
	return 0;
L
Linus Torvalds 已提交
1886 1887
}

1888 1889 1890 1891 1892 1893 1894 1895 1896
static int __init is_i740(struct pci_dev *dev)
{
	if (dev->device == 0x00D1)
		return 1;
	if (dev->device == 0x7000)
		return 1;
	return 0;
}

1897 1898
static int __init intel_opregion_present(void)
{
1899
	int opregion = 0;
1900 1901 1902 1903 1904 1905 1906 1907
	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;
1908 1909 1910
		/* We don't want to poke around undefined i740 registers */
		if (is_i740(dev))
			continue;
1911 1912 1913
		pci_read_config_dword(dev, 0xfc, &address);
		if (!address)
			continue;
1914
		opregion = 1;
1915
	}
1916
	return opregion;
1917 1918
}

1919
int acpi_video_register(void)
L
Linus Torvalds 已提交
1920
{
1921
	int result = 0;
1922 1923
	if (register_count) {
		/*
1924 1925
		 * if the function of acpi_video_register is already called,
		 * don't register the acpi_vide_bus again and return no error.
1926 1927 1928
		 */
		return 0;
	}
L
Linus Torvalds 已提交
1929

1930 1931 1932
	mutex_init(&video_list_lock);
	INIT_LIST_HEAD(&video_bus_head);

L
Linus Torvalds 已提交
1933
	result = acpi_bus_register_driver(&acpi_video_bus);
1934
	if (result < 0)
1935
		return -ENODEV;
L
Linus Torvalds 已提交
1936

1937 1938 1939 1940 1941 1942
	/*
	 * When the acpi_video_bus is loaded successfully, increase
	 * the counter reference.
	 */
	register_count = 1;

1943
	return 0;
L
Linus Torvalds 已提交
1944
}
1945
EXPORT_SYMBOL(acpi_video_register);
1946

1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963
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);

1964 1965 1966 1967 1968 1969 1970 1971 1972
/*
 * 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)
{
1973 1974
	dmi_check_system(video_dmi_table);

1975 1976 1977 1978 1979
	if (intel_opregion_present())
		return 0;

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

1981
static void __exit acpi_video_exit(void)
L
Linus Torvalds 已提交
1982
{
1983
	acpi_video_unregister();
L
Linus Torvalds 已提交
1984

1985
	return;
L
Linus Torvalds 已提交
1986 1987 1988 1989
}

module_init(acpi_video_init);
module_exit(acpi_video_exit);