]> git.karo-electronics.de Git - karo-tx-linux.git/blob - drivers/acpi/video.c
Merge remote-tracking branch 'slab/for-next'
[karo-tx-linux.git] / drivers / acpi / video.c
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);
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, bool raw);
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*/
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, false))
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
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 */
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
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, false))
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
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
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
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;
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
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 dm4",
453          .matches = {
454                 DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
455                 DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion dm4 Notebook PC"),
456                 },
457         },
458         {}
459 };
460
461 static unsigned long long
462 acpi_video_bqc_value_to_level(struct acpi_video_device *device,
463                               unsigned long long bqc_value)
464 {
465         unsigned long long level;
466
467         if (device->brightness->flags._BQC_use_index) {
468                 /*
469                  * _BQC returns an index that doesn't account for
470                  * the first 2 items with special meaning, so we need
471                  * to compensate for that by offsetting ourselves
472                  */
473                 if (device->brightness->flags._BCL_reversed)
474                         bqc_value = device->brightness->count - 3 - bqc_value;
475
476                 level = device->brightness->levels[bqc_value + 2];
477         } else {
478                 level = bqc_value;
479         }
480
481         level += bqc_offset_aml_bug_workaround;
482
483         return level;
484 }
485
486 static int
487 acpi_video_device_lcd_get_level_current(struct acpi_video_device *device,
488                                         unsigned long long *level, bool raw)
489 {
490         acpi_status status = AE_OK;
491         int i;
492
493         if (device->cap._BQC || device->cap._BCQ) {
494                 char *buf = device->cap._BQC ? "_BQC" : "_BCQ";
495
496                 status = acpi_evaluate_integer(device->dev->handle, buf,
497                                                 NULL, level);
498                 if (ACPI_SUCCESS(status)) {
499                         if (raw) {
500                                 /*
501                                  * Caller has indicated he wants the raw
502                                  * value returned by _BQC, so don't furtherly
503                                  * mess with the value.
504                                  */
505                                 return 0;
506                         }
507
508                         *level = acpi_video_bqc_value_to_level(device, *level);
509
510                         for (i = 2; i < device->brightness->count; i++)
511                                 if (device->brightness->levels[i] == *level) {
512                                         device->brightness->curr = *level;
513                                         return 0;
514                         }
515                         /*
516                          * BQC returned an invalid level.
517                          * Stop using it.
518                          */
519                         ACPI_WARNING((AE_INFO,
520                                       "%s returned an invalid level",
521                                       buf));
522                         device->cap._BQC = device->cap._BCQ = 0;
523                 } else {
524                         /* Fixme:
525                          * should we return an error or ignore this failure?
526                          * dev->brightness->curr is a cached value which stores
527                          * the correct current backlight level in most cases.
528                          * ACPI video backlight still works w/ buggy _BQC.
529                          * http://bugzilla.kernel.org/show_bug.cgi?id=12233
530                          */
531                         ACPI_WARNING((AE_INFO, "Evaluating %s failed", buf));
532                         device->cap._BQC = device->cap._BCQ = 0;
533                 }
534         }
535
536         *level = device->brightness->curr;
537         return 0;
538 }
539
540 static int
541 acpi_video_device_EDID(struct acpi_video_device *device,
542                        union acpi_object **edid, ssize_t length)
543 {
544         int status;
545         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
546         union acpi_object *obj;
547         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
548         struct acpi_object_list args = { 1, &arg0 };
549
550
551         *edid = NULL;
552
553         if (!device)
554                 return -ENODEV;
555         if (length == 128)
556                 arg0.integer.value = 1;
557         else if (length == 256)
558                 arg0.integer.value = 2;
559         else
560                 return -EINVAL;
561
562         status = acpi_evaluate_object(device->dev->handle, "_DDC", &args, &buffer);
563         if (ACPI_FAILURE(status))
564                 return -ENODEV;
565
566         obj = buffer.pointer;
567
568         if (obj && obj->type == ACPI_TYPE_BUFFER)
569                 *edid = obj;
570         else {
571                 printk(KERN_ERR PREFIX "Invalid _DDC data\n");
572                 status = -EFAULT;
573                 kfree(obj);
574         }
575
576         return status;
577 }
578
579 /* bus */
580
581 /*
582  *  Arg:
583  *      video           : video bus device pointer
584  *      bios_flag       : 
585  *              0.      The system BIOS should NOT automatically switch(toggle)
586  *                      the active display output.
587  *              1.      The system BIOS should automatically switch (toggle) the
588  *                      active display output. No switch event.
589  *              2.      The _DGS value should be locked.
590  *              3.      The system BIOS should not automatically switch (toggle) the
591  *                      active display output, but instead generate the display switch
592  *                      event notify code.
593  *      lcd_flag        :
594  *              0.      The system BIOS should automatically control the brightness level
595  *                      of the LCD when the power changes from AC to DC
596  *              1.      The system BIOS should NOT automatically control the brightness 
597  *                      level of the LCD when the power changes from AC to DC.
598  * Return Value:
599  *              -EINVAL wrong arg.
600  */
601
602 static int
603 acpi_video_bus_DOS(struct acpi_video_bus *video, int bios_flag, int lcd_flag)
604 {
605         acpi_status status;
606         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
607         struct acpi_object_list args = { 1, &arg0 };
608
609         if (!video->cap._DOS)
610                 return 0;
611
612         if (bios_flag < 0 || bios_flag > 3 || lcd_flag < 0 || lcd_flag > 1)
613                 return -EINVAL;
614         arg0.integer.value = (lcd_flag << 2) | bios_flag;
615         video->dos_setting = arg0.integer.value;
616         status = acpi_evaluate_object(video->device->handle, "_DOS",
617                 &args, NULL);
618         if (ACPI_FAILURE(status))
619                 return -EIO;
620
621         return 0;
622 }
623
624 /*
625  * Simple comparison function used to sort backlight levels.
626  */
627
628 static int
629 acpi_video_cmp_level(const void *a, const void *b)
630 {
631         return *(int *)a - *(int *)b;
632 }
633
634 /*
635  *  Arg:        
636  *      device  : video output device (LCD, CRT, ..)
637  *
638  *  Return Value:
639  *      Maximum brightness level
640  *
641  *  Allocate and initialize device->brightness.
642  */
643
644 static int
645 acpi_video_init_brightness(struct acpi_video_device *device)
646 {
647         union acpi_object *obj = NULL;
648         int i, max_level = 0, count = 0, level_ac_battery = 0;
649         unsigned long long level, level_old;
650         union acpi_object *o;
651         struct acpi_video_device_brightness *br = NULL;
652         int result = -EINVAL;
653
654         if (!ACPI_SUCCESS(acpi_video_device_lcd_query_levels(device, &obj))) {
655                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Could not query available "
656                                                 "LCD brightness level\n"));
657                 goto out;
658         }
659
660         if (obj->package.count < 2)
661                 goto out;
662
663         br = kzalloc(sizeof(*br), GFP_KERNEL);
664         if (!br) {
665                 printk(KERN_ERR "can't allocate memory\n");
666                 result = -ENOMEM;
667                 goto out;
668         }
669
670         br->levels = kmalloc((obj->package.count + 2) * sizeof *(br->levels),
671                                 GFP_KERNEL);
672         if (!br->levels) {
673                 result = -ENOMEM;
674                 goto out_free;
675         }
676
677         for (i = 0; i < obj->package.count; i++) {
678                 o = (union acpi_object *)&obj->package.elements[i];
679                 if (o->type != ACPI_TYPE_INTEGER) {
680                         printk(KERN_ERR PREFIX "Invalid data\n");
681                         continue;
682                 }
683                 br->levels[count] = (u32) o->integer.value;
684
685                 if (br->levels[count] > max_level)
686                         max_level = br->levels[count];
687                 count++;
688         }
689
690         /*
691          * some buggy BIOS don't export the levels
692          * when machine is on AC/Battery in _BCL package.
693          * In this case, the first two elements in _BCL packages
694          * are also supported brightness levels that OS should take care of.
695          */
696         for (i = 2; i < count; i++) {
697                 if (br->levels[i] == br->levels[0])
698                         level_ac_battery++;
699                 if (br->levels[i] == br->levels[1])
700                         level_ac_battery++;
701         }
702
703         if (level_ac_battery < 2) {
704                 level_ac_battery = 2 - level_ac_battery;
705                 br->flags._BCL_no_ac_battery_levels = 1;
706                 for (i = (count - 1 + level_ac_battery); i >= 2; i--)
707                         br->levels[i] = br->levels[i - level_ac_battery];
708                 count += level_ac_battery;
709         } else if (level_ac_battery > 2)
710                 ACPI_ERROR((AE_INFO, "Too many duplicates in _BCL package"));
711
712         /* Check if the _BCL package is in a reversed order */
713         if (max_level == br->levels[2]) {
714                 br->flags._BCL_reversed = 1;
715                 sort(&br->levels[2], count - 2, sizeof(br->levels[2]),
716                         acpi_video_cmp_level, NULL);
717         } else if (max_level != br->levels[count - 1])
718                 ACPI_ERROR((AE_INFO,
719                             "Found unordered _BCL package"));
720
721         br->count = count;
722         device->brightness = br;
723
724         /* Check the input/output of _BQC/_BCL/_BCM */
725         if ((max_level < 100) && (max_level <= (count - 2)))
726                 br->flags._BCL_use_index = 1;
727
728         /*
729          * _BCM is always consistent with _BCL,
730          * at least for all the laptops we have ever seen.
731          */
732         br->flags._BCM_use_index = br->flags._BCL_use_index;
733
734         /* _BQC uses INDEX while _BCL uses VALUE in some laptops */
735         br->curr = level = max_level;
736
737         if (!device->cap._BQC)
738                 goto set_level;
739
740         result = acpi_video_device_lcd_get_level_current(device,
741                                                          &level_old, true);
742         if (result)
743                 goto out_free_levels;
744
745         /*
746          * Set the level to maximum and check if _BQC uses indexed value
747          */
748         result = acpi_video_device_lcd_set_level(device, max_level);
749         if (result)
750                 goto out_free_levels;
751
752         result = acpi_video_device_lcd_get_level_current(device, &level, true);
753         if (result)
754                 goto out_free_levels;
755
756         br->flags._BQC_use_index = (level == max_level ? 0 : 1);
757
758         if (use_bios_initial_backlight) {
759                 level = acpi_video_bqc_value_to_level(device, level_old);
760                 /*
761                  * On some buggy laptops, _BQC returns an uninitialized
762                  * value when invoked for the first time, i.e.
763                  * level_old is invalid (no matter whether it's a level
764                  * or an index). Set the backlight to max_level in this case.
765                  */
766                 for (i = 2; i < br->count; i++)
767                         if (level_old == br->levels[i])
768                                 break;
769                 if (i == br->count)
770                         level = max_level;
771         }
772
773 set_level:
774         result = acpi_video_device_lcd_set_level(device, level);
775         if (result)
776                 goto out_free_levels;
777
778         ACPI_DEBUG_PRINT((ACPI_DB_INFO,
779                           "found %d brightness levels\n", count - 2));
780         kfree(obj);
781         return result;
782
783 out_free_levels:
784         kfree(br->levels);
785 out_free:
786         kfree(br);
787 out:
788         device->brightness = NULL;
789         kfree(obj);
790         return result;
791 }
792
793 /*
794  *  Arg:
795  *      device  : video output device (LCD, CRT, ..)
796  *
797  *  Return Value:
798  *      None
799  *
800  *  Find out all required AML methods defined under the output
801  *  device.
802  */
803
804 static void acpi_video_device_find_cap(struct acpi_video_device *device)
805 {
806         acpi_handle h_dummy1;
807
808         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_ADR", &h_dummy1))) {
809                 device->cap._ADR = 1;
810         }
811         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCL", &h_dummy1))) {
812                 device->cap._BCL = 1;
813         }
814         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCM", &h_dummy1))) {
815                 device->cap._BCM = 1;
816         }
817         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle,"_BQC",&h_dummy1)))
818                 device->cap._BQC = 1;
819         else if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCQ",
820                                 &h_dummy1))) {
821                 printk(KERN_WARNING FW_BUG "_BCQ is used instead of _BQC\n");
822                 device->cap._BCQ = 1;
823         }
824
825         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DDC", &h_dummy1))) {
826                 device->cap._DDC = 1;
827         }
828
829         if (acpi_video_backlight_support()) {
830                 struct backlight_properties props;
831                 struct pci_dev *pdev;
832                 acpi_handle acpi_parent;
833                 struct device *parent = NULL;
834                 int result;
835                 static int count = 0;
836                 char *name;
837
838                 result = acpi_video_init_brightness(device);
839                 if (result)
840                         return;
841                 name = kasprintf(GFP_KERNEL, "acpi_video%d", count);
842                 if (!name)
843                         return;
844                 count++;
845
846                 acpi_get_parent(device->dev->handle, &acpi_parent);
847
848                 pdev = acpi_get_pci_dev(acpi_parent);
849                 if (pdev) {
850                         parent = &pdev->dev;
851                         pci_dev_put(pdev);
852                 }
853
854                 memset(&props, 0, sizeof(struct backlight_properties));
855                 props.type = BACKLIGHT_FIRMWARE;
856                 props.max_brightness = device->brightness->count - 3;
857                 device->backlight = backlight_device_register(name,
858                                                               parent,
859                                                               device,
860                                                               &acpi_backlight_ops,
861                                                               &props);
862                 kfree(name);
863                 if (IS_ERR(device->backlight))
864                         return;
865
866                 /*
867                  * Save current brightness level in case we have to restore it
868                  * before acpi_video_device_lcd_set_level() is called next time.
869                  */
870                 device->backlight->props.brightness =
871                                 acpi_video_get_brightness(device->backlight);
872
873                 device->cooling_dev = thermal_cooling_device_register("LCD",
874                                         device->dev, &video_cooling_ops);
875                 if (IS_ERR(device->cooling_dev)) {
876                         /*
877                          * Set cooling_dev to NULL so we don't crash trying to
878                          * free it.
879                          * Also, why the hell we are returning early and
880                          * not attempt to register video output if cooling
881                          * device registration failed?
882                          * -- dtor
883                          */
884                         device->cooling_dev = NULL;
885                         return;
886                 }
887
888                 dev_info(&device->dev->dev, "registered as cooling_device%d\n",
889                          device->cooling_dev->id);
890                 result = sysfs_create_link(&device->dev->dev.kobj,
891                                 &device->cooling_dev->device.kobj,
892                                 "thermal_cooling");
893                 if (result)
894                         printk(KERN_ERR PREFIX "Create sysfs link\n");
895                 result = sysfs_create_link(&device->cooling_dev->device.kobj,
896                                 &device->dev->dev.kobj, "device");
897                 if (result)
898                         printk(KERN_ERR PREFIX "Create sysfs link\n");
899
900         }
901 }
902
903 /*
904  *  Arg:        
905  *      device  : video output device (VGA)
906  *
907  *  Return Value:
908  *      None
909  *
910  *  Find out all required AML methods defined under the video bus device.
911  */
912
913 static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
914 {
915         acpi_handle h_dummy1;
916
917         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOS", &h_dummy1))) {
918                 video->cap._DOS = 1;
919         }
920         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOD", &h_dummy1))) {
921                 video->cap._DOD = 1;
922         }
923         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_ROM", &h_dummy1))) {
924                 video->cap._ROM = 1;
925         }
926         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_GPD", &h_dummy1))) {
927                 video->cap._GPD = 1;
928         }
929         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_SPD", &h_dummy1))) {
930                 video->cap._SPD = 1;
931         }
932         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_VPO", &h_dummy1))) {
933                 video->cap._VPO = 1;
934         }
935 }
936
937 /*
938  * Check whether the video bus device has required AML method to
939  * support the desired features
940  */
941
942 static int acpi_video_bus_check(struct acpi_video_bus *video)
943 {
944         acpi_status status = -ENOENT;
945         struct pci_dev *dev;
946
947         if (!video)
948                 return -EINVAL;
949
950         dev = acpi_get_pci_dev(video->device->handle);
951         if (!dev)
952                 return -ENODEV;
953         pci_dev_put(dev);
954
955         /* Since there is no HID, CID and so on for VGA driver, we have
956          * to check well known required nodes.
957          */
958
959         /* Does this device support video switching? */
960         if (video->cap._DOS || video->cap._DOD) {
961                 if (!video->cap._DOS) {
962                         printk(KERN_WARNING FW_BUG
963                                 "ACPI(%s) defines _DOD but not _DOS\n",
964                                 acpi_device_bid(video->device));
965                 }
966                 video->flags.multihead = 1;
967                 status = 0;
968         }
969
970         /* Does this device support retrieving a video ROM? */
971         if (video->cap._ROM) {
972                 video->flags.rom = 1;
973                 status = 0;
974         }
975
976         /* Does this device support configuring which video device to POST? */
977         if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
978                 video->flags.post = 1;
979                 status = 0;
980         }
981
982         return status;
983 }
984
985 /* --------------------------------------------------------------------------
986                                  Driver Interface
987    -------------------------------------------------------------------------- */
988
989 /* device interface */
990 static struct acpi_video_device_attrib*
991 acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
992 {
993         struct acpi_video_enumerated_device *ids;
994         int i;
995
996         for (i = 0; i < video->attached_count; i++) {
997                 ids = &video->attached_array[i];
998                 if ((ids->value.int_val & 0xffff) == device_id)
999                         return &ids->value.attrib;
1000         }
1001
1002         return NULL;
1003 }
1004
1005 static int
1006 acpi_video_get_device_type(struct acpi_video_bus *video,
1007                            unsigned long device_id)
1008 {
1009         struct acpi_video_enumerated_device *ids;
1010         int i;
1011
1012         for (i = 0; i < video->attached_count; i++) {
1013                 ids = &video->attached_array[i];
1014                 if ((ids->value.int_val & 0xffff) == device_id)
1015                         return ids->value.int_val;
1016         }
1017
1018         return 0;
1019 }
1020
1021 static int
1022 acpi_video_bus_get_one_device(struct acpi_device *device,
1023                               struct acpi_video_bus *video)
1024 {
1025         unsigned long long device_id;
1026         int status, device_type;
1027         struct acpi_video_device *data;
1028         struct acpi_video_device_attrib* attribute;
1029
1030         if (!device || !video)
1031                 return -EINVAL;
1032
1033         status =
1034             acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
1035         if (ACPI_SUCCESS(status)) {
1036
1037                 data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
1038                 if (!data)
1039                         return -ENOMEM;
1040
1041                 strcpy(acpi_device_name(device), ACPI_VIDEO_DEVICE_NAME);
1042                 strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1043                 device->driver_data = data;
1044
1045                 data->device_id = device_id;
1046                 data->video = video;
1047                 data->dev = device;
1048
1049                 attribute = acpi_video_get_device_attr(video, device_id);
1050
1051                 if((attribute != NULL) && attribute->device_id_scheme) {
1052                         switch (attribute->display_type) {
1053                         case ACPI_VIDEO_DISPLAY_CRT:
1054                                 data->flags.crt = 1;
1055                                 break;
1056                         case ACPI_VIDEO_DISPLAY_TV:
1057                                 data->flags.tvout = 1;
1058                                 break;
1059                         case ACPI_VIDEO_DISPLAY_DVI:
1060                                 data->flags.dvi = 1;
1061                                 break;
1062                         case ACPI_VIDEO_DISPLAY_LCD:
1063                                 data->flags.lcd = 1;
1064                                 break;
1065                         default:
1066                                 data->flags.unknown = 1;
1067                                 break;
1068                         }
1069                         if(attribute->bios_can_detect)
1070                                 data->flags.bios = 1;
1071                 } else {
1072                         /* Check for legacy IDs */
1073                         device_type = acpi_video_get_device_type(video,
1074                                                                  device_id);
1075                         /* Ignore bits 16 and 18-20 */
1076                         switch (device_type & 0xffe2ffff) {
1077                         case ACPI_VIDEO_DISPLAY_LEGACY_MONITOR:
1078                                 data->flags.crt = 1;
1079                                 break;
1080                         case ACPI_VIDEO_DISPLAY_LEGACY_PANEL:
1081                                 data->flags.lcd = 1;
1082                                 break;
1083                         case ACPI_VIDEO_DISPLAY_LEGACY_TV:
1084                                 data->flags.tvout = 1;
1085                                 break;
1086                         default:
1087                                 data->flags.unknown = 1;
1088                         }
1089                 }
1090
1091                 acpi_video_device_bind(video, data);
1092                 acpi_video_device_find_cap(data);
1093
1094                 status = acpi_install_notify_handler(device->handle,
1095                                                      ACPI_DEVICE_NOTIFY,
1096                                                      acpi_video_device_notify,
1097                                                      data);
1098                 if (ACPI_FAILURE(status)) {
1099                         printk(KERN_ERR PREFIX
1100                                           "Error installing notify handler\n");
1101                         if(data->brightness)
1102                                 kfree(data->brightness->levels);
1103                         kfree(data->brightness);
1104                         kfree(data);
1105                         return -ENODEV;
1106                 }
1107
1108                 mutex_lock(&video->device_list_lock);
1109                 list_add_tail(&data->entry, &video->video_device_list);
1110                 mutex_unlock(&video->device_list_lock);
1111
1112                 return 0;
1113         }
1114
1115         return -ENOENT;
1116 }
1117
1118 /*
1119  *  Arg:
1120  *      video   : video bus device 
1121  *
1122  *  Return:
1123  *      none
1124  *  
1125  *  Enumerate the video device list of the video bus, 
1126  *  bind the ids with the corresponding video devices
1127  *  under the video bus.
1128  */
1129
1130 static void acpi_video_device_rebind(struct acpi_video_bus *video)
1131 {
1132         struct acpi_video_device *dev;
1133
1134         mutex_lock(&video->device_list_lock);
1135
1136         list_for_each_entry(dev, &video->video_device_list, entry)
1137                 acpi_video_device_bind(video, dev);
1138
1139         mutex_unlock(&video->device_list_lock);
1140 }
1141
1142 /*
1143  *  Arg:
1144  *      video   : video bus device 
1145  *      device  : video output device under the video 
1146  *              bus
1147  *
1148  *  Return:
1149  *      none
1150  *  
1151  *  Bind the ids with the corresponding video devices
1152  *  under the video bus.
1153  */
1154
1155 static void
1156 acpi_video_device_bind(struct acpi_video_bus *video,
1157                        struct acpi_video_device *device)
1158 {
1159         struct acpi_video_enumerated_device *ids;
1160         int i;
1161
1162         for (i = 0; i < video->attached_count; i++) {
1163                 ids = &video->attached_array[i];
1164                 if (device->device_id == (ids->value.int_val & 0xffff)) {
1165                         ids->bind_info = device;
1166                         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
1167                 }
1168         }
1169 }
1170
1171 /*
1172  *  Arg:
1173  *      video   : video bus device 
1174  *
1175  *  Return:
1176  *      < 0     : error
1177  *  
1178  *  Call _DOD to enumerate all devices attached to display adapter
1179  *
1180  */
1181
1182 static int acpi_video_device_enumerate(struct acpi_video_bus *video)
1183 {
1184         int status;
1185         int count;
1186         int i;
1187         struct acpi_video_enumerated_device *active_list;
1188         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1189         union acpi_object *dod = NULL;
1190         union acpi_object *obj;
1191
1192         status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
1193         if (!ACPI_SUCCESS(status)) {
1194                 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1195                 return status;
1196         }
1197
1198         dod = buffer.pointer;
1199         if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1200                 ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
1201                 status = -EFAULT;
1202                 goto out;
1203         }
1204
1205         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d video heads in _DOD\n",
1206                           dod->package.count));
1207
1208         active_list = kcalloc(1 + dod->package.count,
1209                               sizeof(struct acpi_video_enumerated_device),
1210                               GFP_KERNEL);
1211         if (!active_list) {
1212                 status = -ENOMEM;
1213                 goto out;
1214         }
1215
1216         count = 0;
1217         for (i = 0; i < dod->package.count; i++) {
1218                 obj = &dod->package.elements[i];
1219
1220                 if (obj->type != ACPI_TYPE_INTEGER) {
1221                         printk(KERN_ERR PREFIX
1222                                 "Invalid _DOD data in element %d\n", i);
1223                         continue;
1224                 }
1225
1226                 active_list[count].value.int_val = obj->integer.value;
1227                 active_list[count].bind_info = NULL;
1228                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
1229                                   (int)obj->integer.value));
1230                 count++;
1231         }
1232
1233         kfree(video->attached_array);
1234
1235         video->attached_array = active_list;
1236         video->attached_count = count;
1237
1238  out:
1239         kfree(buffer.pointer);
1240         return status;
1241 }
1242
1243 static int
1244 acpi_video_get_next_level(struct acpi_video_device *device,
1245                           u32 level_current, u32 event)
1246 {
1247         int min, max, min_above, max_below, i, l, delta = 255;
1248         max = max_below = 0;
1249         min = min_above = 255;
1250         /* Find closest level to level_current */
1251         for (i = 2; i < device->brightness->count; i++) {
1252                 l = device->brightness->levels[i];
1253                 if (abs(l - level_current) < abs(delta)) {
1254                         delta = l - level_current;
1255                         if (!delta)
1256                                 break;
1257                 }
1258         }
1259         /* Ajust level_current to closest available level */
1260         level_current += delta;
1261         for (i = 2; i < device->brightness->count; i++) {
1262                 l = device->brightness->levels[i];
1263                 if (l < min)
1264                         min = l;
1265                 if (l > max)
1266                         max = l;
1267                 if (l < min_above && l > level_current)
1268                         min_above = l;
1269                 if (l > max_below && l < level_current)
1270                         max_below = l;
1271         }
1272
1273         switch (event) {
1274         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:
1275                 return (level_current < max) ? min_above : min;
1276         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:
1277                 return (level_current < max) ? min_above : max;
1278         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:
1279                 return (level_current > min) ? max_below : min;
1280         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:
1281         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:
1282                 return 0;
1283         default:
1284                 return level_current;
1285         }
1286 }
1287
1288 static int
1289 acpi_video_switch_brightness(struct acpi_video_device *device, int event)
1290 {
1291         unsigned long long level_current, level_next;
1292         int result = -EINVAL;
1293
1294         /* no warning message if acpi_backlight=vendor is used */
1295         if (!acpi_video_backlight_support())
1296                 return 0;
1297
1298         if (!device->brightness)
1299                 goto out;
1300
1301         result = acpi_video_device_lcd_get_level_current(device,
1302                                                          &level_current,
1303                                                          false);
1304         if (result)
1305                 goto out;
1306
1307         level_next = acpi_video_get_next_level(device, level_current, event);
1308
1309         result = acpi_video_device_lcd_set_level(device, level_next);
1310
1311         if (!result)
1312                 backlight_force_update(device->backlight,
1313                                        BACKLIGHT_UPDATE_HOTKEY);
1314
1315 out:
1316         if (result)
1317                 printk(KERN_ERR PREFIX "Failed to switch the brightness\n");
1318
1319         return result;
1320 }
1321
1322 int acpi_video_get_edid(struct acpi_device *device, int type, int device_id,
1323                         void **edid)
1324 {
1325         struct acpi_video_bus *video;
1326         struct acpi_video_device *video_device;
1327         union acpi_object *buffer = NULL;
1328         acpi_status status;
1329         int i, length;
1330
1331         if (!device || !acpi_driver_data(device))
1332                 return -EINVAL;
1333
1334         video = acpi_driver_data(device);
1335
1336         for (i = 0; i < video->attached_count; i++) {
1337                 video_device = video->attached_array[i].bind_info;
1338                 length = 256;
1339
1340                 if (!video_device)
1341                         continue;
1342
1343                 if (!video_device->cap._DDC)
1344                         continue;
1345
1346                 if (type) {
1347                         switch (type) {
1348                         case ACPI_VIDEO_DISPLAY_CRT:
1349                                 if (!video_device->flags.crt)
1350                                         continue;
1351                                 break;
1352                         case ACPI_VIDEO_DISPLAY_TV:
1353                                 if (!video_device->flags.tvout)
1354                                         continue;
1355                                 break;
1356                         case ACPI_VIDEO_DISPLAY_DVI:
1357                                 if (!video_device->flags.dvi)
1358                                         continue;
1359                                 break;
1360                         case ACPI_VIDEO_DISPLAY_LCD:
1361                                 if (!video_device->flags.lcd)
1362                                         continue;
1363                                 break;
1364                         }
1365                 } else if (video_device->device_id != device_id) {
1366                         continue;
1367                 }
1368
1369                 status = acpi_video_device_EDID(video_device, &buffer, length);
1370
1371                 if (ACPI_FAILURE(status) || !buffer ||
1372                     buffer->type != ACPI_TYPE_BUFFER) {
1373                         length = 128;
1374                         status = acpi_video_device_EDID(video_device, &buffer,
1375                                                         length);
1376                         if (ACPI_FAILURE(status) || !buffer ||
1377                             buffer->type != ACPI_TYPE_BUFFER) {
1378                                 continue;
1379                         }
1380                 }
1381
1382                 *edid = buffer->buffer.pointer;
1383                 return length;
1384         }
1385
1386         return -ENODEV;
1387 }
1388 EXPORT_SYMBOL(acpi_video_get_edid);
1389
1390 static int
1391 acpi_video_bus_get_devices(struct acpi_video_bus *video,
1392                            struct acpi_device *device)
1393 {
1394         int status = 0;
1395         struct acpi_device *dev;
1396
1397         /*
1398          * There are systems where video module known to work fine regardless
1399          * of broken _DOD and ignoring returned value here doesn't cause
1400          * any issues later.
1401          */
1402         acpi_video_device_enumerate(video);
1403
1404         list_for_each_entry(dev, &device->children, node) {
1405
1406                 status = acpi_video_bus_get_one_device(dev, video);
1407                 if (status) {
1408                         printk(KERN_WARNING PREFIX
1409                                         "Can't attach device\n");
1410                         continue;
1411                 }
1412         }
1413         return status;
1414 }
1415
1416 static int acpi_video_bus_put_one_device(struct acpi_video_device *device)
1417 {
1418         acpi_status status;
1419
1420         if (!device || !device->video)
1421                 return -ENOENT;
1422
1423         status = acpi_remove_notify_handler(device->dev->handle,
1424                                             ACPI_DEVICE_NOTIFY,
1425                                             acpi_video_device_notify);
1426         if (ACPI_FAILURE(status)) {
1427                 printk(KERN_WARNING PREFIX
1428                        "Can't remove video notify handler\n");
1429         }
1430         if (device->backlight) {
1431                 backlight_device_unregister(device->backlight);
1432                 device->backlight = NULL;
1433         }
1434         if (device->cooling_dev) {
1435                 sysfs_remove_link(&device->dev->dev.kobj,
1436                                   "thermal_cooling");
1437                 sysfs_remove_link(&device->cooling_dev->device.kobj,
1438                                   "device");
1439                 thermal_cooling_device_unregister(device->cooling_dev);
1440                 device->cooling_dev = NULL;
1441         }
1442
1443         return 0;
1444 }
1445
1446 static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
1447 {
1448         int status;
1449         struct acpi_video_device *dev, *next;
1450
1451         mutex_lock(&video->device_list_lock);
1452
1453         list_for_each_entry_safe(dev, next, &video->video_device_list, entry) {
1454
1455                 status = acpi_video_bus_put_one_device(dev);
1456                 if (ACPI_FAILURE(status))
1457                         printk(KERN_WARNING PREFIX
1458                                "hhuuhhuu bug in acpi video driver.\n");
1459
1460                 if (dev->brightness) {
1461                         kfree(dev->brightness->levels);
1462                         kfree(dev->brightness);
1463                 }
1464                 list_del(&dev->entry);
1465                 kfree(dev);
1466         }
1467
1468         mutex_unlock(&video->device_list_lock);
1469
1470         return 0;
1471 }
1472
1473 /* acpi_video interface */
1474
1475 static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
1476 {
1477         return acpi_video_bus_DOS(video, 0, 0);
1478 }
1479
1480 static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
1481 {
1482         return acpi_video_bus_DOS(video, 0, 1);
1483 }
1484
1485 static void acpi_video_bus_notify(struct acpi_device *device, u32 event)
1486 {
1487         struct acpi_video_bus *video = acpi_driver_data(device);
1488         struct input_dev *input;
1489         int keycode = 0;
1490
1491         if (!video)
1492                 return;
1493
1494         input = video->input;
1495
1496         switch (event) {
1497         case ACPI_VIDEO_NOTIFY_SWITCH:  /* User requested a switch,
1498                                          * most likely via hotkey. */
1499                 acpi_bus_generate_proc_event(device, event, 0);
1500                 keycode = KEY_SWITCHVIDEOMODE;
1501                 break;
1502
1503         case ACPI_VIDEO_NOTIFY_PROBE:   /* User plugged in or removed a video
1504                                          * connector. */
1505                 acpi_video_device_enumerate(video);
1506                 acpi_video_device_rebind(video);
1507                 acpi_bus_generate_proc_event(device, event, 0);
1508                 keycode = KEY_SWITCHVIDEOMODE;
1509                 break;
1510
1511         case ACPI_VIDEO_NOTIFY_CYCLE:   /* Cycle Display output hotkey pressed. */
1512                 acpi_bus_generate_proc_event(device, event, 0);
1513                 keycode = KEY_SWITCHVIDEOMODE;
1514                 break;
1515         case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:     /* Next Display output hotkey pressed. */
1516                 acpi_bus_generate_proc_event(device, event, 0);
1517                 keycode = KEY_VIDEO_NEXT;
1518                 break;
1519         case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:     /* previous Display output hotkey pressed. */
1520                 acpi_bus_generate_proc_event(device, event, 0);
1521                 keycode = KEY_VIDEO_PREV;
1522                 break;
1523
1524         default:
1525                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1526                                   "Unsupported event [0x%x]\n", event));
1527                 break;
1528         }
1529
1530         if (acpi_notifier_call_chain(device, event, 0))
1531                 /* Something vetoed the keypress. */
1532                 keycode = 0;
1533
1534         if (keycode) {
1535                 input_report_key(input, keycode, 1);
1536                 input_sync(input);
1537                 input_report_key(input, keycode, 0);
1538                 input_sync(input);
1539         }
1540
1541         return;
1542 }
1543
1544 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
1545 {
1546         struct acpi_video_device *video_device = data;
1547         struct acpi_device *device = NULL;
1548         struct acpi_video_bus *bus;
1549         struct input_dev *input;
1550         int keycode = 0;
1551
1552         if (!video_device)
1553                 return;
1554
1555         device = video_device->dev;
1556         bus = video_device->video;
1557         input = bus->input;
1558
1559         switch (event) {
1560         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:        /* Cycle brightness */
1561                 if (brightness_switch_enabled)
1562                         acpi_video_switch_brightness(video_device, event);
1563                 acpi_bus_generate_proc_event(device, event, 0);
1564                 keycode = KEY_BRIGHTNESS_CYCLE;
1565                 break;
1566         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:  /* Increase 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_BRIGHTNESSUP;
1571                 break;
1572         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:  /* Decrease 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_BRIGHTNESSDOWN;
1577                 break;
1578         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS: /* zero 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_BRIGHTNESS_ZERO;
1583                 break;
1584         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:     /* display device off */
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_DISPLAY_OFF;
1589                 break;
1590         default:
1591                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1592                                   "Unsupported event [0x%x]\n", event));
1593                 break;
1594         }
1595
1596         acpi_notifier_call_chain(device, event, 0);
1597
1598         if (keycode) {
1599                 input_report_key(input, keycode, 1);
1600                 input_sync(input);
1601                 input_report_key(input, keycode, 0);
1602                 input_sync(input);
1603         }
1604
1605         return;
1606 }
1607
1608 static int acpi_video_resume(struct notifier_block *nb,
1609                                 unsigned long val, void *ign)
1610 {
1611         struct acpi_video_bus *video;
1612         struct acpi_video_device *video_device;
1613         int i;
1614
1615         switch (val) {
1616         case PM_HIBERNATION_PREPARE:
1617         case PM_SUSPEND_PREPARE:
1618         case PM_RESTORE_PREPARE:
1619                 return NOTIFY_DONE;
1620         }
1621
1622         video = container_of(nb, struct acpi_video_bus, pm_nb);
1623
1624         dev_info(&video->device->dev, "Restoring backlight state\n");
1625
1626         for (i = 0; i < video->attached_count; i++) {
1627                 video_device = video->attached_array[i].bind_info;
1628                 if (video_device && video_device->backlight)
1629                         acpi_video_set_brightness(video_device->backlight);
1630         }
1631
1632         return NOTIFY_OK;
1633 }
1634
1635 static acpi_status
1636 acpi_video_bus_match(acpi_handle handle, u32 level, void *context,
1637                         void **return_value)
1638 {
1639         struct acpi_device *device = context;
1640         struct acpi_device *sibling;
1641         int result;
1642
1643         if (handle == device->handle)
1644                 return AE_CTRL_TERMINATE;
1645
1646         result = acpi_bus_get_device(handle, &sibling);
1647         if (result)
1648                 return AE_OK;
1649
1650         if (!strcmp(acpi_device_name(sibling), ACPI_VIDEO_BUS_NAME))
1651                         return AE_ALREADY_EXISTS;
1652
1653         return AE_OK;
1654 }
1655
1656 static int instance;
1657
1658 static int acpi_video_bus_add(struct acpi_device *device)
1659 {
1660         struct acpi_video_bus *video;
1661         struct input_dev *input;
1662         int error;
1663         acpi_status status;
1664
1665         status = acpi_walk_namespace(ACPI_TYPE_DEVICE,
1666                                 device->parent->handle, 1,
1667                                 acpi_video_bus_match, NULL,
1668                                 device, NULL);
1669         if (status == AE_ALREADY_EXISTS) {
1670                 printk(KERN_WARNING FW_BUG
1671                         "Duplicate ACPI video bus devices for the"
1672                         " same VGA controller, please try module "
1673                         "parameter \"video.allow_duplicates=1\""
1674                         "if the current driver doesn't work.\n");
1675                 if (!allow_duplicates)
1676                         return -ENODEV;
1677         }
1678
1679         video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
1680         if (!video)
1681                 return -ENOMEM;
1682
1683         /* a hack to fix the duplicate name "VID" problem on T61 */
1684         if (!strcmp(device->pnp.bus_id, "VID")) {
1685                 if (instance)
1686                         device->pnp.bus_id[3] = '0' + instance;
1687                 instance ++;
1688         }
1689         /* a hack to fix the duplicate name "VGA" problem on Pa 3553 */
1690         if (!strcmp(device->pnp.bus_id, "VGA")) {
1691                 if (instance)
1692                         device->pnp.bus_id[3] = '0' + instance;
1693                 instance++;
1694         }
1695
1696         video->device = device;
1697         strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
1698         strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1699         device->driver_data = video;
1700
1701         acpi_video_bus_find_cap(video);
1702         error = acpi_video_bus_check(video);
1703         if (error)
1704                 goto err_free_video;
1705
1706         mutex_init(&video->device_list_lock);
1707         INIT_LIST_HEAD(&video->video_device_list);
1708
1709         error = acpi_video_bus_get_devices(video, device);
1710         if (error)
1711                 goto err_free_video;
1712
1713         video->input = input = input_allocate_device();
1714         if (!input) {
1715                 error = -ENOMEM;
1716                 goto err_put_video;
1717         }
1718
1719         error = acpi_video_bus_start_devices(video);
1720         if (error)
1721                 goto err_free_input_dev;
1722
1723         snprintf(video->phys, sizeof(video->phys),
1724                 "%s/video/input0", acpi_device_hid(video->device));
1725
1726         input->name = acpi_device_name(video->device);
1727         input->phys = video->phys;
1728         input->id.bustype = BUS_HOST;
1729         input->id.product = 0x06;
1730         input->dev.parent = &device->dev;
1731         input->evbit[0] = BIT(EV_KEY);
1732         set_bit(KEY_SWITCHVIDEOMODE, input->keybit);
1733         set_bit(KEY_VIDEO_NEXT, input->keybit);
1734         set_bit(KEY_VIDEO_PREV, input->keybit);
1735         set_bit(KEY_BRIGHTNESS_CYCLE, input->keybit);
1736         set_bit(KEY_BRIGHTNESSUP, input->keybit);
1737         set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
1738         set_bit(KEY_BRIGHTNESS_ZERO, input->keybit);
1739         set_bit(KEY_DISPLAY_OFF, input->keybit);
1740
1741         printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
1742                ACPI_VIDEO_DEVICE_NAME, acpi_device_bid(device),
1743                video->flags.multihead ? "yes" : "no",
1744                video->flags.rom ? "yes" : "no",
1745                video->flags.post ? "yes" : "no");
1746
1747         video->pm_nb.notifier_call = acpi_video_resume;
1748         video->pm_nb.priority = 0;
1749         error = register_pm_notifier(&video->pm_nb);
1750         if (error)
1751                 goto err_stop_video;
1752
1753         error = input_register_device(input);
1754         if (error)
1755                 goto err_unregister_pm_notifier;
1756
1757         return 0;
1758
1759  err_unregister_pm_notifier:
1760         unregister_pm_notifier(&video->pm_nb);
1761  err_stop_video:
1762         acpi_video_bus_stop_devices(video);
1763  err_free_input_dev:
1764         input_free_device(input);
1765  err_put_video:
1766         acpi_video_bus_put_devices(video);
1767         kfree(video->attached_array);
1768  err_free_video:
1769         kfree(video);
1770         device->driver_data = NULL;
1771
1772         return error;
1773 }
1774
1775 static int acpi_video_bus_remove(struct acpi_device *device)
1776 {
1777         struct acpi_video_bus *video = NULL;
1778
1779
1780         if (!device || !acpi_driver_data(device))
1781                 return -EINVAL;
1782
1783         video = acpi_driver_data(device);
1784
1785         unregister_pm_notifier(&video->pm_nb);
1786
1787         acpi_video_bus_stop_devices(video);
1788         acpi_video_bus_put_devices(video);
1789
1790         input_unregister_device(video->input);
1791         kfree(video->attached_array);
1792         kfree(video);
1793
1794         return 0;
1795 }
1796
1797 static int __init is_i740(struct pci_dev *dev)
1798 {
1799         if (dev->device == 0x00D1)
1800                 return 1;
1801         if (dev->device == 0x7000)
1802                 return 1;
1803         return 0;
1804 }
1805
1806 static int __init intel_opregion_present(void)
1807 {
1808         int opregion = 0;
1809         struct pci_dev *dev = NULL;
1810         u32 address;
1811
1812         for_each_pci_dev(dev) {
1813                 if ((dev->class >> 8) != PCI_CLASS_DISPLAY_VGA)
1814                         continue;
1815                 if (dev->vendor != PCI_VENDOR_ID_INTEL)
1816                         continue;
1817                 /* We don't want to poke around undefined i740 registers */
1818                 if (is_i740(dev))
1819                         continue;
1820                 pci_read_config_dword(dev, 0xfc, &address);
1821                 if (!address)
1822                         continue;
1823                 opregion = 1;
1824         }
1825         return opregion;
1826 }
1827
1828 int acpi_video_register(void)
1829 {
1830         int result = 0;
1831         if (register_count) {
1832                 /*
1833                  * if the function of acpi_video_register is already called,
1834                  * don't register the acpi_vide_bus again and return no error.
1835                  */
1836                 return 0;
1837         }
1838
1839         result = acpi_bus_register_driver(&acpi_video_bus);
1840         if (result < 0)
1841                 return -ENODEV;
1842
1843         /*
1844          * When the acpi_video_bus is loaded successfully, increase
1845          * the counter reference.
1846          */
1847         register_count = 1;
1848
1849         return 0;
1850 }
1851 EXPORT_SYMBOL(acpi_video_register);
1852
1853 void acpi_video_unregister(void)
1854 {
1855         if (!register_count) {
1856                 /*
1857                  * If the acpi video bus is already unloaded, don't
1858                  * unload it again and return directly.
1859                  */
1860                 return;
1861         }
1862         acpi_bus_unregister_driver(&acpi_video_bus);
1863
1864         register_count = 0;
1865
1866         return;
1867 }
1868 EXPORT_SYMBOL(acpi_video_unregister);
1869
1870 /*
1871  * This is kind of nasty. Hardware using Intel chipsets may require
1872  * the video opregion code to be run first in order to initialise
1873  * state before any ACPI video calls are made. To handle this we defer
1874  * registration of the video class until the opregion code has run.
1875  */
1876
1877 static int __init acpi_video_init(void)
1878 {
1879         dmi_check_system(video_dmi_table);
1880
1881         if (intel_opregion_present())
1882                 return 0;
1883
1884         return acpi_video_register();
1885 }
1886
1887 static void __exit acpi_video_exit(void)
1888 {
1889         acpi_video_unregister();
1890
1891         return;
1892 }
1893
1894 module_init(acpi_video_init);
1895 module_exit(acpi_video_exit);