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