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