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