1 /*
2  *  video.c - ACPI Video Driver ($Revision:$)
3  *
4  *  Copyright (C) 2004 Luming Yu <luming.yu@intel.com>
5  *  Copyright (C) 2004 Bruno Ducrot <ducrot@poupinou.org>
6  *  Copyright (C) 2006 Thomas Tuttle <linux-kernel@ttuttle.net>
7  *
8  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
9  *
10  *  This program is free software; you can redistribute it and/or modify
11  *  it under the terms of the GNU General Public License as published by
12  *  the Free Software Foundation; either version 2 of the License, or (at
13  *  your option) any later version.
14  *
15  *  This program is distributed in the hope that it will be useful, but
16  *  WITHOUT ANY WARRANTY; without even the implied warranty of
17  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
18  *  General Public License for more details.
19  *
20  *  You should have received a copy of the GNU General Public License along
21  *  with this program; if not, write to the Free Software Foundation, Inc.,
22  *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
23  *
24  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
25  */
26 
27 #include <linux/kernel.h>
28 #include <linux/module.h>
29 #include <linux/init.h>
30 #include <linux/types.h>
31 #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 #include <linux/pci.h>
38 #include <linux/pci_ids.h>
39 #include <linux/slab.h>
40 #include <asm/uaccess.h>
41 #include <linux/dmi.h>
42 #include <acpi/acpi_bus.h>
43 #include <acpi/acpi_drivers.h>
44 #include <linux/suspend.h>
45 #include <acpi/video.h>
46 
47 #define PREFIX "ACPI: "
48 
49 #define ACPI_VIDEO_BUS_NAME		"Video Bus"
50 #define ACPI_VIDEO_DEVICE_NAME		"Video Device"
51 #define ACPI_VIDEO_NOTIFY_SWITCH	0x80
52 #define ACPI_VIDEO_NOTIFY_PROBE		0x81
53 #define ACPI_VIDEO_NOTIFY_CYCLE		0x82
54 #define ACPI_VIDEO_NOTIFY_NEXT_OUTPUT	0x83
55 #define ACPI_VIDEO_NOTIFY_PREV_OUTPUT	0x84
56 
57 #define ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS	0x85
58 #define	ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS	0x86
59 #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS	0x87
60 #define ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS	0x88
61 #define ACPI_VIDEO_NOTIFY_DISPLAY_OFF		0x89
62 
63 #define MAX_NAME_LEN	20
64 
65 #define _COMPONENT		ACPI_VIDEO_COMPONENT
66 ACPI_MODULE_NAME("video");
67 
68 MODULE_AUTHOR("Bruno Ducrot");
69 MODULE_DESCRIPTION("ACPI Video Driver");
70 MODULE_LICENSE("GPL");
71 
72 static bool brightness_switch_enabled = 1;
73 module_param(brightness_switch_enabled, bool, 0644);
74 
75 /*
76  * By default, we don't allow duplicate ACPI video bus devices
77  * under the same VGA controller
78  */
79 static bool allow_duplicates;
80 module_param(allow_duplicates, bool, 0644);
81 
82 /*
83  * Some BIOSes claim they use minimum backlight at boot,
84  * and this may bring dimming screen after boot
85  */
86 static bool use_bios_initial_backlight = 1;
87 module_param(use_bios_initial_backlight, bool, 0644);
88 
89 static int register_count = 0;
90 static int acpi_video_bus_add(struct acpi_device *device);
91 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);
93 
94 static const struct acpi_device_id video_device_ids[] = {
95 	{ACPI_VIDEO_HID, 0},
96 	{"", 0},
97 };
98 MODULE_DEVICE_TABLE(acpi, video_device_ids);
99 
100 static struct acpi_driver acpi_video_bus = {
101 	.name = "video",
102 	.class = ACPI_VIDEO_CLASS,
103 	.ids = video_device_ids,
104 	.ops = {
105 		.add = acpi_video_bus_add,
106 		.remove = acpi_video_bus_remove,
107 		.notify = acpi_video_bus_notify,
108 		},
109 };
110 
111 struct acpi_video_bus_flags {
112 	u8 multihead:1;		/* can switch video heads */
113 	u8 rom:1;		/* can retrieve a video rom */
114 	u8 post:1;		/* can configure the head to */
115 	u8 reserved:5;
116 };
117 
118 struct acpi_video_bus_cap {
119 	u8 _DOS:1;		/*Enable/Disable output switching */
120 	u8 _DOD:1;		/*Enumerate all devices attached to display adapter */
121 	u8 _ROM:1;		/*Get ROM Data */
122 	u8 _GPD:1;		/*Get POST Device */
123 	u8 _SPD:1;		/*Set POST Device */
124 	u8 _VPO:1;		/*Video POST Options */
125 	u8 reserved:2;
126 };
127 
128 struct acpi_video_device_attrib {
129 	u32 display_index:4;	/* A zero-based instance of the Display */
130 	u32 display_port_attachment:4;	/*This field differentiates the display type */
131 	u32 display_type:4;	/*Describe the specific type in use */
132 	u32 vendor_specific:4;	/*Chipset Vendor Specific */
133 	u32 bios_can_detect:1;	/*BIOS can detect the device */
134 	u32 depend_on_vga:1;	/*Non-VGA output device whose power is related to
135 				   the VGA device. */
136 	u32 pipe_id:3;		/*For VGA multiple-head devices. */
137 	u32 reserved:10;	/*Must be 0 */
138 	u32 device_id_scheme:1;	/*Device ID Scheme */
139 };
140 
141 struct acpi_video_enumerated_device {
142 	union {
143 		u32 int_val;
144 		struct acpi_video_device_attrib attrib;
145 	} value;
146 	struct acpi_video_device *bind_info;
147 };
148 
149 struct acpi_video_bus {
150 	struct acpi_device *device;
151 	u8 dos_setting;
152 	struct acpi_video_enumerated_device *attached_array;
153 	u8 attached_count;
154 	struct acpi_video_bus_cap cap;
155 	struct acpi_video_bus_flags flags;
156 	struct list_head video_device_list;
157 	struct mutex device_list_lock;	/* protects video_device_list */
158 	struct input_dev *input;
159 	char phys[32];	/* for input device */
160 	struct notifier_block pm_nb;
161 };
162 
163 struct acpi_video_device_flags {
164 	u8 crt:1;
165 	u8 lcd:1;
166 	u8 tvout:1;
167 	u8 dvi:1;
168 	u8 bios:1;
169 	u8 unknown:1;
170 	u8 reserved:2;
171 };
172 
173 struct acpi_video_device_cap {
174 	u8 _ADR:1;		/*Return the unique ID */
175 	u8 _BCL:1;		/*Query list of brightness control levels supported */
176 	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 */
179 	u8 _DDC:1;		/*Return the EDID for this device */
180 };
181 
182 struct acpi_video_brightness_flags {
183 	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 	u8 _BCL_use_index:1;		/* levels in _BCL are index values */
186 	u8 _BCM_use_index:1;		/* input of _BCM is an index value */
187 	u8 _BQC_use_index:1;		/* _BQC returns an index value */
188 };
189 
190 struct acpi_video_device_brightness {
191 	int curr;
192 	int count;
193 	int *levels;
194 	struct acpi_video_brightness_flags flags;
195 };
196 
197 struct acpi_video_device {
198 	unsigned long device_id;
199 	struct acpi_video_device_flags flags;
200 	struct acpi_video_device_cap cap;
201 	struct list_head entry;
202 	struct acpi_video_bus *video;
203 	struct acpi_device *dev;
204 	struct acpi_video_device_brightness *brightness;
205 	struct backlight_device *backlight;
206 	struct thermal_cooling_device *cooling_dev;
207 };
208 
209 static const char device_decode[][30] = {
210 	"motherboard VGA device",
211 	"PCI VGA device",
212 	"AGP VGA device",
213 	"UNKNOWN",
214 };
215 
216 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data);
217 static void acpi_video_device_rebind(struct acpi_video_bus *video);
218 static void acpi_video_device_bind(struct acpi_video_bus *video,
219 				   struct acpi_video_device *device);
220 static int acpi_video_device_enumerate(struct acpi_video_bus *video);
221 static int acpi_video_device_lcd_set_level(struct acpi_video_device *device,
222 			int level);
223 static int acpi_video_device_lcd_get_level_current(
224 			struct acpi_video_device *device,
225 			unsigned long long *level, int init);
226 static int acpi_video_get_next_level(struct acpi_video_device *device,
227 				     u32 level_current, u32 event);
228 static int acpi_video_switch_brightness(struct acpi_video_device *device,
229 					 int event);
230 
231 /*backlight device sysfs support*/
acpi_video_get_brightness(struct backlight_device * bd)232 static int acpi_video_get_brightness(struct backlight_device *bd)
233 {
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 	for (i = 2; i < vd->brightness->count; i++) {
242 		if (vd->brightness->levels[i] == cur_level)
243 			/* The first two entries are special - see page 575
244 			   of the ACPI spec 3.0 */
245 			return i-2;
246 	}
247 	return 0;
248 }
249 
acpi_video_set_brightness(struct backlight_device * bd)250 static int acpi_video_set_brightness(struct backlight_device *bd)
251 {
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 	return acpi_video_device_lcd_set_level(vd,
257 				vd->brightness->levels[request_level]);
258 }
259 
260 static const struct backlight_ops acpi_backlight_ops = {
261 	.get_brightness = acpi_video_get_brightness,
262 	.update_status  = acpi_video_set_brightness,
263 };
264 
265 /* thermal cooling device callbacks */
video_get_max_state(struct thermal_cooling_device * cooling_dev,unsigned long * state)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 	struct acpi_video_device *video = acpi_driver_data(device);
271 
272 	*state = video->brightness->count - 3;
273 	return 0;
274 }
275 
video_get_cur_state(struct thermal_cooling_device * cooling_dev,unsigned long * state)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 	for (offset = 2; offset < video->brightness->count; offset++)
287 		if (level == video->brightness->levels[offset]) {
288 			*state = video->brightness->count - offset - 1;
289 			return 0;
290 		}
291 
292 	return -EINVAL;
293 }
294 
295 static int
video_set_cur_state(struct thermal_cooling_device * cooling_dev,unsigned long state)296 video_set_cur_state(struct thermal_cooling_device *cooling_dev, unsigned long state)
297 {
298 	struct acpi_device *device = cooling_dev->devdata;
299 	struct acpi_video_device *video = acpi_driver_data(device);
300 	int level;
301 
302 	if ( state >= video->brightness->count - 2)
303 		return -EINVAL;
304 
305 	state = video->brightness->count - state;
306 	level = video->brightness->levels[state -1];
307 	return acpi_video_device_lcd_set_level(video, level);
308 }
309 
310 static const struct thermal_cooling_device_ops video_cooling_ops = {
311 	.get_max_state = video_get_max_state,
312 	.get_cur_state = video_get_cur_state,
313 	.set_cur_state = video_set_cur_state,
314 };
315 
316 /* --------------------------------------------------------------------------
317                                Video Management
318    -------------------------------------------------------------------------- */
319 
320 static int
acpi_video_device_lcd_query_levels(struct acpi_video_device * device,union acpi_object ** levels)321 acpi_video_device_lcd_query_levels(struct acpi_video_device *device,
322 				   union acpi_object **levels)
323 {
324 	int status;
325 	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
326 	union acpi_object *obj;
327 
328 
329 	*levels = NULL;
330 
331 	status = acpi_evaluate_object(device->dev->handle, "_BCL", NULL, &buffer);
332 	if (!ACPI_SUCCESS(status))
333 		return status;
334 	obj = (union acpi_object *)buffer.pointer;
335 	if (!obj || (obj->type != ACPI_TYPE_PACKAGE)) {
336 		printk(KERN_ERR PREFIX "Invalid _BCL data\n");
337 		status = -EFAULT;
338 		goto err;
339 	}
340 
341 	*levels = obj;
342 
343 	return 0;
344 
345       err:
346 	kfree(buffer.pointer);
347 
348 	return status;
349 }
350 
351 static int
acpi_video_device_lcd_set_level(struct acpi_video_device * device,int level)352 acpi_video_device_lcd_set_level(struct acpi_video_device *device, int level)
353 {
354 	int status;
355 	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
356 	struct acpi_object_list args = { 1, &arg0 };
357 	int state;
358 
359 	arg0.integer.value = level;
360 
361 	status = acpi_evaluate_object(device->dev->handle, "_BCM",
362 				      &args, NULL);
363 	if (ACPI_FAILURE(status)) {
364 		ACPI_ERROR((AE_INFO, "Evaluating _BCM failed"));
365 		return -EIO;
366 	}
367 
368 	device->brightness->curr = level;
369 	for (state = 2; state < device->brightness->count; state++)
370 		if (level == device->brightness->levels[state]) {
371 			if (device->backlight)
372 				device->backlight->props.brightness = state - 2;
373 			return 0;
374 		}
375 
376 	ACPI_ERROR((AE_INFO, "Current brightness invalid"));
377 	return -EINVAL;
378 }
379 
380 /*
381  * For some buggy _BQC methods, we need to add a constant value to
382  * the _BQC return value to get the actual current brightness level
383  */
384 
385 static int bqc_offset_aml_bug_workaround;
video_set_bqc_offset(const struct dmi_system_id * d)386 static int __init video_set_bqc_offset(const struct dmi_system_id *d)
387 {
388 	bqc_offset_aml_bug_workaround = 9;
389 	return 0;
390 }
391 
video_ignore_initial_backlight(const struct dmi_system_id * d)392 static int video_ignore_initial_backlight(const struct dmi_system_id *d)
393 {
394 	use_bios_initial_backlight = 0;
395 	return 0;
396 }
397 
398 static struct dmi_system_id video_dmi_table[] __initdata = {
399 	/*
400 	 * Broken _BQC workaround http://bugzilla.kernel.org/show_bug.cgi?id=13121
401 	 */
402 	{
403 	 .callback = video_set_bqc_offset,
404 	 .ident = "Acer Aspire 5720",
405 	 .matches = {
406 		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
407 		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5720"),
408 		},
409 	},
410 	{
411 	 .callback = video_set_bqc_offset,
412 	 .ident = "Acer Aspire 5710Z",
413 	 .matches = {
414 		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
415 		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5710Z"),
416 		},
417 	},
418 	{
419 	 .callback = video_set_bqc_offset,
420 	 .ident = "eMachines E510",
421 	 .matches = {
422 		DMI_MATCH(DMI_BOARD_VENDOR, "EMACHINES"),
423 		DMI_MATCH(DMI_PRODUCT_NAME, "eMachines E510"),
424 		},
425 	},
426 	{
427 	 .callback = video_set_bqc_offset,
428 	 .ident = "Acer Aspire 5315",
429 	 .matches = {
430 		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
431 		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5315"),
432 		},
433 	},
434 	{
435 	 .callback = video_set_bqc_offset,
436 	 .ident = "Acer Aspire 7720",
437 	 .matches = {
438 		DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
439 		DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 7720"),
440 		},
441 	},
442 	{
443 	 .callback = video_ignore_initial_backlight,
444 	 .ident = "HP Folio 13-2000",
445 	 .matches = {
446 		DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
447 		DMI_MATCH(DMI_PRODUCT_NAME, "HP Folio 13 - 2000 Notebook PC"),
448 		},
449 	},
450 	{
451 	 .callback = video_ignore_initial_backlight,
452 	 .ident = "HP Pavilion g6 Notebook PC",
453 	 .matches = {
454 		 DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
455 		 DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion g6 Notebook PC"),
456 		},
457 	},
458 	{
459 	 .callback = video_ignore_initial_backlight,
460 	 .ident = "HP Pavilion m4",
461 	 .matches = {
462 		DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
463 		DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion m4 Notebook PC"),
464 		},
465 	},
466 	{
467 	 .callback = video_ignore_initial_backlight,
468 	 .ident = "HP 1000 Notebook PC",
469 	 .matches = {
470 		DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
471 		DMI_MATCH(DMI_PRODUCT_NAME, "HP 1000 Notebook PC"),
472 		},
473 	},
474 	{
475 	 .callback = video_ignore_initial_backlight,
476 	 .ident = "HP Pavilion dm4",
477 	 .matches = {
478 		DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
479 		DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion dm4 Notebook PC"),
480 		},
481 	},
482 	{}
483 };
484 
485 static int
acpi_video_device_lcd_get_level_current(struct acpi_video_device * device,unsigned long long * level,int init)486 acpi_video_device_lcd_get_level_current(struct acpi_video_device *device,
487 					unsigned long long *level, int init)
488 {
489 	acpi_status status = AE_OK;
490 	int i;
491 
492 	if (device->cap._BQC || device->cap._BCQ) {
493 		char *buf = device->cap._BQC ? "_BQC" : "_BCQ";
494 
495 		status = acpi_evaluate_integer(device->dev->handle, buf,
496 						NULL, level);
497 		if (ACPI_SUCCESS(status)) {
498 			if (device->brightness->flags._BQC_use_index) {
499 				if (device->brightness->flags._BCL_reversed)
500 					*level = device->brightness->count
501 								 - 3 - (*level);
502 				*level = device->brightness->levels[*level + 2];
503 
504 			}
505 			*level += bqc_offset_aml_bug_workaround;
506 			for (i = 2; i < device->brightness->count; i++)
507 				if (device->brightness->levels[i] == *level) {
508 					device->brightness->curr = *level;
509 					return 0;
510 			}
511 			if (!init) {
512 				/*
513 				 * BQC returned an invalid level.
514 				 * Stop using it.
515 				 */
516 				ACPI_WARNING((AE_INFO,
517 					      "%s returned an invalid level",
518 					      buf));
519 				device->cap._BQC = device->cap._BCQ = 0;
520 			}
521 		} else {
522 			/* Fixme:
523 			 * should we return an error or ignore this failure?
524 			 * dev->brightness->curr is a cached value which stores
525 			 * the correct current backlight level in most cases.
526 			 * ACPI video backlight still works w/ buggy _BQC.
527 			 * http://bugzilla.kernel.org/show_bug.cgi?id=12233
528 			 */
529 			ACPI_WARNING((AE_INFO, "Evaluating %s failed", buf));
530 			device->cap._BQC = device->cap._BCQ = 0;
531 		}
532 	}
533 
534 	*level = device->brightness->curr;
535 	return 0;
536 }
537 
538 static int
acpi_video_device_EDID(struct acpi_video_device * device,union acpi_object ** edid,ssize_t length)539 acpi_video_device_EDID(struct acpi_video_device *device,
540 		       union acpi_object **edid, ssize_t length)
541 {
542 	int status;
543 	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
544 	union acpi_object *obj;
545 	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
546 	struct acpi_object_list args = { 1, &arg0 };
547 
548 
549 	*edid = NULL;
550 
551 	if (!device)
552 		return -ENODEV;
553 	if (length == 128)
554 		arg0.integer.value = 1;
555 	else if (length == 256)
556 		arg0.integer.value = 2;
557 	else
558 		return -EINVAL;
559 
560 	status = acpi_evaluate_object(device->dev->handle, "_DDC", &args, &buffer);
561 	if (ACPI_FAILURE(status))
562 		return -ENODEV;
563 
564 	obj = buffer.pointer;
565 
566 	if (obj && obj->type == ACPI_TYPE_BUFFER)
567 		*edid = obj;
568 	else {
569 		printk(KERN_ERR PREFIX "Invalid _DDC data\n");
570 		status = -EFAULT;
571 		kfree(obj);
572 	}
573 
574 	return status;
575 }
576 
577 /* bus */
578 
579 /*
580  *  Arg:
581  *  	video		: video bus device pointer
582  *	bios_flag	:
583  *		0.	The system BIOS should NOT automatically switch(toggle)
584  *			the active display output.
585  *		1.	The system BIOS should automatically switch (toggle) the
586  *			active display output. No switch event.
587  *		2.	The _DGS value should be locked.
588  *		3.	The system BIOS should not automatically switch (toggle) the
589  *			active display output, but instead generate the display switch
590  *			event notify code.
591  *	lcd_flag	:
592  *		0.	The system BIOS should automatically control the brightness level
593  *			of the LCD when the power changes from AC to DC
594  *		1. 	The system BIOS should NOT automatically control the brightness
595  *			level of the LCD when the power changes from AC to DC.
596  * Return Value:
597  *		-EINVAL	wrong arg.
598  */
599 
600 static int
acpi_video_bus_DOS(struct acpi_video_bus * video,int bios_flag,int lcd_flag)601 acpi_video_bus_DOS(struct acpi_video_bus *video, int bios_flag, int lcd_flag)
602 {
603 	acpi_status status;
604 	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
605 	struct acpi_object_list args = { 1, &arg0 };
606 
607 	if (!video->cap._DOS)
608 		return 0;
609 
610 	if (bios_flag < 0 || bios_flag > 3 || lcd_flag < 0 || lcd_flag > 1)
611 		return -EINVAL;
612 	arg0.integer.value = (lcd_flag << 2) | bios_flag;
613 	video->dos_setting = arg0.integer.value;
614 	status = acpi_evaluate_object(video->device->handle, "_DOS",
615 		&args, NULL);
616 	if (ACPI_FAILURE(status))
617 		return -EIO;
618 
619 	return 0;
620 }
621 
622 /*
623  * Simple comparison function used to sort backlight levels.
624  */
625 
626 static int
acpi_video_cmp_level(const void * a,const void * b)627 acpi_video_cmp_level(const void *a, const void *b)
628 {
629 	return *(int *)a - *(int *)b;
630 }
631 
632 /*
633  *  Arg:
634  *  	device	: video output device (LCD, CRT, ..)
635  *
636  *  Return Value:
637  *	Maximum brightness level
638  *
639  *  Allocate and initialize device->brightness.
640  */
641 
642 static int
acpi_video_init_brightness(struct acpi_video_device * device)643 acpi_video_init_brightness(struct acpi_video_device *device)
644 {
645 	union acpi_object *obj = NULL;
646 	int i, max_level = 0, count = 0, level_ac_battery = 0;
647 	unsigned long long level, level_old;
648 	union acpi_object *o;
649 	struct acpi_video_device_brightness *br = NULL;
650 	int result = -EINVAL;
651 	u32 value;
652 
653 	if (!ACPI_SUCCESS(acpi_video_device_lcd_query_levels(device, &obj))) {
654 		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Could not query available "
655 						"LCD brightness level\n"));
656 		goto out;
657 	}
658 
659 	if (obj->package.count < 2)
660 		goto out;
661 
662 	br = kzalloc(sizeof(*br), GFP_KERNEL);
663 	if (!br) {
664 		printk(KERN_ERR "can't allocate memory\n");
665 		result = -ENOMEM;
666 		goto out;
667 	}
668 
669 	br->levels = kmalloc((obj->package.count + 2) * sizeof *(br->levels),
670 				GFP_KERNEL);
671 	if (!br->levels) {
672 		result = -ENOMEM;
673 		goto out_free;
674 	}
675 
676 	for (i = 0; i < obj->package.count; i++) {
677 		o = (union acpi_object *)&obj->package.elements[i];
678 		if (o->type != ACPI_TYPE_INTEGER) {
679 			printk(KERN_ERR PREFIX "Invalid data\n");
680 			continue;
681 		}
682 		value = (u32) o->integer.value;
683 		/* Skip duplicate entries */
684 		if (count > 2 && br->levels[count - 1] == value)
685 			continue;
686 
687 		br->levels[count] = value;
688 
689 		if (br->levels[count] > max_level)
690 			max_level = br->levels[count];
691 		count++;
692 	}
693 
694 	/*
695 	 * some buggy BIOS don't export the levels
696 	 * when machine is on AC/Battery in _BCL package.
697 	 * In this case, the first two elements in _BCL packages
698 	 * are also supported brightness levels that OS should take care of.
699 	 */
700 	for (i = 2; i < count; i++) {
701 		if (br->levels[i] == br->levels[0])
702 			level_ac_battery++;
703 		if (br->levels[i] == br->levels[1])
704 			level_ac_battery++;
705 	}
706 
707 	if (level_ac_battery < 2) {
708 		level_ac_battery = 2 - level_ac_battery;
709 		br->flags._BCL_no_ac_battery_levels = 1;
710 		for (i = (count - 1 + level_ac_battery); i >= 2; i--)
711 			br->levels[i] = br->levels[i - level_ac_battery];
712 		count += level_ac_battery;
713 	} else if (level_ac_battery > 2)
714 		ACPI_ERROR((AE_INFO, "Too many duplicates in _BCL package\n"));
715 
716 	/* Check if the _BCL package is in a reversed order */
717 	if (max_level == br->levels[2]) {
718 		br->flags._BCL_reversed = 1;
719 		sort(&br->levels[2], count - 2, sizeof(br->levels[2]),
720 			acpi_video_cmp_level, NULL);
721 	} else if (max_level != br->levels[count - 1])
722 		ACPI_ERROR((AE_INFO,
723 			    "Found unordered _BCL package\n"));
724 
725 	br->count = count;
726 	device->brightness = br;
727 
728 	/* Check the input/output of _BQC/_BCL/_BCM */
729 	if ((max_level < 100) && (max_level <= (count - 2)))
730 		br->flags._BCL_use_index = 1;
731 
732 	/*
733 	 * _BCM is always consistent with _BCL,
734 	 * at least for all the laptops we have ever seen.
735 	 */
736 	br->flags._BCM_use_index = br->flags._BCL_use_index;
737 
738 	/* _BQC uses INDEX while _BCL uses VALUE in some laptops */
739 	br->curr = level = max_level;
740 
741 	if (!device->cap._BQC)
742 		goto set_level;
743 
744 	result = acpi_video_device_lcd_get_level_current(device, &level_old, 1);
745 	if (result)
746 		goto out_free_levels;
747 
748 	/*
749 	 * Set the level to maximum and check if _BQC uses indexed value
750 	 */
751 	result = acpi_video_device_lcd_set_level(device, max_level);
752 	if (result)
753 		goto out_free_levels;
754 
755 	result = acpi_video_device_lcd_get_level_current(device, &level, 0);
756 	if (result)
757 		goto out_free_levels;
758 
759 	br->flags._BQC_use_index = (level == max_level ? 0 : 1);
760 
761 	if (!br->flags._BQC_use_index) {
762 		/*
763 		 * Set the backlight to the initial state.
764 		 * On some buggy laptops, _BQC returns an uninitialized value
765 		 * when invoked for the first time, i.e. level_old is invalid.
766 		 * set the backlight to max_level in this case
767 		 */
768 		if (use_bios_initial_backlight) {
769 			for (i = 2; i < br->count; i++)
770 				if (level_old == br->levels[i])
771 					level = level_old;
772 		}
773 		goto set_level;
774 	}
775 
776 	if (br->flags._BCL_reversed)
777 		level_old = (br->count - 1) - level_old;
778 	level = br->levels[level_old];
779 
780 set_level:
781 	result = acpi_video_device_lcd_set_level(device, level);
782 	if (result)
783 		goto out_free_levels;
784 
785 	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
786 			  "found %d brightness levels\n", count - 2));
787 	kfree(obj);
788 	return result;
789 
790 out_free_levels:
791 	kfree(br->levels);
792 out_free:
793 	kfree(br);
794 out:
795 	device->brightness = NULL;
796 	kfree(obj);
797 	return result;
798 }
799 
800 /*
801  *  Arg:
802  *	device	: video output device (LCD, CRT, ..)
803  *
804  *  Return Value:
805  *  	None
806  *
807  *  Find out all required AML methods defined under the output
808  *  device.
809  */
810 
acpi_video_device_find_cap(struct acpi_video_device * device)811 static void acpi_video_device_find_cap(struct acpi_video_device *device)
812 {
813 	acpi_handle h_dummy1;
814 
815 	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_ADR", &h_dummy1))) {
816 		device->cap._ADR = 1;
817 	}
818 	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCL", &h_dummy1))) {
819 		device->cap._BCL = 1;
820 	}
821 	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCM", &h_dummy1))) {
822 		device->cap._BCM = 1;
823 	}
824 	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle,"_BQC",&h_dummy1)))
825 		device->cap._BQC = 1;
826 	else if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCQ",
827 				&h_dummy1))) {
828 		printk(KERN_WARNING FW_BUG "_BCQ is used instead of _BQC\n");
829 		device->cap._BCQ = 1;
830 	}
831 
832 	if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DDC", &h_dummy1))) {
833 		device->cap._DDC = 1;
834 	}
835 
836 	if (acpi_video_backlight_support()) {
837 		struct backlight_properties props;
838 		struct pci_dev *pdev;
839 		acpi_handle acpi_parent;
840 		struct device *parent = NULL;
841 		int result;
842 		static int count = 0;
843 		char *name;
844 
845 		result = acpi_video_init_brightness(device);
846 		if (result)
847 			return;
848 		name = kasprintf(GFP_KERNEL, "acpi_video%d", count);
849 		if (!name)
850 			return;
851 		count++;
852 
853 		acpi_get_parent(device->dev->handle, &acpi_parent);
854 
855 		pdev = acpi_get_pci_dev(acpi_parent);
856 		if (pdev) {
857 			parent = &pdev->dev;
858 			pci_dev_put(pdev);
859 		}
860 
861 		memset(&props, 0, sizeof(struct backlight_properties));
862 		props.type = BACKLIGHT_FIRMWARE;
863 		props.max_brightness = device->brightness->count - 3;
864 		device->backlight = backlight_device_register(name,
865 							      parent,
866 							      device,
867 							      &acpi_backlight_ops,
868 							      &props);
869 		kfree(name);
870 		if (IS_ERR(device->backlight))
871 			return;
872 
873 		/*
874 		 * Save current brightness level in case we have to restore it
875 		 * before acpi_video_device_lcd_set_level() is called next time.
876 		 */
877 		device->backlight->props.brightness =
878 				acpi_video_get_brightness(device->backlight);
879 
880 		device->cooling_dev = thermal_cooling_device_register("LCD",
881 					device->dev, &video_cooling_ops);
882 		if (IS_ERR(device->cooling_dev)) {
883 			/*
884 			 * Set cooling_dev to NULL so we don't crash trying to
885 			 * free it.
886 			 * Also, why the hell we are returning early and
887 			 * not attempt to register video output if cooling
888 			 * device registration failed?
889 			 * -- dtor
890 			 */
891 			device->cooling_dev = NULL;
892 			return;
893 		}
894 
895 		dev_info(&device->dev->dev, "registered as cooling_device%d\n",
896 			 device->cooling_dev->id);
897 		result = sysfs_create_link(&device->dev->dev.kobj,
898 				&device->cooling_dev->device.kobj,
899 				"thermal_cooling");
900 		if (result)
901 			printk(KERN_ERR PREFIX "Create sysfs link\n");
902 		result = sysfs_create_link(&device->cooling_dev->device.kobj,
903 				&device->dev->dev.kobj, "device");
904 		if (result)
905 			printk(KERN_ERR PREFIX "Create sysfs link\n");
906 
907 	}
908 }
909 
910 /*
911  *  Arg:
912  *  	device	: video output device (VGA)
913  *
914  *  Return Value:
915  *  	None
916  *
917  *  Find out all required AML methods defined under the video bus device.
918  */
919 
acpi_video_bus_find_cap(struct acpi_video_bus * video)920 static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
921 {
922 	acpi_handle h_dummy1;
923 
924 	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOS", &h_dummy1))) {
925 		video->cap._DOS = 1;
926 	}
927 	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOD", &h_dummy1))) {
928 		video->cap._DOD = 1;
929 	}
930 	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_ROM", &h_dummy1))) {
931 		video->cap._ROM = 1;
932 	}
933 	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_GPD", &h_dummy1))) {
934 		video->cap._GPD = 1;
935 	}
936 	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_SPD", &h_dummy1))) {
937 		video->cap._SPD = 1;
938 	}
939 	if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_VPO", &h_dummy1))) {
940 		video->cap._VPO = 1;
941 	}
942 }
943 
944 /*
945  * Check whether the video bus device has required AML method to
946  * support the desired features
947  */
948 
acpi_video_bus_check(struct acpi_video_bus * video)949 static int acpi_video_bus_check(struct acpi_video_bus *video)
950 {
951 	acpi_status status = -ENOENT;
952 	struct pci_dev *dev;
953 
954 	if (!video)
955 		return -EINVAL;
956 
957 	dev = acpi_get_pci_dev(video->device->handle);
958 	if (!dev)
959 		return -ENODEV;
960 	pci_dev_put(dev);
961 
962 	/* Since there is no HID, CID and so on for VGA driver, we have
963 	 * to check well known required nodes.
964 	 */
965 
966 	/* Does this device support video switching? */
967 	if (video->cap._DOS || video->cap._DOD) {
968 		if (!video->cap._DOS) {
969 			printk(KERN_WARNING FW_BUG
970 				"ACPI(%s) defines _DOD but not _DOS\n",
971 				acpi_device_bid(video->device));
972 		}
973 		video->flags.multihead = 1;
974 		status = 0;
975 	}
976 
977 	/* Does this device support retrieving a video ROM? */
978 	if (video->cap._ROM) {
979 		video->flags.rom = 1;
980 		status = 0;
981 	}
982 
983 	/* Does this device support configuring which video device to POST? */
984 	if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
985 		video->flags.post = 1;
986 		status = 0;
987 	}
988 
989 	return status;
990 }
991 
992 /* --------------------------------------------------------------------------
993                                  Driver Interface
994    -------------------------------------------------------------------------- */
995 
996 /* device interface */
997 static struct acpi_video_device_attrib*
acpi_video_get_device_attr(struct acpi_video_bus * video,unsigned long device_id)998 acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
999 {
1000 	struct acpi_video_enumerated_device *ids;
1001 	int i;
1002 
1003 	for (i = 0; i < video->attached_count; i++) {
1004 		ids = &video->attached_array[i];
1005 		if ((ids->value.int_val & 0xffff) == device_id)
1006 			return &ids->value.attrib;
1007 	}
1008 
1009 	return NULL;
1010 }
1011 
1012 static int
acpi_video_get_device_type(struct acpi_video_bus * video,unsigned long device_id)1013 acpi_video_get_device_type(struct acpi_video_bus *video,
1014 			   unsigned long device_id)
1015 {
1016 	struct acpi_video_enumerated_device *ids;
1017 	int i;
1018 
1019 	for (i = 0; i < video->attached_count; i++) {
1020 		ids = &video->attached_array[i];
1021 		if ((ids->value.int_val & 0xffff) == device_id)
1022 			return ids->value.int_val;
1023 	}
1024 
1025 	return 0;
1026 }
1027 
1028 static int
acpi_video_bus_get_one_device(struct acpi_device * device,struct acpi_video_bus * video)1029 acpi_video_bus_get_one_device(struct acpi_device *device,
1030 			      struct acpi_video_bus *video)
1031 {
1032 	unsigned long long device_id;
1033 	int status, device_type;
1034 	struct acpi_video_device *data;
1035 	struct acpi_video_device_attrib* attribute;
1036 
1037 	if (!device || !video)
1038 		return -EINVAL;
1039 
1040 	status =
1041 	    acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
1042 	if (ACPI_SUCCESS(status)) {
1043 
1044 		data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
1045 		if (!data)
1046 			return -ENOMEM;
1047 
1048 		strcpy(acpi_device_name(device), ACPI_VIDEO_DEVICE_NAME);
1049 		strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1050 		device->driver_data = data;
1051 
1052 		data->device_id = device_id;
1053 		data->video = video;
1054 		data->dev = device;
1055 
1056 		attribute = acpi_video_get_device_attr(video, device_id);
1057 
1058 		if((attribute != NULL) && attribute->device_id_scheme) {
1059 			switch (attribute->display_type) {
1060 			case ACPI_VIDEO_DISPLAY_CRT:
1061 				data->flags.crt = 1;
1062 				break;
1063 			case ACPI_VIDEO_DISPLAY_TV:
1064 				data->flags.tvout = 1;
1065 				break;
1066 			case ACPI_VIDEO_DISPLAY_DVI:
1067 				data->flags.dvi = 1;
1068 				break;
1069 			case ACPI_VIDEO_DISPLAY_LCD:
1070 				data->flags.lcd = 1;
1071 				break;
1072 			default:
1073 				data->flags.unknown = 1;
1074 				break;
1075 			}
1076 			if(attribute->bios_can_detect)
1077 				data->flags.bios = 1;
1078 		} else {
1079 			/* Check for legacy IDs */
1080 			device_type = acpi_video_get_device_type(video,
1081 								 device_id);
1082 			/* Ignore bits 16 and 18-20 */
1083 			switch (device_type & 0xffe2ffff) {
1084 			case ACPI_VIDEO_DISPLAY_LEGACY_MONITOR:
1085 				data->flags.crt = 1;
1086 				break;
1087 			case ACPI_VIDEO_DISPLAY_LEGACY_PANEL:
1088 				data->flags.lcd = 1;
1089 				break;
1090 			case ACPI_VIDEO_DISPLAY_LEGACY_TV:
1091 				data->flags.tvout = 1;
1092 				break;
1093 			default:
1094 				data->flags.unknown = 1;
1095 			}
1096 		}
1097 
1098 		acpi_video_device_bind(video, data);
1099 		acpi_video_device_find_cap(data);
1100 
1101 		status = acpi_install_notify_handler(device->handle,
1102 						     ACPI_DEVICE_NOTIFY,
1103 						     acpi_video_device_notify,
1104 						     data);
1105 		if (ACPI_FAILURE(status)) {
1106 			printk(KERN_ERR PREFIX
1107 					  "Error installing notify handler\n");
1108 			if(data->brightness)
1109 				kfree(data->brightness->levels);
1110 			kfree(data->brightness);
1111 			kfree(data);
1112 			return -ENODEV;
1113 		}
1114 
1115 		mutex_lock(&video->device_list_lock);
1116 		list_add_tail(&data->entry, &video->video_device_list);
1117 		mutex_unlock(&video->device_list_lock);
1118 
1119 		return 0;
1120 	}
1121 
1122 	return -ENOENT;
1123 }
1124 
1125 /*
1126  *  Arg:
1127  *  	video	: video bus device
1128  *
1129  *  Return:
1130  *  	none
1131  *
1132  *  Enumerate the video device list of the video bus,
1133  *  bind the ids with the corresponding video devices
1134  *  under the video bus.
1135  */
1136 
acpi_video_device_rebind(struct acpi_video_bus * video)1137 static void acpi_video_device_rebind(struct acpi_video_bus *video)
1138 {
1139 	struct acpi_video_device *dev;
1140 
1141 	mutex_lock(&video->device_list_lock);
1142 
1143 	list_for_each_entry(dev, &video->video_device_list, entry)
1144 		acpi_video_device_bind(video, dev);
1145 
1146 	mutex_unlock(&video->device_list_lock);
1147 }
1148 
1149 /*
1150  *  Arg:
1151  *  	video	: video bus device
1152  *  	device	: video output device under the video
1153  *  		bus
1154  *
1155  *  Return:
1156  *  	none
1157  *
1158  *  Bind the ids with the corresponding video devices
1159  *  under the video bus.
1160  */
1161 
1162 static void
acpi_video_device_bind(struct acpi_video_bus * video,struct acpi_video_device * device)1163 acpi_video_device_bind(struct acpi_video_bus *video,
1164 		       struct acpi_video_device *device)
1165 {
1166 	struct acpi_video_enumerated_device *ids;
1167 	int i;
1168 
1169 	for (i = 0; i < video->attached_count; i++) {
1170 		ids = &video->attached_array[i];
1171 		if (device->device_id == (ids->value.int_val & 0xffff)) {
1172 			ids->bind_info = device;
1173 			ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
1174 		}
1175 	}
1176 }
1177 
1178 /*
1179  *  Arg:
1180  *  	video	: video bus device
1181  *
1182  *  Return:
1183  *  	< 0	: error
1184  *
1185  *  Call _DOD to enumerate all devices attached to display adapter
1186  *
1187  */
1188 
acpi_video_device_enumerate(struct acpi_video_bus * video)1189 static int acpi_video_device_enumerate(struct acpi_video_bus *video)
1190 {
1191 	int status;
1192 	int count;
1193 	int i;
1194 	struct acpi_video_enumerated_device *active_list;
1195 	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1196 	union acpi_object *dod = NULL;
1197 	union acpi_object *obj;
1198 
1199 	status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
1200 	if (!ACPI_SUCCESS(status)) {
1201 		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1202 		return status;
1203 	}
1204 
1205 	dod = buffer.pointer;
1206 	if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1207 		ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
1208 		status = -EFAULT;
1209 		goto out;
1210 	}
1211 
1212 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d video heads in _DOD\n",
1213 			  dod->package.count));
1214 
1215 	active_list = kcalloc(1 + dod->package.count,
1216 			      sizeof(struct acpi_video_enumerated_device),
1217 			      GFP_KERNEL);
1218 	if (!active_list) {
1219 		status = -ENOMEM;
1220 		goto out;
1221 	}
1222 
1223 	count = 0;
1224 	for (i = 0; i < dod->package.count; i++) {
1225 		obj = &dod->package.elements[i];
1226 
1227 		if (obj->type != ACPI_TYPE_INTEGER) {
1228 			printk(KERN_ERR PREFIX
1229 				"Invalid _DOD data in element %d\n", i);
1230 			continue;
1231 		}
1232 
1233 		active_list[count].value.int_val = obj->integer.value;
1234 		active_list[count].bind_info = NULL;
1235 		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
1236 				  (int)obj->integer.value));
1237 		count++;
1238 	}
1239 
1240 	kfree(video->attached_array);
1241 
1242 	video->attached_array = active_list;
1243 	video->attached_count = count;
1244 
1245  out:
1246 	kfree(buffer.pointer);
1247 	return status;
1248 }
1249 
1250 static int
acpi_video_get_next_level(struct acpi_video_device * device,u32 level_current,u32 event)1251 acpi_video_get_next_level(struct acpi_video_device *device,
1252 			  u32 level_current, u32 event)
1253 {
1254 	int min, max, min_above, max_below, i, l, delta = 255;
1255 	max = max_below = 0;
1256 	min = min_above = 255;
1257 	/* Find closest level to level_current */
1258 	for (i = 2; i < device->brightness->count; i++) {
1259 		l = device->brightness->levels[i];
1260 		if (abs(l - level_current) < abs(delta)) {
1261 			delta = l - level_current;
1262 			if (!delta)
1263 				break;
1264 		}
1265 	}
1266 	/* Ajust level_current to closest available level */
1267 	level_current += delta;
1268 	for (i = 2; i < device->brightness->count; i++) {
1269 		l = device->brightness->levels[i];
1270 		if (l < min)
1271 			min = l;
1272 		if (l > max)
1273 			max = l;
1274 		if (l < min_above && l > level_current)
1275 			min_above = l;
1276 		if (l > max_below && l < level_current)
1277 			max_below = l;
1278 	}
1279 
1280 	switch (event) {
1281 	case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:
1282 		return (level_current < max) ? min_above : min;
1283 	case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:
1284 		return (level_current < max) ? min_above : max;
1285 	case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:
1286 		return (level_current > min) ? max_below : min;
1287 	case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:
1288 	case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:
1289 		return 0;
1290 	default:
1291 		return level_current;
1292 	}
1293 }
1294 
1295 static int
acpi_video_switch_brightness(struct acpi_video_device * device,int event)1296 acpi_video_switch_brightness(struct acpi_video_device *device, int event)
1297 {
1298 	unsigned long long level_current, level_next;
1299 	int result = -EINVAL;
1300 
1301 	/* no warning message if acpi_backlight=vendor is used */
1302 	if (!acpi_video_backlight_support())
1303 		return 0;
1304 
1305 	if (!device->brightness)
1306 		goto out;
1307 
1308 	result = acpi_video_device_lcd_get_level_current(device,
1309 							 &level_current, 0);
1310 	if (result)
1311 		goto out;
1312 
1313 	level_next = acpi_video_get_next_level(device, level_current, event);
1314 
1315 	result = acpi_video_device_lcd_set_level(device, level_next);
1316 
1317 	if (!result)
1318 		backlight_force_update(device->backlight,
1319 				       BACKLIGHT_UPDATE_HOTKEY);
1320 
1321 out:
1322 	if (result)
1323 		printk(KERN_ERR PREFIX "Failed to switch the brightness\n");
1324 
1325 	return result;
1326 }
1327 
acpi_video_get_edid(struct acpi_device * device,int type,int device_id,void ** edid)1328 int acpi_video_get_edid(struct acpi_device *device, int type, int device_id,
1329 			void **edid)
1330 {
1331 	struct acpi_video_bus *video;
1332 	struct acpi_video_device *video_device;
1333 	union acpi_object *buffer = NULL;
1334 	acpi_status status;
1335 	int i, length;
1336 
1337 	if (!device || !acpi_driver_data(device))
1338 		return -EINVAL;
1339 
1340 	video = acpi_driver_data(device);
1341 
1342 	for (i = 0; i < video->attached_count; i++) {
1343 		video_device = video->attached_array[i].bind_info;
1344 		length = 256;
1345 
1346 		if (!video_device)
1347 			continue;
1348 
1349 		if (!video_device->cap._DDC)
1350 			continue;
1351 
1352 		if (type) {
1353 			switch (type) {
1354 			case ACPI_VIDEO_DISPLAY_CRT:
1355 				if (!video_device->flags.crt)
1356 					continue;
1357 				break;
1358 			case ACPI_VIDEO_DISPLAY_TV:
1359 				if (!video_device->flags.tvout)
1360 					continue;
1361 				break;
1362 			case ACPI_VIDEO_DISPLAY_DVI:
1363 				if (!video_device->flags.dvi)
1364 					continue;
1365 				break;
1366 			case ACPI_VIDEO_DISPLAY_LCD:
1367 				if (!video_device->flags.lcd)
1368 					continue;
1369 				break;
1370 			}
1371 		} else if (video_device->device_id != device_id) {
1372 			continue;
1373 		}
1374 
1375 		status = acpi_video_device_EDID(video_device, &buffer, length);
1376 
1377 		if (ACPI_FAILURE(status) || !buffer ||
1378 		    buffer->type != ACPI_TYPE_BUFFER) {
1379 			length = 128;
1380 			status = acpi_video_device_EDID(video_device, &buffer,
1381 							length);
1382 			if (ACPI_FAILURE(status) || !buffer ||
1383 			    buffer->type != ACPI_TYPE_BUFFER) {
1384 				continue;
1385 			}
1386 		}
1387 
1388 		*edid = buffer->buffer.pointer;
1389 		return length;
1390 	}
1391 
1392 	return -ENODEV;
1393 }
1394 EXPORT_SYMBOL(acpi_video_get_edid);
1395 
1396 static int
acpi_video_bus_get_devices(struct acpi_video_bus * video,struct acpi_device * device)1397 acpi_video_bus_get_devices(struct acpi_video_bus *video,
1398 			   struct acpi_device *device)
1399 {
1400 	int status = 0;
1401 	struct acpi_device *dev;
1402 
1403 	/*
1404 	 * There are systems where video module known to work fine regardless
1405 	 * of broken _DOD and ignoring returned value here doesn't cause
1406 	 * any issues later.
1407 	 */
1408 	acpi_video_device_enumerate(video);
1409 
1410 	list_for_each_entry(dev, &device->children, node) {
1411 
1412 		status = acpi_video_bus_get_one_device(dev, video);
1413 		if (status) {
1414 			printk(KERN_WARNING PREFIX
1415 					"Can't attach device\n");
1416 			continue;
1417 		}
1418 	}
1419 	return status;
1420 }
1421 
acpi_video_bus_put_one_device(struct acpi_video_device * device)1422 static int acpi_video_bus_put_one_device(struct acpi_video_device *device)
1423 {
1424 	acpi_status status;
1425 
1426 	if (!device || !device->video)
1427 		return -ENOENT;
1428 
1429 	status = acpi_remove_notify_handler(device->dev->handle,
1430 					    ACPI_DEVICE_NOTIFY,
1431 					    acpi_video_device_notify);
1432 	if (ACPI_FAILURE(status)) {
1433 		printk(KERN_WARNING PREFIX
1434 		       "Can't remove video notify handler\n");
1435 	}
1436 	if (device->backlight) {
1437 		backlight_device_unregister(device->backlight);
1438 		device->backlight = NULL;
1439 	}
1440 	if (device->cooling_dev) {
1441 		sysfs_remove_link(&device->dev->dev.kobj,
1442 				  "thermal_cooling");
1443 		sysfs_remove_link(&device->cooling_dev->device.kobj,
1444 				  "device");
1445 		thermal_cooling_device_unregister(device->cooling_dev);
1446 		device->cooling_dev = NULL;
1447 	}
1448 
1449 	return 0;
1450 }
1451 
acpi_video_bus_put_devices(struct acpi_video_bus * video)1452 static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
1453 {
1454 	int status;
1455 	struct acpi_video_device *dev, *next;
1456 
1457 	mutex_lock(&video->device_list_lock);
1458 
1459 	list_for_each_entry_safe(dev, next, &video->video_device_list, entry) {
1460 
1461 		status = acpi_video_bus_put_one_device(dev);
1462 		if (ACPI_FAILURE(status))
1463 			printk(KERN_WARNING PREFIX
1464 			       "hhuuhhuu bug in acpi video driver.\n");
1465 
1466 		if (dev->brightness) {
1467 			kfree(dev->brightness->levels);
1468 			kfree(dev->brightness);
1469 		}
1470 		list_del(&dev->entry);
1471 		kfree(dev);
1472 	}
1473 
1474 	mutex_unlock(&video->device_list_lock);
1475 
1476 	return 0;
1477 }
1478 
1479 /* acpi_video interface */
1480 
acpi_video_bus_start_devices(struct acpi_video_bus * video)1481 static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
1482 {
1483 	return acpi_video_bus_DOS(video, 0, 0);
1484 }
1485 
acpi_video_bus_stop_devices(struct acpi_video_bus * video)1486 static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
1487 {
1488 	return acpi_video_bus_DOS(video, 0, 1);
1489 }
1490 
acpi_video_bus_notify(struct acpi_device * device,u32 event)1491 static void acpi_video_bus_notify(struct acpi_device *device, u32 event)
1492 {
1493 	struct acpi_video_bus *video = acpi_driver_data(device);
1494 	struct input_dev *input;
1495 	int keycode = 0;
1496 
1497 	if (!video)
1498 		return;
1499 
1500 	input = video->input;
1501 
1502 	switch (event) {
1503 	case ACPI_VIDEO_NOTIFY_SWITCH:	/* User requested a switch,
1504 					 * most likely via hotkey. */
1505 		acpi_bus_generate_proc_event(device, event, 0);
1506 		if (!acpi_notifier_call_chain(device, event, 0))
1507 			keycode = KEY_SWITCHVIDEOMODE;
1508 		break;
1509 
1510 	case ACPI_VIDEO_NOTIFY_PROBE:	/* User plugged in or removed a video
1511 					 * connector. */
1512 		acpi_video_device_enumerate(video);
1513 		acpi_video_device_rebind(video);
1514 		acpi_bus_generate_proc_event(device, event, 0);
1515 		keycode = KEY_SWITCHVIDEOMODE;
1516 		break;
1517 
1518 	case ACPI_VIDEO_NOTIFY_CYCLE:	/* Cycle Display output hotkey pressed. */
1519 		acpi_bus_generate_proc_event(device, event, 0);
1520 		keycode = KEY_SWITCHVIDEOMODE;
1521 		break;
1522 	case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:	/* Next Display output hotkey pressed. */
1523 		acpi_bus_generate_proc_event(device, event, 0);
1524 		keycode = KEY_VIDEO_NEXT;
1525 		break;
1526 	case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:	/* previous Display output hotkey pressed. */
1527 		acpi_bus_generate_proc_event(device, event, 0);
1528 		keycode = KEY_VIDEO_PREV;
1529 		break;
1530 
1531 	default:
1532 		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1533 				  "Unsupported event [0x%x]\n", event));
1534 		break;
1535 	}
1536 
1537 	if (event != ACPI_VIDEO_NOTIFY_SWITCH)
1538 		acpi_notifier_call_chain(device, event, 0);
1539 
1540 	if (keycode) {
1541 		input_report_key(input, keycode, 1);
1542 		input_sync(input);
1543 		input_report_key(input, keycode, 0);
1544 		input_sync(input);
1545 	}
1546 
1547 	return;
1548 }
1549 
acpi_video_device_notify(acpi_handle handle,u32 event,void * data)1550 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
1551 {
1552 	struct acpi_video_device *video_device = data;
1553 	struct acpi_device *device = NULL;
1554 	struct acpi_video_bus *bus;
1555 	struct input_dev *input;
1556 	int keycode = 0;
1557 
1558 	if (!video_device)
1559 		return;
1560 
1561 	device = video_device->dev;
1562 	bus = video_device->video;
1563 	input = bus->input;
1564 
1565 	switch (event) {
1566 	case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:	/* Cycle brightness */
1567 		if (brightness_switch_enabled)
1568 			acpi_video_switch_brightness(video_device, event);
1569 		acpi_bus_generate_proc_event(device, event, 0);
1570 		keycode = KEY_BRIGHTNESS_CYCLE;
1571 		break;
1572 	case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:	/* Increase brightness */
1573 		if (brightness_switch_enabled)
1574 			acpi_video_switch_brightness(video_device, event);
1575 		acpi_bus_generate_proc_event(device, event, 0);
1576 		keycode = KEY_BRIGHTNESSUP;
1577 		break;
1578 	case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:	/* Decrease brightness */
1579 		if (brightness_switch_enabled)
1580 			acpi_video_switch_brightness(video_device, event);
1581 		acpi_bus_generate_proc_event(device, event, 0);
1582 		keycode = KEY_BRIGHTNESSDOWN;
1583 		break;
1584 	case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:	/* zero brightness */
1585 		if (brightness_switch_enabled)
1586 			acpi_video_switch_brightness(video_device, event);
1587 		acpi_bus_generate_proc_event(device, event, 0);
1588 		keycode = KEY_BRIGHTNESS_ZERO;
1589 		break;
1590 	case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:	/* display device off */
1591 		if (brightness_switch_enabled)
1592 			acpi_video_switch_brightness(video_device, event);
1593 		acpi_bus_generate_proc_event(device, event, 0);
1594 		keycode = KEY_DISPLAY_OFF;
1595 		break;
1596 	default:
1597 		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1598 				  "Unsupported event [0x%x]\n", event));
1599 		break;
1600 	}
1601 
1602 	acpi_notifier_call_chain(device, event, 0);
1603 
1604 	if (keycode) {
1605 		input_report_key(input, keycode, 1);
1606 		input_sync(input);
1607 		input_report_key(input, keycode, 0);
1608 		input_sync(input);
1609 	}
1610 
1611 	return;
1612 }
1613 
acpi_video_resume(struct notifier_block * nb,unsigned long val,void * ign)1614 static int acpi_video_resume(struct notifier_block *nb,
1615 				unsigned long val, void *ign)
1616 {
1617 	struct acpi_video_bus *video;
1618 	struct acpi_video_device *video_device;
1619 	int i;
1620 
1621 	switch (val) {
1622 	case PM_HIBERNATION_PREPARE:
1623 	case PM_SUSPEND_PREPARE:
1624 	case PM_RESTORE_PREPARE:
1625 		return NOTIFY_DONE;
1626 	}
1627 
1628 	video = container_of(nb, struct acpi_video_bus, pm_nb);
1629 
1630 	dev_info(&video->device->dev, "Restoring backlight state\n");
1631 
1632 	for (i = 0; i < video->attached_count; i++) {
1633 		video_device = video->attached_array[i].bind_info;
1634 		if (video_device && video_device->backlight)
1635 			acpi_video_set_brightness(video_device->backlight);
1636 	}
1637 
1638 	return NOTIFY_OK;
1639 }
1640 
1641 static acpi_status
acpi_video_bus_match(acpi_handle handle,u32 level,void * context,void ** return_value)1642 acpi_video_bus_match(acpi_handle handle, u32 level, void *context,
1643 			void **return_value)
1644 {
1645 	struct acpi_device *device = context;
1646 	struct acpi_device *sibling;
1647 	int result;
1648 
1649 	if (handle == device->handle)
1650 		return AE_CTRL_TERMINATE;
1651 
1652 	result = acpi_bus_get_device(handle, &sibling);
1653 	if (result)
1654 		return AE_OK;
1655 
1656 	if (!strcmp(acpi_device_name(sibling), ACPI_VIDEO_BUS_NAME))
1657 			return AE_ALREADY_EXISTS;
1658 
1659 	return AE_OK;
1660 }
1661 
1662 static int instance;
1663 
acpi_video_bus_add(struct acpi_device * device)1664 static int acpi_video_bus_add(struct acpi_device *device)
1665 {
1666 	struct acpi_video_bus *video;
1667 	struct input_dev *input;
1668 	int error;
1669 	acpi_status status;
1670 
1671 	status = acpi_walk_namespace(ACPI_TYPE_DEVICE,
1672 				device->parent->handle, 1,
1673 				acpi_video_bus_match, NULL,
1674 				device, NULL);
1675 	if (status == AE_ALREADY_EXISTS) {
1676 		printk(KERN_WARNING FW_BUG
1677 			"Duplicate ACPI video bus devices for the"
1678 			" same VGA controller, please try module "
1679 			"parameter \"video.allow_duplicates=1\""
1680 			"if the current driver doesn't work.\n");
1681 		if (!allow_duplicates)
1682 			return -ENODEV;
1683 	}
1684 
1685 	video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
1686 	if (!video)
1687 		return -ENOMEM;
1688 
1689 	/* a hack to fix the duplicate name "VID" problem on T61 */
1690 	if (!strcmp(device->pnp.bus_id, "VID")) {
1691 		if (instance)
1692 			device->pnp.bus_id[3] = '0' + instance;
1693 		instance ++;
1694 	}
1695 	/* a hack to fix the duplicate name "VGA" problem on Pa 3553 */
1696 	if (!strcmp(device->pnp.bus_id, "VGA")) {
1697 		if (instance)
1698 			device->pnp.bus_id[3] = '0' + instance;
1699 		instance++;
1700 	}
1701 
1702 	video->device = device;
1703 	strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
1704 	strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1705 	device->driver_data = video;
1706 
1707 	acpi_video_bus_find_cap(video);
1708 	error = acpi_video_bus_check(video);
1709 	if (error)
1710 		goto err_free_video;
1711 
1712 	mutex_init(&video->device_list_lock);
1713 	INIT_LIST_HEAD(&video->video_device_list);
1714 
1715 	error = acpi_video_bus_get_devices(video, device);
1716 	if (error)
1717 		goto err_free_video;
1718 
1719 	video->input = input = input_allocate_device();
1720 	if (!input) {
1721 		error = -ENOMEM;
1722 		goto err_put_video;
1723 	}
1724 
1725 	error = acpi_video_bus_start_devices(video);
1726 	if (error)
1727 		goto err_free_input_dev;
1728 
1729 	snprintf(video->phys, sizeof(video->phys),
1730 		"%s/video/input0", acpi_device_hid(video->device));
1731 
1732 	input->name = acpi_device_name(video->device);
1733 	input->phys = video->phys;
1734 	input->id.bustype = BUS_HOST;
1735 	input->id.product = 0x06;
1736 	input->dev.parent = &device->dev;
1737 	input->evbit[0] = BIT(EV_KEY);
1738 	set_bit(KEY_SWITCHVIDEOMODE, input->keybit);
1739 	set_bit(KEY_VIDEO_NEXT, input->keybit);
1740 	set_bit(KEY_VIDEO_PREV, input->keybit);
1741 	set_bit(KEY_BRIGHTNESS_CYCLE, input->keybit);
1742 	set_bit(KEY_BRIGHTNESSUP, input->keybit);
1743 	set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
1744 	set_bit(KEY_BRIGHTNESS_ZERO, input->keybit);
1745 	set_bit(KEY_DISPLAY_OFF, input->keybit);
1746 
1747 	error = input_register_device(input);
1748 	if (error)
1749 		goto err_stop_video;
1750 
1751 	printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
1752 	       ACPI_VIDEO_DEVICE_NAME, acpi_device_bid(device),
1753 	       video->flags.multihead ? "yes" : "no",
1754 	       video->flags.rom ? "yes" : "no",
1755 	       video->flags.post ? "yes" : "no");
1756 
1757 	video->pm_nb.notifier_call = acpi_video_resume;
1758 	video->pm_nb.priority = 0;
1759 	error = register_pm_notifier(&video->pm_nb);
1760 	if (error)
1761 		goto err_unregister_input_dev;
1762 
1763 	return 0;
1764 
1765  err_unregister_input_dev:
1766 	input_unregister_device(input);
1767  err_stop_video:
1768 	acpi_video_bus_stop_devices(video);
1769  err_free_input_dev:
1770 	input_free_device(input);
1771  err_put_video:
1772 	acpi_video_bus_put_devices(video);
1773 	kfree(video->attached_array);
1774  err_free_video:
1775 	kfree(video);
1776 	device->driver_data = NULL;
1777 
1778 	return error;
1779 }
1780 
acpi_video_bus_remove(struct acpi_device * device,int type)1781 static int acpi_video_bus_remove(struct acpi_device *device, int type)
1782 {
1783 	struct acpi_video_bus *video = NULL;
1784 
1785 
1786 	if (!device || !acpi_driver_data(device))
1787 		return -EINVAL;
1788 
1789 	video = acpi_driver_data(device);
1790 
1791 	unregister_pm_notifier(&video->pm_nb);
1792 
1793 	acpi_video_bus_stop_devices(video);
1794 	acpi_video_bus_put_devices(video);
1795 
1796 	input_unregister_device(video->input);
1797 	kfree(video->attached_array);
1798 	kfree(video);
1799 
1800 	return 0;
1801 }
1802 
intel_opregion_present(void)1803 static int __init intel_opregion_present(void)
1804 {
1805 	int i915 = 0;
1806 #if defined(CONFIG_DRM_I915) || defined(CONFIG_DRM_I915_MODULE)
1807 	struct pci_dev *dev = NULL;
1808 	u32 address;
1809 
1810 	for_each_pci_dev(dev) {
1811 		if ((dev->class >> 8) != PCI_CLASS_DISPLAY_VGA)
1812 			continue;
1813 		if (dev->vendor != PCI_VENDOR_ID_INTEL)
1814 			continue;
1815 		pci_read_config_dword(dev, 0xfc, &address);
1816 		if (!address)
1817 			continue;
1818 		i915 = 1;
1819 	}
1820 #endif
1821 	return i915;
1822 }
1823 
acpi_video_register(void)1824 int acpi_video_register(void)
1825 {
1826 	int result = 0;
1827 	if (register_count) {
1828 		/*
1829 		 * if the function of acpi_video_register is already called,
1830 		 * don't register the acpi_vide_bus again and return no error.
1831 		 */
1832 		return 0;
1833 	}
1834 
1835 	result = acpi_bus_register_driver(&acpi_video_bus);
1836 	if (result < 0)
1837 		return -ENODEV;
1838 
1839 	/*
1840 	 * When the acpi_video_bus is loaded successfully, increase
1841 	 * the counter reference.
1842 	 */
1843 	register_count = 1;
1844 
1845 	return 0;
1846 }
1847 EXPORT_SYMBOL(acpi_video_register);
1848 
acpi_video_unregister(void)1849 void acpi_video_unregister(void)
1850 {
1851 	if (!register_count) {
1852 		/*
1853 		 * If the acpi video bus is already unloaded, don't
1854 		 * unload it again and return directly.
1855 		 */
1856 		return;
1857 	}
1858 	acpi_bus_unregister_driver(&acpi_video_bus);
1859 
1860 	register_count = 0;
1861 
1862 	return;
1863 }
1864 EXPORT_SYMBOL(acpi_video_unregister);
1865 
1866 /*
1867  * This is kind of nasty. Hardware using Intel chipsets may require
1868  * the video opregion code to be run first in order to initialise
1869  * state before any ACPI video calls are made. To handle this we defer
1870  * registration of the video class until the opregion code has run.
1871  */
1872 
acpi_video_init(void)1873 static int __init acpi_video_init(void)
1874 {
1875 	dmi_check_system(video_dmi_table);
1876 
1877 	if (intel_opregion_present())
1878 		return 0;
1879 
1880 	return acpi_video_register();
1881 }
1882 
acpi_video_exit(void)1883 static void __exit acpi_video_exit(void)
1884 {
1885 	acpi_video_unregister();
1886 
1887 	return;
1888 }
1889 
1890 module_init(acpi_video_init);
1891 module_exit(acpi_video_exit);
1892