X-Git-Url: http://4ch.mooo.com/gitweb/?a=blobdiff_plain;f=src%2Flib%2Fmodex16.c;h=62f5c4ef547aac9c64b767a742c53912e624cb19;hb=d5a4d9aafbf32d7224dbe7f284a7f7ee37b89f89;hp=7d7d7631dce9b3a3217de6ac55a465706d075e3f;hpb=2a9ec1a325590c2bc55ecb8e36e376c51c0d3c53;p=16.git diff --git a/src/lib/modex16.c b/src/lib/modex16.c index 7d7d7631..62f5c4ef 100755 --- a/src/lib/modex16.c +++ b/src/lib/modex16.c @@ -35,7 +35,7 @@ static byte tmppal[PAL_SIZE]; // setvideo() - This function Manages the video modes // // // ///////////////////////////////////////////////////////////////////////////// -void VGAmodeX(sword vq, byte cm, global_game_variables_t *gv) +void VGAmodeX(sword vq, boolean cmem, global_game_variables_t *gv) { union REGS in, out; @@ -54,7 +54,7 @@ void VGAmodeX(sword vq, byte cm, global_game_variables_t *gv) //int86(0x10, &in, &out); gv->video.old_mode = vgaGetMode();//out.h.al; // enter mode - modexEnter(vq, cm, gv); + modexEnter(vq, cmem, gv); break; } } @@ -62,11 +62,12 @@ void VGAmodeX(sword vq, byte cm, global_game_variables_t *gv) static void vgaSetMode(byte mode) { - union REGS regs; + union REGS regs; - regs.h.ah = SET_MODE; - regs.h.al = mode; - int86(VIDEO_INT, ®s, ®s); + regs.h.ah = SET_MODE; + regs.h.al = mode; + int86(VIDEO_INT, ®s, ®s); + //int10_setmode(mode); } //--------------------------------------------------- @@ -74,140 +75,105 @@ vgaSetMode(byte mode) // Use the bios to get the current video mode // -long +byte/*FIXME: why long? "long" is 32-bit datatype, VGA modes are 8-bit numbers. */ vgaGetMode() { - union REGS rg; - - rg.h.ah = 0x0f; - int86(VIDEO_INT, &rg, &rg); - - return rg.h.al; + return int10_getmode(); } /* -========================= Entry Points ==========================- */ -void -modexEnter(sword vq, boolean cm, global_game_variables_t *gv) +void modexEnter(sword vq, boolean cmem, global_game_variables_t *gv) { word i; - dword far*ptr=(dword far*)VGA; /* used for faster screen clearing */ + struct vga_mode_params cm; int CRTParmCount; - /* common mode X initiation stuff~ */ - modexsetBaseXMode(gv->video.page); + + vgaSetMode(VGA_256_COLOR_MODE); + vga_enable_256color_modex(); + + update_state_from_vga(); + vga_read_crtc_mode_(&cm); + + /* reprogram the CRT controller */ + //outp(CRTC_INDEX, 0x11); /* VSync End reg contains register write prot */ + //outp(CRTC_DATA, 0x7f); /* get current write protect on varios regs */ switch(vq) { case 1: - CRTParmCount = sizeof(ModeX_320x240regs) / sizeof(ModeX_320x240regs[0]); - /* width and height */ - gv->video.page[0].sw=320; - gv->video.page[0].sh=240; - - /* send the CRTParms */ - for(i=0; ivideo.page[0].sw=120; - gv->video.page[0].sh=160; - - /* send the CRTParms */ - for(i=0; ivideo.page[0].sw=320; - gv->video.page[0].sh=200; - - /* send the CRTParms */ - for(i=0; ivideo.page[0].sw=192; - gv->video.page[0].sh=144; - - /* send the CRTParms */ - for(i=0; ivideo.page[0].sw=256; - gv->video.page[0].sh=192; - - /* send the CRTParms */ - for(i=0; ivideo.page[0].sw = vga_state.vga_width = 320; // VGA lib currently does not update this + gv->video.page[0].sh = vga_state.vga_height = 240; // VGA lib currently does not update this + /* virtual width and height. match screen, at first */ + gv->video.page[0].height = gv->video.page[0].sh; + gv->video.page[0].width = gv->video.page[0].sw; + + // mode X BYTE mode + cm.word_mode = 0; + cm.dword_mode = 0; + // 320x240 mode 60Hz + cm.horizontal_total=0x5f + 5; /* CRTC[0] -5 */ + cm.horizontal_display_end=0x4f + 1; /* CRTC[1] -1 */ + cm.horizontal_blank_start=0x50 + 1; /* CRTC[2] */ + //cm.horizontal_blank_end=0x82 + 1; /* CRTC[3] bit 0-4 & CRTC[5] bit 7 *///skewing ^^; + cm.horizontal_start_retrace=0x54;/* CRTC[4] */ + cm.horizontal_end_retrace=0x80; /* CRTC[5] bit 0-4 */ + //cm.horizontal_start_delay_after_total=0x3e; /* CRTC[3] bit 5-6 */ + //cm.horizontal_start_delay_after_retrace=0x41; /* CRTC[5] bit 5-6 */ + cm.vertical_total = 0x20D + 2; + cm.vertical_start_retrace = 0x1EA; + cm.vertical_end_retrace = 0x1EC; + cm.vertical_display_end = 480; + cm.vertical_blank_start = 0x1E7 + 1; + cm.vertical_blank_end = 0x206 + 1; + cm.clock_select = 0; /* misc register = 0xE3 25MHz */ + cm.vsync_neg = 1; + cm.hsync_neg = 1; + cm.offset = (vga_state.vga_width / (4 * 2)); // 320 wide (40 x 4 pixel groups x 2) + break; + case 2: // TODO: 160x120 according to ModeX_160x120regs + return; + case 3: // TODO: 160x120 according to ModeX_320x200regs + return; + case 4: // TODO: 160x120 according to ModeX_192x144regs + return; + case 5: // TODO: 160x120 according to ModeX_256x192regs + return; + default: + return; } + vga_state.vga_stride = cm.offset * 2; + vga_write_crtc_mode(&cm,0); + /* clear video memory */ - switch (cm) + switch (cmem) { - case 1: - /* clear video memory */ - outpw(SC_INDEX, 0x0f02); - for(i=0; i<0x8000; i++) { - ptr[i] = 0x0000; + case 1: { + /* clear video memory */ + dword far*ptr=(dword far*)vga_state.vga_graphics_ram;//VGA; /* used for faster screen clearing */ + vga_write_sequencer(2/*map mask register*/,0xf/*all 4 planes*/); + for(i = 0;i < 0x4000; i++) ptr[i] = 0x0000; // 0x4000 x dword = 64KB } break; } - gv->video.page[0].tilesw = gv->video.page[0].sw/TILEWH; - gv->video.page[0].tilesh = gv->video.page[0].sh/TILEWH; + +// gv->video.page[0].tw = gv->video.page[0].sw/TILEWH; +// gv->video.page[0].th = gv->video.page[0].sh/TILEWH; + //TODO MAKE FLEXIBLE~ - gv->video.page[0].tilemidposscreenx = gv->video.page[0].tilesw; - gv->video.page[0].tilemidposscreeny = (gv->video.page[0].tilesh/2)+1; - #define PAGE_SIZE (word)(gv->video.page[0].sw/4 * gv->video.page[0].sh) +// gv->video.page[0].tilemidposscreenx = gv->video.page[0].tilesw; +// gv->video.page[0].tilemidposscreeny = (gv->video.page[0].tilesh/2)+1; } void modexLeave() { - /* TODO restore original mode and palette */ - vgaSetMode(TEXT_MODE); -} - -// setBaseXMode() does the initialization to make the VGA ready to -// accept any combination of configuration register settings. This -// involves enabling writes to index 0 to 7 of the CRT controller (port -// 0x3D4), by clearing the most significant bit (bit 7) of index 0x11. -void -modexsetBaseXMode(page_t *page) -{ - word temp; - /* TODO save current video mode and palette */ - vgaSetMode(VGA_256_COLOR_MODE); - - /* disable chain4 mode */ - outpw(SC_INDEX, 0x0604); - - /* synchronous reset while setting Misc Output */ - outpw(SC_INDEX, 0x0100); - - /* select 25 MHz dot clock & 60 Hz scanning rate */ - outp(MISC_OUTPUT, 0xe3); - - /* undo reset (restart sequencer) */ - outpw(SC_INDEX, 0x0300); - - /* reprogram the CRT controller */ - outp(CRTC_INDEX, 0x11); /* VSync End reg contains register write prot */ -// temp = inp(CRTC_DATA) & 0x7F; -// outp(CRTC_INDEX, 0x11); - outp(CRTC_DATA, 0x7f); /* get current write protect on varios regs */ -// outp(CRTC_DATA, temp); /* get current write protect on varios regs */ + /* VGAmodeX restores original mode and palette */ + vgaSetMode(TEXT_MODE); } page_t @@ -216,20 +182,23 @@ modexDefaultPage(page_t *p) page_t page; /* default page values */ - page.data = VGA; + //page.data = VGA; + //page.data = (byte far *)(vga_state.vga_graphics_ram); + page.data = (vga_state.vga_graphics_ram); page.dx = 0; page.dy = 0; page.sw = p->sw; page.sh = p->sh; - page.width = p->sw; - page.height = p->sh; + page.width = p->sw+TILEWHD; + page.height = p->sh+TILEWHD; page.tw = page.sw/TILEWH; page.th = page.sh/TILEWH; + page.tilesw=page.width/TILEWH; + page.tilesh=page.height/TILEWH; page.tilemidposscreenx = page.tw/2; page.tilemidposscreeny = (page.th/2)+1; - page.tilesw=p->tilesw; - page.tilesh=p->tilesh; - //pageSize = p->sw*p->sh; + page.stridew=page.width/4; + page.pagesize = (word)(page.width/4)*page.height; page.id = 0; return page; @@ -242,17 +211,22 @@ page_t modexNextPage(page_t *p) { page_t result; - result.data = p->data + (p->width/4)*p->height; + result.data = p->data + (p->pagesize); result.dx = 0; result.dy = 0; + result.sw = p->sw; + result.sh = p->sh; result.width = p->width; result.height = p->height; - result.tw = p->width/TILEWH; - result.th = p->height/TILEWH; + result.tw = p->tw; + result.th = p->th; + result.tilesw = p->tilesw; + result.tilesh = p->tilesh; result.id = p->id+1; + result.stridew=p->stridew; + result.pagesize = p->pagesize; return result; -// return modexNextPageFlexibleSize(&p, p->width, p->height); } //next page with defined dimentions~ @@ -261,18 +235,50 @@ modexNextPageFlexibleSize(page_t *p, word x, word y) { page_t result; - result.data = p->data + (p->width/4)*p->height; /* compute the offset */ + result.data = p->data + (p->pagesize); /* compute the offset */ result.dx = 0; result.dy = 0; + result.sw = x; + result.sh = y; result.width = x; result.height = y; - result.tw = p->width/TILEWH; - result.th = p->height/TILEWH; + result.tw = result.sw/TILEWH; + result.th = result.sh/TILEWH; + result.tilesw=result.width/TILEWH; + result.tilesh=result.height/TILEWH; result.id = p->id+1; + result.stridew=result.width/4; + result.pagesize = (word)(result.width/4)*result.height; return result; } +void modexCalcVmemRemain(video_t *video) +{ + byte i; + //printf("\n\n 1st vmem_remain=%u\n", video->vmem_remain); + for(i=0; inum_of_pages; i++) + { + video->vmem_remain-=video->page[i].pagesize; + //printf(" [%u], video->page[%u].pagesize=%u\n", i, i, video->page[i].pagesize); + //printf(" [%u], vmem_remain=%u\n", i, video->vmem_remain); + } +} + +void modexHiganbanaPageSetup(video_t *video) +{ + video->vmem_remain=65535U; + video->num_of_pages=0; + (video->page[0]) = modexDefaultPage(&(video->page[0])); video->num_of_pages++; //video->page[0].width += (TILEWHD); video->page[0].height += (TILEWHD); + (video->page[1]) = modexNextPage(&(video->page[0])); video->num_of_pages++; + (video->page[2]) = modexNextPageFlexibleSize(&(video->page[1]), TILEWH*4, TILEWH*4); video->num_of_pages++; + (video->page[3]) = modexNextPageFlexibleSize(&(video->page[2]), video->page[0].sw, 208); video->num_of_pages++; +// (video->page[2]) = modexNextPageFlexibleSize(&(video->page[1]), video->page[0].width, 172); video->num_of_pages++; +// (video->page[3]) = modexNextPageFlexibleSize(&(video->page[2]), 72, 128); video->num_of_pages++; + modexCalcVmemRemain(video); + video->p=0; + video->r=1; +} void modexShowPage(page_t *page) { @@ -307,28 +313,25 @@ modexShowPage(page_t *page) { outp(AC_INDEX, (page->dx & 0x03) << 1); } - void modexPanPage(page_t *page, int dx, int dy) { page->dx = dx; page->dy = dy; } - void modexSelectPlane(byte plane) { outp(SC_INDEX, MAP_MASK); /* select plane */ outp(SC_DATA, plane); } - void modexClearRegion(page_t *page, int x, int y, int w, int h, byte color) { word pageOff = (word) page->data; word xoff=x/4; /* xoffset that begins each row */ word scanCount=w/4; /* number of iterations per row (excluding right clip)*/ - word poffset = pageOff + y*(page->width/4) + xoff; /* starting offset */ - word nextRow = page->width/4-scanCount-1; /* loc of next row */ + word poffset = pageOff + y*(page->stridew) + xoff; /* starting offset */ + word nextRow = page->stridew-scanCount-1; /* loc of next row */ byte lclip[] = {0x0f, 0x0e, 0x0c, 0x08}; /* clips for rectangles not on 4s */ byte rclip[] = {0x00, 0x01, 0x03, 0x07}; byte left = lclip[x&0x03]; @@ -340,6 +343,14 @@ modexClearRegion(page_t *page, int x, int y, int w, int h, byte color) { } __asm { + PUSHF + PUSH ES + PUSH AX + PUSH BX + PUSH CX + PUSH DX + PUSH SI + PUSH DI MOV AX, SCREEN_SEG ; go to the VGA memory MOV ES, AX MOV DI, poffset ; go to the first pixel @@ -373,6 +384,14 @@ modexClearRegion(page_t *page, int x, int y, int w, int h, byte color) { ADD DI, nextRow ; go to the next row DEC h JNZ SCAN_START + POP DI + POP SI + POP DX + POP CX + POP BX + POP AX + POP ES + POPF } } @@ -388,17 +407,26 @@ modexCopyPageRegion(page_t *dest, page_t *src, word dx, word dy, word width, word height) { - word doffset = (word)dest->data + dy*(dest->width/4) + dx/4; - word soffset = (word)src->data + sy*(src->width/4) + sx/4; - word scans = width/4; - word nextSrcRow = src->width/4 - scans - 1; - word nextDestRow = dest->width/4 - scans - 1; + word doffset = (word)dest->data + dy*(dest->stridew) + dx/4; + word soffset = (word)src->data + sy*(src->stridew) + sx/4; + word scans = vga_state.vga_stride; + word nextSrcRow = src->stridew - scans - 1; + word nextDestRow = dest->stridew - scans - 1; byte lclip[] = {0x0f, 0x0e, 0x0c, 0x08}; /* clips for rectangles not on 4s */ byte rclip[] = {0x0f, 0x01, 0x03, 0x07}; byte left = lclip[sx&0x03]; byte right = rclip[(sx+width)&0x03]; __asm { + PUSHF + PUSH ES + PUSH AX + PUSH BX + PUSH CX + PUSH DX + PUSH SI + PUSH DI + MOV AX, SCREEN_SEG ; work in the vga space MOV ES, AX ; MOV DI, doffset ; @@ -447,6 +475,15 @@ modexCopyPageRegion(page_t *dest, page_t *src, MOV DX, GC_INDEX+1 ; go back to CPU data MOV AL, 0ffh ; none from latches OUT DX, AL ; + + POP DI + POP SI + POP DX + POP CX + POP BX + POP AX + POP ES + POPF } } @@ -602,7 +639,8 @@ modexPalUpdate(bitmap_t *bmp, word *i, word qp, word aqoffset) static word a[PAL_SIZE]; //palette array of change values! word z=0, aq=0, aa=0, pp=0; - modexWaitBorder(); + //modexWaitBorder(); + vga_wait_for_vsync(); if((*i)==0) { memset(a, -1, sizeof(a)); @@ -652,7 +690,8 @@ modexPalUpdate(bitmap_t *bmp, word *i, word qp, word aqoffset) //if(qp>0) printf("qp=%d\n", qp); //if(qp>0) printf(" (*i)=%d\n", (*i)/3); } - modexWaitBorder(); /* waits one retrace -- less flicker */ + //modexWaitBorder(); /* waits one retrace -- less flicker */ + vga_wait_for_vsync(); if((*i)>=PAL_SIZE/2 && w==0) { for(; (*i)=page[0].sw-1){ x=0; yy+=4; } - modexClearRegion(page, x+xl, y+yy, 4, 4, color); - } - //modexputPixel(page, x+xl, y, color); -} - -void modexprint(page_t *page, word x, word y, word t, word col, word bgcol, const byte *str, boolean q) +void modexprint(page_t *page, word x, word y, word t, word col, word bgcol, const byte *str) { word s, o, w; + word x_draw = x; word addr = (word) romFontsData.l; + word addrq = (page->width/4) * y + (x / 4) + ((word)page->data); + word addrr = addrq; byte c; s=romFonts[t].seg; @@ -948,35 +982,23 @@ void modexprint(page_t *page, word x, word y, word t, word col, word bgcol, cons for(; *str != '\0'; str++) { c = (*str); - if((c=='\n'/* || c=="\ -"*/) || romFontsData.chw ->=page->width) + if(c=='\n') { - romFontsData.chw=0; - y+=romFonts[t].charSize; + x = x_draw; + romFontsData.chw = 0; + addrq += (page->width / 4) * 8; + addrr = addrq; + y += 8; continue; } - //load the letter 'A' - __asm { - MOV DI, addr - MOV SI, o - MOV ES, s - SUB AH, AH - MOV AL, c ; the letter - MOV CX, w - MUL CX - ADD SI, AX ;the address of charcter - L1: MOV AX, ES:SI - MOV DS:DI, AX - INC SI - INC DI - DEC CX - JNZ L1 - } -//TODO: OPTIMIZE THIS!!!! - modexDrawCharPBuf(page, x, y, t, col, bgcol, q); - //if(!q) getch(); + // load the character into romFontsData.l + // no need for inline assembly! + // NTS: It might even be faster to just let the modexDrawChar point directly at ROM font than to copy per char! --J.C. + _fmemcpy(romFontsData.l,MK_FP(s,o+(w*c))/*ROM font location*/,w/*char size*/); + modexDrawChar(page, x_draw/*for mode X planar use*/, t, col, bgcol, addrr); + x_draw += 8; /* track X for edge of screen */ + addrr += 2; /* move 8 pixels over (2 x 4 planar pixels per byte) */ } } @@ -1023,6 +1045,15 @@ void modexprintbig(page_t *page, word x, word y, word t, word col, word bgcol, c } //load the letter 'A' __asm { + PUSHF + PUSH ES + PUSH AX + PUSH BX + PUSH CX + PUSH DX + PUSH SI + PUSH DI + MOV DI, addr MOV SI, o MOV ES, s @@ -1037,6 +1068,15 @@ void modexprintbig(page_t *page, word x, word y, word t, word col, word bgcol, c INC DI DEC CX JNZ L1 + + POP DI + POP SI + POP DX + POP CX + POP BX + POP AX + POP ES + POPF } for(i=0; iwidth, page->height, color); /* set map mask to all 4 planes */ @@ -1087,11 +1127,203 @@ void cls(page_t *page, byte color, byte *Where) void modexWaitBorder() { - while(inp(INPUT_STATUS_1) & 8) { - /* spin */ - } + while(inp(INPUT_STATUS_1) & 8) { + // spin + } - while(!(inp(INPUT_STATUS_1) & 8)) { - /* spin */ - } + while(!(inp(INPUT_STATUS_1) & 8)) { + //spin + } +} + +void bios_cls() { + VGA_ALPHA_PTR ap; + VGA_RAM_PTR rp; + unsigned char m; + + m = int10_getmode(); + if ((rp=vga_state.vga_graphics_ram) != NULL && !(m <= 3 || m == 7)) { + unsigned int i,im; + + im = (FP_SEG(vga_state.vga_graphics_ram_fence) - FP_SEG(vga_state.vga_graphics_ram)); + if (im > 0xFFE) im = 0xFFE; + im <<= 4; + for (i=0;i < im;i++) vga_state.vga_graphics_ram[i] = 0; + } + else if ((ap=vga_state.vga_alpha_ram) != NULL) { + unsigned int i,im; + + im = (FP_SEG(vga_state.vga_alpha_ram_fence) - FP_SEG(vga_state.vga_alpha_ram)); + if (im > 0x7FE) im = 0x7FE; + im <<= 4 - 1; /* because ptr is type uint16_t */ + for (i=0;i < im;i++) vga_state.vga_alpha_ram[i] = 0x0720; + } + else { + printf("WARNING: bios cls no ptr\n"); + } +} + +void modexprintmeminfo(video_t *v) +{ + byte i; + printf("video memory remaining: %u\n", v->vmem_remain); + printf("page "); + for(i=0; inum_of_pages;i++) + { + printf(" [%u]=", i); + printf("(%Fp)", (v->page[i].data)); + printf(" size=%u", v->page[i].pagesize); + printf(" sw=%lu sh=%lu ", (unsigned long)v->page[i].sw, (unsigned long)v->page[i].sh); + printf(" width=%lu height=%lu", (unsigned long)v->page[i].width, (unsigned long)v->page[i].height); + printf("\n"); + } +} + +void vga_write_crtc_mode_(struct vga_mode_params *p,unsigned int flags) { + unsigned char c,c2,syncreset=0; + + if (!(vga_state.vga_flags & VGA_IS_VGA)) + return; + + /* sync disable unless told not to */ + if (!(flags & VGA_WRITE_CRTC_MODE_NO_CLEAR_SYNC)) { + c = vga_read_CRTC(0x17); + vga_write_CRTC(0x17,c&0x7F); + } + + c = inp(0x3CC); /* misc out reg */ + /* if changing the clock select bits then we need to do a reset of the sequencer */ + if (p->clock_select != ((c >> 2) & 3)) syncreset=1; + /* proceed to change bits */ + c &= ~((3 << 2) | (1 << 6) | (1 << 7)); + c |= (p->clock_select&3) << 2; + c |= p->hsync_neg << 6; + c |= p->vsync_neg << 7; + if (syncreset) vga_write_sequencer(0,0x01/*SR=0 AR=1 start synchronous reset*/); + outp(0x3C2,c); /* misc out */ + if (syncreset) vga_write_sequencer(0,0x03/*SR=1 AR=1 restart sequencer*/); + + vga_write_sequencer(1, + (p->shift_load_rate << 2) | + (p->shift4_enable << 4) | + ((p->clock9 ^ 1) << 0) | + (p->clock_div2 << 3)); + + c = 0; /* use 'c' as overflow register */ + c2 = vga_read_CRTC(0x09); /* read max scan line */ + c2 &= ~(1 << 5); /* mask out start vertical blank bit 9 */ + vga_write_CRTC(0x11, /* NTS: we leave bit 7 (protect) == 0 so we can program regs 0-7 in this routine */ + (((p->refresh_cycles_per_scanline == 5) ? 1 : 0) << 6) | + (p->vertical_end_retrace & 0xF)); + vga_write_CRTC(0x06,(p->vertical_total - 2)); + c |= (((p->vertical_total - 2) >> 8) & 1) << 0; + c |= (((p->vertical_total - 2) >> 9) & 1) << 5; + vga_write_CRTC(0x10,p->vertical_start_retrace); + c |= ((p->vertical_start_retrace >> 8) & 1) << 2; + c |= ((p->vertical_start_retrace >> 9) & 1) << 7; + vga_write_CRTC(0x12,p->vertical_display_end - 1); + c |= (((p->vertical_display_end - 1) >> 8) & 1) << 1; + c |= (((p->vertical_display_end - 1) >> 9) & 1) << 6; + vga_write_CRTC(0x15,p->vertical_blank_start - 1); + c |= (((p->vertical_blank_start - 1) >> 8) & 1) << 3; + c2|= (((p->vertical_blank_start - 1) >> 9) & 1) << 5; + + /* NTS: this field is 7 bits wide but "Some SVGA chipsets use all 8" as VGADOC says. */ + /* writing it in this way resolves the partial/full screen blanking problems with Intel 855/915/945 chipsets */ + vga_write_CRTC(0x16,p->vertical_blank_end - 1); + + vga_write_CRTC(0x14, /* NTS we write "underline location == 0" */ + (p->dword_mode << 6) | + (p->inc_mem_addr_only_every_4th << 5)); + vga_write_CRTC(0x07,c); /* overflow reg */ + + c2 &= ~(0x9F); /* mask out SD + Max scanline */ + c2 |= (p->scan_double << 7); + c2 |= (p->max_scanline - 1) & 0x1F; + vga_write_CRTC(0x09,c2); + vga_write_CRTC(0x13,p->offset); + vga_write_CRTC(0,(p->horizontal_total - 5)); + vga_write_CRTC(1,(p->horizontal_display_end - 1)); + vga_write_CRTC(2,p->horizontal_blank_start - 1); + vga_write_CRTC(3,((p->horizontal_blank_end - 1) & 0x1F) | (p->horizontal_start_delay_after_total << 5) | 0x80); + vga_write_CRTC(4,p->horizontal_start_retrace); + vga_write_CRTC(5,((((p->horizontal_blank_end - 1) >> 5) & 1) << 7) | (p->horizontal_start_delay_after_retrace << 5) | + (p->horizontal_end_retrace & 0x1F)); + + /* finish by writing reg 0x17 which also enables sync */ + vga_write_CRTC(0x17, + (p->sync_enable << 7) | + (vga_read_CRTC(0x17) & 0x10) | /* NTS: one undocumented bit, perhaps best not to change it */ + ((p->word_mode^1) << 6) | + (p->address_wrap_select << 5) | + (p->memaddr_div2 << 3) | + (p->scanline_div2 << 2) | + ((p->map14 ^ 1) << 1) | + ((p->map13 ^ 1) << 0)); + + /* reinforce write protect */ + c = vga_read_CRTC(0x11); + vga_write_CRTC(0x11,c|0x80); +} + +void vga_read_crtc_mode_(struct vga_mode_params *p) { + unsigned char c,c2; + + if (!(vga_state.vga_flags & VGA_IS_VGA)) + return; + + c = inp(0x3CC); /* misc out reg */ + p->clock_select = (c >> 2) & 3; + p->hsync_neg = (c >> 6) & 1; + p->vsync_neg = (c >> 7) & 1; + + c = vga_read_sequencer(1); + p->clock9 = (c & 1) ^ 1; + p->clock_div2 = (c >> 3) & 1; + p->shift4_enable = (c >> 4) & 1; + p->shift_load_rate = (c >> 2) & 1; + + p->sync_enable = (vga_read_CRTC(0x17) >> 7) & 1; + p->word_mode = ((vga_read_CRTC(0x17) >> 6) & 1) ^ 1; + p->address_wrap_select = (vga_read_CRTC(0x17) >> 5) & 1; + p->memaddr_div2 = (vga_read_CRTC(0x17) >> 3) & 1; + p->scanline_div2 = (vga_read_CRTC(0x17) >> 2) & 1; + p->map14 = ((vga_read_CRTC(0x17) >> 1) & 1) ^ 1; + p->map13 = ((vga_read_CRTC(0x17) >> 0) & 1) ^ 1; + + p->dword_mode = (vga_read_CRTC(0x14) >> 6) & 1; + p->horizontal_total = vga_read_CRTC(0) + 5; + p->horizontal_display_end = vga_read_CRTC(1);// + 1; + p->horizontal_blank_start = vga_read_CRTC(2) + 1; + p->horizontal_blank_end = ((vga_read_CRTC(3) & 0x1F) | ((vga_read_CRTC(5) >> 7) << 5) | + ((p->horizontal_blank_start - 1) & (~0x3F))) + 1; + if (p->horizontal_blank_start >= p->horizontal_blank_end) + p->horizontal_blank_end += 0x40; + p->horizontal_start_retrace = vga_read_CRTC(4); + p->horizontal_end_retrace = (vga_read_CRTC(5) & 0x1F) | + (p->horizontal_start_retrace & (~0x1F)); + if ((p->horizontal_start_retrace&0x1F) >= (p->horizontal_end_retrace&0x1F)) + p->horizontal_end_retrace += 0x20; + p->horizontal_start_delay_after_total = (vga_read_CRTC(3) >> 5) & 3; + p->horizontal_start_delay_after_retrace = (vga_read_CRTC(5) >> 5) & 3; + + c = vga_read_CRTC(7); /* c = overflow reg */ + c2 = vga_read_CRTC(9); + + p->scan_double = (c2 >> 7) & 1; + p->max_scanline = (c2 & 0x1F) + 1; + p->offset = vga_read_CRTC(0x13); + p->vertical_total = (vga_read_CRTC(6) | ((c & 1) << 8) | (((c >> 5) & 1) << 9)) + 2; + p->vertical_start_retrace = (vga_read_CRTC(0x10) | (((c >> 2) & 1) << 8) | (((c >> 7) & 1) << 9)); + p->vertical_end_retrace = (vga_read_CRTC(0x11) & 0xF) | + (p->vertical_start_retrace & (~0xF)); + if ((p->vertical_start_retrace&0xF) >= (p->vertical_end_retrace&0xF)) + p->vertical_end_retrace += 0x10; + p->refresh_cycles_per_scanline = ((vga_read_CRTC(0x11) >> 6) & 1) ? 5 : 3; + p->inc_mem_addr_only_every_4th = (vga_read_CRTC(0x14) >> 5) & 1; + p->vertical_display_end = ((vga_read_CRTC(0x12) | (((c >> 1) & 1) << 8) | (((c >> 6) & 1) << 9))) + 1; + p->vertical_blank_start = ((vga_read_CRTC(0x15) | (((c >> 3) & 1) << 8) | (((c2 >> 5) & 1) << 9))) + 1; + p->vertical_blank_end = ((vga_read_CRTC(0x16) & 0x7F) | ((p->vertical_blank_start - 1) & (~0x7F))) + 1; + if (p->vertical_blank_start >= p->vertical_blank_end) + p->vertical_blank_end += 0x80; }