static int get_mode_info(int mode, struct vbe_mode_info *mi);
static int conv_vbeinfo(int mode, struct vid_modeinfo *mi, struct vbe_mode_info *vbemi);
static unsigned int calc_mask(int nbits, int pos);
+static void print_mode_info(int mode, struct vid_modeinfo *mi);
static void pack(uint32_t *pix, int r, int g, int b);
static void unpack(uint32_t pix, int *r, int *g, int *b);
static void clear(uint32_t color);
+static void blit_lfb(int x, int y, int w, int h, void *fb, int pitch);
+static void blit_banked(int x, int y, int w, int h, void *fb, int pitch);
static void blitfb_lfb(void *fb, int pitch);
static void blitfb_banked(void *fb, int pitch);
static void flip(int vsync);
cur_pgsize = minf->height * minf->pitch;
if(mode & VBE_MODE_LFB) {
+ minf->ops.blit = blit_lfb;
minf->ops.blitfb = blitfb_lfb;
} else {
+ minf->ops.blit = blit_banked;
minf->ops.blitfb = blitfb_banked;
}
+
+ print_mode_info(mode, minf);
return 0;
}
mi->ops.getpal = vga_getpal;
mi->ops.vsync = vid_vsync;
mi->ops.clear = clear;
+ mi->ops.blit = 0;
mi->ops.blitfb = 0;
mi->ops.flip = flip;
return 0;
return mask << pos;
}
+static void print_mode_info(int mode, struct vid_modeinfo *mi)
+{
+ infomsg("VBE mode %04x\n", mode);
+ infomsg(" %dx%d %d bpp (%d colors)\n", mi->width, mi->height,
+ mi->bpp, mi->ncolors);
+ infomsg(" pitch: %d bytes, %d vmem pages\n", mi->pitch, mi->pages);
+
+ if(mi->bpp > 8) {
+ infomsg(" RGB mask %06x %06x %06x (pos: %d %d %d)\n", (unsigned int)mi->rmask,
+ (unsigned int)mi->gmask, (unsigned int)mi->bmask, mi->rshift,
+ mi->gshift, mi->bshift);
+ }
+
+ if(mode & VBE_MODE_LFB) {
+ infomsg(" LFB address %xh, size: %d\n", (unsigned int)mi->vmem_addr,
+ (int)mi->vmem_size);
+ } else {
+ infomsg(" banked window %d kb, granularity: %d kb, step: %d\n", mi->win_size,
+ mi->win_gran, mi->win_step);
+ }
+}
+
static void pack(uint32_t *pix, int r, int g, int b)
{
{
}
+static void blit_lfb(int x, int y, int w, int h, void *fb, int pitch)
+{
+ int i, pixsz, spansz;
+ unsigned char *dest, *src;
+
+ /*dbgmsg("blit: %d,%d (%dx%d)\n", x, y, w, h);*/
+
+ pixsz = (cur_mi->bpp + 7) >> 3;
+ spansz = w * pixsz;
+
+ dest = (char*)vid_vmem + cur_mi->pitch * y + x * pixsz;
+ src = fb;
+
+ for(i=0; i<h; i++) {
+ memcpy(dest, src, spansz);
+ dest += cur_mi->pitch;
+ src += pitch;
+ }
+}
+
+static void blit_banked(int x, int y, int w, int h, void *fb, int pitch)
+{
+ abort();
+}
+
static void blitfb_lfb(void *fb, int pitch)
{
- int i;
+ int i, pixsz, spansz;
unsigned char *dest, *src;
+ pixsz = (cur_mi->bpp + 7) >> 3;
+ spansz = cur_mi->width * pixsz;
+
dest = vid_vmem;
src = fb;
for(i=0; i<cur_mi->height; i++) {
- memcpy(dest, src, cur_mi->pitch);
+ memcpy(dest, src, spansz);
dest += cur_mi->pitch;
src += pitch;
}