Pull video into release branch
[linux-2.6] / arch / i386 / boot / video-vesa.c
1 /* -*- linux-c -*- ------------------------------------------------------- *
2  *
3  *   Copyright (C) 1991, 1992 Linus Torvalds
4  *   Copyright 2007 rPath, Inc. - All Rights Reserved
5  *
6  *   This file is part of the Linux kernel, and is made available under
7  *   the terms of the GNU General Public License version 2.
8  *
9  * ----------------------------------------------------------------------- */
10
11 /*
12  * arch/i386/boot/video-vesa.c
13  *
14  * VESA text modes
15  */
16
17 #include "boot.h"
18 #include "video.h"
19 #include "vesa.h"
20
21 /* VESA information */
22 static struct vesa_general_info vginfo;
23 static struct vesa_mode_info vminfo;
24
25 __videocard video_vesa;
26
27 static void vesa_store_mode_params_graphics(void);
28
29 static int vesa_probe(void)
30 {
31 #if defined(CONFIG_VIDEO_VESA) || defined(CONFIG_FIRMWARE_EDID)
32         u16 ax;
33         u16 mode;
34         addr_t mode_ptr;
35         struct mode_info *mi;
36         int nmodes = 0;
37
38         video_vesa.modes = GET_HEAP(struct mode_info, 0);
39
40         vginfo.signature = VBE2_MAGIC;
41
42         /* Optimistically assume a VESA BIOS is register-clean... */
43         ax = 0x4f00;
44         asm("int $0x10" : "+a" (ax), "=m" (vginfo) : "D" (&vginfo));
45
46         if (ax != 0x004f ||
47             vginfo.signature != VESA_MAGIC ||
48             vginfo.version < 0x0102)
49                 return 0;       /* Not present */
50 #endif /* CONFIG_VIDEO_VESA || CONFIG_FIRMWARE_EDID */
51 #ifdef CONFIG_VIDEO_VESA
52         set_fs(vginfo.video_mode_ptr.seg);
53         mode_ptr = vginfo.video_mode_ptr.off;
54
55         while ((mode = rdfs16(mode_ptr)) != 0xffff) {
56                 mode_ptr += 2;
57
58                 if (heap_free() < sizeof(struct mode_info))
59                         break;  /* Heap full, can't save mode info */
60
61                 if (mode & ~0x1ff)
62                         continue;
63
64                 memset(&vminfo, 0, sizeof vminfo); /* Just in case... */
65
66                 ax = 0x4f01;
67                 asm("int $0x10"
68                     : "+a" (ax), "=m" (vminfo)
69                     : "c" (mode), "D" (&vminfo));
70
71                 if (ax != 0x004f)
72                         continue;
73
74                 if ((vminfo.mode_attr & 0x15) == 0x05) {
75                         /* Text Mode, TTY BIOS supported,
76                            supported by hardware */
77                         mi = GET_HEAP(struct mode_info, 1);
78                         mi->mode = mode + VIDEO_FIRST_VESA;
79                         mi->x    = vminfo.h_res;
80                         mi->y    = vminfo.v_res;
81                         nmodes++;
82                 } else if ((vminfo.mode_attr & 0x99) == 0x99) {
83 #ifdef CONFIG_FB
84                         /* Graphics mode, color, linear frame buffer
85                            supported -- register the mode but hide from
86                            the menu.  Only do this if framebuffer is
87                            configured, however, otherwise the user will
88                            be left without a screen. */
89                         mi = GET_HEAP(struct mode_info, 1);
90                         mi->mode = mode + VIDEO_FIRST_VESA;
91                         mi->x = mi->y = 0;
92                         nmodes++;
93 #endif
94                 }
95         }
96
97         return nmodes;
98 #else
99         return 0;
100 #endif /* CONFIG_VIDEO_VESA */
101 }
102
103 static int vesa_set_mode(struct mode_info *mode)
104 {
105         u16 ax;
106         int is_graphic;
107         u16 vesa_mode = mode->mode - VIDEO_FIRST_VESA;
108
109         memset(&vminfo, 0, sizeof vminfo); /* Just in case... */
110
111         ax = 0x4f01;
112         asm("int $0x10"
113             : "+a" (ax), "=m" (vminfo)
114             : "c" (vesa_mode), "D" (&vminfo));
115
116         if (ax != 0x004f)
117                 return -1;
118
119         if ((vminfo.mode_attr & 0x15) == 0x05) {
120                 /* It's a supported text mode */
121                 is_graphic = 0;
122         } else if ((vminfo.mode_attr & 0x99) == 0x99) {
123                 /* It's a graphics mode with linear frame buffer */
124                 is_graphic = 1;
125                 vesa_mode |= 0x4000; /* Request linear frame buffer */
126         } else {
127                 return -1;      /* Invalid mode */
128         }
129
130
131         ax = 0x4f02;
132         asm volatile("int $0x10"
133                      : "+a" (ax)
134                      : "b" (vesa_mode), "D" (0));
135
136         if (ax != 0x004f)
137                 return -1;
138
139         graphic_mode = is_graphic;
140         if (!is_graphic) {
141                 /* Text mode */
142                 force_x = mode->x;
143                 force_y = mode->y;
144                 do_restore = 1;
145         } else {
146                 /* Graphics mode */
147                 vesa_store_mode_params_graphics();
148         }
149
150         return 0;
151 }
152
153
154 /* Switch DAC to 8-bit mode */
155 static void vesa_dac_set_8bits(void)
156 {
157         u8 dac_size = 6;
158
159         /* If possible, switch the DAC to 8-bit mode */
160         if (vginfo.capabilities & 1) {
161                 u16 ax, bx;
162
163                 ax = 0x4f08;
164                 bx = 0x0800;
165                 asm volatile(INT10
166                              : "+a" (ax), "+b" (bx)
167                              : : "ecx", "edx", "esi", "edi");
168
169                 if (ax == 0x004f)
170                         dac_size = bx >> 8;
171         }
172
173         /* Set the color sizes to the DAC size, and offsets to 0 */
174         boot_params.screen_info.red_size = dac_size;
175         boot_params.screen_info.green_size = dac_size;
176         boot_params.screen_info.blue_size = dac_size;
177         boot_params.screen_info.rsvd_size = dac_size;
178
179         boot_params.screen_info.red_pos = 0;
180         boot_params.screen_info.green_pos = 0;
181         boot_params.screen_info.blue_pos = 0;
182         boot_params.screen_info.rsvd_pos = 0;
183 }
184
185 /* Save the VESA protected mode info */
186 static void vesa_store_pm_info(void)
187 {
188         u16 ax, bx, di, es;
189
190         ax = 0x4f0a;
191         bx = di = 0;
192         asm("pushw %%es; "INT10"; movw %%es,%0; popw %%es"
193             : "=d" (es), "+a" (ax), "+b" (bx), "+D" (di)
194             : : "ecx", "esi");
195
196         if (ax != 0x004f)
197                 return;
198
199         boot_params.screen_info.vesapm_seg = es;
200         boot_params.screen_info.vesapm_off = di;
201 }
202
203 /*
204  * Save video mode parameters for graphics mode
205  */
206 static void vesa_store_mode_params_graphics(void)
207 {
208         /* Tell the kernel we're in VESA graphics mode */
209         boot_params.screen_info.orig_video_isVGA = 0x23;
210
211         /* Mode parameters */
212         boot_params.screen_info.vesa_attributes = vminfo.mode_attr;
213         boot_params.screen_info.lfb_linelength = vminfo.logical_scan;
214         boot_params.screen_info.lfb_width = vminfo.h_res;
215         boot_params.screen_info.lfb_height = vminfo.v_res;
216         boot_params.screen_info.lfb_depth = vminfo.bpp;
217         boot_params.screen_info.pages = vminfo.image_planes;
218         boot_params.screen_info.lfb_base = vminfo.lfb_ptr;
219         memcpy(&boot_params.screen_info.red_size,
220                &vminfo.rmask, 8);
221
222         /* General parameters */
223         boot_params.screen_info.lfb_size = vginfo.total_memory;
224
225         if (vminfo.bpp <= 8)
226                 vesa_dac_set_8bits();
227
228         vesa_store_pm_info();
229 }
230
231 /*
232  * Save EDID information for the kernel; this is invoked, separately,
233  * after mode-setting.
234  */
235 void vesa_store_edid(void)
236 {
237 #ifdef CONFIG_FIRMWARE_EDID
238         u16 ax, bx, cx, dx, di;
239
240         /* Apparently used as a nonsense token... */
241         memset(&boot_params.edid_info, 0x13, sizeof boot_params.edid_info);
242
243         if (vginfo.version < 0x0200)
244                 return;         /* EDID requires VBE 2.0+ */
245
246         ax = 0x4f15;            /* VBE DDC */
247         bx = 0x0000;            /* Report DDC capabilities */
248         cx = 0;                 /* Controller 0 */
249         di = 0;                 /* ES:DI must be 0 by spec */
250
251         /* Note: The VBE DDC spec is different from the main VESA spec;
252            we genuinely have to assume all registers are destroyed here. */
253
254         asm("pushw %%es; movw %2,%%es; "INT10"; popw %%es"
255             : "+a" (ax), "+b" (bx)
256             :  "c" (cx), "D" (di)
257             : "esi");
258
259         if (ax != 0x004f)
260                 return;         /* No EDID */
261
262         /* BH = time in seconds to transfer EDD information */
263         /* BL = DDC level supported */
264
265         ax = 0x4f15;            /* VBE DDC */
266         bx = 0x0001;            /* Read EDID */
267         cx = 0;                 /* Controller 0 */
268         dx = 0;                 /* EDID block number */
269         di =(size_t) &boot_params.edid_info; /* (ES:)Pointer to block */
270         asm(INT10
271             : "+a" (ax), "+b" (bx), "+d" (dx)
272             : "c" (cx), "D" (di)
273             : "esi");
274 #endif /* CONFIG_FIRMWARE_EDID */
275 }
276
277 __videocard video_vesa =
278 {
279         .card_name      = "VESA",
280         .probe          = vesa_probe,
281         .set_mode       = vesa_set_mode,
282         .xmode_first    = VIDEO_FIRST_VESA,
283         .xmode_n        = 0x200,
284 };