vbe.c revision 1.2.4.3
1 1.2.4.3 yamt /* $NetBSD: vbe.c,v 1.2.4.3 2009/09/16 13:37:39 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 int vbeverbose = 1; 42 1.2.4.2 yamt 43 1.2.4.2 yamt static struct _vbestate { 44 1.2.4.2 yamt int available; 45 1.2.4.3 yamt int modenum; 46 1.2.4.2 yamt } vbestate; 47 1.2.4.2 yamt 48 1.2.4.2 yamt static void 49 1.2.4.2 yamt vbe_dump(struct vbeinfoblock *vbe) 50 1.2.4.2 yamt { 51 1.2.4.2 yamt int mem = (int)vbe->TotalMemory * 64; 52 1.2.4.2 yamt 53 1.2.4.2 yamt if (!vbeverbose) 54 1.2.4.2 yamt return; 55 1.2.4.2 yamt 56 1.2.4.2 yamt printf(">> VESA VBE Version %d.%d %d k\n", 57 1.2.4.2 yamt vbe->VbeVersion >> 8, vbe->VbeVersion & 0xff, mem); 58 1.2.4.2 yamt } 59 1.2.4.2 yamt 60 1.2.4.2 yamt static int 61 1.2.4.2 yamt vbe_mode_is_supported(struct modeinfoblock *mi) 62 1.2.4.2 yamt { 63 1.2.4.2 yamt if ((mi->ModeAttributes & 0x01) == 0) 64 1.2.4.2 yamt return 0; /* mode not supported by hardware */ 65 1.2.4.2 yamt if ((mi->ModeAttributes & 0x08) == 0) 66 1.2.4.2 yamt return 0; /* linear fb not available */ 67 1.2.4.2 yamt if ((mi->ModeAttributes & 0x10) == 0) 68 1.2.4.2 yamt return 0; /* text mode */ 69 1.2.4.2 yamt if (mi->NumberOfPlanes != 1) 70 1.2.4.2 yamt return 0; /* planar mode not supported */ 71 1.2.4.2 yamt if (mi->MemoryModel != 0x04 /* Packed pixel */ && 72 1.2.4.2 yamt mi->MemoryModel != 0x06 /* Direct Color */) 73 1.2.4.2 yamt return 0; /* unsupported pixel format */ 74 1.2.4.2 yamt return 1; 75 1.2.4.2 yamt } 76 1.2.4.2 yamt 77 1.2.4.2 yamt void 78 1.2.4.2 yamt vbe_init(void) 79 1.2.4.2 yamt { 80 1.2.4.2 yamt struct vbeinfoblock vbe; 81 1.2.4.2 yamt 82 1.2.4.2 yamt memset(&vbe, 0, sizeof(vbe)); 83 1.2.4.2 yamt memcpy(vbe.VbeSignature, "VBE2", 4); 84 1.2.4.2 yamt if (biosvbe_info(&vbe) != 0x004f) 85 1.2.4.2 yamt return; 86 1.2.4.2 yamt if (memcmp(vbe.VbeSignature, "VESA", 4) != 0) { 87 1.2.4.2 yamt printf("VESA VBE: bad signature %c%c%c%c\n", 88 1.2.4.2 yamt vbe.VbeSignature[0], vbe.VbeSignature[1], 89 1.2.4.2 yamt vbe.VbeSignature[2], vbe.VbeSignature[3]); 90 1.2.4.2 yamt return; 91 1.2.4.2 yamt } 92 1.2.4.2 yamt 93 1.2.4.2 yamt vbe_dump(&vbe); 94 1.2.4.2 yamt vbestate.available = 1; 95 1.2.4.3 yamt vbestate.modenum = 0; 96 1.2.4.2 yamt } 97 1.2.4.2 yamt 98 1.2.4.2 yamt int 99 1.2.4.2 yamt vbe_available(void) 100 1.2.4.2 yamt { 101 1.2.4.2 yamt return vbestate.available; 102 1.2.4.2 yamt } 103 1.2.4.2 yamt 104 1.2.4.2 yamt int 105 1.2.4.2 yamt vbe_set_palette(const uint8_t *cmap, int slot) 106 1.2.4.2 yamt { 107 1.2.4.2 yamt struct paletteentry pe; 108 1.2.4.2 yamt int ret; 109 1.2.4.2 yamt 110 1.2.4.2 yamt if (!vbestate.available) { 111 1.2.4.2 yamt printf("VESA BIOS extensions not available\n"); 112 1.2.4.2 yamt return 1; 113 1.2.4.2 yamt } 114 1.2.4.2 yamt 115 1.2.4.2 yamt pe.Blue = cmap[2] >> 2; 116 1.2.4.2 yamt pe.Green = cmap[1] >> 2; 117 1.2.4.2 yamt pe.Red = cmap[0] >> 2; 118 1.2.4.2 yamt pe.Alignment = 0; 119 1.2.4.2 yamt 120 1.2.4.2 yamt ret = biosvbe_palette_data(0x0600, slot, &pe); 121 1.2.4.2 yamt 122 1.2.4.2 yamt return ret == 0x004f ? 0 : 1; 123 1.2.4.2 yamt } 124 1.2.4.2 yamt 125 1.2.4.2 yamt int 126 1.2.4.2 yamt vbe_set_mode(int modenum) 127 1.2.4.2 yamt { 128 1.2.4.2 yamt struct modeinfoblock mi; 129 1.2.4.2 yamt struct btinfo_framebuffer fb; 130 1.2.4.2 yamt int ret, i; 131 1.2.4.2 yamt 132 1.2.4.2 yamt if (!vbestate.available) { 133 1.2.4.2 yamt printf("VESA BIOS extensions not available\n"); 134 1.2.4.2 yamt return 1; 135 1.2.4.2 yamt } 136 1.2.4.2 yamt 137 1.2.4.2 yamt ret = biosvbe_get_mode_info(modenum, &mi); 138 1.2.4.2 yamt if (ret != 0x004f) { 139 1.2.4.2 yamt printf("VESA VBE mode 0x%x is invalid.\n", modenum); 140 1.2.4.2 yamt return 1; 141 1.2.4.2 yamt } 142 1.2.4.2 yamt 143 1.2.4.2 yamt if (!vbe_mode_is_supported(&mi)) { 144 1.2.4.2 yamt printf("VESA VBE mode 0x%x is not supported.\n", modenum); 145 1.2.4.2 yamt return 1; 146 1.2.4.2 yamt } 147 1.2.4.2 yamt 148 1.2.4.2 yamt ret = biosvbe_set_mode(modenum); 149 1.2.4.2 yamt if (ret != 0x004f) { 150 1.2.4.2 yamt printf("VESA VBE mode 0x%x could not be set.\n", modenum); 151 1.2.4.2 yamt return 1; 152 1.2.4.2 yamt } 153 1.2.4.2 yamt 154 1.2.4.2 yamt /* Setup palette for packed pixel mode */ 155 1.2.4.2 yamt if (mi.MemoryModel == 0x04) 156 1.2.4.2 yamt for (i = 0; i < 256; i++) 157 1.2.4.2 yamt vbe_set_palette(&rasops_cmap[i * 3], i); 158 1.2.4.2 yamt 159 1.2.4.2 yamt fb.physaddr = (uint64_t)mi.PhysBasePtr & 0xffffffff; 160 1.2.4.2 yamt fb.width = mi.XResolution; 161 1.2.4.2 yamt fb.height = mi.YResolution; 162 1.2.4.2 yamt fb.stride = mi.BytesPerScanLine; 163 1.2.4.2 yamt fb.depth = mi.BitsPerPixel; 164 1.2.4.2 yamt fb.flags = 0; 165 1.2.4.2 yamt fb.rnum = mi.RedMaskSize; 166 1.2.4.2 yamt fb.rpos = mi.RedFieldPosition; 167 1.2.4.2 yamt fb.gnum = mi.GreenMaskSize; 168 1.2.4.2 yamt fb.gpos = mi.GreenFieldPosition; 169 1.2.4.2 yamt fb.bnum = mi.BlueMaskSize; 170 1.2.4.2 yamt fb.bpos = mi.BlueFieldPosition; 171 1.2.4.3 yamt fb.vbemode = modenum; 172 1.2.4.2 yamt 173 1.2.4.2 yamt framebuffer_configure(&fb); 174 1.2.4.2 yamt 175 1.2.4.2 yamt return 0; 176 1.2.4.2 yamt } 177 1.2.4.2 yamt 178 1.2.4.3 yamt int 179 1.2.4.3 yamt vbe_commit(void) 180 1.2.4.3 yamt { 181 1.2.4.3 yamt int ret = 1; 182 1.2.4.3 yamt 183 1.2.4.3 yamt if (vbestate.modenum > 0) { 184 1.2.4.3 yamt ret = vbe_set_mode(vbestate.modenum); 185 1.2.4.3 yamt if (ret) { 186 1.2.4.3 yamt printf("WARNING: failed to set VESA VBE mode 0x%x\n", 187 1.2.4.3 yamt vbestate.modenum); 188 1.2.4.3 yamt delay(5000000); 189 1.2.4.3 yamt } 190 1.2.4.3 yamt } 191 1.2.4.3 yamt return ret; 192 1.2.4.3 yamt } 193 1.2.4.3 yamt 194 1.2.4.2 yamt static void * 195 1.2.4.2 yamt vbe_farptr(uint32_t farptr) 196 1.2.4.2 yamt { 197 1.2.4.2 yamt return VBEPHYPTR((((farptr & 0xffff0000) >> 12) + (farptr & 0xffff))); 198 1.2.4.2 yamt } 199 1.2.4.2 yamt 200 1.2.4.2 yamt static int 201 1.2.4.2 yamt vbe_parse_mode_str(char *str, int *x, int *y, int *bpp) 202 1.2.4.2 yamt { 203 1.2.4.2 yamt char *p; 204 1.2.4.2 yamt 205 1.2.4.2 yamt p = str; 206 1.2.4.2 yamt *x = strtoul(p, NULL, 0); 207 1.2.4.2 yamt if (*x == 0) 208 1.2.4.2 yamt return 0; 209 1.2.4.2 yamt p = strchr(p, 'x'); 210 1.2.4.2 yamt if (!p) 211 1.2.4.2 yamt return 0; 212 1.2.4.2 yamt ++p; 213 1.2.4.2 yamt *y = strtoul(p, NULL, 0); 214 1.2.4.2 yamt if (*y == 0) 215 1.2.4.2 yamt return 0; 216 1.2.4.2 yamt p = strchr(p, 'x'); 217 1.2.4.2 yamt if (!p) 218 1.2.4.2 yamt *bpp = 8; 219 1.2.4.2 yamt else { 220 1.2.4.2 yamt ++p; 221 1.2.4.2 yamt *bpp = strtoul(p, NULL, 0); 222 1.2.4.2 yamt if (*bpp == 0) 223 1.2.4.2 yamt return 0; 224 1.2.4.2 yamt } 225 1.2.4.2 yamt 226 1.2.4.2 yamt return 1; 227 1.2.4.2 yamt } 228 1.2.4.2 yamt 229 1.2.4.2 yamt static int 230 1.2.4.2 yamt vbe_find_mode(char *str) 231 1.2.4.2 yamt { 232 1.2.4.2 yamt struct vbeinfoblock vbe; 233 1.2.4.2 yamt struct modeinfoblock mi; 234 1.2.4.2 yamt uint32_t farptr; 235 1.2.4.2 yamt uint16_t mode; 236 1.2.4.2 yamt int x, y, bpp; 237 1.2.4.2 yamt int safety = 0; 238 1.2.4.2 yamt 239 1.2.4.2 yamt if (!vbe_parse_mode_str(str, &x, &y, &bpp)) 240 1.2.4.2 yamt return 0; 241 1.2.4.2 yamt 242 1.2.4.2 yamt memset(&vbe, 0, sizeof(vbe)); 243 1.2.4.2 yamt memcpy(vbe.VbeSignature, "VBE2", 4); 244 1.2.4.2 yamt if (biosvbe_info(&vbe) != 0x004f) 245 1.2.4.2 yamt return 0; 246 1.2.4.2 yamt if (memcmp(vbe.VbeSignature, "VESA", 4) != 0) 247 1.2.4.2 yamt return 0; 248 1.2.4.2 yamt farptr = vbe.VideoModePtr; 249 1.2.4.2 yamt if (farptr == 0) 250 1.2.4.2 yamt return 0; 251 1.2.4.2 yamt 252 1.2.4.2 yamt while ((mode = *(uint16_t *)vbe_farptr(farptr)) != 0xffff) { 253 1.2.4.2 yamt safety++; 254 1.2.4.2 yamt farptr += 2; 255 1.2.4.2 yamt if (safety == 100) 256 1.2.4.2 yamt return 0; 257 1.2.4.2 yamt if (biosvbe_get_mode_info(mode, &mi) != 0x004f) 258 1.2.4.2 yamt continue; 259 1.2.4.2 yamt /* we only care about linear modes here */ 260 1.2.4.2 yamt if (vbe_mode_is_supported(&mi) == 0) 261 1.2.4.2 yamt continue; 262 1.2.4.2 yamt safety = 0; 263 1.2.4.2 yamt if (mi.XResolution == x && 264 1.2.4.2 yamt mi.YResolution == y && 265 1.2.4.2 yamt mi.BitsPerPixel == bpp) 266 1.2.4.2 yamt return mode; 267 1.2.4.2 yamt } 268 1.2.4.2 yamt 269 1.2.4.2 yamt printf("VESA VBE BIOS does not support %s\n", str); 270 1.2.4.2 yamt return 0; 271 1.2.4.2 yamt } 272 1.2.4.2 yamt 273 1.2.4.2 yamt static void 274 1.2.4.2 yamt vbe_dump_mode(int modenum, struct modeinfoblock *mi) 275 1.2.4.2 yamt { 276 1.2.4.2 yamt printf("0x%x=%dx%dx%d", modenum, 277 1.2.4.2 yamt mi->XResolution, mi->YResolution, mi->BitsPerPixel); 278 1.2.4.2 yamt } 279 1.2.4.2 yamt 280 1.2.4.2 yamt void 281 1.2.4.2 yamt vbe_modelist(void) 282 1.2.4.2 yamt { 283 1.2.4.2 yamt struct vbeinfoblock vbe; 284 1.2.4.2 yamt struct modeinfoblock mi; 285 1.2.4.2 yamt uint32_t farptr; 286 1.2.4.2 yamt uint16_t mode; 287 1.2.4.2 yamt int nmodes = 0, safety = 0; 288 1.2.4.2 yamt 289 1.2.4.2 yamt if (!vbestate.available) { 290 1.2.4.2 yamt printf("VESA BIOS extensions not available\n"); 291 1.2.4.2 yamt return; 292 1.2.4.2 yamt } 293 1.2.4.2 yamt 294 1.2.4.2 yamt printf("Modes: "); 295 1.2.4.2 yamt memset(&vbe, 0, sizeof(vbe)); 296 1.2.4.2 yamt memcpy(vbe.VbeSignature, "VBE2", 4); 297 1.2.4.2 yamt if (biosvbe_info(&vbe) != 0x004f) 298 1.2.4.2 yamt goto done; 299 1.2.4.2 yamt if (memcmp(vbe.VbeSignature, "VESA", 4) != 0) 300 1.2.4.2 yamt goto done; 301 1.2.4.2 yamt farptr = vbe.VideoModePtr; 302 1.2.4.2 yamt if (farptr == 0) 303 1.2.4.2 yamt goto done; 304 1.2.4.2 yamt 305 1.2.4.2 yamt while ((mode = *(uint16_t *)vbe_farptr(farptr)) != 0xffff) { 306 1.2.4.2 yamt safety++; 307 1.2.4.2 yamt farptr += 2; 308 1.2.4.2 yamt if (safety == 100) { 309 1.2.4.2 yamt printf("[garbage] "); 310 1.2.4.2 yamt break; 311 1.2.4.2 yamt } 312 1.2.4.2 yamt if (biosvbe_get_mode_info(mode, &mi) != 0x004f) 313 1.2.4.2 yamt continue; 314 1.2.4.2 yamt /* we only care about linear modes here */ 315 1.2.4.2 yamt if (vbe_mode_is_supported(&mi) == 0) 316 1.2.4.2 yamt continue; 317 1.2.4.2 yamt safety = 0; 318 1.2.4.2 yamt if (nmodes % 4 == 0) 319 1.2.4.2 yamt printf("\n"); 320 1.2.4.2 yamt else 321 1.2.4.2 yamt printf(" "); 322 1.2.4.2 yamt vbe_dump_mode(mode, &mi); 323 1.2.4.2 yamt nmodes++; 324 1.2.4.2 yamt } 325 1.2.4.2 yamt 326 1.2.4.2 yamt done: 327 1.2.4.2 yamt if (nmodes == 0) 328 1.2.4.2 yamt printf("none found"); 329 1.2.4.2 yamt printf("\n"); 330 1.2.4.2 yamt } 331 1.2.4.2 yamt 332 1.2.4.2 yamt void 333 1.2.4.2 yamt command_vesa(char *cmd) 334 1.2.4.2 yamt { 335 1.2.4.2 yamt char arg[20]; 336 1.2.4.2 yamt int modenum; 337 1.2.4.2 yamt 338 1.2.4.2 yamt if (!vbe_available()) { 339 1.2.4.2 yamt printf("VESA VBE not available\n"); 340 1.2.4.2 yamt return; 341 1.2.4.2 yamt } 342 1.2.4.2 yamt 343 1.2.4.2 yamt strlcpy(arg, cmd, sizeof(arg)); 344 1.2.4.2 yamt 345 1.2.4.2 yamt if (strcmp(arg, "list") == 0) { 346 1.2.4.2 yamt vbe_modelist(); 347 1.2.4.2 yamt return; 348 1.2.4.2 yamt } 349 1.2.4.2 yamt 350 1.2.4.2 yamt if (strcmp(arg, "disabled") == 0 || strcmp(arg, "off") == 0) { 351 1.2.4.3 yamt vbestate.modenum = 0; 352 1.2.4.2 yamt return; 353 1.2.4.2 yamt } 354 1.2.4.2 yamt 355 1.2.4.2 yamt if (strcmp(arg, "enabled") == 0 || strcmp(arg, "on") == 0) 356 1.2.4.2 yamt modenum = VBE_DEFAULT_MODE; 357 1.2.4.2 yamt else if (strncmp(arg, "0x", 2) == 0) 358 1.2.4.2 yamt modenum = strtoul(arg, NULL, 0); 359 1.2.4.2 yamt else if (strchr(arg, 'x') != NULL) { 360 1.2.4.2 yamt modenum = vbe_find_mode(arg); 361 1.2.4.3 yamt if (modenum == 0) { 362 1.2.4.3 yamt printf("mode %s not supported by firmware\n", arg); 363 1.2.4.2 yamt return; 364 1.2.4.3 yamt } 365 1.2.4.2 yamt } else 366 1.2.4.2 yamt modenum = 0; 367 1.2.4.2 yamt 368 1.2.4.2 yamt if (modenum >= 0x100) { 369 1.2.4.3 yamt vbestate.modenum = modenum; 370 1.2.4.2 yamt return; 371 1.2.4.2 yamt } 372 1.2.4.2 yamt 373 1.2.4.2 yamt printf("invalid flag, must be 'enabled', 'disabled', " 374 1.2.4.2 yamt "a display mode, or a valid VESA VBE mode number.\n"); 375 1.2.4.2 yamt } 376
Indexes created Wed Oct 22 06:10:02 GMT 2025