vbe.c revision 1.2.4.4
1 1.2.4.4 yamt /* $NetBSD: vbe.c,v 1.2.4.4 2010/03/11 15:02:31 yamt Exp $ */ 2 1.2.4.2 yamt 3 1.2.4.2 yamt /*- 4 1.2.4.2 yamt * Copyright (c) 2009 Jared D. McNeill <jmcneill (at) invisible.ca> 5 1.2.4.2 yamt * All rights reserved. 6 1.2.4.2 yamt * 7 1.2.4.2 yamt * Redistribution and use in source and binary forms, with or without 8 1.2.4.2 yamt * modification, are permitted provided that the following conditions 9 1.2.4.2 yamt * are met: 10 1.2.4.2 yamt * 1. Redistributions of source code must retain the above copyright 11 1.2.4.2 yamt * notice, this list of conditions and the following disclaimer. 12 1.2.4.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 13 1.2.4.2 yamt * notice, this list of conditions and the following disclaimer in the 14 1.2.4.2 yamt * documentation and/or other materials provided with the distribution. 15 1.2.4.2 yamt * 16 1.2.4.2 yamt * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 1.2.4.2 yamt * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 1.2.4.2 yamt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 1.2.4.2 yamt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 1.2.4.2 yamt * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 1.2.4.2 yamt * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 1.2.4.2 yamt * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 1.2.4.2 yamt * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 1.2.4.2 yamt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 1.2.4.2 yamt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 1.2.4.2 yamt * POSSIBILITY OF SUCH DAMAGE. 27 1.2.4.2 yamt */ 28 1.2.4.2 yamt 29 1.2.4.2 yamt /* 30 1.2.4.2 yamt * VESA BIOS Extensions routines 31 1.2.4.2 yamt */ 32 1.2.4.2 yamt 33 1.2.4.2 yamt #include <lib/libsa/stand.h> 34 1.2.4.2 yamt #include <lib/libkern/libkern.h> 35 1.2.4.2 yamt #include <machine/bootinfo.h> 36 1.2.4.2 yamt #include "libi386.h" 37 1.2.4.2 yamt #include "vbe.h" 38 1.2.4.2 yamt 39 1.2.4.2 yamt extern const uint8_t rasops_cmap[]; 40 1.2.4.2 yamt 41 1.2.4.2 yamt static struct _vbestate { 42 1.2.4.2 yamt int available; 43 1.2.4.3 yamt int modenum; 44 1.2.4.2 yamt } vbestate; 45 1.2.4.2 yamt 46 1.2.4.2 yamt static int 47 1.2.4.2 yamt vbe_mode_is_supported(struct modeinfoblock *mi) 48 1.2.4.2 yamt { 49 1.2.4.2 yamt if ((mi->ModeAttributes & 0x01) == 0) 50 1.2.4.2 yamt return 0; /* mode not supported by hardware */ 51 1.2.4.2 yamt if ((mi->ModeAttributes & 0x08) == 0) 52 1.2.4.2 yamt return 0; /* linear fb not available */ 53 1.2.4.2 yamt if ((mi->ModeAttributes & 0x10) == 0) 54 1.2.4.2 yamt return 0; /* text mode */ 55 1.2.4.2 yamt if (mi->NumberOfPlanes != 1) 56 1.2.4.2 yamt return 0; /* planar mode not supported */ 57 1.2.4.2 yamt if (mi->MemoryModel != 0x04 /* Packed pixel */ && 58 1.2.4.2 yamt mi->MemoryModel != 0x06 /* Direct Color */) 59 1.2.4.2 yamt return 0; /* unsupported pixel format */ 60 1.2.4.2 yamt return 1; 61 1.2.4.2 yamt } 62 1.2.4.2 yamt 63 1.2.4.4 yamt static bool 64 1.2.4.4 yamt vbe_check(void) 65 1.2.4.4 yamt { 66 1.2.4.4 yamt if (!vbestate.available) { 67 1.2.4.4 yamt printf("VBE not available\n"); 68 1.2.4.4 yamt return false; 69 1.2.4.4 yamt } 70 1.2.4.4 yamt return true; 71 1.2.4.4 yamt } 72 1.2.4.4 yamt 73 1.2.4.2 yamt void 74 1.2.4.2 yamt vbe_init(void) 75 1.2.4.2 yamt { 76 1.2.4.2 yamt struct vbeinfoblock vbe; 77 1.2.4.2 yamt 78 1.2.4.2 yamt memset(&vbe, 0, sizeof(vbe)); 79 1.2.4.2 yamt memcpy(vbe.VbeSignature, "VBE2", 4); 80 1.2.4.2 yamt if (biosvbe_info(&vbe) != 0x004f) 81 1.2.4.2 yamt return; 82 1.2.4.4 yamt if (memcmp(vbe.VbeSignature, "VESA", 4) != 0) 83 1.2.4.2 yamt return; 84 1.2.4.2 yamt 85 1.2.4.2 yamt vbestate.available = 1; 86 1.2.4.3 yamt vbestate.modenum = 0; 87 1.2.4.2 yamt } 88 1.2.4.2 yamt 89 1.2.4.2 yamt int 90 1.2.4.2 yamt vbe_available(void) 91 1.2.4.2 yamt { 92 1.2.4.2 yamt return vbestate.available; 93 1.2.4.2 yamt } 94 1.2.4.2 yamt 95 1.2.4.2 yamt int 96 1.2.4.2 yamt vbe_set_palette(const uint8_t *cmap, int slot) 97 1.2.4.2 yamt { 98 1.2.4.2 yamt struct paletteentry pe; 99 1.2.4.2 yamt int ret; 100 1.2.4.2 yamt 101 1.2.4.4 yamt if (!vbe_check()) 102 1.2.4.2 yamt return 1; 103 1.2.4.2 yamt 104 1.2.4.2 yamt pe.Blue = cmap[2] >> 2; 105 1.2.4.2 yamt pe.Green = cmap[1] >> 2; 106 1.2.4.2 yamt pe.Red = cmap[0] >> 2; 107 1.2.4.2 yamt pe.Alignment = 0; 108 1.2.4.2 yamt 109 1.2.4.2 yamt ret = biosvbe_palette_data(0x0600, slot, &pe); 110 1.2.4.2 yamt 111 1.2.4.2 yamt return ret == 0x004f ? 0 : 1; 112 1.2.4.2 yamt } 113 1.2.4.2 yamt 114 1.2.4.2 yamt int 115 1.2.4.2 yamt vbe_set_mode(int modenum) 116 1.2.4.2 yamt { 117 1.2.4.2 yamt struct modeinfoblock mi; 118 1.2.4.2 yamt struct btinfo_framebuffer fb; 119 1.2.4.2 yamt int ret, i; 120 1.2.4.2 yamt 121 1.2.4.4 yamt if (!vbe_check()) 122 1.2.4.2 yamt return 1; 123 1.2.4.2 yamt 124 1.2.4.2 yamt ret = biosvbe_get_mode_info(modenum, &mi); 125 1.2.4.2 yamt if (ret != 0x004f) { 126 1.2.4.4 yamt printf("mode 0x%x invalid\n", modenum); 127 1.2.4.2 yamt return 1; 128 1.2.4.2 yamt } 129 1.2.4.2 yamt 130 1.2.4.2 yamt if (!vbe_mode_is_supported(&mi)) { 131 1.2.4.4 yamt printf("mode 0x%x not supported\n", modenum); 132 1.2.4.2 yamt return 1; 133 1.2.4.2 yamt } 134 1.2.4.2 yamt 135 1.2.4.2 yamt ret = biosvbe_set_mode(modenum); 136 1.2.4.2 yamt if (ret != 0x004f) { 137 1.2.4.4 yamt printf("mode 0x%x could not be set\n", modenum); 138 1.2.4.2 yamt return 1; 139 1.2.4.2 yamt } 140 1.2.4.2 yamt 141 1.2.4.2 yamt /* Setup palette for packed pixel mode */ 142 1.2.4.2 yamt if (mi.MemoryModel == 0x04) 143 1.2.4.2 yamt for (i = 0; i < 256; i++) 144 1.2.4.2 yamt vbe_set_palette(&rasops_cmap[i * 3], i); 145 1.2.4.2 yamt 146 1.2.4.2 yamt fb.physaddr = (uint64_t)mi.PhysBasePtr & 0xffffffff; 147 1.2.4.2 yamt fb.width = mi.XResolution; 148 1.2.4.2 yamt fb.height = mi.YResolution; 149 1.2.4.2 yamt fb.stride = mi.BytesPerScanLine; 150 1.2.4.2 yamt fb.depth = mi.BitsPerPixel; 151 1.2.4.2 yamt fb.flags = 0; 152 1.2.4.2 yamt fb.rnum = mi.RedMaskSize; 153 1.2.4.2 yamt fb.rpos = mi.RedFieldPosition; 154 1.2.4.2 yamt fb.gnum = mi.GreenMaskSize; 155 1.2.4.2 yamt fb.gpos = mi.GreenFieldPosition; 156 1.2.4.2 yamt fb.bnum = mi.BlueMaskSize; 157 1.2.4.2 yamt fb.bpos = mi.BlueFieldPosition; 158 1.2.4.3 yamt fb.vbemode = modenum; 159 1.2.4.2 yamt 160 1.2.4.2 yamt framebuffer_configure(&fb); 161 1.2.4.2 yamt 162 1.2.4.2 yamt return 0; 163 1.2.4.2 yamt } 164 1.2.4.2 yamt 165 1.2.4.3 yamt int 166 1.2.4.3 yamt vbe_commit(void) 167 1.2.4.3 yamt { 168 1.2.4.3 yamt int ret = 1; 169 1.2.4.3 yamt 170 1.2.4.3 yamt if (vbestate.modenum > 0) { 171 1.2.4.3 yamt ret = vbe_set_mode(vbestate.modenum); 172 1.2.4.3 yamt if (ret) { 173 1.2.4.4 yamt printf("WARNING: failed to set VBE mode 0x%x\n", 174 1.2.4.3 yamt vbestate.modenum); 175 1.2.4.3 yamt delay(5000000); 176 1.2.4.3 yamt } 177 1.2.4.3 yamt } 178 1.2.4.3 yamt return ret; 179 1.2.4.3 yamt } 180 1.2.4.3 yamt 181 1.2.4.2 yamt static void * 182 1.2.4.2 yamt vbe_farptr(uint32_t farptr) 183 1.2.4.2 yamt { 184 1.2.4.2 yamt return VBEPHYPTR((((farptr & 0xffff0000) >> 12) + (farptr & 0xffff))); 185 1.2.4.2 yamt } 186 1.2.4.2 yamt 187 1.2.4.2 yamt static int 188 1.2.4.2 yamt vbe_parse_mode_str(char *str, int *x, int *y, int *bpp) 189 1.2.4.2 yamt { 190 1.2.4.2 yamt char *p; 191 1.2.4.2 yamt 192 1.2.4.2 yamt p = str; 193 1.2.4.2 yamt *x = strtoul(p, NULL, 0); 194 1.2.4.2 yamt if (*x == 0) 195 1.2.4.2 yamt return 0; 196 1.2.4.2 yamt p = strchr(p, 'x'); 197 1.2.4.2 yamt if (!p) 198 1.2.4.2 yamt return 0; 199 1.2.4.2 yamt ++p; 200 1.2.4.2 yamt *y = strtoul(p, NULL, 0); 201 1.2.4.2 yamt if (*y == 0) 202 1.2.4.2 yamt return 0; 203 1.2.4.2 yamt p = strchr(p, 'x'); 204 1.2.4.2 yamt if (!p) 205 1.2.4.2 yamt *bpp = 8; 206 1.2.4.2 yamt else { 207 1.2.4.2 yamt ++p; 208 1.2.4.2 yamt *bpp = strtoul(p, NULL, 0); 209 1.2.4.2 yamt if (*bpp == 0) 210 1.2.4.2 yamt return 0; 211 1.2.4.2 yamt } 212 1.2.4.2 yamt 213 1.2.4.2 yamt return 1; 214 1.2.4.2 yamt } 215 1.2.4.2 yamt 216 1.2.4.2 yamt static int 217 1.2.4.2 yamt vbe_find_mode(char *str) 218 1.2.4.2 yamt { 219 1.2.4.2 yamt struct vbeinfoblock vbe; 220 1.2.4.2 yamt struct modeinfoblock mi; 221 1.2.4.2 yamt uint32_t farptr; 222 1.2.4.2 yamt uint16_t mode; 223 1.2.4.2 yamt int x, y, bpp; 224 1.2.4.2 yamt int safety = 0; 225 1.2.4.2 yamt 226 1.2.4.2 yamt if (!vbe_parse_mode_str(str, &x, &y, &bpp)) 227 1.2.4.2 yamt return 0; 228 1.2.4.2 yamt 229 1.2.4.2 yamt memset(&vbe, 0, sizeof(vbe)); 230 1.2.4.2 yamt memcpy(vbe.VbeSignature, "VBE2", 4); 231 1.2.4.2 yamt if (biosvbe_info(&vbe) != 0x004f) 232 1.2.4.2 yamt return 0; 233 1.2.4.2 yamt if (memcmp(vbe.VbeSignature, "VESA", 4) != 0) 234 1.2.4.2 yamt return 0; 235 1.2.4.2 yamt farptr = vbe.VideoModePtr; 236 1.2.4.2 yamt if (farptr == 0) 237 1.2.4.2 yamt return 0; 238 1.2.4.2 yamt 239 1.2.4.2 yamt while ((mode = *(uint16_t *)vbe_farptr(farptr)) != 0xffff) { 240 1.2.4.2 yamt safety++; 241 1.2.4.2 yamt farptr += 2; 242 1.2.4.2 yamt if (safety == 100) 243 1.2.4.2 yamt return 0; 244 1.2.4.2 yamt if (biosvbe_get_mode_info(mode, &mi) != 0x004f) 245 1.2.4.2 yamt continue; 246 1.2.4.2 yamt /* we only care about linear modes here */ 247 1.2.4.2 yamt if (vbe_mode_is_supported(&mi) == 0) 248 1.2.4.2 yamt continue; 249 1.2.4.2 yamt safety = 0; 250 1.2.4.2 yamt if (mi.XResolution == x && 251 1.2.4.2 yamt mi.YResolution == y && 252 1.2.4.2 yamt mi.BitsPerPixel == bpp) 253 1.2.4.2 yamt return mode; 254 1.2.4.2 yamt } 255 1.2.4.2 yamt 256 1.2.4.2 yamt return 0; 257 1.2.4.2 yamt } 258 1.2.4.2 yamt 259 1.2.4.2 yamt static void 260 1.2.4.2 yamt vbe_dump_mode(int modenum, struct modeinfoblock *mi) 261 1.2.4.2 yamt { 262 1.2.4.2 yamt printf("0x%x=%dx%dx%d", modenum, 263 1.2.4.2 yamt mi->XResolution, mi->YResolution, mi->BitsPerPixel); 264 1.2.4.2 yamt } 265 1.2.4.2 yamt 266 1.2.4.2 yamt void 267 1.2.4.2 yamt vbe_modelist(void) 268 1.2.4.2 yamt { 269 1.2.4.2 yamt struct vbeinfoblock vbe; 270 1.2.4.2 yamt struct modeinfoblock mi; 271 1.2.4.2 yamt uint32_t farptr; 272 1.2.4.2 yamt uint16_t mode; 273 1.2.4.2 yamt int nmodes = 0, safety = 0; 274 1.2.4.2 yamt 275 1.2.4.4 yamt if (!vbe_check()) 276 1.2.4.2 yamt return; 277 1.2.4.2 yamt 278 1.2.4.2 yamt printf("Modes: "); 279 1.2.4.2 yamt memset(&vbe, 0, sizeof(vbe)); 280 1.2.4.2 yamt memcpy(vbe.VbeSignature, "VBE2", 4); 281 1.2.4.2 yamt if (biosvbe_info(&vbe) != 0x004f) 282 1.2.4.2 yamt goto done; 283 1.2.4.2 yamt if (memcmp(vbe.VbeSignature, "VESA", 4) != 0) 284 1.2.4.2 yamt goto done; 285 1.2.4.2 yamt farptr = vbe.VideoModePtr; 286 1.2.4.2 yamt if (farptr == 0) 287 1.2.4.2 yamt goto done; 288 1.2.4.2 yamt 289 1.2.4.2 yamt while ((mode = *(uint16_t *)vbe_farptr(farptr)) != 0xffff) { 290 1.2.4.2 yamt safety++; 291 1.2.4.2 yamt farptr += 2; 292 1.2.4.2 yamt if (safety == 100) { 293 1.2.4.4 yamt printf("[?] "); 294 1.2.4.2 yamt break; 295 1.2.4.2 yamt } 296 1.2.4.2 yamt if (biosvbe_get_mode_info(mode, &mi) != 0x004f) 297 1.2.4.2 yamt continue; 298 1.2.4.2 yamt /* we only care about linear modes here */ 299 1.2.4.2 yamt if (vbe_mode_is_supported(&mi) == 0) 300 1.2.4.2 yamt continue; 301 1.2.4.2 yamt safety = 0; 302 1.2.4.2 yamt if (nmodes % 4 == 0) 303 1.2.4.2 yamt printf("\n"); 304 1.2.4.2 yamt else 305 1.2.4.2 yamt printf(" "); 306 1.2.4.2 yamt vbe_dump_mode(mode, &mi); 307 1.2.4.2 yamt nmodes++; 308 1.2.4.2 yamt } 309 1.2.4.2 yamt 310 1.2.4.2 yamt done: 311 1.2.4.2 yamt if (nmodes == 0) 312 1.2.4.2 yamt printf("none found"); 313 1.2.4.2 yamt printf("\n"); 314 1.2.4.2 yamt } 315 1.2.4.2 yamt 316 1.2.4.2 yamt void 317 1.2.4.2 yamt command_vesa(char *cmd) 318 1.2.4.2 yamt { 319 1.2.4.2 yamt char arg[20]; 320 1.2.4.2 yamt int modenum; 321 1.2.4.2 yamt 322 1.2.4.4 yamt if (!vbe_check()) 323 1.2.4.2 yamt return; 324 1.2.4.2 yamt 325 1.2.4.2 yamt strlcpy(arg, cmd, sizeof(arg)); 326 1.2.4.2 yamt 327 1.2.4.2 yamt if (strcmp(arg, "list") == 0) { 328 1.2.4.2 yamt vbe_modelist(); 329 1.2.4.2 yamt return; 330 1.2.4.2 yamt } 331 1.2.4.2 yamt 332 1.2.4.2 yamt if (strcmp(arg, "disabled") == 0 || strcmp(arg, "off") == 0) { 333 1.2.4.3 yamt vbestate.modenum = 0; 334 1.2.4.2 yamt return; 335 1.2.4.2 yamt } 336 1.2.4.2 yamt 337 1.2.4.2 yamt if (strcmp(arg, "enabled") == 0 || strcmp(arg, "on") == 0) 338 1.2.4.2 yamt modenum = VBE_DEFAULT_MODE; 339 1.2.4.2 yamt else if (strncmp(arg, "0x", 2) == 0) 340 1.2.4.2 yamt modenum = strtoul(arg, NULL, 0); 341 1.2.4.2 yamt else if (strchr(arg, 'x') != NULL) { 342 1.2.4.2 yamt modenum = vbe_find_mode(arg); 343 1.2.4.3 yamt if (modenum == 0) { 344 1.2.4.3 yamt printf("mode %s not supported by firmware\n", arg); 345 1.2.4.2 yamt return; 346 1.2.4.3 yamt } 347 1.2.4.2 yamt } else 348 1.2.4.2 yamt modenum = 0; 349 1.2.4.2 yamt 350 1.2.4.2 yamt if (modenum >= 0x100) { 351 1.2.4.3 yamt vbestate.modenum = modenum; 352 1.2.4.2 yamt return; 353 1.2.4.2 yamt } 354 1.2.4.2 yamt 355 1.2.4.4 yamt printf("invalid flag, must be 'on', 'off', " 356 1.2.4.4 yamt "a display mode, or a VBE mode number\n"); 357 1.2.4.2 yamt } 358
Indexes created Tue Oct 21 19:09:51 GMT 2025