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), "=m" (boot_params.edid_info)
 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 };