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