diff --git a/sys/dev/fb/vesa.c b/sys/dev/fb/vesa.c index 1b9f4fbdb596..ec08cfb7be51 100644 --- a/sys/dev/fb/vesa.c +++ b/sys/dev/fb/vesa.c @@ -725,9 +725,11 @@ vesa_bios_init(void) video_info_t *p; x86regs_t regs; size_t bsize; + size_t msize; void *vmbuf; uint32_t offs; uint16_t vers; + int bpsl; int is_via_cle266; int modes; int i; @@ -807,6 +809,8 @@ vesa_bios_init(void) if (buf.v_modetable == 0) goto fail; + msize = (size_t)buf.v_memsize * 64 * 1024; + vesa_vmodetab = x86bios_offset(BIOS_SADDRTOLADDR(buf.v_modetable)); for (i = 0, modes = 0; (i < (M_VESA_MODE_MAX - M_VESA_BASE + 1)) && @@ -850,6 +854,25 @@ vesa_bios_init(void) } #endif + bpsl = (vmode.v_modeattr & V_MODELFB) != 0 && vers >= 0x0300 ? + vmode.v_linbpscanline : vmode.v_bpscanline; + bsize = bpsl * vmode.v_height; + if ((vmode.v_modeattr & V_MODEGRAPHICS) != 0) + bsize *= vmode.v_planes; + + /* Does it have enough memory to support this mode? */ + if (msize < bsize) { +#if VESA_DEBUG > 1 + printf("Rejecting VESA %s mode: %d x %d x %d bpp " + " attr = %x, not enough memory\n", + vmode.v_modeattr & V_MODEGRAPHICS ? + "graphics" : "text", + vmode.v_width, vmode.v_height, vmode.v_bpp, + vmode.v_modeattr); +#endif + continue; + } + /* expand the array if necessary */ if (modes >= vesa_vmode_max) { vesa_vmode_max += MODE_TABLE_DELTA; @@ -891,87 +914,17 @@ vesa_bios_init(void) /* XXX window B */ vesa_vmode[modes].vi_window_size = vmode.v_wsize * 1024; vesa_vmode[modes].vi_window_gran = vmode.v_wgran * 1024; - if (vmode.v_modeattr & V_MODELFB) { + if (vmode.v_modeattr & V_MODELFB) vesa_vmode[modes].vi_buffer = vmode.v_lfb; - vesa_vmode[modes].vi_line_width = vers >= 0x0300 ? - vmode.v_linbpscanline : vmode.v_bpscanline; - } else - vesa_vmode[modes].vi_line_width = vmode.v_bpscanline; - /* XXX */ - vesa_vmode[modes].vi_buffer_size = - vesa_adp_info->v_memsize * 64 * 1024; -#if 0 - if (vmode.v_offscreen > vmode.v_lfb) - vesa_vmode[modes].vi_buffer_size = vmode.v_offscreen + - vmode.v_offscreensize * 1024 - vmode.v_lfb; - else - vesa_vmode[modes].vi_buffer_size = vmode.v_offscreen + - vmode.v_offscreensize * 1024; -#endif + vesa_vmode[modes].vi_buffer_size = bsize; vesa_vmode[modes].vi_mem_model = vesa_translate_mmodel(vmode.v_memmodel); if (vesa_vmode[modes].vi_mem_model == V_INFO_MM_PACKED || vesa_vmode[modes].vi_mem_model == V_INFO_MM_DIRECT) vesa_vmode[modes].vi_pixel_size = (vmode.v_bpp + 7) / 8; -#if 0 - if (vesa_vmode[modes].vi_mem_model == V_INFO_MM_DIRECT) { - if ((vmode.v_modeattr & V_MODELFB) != 0 && - vers >= 0x0300) { - vesa_vmode[modes].vi_pixel_fields[0] = - vmode.v_linredfieldpos; - vesa_vmode[modes].vi_pixel_fields[1] = - vmode.v_lingreenfieldpos; - vesa_vmode[modes].vi_pixel_fields[2] = - vmode.v_linbluefieldpos; - vesa_vmode[modes].vi_pixel_fields[3] = - vmode.v_linresfieldpos; - vesa_vmode[modes].vi_pixel_fsizes[0] = - vmode.v_linredmasksize; - vesa_vmode[modes].vi_pixel_fsizes[1] = - vmode.v_lingreenmasksize; - vesa_vmode[modes].vi_pixel_fsizes[2] = - vmode.v_linbluemasksize; - vesa_vmode[modes].vi_pixel_fsizes[3] = - vmode.v_linresmasksize; - } else { - vesa_vmode[modes].vi_pixel_fields[0] = - vmode.v_redfieldpos; - vesa_vmode[modes].vi_pixel_fields[1] = - vmode.v_greenfieldpos; - vesa_vmode[modes].vi_pixel_fields[2] = - vmode.v_bluefieldpos; - vesa_vmode[modes].vi_pixel_fields[3] = - vmode.v_resfieldpos; - vesa_vmode[modes].vi_pixel_fsizes[0] = - vmode.v_redmasksize; - vesa_vmode[modes].vi_pixel_fsizes[1] = - vmode.v_greenmasksize; - vesa_vmode[modes].vi_pixel_fsizes[2] = - vmode.v_bluemasksize; - vesa_vmode[modes].vi_pixel_fsizes[3] = - vmode.v_resmasksize; - } - } -#endif - vesa_vmode[modes].vi_flags = vesa_translate_flags(vmode.v_modeattr) | V_INFO_VESA; - /* Does it have enough memory to support this mode? */ - bsize = (size_t)vesa_vmode[modes].vi_line_width * - vesa_vmode[modes].vi_height; - if (bsize > vesa_vmode[modes].vi_buffer_size) { -#if VESA_DEBUG > 1 - printf("Rejecting VESA %s mode: %d x %d x %d bpp " - " attr = %x, not enough memory\n", - (vmode.v_modeattr & V_MODEGRAPHICS) != 0 ? - "graphics" : "text", - vmode.v_width, vmode.v_height, vmode.v_bpp, - vmode.v_modeattr); -#endif - continue; - } - ++modes; } vesa_vmode[modes].vi_mode = EOT; @@ -1208,7 +1161,7 @@ vesa_set_mode(video_adapter_t *adp, int mode) int10_set_mode(adp->va_initial_bios_mode); if (adp->va_info.vi_flags & V_INFO_LINEAR) pmap_unmapdev(adp->va_buffer, - vesa_adp_info->v_memsize * 64 * 1024); + adp->va_buffer_size); /* * Once (*prevvidsw->get_info)() succeeded, * (*prevvidsw->set_mode)() below won't fail... @@ -1239,8 +1192,7 @@ vesa_set_mode(video_adapter_t *adp, int mode) vesa_bios_set_dac(8); if (adp->va_info.vi_flags & V_INFO_LINEAR) - pmap_unmapdev(adp->va_buffer, - vesa_adp_info->v_memsize * 64 * 1024); + pmap_unmapdev(adp->va_buffer, adp->va_buffer_size); #if VESA_DEBUG > 0 printf("VESA: mode set!\n"); @@ -1257,20 +1209,21 @@ vesa_set_mode(video_adapter_t *adp, int mode) #endif vesa_adp->va_buffer = (vm_offset_t)pmap_mapdev_attr(info.vi_buffer, - vesa_adp_info->v_memsize * 64 * 1024, PAT_WRITE_COMBINING); - vesa_adp->va_buffer_size = info.vi_buffer_size; + info.vi_buffer_size, PAT_WRITE_COMBINING); vesa_adp->va_window = vesa_adp->va_buffer; - vesa_adp->va_window_size = info.vi_buffer_size/info.vi_planes; - vesa_adp->va_window_gran = info.vi_buffer_size/info.vi_planes; + vesa_adp->va_window_size = info.vi_buffer_size / info.vi_planes; + vesa_adp->va_window_gran = info.vi_buffer_size / info.vi_planes; } else { vesa_adp->va_buffer = 0; - vesa_adp->va_buffer_size = info.vi_buffer_size; vesa_adp->va_window = (vm_offset_t)x86bios_offset(info.vi_window); vesa_adp->va_window_size = info.vi_window_size; vesa_adp->va_window_gran = info.vi_window_gran; } + vesa_adp->va_buffer_size = info.vi_buffer_size; vesa_adp->va_window_orig = 0; - vesa_adp->va_line_width = info.vi_line_width; + vesa_adp->va_line_width = info.vi_buffer_size / info.vi_height; + if ((info.vi_flags & V_INFO_GRAPHICS) != 0) + vesa_adp->va_line_width /= info.vi_planes; vesa_adp->va_disp_start.x = 0; vesa_adp->va_disp_start.y = 0; #if VESA_DEBUG > 0 diff --git a/sys/sys/fbio.h b/sys/sys/fbio.h index 5bc27ff2d1cb..415ad966911f 100644 --- a/sys/sys/fbio.h +++ b/sys/sys/fbio.h @@ -295,10 +295,8 @@ struct video_info { /* for MM_DIRECT only */ int vi_pixel_fields[4]; /* RGB and reserved fields */ int vi_pixel_fsizes[4]; - /* XXX for VESA only */ - int vi_line_width; /* reserved */ - u_char vi_reserved[60]; + u_char vi_reserved[64]; vm_offset_t vi_registers; /* physical address */ vm_offset_t vi_registers_size; };