6cb3e7b1214561d7b3d02572f925d8e8d6fd2f4f
[safe/jmp/linux-2.6] / 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/proc_fs.h>
33 #include <linux/seq_file.h>
34 #include <linux/input.h>
35 #include <linux/backlight.h>
36 #include <linux/video_output.h>
37 #include <asm/uaccess.h>
38
39 #include <acpi/acpi_bus.h>
40 #include <acpi/acpi_drivers.h>
41
42 #define ACPI_VIDEO_COMPONENT            0x08000000
43 #define ACPI_VIDEO_CLASS                "video"
44 #define ACPI_VIDEO_BUS_NAME             "Video Bus"
45 #define ACPI_VIDEO_DEVICE_NAME          "Video Device"
46 #define ACPI_VIDEO_NOTIFY_SWITCH        0x80
47 #define ACPI_VIDEO_NOTIFY_PROBE         0x81
48 #define ACPI_VIDEO_NOTIFY_CYCLE         0x82
49 #define ACPI_VIDEO_NOTIFY_NEXT_OUTPUT   0x83
50 #define ACPI_VIDEO_NOTIFY_PREV_OUTPUT   0x84
51
52 #define ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS      0x85
53 #define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS        0x86
54 #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS        0x87
55 #define ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS       0x88
56 #define ACPI_VIDEO_NOTIFY_DISPLAY_OFF           0x89
57
58 #define ACPI_VIDEO_HEAD_INVALID         (~0u - 1)
59 #define ACPI_VIDEO_HEAD_END             (~0u)
60 #define MAX_NAME_LEN    20
61
62 #define ACPI_VIDEO_DISPLAY_CRT  1
63 #define ACPI_VIDEO_DISPLAY_TV   2
64 #define ACPI_VIDEO_DISPLAY_DVI  3
65 #define ACPI_VIDEO_DISPLAY_LCD  4
66
67 #define _COMPONENT              ACPI_VIDEO_COMPONENT
68 ACPI_MODULE_NAME("video");
69
70 MODULE_AUTHOR("Bruno Ducrot");
71 MODULE_DESCRIPTION("ACPI Video Driver");
72 MODULE_LICENSE("GPL");
73
74 static int acpi_video_bus_add(struct acpi_device *device);
75 static int acpi_video_bus_remove(struct acpi_device *device, int type);
76
77 static const struct acpi_device_id video_device_ids[] = {
78         {ACPI_VIDEO_HID, 0},
79         {"", 0},
80 };
81 MODULE_DEVICE_TABLE(acpi, video_device_ids);
82
83 static struct acpi_driver acpi_video_bus = {
84         .name = "video",
85         .class = ACPI_VIDEO_CLASS,
86         .ids = video_device_ids,
87         .ops = {
88                 .add = acpi_video_bus_add,
89                 .remove = acpi_video_bus_remove,
90                 },
91 };
92
93 struct acpi_video_bus_flags {
94         u8 multihead:1;         /* can switch video heads */
95         u8 rom:1;               /* can retrieve a video rom */
96         u8 post:1;              /* can configure the head to */
97         u8 reserved:5;
98 };
99
100 struct acpi_video_bus_cap {
101         u8 _DOS:1;              /*Enable/Disable output switching */
102         u8 _DOD:1;              /*Enumerate all devices attached to display adapter */
103         u8 _ROM:1;              /*Get ROM Data */
104         u8 _GPD:1;              /*Get POST Device */
105         u8 _SPD:1;              /*Set POST Device */
106         u8 _VPO:1;              /*Video POST Options */
107         u8 reserved:2;
108 };
109
110 struct acpi_video_device_attrib {
111         u32 display_index:4;    /* A zero-based instance of the Display */
112         u32 display_port_attachment:4;  /*This field differentiates the display type */
113         u32 display_type:4;     /*Describe the specific type in use */
114         u32 vendor_specific:4;  /*Chipset Vendor Specific */
115         u32 bios_can_detect:1;  /*BIOS can detect the device */
116         u32 depend_on_vga:1;    /*Non-VGA output device whose power is related to 
117                                    the VGA device. */
118         u32 pipe_id:3;          /*For VGA multiple-head devices. */
119         u32 reserved:10;        /*Must be 0 */
120         u32 device_id_scheme:1; /*Device ID Scheme */
121 };
122
123 struct acpi_video_enumerated_device {
124         union {
125                 u32 int_val;
126                 struct acpi_video_device_attrib attrib;
127         } value;
128         struct acpi_video_device *bind_info;
129 };
130
131 struct acpi_video_bus {
132         struct acpi_device *device;
133         u8 dos_setting;
134         struct acpi_video_enumerated_device *attached_array;
135         u8 attached_count;
136         struct acpi_video_bus_cap cap;
137         struct acpi_video_bus_flags flags;
138         struct semaphore sem;
139         struct list_head video_device_list;
140         struct proc_dir_entry *dir;
141         struct input_dev *input;
142         char phys[32];  /* for input device */
143 };
144
145 struct acpi_video_device_flags {
146         u8 crt:1;
147         u8 lcd:1;
148         u8 tvout:1;
149         u8 dvi:1;
150         u8 bios:1;
151         u8 unknown:1;
152         u8 reserved:2;
153 };
154
155 struct acpi_video_device_cap {
156         u8 _ADR:1;              /*Return the unique ID */
157         u8 _BCL:1;              /*Query list of brightness control levels supported */
158         u8 _BCM:1;              /*Set the brightness level */
159         u8 _BQC:1;              /* Get current brightness level */
160         u8 _DDC:1;              /*Return the EDID for this device */
161         u8 _DCS:1;              /*Return status of output device */
162         u8 _DGS:1;              /*Query graphics state */
163         u8 _DSS:1;              /*Device state set */
164 };
165
166 struct acpi_video_device_brightness {
167         int curr;
168         int count;
169         int *levels;
170 };
171
172 struct acpi_video_device {
173         unsigned long device_id;
174         struct acpi_video_device_flags flags;
175         struct acpi_video_device_cap cap;
176         struct list_head entry;
177         struct acpi_video_bus *video;
178         struct acpi_device *dev;
179         struct acpi_video_device_brightness *brightness;
180         struct backlight_device *backlight;
181         struct output_device *output_dev;
182 };
183
184 /* bus */
185 static int acpi_video_bus_info_open_fs(struct inode *inode, struct file *file);
186 static struct file_operations acpi_video_bus_info_fops = {
187         .open = acpi_video_bus_info_open_fs,
188         .read = seq_read,
189         .llseek = seq_lseek,
190         .release = single_release,
191 };
192
193 static int acpi_video_bus_ROM_open_fs(struct inode *inode, struct file *file);
194 static struct file_operations acpi_video_bus_ROM_fops = {
195         .open = acpi_video_bus_ROM_open_fs,
196         .read = seq_read,
197         .llseek = seq_lseek,
198         .release = single_release,
199 };
200
201 static int acpi_video_bus_POST_info_open_fs(struct inode *inode,
202                                             struct file *file);
203 static struct file_operations acpi_video_bus_POST_info_fops = {
204         .open = acpi_video_bus_POST_info_open_fs,
205         .read = seq_read,
206         .llseek = seq_lseek,
207         .release = single_release,
208 };
209
210 static int acpi_video_bus_POST_open_fs(struct inode *inode, struct file *file);
211 static struct file_operations acpi_video_bus_POST_fops = {
212         .open = acpi_video_bus_POST_open_fs,
213         .read = seq_read,
214         .llseek = seq_lseek,
215         .release = single_release,
216 };
217
218 static int acpi_video_bus_DOS_open_fs(struct inode *inode, struct file *file);
219 static struct file_operations acpi_video_bus_DOS_fops = {
220         .open = acpi_video_bus_DOS_open_fs,
221         .read = seq_read,
222         .llseek = seq_lseek,
223         .release = single_release,
224 };
225
226 /* device */
227 static int acpi_video_device_info_open_fs(struct inode *inode,
228                                           struct file *file);
229 static struct file_operations acpi_video_device_info_fops = {
230         .open = acpi_video_device_info_open_fs,
231         .read = seq_read,
232         .llseek = seq_lseek,
233         .release = single_release,
234 };
235
236 static int acpi_video_device_state_open_fs(struct inode *inode,
237                                            struct file *file);
238 static struct file_operations acpi_video_device_state_fops = {
239         .open = acpi_video_device_state_open_fs,
240         .read = seq_read,
241         .llseek = seq_lseek,
242         .release = single_release,
243 };
244
245 static int acpi_video_device_brightness_open_fs(struct inode *inode,
246                                                 struct file *file);
247 static struct file_operations acpi_video_device_brightness_fops = {
248         .open = acpi_video_device_brightness_open_fs,
249         .read = seq_read,
250         .llseek = seq_lseek,
251         .release = single_release,
252 };
253
254 static int acpi_video_device_EDID_open_fs(struct inode *inode,
255                                           struct file *file);
256 static struct file_operations acpi_video_device_EDID_fops = {
257         .open = acpi_video_device_EDID_open_fs,
258         .read = seq_read,
259         .llseek = seq_lseek,
260         .release = single_release,
261 };
262
263 static char device_decode[][30] = {
264         "motherboard VGA device",
265         "PCI VGA device",
266         "AGP VGA device",
267         "UNKNOWN",
268 };
269
270 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data);
271 static void acpi_video_device_rebind(struct acpi_video_bus *video);
272 static void acpi_video_device_bind(struct acpi_video_bus *video,
273                                    struct acpi_video_device *device);
274 static int acpi_video_device_enumerate(struct acpi_video_bus *video);
275 static int acpi_video_switch_output(struct acpi_video_bus *video, int event);
276 static int acpi_video_device_lcd_set_level(struct acpi_video_device *device,
277                         int level);
278 static int acpi_video_device_lcd_get_level_current(
279                         struct acpi_video_device *device,
280                         unsigned long *level);
281 static int acpi_video_get_next_level(struct acpi_video_device *device,
282                                      u32 level_current, u32 event);
283 static void acpi_video_switch_brightness(struct acpi_video_device *device,
284                                          int event);
285 static int acpi_video_device_get_state(struct acpi_video_device *device,
286                             unsigned long *state);
287 static int acpi_video_output_get(struct output_device *od);
288 static int acpi_video_device_set_state(struct acpi_video_device *device, int state);
289
290 /*backlight device sysfs support*/
291 static int acpi_video_get_brightness(struct backlight_device *bd)
292 {
293         unsigned long cur_level;
294         struct acpi_video_device *vd =
295                 (struct acpi_video_device *)bl_get_data(bd);
296         acpi_video_device_lcd_get_level_current(vd, &cur_level);
297         return (int) cur_level;
298 }
299
300 static int acpi_video_set_brightness(struct backlight_device *bd)
301 {
302         int request_level = bd->props.brightness;
303         struct acpi_video_device *vd =
304                 (struct acpi_video_device *)bl_get_data(bd);
305         acpi_video_device_lcd_set_level(vd, request_level);
306         return 0;
307 }
308
309 static struct backlight_ops acpi_backlight_ops = {
310         .get_brightness = acpi_video_get_brightness,
311         .update_status  = acpi_video_set_brightness,
312 };
313
314 /*video output device sysfs support*/
315 static int acpi_video_output_get(struct output_device *od)
316 {
317         unsigned long state;
318         struct acpi_video_device *vd =
319                 (struct acpi_video_device *)class_get_devdata(&od->class_dev);
320         acpi_video_device_get_state(vd, &state);
321         return (int)state;
322 }
323
324 static int acpi_video_output_set(struct output_device *od)
325 {
326         unsigned long state = od->request_state;
327         struct acpi_video_device *vd=
328                 (struct acpi_video_device *)class_get_devdata(&od->class_dev);
329         return acpi_video_device_set_state(vd, state);
330 }
331
332 static struct output_properties acpi_output_properties = {
333         .set_state = acpi_video_output_set,
334         .get_status = acpi_video_output_get,
335 };
336 /* --------------------------------------------------------------------------
337                                Video Management
338    -------------------------------------------------------------------------- */
339
340 /* device */
341
342 static int
343 acpi_video_device_query(struct acpi_video_device *device, unsigned long *state)
344 {
345         int status;
346
347         status = acpi_evaluate_integer(device->dev->handle, "_DGS", NULL, state);
348
349         return status;
350 }
351
352 static int
353 acpi_video_device_get_state(struct acpi_video_device *device,
354                             unsigned long *state)
355 {
356         int status;
357
358         status = acpi_evaluate_integer(device->dev->handle, "_DCS", NULL, state);
359
360         return status;
361 }
362
363 static int
364 acpi_video_device_set_state(struct acpi_video_device *device, int state)
365 {
366         int status;
367         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
368         struct acpi_object_list args = { 1, &arg0 };
369         unsigned long ret;
370
371
372         arg0.integer.value = state;
373         status = acpi_evaluate_integer(device->dev->handle, "_DSS", &args, &ret);
374
375         return status;
376 }
377
378 static int
379 acpi_video_device_lcd_query_levels(struct acpi_video_device *device,
380                                    union acpi_object **levels)
381 {
382         int status;
383         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
384         union acpi_object *obj;
385
386
387         *levels = NULL;
388
389         status = acpi_evaluate_object(device->dev->handle, "_BCL", NULL, &buffer);
390         if (!ACPI_SUCCESS(status))
391                 return status;
392         obj = (union acpi_object *)buffer.pointer;
393         if (!obj || (obj->type != ACPI_TYPE_PACKAGE)) {
394                 printk(KERN_ERR PREFIX "Invalid _BCL data\n");
395                 status = -EFAULT;
396                 goto err;
397         }
398
399         *levels = obj;
400
401         return 0;
402
403       err:
404         kfree(buffer.pointer);
405
406         return status;
407 }
408
409 static int
410 acpi_video_device_lcd_set_level(struct acpi_video_device *device, int level)
411 {
412         int status;
413         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
414         struct acpi_object_list args = { 1, &arg0 };
415
416
417         arg0.integer.value = level;
418         status = acpi_evaluate_object(device->dev->handle, "_BCM", &args, NULL);
419
420         printk(KERN_DEBUG "set_level status: %x\n", status);
421         return status;
422 }
423
424 static int
425 acpi_video_device_lcd_get_level_current(struct acpi_video_device *device,
426                                         unsigned long *level)
427 {
428         int status;
429
430         status = acpi_evaluate_integer(device->dev->handle, "_BQC", NULL, level);
431
432         return status;
433 }
434
435 static int
436 acpi_video_device_EDID(struct acpi_video_device *device,
437                        union acpi_object **edid, ssize_t length)
438 {
439         int status;
440         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
441         union acpi_object *obj;
442         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
443         struct acpi_object_list args = { 1, &arg0 };
444
445
446         *edid = NULL;
447
448         if (!device)
449                 return -ENODEV;
450         if (length == 128)
451                 arg0.integer.value = 1;
452         else if (length == 256)
453                 arg0.integer.value = 2;
454         else
455                 return -EINVAL;
456
457         status = acpi_evaluate_object(device->dev->handle, "_DDC", &args, &buffer);
458         if (ACPI_FAILURE(status))
459                 return -ENODEV;
460
461         obj = buffer.pointer;
462
463         if (obj && obj->type == ACPI_TYPE_BUFFER)
464                 *edid = obj;
465         else {
466                 printk(KERN_ERR PREFIX "Invalid _DDC data\n");
467                 status = -EFAULT;
468                 kfree(obj);
469         }
470
471         return status;
472 }
473
474 /* bus */
475
476 static int
477 acpi_video_bus_set_POST(struct acpi_video_bus *video, unsigned long option)
478 {
479         int status;
480         unsigned long tmp;
481         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
482         struct acpi_object_list args = { 1, &arg0 };
483
484
485         arg0.integer.value = option;
486
487         status = acpi_evaluate_integer(video->device->handle, "_SPD", &args, &tmp);
488         if (ACPI_SUCCESS(status))
489                 status = tmp ? (-EINVAL) : (AE_OK);
490
491         return status;
492 }
493
494 static int
495 acpi_video_bus_get_POST(struct acpi_video_bus *video, unsigned long *id)
496 {
497         int status;
498
499         status = acpi_evaluate_integer(video->device->handle, "_GPD", NULL, id);
500
501         return status;
502 }
503
504 static int
505 acpi_video_bus_POST_options(struct acpi_video_bus *video,
506                             unsigned long *options)
507 {
508         int status;
509
510         status = acpi_evaluate_integer(video->device->handle, "_VPO", NULL, options);
511         *options &= 3;
512
513         return status;
514 }
515
516 /*
517  *  Arg:
518  *      video           : video bus device pointer
519  *      bios_flag       : 
520  *              0.      The system BIOS should NOT automatically switch(toggle)
521  *                      the active display output.
522  *              1.      The system BIOS should automatically switch (toggle) the
523  *                      active display output. No switch event.
524  *              2.      The _DGS value should be locked.
525  *              3.      The system BIOS should not automatically switch (toggle) the
526  *                      active display output, but instead generate the display switch
527  *                      event notify code.
528  *      lcd_flag        :
529  *              0.      The system BIOS should automatically control the brightness level
530  *                      of the LCD when the power changes from AC to DC
531  *              1.      The system BIOS should NOT automatically control the brightness 
532  *                      level of the LCD when the power changes from AC to DC.
533  * Return Value:
534  *              -1      wrong arg.
535  */
536
537 static int
538 acpi_video_bus_DOS(struct acpi_video_bus *video, int bios_flag, int lcd_flag)
539 {
540         acpi_integer status = 0;
541         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
542         struct acpi_object_list args = { 1, &arg0 };
543
544
545         if (bios_flag < 0 || bios_flag > 3 || lcd_flag < 0 || lcd_flag > 1) {
546                 status = -1;
547                 goto Failed;
548         }
549         arg0.integer.value = (lcd_flag << 2) | bios_flag;
550         video->dos_setting = arg0.integer.value;
551         acpi_evaluate_object(video->device->handle, "_DOS", &args, NULL);
552
553       Failed:
554         return status;
555 }
556
557 /*
558  *  Arg:        
559  *      device  : video output device (LCD, CRT, ..)
560  *
561  *  Return Value:
562  *      None
563  *
564  *  Find out all required AML methods defined under the output
565  *  device.
566  */
567
568 static void acpi_video_device_find_cap(struct acpi_video_device *device)
569 {
570         acpi_handle h_dummy1;
571         int i;
572         u32 max_level = 0;
573         union acpi_object *obj = NULL;
574         struct acpi_video_device_brightness *br = NULL;
575
576
577         memset(&device->cap, 0, 4);
578
579         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_ADR", &h_dummy1))) {
580                 device->cap._ADR = 1;
581         }
582         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCL", &h_dummy1))) {
583                 device->cap._BCL = 1;
584         }
585         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCM", &h_dummy1))) {
586                 device->cap._BCM = 1;
587         }
588         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle,"_BQC",&h_dummy1)))
589                 device->cap._BQC = 1;
590         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DDC", &h_dummy1))) {
591                 device->cap._DDC = 1;
592         }
593         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DCS", &h_dummy1))) {
594                 device->cap._DCS = 1;
595         }
596         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DGS", &h_dummy1))) {
597                 device->cap._DGS = 1;
598         }
599         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DSS", &h_dummy1))) {
600                 device->cap._DSS = 1;
601         }
602
603         if (ACPI_SUCCESS(acpi_video_device_lcd_query_levels(device, &obj))) {
604
605                 if (obj->package.count >= 2) {
606                         int count = 0;
607                         union acpi_object *o;
608
609                         br = kzalloc(sizeof(*br), GFP_KERNEL);
610                         if (!br) {
611                                 printk(KERN_ERR "can't allocate memory\n");
612                         } else {
613                                 br->levels = kmalloc(obj->package.count *
614                                                      sizeof *(br->levels), GFP_KERNEL);
615                                 if (!br->levels)
616                                         goto out;
617
618                                 for (i = 0; i < obj->package.count; i++) {
619                                         o = (union acpi_object *)&obj->package.
620                                             elements[i];
621                                         if (o->type != ACPI_TYPE_INTEGER) {
622                                                 printk(KERN_ERR PREFIX "Invalid data\n");
623                                                 continue;
624                                         }
625                                         br->levels[count] = (u32) o->integer.value;
626
627                                         if (br->levels[count] > max_level)
628                                                 max_level = br->levels[count];
629                                         count++;
630                                 }
631                               out:
632                                 if (count < 2) {
633                                         kfree(br->levels);
634                                         kfree(br);
635                                 } else {
636                                         br->count = count;
637                                         device->brightness = br;
638                                         ACPI_DEBUG_PRINT((ACPI_DB_INFO,
639                                                           "found %d brightness levels\n",
640                                                           count));
641                                 }
642                         }
643                 }
644
645         } else {
646                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Could not query available LCD brightness level\n"));
647         }
648
649         kfree(obj);
650
651         if (device->cap._BCL && device->cap._BCM && device->cap._BQC && max_level > 0){
652                 unsigned long tmp;
653                 static int count = 0;
654                 char *name;
655                 name = kzalloc(MAX_NAME_LEN, GFP_KERNEL);
656                 if (!name)
657                         return;
658
659                 sprintf(name, "acpi_video%d", count++);
660                 acpi_video_device_lcd_get_level_current(device, &tmp);
661                 device->backlight = backlight_device_register(name,
662                         NULL, device, &acpi_backlight_ops);
663                 device->backlight->props.max_brightness = max_level;
664                 device->backlight->props.brightness = (int)tmp;
665                 backlight_update_status(device->backlight);
666
667                 kfree(name);
668         }
669         if (device->cap._DCS && device->cap._DSS){
670                 static int count = 0;
671                 char *name;
672                 name = kzalloc(MAX_NAME_LEN, GFP_KERNEL);
673                 if (!name)
674                         return;
675                 sprintf(name, "acpi_video%d", count++);
676                 device->output_dev = video_output_register(name,
677                                 NULL, device, &acpi_output_properties);
678                 kfree(name);
679         }
680         return;
681 }
682
683 /*
684  *  Arg:        
685  *      device  : video output device (VGA)
686  *
687  *  Return Value:
688  *      None
689  *
690  *  Find out all required AML methods defined under the video bus device.
691  */
692
693 static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
694 {
695         acpi_handle h_dummy1;
696
697         memset(&video->cap, 0, 4);
698         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOS", &h_dummy1))) {
699                 video->cap._DOS = 1;
700         }
701         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOD", &h_dummy1))) {
702                 video->cap._DOD = 1;
703         }
704         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_ROM", &h_dummy1))) {
705                 video->cap._ROM = 1;
706         }
707         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_GPD", &h_dummy1))) {
708                 video->cap._GPD = 1;
709         }
710         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_SPD", &h_dummy1))) {
711                 video->cap._SPD = 1;
712         }
713         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_VPO", &h_dummy1))) {
714                 video->cap._VPO = 1;
715         }
716 }
717
718 /*
719  * Check whether the video bus device has required AML method to
720  * support the desired features
721  */
722
723 static int acpi_video_bus_check(struct acpi_video_bus *video)
724 {
725         acpi_status status = -ENOENT;
726
727
728         if (!video)
729                 return -EINVAL;
730
731         /* Since there is no HID, CID and so on for VGA driver, we have
732          * to check well known required nodes.
733          */
734
735         /* Does this device support video switching? */
736         if (video->cap._DOS) {
737                 video->flags.multihead = 1;
738                 status = 0;
739         }
740
741         /* Does this device support retrieving a video ROM? */
742         if (video->cap._ROM) {
743                 video->flags.rom = 1;
744                 status = 0;
745         }
746
747         /* Does this device support configuring which video device to POST? */
748         if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
749                 video->flags.post = 1;
750                 status = 0;
751         }
752
753         return status;
754 }
755
756 /* --------------------------------------------------------------------------
757                               FS Interface (/proc)
758    -------------------------------------------------------------------------- */
759
760 static struct proc_dir_entry *acpi_video_dir;
761
762 /* video devices */
763
764 static int acpi_video_device_info_seq_show(struct seq_file *seq, void *offset)
765 {
766         struct acpi_video_device *dev = seq->private;
767
768
769         if (!dev)
770                 goto end;
771
772         seq_printf(seq, "device_id:    0x%04x\n", (u32) dev->device_id);
773         seq_printf(seq, "type:         ");
774         if (dev->flags.crt)
775                 seq_printf(seq, "CRT\n");
776         else if (dev->flags.lcd)
777                 seq_printf(seq, "LCD\n");
778         else if (dev->flags.tvout)
779                 seq_printf(seq, "TVOUT\n");
780         else if (dev->flags.dvi)
781                 seq_printf(seq, "DVI\n");
782         else
783                 seq_printf(seq, "UNKNOWN\n");
784
785         seq_printf(seq, "known by bios: %s\n", dev->flags.bios ? "yes" : "no");
786
787       end:
788         return 0;
789 }
790
791 static int
792 acpi_video_device_info_open_fs(struct inode *inode, struct file *file)
793 {
794         return single_open(file, acpi_video_device_info_seq_show,
795                            PDE(inode)->data);
796 }
797
798 static int acpi_video_device_state_seq_show(struct seq_file *seq, void *offset)
799 {
800         int status;
801         struct acpi_video_device *dev = seq->private;
802         unsigned long state;
803
804
805         if (!dev)
806                 goto end;
807
808         status = acpi_video_device_get_state(dev, &state);
809         seq_printf(seq, "state:     ");
810         if (ACPI_SUCCESS(status))
811                 seq_printf(seq, "0x%02lx\n", state);
812         else
813                 seq_printf(seq, "<not supported>\n");
814
815         status = acpi_video_device_query(dev, &state);
816         seq_printf(seq, "query:     ");
817         if (ACPI_SUCCESS(status))
818                 seq_printf(seq, "0x%02lx\n", state);
819         else
820                 seq_printf(seq, "<not supported>\n");
821
822       end:
823         return 0;
824 }
825
826 static int
827 acpi_video_device_state_open_fs(struct inode *inode, struct file *file)
828 {
829         return single_open(file, acpi_video_device_state_seq_show,
830                            PDE(inode)->data);
831 }
832
833 static ssize_t
834 acpi_video_device_write_state(struct file *file,
835                               const char __user * buffer,
836                               size_t count, loff_t * data)
837 {
838         int status;
839         struct seq_file *m = file->private_data;
840         struct acpi_video_device *dev = m->private;
841         char str[12] = { 0 };
842         u32 state = 0;
843
844
845         if (!dev || count + 1 > sizeof str)
846                 return -EINVAL;
847
848         if (copy_from_user(str, buffer, count))
849                 return -EFAULT;
850
851         str[count] = 0;
852         state = simple_strtoul(str, NULL, 0);
853         state &= ((1ul << 31) | (1ul << 30) | (1ul << 0));
854
855         status = acpi_video_device_set_state(dev, state);
856
857         if (status)
858                 return -EFAULT;
859
860         return count;
861 }
862
863 static int
864 acpi_video_device_brightness_seq_show(struct seq_file *seq, void *offset)
865 {
866         struct acpi_video_device *dev = seq->private;
867         int i;
868
869
870         if (!dev || !dev->brightness) {
871                 seq_printf(seq, "<not supported>\n");
872                 return 0;
873         }
874
875         seq_printf(seq, "levels: ");
876         for (i = 0; i < dev->brightness->count; i++)
877                 seq_printf(seq, " %d", dev->brightness->levels[i]);
878         seq_printf(seq, "\ncurrent: %d\n", dev->brightness->curr);
879
880         return 0;
881 }
882
883 static int
884 acpi_video_device_brightness_open_fs(struct inode *inode, struct file *file)
885 {
886         return single_open(file, acpi_video_device_brightness_seq_show,
887                            PDE(inode)->data);
888 }
889
890 static ssize_t
891 acpi_video_device_write_brightness(struct file *file,
892                                    const char __user * buffer,
893                                    size_t count, loff_t * data)
894 {
895         struct seq_file *m = file->private_data;
896         struct acpi_video_device *dev = m->private;
897         char str[4] = { 0 };
898         unsigned int level = 0;
899         int i;
900
901
902         if (!dev || !dev->brightness || count + 1 > sizeof str)
903                 return -EINVAL;
904
905         if (copy_from_user(str, buffer, count))
906                 return -EFAULT;
907
908         str[count] = 0;
909         level = simple_strtoul(str, NULL, 0);
910
911         if (level > 100)
912                 return -EFAULT;
913
914         /* validate through the list of available levels */
915         for (i = 0; i < dev->brightness->count; i++)
916                 if (level == dev->brightness->levels[i]) {
917                         if (ACPI_SUCCESS
918                             (acpi_video_device_lcd_set_level(dev, level)))
919                                 dev->brightness->curr = level;
920                         break;
921                 }
922
923         return count;
924 }
925
926 static int acpi_video_device_EDID_seq_show(struct seq_file *seq, void *offset)
927 {
928         struct acpi_video_device *dev = seq->private;
929         int status;
930         int i;
931         union acpi_object *edid = NULL;
932
933
934         if (!dev)
935                 goto out;
936
937         status = acpi_video_device_EDID(dev, &edid, 128);
938         if (ACPI_FAILURE(status)) {
939                 status = acpi_video_device_EDID(dev, &edid, 256);
940         }
941
942         if (ACPI_FAILURE(status)) {
943                 goto out;
944         }
945
946         if (edid && edid->type == ACPI_TYPE_BUFFER) {
947                 for (i = 0; i < edid->buffer.length; i++)
948                         seq_putc(seq, edid->buffer.pointer[i]);
949         }
950
951       out:
952         if (!edid)
953                 seq_printf(seq, "<not supported>\n");
954         else
955                 kfree(edid);
956
957         return 0;
958 }
959
960 static int
961 acpi_video_device_EDID_open_fs(struct inode *inode, struct file *file)
962 {
963         return single_open(file, acpi_video_device_EDID_seq_show,
964                            PDE(inode)->data);
965 }
966
967 static int acpi_video_device_add_fs(struct acpi_device *device)
968 {
969         struct proc_dir_entry *entry = NULL;
970         struct acpi_video_device *vid_dev;
971
972
973         if (!device)
974                 return -ENODEV;
975
976         vid_dev = acpi_driver_data(device);
977         if (!vid_dev)
978                 return -ENODEV;
979
980         if (!acpi_device_dir(device)) {
981                 acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device),
982                                                      vid_dev->video->dir);
983                 if (!acpi_device_dir(device))
984                         return -ENODEV;
985                 acpi_device_dir(device)->owner = THIS_MODULE;
986         }
987
988         /* 'info' [R] */
989         entry = create_proc_entry("info", S_IRUGO, acpi_device_dir(device));
990         if (!entry)
991                 return -ENODEV;
992         else {
993                 entry->proc_fops = &acpi_video_device_info_fops;
994                 entry->data = acpi_driver_data(device);
995                 entry->owner = THIS_MODULE;
996         }
997
998         /* 'state' [R/W] */
999         entry =
1000             create_proc_entry("state", S_IFREG | S_IRUGO | S_IWUSR,
1001                               acpi_device_dir(device));
1002         if (!entry)
1003                 return -ENODEV;
1004         else {
1005                 acpi_video_device_state_fops.write = acpi_video_device_write_state;
1006                 entry->proc_fops = &acpi_video_device_state_fops;
1007                 entry->data = acpi_driver_data(device);
1008                 entry->owner = THIS_MODULE;
1009         }
1010
1011         /* 'brightness' [R/W] */
1012         entry =
1013             create_proc_entry("brightness", S_IFREG | S_IRUGO | S_IWUSR,
1014                               acpi_device_dir(device));
1015         if (!entry)
1016                 return -ENODEV;
1017         else {
1018                 acpi_video_device_brightness_fops.write = acpi_video_device_write_brightness;
1019                 entry->proc_fops = &acpi_video_device_brightness_fops;
1020                 entry->data = acpi_driver_data(device);
1021                 entry->owner = THIS_MODULE;
1022         }
1023
1024         /* 'EDID' [R] */
1025         entry = create_proc_entry("EDID", S_IRUGO, acpi_device_dir(device));
1026         if (!entry)
1027                 return -ENODEV;
1028         else {
1029                 entry->proc_fops = &acpi_video_device_EDID_fops;
1030                 entry->data = acpi_driver_data(device);
1031                 entry->owner = THIS_MODULE;
1032         }
1033
1034         return 0;
1035 }
1036
1037 static int acpi_video_device_remove_fs(struct acpi_device *device)
1038 {
1039         struct acpi_video_device *vid_dev;
1040
1041         vid_dev = acpi_driver_data(device);
1042         if (!vid_dev || !vid_dev->video || !vid_dev->video->dir)
1043                 return -ENODEV;
1044
1045         if (acpi_device_dir(device)) {
1046                 remove_proc_entry("info", acpi_device_dir(device));
1047                 remove_proc_entry("state", acpi_device_dir(device));
1048                 remove_proc_entry("brightness", acpi_device_dir(device));
1049                 remove_proc_entry("EDID", acpi_device_dir(device));
1050                 remove_proc_entry(acpi_device_bid(device), vid_dev->video->dir);
1051                 acpi_device_dir(device) = NULL;
1052         }
1053
1054         return 0;
1055 }
1056
1057 /* video bus */
1058 static int acpi_video_bus_info_seq_show(struct seq_file *seq, void *offset)
1059 {
1060         struct acpi_video_bus *video = seq->private;
1061
1062
1063         if (!video)
1064                 goto end;
1065
1066         seq_printf(seq, "Switching heads:              %s\n",
1067                    video->flags.multihead ? "yes" : "no");
1068         seq_printf(seq, "Video ROM:                    %s\n",
1069                    video->flags.rom ? "yes" : "no");
1070         seq_printf(seq, "Device to be POSTed on boot:  %s\n",
1071                    video->flags.post ? "yes" : "no");
1072
1073       end:
1074         return 0;
1075 }
1076
1077 static int acpi_video_bus_info_open_fs(struct inode *inode, struct file *file)
1078 {
1079         return single_open(file, acpi_video_bus_info_seq_show,
1080                            PDE(inode)->data);
1081 }
1082
1083 static int acpi_video_bus_ROM_seq_show(struct seq_file *seq, void *offset)
1084 {
1085         struct acpi_video_bus *video = seq->private;
1086
1087
1088         if (!video)
1089                 goto end;
1090
1091         printk(KERN_INFO PREFIX "Please implement %s\n", __FUNCTION__);
1092         seq_printf(seq, "<TODO>\n");
1093
1094       end:
1095         return 0;
1096 }
1097
1098 static int acpi_video_bus_ROM_open_fs(struct inode *inode, struct file *file)
1099 {
1100         return single_open(file, acpi_video_bus_ROM_seq_show, PDE(inode)->data);
1101 }
1102
1103 static int acpi_video_bus_POST_info_seq_show(struct seq_file *seq, void *offset)
1104 {
1105         struct acpi_video_bus *video = seq->private;
1106         unsigned long options;
1107         int status;
1108
1109
1110         if (!video)
1111                 goto end;
1112
1113         status = acpi_video_bus_POST_options(video, &options);
1114         if (ACPI_SUCCESS(status)) {
1115                 if (!(options & 1)) {
1116                         printk(KERN_WARNING PREFIX
1117                                "The motherboard VGA device is not listed as a possible POST device.\n");
1118                         printk(KERN_WARNING PREFIX
1119                                "This indicates a BIOS bug. Please contact the manufacturer.\n");
1120                 }
1121                 printk("%lx\n", options);
1122                 seq_printf(seq, "can POST: <integrated video>");
1123                 if (options & 2)
1124                         seq_printf(seq, " <PCI video>");
1125                 if (options & 4)
1126                         seq_printf(seq, " <AGP video>");
1127                 seq_putc(seq, '\n');
1128         } else
1129                 seq_printf(seq, "<not supported>\n");
1130       end:
1131         return 0;
1132 }
1133
1134 static int
1135 acpi_video_bus_POST_info_open_fs(struct inode *inode, struct file *file)
1136 {
1137         return single_open(file, acpi_video_bus_POST_info_seq_show,
1138                            PDE(inode)->data);
1139 }
1140
1141 static int acpi_video_bus_POST_seq_show(struct seq_file *seq, void *offset)
1142 {
1143         struct acpi_video_bus *video = seq->private;
1144         int status;
1145         unsigned long id;
1146
1147
1148         if (!video)
1149                 goto end;
1150
1151         status = acpi_video_bus_get_POST(video, &id);
1152         if (!ACPI_SUCCESS(status)) {
1153                 seq_printf(seq, "<not supported>\n");
1154                 goto end;
1155         }
1156         seq_printf(seq, "device POSTed is <%s>\n", device_decode[id & 3]);
1157
1158       end:
1159         return 0;
1160 }
1161
1162 static int acpi_video_bus_DOS_seq_show(struct seq_file *seq, void *offset)
1163 {
1164         struct acpi_video_bus *video = seq->private;
1165
1166
1167         seq_printf(seq, "DOS setting: <%d>\n", video->dos_setting);
1168
1169         return 0;
1170 }
1171
1172 static int acpi_video_bus_POST_open_fs(struct inode *inode, struct file *file)
1173 {
1174         return single_open(file, acpi_video_bus_POST_seq_show,
1175                            PDE(inode)->data);
1176 }
1177
1178 static int acpi_video_bus_DOS_open_fs(struct inode *inode, struct file *file)
1179 {
1180         return single_open(file, acpi_video_bus_DOS_seq_show, PDE(inode)->data);
1181 }
1182
1183 static ssize_t
1184 acpi_video_bus_write_POST(struct file *file,
1185                           const char __user * buffer,
1186                           size_t count, loff_t * data)
1187 {
1188         int status;
1189         struct seq_file *m = file->private_data;
1190         struct acpi_video_bus *video = m->private;
1191         char str[12] = { 0 };
1192         unsigned long opt, options;
1193
1194
1195         if (!video || count + 1 > sizeof str)
1196                 return -EINVAL;
1197
1198         status = acpi_video_bus_POST_options(video, &options);
1199         if (!ACPI_SUCCESS(status))
1200                 return -EINVAL;
1201
1202         if (copy_from_user(str, buffer, count))
1203                 return -EFAULT;
1204
1205         str[count] = 0;
1206         opt = strtoul(str, NULL, 0);
1207         if (opt > 3)
1208                 return -EFAULT;
1209
1210         /* just in case an OEM 'forgot' the motherboard... */
1211         options |= 1;
1212
1213         if (options & (1ul << opt)) {
1214                 status = acpi_video_bus_set_POST(video, opt);
1215                 if (!ACPI_SUCCESS(status))
1216                         return -EFAULT;
1217
1218         }
1219
1220         return count;
1221 }
1222
1223 static ssize_t
1224 acpi_video_bus_write_DOS(struct file *file,
1225                          const char __user * buffer,
1226                          size_t count, loff_t * data)
1227 {
1228         int status;
1229         struct seq_file *m = file->private_data;
1230         struct acpi_video_bus *video = m->private;
1231         char str[12] = { 0 };
1232         unsigned long opt;
1233
1234
1235         if (!video || count + 1 > sizeof str)
1236                 return -EINVAL;
1237
1238         if (copy_from_user(str, buffer, count))
1239                 return -EFAULT;
1240
1241         str[count] = 0;
1242         opt = strtoul(str, NULL, 0);
1243         if (opt > 7)
1244                 return -EFAULT;
1245
1246         status = acpi_video_bus_DOS(video, opt & 0x3, (opt & 0x4) >> 2);
1247
1248         if (!ACPI_SUCCESS(status))
1249                 return -EFAULT;
1250
1251         return count;
1252 }
1253
1254 static int acpi_video_bus_add_fs(struct acpi_device *device)
1255 {
1256         struct proc_dir_entry *entry = NULL;
1257         struct acpi_video_bus *video;
1258
1259
1260         video = acpi_driver_data(device);
1261
1262         if (!acpi_device_dir(device)) {
1263                 acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device),
1264                                                      acpi_video_dir);
1265                 if (!acpi_device_dir(device))
1266                         return -ENODEV;
1267                 video->dir = acpi_device_dir(device);
1268                 acpi_device_dir(device)->owner = THIS_MODULE;
1269         }
1270
1271         /* 'info' [R] */
1272         entry = create_proc_entry("info", S_IRUGO, acpi_device_dir(device));
1273         if (!entry)
1274                 return -ENODEV;
1275         else {
1276                 entry->proc_fops = &acpi_video_bus_info_fops;
1277                 entry->data = acpi_driver_data(device);
1278                 entry->owner = THIS_MODULE;
1279         }
1280
1281         /* 'ROM' [R] */
1282         entry = create_proc_entry("ROM", S_IRUGO, acpi_device_dir(device));
1283         if (!entry)
1284                 return -ENODEV;
1285         else {
1286                 entry->proc_fops = &acpi_video_bus_ROM_fops;
1287                 entry->data = acpi_driver_data(device);
1288                 entry->owner = THIS_MODULE;
1289         }
1290
1291         /* 'POST_info' [R] */
1292         entry =
1293             create_proc_entry("POST_info", S_IRUGO, acpi_device_dir(device));
1294         if (!entry)
1295                 return -ENODEV;
1296         else {
1297                 entry->proc_fops = &acpi_video_bus_POST_info_fops;
1298                 entry->data = acpi_driver_data(device);
1299                 entry->owner = THIS_MODULE;
1300         }
1301
1302         /* 'POST' [R/W] */
1303         entry =
1304             create_proc_entry("POST", S_IFREG | S_IRUGO | S_IRUSR,
1305                               acpi_device_dir(device));
1306         if (!entry)
1307                 return -ENODEV;
1308         else {
1309                 acpi_video_bus_POST_fops.write = acpi_video_bus_write_POST;
1310                 entry->proc_fops = &acpi_video_bus_POST_fops;
1311                 entry->data = acpi_driver_data(device);
1312                 entry->owner = THIS_MODULE;
1313         }
1314
1315         /* 'DOS' [R/W] */
1316         entry =
1317             create_proc_entry("DOS", S_IFREG | S_IRUGO | S_IRUSR,
1318                               acpi_device_dir(device));
1319         if (!entry)
1320                 return -ENODEV;
1321         else {
1322                 acpi_video_bus_DOS_fops.write = acpi_video_bus_write_DOS;
1323                 entry->proc_fops = &acpi_video_bus_DOS_fops;
1324                 entry->data = acpi_driver_data(device);
1325                 entry->owner = THIS_MODULE;
1326         }
1327
1328         return 0;
1329 }
1330
1331 static int acpi_video_bus_remove_fs(struct acpi_device *device)
1332 {
1333         struct acpi_video_bus *video;
1334
1335
1336         video = acpi_driver_data(device);
1337
1338         if (acpi_device_dir(device)) {
1339                 remove_proc_entry("info", acpi_device_dir(device));
1340                 remove_proc_entry("ROM", acpi_device_dir(device));
1341                 remove_proc_entry("POST_info", acpi_device_dir(device));
1342                 remove_proc_entry("POST", acpi_device_dir(device));
1343                 remove_proc_entry("DOS", acpi_device_dir(device));
1344                 remove_proc_entry(acpi_device_bid(device), acpi_video_dir);
1345                 acpi_device_dir(device) = NULL;
1346         }
1347
1348         return 0;
1349 }
1350
1351 /* --------------------------------------------------------------------------
1352                                  Driver Interface
1353    -------------------------------------------------------------------------- */
1354
1355 /* device interface */
1356 static struct acpi_video_device_attrib*
1357 acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
1358 {
1359         int count;
1360
1361         for(count = 0; count < video->attached_count; count++)
1362                 if((video->attached_array[count].value.int_val & 0xffff) == device_id)
1363                         return &(video->attached_array[count].value.attrib);
1364         return NULL;
1365 }
1366
1367 static int
1368 acpi_video_bus_get_one_device(struct acpi_device *device,
1369                               struct acpi_video_bus *video)
1370 {
1371         unsigned long device_id;
1372         int status;
1373         struct acpi_video_device *data;
1374         struct acpi_video_device_attrib* attribute;
1375
1376         if (!device || !video)
1377                 return -EINVAL;
1378
1379         status =
1380             acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
1381         if (ACPI_SUCCESS(status)) {
1382
1383                 data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
1384                 if (!data)
1385                         return -ENOMEM;
1386
1387                 strcpy(acpi_device_name(device), ACPI_VIDEO_DEVICE_NAME);
1388                 strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1389                 acpi_driver_data(device) = data;
1390
1391                 data->device_id = device_id;
1392                 data->video = video;
1393                 data->dev = device;
1394
1395                 attribute = acpi_video_get_device_attr(video, device_id);
1396
1397                 if((attribute != NULL) && attribute->device_id_scheme) {
1398                         switch (attribute->display_type) {
1399                         case ACPI_VIDEO_DISPLAY_CRT:
1400                                 data->flags.crt = 1;
1401                                 break;
1402                         case ACPI_VIDEO_DISPLAY_TV:
1403                                 data->flags.tvout = 1;
1404                                 break;
1405                         case ACPI_VIDEO_DISPLAY_DVI:
1406                                 data->flags.dvi = 1;
1407                                 break;
1408                         case ACPI_VIDEO_DISPLAY_LCD:
1409                                 data->flags.lcd = 1;
1410                                 break;
1411                         default:
1412                                 data->flags.unknown = 1;
1413                                 break;
1414                         }
1415                         if(attribute->bios_can_detect)
1416                                 data->flags.bios = 1;
1417                 } else
1418                         data->flags.unknown = 1;
1419
1420                 acpi_video_device_bind(video, data);
1421                 acpi_video_device_find_cap(data);
1422
1423                 status = acpi_install_notify_handler(device->handle,
1424                                                      ACPI_DEVICE_NOTIFY,
1425                                                      acpi_video_device_notify,
1426                                                      data);
1427                 if (ACPI_FAILURE(status)) {
1428                         ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
1429                                           "Error installing notify handler\n"));
1430                         if(data->brightness)
1431                                 kfree(data->brightness->levels);
1432                         kfree(data->brightness);
1433                         kfree(data);
1434                         return -ENODEV;
1435                 }
1436
1437                 down(&video->sem);
1438                 list_add_tail(&data->entry, &video->video_device_list);
1439                 up(&video->sem);
1440
1441                 acpi_video_device_add_fs(device);
1442
1443                 return 0;
1444         }
1445
1446         return -ENOENT;
1447 }
1448
1449 /*
1450  *  Arg:
1451  *      video   : video bus device 
1452  *
1453  *  Return:
1454  *      none
1455  *  
1456  *  Enumerate the video device list of the video bus, 
1457  *  bind the ids with the corresponding video devices
1458  *  under the video bus.
1459  */
1460
1461 static void acpi_video_device_rebind(struct acpi_video_bus *video)
1462 {
1463         struct list_head *node, *next;
1464         list_for_each_safe(node, next, &video->video_device_list) {
1465                 struct acpi_video_device *dev =
1466                     container_of(node, struct acpi_video_device, entry);
1467                 acpi_video_device_bind(video, dev);
1468         }
1469 }
1470
1471 /*
1472  *  Arg:
1473  *      video   : video bus device 
1474  *      device  : video output device under the video 
1475  *              bus
1476  *
1477  *  Return:
1478  *      none
1479  *  
1480  *  Bind the ids with the corresponding video devices
1481  *  under the video bus.
1482  */
1483
1484 static void
1485 acpi_video_device_bind(struct acpi_video_bus *video,
1486                        struct acpi_video_device *device)
1487 {
1488         int i;
1489
1490 #define IDS_VAL(i) video->attached_array[i].value.int_val
1491 #define IDS_BIND(i) video->attached_array[i].bind_info
1492
1493         for (i = 0; IDS_VAL(i) != ACPI_VIDEO_HEAD_INVALID &&
1494              i < video->attached_count; i++) {
1495                 if (device->device_id == (IDS_VAL(i) & 0xffff)) {
1496                         IDS_BIND(i) = device;
1497                         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
1498                 }
1499         }
1500 #undef IDS_VAL
1501 #undef IDS_BIND
1502 }
1503
1504 /*
1505  *  Arg:
1506  *      video   : video bus device 
1507  *
1508  *  Return:
1509  *      < 0     : error
1510  *  
1511  *  Call _DOD to enumerate all devices attached to display adapter
1512  *
1513  */
1514
1515 static int acpi_video_device_enumerate(struct acpi_video_bus *video)
1516 {
1517         int status;
1518         int count;
1519         int i;
1520         struct acpi_video_enumerated_device *active_device_list;
1521         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1522         union acpi_object *dod = NULL;
1523         union acpi_object *obj;
1524
1525         status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
1526         if (!ACPI_SUCCESS(status)) {
1527                 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1528                 return status;
1529         }
1530
1531         dod = buffer.pointer;
1532         if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1533                 ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
1534                 status = -EFAULT;
1535                 goto out;
1536         }
1537
1538         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d video heads in _DOD\n",
1539                           dod->package.count));
1540
1541         active_device_list = kmalloc((1 +
1542                                       dod->package.count) *
1543                                      sizeof(struct
1544                                             acpi_video_enumerated_device),
1545                                      GFP_KERNEL);
1546
1547         if (!active_device_list) {
1548                 status = -ENOMEM;
1549                 goto out;
1550         }
1551
1552         count = 0;
1553         for (i = 0; i < dod->package.count; i++) {
1554                 obj = &dod->package.elements[i];
1555
1556                 if (obj->type != ACPI_TYPE_INTEGER) {
1557                         printk(KERN_ERR PREFIX "Invalid _DOD data\n");
1558                         active_device_list[i].value.int_val =
1559                             ACPI_VIDEO_HEAD_INVALID;
1560                 }
1561                 active_device_list[i].value.int_val = obj->integer.value;
1562                 active_device_list[i].bind_info = NULL;
1563                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
1564                                   (int)obj->integer.value));
1565                 count++;
1566         }
1567         active_device_list[count].value.int_val = ACPI_VIDEO_HEAD_END;
1568
1569         kfree(video->attached_array);
1570
1571         video->attached_array = active_device_list;
1572         video->attached_count = count;
1573       out:
1574         kfree(buffer.pointer);
1575         return status;
1576 }
1577
1578 /*
1579  *  Arg:
1580  *      video   : video bus device 
1581  *      event   : notify event
1582  *
1583  *  Return:
1584  *      < 0     : error
1585  *  
1586  *      1. Find out the current active output device.
1587  *      2. Identify the next output device to switch to.
1588  *      3. call _DSS to do actual switch.
1589  */
1590
1591 static int acpi_video_switch_output(struct acpi_video_bus *video, int event)
1592 {
1593         struct list_head *node, *next;
1594         struct acpi_video_device *dev = NULL;
1595         struct acpi_video_device *dev_next = NULL;
1596         struct acpi_video_device *dev_prev = NULL;
1597         unsigned long state;
1598         int status = 0;
1599
1600
1601         list_for_each_safe(node, next, &video->video_device_list) {
1602                 dev = container_of(node, struct acpi_video_device, entry);
1603                 status = acpi_video_device_get_state(dev, &state);
1604                 if (state & 0x2) {
1605                         dev_next =
1606                             container_of(node->next, struct acpi_video_device,
1607                                          entry);
1608                         dev_prev =
1609                             container_of(node->prev, struct acpi_video_device,
1610                                          entry);
1611                         goto out;
1612                 }
1613         }
1614         dev_next = container_of(node->next, struct acpi_video_device, entry);
1615         dev_prev = container_of(node->prev, struct acpi_video_device, entry);
1616       out:
1617         switch (event) {
1618         case ACPI_VIDEO_NOTIFY_CYCLE:
1619         case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:
1620                 acpi_video_device_set_state(dev, 0);
1621                 acpi_video_device_set_state(dev_next, 0x80000001);
1622                 break;
1623         case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:
1624                 acpi_video_device_set_state(dev, 0);
1625                 acpi_video_device_set_state(dev_prev, 0x80000001);
1626         default:
1627                 break;
1628         }
1629
1630         return status;
1631 }
1632
1633 static int
1634 acpi_video_get_next_level(struct acpi_video_device *device,
1635                           u32 level_current, u32 event)
1636 {
1637         int min, max, min_above, max_below, i, l;
1638         max = max_below = 0;
1639         min = min_above = 255;
1640         for (i = 0; i < device->brightness->count; i++) {
1641                 l = device->brightness->levels[i];
1642                 if (l < min)
1643                         min = l;
1644                 if (l > max)
1645                         max = l;
1646                 if (l < min_above && l > level_current)
1647                         min_above = l;
1648                 if (l > max_below && l < level_current)
1649                         max_below = l;
1650         }
1651
1652         switch (event) {
1653         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:
1654                 return (level_current < max) ? min_above : min;
1655         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:
1656                 return (level_current < max) ? min_above : max;
1657         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:
1658                 return (level_current > min) ? max_below : min;
1659         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:
1660         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:
1661                 return 0;
1662         default:
1663                 return level_current;
1664         }
1665 }
1666
1667 static void
1668 acpi_video_switch_brightness(struct acpi_video_device *device, int event)
1669 {
1670         unsigned long level_current, level_next;
1671         acpi_video_device_lcd_get_level_current(device, &level_current);
1672         level_next = acpi_video_get_next_level(device, level_current, event);
1673         acpi_video_device_lcd_set_level(device, level_next);
1674 }
1675
1676 static int
1677 acpi_video_bus_get_devices(struct acpi_video_bus *video,
1678                            struct acpi_device *device)
1679 {
1680         int status = 0;
1681         struct list_head *node, *next;
1682
1683
1684         acpi_video_device_enumerate(video);
1685
1686         list_for_each_safe(node, next, &device->children) {
1687                 struct acpi_device *dev =
1688                     list_entry(node, struct acpi_device, node);
1689
1690                 if (!dev)
1691                         continue;
1692
1693                 status = acpi_video_bus_get_one_device(dev, video);
1694                 if (ACPI_FAILURE(status)) {
1695                         ACPI_EXCEPTION((AE_INFO, status, "Cant attach device"));
1696                         continue;
1697                 }
1698
1699         }
1700         return status;
1701 }
1702
1703 static int acpi_video_bus_put_one_device(struct acpi_video_device *device)
1704 {
1705         acpi_status status;
1706         struct acpi_video_bus *video;
1707
1708
1709         if (!device || !device->video)
1710                 return -ENOENT;
1711
1712         video = device->video;
1713
1714         down(&video->sem);
1715         list_del(&device->entry);
1716         up(&video->sem);
1717         acpi_video_device_remove_fs(device->dev);
1718
1719         status = acpi_remove_notify_handler(device->dev->handle,
1720                                             ACPI_DEVICE_NOTIFY,
1721                                             acpi_video_device_notify);
1722         backlight_device_unregister(device->backlight);
1723         video_output_unregister(device->output_dev);
1724         return 0;
1725 }
1726
1727 static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
1728 {
1729         int status;
1730         struct list_head *node, *next;
1731
1732
1733         list_for_each_safe(node, next, &video->video_device_list) {
1734                 struct acpi_video_device *data =
1735                     list_entry(node, struct acpi_video_device, entry);
1736                 if (!data)
1737                         continue;
1738
1739                 status = acpi_video_bus_put_one_device(data);
1740                 if (ACPI_FAILURE(status))
1741                         printk(KERN_WARNING PREFIX
1742                                "hhuuhhuu bug in acpi video driver.\n");
1743
1744                 if (data->brightness)
1745                         kfree(data->brightness->levels);
1746                 kfree(data->brightness);
1747                 kfree(data);
1748         }
1749
1750         return 0;
1751 }
1752
1753 /* acpi_video interface */
1754
1755 static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
1756 {
1757         return acpi_video_bus_DOS(video, 0, 0);
1758 }
1759
1760 static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
1761 {
1762         return acpi_video_bus_DOS(video, 0, 1);
1763 }
1764
1765 static void acpi_video_bus_notify(acpi_handle handle, u32 event, void *data)
1766 {
1767         struct acpi_video_bus *video = data;
1768         struct acpi_device *device = NULL;
1769         struct input_dev *input;
1770         int keycode;
1771
1772
1773         printk("video bus notify\n");
1774
1775         if (!video)
1776                 return;
1777
1778         device = video->device;
1779         input = video->input;
1780
1781         switch (event) {
1782         case ACPI_VIDEO_NOTIFY_SWITCH:  /* User requested a switch,
1783                                          * most likely via hotkey. */
1784                 acpi_bus_generate_proc_event(device, event, 0);
1785                 keycode = KEY_SWITCHVIDEOMODE;
1786                 break;
1787
1788         case ACPI_VIDEO_NOTIFY_PROBE:   /* User plugged in or removed a video
1789                                          * connector. */
1790                 acpi_video_device_enumerate(video);
1791                 acpi_video_device_rebind(video);
1792                 acpi_video_switch_output(video, event);
1793                 acpi_bus_generate_proc_event(device, event, 0);
1794                 keycode = KEY_SWITCHVIDEOMODE;
1795                 break;
1796
1797         case ACPI_VIDEO_NOTIFY_CYCLE:   /* Cycle Display output hotkey pressed. */
1798                 acpi_video_switch_output(video, event);
1799                 acpi_bus_generate_proc_event(device, event, 0);
1800                 keycode = KEY_SWITCHVIDEOMODE;
1801                 break;
1802         case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:     /* Next Display output hotkey pressed. */
1803                 acpi_video_switch_output(video, event);
1804                 acpi_bus_generate_proc_event(device, event, 0);
1805                 keycode = KEY_VIDEO_NEXT;
1806                 break;
1807         case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:     /* previous Display output hotkey pressed. */
1808                 acpi_video_switch_output(video, event);
1809                 acpi_bus_generate_proc_event(device, event, 0);
1810                 keycode = KEY_VIDEO_PREV;
1811                 break;
1812
1813         default:
1814                 keycode = KEY_UNKNOWN;
1815                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1816                                   "Unsupported event [0x%x]\n", event));
1817                 break;
1818         }
1819
1820         input_report_key(input, keycode, 1);
1821         input_sync(input);
1822         input_report_key(input, keycode, 0);
1823         input_sync(input);
1824
1825         return;
1826 }
1827
1828 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
1829 {
1830         struct acpi_video_device *video_device = data;
1831         struct acpi_device *device = NULL;
1832         struct acpi_video_bus *bus;
1833         struct input_dev *input;
1834         int keycode;
1835
1836         if (!video_device)
1837                 return;
1838
1839         device = video_device->dev;
1840         bus = video_device->video;
1841         input = bus->input;
1842
1843         switch (event) {
1844         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:        /* Cycle brightness */
1845                 acpi_video_switch_brightness(video_device, event);
1846                 acpi_bus_generate_proc_event(device, event, 0);
1847                 keycode = KEY_BRIGHTNESS_CYCLE;
1848                 break;
1849         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:  /* Increase brightness */
1850                 acpi_video_switch_brightness(video_device, event);
1851                 acpi_bus_generate_proc_event(device, event, 0);
1852                 keycode = KEY_BRIGHTNESSUP;
1853                 break;
1854         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:  /* Decrease brightness */
1855                 acpi_video_switch_brightness(video_device, event);
1856                 acpi_bus_generate_proc_event(device, event, 0);
1857                 keycode = KEY_BRIGHTNESSDOWN;
1858                 break;
1859         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS: /* zero brightnesss */
1860                 acpi_video_switch_brightness(video_device, event);
1861                 acpi_bus_generate_proc_event(device, event, 0);
1862                 keycode = KEY_BRIGHTNESS_ZERO;
1863                 break;
1864         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:     /* display device off */
1865                 acpi_video_switch_brightness(video_device, event);
1866                 acpi_bus_generate_proc_event(device, event, 0);
1867                 keycode = KEY_DISPLAY_OFF;
1868                 break;
1869         default:
1870                 keycode = KEY_UNKNOWN;
1871                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1872                                   "Unsupported event [0x%x]\n", event));
1873                 break;
1874         }
1875
1876         input_report_key(input, keycode, 1);
1877         input_sync(input);
1878         input_report_key(input, keycode, 0);
1879         input_sync(input);
1880
1881         return;
1882 }
1883
1884 static int instance;
1885 static int acpi_video_bus_add(struct acpi_device *device)
1886 {
1887         int result = 0;
1888         acpi_status status = 0;
1889         struct acpi_video_bus *video = NULL;
1890         struct input_dev *input;
1891
1892
1893         if (!device)
1894                 return -EINVAL;
1895
1896         video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
1897         if (!video)
1898                 return -ENOMEM;
1899
1900         /* a hack to fix the duplicate name "VID" problem on T61 */
1901         if (!strcmp(device->pnp.bus_id, "VID")) {
1902                 if (instance)
1903                         device->pnp.bus_id[3] = '0' + instance;
1904                 instance ++;
1905         }
1906
1907         video->device = device;
1908         strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
1909         strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1910         acpi_driver_data(device) = video;
1911
1912         acpi_video_bus_find_cap(video);
1913         result = acpi_video_bus_check(video);
1914         if (result)
1915                 goto end;
1916
1917         result = acpi_video_bus_add_fs(device);
1918         if (result)
1919                 goto end;
1920
1921         init_MUTEX(&video->sem);
1922         INIT_LIST_HEAD(&video->video_device_list);
1923
1924         acpi_video_bus_get_devices(video, device);
1925         acpi_video_bus_start_devices(video);
1926
1927         status = acpi_install_notify_handler(device->handle,
1928                                              ACPI_DEVICE_NOTIFY,
1929                                              acpi_video_bus_notify, video);
1930         if (ACPI_FAILURE(status)) {
1931                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
1932                                   "Error installing notify handler\n"));
1933                 acpi_video_bus_stop_devices(video);
1934                 acpi_video_bus_put_devices(video);
1935                 kfree(video->attached_array);
1936                 acpi_video_bus_remove_fs(device);
1937                 result = -ENODEV;
1938                 goto end;
1939         }
1940
1941
1942         video->input = input = input_allocate_device();
1943
1944         snprintf(video->phys, sizeof(video->phys),
1945                 "%s/video/input0", acpi_device_hid(video->device));
1946
1947         input->name = acpi_device_name(video->device);
1948         input->phys = video->phys;
1949         input->id.bustype = BUS_HOST;
1950         input->id.product = 0x06;
1951         input->evbit[0] = BIT(EV_KEY);
1952         set_bit(KEY_SWITCHVIDEOMODE, input->keybit);
1953         set_bit(KEY_VIDEO_NEXT, input->keybit);
1954         set_bit(KEY_VIDEO_PREV, input->keybit);
1955         set_bit(KEY_BRIGHTNESS_CYCLE, input->keybit);
1956         set_bit(KEY_BRIGHTNESSUP, input->keybit);
1957         set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
1958         set_bit(KEY_BRIGHTNESS_ZERO, input->keybit);
1959         set_bit(KEY_DISPLAY_OFF, input->keybit);
1960         set_bit(KEY_UNKNOWN, input->keybit);
1961         result = input_register_device(input);
1962         if (result) {
1963                 acpi_remove_notify_handler(video->device->handle,
1964                                                 ACPI_DEVICE_NOTIFY,
1965                                                 acpi_video_bus_notify);
1966                 acpi_video_bus_stop_devices(video);
1967                 acpi_video_bus_put_devices(video);
1968                 kfree(video->attached_array);
1969                 acpi_video_bus_remove_fs(device);
1970                 goto end;
1971         }
1972
1973
1974         printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
1975                ACPI_VIDEO_DEVICE_NAME, acpi_device_bid(device),
1976                video->flags.multihead ? "yes" : "no",
1977                video->flags.rom ? "yes" : "no",
1978                video->flags.post ? "yes" : "no");
1979
1980       end:
1981         if (result)
1982                 kfree(video);
1983
1984         return result;
1985 }
1986
1987 static int acpi_video_bus_remove(struct acpi_device *device, int type)
1988 {
1989         acpi_status status = 0;
1990         struct acpi_video_bus *video = NULL;
1991
1992
1993         if (!device || !acpi_driver_data(device))
1994                 return -EINVAL;
1995
1996         video = acpi_driver_data(device);
1997
1998         acpi_video_bus_stop_devices(video);
1999
2000         status = acpi_remove_notify_handler(video->device->handle,
2001                                             ACPI_DEVICE_NOTIFY,
2002                                             acpi_video_bus_notify);
2003
2004         acpi_video_bus_put_devices(video);
2005         acpi_video_bus_remove_fs(device);
2006
2007         input_unregister_device(video->input);
2008         kfree(video->attached_array);
2009         kfree(video);
2010
2011         return 0;
2012 }
2013
2014 static int __init acpi_video_init(void)
2015 {
2016         int result = 0;
2017
2018
2019         /*
2020            acpi_dbg_level = 0xFFFFFFFF;
2021            acpi_dbg_layer = 0x08000000;
2022          */
2023
2024         acpi_video_dir = proc_mkdir(ACPI_VIDEO_CLASS, acpi_root_dir);
2025         if (!acpi_video_dir)
2026                 return -ENODEV;
2027         acpi_video_dir->owner = THIS_MODULE;
2028
2029         result = acpi_bus_register_driver(&acpi_video_bus);
2030         if (result < 0) {
2031                 remove_proc_entry(ACPI_VIDEO_CLASS, acpi_root_dir);
2032                 return -ENODEV;
2033         }
2034
2035         return 0;
2036 }
2037
2038 static void __exit acpi_video_exit(void)
2039 {
2040
2041         acpi_bus_unregister_driver(&acpi_video_bus);
2042
2043         remove_proc_entry(ACPI_VIDEO_CLASS, acpi_root_dir);
2044
2045         return;
2046 }
2047
2048 module_init(acpi_video_init);
2049 module_exit(acpi_video_exit);