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