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