2 * COPYRIGHT: GPL - See COPYING in the top level directory
3 * PROJECT: ReactOS Virtual DOS Machine
5 * PURPOSE: VGA hardware emulation
6 * PROGRAMMERS: Aleksandar Andrejevic <theflash AT sdf DOT lonestar DOT org>
9 /* INCLUDES *******************************************************************/
16 /* PRIVATE VARIABLES **********************************************************/
18 static CONST DWORD MemoryBase
[] = { 0xA0000, 0xA0000, 0xB0000, 0xB8000 };
19 static CONST DWORD MemoryLimit
[] = { 0xAFFFF, 0xAFFFF, 0xB7FFF, 0xBFFFF };
21 static BYTE VgaMemory
[VGA_NUM_BANKS
* VGA_BANK_SIZE
];
22 static BYTE VgaMiscRegister
;
23 static BYTE VgaSeqIndex
= VGA_SEQ_RESET_REG
;
24 static BYTE VgaSeqRegisters
[VGA_SEQ_MAX_REG
];
25 static BYTE VgaGcIndex
= VGA_GC_RESET_REG
;
26 static BYTE VgaGcRegisters
[VGA_GC_MAX_REG
];
27 static BYTE VgaCrtcIndex
= VGA_CRTC_HORZ_TOTAL_REG
;
28 static BYTE VgaCrtcRegisters
[VGA_CRTC_MAX_REG
];
29 static BYTE VgaAcIndex
= VGA_AC_PAL_0_REG
;
30 static BOOLEAN VgaAcLatch
= FALSE
;
31 static BYTE VgaAcRegisters
[VGA_AC_MAX_REG
];
32 static BYTE VgaDacIndex
= 0;
33 static BOOLEAN VgaDacReadWrite
= FALSE
;
34 static BYTE VgaDacRegisters
[VGA_PALETTE_SIZE
];
35 static BOOLEAN InVerticalRetrace
= FALSE
;
36 static BOOLEAN InHorizontalRetrace
= FALSE
;
37 static HANDLE TextConsoleBuffer
= NULL
;
38 static HANDLE GraphicsConsoleBuffer
= NULL
;
39 static LPVOID ConsoleFramebuffer
= NULL
;
40 static HANDLE ConsoleMutex
= NULL
;
41 static BOOLEAN NeedsUpdate
= FALSE
;
42 static BOOLEAN ModeChanged
= TRUE
;
43 static BOOLEAN CursorMoved
= FALSE
;
44 static BOOLEAN TextMode
= TRUE
;
45 static SMALL_RECT UpdateRectangle
= { 0, 0, 0, 0 };
47 /* PRIVATE FUNCTIONS **********************************************************/
49 static inline INT
VgaGetAddressSize(VOID
)
51 if (VgaCrtcRegisters
[VGA_CRTC_UNDERLINE_REG
] & VGA_CRTC_UNDERLINE_DWORD
)
53 /* Double-word addressing */
57 if (VgaCrtcRegisters
[VGA_CRTC_MODE_CONTROL_REG
] & VGA_CRTC_MODE_CONTROL_BYTE
)
67 static inline DWORD
VgaTranslateReadAddress(DWORD Address
)
69 DWORD Offset
= Address
- VgaGetVideoBaseAddress();
72 /* Check for chain-4 and odd-even mode */
73 if (VgaSeqRegisters
[VGA_SEQ_MEM_REG
] & VGA_SEQ_MEM_C4
)
75 /* The lowest two bits are the plane number */
79 else if (VgaGcRegisters
[VGA_GC_MODE_REG
] & VGA_GC_MODE_OE
)
81 /* The LSB is the plane number */
87 /* Use the read mode */
88 Plane
= VgaGcRegisters
[VGA_GC_READ_MAP_SEL_REG
] & 0x03;
91 /* Multiply the offset by the address size */
92 Offset
*= VgaGetAddressSize();
94 return Offset
+ Plane
* VGA_BANK_SIZE
;
97 static inline DWORD
VgaTranslateWriteAddress(DWORD Address
)
99 DWORD Offset
= Address
- VgaGetVideoBaseAddress();
101 /* Check for chain-4 and odd-even mode */
102 if (VgaSeqRegisters
[VGA_SEQ_MEM_REG
] & VGA_SEQ_MEM_C4
)
104 /* Shift the offset to the right by 2 */
107 else if (VgaGcRegisters
[VGA_GC_MODE_REG
] & VGA_GC_MODE_OE
)
109 /* Shift the offset to the right by 1 */
113 /* Multiply the offset by the address size */
114 Offset
*= VgaGetAddressSize();
116 /* Return the offset on plane 0 */
120 static inline VOID
VgaMarkForUpdate(SHORT Row
, SHORT Column
)
122 DPRINT("VgaMarkForUpdate: Row %d, Column %d\n", Row
, Column
);
124 /* Check if this is the first time the rectangle is updated */
127 UpdateRectangle
.Left
= UpdateRectangle
.Top
= SHRT_MAX
;
128 UpdateRectangle
.Right
= UpdateRectangle
.Bottom
= SHRT_MIN
;
131 /* Expand the rectangle to include the point */
132 UpdateRectangle
.Left
= min(UpdateRectangle
.Left
, Column
);
133 UpdateRectangle
.Right
= max(UpdateRectangle
.Right
, Column
);
134 UpdateRectangle
.Top
= min(UpdateRectangle
.Top
, Row
);
135 UpdateRectangle
.Bottom
= max(UpdateRectangle
.Bottom
, Row
);
137 /* Set the update request flag */
141 static VOID
VgaWriteSequencer(BYTE Data
)
143 ASSERT(VgaSeqIndex
< VGA_SEQ_MAX_REG
);
146 VgaSeqRegisters
[VgaSeqIndex
] = Data
;
149 static VOID
VgaWriteGc(BYTE Data
)
151 ASSERT(VgaGcIndex
< VGA_GC_MAX_REG
);
154 VgaGcRegisters
[VgaGcIndex
] = Data
;
156 /* Check the index */
159 case VGA_GC_MISC_REG
:
161 /* The GC misc register decides if it's text or graphics mode */
169 static VOID
VgaWriteCrtc(BYTE Data
)
171 ASSERT(VgaGcIndex
< VGA_CRTC_MAX_REG
);
174 VgaCrtcRegisters
[VgaCrtcIndex
] = Data
;
176 /* Check the index */
177 switch (VgaCrtcIndex
)
179 case VGA_CRTC_END_HORZ_DISP_REG
:
180 case VGA_CRTC_VERT_DISP_END_REG
:
181 case VGA_CRTC_OVERFLOW_REG
:
183 /* The video mode has changed */
189 case VGA_CRTC_CURSOR_LOC_LOW_REG
:
190 case VGA_CRTC_CURSOR_LOC_HIGH_REG
:
191 case VGA_CRTC_CURSOR_START_REG
:
192 case VGA_CRTC_CURSOR_END_REG
:
194 /* Set the cursor moved flag */
202 static VOID
VgaWriteDac(BYTE Data
)
205 VgaDacRegisters
[VgaDacIndex
++] = Data
;
206 VgaDacIndex
%= VGA_PALETTE_SIZE
;
208 // TODO: Change the palette!
211 static VOID
VgaWriteAc(BYTE Data
)
213 ASSERT(VgaAcIndex
< VGA_AC_MAX_REG
);
216 VgaAcRegisters
[VgaAcIndex
] = Data
;
219 static BOOL
VgaEnterGraphicsMode(PCOORD Resolution
)
222 CONSOLE_GRAPHICS_BUFFER_INFO GraphicsBufferInfo
;
223 BYTE BitmapInfoBuffer
[VGA_BITMAP_INFO_SIZE
];
224 LPBITMAPINFO BitmapInfo
= (LPBITMAPINFO
)BitmapInfoBuffer
;
225 LPWORD PaletteIndex
= (LPWORD
)(BitmapInfoBuffer
+ sizeof(BITMAPINFOHEADER
));
227 /* Fill the bitmap info header */
228 ZeroMemory(&BitmapInfo
->bmiHeader
, sizeof(BITMAPINFOHEADER
));
229 BitmapInfo
->bmiHeader
.biSize
= sizeof(BITMAPINFOHEADER
);
230 BitmapInfo
->bmiHeader
.biWidth
= Resolution
->X
;
231 BitmapInfo
->bmiHeader
.biHeight
= Resolution
->Y
;
232 BitmapInfo
->bmiHeader
.biBitCount
= 8;
233 BitmapInfo
->bmiHeader
.biPlanes
= 1;
234 BitmapInfo
->bmiHeader
.biCompression
= BI_RGB
;
235 BitmapInfo
->bmiHeader
.biSizeImage
= Resolution
->X
* Resolution
->Y
;
237 /* Fill the palette data */
238 for (i
= 0; i
< (VGA_PALETTE_SIZE
/ 3); i
++) PaletteIndex
[i
] = (WORD
)i
;
240 /* Fill the console graphics buffer info */
241 GraphicsBufferInfo
.dwBitMapInfoLength
= VGA_BITMAP_INFO_SIZE
;
242 GraphicsBufferInfo
.lpBitMapInfo
= BitmapInfo
;
243 GraphicsBufferInfo
.dwUsage
= DIB_PAL_COLORS
;
245 /* Create the buffer */
246 GraphicsConsoleBuffer
= CreateConsoleScreenBuffer(GENERIC_READ
| GENERIC_WRITE
,
247 FILE_SHARE_READ
| FILE_SHARE_WRITE
,
249 CONSOLE_GRAPHICS_BUFFER
,
250 &GraphicsBufferInfo
);
251 if (GraphicsConsoleBuffer
== INVALID_HANDLE_VALUE
) return FALSE
;
253 /* Save the framebuffer address and mutex */
254 ConsoleFramebuffer
= GraphicsBufferInfo
.lpBitMap
;
255 ConsoleMutex
= GraphicsBufferInfo
.hMutex
;
257 /* Set the active buffer */
258 SetConsoleActiveScreenBuffer(GraphicsConsoleBuffer
);
263 static VOID
VgaLeaveGraphicsMode(VOID
)
265 /* Switch back to the text buffer */
266 SetConsoleActiveScreenBuffer(TextConsoleBuffer
);
268 /* Cleanup the video data */
269 CloseHandle(ConsoleMutex
);
270 CloseHandle(GraphicsConsoleBuffer
);
271 GraphicsConsoleBuffer
= NULL
;
274 static BOOL
VgaEnterTextMode(PCOORD Resolution
)
276 /* Resize the console */
277 SetConsoleScreenBufferSize(TextConsoleBuffer
, *Resolution
);
279 /* Allocate a framebuffer */
280 ConsoleFramebuffer
= HeapAlloc(GetProcessHeap(),
282 Resolution
->X
* Resolution
->Y
283 * sizeof(CHAR_INFO
));
284 if (ConsoleFramebuffer
== NULL
)
286 DisplayMessage(L
"An unexpected error occurred!\n");
294 static VOID
VgaLeaveTextMode(VOID
)
296 /* Free the old framebuffer */
297 HeapFree(GetProcessHeap(), 0, ConsoleFramebuffer
);
298 ConsoleFramebuffer
= NULL
;
301 static VOID
VgaUpdateMode(VOID
)
303 COORD Resolution
= VgaGetDisplayResolution();
307 /* Leave the current graphics mode */
308 VgaLeaveGraphicsMode();
312 /* Leave the current text mode */
316 /* Check if the new mode is alphanumeric */
317 if (!(VgaGcRegisters
[VGA_GC_MISC_REG
] & VGA_GC_MISC_NOALPHA
))
319 /* Enter new text mode */
320 if (!VgaEnterTextMode(&Resolution
)) return;
322 /* Set the text mode flag */
327 /* Enter 8-bit graphics mode */
328 if (!VgaEnterGraphicsMode(&Resolution
)) return;
330 /* Clear the text mode flag */
334 /* Perform a full update */
336 UpdateRectangle
.Left
= 0;
337 UpdateRectangle
.Top
= 0;
338 UpdateRectangle
.Right
= Resolution
.X
;
339 UpdateRectangle
.Bottom
= Resolution
.Y
;
342 static VOID
VgaUpdateFramebuffer(VOID
)
345 COORD Resolution
= VgaGetDisplayResolution();
346 INT AddressSize
= VgaGetAddressSize();
347 DWORD Address
= (VgaCrtcRegisters
[VGA_CRTC_START_ADDR_HIGH_REG
] << 8)
348 + VgaCrtcRegisters
[VGA_CRTC_START_ADDR_LOW_REG
];
349 DWORD ScanlineSize
= (DWORD
)VgaCrtcRegisters
[VGA_CRTC_OFFSET_REG
] * 2;
350 PCHAR_INFO CharBuffer
= (PCHAR_INFO
)ConsoleFramebuffer
;
351 PBYTE GraphicsBuffer
= (PBYTE
)ConsoleFramebuffer
;
353 /* Loop through the scanlines */
354 for (i
= 0; i
< Resolution
.Y
; i
++)
356 /* Check if this is text mode or graphics mode */
357 if (VgaGcRegisters
[VGA_GC_MISC_REG
] & VGA_GC_MISC_NOALPHA
)
361 /* Loop through the pixels */
362 for (j
= 0; j
< Resolution
.X
; j
++)
366 /* Check the shifting mode */
367 if (VgaGcRegisters
[VGA_GC_MODE_REG
] & VGA_GC_MODE_SHIFT256
)
369 /* 4 bits shifted from each plane */
371 /* Check if this is 16 or 256 color mode */
372 if (VgaAcRegisters
[VGA_AC_CONTROL_REG
] & VGA_AC_CONTROL_8BIT
)
374 /* One byte per pixel */
375 PixelData
= VgaMemory
[(j
% VGA_NUM_BANKS
) * VGA_BANK_SIZE
376 + (Address
+ (j
/ VGA_NUM_BANKS
))
381 /* 4-bits per pixel */
383 PixelData
= VgaMemory
[(j
% VGA_NUM_BANKS
) * VGA_BANK_SIZE
384 + (Address
+ (j
/ (VGA_NUM_BANKS
* 2)))
387 /* Check if we should use the highest 4 bits or lowest 4 */
388 if (((j
/ VGA_NUM_BANKS
) % 2) == 0)
400 else if (VgaGcRegisters
[VGA_GC_MODE_REG
] & VGA_GC_MODE_SHIFTREG
)
403 * 2 bits shifted from plane 0 and 2 for the first 4 pixels,
404 * then 2 bits shifted from plane 1 and 3 for the next 4
407 // TODO: NOT IMPLEMENTED!
408 DPRINT1("Interleaved shift mode is not implemented!\n");
412 /* 1 bit shifted from each plane */
414 /* Check if this is 16 or 256 color mode */
415 if (VgaAcRegisters
[VGA_AC_CONTROL_REG
] & VGA_AC_CONTROL_8BIT
)
417 /* 8 bits per pixel, 2 on each plane */
419 for (k
= 0; k
< VGA_NUM_BANKS
; k
++)
421 /* The data is on plane k, 4 pixels per byte */
422 BYTE PlaneData
= VgaMemory
[k
* VGA_BANK_SIZE
423 + (Address
+ (j
/ 4)) * AddressSize
];
425 /* The mask of the first bit in the pair */
426 BYTE BitMask
= 1 << (((3 - (j
% 4)) * 2) + 1);
428 /* Bits 0, 1, 2 and 3 come from the first bit of the pair */
429 if (PlaneData
& BitMask
) PixelData
|= 1 << k
;
431 /* Bits 4, 5, 6 and 7 come from the second bit of the pair */
432 if (PlaneData
& (BitMask
>> 1)) PixelData
|= 1 << (k
+ 4);
437 /* 4 bits per pixel, 1 on each plane */
439 for (k
= 0; k
< VGA_NUM_BANKS
; k
++)
441 BYTE PlaneData
= VgaMemory
[k
* VGA_BANK_SIZE
442 + (Address
+ (j
/ 8)) * AddressSize
];
444 /* If the bit on that plane is set, set it */
445 if (PlaneData
& (1 << (7 - (j
% 8)))) PixelData
|= 1 << k
;
450 /* Now check if the resulting pixel data has changed */
451 if (GraphicsBuffer
[i
* Resolution
.X
+ j
] != PixelData
)
453 /* Yes, write the new value */
454 GraphicsBuffer
[i
* Resolution
.X
+ j
] = PixelData
;
456 /* Mark the specified pixel as changed */
457 VgaMarkForUpdate(i
, j
);
465 /* Loop through the characters */
466 for (j
= 0; j
< Resolution
.X
; j
++)
468 DWORD CurrentAddr
= LOWORD((Address
+ j
) * AddressSize
);
471 /* Plane 0 holds the character itself */
472 CharInfo
.Char
.AsciiChar
= VgaMemory
[CurrentAddr
];
474 /* Plane 1 holds the attribute */
475 CharInfo
.Attributes
= VgaMemory
[CurrentAddr
+ VGA_BANK_SIZE
];
477 /* Now check if the resulting character data has changed */
478 if ((CharBuffer
[i
* Resolution
.X
+ j
].Char
.AsciiChar
!= CharInfo
.Char
.AsciiChar
)
479 || (CharBuffer
[i
* Resolution
.X
+ j
].Attributes
!= CharInfo
.Attributes
))
481 /* Yes, write the new value */
482 CharBuffer
[i
* Resolution
.X
+ j
] = CharInfo
;
484 /* Mark the specified pixel as changed */
485 VgaMarkForUpdate(i
, j
);
490 /* Move to the next scanline */
491 Address
+= ScanlineSize
;
495 static VOID
VgaUpdateTextCursor(VOID
)
498 CONSOLE_CURSOR_INFO CursorInfo
;
499 BYTE CursorStart
= VgaCrtcRegisters
[VGA_CRTC_CURSOR_START_REG
] & 0x3F;
500 BYTE CursorEnd
= VgaCrtcRegisters
[VGA_CRTC_CURSOR_END_REG
] & 0x1F;
501 DWORD ScanlineSize
= (DWORD
)VgaCrtcRegisters
[VGA_CRTC_OFFSET_REG
] * 2;
502 WORD Location
= MAKEWORD(VgaCrtcRegisters
[VGA_CRTC_CURSOR_LOC_LOW_REG
],
503 VgaCrtcRegisters
[VGA_CRTC_CURSOR_LOC_HIGH_REG
]);
505 if (CursorStart
< CursorEnd
)
508 CursorInfo
.bVisible
= TRUE
;
509 CursorInfo
.dwSize
= (100 * (CursorEnd
- CursorStart
)) >> 5;
514 CursorInfo
.bVisible
= FALSE
;
515 CursorInfo
.dwSize
= 0;
518 /* Add the cursor skew to the location */
519 Location
+= (VgaCrtcRegisters
[VGA_CRTC_CURSOR_END_REG
] >> 5) & 3;
521 /* Find the coordinates of the new position */
522 Position
.X
= (WORD
)(Location
% ScanlineSize
);
523 Position
.Y
= (WORD
)(Location
/ ScanlineSize
);
525 /* Update the physical cursor */
526 SetConsoleCursorInfo(TextConsoleBuffer
, &CursorInfo
);
527 SetConsoleCursorPosition(TextConsoleBuffer
, Position
);
530 /* PUBLIC FUNCTIONS ***********************************************************/
532 DWORD
VgaGetVideoBaseAddress(VOID
)
534 return MemoryBase
[(VgaGcRegisters
[VGA_GC_MISC_REG
] >> 2) & 0x03];
537 DWORD
VgaGetVideoLimitAddress(VOID
)
539 return MemoryLimit
[(VgaGcRegisters
[VGA_GC_MISC_REG
] >> 2) & 0x03];
542 COORD
VgaGetDisplayResolution(VOID
)
546 /* The low 8 bits are in the display registers */
547 Resolution
.X
= VgaCrtcRegisters
[VGA_CRTC_END_HORZ_DISP_REG
];
548 Resolution
.Y
= VgaCrtcRegisters
[VGA_CRTC_VERT_DISP_END_REG
];
550 /* Set the top bits from the overflow register */
551 if (VgaCrtcRegisters
[VGA_CRTC_OVERFLOW_REG
] & VGA_CRTC_OVERFLOW_VDE8
)
553 Resolution
.Y
|= 1 << 8;
555 if (VgaCrtcRegisters
[VGA_CRTC_OVERFLOW_REG
] & VGA_CRTC_OVERFLOW_VDE9
)
557 Resolution
.Y
|= 1 << 9;
560 /* Increase the values by 1 */
564 if (VgaGcRegisters
[VGA_GC_MISC_REG
] & VGA_GC_MISC_NOALPHA
)
566 /* Multiply the horizontal resolution by the 9/8 dot mode */
567 Resolution
.X
*= (VgaSeqRegisters
[VGA_SEQ_CLOCK_REG
] & VGA_SEQ_CLOCK_98DM
)
570 /* The horizontal resolution is halved in 8-bit mode */
571 if (VgaAcRegisters
[VGA_AC_CONTROL_REG
] & VGA_AC_CONTROL_8BIT
) Resolution
.X
/= 2;
573 /* Divide the vertical resolution by the maximum scan line */
574 Resolution
.Y
/= ((DWORD
)VgaCrtcRegisters
[VGA_CRTC_MAX_SCAN_LINE_REG
] & 0x1F) + 1;
578 /* Divide the number of scanlines by the font size */
582 /* Return the resolution */
586 VOID
VgaRefreshDisplay(VOID
)
588 COORD Resolution
= VgaGetDisplayResolution();
590 DPRINT("VgaRefreshDisplay\n");
594 /* Change the display mode */
597 /* Reset the mode change flag */
603 /* Change the text cursor location */
604 VgaUpdateTextCursor();
606 /* Reset the cursor move flag */
610 /* Update the contents of the framebuffer */
611 VgaUpdateFramebuffer();
613 /* Set the vertical retrace flag */
614 InVerticalRetrace
= TRUE
;
616 /* Ignore if there's nothing to update */
617 if (!NeedsUpdate
) return;
619 DPRINT("Updating screen rectangle (%d, %d, %d, %d)\n",
620 UpdateRectangle
.Left
,
622 UpdateRectangle
.Right
,
623 UpdateRectangle
.Bottom
);
625 /* Check if this is text mode or graphics mode */
626 if (VgaGcRegisters
[VGA_GC_MISC_REG
] & VGA_GC_MISC_NOALPHA
)
630 /* Redraw the screen */
631 InvalidateConsoleDIBits(GraphicsConsoleBuffer
, &UpdateRectangle
);
636 COORD Origin
= { UpdateRectangle
.Left
, UpdateRectangle
.Top
};
638 /* Write the data to the console */
639 WriteConsoleOutputA(TextConsoleBuffer
,
640 (PCHAR_INFO
)ConsoleFramebuffer
,
647 /* Clear the update flag */
651 VOID
VgaHorizontalRetrace(VOID
)
654 InHorizontalRetrace
= TRUE
;
657 VOID
VgaReadMemory(DWORD Address
, LPBYTE Buffer
, DWORD Size
)
662 DPRINT("VgaReadMemory: Address 0x%08X, Size %lu\n",
666 /* Ignore if video RAM access is disabled */
667 if (!(VgaMiscRegister
& VGA_MISC_RAM_ENABLED
)) return;
669 /* Loop through each byte */
670 for (i
= 0; i
< Size
; i
++)
672 VideoAddress
= VgaTranslateReadAddress(Address
+ i
);
674 /* Copy the value to the buffer */
675 Buffer
[i
] = VgaMemory
[VideoAddress
];
679 VOID
VgaWriteMemory(DWORD Address
, LPBYTE Buffer
, DWORD Size
)
684 DPRINT("VgaWriteMemory: Address 0x%08X, Size %lu\n",
688 /* Ignore if video RAM access is disabled */
689 if (!(VgaMiscRegister
& VGA_MISC_RAM_ENABLED
)) return;
691 /* Also ignore if write access to all planes is disabled */
692 if ((VgaSeqRegisters
[VGA_SEQ_MASK_REG
] & 0x0F) == 0x00) return;
694 /* Loop through each byte */
695 for (i
= 0; i
< Size
; i
++)
697 VideoAddress
= VgaTranslateWriteAddress(Address
+ i
);
699 for (j
= 0; j
< VGA_NUM_BANKS
; j
++)
701 /* Make sure the page is writeable */
702 if (!(VgaSeqRegisters
[VGA_SEQ_MASK_REG
] & (1 << j
))) continue;
704 /* Check if this is chain-4 mode */
705 if (VgaSeqRegisters
[VGA_SEQ_MEM_REG
] & VGA_SEQ_MEM_C4
)
707 if (((Address
+ i
) & 3) != j
)
709 /* This plane will not be accessed */
714 /* Check if this is odd-even mode */
715 if (VgaGcRegisters
[VGA_GC_MODE_REG
] & VGA_GC_MODE_OE
)
717 if (((Address
+ i
) & 1) != (j
& 1))
719 /* This plane will not be accessed */
724 /* Copy the value to the VGA memory */
725 VgaMemory
[VideoAddress
+ j
* VGA_BANK_SIZE
] = Buffer
[i
];
730 BYTE
VgaReadPort(WORD Port
)
732 DPRINT("VgaReadPort: Port 0x%04X\n", Port
);
743 return VgaAcRegisters
[VgaAcIndex
];
753 return VgaSeqRegisters
[VgaSeqIndex
];
756 case VGA_DAC_READ_INDEX
:
758 /* This returns the read/write state */
759 return VgaDacReadWrite
? 0 : 3;
762 case VGA_DAC_WRITE_INDEX
:
769 /* Ignore reads in write mode */
770 if (!VgaDacReadWrite
)
772 BYTE Data
= VgaDacRegisters
[VgaDacIndex
++];
773 VgaDacIndex
%= VGA_PALETTE_SIZE
;
782 return VgaMiscRegister
;
792 return VgaCrtcRegisters
[VgaCrtcIndex
];
802 return VgaGcRegisters
[VgaGcIndex
];
810 /* Reset the AC latch */
813 /* Set a flag if there is a vertical or horizontal retrace */
814 if (InVerticalRetrace
|| InHorizontalRetrace
) Result
|= VGA_STAT_DD
;
816 /* Set an additional flag if there was a vertical retrace */
817 if (InVerticalRetrace
) Result
|= VGA_STAT_VRETRACE
;
819 /* Clear the flags */
820 InHorizontalRetrace
= InVerticalRetrace
= FALSE
;
829 VOID
VgaWritePort(WORD Port
, BYTE Data
)
831 DPRINT("VgaWritePort: Port 0x%04X, Data 0x%02X\n", Port
, Data
);
839 /* Change the index */
840 if (Data
< VGA_AC_MAX_REG
) VgaAcIndex
= Data
;
848 /* Toggle the latch */
849 VgaAcLatch
= !VgaAcLatch
;
856 /* Set the sequencer index register */
857 if (Data
< VGA_SEQ_MAX_REG
) VgaSeqIndex
= Data
;
864 /* Call the sequencer function */
865 VgaWriteSequencer(Data
);
870 case VGA_DAC_READ_INDEX
:
872 VgaDacReadWrite
= FALSE
;
873 VgaDacIndex
= Data
% VGA_PALETTE_SIZE
;
878 case VGA_DAC_WRITE_INDEX
:
880 VgaDacReadWrite
= TRUE
;
881 VgaDacIndex
= Data
% VGA_PALETTE_SIZE
;
888 /* Ignore writes in read mode */
889 if (VgaDacReadWrite
) VgaWriteDac(Data
& 0x3F);
896 VgaMiscRegister
= Data
;
903 /* Set the CRTC index register */
904 if (Data
< VGA_CRTC_MAX_REG
) VgaCrtcIndex
= Data
;
911 /* Call the CRTC function */
919 /* Set the GC index register */
920 if (Data
< VGA_GC_MAX_REG
) VgaGcIndex
= Data
;
926 /* Call the GC function */
934 VOID
VgaInitialize(HANDLE TextHandle
)
940 COORD Origin
= { 0, 0 };
941 SMALL_RECT ScreenRect
;
942 PCHAR_INFO CharBuffer
;
946 /* Set the global handle */
947 TextConsoleBuffer
= TextHandle
;
949 /* Set the default video mode */
950 BiosSetVideoMode(BIOS_DEFAULT_VIDEO_MODE
);
955 Resolution
= VgaGetDisplayResolution();
956 CharBuffer
= (PCHAR_INFO
)ConsoleFramebuffer
;
957 AddressSize
= VgaGetAddressSize();
958 ScreenRect
.Left
= ScreenRect
.Top
= 0;
959 ScreenRect
.Right
= Resolution
.X
;
960 ScreenRect
.Bottom
= Resolution
.Y
;
961 ScanlineSize
= (DWORD
)VgaCrtcRegisters
[VGA_CRTC_OFFSET_REG
] * 2;
963 /* Read the data from the console into the framebuffer */
964 ReadConsoleOutputA(TextConsoleBuffer
,
970 /* Loop through the scanlines */
971 for (i
= 0; i
< Resolution
.Y
; i
++)
973 /* Loop through the characters */
974 for (j
= 0; j
< Resolution
.X
; j
++)
976 CurrentAddr
= LOWORD((Address
+ j
) * AddressSize
);
978 /* Store the character in plane 0 */
979 VgaMemory
[CurrentAddr
] = CharBuffer
[i
* Resolution
.X
+ j
].Char
.AsciiChar
;
981 /* Store the attribute in plane 1 */
982 VgaMemory
[CurrentAddr
+ VGA_BANK_SIZE
] = (BYTE
)CharBuffer
[i
* Resolution
.X
+ j
].Attributes
;
985 /* Move to the next scanline */
986 Address
+= ScanlineSize
;