* Helper functions
****************************************************************/
+u16
+calc_page_size(u8 memmodel, u16 width, u16 height)
+{
+ switch (memmodel) {
+ case MM_TEXT:
+ return ALIGN(width * height * 2, 2*1024);
+ case MM_CGA:
+ return 16*1024;
+ default:
+ return ALIGN(width * height / 8, 8*1024);
+ }
+}
+
static void
set_cursor_shape(u8 start, u8 end)
{
if (cp.page != current)
return;
- // Get the dimensions
+ // Calculate the memory address
u16 nbcols = GET_BDA(video_cols);
- u16 nbrows = GET_BDA(video_rows) + 1;
+ u16 address = (GET_BDA(video_pagesize) * cp.page
+ + (cp.x + cp.y * nbcols) * 2);
- // Calculate the address knowing nbcols nbrows and page num
- u16 address = (SCREEN_IO_START(nbcols, nbrows, cp.page)
- + cp.x + cp.y * nbcols);
-
- stdvga_set_cursor_pos(address);
+ stdvga_set_cursor_pos(address / 2);
}
static struct cursorpos
// Get pos curs pos for the right page
struct cursorpos cp = get_cursor_pos(page);
- u16 address;
- if (GET_GLOBAL(vmode_g->memmodel) == MM_TEXT) {
- // Get the dimensions
- u16 nbcols = GET_BDA(video_cols);
- u16 nbrows = GET_BDA(video_rows) + 1;
-
- // Calculate the address knowing nbcols nbrows and page num
- address = SCREEN_MEM_START(nbcols, nbrows, page);
- SET_BDA(video_pagestart, address);
-
- // Start address
- address = SCREEN_IO_START(nbcols, nbrows, page);
- } else {
- address = page * GET_GLOBAL(vmode_g->slength);
- }
-
- stdvga_set_active_page(address);
+ // Calculate memory address of start of page
+ u8 memmodel = GET_GLOBAL(vmode_g->memmodel);
+ u16 address = GET_BDA(video_pagesize) * page;
+ stdvga_set_active_page(memmodel == MM_TEXT ? address / 2 : address);
// And change the BIOS page
+ SET_BDA(video_pagestart, address);
SET_BDA(video_page, page);
dprintf(1, "Set active page %02x address %04x\n", page, address);
u8 rows = vde / lines;
SET_BDA(video_rows, rows - 1);
u16 cols = GET_BDA(video_cols);
- SET_BDA(video_pagesize, rows * cols * 2);
+ SET_BDA(video_pagesize, calc_page_size(MM_TEXT, cols, rows));
}
// Set the BIOS mem
int width = GET_GLOBAL(vmode_g->width);
int height = GET_GLOBAL(vmode_g->height);
+ u8 memmodel = GET_GLOBAL(vmode_g->memmodel);
int cheight = GET_GLOBAL(vmode_g->cheight);
SET_BDA(video_mode, mode);
- if (GET_GLOBAL(vmode_g->memmodel) == MM_TEXT) {
+ if (memmodel == MM_TEXT) {
SET_BDA(video_cols, width);
SET_BDA(video_rows, height-1);
SET_BDA(cursor_type, 0x0607);
SET_BDA(video_rows, (height / cheight) - 1);
SET_BDA(cursor_type, 0x0000);
}
- SET_BDA(video_pagesize, GET_GLOBAL(vmode_g->slength));
+ SET_BDA(video_pagesize, calc_page_size(memmodel, width, height));
SET_BDA(crtc_address, stdvga_get_crtc());
SET_BDA(char_height, cheight);
SET_BDA(video_ctl, 0x60 | (flags & MF_NOCLEARMEM ? 0x80 : 0x00));
continue;
int width = GET_GLOBAL(vmode_g->width);
int height = GET_GLOBAL(vmode_g->height);
+ u8 memmodel = GET_GLOBAL(vmode_g->memmodel);
int cheight = GET_GLOBAL(vmode_g->cheight);
- if (GET_GLOBAL(vmode_g->memmodel) == MM_TEXT) {
+ if (memmodel == MM_TEXT) {
SET_VGA(vparam_g->twidth, width);
SET_VGA(vparam_g->theightm1, height-1);
} else {
SET_VGA(vparam_g->theightm1, (height / cheight) - 1);
}
SET_VGA(vparam_g->cheight, cheight);
- SET_VGA(vparam_g->slength, GET_GLOBAL(vmode_g->slength));
+ SET_VGA(vparam_g->slength, calc_page_size(memmodel, width, height));
memcpy_far(get_global_seg(), vparam_g->sequ_regs
, get_global_seg(), GET_GLOBAL(vmode_g->sequ_regs)
, ARRAY_SIZE(vparam_g->sequ_regs));
#define VPARAM(x) &video_param_table[x]
static struct vgamode_s vga_modes[] VAR16 = {
- //mode model tx ty bpp cw ch sstart slength
+ //mode model tx ty bpp cw ch sstart
// pelm dac sequ misc crtc actl grdc
- {0x00, MM_TEXT, 40, 25, 4, 9, 16, SEG_CTEXT, 0x0800
+ {0x00, MM_TEXT, 40, 25, 4, 9, 16, SEG_CTEXT
, 0xFF, PAL(palette2), sequ_01, 0x67, crtc_01, actl_01, grdc_01},
- {0x01, MM_TEXT, 40, 25, 4, 9, 16, SEG_CTEXT, 0x0800
+ {0x01, MM_TEXT, 40, 25, 4, 9, 16, SEG_CTEXT
, 0xFF, PAL(palette2), sequ_01, 0x67, crtc_01, actl_01, grdc_01},
- {0x02, MM_TEXT, 80, 25, 4, 9, 16, SEG_CTEXT, 0x1000
+ {0x02, MM_TEXT, 80, 25, 4, 9, 16, SEG_CTEXT
, 0xFF, PAL(palette2), sequ_03, 0x67, crtc_03, actl_01, grdc_01},
- {0x03, MM_TEXT, 80, 25, 4, 9, 16, SEG_CTEXT, 0x1000
+ {0x03, MM_TEXT, 80, 25, 4, 9, 16, SEG_CTEXT
, 0xFF, PAL(palette2), sequ_03, 0x67, crtc_03, actl_01, grdc_01},
- {0x04, MM_CGA, 320, 200, 2, 8, 8, SEG_CTEXT, 0x0800
+ {0x04, MM_CGA, 320, 200, 2, 8, 8, SEG_CTEXT
, 0xFF, PAL(palette1), sequ_04, 0x63, crtc_04, actl_04, grdc_04},
- {0x05, MM_CGA, 320, 200, 2, 8, 8, SEG_CTEXT, 0x0800
+ {0x05, MM_CGA, 320, 200, 2, 8, 8, SEG_CTEXT
, 0xFF, PAL(palette1), sequ_04, 0x63, crtc_04, actl_04, grdc_04},
- {0x06, MM_CGA, 640, 200, 1, 8, 8, SEG_CTEXT, 0x1000
+ {0x06, MM_CGA, 640, 200, 1, 8, 8, SEG_CTEXT
, 0xFF, PAL(palette1), sequ_06, 0x63, crtc_06, actl_06, grdc_06},
- {0x07, MM_TEXT, 80, 25, 4, 9, 16, SEG_MTEXT, 0x1000
+ {0x07, MM_TEXT, 80, 25, 4, 9, 16, SEG_MTEXT
, 0xFF, PAL(palette0), sequ_03, 0x66, crtc_07, actl_07, grdc_07},
- {0x0D, MM_PLANAR, 320, 200, 4, 8, 8, SEG_GRAPH, 0x2000
+ {0x0D, MM_PLANAR, 320, 200, 4, 8, 8, SEG_GRAPH
, 0xFF, PAL(palette1), sequ_0d, 0x63, crtc_0d, actl_0d, grdc_0d},
- {0x0E, MM_PLANAR, 640, 200, 4, 8, 8, SEG_GRAPH, 0x4000
+ {0x0E, MM_PLANAR, 640, 200, 4, 8, 8, SEG_GRAPH
, 0xFF, PAL(palette1), sequ_0e, 0x63, crtc_0e, actl_0d, grdc_0d},
- {0x0F, MM_PLANAR, 640, 350, 1, 8, 14, SEG_GRAPH, 0x8000
+ {0x0F, MM_PLANAR, 640, 350, 1, 8, 14, SEG_GRAPH
, 0xFF, PAL(palette0), sequ_0e, 0xa3, crtc_0f, actl_0f, grdc_0d},
- {0x10, MM_PLANAR, 640, 350, 4, 8, 14, SEG_GRAPH, 0x8000
+ {0x10, MM_PLANAR, 640, 350, 4, 8, 14, SEG_GRAPH
, 0xFF, PAL(palette2), sequ_0e, 0xa3, crtc_0f, actl_10, grdc_0d},
- {0x11, MM_PLANAR, 640, 480, 1, 8, 16, SEG_GRAPH, 0x0000
+ {0x11, MM_PLANAR, 640, 480, 1, 8, 16, SEG_GRAPH
, 0xFF, PAL(palette2), sequ_0e, 0xe3, crtc_11, actl_11, grdc_0d},
- {0x12, MM_PLANAR, 640, 480, 4, 8, 16, SEG_GRAPH, 0x0000
+ {0x12, MM_PLANAR, 640, 480, 4, 8, 16, SEG_GRAPH
, 0xFF, PAL(palette2), sequ_0e, 0xe3, crtc_11, actl_10, grdc_0d},
- {0x13, MM_PACKED, 320, 200, 8, 8, 8, SEG_GRAPH, 0x0000
+ {0x13, MM_PACKED, 320, 200, 8, 8, 8, SEG_GRAPH
, 0xFF, PAL(palette3), sequ_13, 0x63, crtc_13, actl_13, grdc_13},
- {0x6A, MM_PLANAR, 800, 600, 4, 8, 16, SEG_GRAPH, 0x0000
+ {0x6A, MM_PLANAR, 800, 600, 4, 8, 16, SEG_GRAPH
, 0xFF, PAL(palette2), sequ_0e, 0xe3, crtc_6A, actl_10, grdc_0d},
};