projects / reactos.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
[NTVDM]
[reactos.git] / reactos / subsystems / mvdm / ntvdm / hardware / video / vga.c
1 /*
2 * COPYRIGHT: GPL - See COPYING in the top level directory
3 * PROJECT: ReactOS Virtual DOS Machine
4 * FILE: vga.c
5 * PURPOSE: VGA hardware emulation
6 * PROGRAMMERS: Aleksandar Andrejevic <theflash AT sdf DOT lonestar DOT org>
7 */
8
9 /* INCLUDES *******************************************************************/
10
11 #define NDEBUG
12
13 #include "ntvdm.h"
14 #include "emulator.h"
15 #include "vga.h"
16 #include <bios/vidbios.h>
17
18 #include "memory.h"
19 #include "io.h"
20 #include "clock.h"
21
22 /* PRIVATE VARIABLES **********************************************************/
23
24 static CONST DWORD MemoryBase[] = { 0xA0000, 0xA0000, 0xB0000, 0xB8000 };
25 static CONST DWORD MemoryLimit[] = { 0xBFFFF, 0xAFFFF, 0xB7FFF, 0xBFFFF };
26
27 /*
28 * Activate this line if you want to use the real
29 * RegisterConsoleVDM API of ReactOS/Windows.
30 */
31 // #define USE_REAL_REGISTERCONSOLEVDM
32
33 #define USE_REACTOS_COLORS
34 // #define USE_DOSBOX_COLORS
35
36 #if defined(USE_REACTOS_COLORS)
37
38 // ReactOS colors
39 static CONST COLORREF VgaDefaultPalette[VGA_MAX_COLORS] =
40 {
41 RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0xAA), RGB(0x00, 0xAA, 0x00), RGB(0x00, 0xAA, 0xAA),
42 RGB(0xAA, 0x00, 0x00), RGB(0xAA, 0x00, 0xAA), RGB(0xAA, 0x55, 0x00), RGB(0xAA, 0xAA, 0xAA),
43 RGB(0x55, 0x55, 0x55), RGB(0x55, 0x55, 0xFF), RGB(0x55, 0xFF, 0x55), RGB(0x55, 0xFF, 0xFF),
44 RGB(0xFF, 0x55, 0x55), RGB(0xFF, 0x55, 0xFF), RGB(0xFF, 0xFF, 0x55), RGB(0xFF, 0xFF, 0xFF),
45 RGB(0x00, 0x00, 0x00), RGB(0x10, 0x10, 0x10), RGB(0x20, 0x20, 0x20), RGB(0x35, 0x35, 0x35),
46 RGB(0x45, 0x45, 0x45), RGB(0x55, 0x55, 0x55), RGB(0x65, 0x65, 0x65), RGB(0x75, 0x75, 0x75),
47 RGB(0x8A, 0x8A, 0x8A), RGB(0x9A, 0x9A, 0x9A), RGB(0xAA, 0xAA, 0xAA), RGB(0xBA, 0xBA, 0xBA),
48 RGB(0xCA, 0xCA, 0xCA), RGB(0xDF, 0xDF, 0xDF), RGB(0xEF, 0xEF, 0xEF), RGB(0xFF, 0xFF, 0xFF),
49 RGB(0x00, 0x00, 0xFF), RGB(0x41, 0x00, 0xFF), RGB(0x82, 0x00, 0xFF), RGB(0xBE, 0x00, 0xFF),
50 RGB(0xFF, 0x00, 0xFF), RGB(0xFF, 0x00, 0xBE), RGB(0xFF, 0x00, 0x82), RGB(0xFF, 0x00, 0x41),
51 RGB(0xFF, 0x00, 0x00), RGB(0xFF, 0x41, 0x00), RGB(0xFF, 0x82, 0x00), RGB(0xFF, 0xBE, 0x00),
52 RGB(0xFF, 0xFF, 0x00), RGB(0xBE, 0xFF, 0x00), RGB(0x82, 0xFF, 0x00), RGB(0x41, 0xFF, 0x00),
53 RGB(0x00, 0xFF, 0x00), RGB(0x00, 0xFF, 0x41), RGB(0x00, 0xFF, 0x82), RGB(0x00, 0xFF, 0xBE),
54 RGB(0x00, 0xFF, 0xFF), RGB(0x00, 0xBE, 0xFF), RGB(0x00, 0x82, 0xFF), RGB(0x00, 0x41, 0xFF),
55 RGB(0x82, 0x82, 0xFF), RGB(0x9E, 0x82, 0xFF), RGB(0xBE, 0x82, 0xFF), RGB(0xDF, 0x82, 0xFF),
56 RGB(0xFF, 0x82, 0xFF), RGB(0xFF, 0x82, 0xDF), RGB(0xFF, 0x82, 0xBE), RGB(0xFF, 0x82, 0x9E),
57 RGB(0xFF, 0x82, 0x82), RGB(0xFF, 0x9E, 0x82), RGB(0xFF, 0xBE, 0x82), RGB(0xFF, 0xDF, 0x82),
58 RGB(0xFF, 0xFF, 0x82), RGB(0xDF, 0xFF, 0x82), RGB(0xBE, 0xFF, 0x82), RGB(0x9E, 0xFF, 0x82),
59 RGB(0x82, 0xFF, 0x82), RGB(0x82, 0xFF, 0x9E), RGB(0x82, 0xFF, 0xBE), RGB(0x82, 0xFF, 0xDF),
60 RGB(0x82, 0xFF, 0xFF), RGB(0x82, 0xDF, 0xFF), RGB(0x82, 0xBE, 0xFF), RGB(0x82, 0x9E, 0xFF),
61 RGB(0xBA, 0xBA, 0xFF), RGB(0xCA, 0xBA, 0xFF), RGB(0xDF, 0xBA, 0xFF), RGB(0xEF, 0xBA, 0xFF),
62 RGB(0xFF, 0xBA, 0xFF), RGB(0xFF, 0xBA, 0xEF), RGB(0xFF, 0xBA, 0xDF), RGB(0xFF, 0xBA, 0xCA),
63 RGB(0xFF, 0xBA, 0xBA), RGB(0xFF, 0xCA, 0xBA), RGB(0xFF, 0xDF, 0xBA), RGB(0xFF, 0xEF, 0xBA),
64 RGB(0xFF, 0xFF, 0xBA), RGB(0xEF, 0xFF, 0xBA), RGB(0xDF, 0xFF, 0xBA), RGB(0xCA, 0xFF, 0xBA),
65 RGB(0xBA, 0xFF, 0xBA), RGB(0xBA, 0xFF, 0xCA), RGB(0xBA, 0xFF, 0xDF), RGB(0xBA, 0xFF, 0xEF),
66 RGB(0xBA, 0xFF, 0xFF), RGB(0xBA, 0xEF, 0xFF), RGB(0xBA, 0xDF, 0xFF), RGB(0xBA, 0xCA, 0xFF),
67 RGB(0x00, 0x00, 0x71), RGB(0x1C, 0x00, 0x71), RGB(0x39, 0x00, 0x71), RGB(0x55, 0x00, 0x71),
68 RGB(0x71, 0x00, 0x71), RGB(0x71, 0x00, 0x55), RGB(0x71, 0x00, 0x39), RGB(0x71, 0x00, 0x1C),
69 RGB(0x71, 0x00, 0x00), RGB(0x71, 0x1C, 0x00), RGB(0x71, 0x39, 0x00), RGB(0x71, 0x55, 0x00),
70 RGB(0x71, 0x71, 0x00), RGB(0x55, 0x71, 0x00), RGB(0x39, 0x71, 0x00), RGB(0x1C, 0x71, 0x00),
71 RGB(0x00, 0x71, 0x00), RGB(0x00, 0x71, 0x1C), RGB(0x00, 0x71, 0x39), RGB(0x00, 0x71, 0x55),
72 RGB(0x00, 0x71, 0x71), RGB(0x00, 0x55, 0x71), RGB(0x00, 0x39, 0x71), RGB(0x00, 0x1C, 0x71),
73 RGB(0x39, 0x39, 0x71), RGB(0x45, 0x39, 0x71), RGB(0x55, 0x39, 0x71), RGB(0x61, 0x39, 0x71),
74 RGB(0x71, 0x39, 0x71), RGB(0x71, 0x39, 0x61), RGB(0x71, 0x39, 0x55), RGB(0x71, 0x39, 0x45),
75 RGB(0x71, 0x39, 0x39), RGB(0x71, 0x45, 0x39), RGB(0x71, 0x55, 0x39), RGB(0x71, 0x61, 0x39),
76 RGB(0x71, 0x71, 0x39), RGB(0x61, 0x71, 0x39), RGB(0x55, 0x71, 0x39), RGB(0x45, 0x71, 0x39),
77 RGB(0x39, 0x71, 0x39), RGB(0x39, 0x71, 0x45), RGB(0x39, 0x71, 0x55), RGB(0x39, 0x71, 0x61),
78 RGB(0x39, 0x71, 0x71), RGB(0x39, 0x61, 0x71), RGB(0x39, 0x55, 0x71), RGB(0x39, 0x45, 0x71),
79 RGB(0x51, 0x51, 0x71), RGB(0x59, 0x51, 0x71), RGB(0x61, 0x51, 0x71), RGB(0x69, 0x51, 0x71),
80 RGB(0x71, 0x51, 0x71), RGB(0x71, 0x51, 0x69), RGB(0x71, 0x51, 0x61), RGB(0x71, 0x51, 0x59),
81 RGB(0x71, 0x51, 0x51), RGB(0x71, 0x59, 0x51), RGB(0x71, 0x61, 0x51), RGB(0x71, 0x69, 0x51),
82 RGB(0x71, 0x71, 0x51), RGB(0x69, 0x71, 0x51), RGB(0x61, 0x71, 0x51), RGB(0x59, 0x71, 0x51),
83 RGB(0x51, 0x71, 0x51), RGB(0x51, 0x71, 0x59), RGB(0x51, 0x71, 0x61), RGB(0x51, 0x71, 0x69),
84 RGB(0x51, 0x71, 0x71), RGB(0x51, 0x69, 0x71), RGB(0x51, 0x61, 0x71), RGB(0x51, 0x59, 0x71),
85 RGB(0x00, 0x00, 0x41), RGB(0x10, 0x00, 0x41), RGB(0x20, 0x00, 0x41), RGB(0x31, 0x00, 0x41),
86 RGB(0x41, 0x00, 0x41), RGB(0x41, 0x00, 0x31), RGB(0x41, 0x00, 0x20), RGB(0x41, 0x00, 0x10),
87 RGB(0x41, 0x00, 0x00), RGB(0x41, 0x10, 0x00), RGB(0x41, 0x20, 0x00), RGB(0x41, 0x31, 0x00),
88 RGB(0x41, 0x41, 0x00), RGB(0x31, 0x41, 0x00), RGB(0x20, 0x41, 0x00), RGB(0x10, 0x41, 0x00),
89 RGB(0x00, 0x41, 0x00), RGB(0x00, 0x41, 0x10), RGB(0x00, 0x41, 0x20), RGB(0x00, 0x41, 0x31),
90 RGB(0x00, 0x41, 0x41), RGB(0x00, 0x31, 0x41), RGB(0x00, 0x20, 0x41), RGB(0x00, 0x10, 0x41),
91 RGB(0x20, 0x20, 0x41), RGB(0x28, 0x20, 0x41), RGB(0x31, 0x20, 0x41), RGB(0x39, 0x20, 0x41),
92 RGB(0x41, 0x20, 0x41), RGB(0x41, 0x20, 0x39), RGB(0x41, 0x20, 0x31), RGB(0x41, 0x20, 0x28),
93 RGB(0x41, 0x20, 0x20), RGB(0x41, 0x28, 0x20), RGB(0x41, 0x31, 0x20), RGB(0x41, 0x39, 0x20),
94 RGB(0x41, 0x41, 0x20), RGB(0x39, 0x41, 0x20), RGB(0x31, 0x41, 0x20), RGB(0x28, 0x41, 0x20),
95 RGB(0x20, 0x41, 0x20), RGB(0x20, 0x41, 0x28), RGB(0x20, 0x41, 0x31), RGB(0x20, 0x41, 0x39),
96 RGB(0x20, 0x41, 0x41), RGB(0x20, 0x39, 0x41), RGB(0x20, 0x31, 0x41), RGB(0x20, 0x28, 0x41),
97 RGB(0x2D, 0x2D, 0x41), RGB(0x31, 0x2D, 0x41), RGB(0x35, 0x2D, 0x41), RGB(0x3D, 0x2D, 0x41),
98 RGB(0x41, 0x2D, 0x41), RGB(0x41, 0x2D, 0x3D), RGB(0x41, 0x2D, 0x35), RGB(0x41, 0x2D, 0x31),
99 RGB(0x41, 0x2D, 0x2D), RGB(0x41, 0x31, 0x2D), RGB(0x41, 0x35, 0x2D), RGB(0x41, 0x3D, 0x2D),
100 RGB(0x41, 0x41, 0x2D), RGB(0x3D, 0x41, 0x2D), RGB(0x35, 0x41, 0x2D), RGB(0x31, 0x41, 0x2D),
101 RGB(0x2D, 0x41, 0x2D), RGB(0x2D, 0x41, 0x31), RGB(0x2D, 0x41, 0x35), RGB(0x2D, 0x41, 0x3D),
102 RGB(0x2D, 0x41, 0x41), RGB(0x2D, 0x3D, 0x41), RGB(0x2D, 0x35, 0x41), RGB(0x2D, 0x31, 0x41),
103 RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00),
104 RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00)
105 };
106
107 #elif defined(USE_DOSBOX_COLORS)
108
109 // DOSBox colors
110 static CONST COLORREF VgaDefaultPalette[VGA_MAX_COLORS] =
111 {
112 RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0xAA), RGB(0x00, 0xAA, 0x00), RGB(0x00, 0xAA, 0xAA),
113 RGB(0xAA, 0x00, 0x00), RGB(0xAA, 0x00, 0xAA), RGB(0xAA, 0x55, 0x00), RGB(0xAA, 0xAA, 0xAA),
114 RGB(0x55, 0x55, 0x55), RGB(0x55, 0x55, 0xFF), RGB(0x55, 0xFF, 0x55), RGB(0x55, 0xFF, 0xFF),
115 RGB(0xFF, 0x55, 0x55), RGB(0xFF, 0x55, 0xFF), RGB(0xFF, 0xFF, 0x55), RGB(0xFF, 0xFF, 0xFF),
116 RGB(0x00, 0x00, 0x00), RGB(0x14, 0x14, 0x14), RGB(0x20, 0x20, 0x20), RGB(0x2C, 0x2C, 0x2C),
117 RGB(0x38, 0x38, 0x38), RGB(0x45, 0x45, 0x45), RGB(0x51, 0x51, 0x51), RGB(0x61, 0x61, 0x61),
118 RGB(0x71, 0x71, 0x71), RGB(0x82, 0x82, 0x82), RGB(0x92, 0x92, 0x92), RGB(0xA2, 0xA2, 0xA2),
119 RGB(0xB6, 0xB6, 0xB6), RGB(0xCB, 0xCB, 0xCB), RGB(0xE3, 0xE3, 0xE3), RGB(0xFF, 0xFF, 0xFF),
120 RGB(0x00, 0x00, 0xFF), RGB(0x41, 0x00, 0xFF), RGB(0x7D, 0x00, 0xFF), RGB(0xBE, 0x00, 0xFF),
121 RGB(0xFF, 0x00, 0xFF), RGB(0xFF, 0x00, 0xBE), RGB(0xFF, 0x00, 0x7D), RGB(0xFF, 0x00, 0x41),
122 RGB(0xFF, 0x00, 0x00), RGB(0xFF, 0x41, 0x00), RGB(0xFF, 0x7D, 0x00), RGB(0xFF, 0xBE, 0x00),
123 RGB(0xFF, 0xFF, 0x00), RGB(0xBE, 0xFF, 0x00), RGB(0x7D, 0xFF, 0x00), RGB(0x41, 0xFF, 0x00),
124 RGB(0x00, 0xFF, 0x00), RGB(0x00, 0xFF, 0x41), RGB(0x00, 0xFF, 0x7D), RGB(0x00, 0xFF, 0xBE),
125 RGB(0x00, 0xFF, 0xFF), RGB(0x00, 0xBE, 0xFF), RGB(0x00, 0x7D, 0xFF), RGB(0x00, 0x41, 0xFF),
126 RGB(0x7D, 0x7D, 0xFF), RGB(0x9E, 0x7D, 0xFF), RGB(0xBE, 0x7D, 0xFF), RGB(0xDF, 0x7D, 0xFF),
127 RGB(0xFF, 0x7D, 0xFF), RGB(0xFF, 0x7D, 0xDF), RGB(0xFF, 0x7D, 0xBE), RGB(0xFF, 0x7D, 0x9E),
128
129 RGB(0xFF, 0x7D, 0x7D), RGB(0xFF, 0x9E, 0x7D), RGB(0xFF, 0xBE, 0x7D), RGB(0xFF, 0xDF, 0x7D),
130 RGB(0xFF, 0xFF, 0x7D), RGB(0xDF, 0xFF, 0x7D), RGB(0xBE, 0xFF, 0x7D), RGB(0x9E, 0xFF, 0x7D),
131 RGB(0x7D, 0xFF, 0x7D), RGB(0x7D, 0xFF, 0x9E), RGB(0x7D, 0xFF, 0xBE), RGB(0x7D, 0xFF, 0xDF),
132 RGB(0x7D, 0xFF, 0xFF), RGB(0x7D, 0xDF, 0xFF), RGB(0x7D, 0xBE, 0xFF), RGB(0x7D, 0x9E, 0xFF),
133 RGB(0xB6, 0xB6, 0xFF), RGB(0xC7, 0xB6, 0xFF), RGB(0xDB, 0xB6, 0xFF), RGB(0xEB, 0xB6, 0xFF),
134 RGB(0xFF, 0xB6, 0xFF), RGB(0xFF, 0xB6, 0xEB), RGB(0xFF, 0xB6, 0xDB), RGB(0xFF, 0xB6, 0xC7),
135 RGB(0xFF, 0xB6, 0xB6), RGB(0xFF, 0xC7, 0xB6), RGB(0xFF, 0xDB, 0xB6), RGB(0xFF, 0xEB, 0xB6),
136 RGB(0xFF, 0xFF, 0xB6), RGB(0xEB, 0xFF, 0xB6), RGB(0xDB, 0xFF, 0xB6), RGB(0xC7, 0xFF, 0xB6),
137 RGB(0xB6, 0xFF, 0xB6), RGB(0xB6, 0xFF, 0xC7), RGB(0xB6, 0xFF, 0xDB), RGB(0xB6, 0xFF, 0xEB),
138 RGB(0xB6, 0xFF, 0xFF), RGB(0xB6, 0xEB, 0xFF), RGB(0xB6, 0xDB, 0xFF), RGB(0xB6, 0xC7, 0xFF),
139 RGB(0x00, 0x00, 0x71), RGB(0x1C, 0x00, 0x71), RGB(0x38, 0x00, 0x71), RGB(0x55, 0x00, 0x71),
140 RGB(0x71, 0x00, 0x71), RGB(0x71, 0x00, 0x55), RGB(0x71, 0x00, 0x38), RGB(0x71, 0x00, 0x1C),
141 RGB(0x71, 0x00, 0x00), RGB(0x71, 0x1C, 0x00), RGB(0x71, 0x38, 0x00), RGB(0x71, 0x55, 0x00),
142 RGB(0x71, 0x71, 0x00), RGB(0x55, 0x71, 0x00), RGB(0x38, 0x71, 0x00), RGB(0x1C, 0x71, 0x00),
143 RGB(0x00, 0x71, 0x00), RGB(0x00, 0x71, 0x1C), RGB(0x00, 0x71, 0x38), RGB(0x00, 0x71, 0x55),
144 RGB(0x00, 0x71, 0x71), RGB(0x00, 0x55, 0x71), RGB(0x00, 0x38, 0x71), RGB(0x00, 0x1C, 0x71),
145
146 RGB(0x38, 0x38, 0x71), RGB(0x45, 0x38, 0x71), RGB(0x55, 0x38, 0x71), RGB(0x61, 0x38, 0x71),
147 RGB(0x71, 0x38, 0x71), RGB(0x71, 0x38, 0x61), RGB(0x71, 0x38, 0x55), RGB(0x71, 0x38, 0x45),
148 RGB(0x71, 0x38, 0x38), RGB(0x71, 0x45, 0x38), RGB(0x71, 0x55, 0x38), RGB(0x71, 0x61, 0x38),
149 RGB(0x71, 0x71, 0x38), RGB(0x61, 0x71, 0x38), RGB(0x55, 0x71, 0x38), RGB(0x45, 0x71, 0x38),
150 RGB(0x38, 0x71, 0x38), RGB(0x38, 0x71, 0x45), RGB(0x38, 0x71, 0x55), RGB(0x38, 0x71, 0x61),
151 RGB(0x38, 0x71, 0x71), RGB(0x38, 0x61, 0x71), RGB(0x38, 0x55, 0x71), RGB(0x38, 0x45, 0x71),
152 RGB(0x51, 0x51, 0x71), RGB(0x59, 0x51, 0x71), RGB(0x61, 0x51, 0x71), RGB(0x69, 0x51, 0x71),
153 RGB(0x71, 0x51, 0x71), RGB(0x71, 0x51, 0x69), RGB(0x71, 0x51, 0x61), RGB(0x71, 0x51, 0x59),
154 RGB(0x71, 0x51, 0x51), RGB(0x71, 0x59, 0x51), RGB(0x71, 0x61, 0x51), RGB(0x71, 0x69, 0x51),
155 RGB(0x71, 0x71, 0x51), RGB(0x69, 0x71, 0x51), RGB(0x61, 0x71, 0x51), RGB(0x59, 0x71, 0x51),
156 RGB(0x51, 0x71, 0x51), RGB(0x51, 0x71, 0x59), RGB(0x51, 0x71, 0x61), RGB(0x51, 0x71, 0x69),
157 RGB(0x51, 0x71, 0x71), RGB(0x51, 0x69, 0x71), RGB(0x51, 0x61, 0x71), RGB(0x51, 0x59, 0x71),
158 RGB(0x00, 0x00, 0x41), RGB(0x10, 0x00, 0x41), RGB(0x20, 0x00, 0x41), RGB(0x30, 0x00, 0x41),
159 RGB(0x41, 0x00, 0x41), RGB(0x41, 0x00, 0x30), RGB(0x41, 0x00, 0x20), RGB(0x41, 0x00, 0x10),
160 RGB(0x41, 0x00, 0x00), RGB(0x41, 0x10, 0x00), RGB(0x41, 0x20, 0x00), RGB(0x41, 0x30, 0x00),
161 RGB(0x41, 0x41, 0x00), RGB(0x30, 0x41, 0x00), RGB(0x20, 0x41, 0x00), RGB(0x10, 0x41, 0x00),
162
163 RGB(0x00, 0x41, 0x00), RGB(0x00, 0x41, 0x10), RGB(0x00, 0x41, 0x20), RGB(0x00, 0x41, 0x30),
164 RGB(0x00, 0x41, 0x41), RGB(0x00, 0x30, 0x41), RGB(0x00, 0x20, 0x41), RGB(0x00, 0x10, 0x41),
165 RGB(0x20, 0x20, 0x41), RGB(0x28, 0x20, 0x41), RGB(0x30, 0x20, 0x41), RGB(0x38, 0x20, 0x41),
166 RGB(0x41, 0x20, 0x41), RGB(0x41, 0x20, 0x38), RGB(0x41, 0x20, 0x30), RGB(0x41, 0x20, 0x28),
167 RGB(0x41, 0x20, 0x20), RGB(0x41, 0x28, 0x20), RGB(0x41, 0x30, 0x20), RGB(0x41, 0x38, 0x20),
168 RGB(0x41, 0x41, 0x20), RGB(0x38, 0x41, 0x20), RGB(0x30, 0x41, 0x20), RGB(0x28, 0x41, 0x20),
169 RGB(0x20, 0x41, 0x20), RGB(0x20, 0x41, 0x28), RGB(0x20, 0x41, 0x30), RGB(0x20, 0x41, 0x38),
170 RGB(0x20, 0x41, 0x41), RGB(0x20, 0x38, 0x41), RGB(0x20, 0x30, 0x41), RGB(0x20, 0x28, 0x41),
171 RGB(0x2C, 0x2C, 0x41), RGB(0x30, 0x2C, 0x41), RGB(0x34, 0x2C, 0x41), RGB(0x3C, 0x2C, 0x41),
172 RGB(0x41, 0x2C, 0x41), RGB(0x41, 0x2C, 0x3C), RGB(0x41, 0x2C, 0x34), RGB(0x41, 0x2C, 0x30),
173 RGB(0x41, 0x2C, 0x2C), RGB(0x41, 0x30, 0x2C), RGB(0x41, 0x34, 0x2C), RGB(0x41, 0x3C, 0x2C),
174 RGB(0x41, 0x41, 0x2C), RGB(0x3C, 0x41, 0x2C), RGB(0x34, 0x41, 0x2C), RGB(0x30, 0x41, 0x2C),
175 RGB(0x2C, 0x41, 0x2C), RGB(0x2C, 0x41, 0x30), RGB(0x2C, 0x41, 0x34), RGB(0x2C, 0x41, 0x3C),
176 RGB(0x2C, 0x41, 0x41), RGB(0x2C, 0x3C, 0x41), RGB(0x2C, 0x34, 0x41), RGB(0x2C, 0x30, 0x41),
177 RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00),
178 RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00), RGB(0x00, 0x00, 0x00)
179 };
180
181 #endif
182
183 /*
184 * Default 16-color palette for foreground and background
185 * (corresponding flags in comments).
186 * Taken from subsystems/win32/winsrv/consrv/frontends/gui/conwnd.c
187 */
188 static const COLORREF ConsoleColors[16] =
189 {
190 RGB(0, 0, 0), // (Black)
191 RGB(0, 0, 128), // BLUE
192 RGB(0, 128, 0), // GREEN
193 RGB(0, 128, 128), // BLUE | GREEN
194 RGB(128, 0, 0), // RED
195 RGB(128, 0, 128), // BLUE | RED
196 RGB(128, 128, 0), // GREEN | RED
197 RGB(192, 192, 192), // BLUE | GREEN | RED
198
199 RGB(128, 128, 128), // (Grey) INTENSITY
200 RGB(0, 0, 255), // BLUE | INTENSITY
201 RGB(0, 255, 0), // GREEN | INTENSITY
202 RGB(0, 255, 255), // BLUE | GREEN | INTENSITY
203 RGB(255, 0, 0), // RED | INTENSITY
204 RGB(255, 0, 255), // BLUE | RED | INTENSITY
205 RGB(255, 255, 0), // GREEN | RED | INTENSITY
206 RGB(255, 255, 255) // BLUE | GREEN | RED | INTENSITY
207 };
208
209 /*
210 * Console interface -- VGA-mode-agnostic
211 */
212 typedef struct _CHAR_CELL
213 {
214 CHAR Char;
215 BYTE Attributes;
216 } CHAR_CELL, *PCHAR_CELL;
217 C_ASSERT(sizeof(CHAR_CELL) == 2);
218
219 static LPVOID ConsoleFramebuffer = NULL; // Active framebuffer, points to
220 // either TextFramebuffer or a
221 // valid graphics framebuffer.
222 static HPALETTE TextPaletteHandle = NULL;
223 static HPALETTE PaletteHandle = NULL;
224
225 static HANDLE StartEvent = NULL;
226 static HANDLE EndEvent = NULL;
227 static HANDLE AnotherEvent = NULL;
228
229 static CONSOLE_CURSOR_INFO OrgConsoleCursorInfo;
230 static CONSOLE_SCREEN_BUFFER_INFO OrgConsoleBufferInfo;
231
232
233 /*
234 * Text mode -- we always keep a valid text mode framebuffer
235 * even if we are in graphics mode. This is needed in order
236 * to keep a consistent VGA state.
237 */
238 static CONSOLE_SCREEN_BUFFER_INFO ConsoleInfo;
239 static COORD TextResolution = {0};
240 static PCHAR_CELL TextFramebuffer = NULL;
241 static HANDLE TextConsoleBuffer = NULL;
242
243 /* Graphics mode */
244 static HANDLE GraphicsConsoleBuffer = NULL;
245 static HANDLE ConsoleMutex = NULL;
246 /* DoubleVision support */
247 static BOOLEAN DoubleWidth = FALSE;
248 static BOOLEAN DoubleHeight = FALSE;
249
250 static PHARDWARE_TIMER VSyncTimer;
251 static PHARDWARE_TIMER HSyncTimer;
252
253 /*
254 * VGA Hardware
255 */
256 static BYTE VgaMemory[VGA_NUM_BANKS * VGA_BANK_SIZE];
257
258 static BYTE VgaLatchRegisters[VGA_NUM_BANKS] = {0, 0, 0, 0};
259
260 static BYTE VgaMiscRegister;
261 static BYTE VgaFeatureRegister;
262
263 static BYTE VgaSeqIndex = VGA_SEQ_RESET_REG;
264 static BYTE VgaSeqRegisters[VGA_SEQ_MAX_REG];
265
266 static BYTE VgaCrtcIndex = VGA_CRTC_HORZ_TOTAL_REG;
267 static BYTE VgaCrtcRegisters[VGA_CRTC_MAX_REG];
268
269 static BYTE VgaGcIndex = VGA_GC_RESET_REG;
270 static BYTE VgaGcRegisters[VGA_GC_MAX_REG];
271
272 static BOOLEAN VgaAcLatch = FALSE;
273 static BOOLEAN VgaAcPalDisable = TRUE;
274 static BYTE VgaAcIndex = VGA_AC_PAL_0_REG;
275 static BYTE VgaAcRegisters[VGA_AC_MAX_REG];
276
277 static BYTE VgaDacMask = 0xFF;
278
279 static BOOLEAN VgaDacReadWrite = FALSE;
280 static WORD VgaDacIndex = 0;
281 static BYTE VgaDacRegisters[VGA_PALETTE_SIZE];
282
283 // static VGA_REGISTERS VgaRegisters;
284
285 static BOOLEAN InVerticalRetrace = FALSE;
286 static BOOLEAN InHorizontalRetrace = FALSE;
287
288 static BOOLEAN NeedsUpdate = FALSE;
289 static BOOLEAN ModeChanged = FALSE;
290 static BOOLEAN CursorChanged = FALSE;
291 static BOOLEAN PaletteChanged = FALSE;
292
293 typedef enum _SCREEN_MODE
294 {
295 TEXT_MODE,
296 GRAPHICS_MODE
297 } SCREEN_MODE, *PSCREEN_MODE;
298
299 static SCREEN_MODE ScreenMode = TEXT_MODE;
300 static COORD CurrResolution = {0};
301
302 static SMALL_RECT UpdateRectangle = { 0, 0, 0, 0 };
303
304 /* RegisterConsoleVDM EMULATION ***********************************************/
305
306 #include <ntddvdeo.h>
307
308 #ifdef USE_REAL_REGISTERCONSOLEVDM
309
310 #define __RegisterConsoleVDM RegisterConsoleVDM
311 #define __InvalidateConsoleDIBits InvalidateConsoleDIBits
312
313 #else
314
315 /*
316 * This private buffer, per-console, is used by
317 * RegisterConsoleVDM and InvalidateConsoleDIBits.
318 */
319 static COORD VDMBufferSize = {0};
320 static PCHAR_CELL VDMBuffer = NULL;
321
322 static PCHAR_INFO CharBuff = NULL; // This is a hack, which is unneeded
323 // for the real RegisterConsoleVDM and
324 // InvalidateConsoleDIBits
325
326 BOOL
327 WINAPI
328 __RegisterConsoleVDM(IN DWORD dwRegisterFlags,
329 IN HANDLE hStartHardwareEvent,
330 IN HANDLE hEndHardwareEvent,
331 IN HANDLE hErrorHardwareEvent,
332 IN DWORD dwUnusedVar,
333 OUT LPDWORD lpVideoStateLength,
334 OUT PVOID* lpVideoState, // PVIDEO_HARDWARE_STATE_HEADER*
335 IN PVOID lpUnusedBuffer,
336 IN DWORD dwUnusedBufferLength,
337 IN COORD dwVDMBufferSize,
338 OUT PVOID* lpVDMBuffer)
339 {
340 UNREFERENCED_PARAMETER(hErrorHardwareEvent);
341 UNREFERENCED_PARAMETER(dwUnusedVar);
342 UNREFERENCED_PARAMETER(lpVideoStateLength);
343 UNREFERENCED_PARAMETER(lpVideoState);
344 UNREFERENCED_PARAMETER(lpUnusedBuffer);
345 UNREFERENCED_PARAMETER(dwUnusedBufferLength);
346
347 SetLastError(0);
348 DPRINT1("__RegisterConsoleVDM(%d)\n", dwRegisterFlags);
349
350 if (lpVDMBuffer == NULL) return FALSE;
351
352 if (dwRegisterFlags != 0)
353 {
354 // if (hStartHardwareEvent == NULL || hEndHardwareEvent == NULL) return FALSE;
355 if (VDMBuffer != NULL) return FALSE;
356
357 VDMBufferSize = dwVDMBufferSize;
358
359 /* HACK: Cache -- to be removed in the real implementation */
360 CharBuff = RtlAllocateHeap(RtlGetProcessHeap(),
361 HEAP_ZERO_MEMORY,
362 VDMBufferSize.X * VDMBufferSize.Y
363 * sizeof(*CharBuff));
364 ASSERT(CharBuff);
365
366 VDMBuffer = RtlAllocateHeap(RtlGetProcessHeap(),
367 HEAP_ZERO_MEMORY,
368 VDMBufferSize.X * VDMBufferSize.Y
369 * sizeof(*VDMBuffer));
370 *lpVDMBuffer = VDMBuffer;
371 return (VDMBuffer != NULL);
372 }
373 else
374 {
375 /* HACK: Cache -- to be removed in the real implementation */
376 if (CharBuff) RtlFreeHeap(RtlGetProcessHeap(), 0, CharBuff);
377 CharBuff = NULL;
378
379 if (VDMBuffer) RtlFreeHeap(RtlGetProcessHeap(), 0, VDMBuffer);
380 VDMBuffer = NULL;
381
382 VDMBufferSize.X = VDMBufferSize.Y = 0;
383
384 return TRUE;
385 }
386 }
387
388 BOOL
389 __InvalidateConsoleDIBits(IN HANDLE hConsoleOutput,
390 IN PSMALL_RECT lpRect)
391 {
392 if ((hConsoleOutput == TextConsoleBuffer) && (VDMBuffer != NULL))
393 {
394 /* HACK: Write the cached data to the console */
395
396 COORD Origin = { lpRect->Left, lpRect->Top };
397 SHORT i, j;
398
399 ASSERT(CharBuff);
400
401 for (i = 0; i < VDMBufferSize.Y; i++)
402 {
403 for (j = 0; j < VDMBufferSize.X; j++)
404 {
405 CharBuff[i * VDMBufferSize.X + j].Char.AsciiChar = VDMBuffer[i * VDMBufferSize.X + j].Char;
406 CharBuff[i * VDMBufferSize.X + j].Attributes = VDMBuffer[i * VDMBufferSize.X + j].Attributes;
407 }
408 }
409
410 WriteConsoleOutputA(hConsoleOutput,
411 CharBuff,
412 VDMBufferSize,
413 Origin,
414 lpRect);
415 }
416
417 return InvalidateConsoleDIBits(hConsoleOutput, lpRect);
418 }
419
420 #endif
421
422 /* PRIVATE FUNCTIONS **********************************************************/
423
424 static inline DWORD VgaGetAddressSize(VOID);
425 static VOID VgaUpdateTextCursor(VOID);
426
427 static inline DWORD VgaGetVideoBaseAddress(VOID)
428 {
429 return MemoryBase[(VgaGcRegisters[VGA_GC_MISC_REG] >> 2) & 0x03];
430 }
431
432 static inline DWORD VgaGetVideoLimitAddress(VOID)
433 {
434 return MemoryLimit[(VgaGcRegisters[VGA_GC_MISC_REG] >> 2) & 0x03];
435 }
436
437 static VOID VgaUpdateCursorPosition(VOID)
438 {
439 /*
440 * Update the cursor position in the VGA registers.
441 */
442 WORD Offset = ConsoleInfo.dwCursorPosition.Y * TextResolution.X +
443 ConsoleInfo.dwCursorPosition.X;
444
445 VgaCrtcRegisters[VGA_CRTC_CURSOR_LOC_LOW_REG] = LOBYTE(Offset);
446 VgaCrtcRegisters[VGA_CRTC_CURSOR_LOC_HIGH_REG] = HIBYTE(Offset);
447
448 // VidBiosSyncCursorPosition();
449 VgaUpdateTextCursor();
450 }
451
452 static BOOL VgaAttachToConsoleInternal(PCOORD Resolution)
453 {
454 BOOL Success;
455 ULONG Length = 0;
456 PVIDEO_HARDWARE_STATE_HEADER State;
457
458 #ifdef USE_REAL_REGISTERCONSOLEVDM
459 PCHAR_INFO CharBuff = NULL;
460 #endif
461 SHORT i, j;
462 DWORD AddressSize, ScanlineSize;
463 DWORD Address = 0;
464 DWORD CurrentAddr;
465 SMALL_RECT ConRect;
466 COORD Origin = { 0, 0 };
467
468 ASSERT(TextFramebuffer == NULL);
469
470 TextResolution = *Resolution;
471
472 /*
473 * Windows 2k3 winsrv.dll calls NtVdmControl(VdmQueryVdmProcess == 14, &ConsoleHandle);
474 * in the two following APIs:
475 * SrvRegisterConsoleVDM (corresponding Win32 API: RegisterConsoleVDM)
476 * SrvVDMConsoleOperation (corresponding Win32 API: )
477 * to check whether the current process is a VDM process, and fails otherwise
478 * with the error 0xC0000022 (STATUS_ACCESS_DENIED).
479 *
480 * It is worth it to notice that also basesrv.dll does the same only for the
481 * BaseSrvIsFirstVDM API...
482 */
483
484 Success =
485 __RegisterConsoleVDM(1,
486 StartEvent,
487 EndEvent,
488 AnotherEvent, // NULL,
489 0,
490 &Length, // NULL, <-- putting this (and null in the next var) makes the API returning error 12 "ERROR_INVALID_ACCESS"
491 (PVOID*)&State, // NULL,
492 NULL,
493 0,
494 TextResolution,
495 (PVOID*)&TextFramebuffer);
496 if (!Success)
497 {
498 DisplayMessage(L"RegisterConsoleVDM failed with error %d\n", GetLastError());
499 EmulatorTerminate();
500 return FALSE;
501 }
502
503 #ifdef USE_REAL_REGISTERCONSOLEVDM
504 CharBuff = RtlAllocateHeap(RtlGetProcessHeap(),
505 HEAP_ZERO_MEMORY,
506 TextResolution.X * TextResolution.Y
507 * sizeof(*CharBuff));
508 ASSERT(CharBuff);
509 #endif
510
511 /*
512 * Resize the console
513 */
514 ConRect.Left = 0;
515 ConRect.Top = ConsoleInfo.srWindow.Top;
516 ConRect.Right = ConRect.Left + Resolution->X - 1;
517 ConRect.Bottom = ConRect.Top + Resolution->Y - 1;
518 /*
519 * Use this trick to effectively resize the console buffer and window,
520 * because:
521 * - SetConsoleScreenBufferSize fails if the new console screen buffer size
522 * is smaller than the current console window size, and:
523 * - SetConsoleWindowInfo fails if the new console window size is larger
524 * than the current console screen buffer size.
525 */
526 SetConsoleScreenBufferSize(TextConsoleBuffer, *Resolution);
527 SetConsoleWindowInfo(TextConsoleBuffer, TRUE, &ConRect);
528 SetConsoleScreenBufferSize(TextConsoleBuffer, *Resolution);
529 /* Update the saved console information */
530 GetConsoleScreenBufferInfo(TextConsoleBuffer, &ConsoleInfo);
531
532 /*
533 * Copy console data into VGA memory
534 */
535
536 /* Get the data */
537 AddressSize = VgaGetAddressSize();
538 ConRect.Left = ConRect.Top = 0;
539 ConRect.Right = TextResolution.X;
540 ConRect.Bottom = TextResolution.Y;
541 ScanlineSize = (DWORD)VgaCrtcRegisters[VGA_CRTC_OFFSET_REG] * 2;
542
543 /* Read the data from the console into the framebuffer... */
544 ReadConsoleOutputA(TextConsoleBuffer,
545 CharBuff,
546 TextResolution,
547 Origin,
548 &ConRect);
549
550 /* ... and copy the framebuffer into the VGA memory */
551
552 /* Loop through the scanlines */
553 for (i = 0; i < TextResolution.Y; i++)
554 {
555 /* Loop through the characters */
556 for (j = 0; j < TextResolution.X; j++)
557 {
558 CurrentAddr = LOWORD((Address + j) * AddressSize);
559
560 /* Store the character in plane 0 */
561 VgaMemory[CurrentAddr] = CharBuff[i * TextResolution.X + j].Char.AsciiChar;
562
563 /* Store the attribute in plane 1 */
564 VgaMemory[CurrentAddr + VGA_BANK_SIZE] = (BYTE)CharBuff[i * TextResolution.X + j].Attributes;
565 }
566
567 /* Move to the next scanline */
568 Address += ScanlineSize;
569 }
570
571 #ifdef USE_REAL_REGISTERCONSOLEVDM
572 if (CharBuff) RtlFreeHeap(RtlGetProcessHeap(), 0, CharBuff);
573 #endif
574
575 VgaUpdateCursorPosition();
576
577 return TRUE;
578 }
579
580 static BOOL IsConsoleHandle(HANDLE hHandle)
581 {
582 DWORD dwMode;
583
584 /* Check whether the handle may be that of a console... */
585 if ((GetFileType(hHandle) & ~FILE_TYPE_REMOTE) != FILE_TYPE_CHAR)
586 return FALSE;
587
588 /*
589 * It may be. Perform another test... The idea comes from the
590 * MSDN description of the WriteConsole API:
591 *
592 * "WriteConsole fails if it is used with a standard handle
593 * that is redirected to a file. If an application processes
594 * multilingual output that can be redirected, determine whether
595 * the output handle is a console handle (one method is to call
596 * the GetConsoleMode function and check whether it succeeds).
597 * If the handle is a console handle, call WriteConsole. If the
598 * handle is not a console handle, the output is redirected and
599 * you should call WriteFile to perform the I/O."
600 */
601 return GetConsoleMode(hHandle, &dwMode);
602 }
603
604 static inline DWORD VgaGetAddressSize(VOID)
605 {
606 if (VgaCrtcRegisters[VGA_CRTC_UNDERLINE_REG] & VGA_CRTC_UNDERLINE_DWORD)
607 {
608 /* Double-word addressing */
609 return 4; // sizeof(DWORD)
610 }
611 else if (VgaCrtcRegisters[VGA_CRTC_MODE_CONTROL_REG] & VGA_CRTC_MODE_CONTROL_BYTE)
612 {
613 /* Byte addressing */
614 return 1; // sizeof(BYTE)
615 }
616 else
617 {
618 /* Word addressing */
619 return 2; // sizeof(WORD)
620 }
621 }
622
623 static inline DWORD VgaTranslateReadAddress(DWORD Address)
624 {
625 DWORD Offset = LOWORD(Address - VgaGetVideoBaseAddress());
626 BYTE Plane;
627
628 /* Check for chain-4 and odd-even mode */
629 if (VgaSeqRegisters[VGA_SEQ_MEM_REG] & VGA_SEQ_MEM_C4)
630 {
631 /* The lowest two bits are the plane number */
632 Plane = Offset & 0x03;
633 Offset &= ~3;
634 }
635 else if (VgaGcRegisters[VGA_GC_MODE_REG] & VGA_GC_MODE_OE)
636 {
637 /* The LSB is the plane number */
638 Plane = Offset & 0x01;
639 Offset &= ~1;
640 }
641 else
642 {
643 /* Use the read mode */
644 Plane = VgaGcRegisters[VGA_GC_READ_MAP_SEL_REG] & 0x03;
645 }
646
647 /* Return the offset on plane 0 for read mode 1 */
648 if (VgaGcRegisters[VGA_GC_MODE_REG] & VGA_GC_MODE_READ) return Offset;
649 else return Offset + Plane * VGA_BANK_SIZE;
650 }
651
652 static inline DWORD VgaTranslateWriteAddress(DWORD Address)
653 {
654 DWORD Offset = LOWORD(Address - VgaGetVideoBaseAddress());
655
656 /* Check for chain-4 and odd-even mode */
657 if (VgaSeqRegisters[VGA_SEQ_MEM_REG] & VGA_SEQ_MEM_C4)
658 {
659 /* Clear the lowest two bits since they're used to select the bank */
660 Offset &= ~3;
661 }
662 else if (VgaGcRegisters[VGA_GC_MODE_REG] & VGA_GC_MODE_OE)
663 {
664 /* Clear the lowest bit since it's used to select odd/even */
665 Offset &= ~1;
666 }
667
668 /* Return the offset on plane 0 */
669 return Offset;
670 }
671
672 static inline BYTE VgaTranslateByteForWriting(BYTE Data, BYTE Plane)
673 {
674 BYTE WriteMode = VgaGcRegisters[VGA_GC_MODE_REG] & 0x03;
675 BYTE BitMask = VgaGcRegisters[VGA_GC_BITMASK_REG];
676
677 if (WriteMode == 1)
678 {
679 /* In write mode 1 just return the latch register */
680 return VgaLatchRegisters[Plane];
681 }
682
683 if (WriteMode != 2)
684 {
685 /* Write modes 0 and 3 rotate the data to the right first */
686 BYTE RotateCount = VgaGcRegisters[VGA_GC_ROTATE_REG] & 0x07;
687 Data = LOBYTE(((DWORD)Data >> RotateCount) | ((DWORD)Data << (8 - RotateCount)));
688 }
689 else
690 {
691 /* Write mode 2 expands the appropriate bit to all 8 bits */
692 Data = (Data & (1 << Plane)) ? 0xFF : 0x00;
693 }
694
695 if (WriteMode == 0)
696 {
697 /*
698 * In write mode 0, the enable set/reset register decides if the
699 * set/reset bit should be expanded to all 8 bits.
700 */
701 if (VgaGcRegisters[VGA_GC_ENABLE_RESET_REG] & (1 << Plane))
702 {
703 /* Copy the bit from the set/reset register to all 8 bits */
704 Data = (VgaGcRegisters[VGA_GC_RESET_REG] & (1 << Plane)) ? 0xFF : 0x00;
705 }
706 }
707
708 if (WriteMode != 3)
709 {
710 /* Write modes 0 and 2 then perform a logical operation on the data and latch */
711 BYTE LogicalOperation = (VgaGcRegisters[VGA_GC_ROTATE_REG] >> 3) & 0x03;
712
713 if (LogicalOperation == 1) Data &= VgaLatchRegisters[Plane];
714 else if (LogicalOperation == 2) Data |= VgaLatchRegisters[Plane];
715 else if (LogicalOperation == 3) Data ^= VgaLatchRegisters[Plane];
716 }
717 else
718 {
719 /* For write mode 3, we AND the bitmask with the data, which is used as the new bitmask */
720 BitMask &= Data;
721
722 /* Then we expand the bit in the set/reset field */
723 Data = (VgaGcRegisters[VGA_GC_RESET_REG] & (1 << Plane)) ? 0xFF : 0x00;
724 }
725
726 /* Bits cleared in the bitmask are replaced with latch register bits */
727 Data = (Data & BitMask) | (VgaLatchRegisters[Plane] & (~BitMask));
728
729 /* Return the byte */
730 return Data;
731 }
732
733 static inline VOID VgaMarkForUpdate(SHORT Row, SHORT Column)
734 {
735 /* Check if this is the first time the rectangle is updated */
736 if (!NeedsUpdate)
737 {
738 UpdateRectangle.Left = UpdateRectangle.Top = MAXSHORT;
739 UpdateRectangle.Right = UpdateRectangle.Bottom = MINSHORT;
740 }
741
742 /* Expand the rectangle to include the point */
743 UpdateRectangle.Left = min(UpdateRectangle.Left, Column);
744 UpdateRectangle.Right = max(UpdateRectangle.Right, Column);
745 UpdateRectangle.Top = min(UpdateRectangle.Top, Row);
746 UpdateRectangle.Bottom = max(UpdateRectangle.Bottom, Row);
747
748 /* Set the update request flag */
749 NeedsUpdate = TRUE;
750 }
751
752 static VOID VgaRestoreDefaultPalette(PPALETTEENTRY Entries, USHORT NumOfEntries)
753 {
754 USHORT i;
755
756 /* Copy the colors of the default palette to the DAC and console palette */
757 for (i = 0; i < NumOfEntries; i++)
758 {
759 /* Set the palette entries */
760 Entries[i].peRed = GetRValue(VgaDefaultPalette[i]);
761 Entries[i].peGreen = GetGValue(VgaDefaultPalette[i]);
762 Entries[i].peBlue = GetBValue(VgaDefaultPalette[i]);
763 Entries[i].peFlags = 0;
764
765 /* Set the DAC registers */
766 VgaDacRegisters[i * 3] = VGA_COLOR_TO_DAC(GetRValue(VgaDefaultPalette[i]));
767 VgaDacRegisters[i * 3 + 1] = VGA_COLOR_TO_DAC(GetGValue(VgaDefaultPalette[i]));
768 VgaDacRegisters[i * 3 + 2] = VGA_COLOR_TO_DAC(GetBValue(VgaDefaultPalette[i]));
769 }
770 }
771
772 static BOOLEAN VgaInitializePalette(VOID)
773 {
774 INT i;
775 BOOLEAN Result = FALSE;
776 LPLOGPALETTE Palette, TextPalette;
777
778 /* Allocate storage space for the palettes */
779 Palette = RtlAllocateHeap(RtlGetProcessHeap(),
780 HEAP_ZERO_MEMORY,
781 sizeof(LOGPALETTE) +
782 VGA_MAX_COLORS * sizeof(PALETTEENTRY));
783 TextPalette = RtlAllocateHeap(RtlGetProcessHeap(),
784 HEAP_ZERO_MEMORY,
785 sizeof(LOGPALETTE) +
786 (VGA_AC_PAL_F_REG + 1) * sizeof(PALETTEENTRY));
787 if ((Palette == NULL) || (TextPalette == NULL)) goto Cleanup;
788
789 /* Initialize the palettes */
790 Palette->palVersion = TextPalette->palVersion = 0x0300;
791 Palette->palNumEntries = VGA_MAX_COLORS;
792 TextPalette->palNumEntries = VGA_AC_PAL_F_REG + 1;
793
794 /* Restore the default graphics palette */
795 VgaRestoreDefaultPalette(Palette->palPalEntry, Palette->palNumEntries);
796
797 /* Set the default text palette */
798 for (i = 0; i < TextPalette->palNumEntries; i++)
799 {
800 /* Set the palette entries */
801 TextPalette->palPalEntry[i].peRed = GetRValue(ConsoleColors[i]);
802 TextPalette->palPalEntry[i].peGreen = GetGValue(ConsoleColors[i]);
803 TextPalette->palPalEntry[i].peBlue = GetBValue(ConsoleColors[i]);
804 TextPalette->palPalEntry[i].peFlags = 0;
805 }
806
807 /* Create the palettes */
808 PaletteHandle = CreatePalette(Palette);
809 TextPaletteHandle = CreatePalette(TextPalette);
810
811 if (PaletteHandle != NULL && TextPaletteHandle != NULL)
812 {
813 /* The palettes have been created successfully */
814 Result = TRUE;
815 }
816
817 Cleanup:
818 /* Free the palettes */
819 if (Palette) RtlFreeHeap(RtlGetProcessHeap(), 0, Palette);
820 if (TextPalette) RtlFreeHeap(RtlGetProcessHeap(), 0, TextPalette);
821
822 if (!Result)
823 {
824 /* Something failed, delete the palettes */
825 if (PaletteHandle) DeleteObject(PaletteHandle);
826 if (TextPaletteHandle) DeleteObject(TextPaletteHandle);
827 }
828
829 return Result;
830 }
831
832 static VOID VgaResetPalette(VOID)
833 {
834 PALETTEENTRY Entries[VGA_MAX_COLORS];
835
836 /* Restore the default palette */
837 VgaRestoreDefaultPalette(Entries, VGA_MAX_COLORS);
838 SetPaletteEntries(PaletteHandle, 0, VGA_MAX_COLORS, Entries);
839 PaletteChanged = TRUE;
840 }
841
842 static VOID VgaSetActiveScreenBuffer(HANDLE ScreenBuffer)
843 {
844 /* Set the active buffer */
845 SetConsoleActiveScreenBuffer(ScreenBuffer);
846
847 /* Reinitialize the VDM menu */
848 DestroyVdmMenu();
849 CreateVdmMenu(ScreenBuffer);
850 }
851
852 static BOOL VgaEnterGraphicsMode(PCOORD Resolution)
853 {
854 DWORD i;
855 CONSOLE_GRAPHICS_BUFFER_INFO GraphicsBufferInfo;
856 BYTE BitmapInfoBuffer[VGA_BITMAP_INFO_SIZE];
857 LPBITMAPINFO BitmapInfo = (LPBITMAPINFO)BitmapInfoBuffer;
858 LPWORD PaletteIndex = (LPWORD)(BitmapInfo->bmiColors);
859
860 LONG Width = Resolution->X;
861 LONG Height = Resolution->Y;
862
863 /* Use DoubleVision mode if the resolution is too small */
864 DoubleWidth = (Width < VGA_MINIMUM_WIDTH);
865 if (DoubleWidth) Width *= 2;
866 DoubleHeight = (Height < VGA_MINIMUM_HEIGHT);
867 if (DoubleHeight) Height *= 2;
868
869 /* Fill the bitmap info header */
870 RtlZeroMemory(&BitmapInfo->bmiHeader, sizeof(BitmapInfo->bmiHeader));
871 BitmapInfo->bmiHeader.biSize = sizeof(BitmapInfo->bmiHeader);
872 BitmapInfo->bmiHeader.biWidth = Width;
873 BitmapInfo->bmiHeader.biHeight = Height;
874 BitmapInfo->bmiHeader.biBitCount = 8;
875 BitmapInfo->bmiHeader.biPlanes = 1;
876 BitmapInfo->bmiHeader.biCompression = BI_RGB;
877 BitmapInfo->bmiHeader.biSizeImage = Width * Height /* * 1 == biBitCount / 8 */;
878
879 /* Fill the palette data */
880 for (i = 0; i < (VGA_PALETTE_SIZE / 3); i++) PaletteIndex[i] = (WORD)i;
881
882 /* Fill the console graphics buffer info */
883 GraphicsBufferInfo.dwBitMapInfoLength = VGA_BITMAP_INFO_SIZE;
884 GraphicsBufferInfo.lpBitMapInfo = BitmapInfo;
885 GraphicsBufferInfo.dwUsage = DIB_PAL_COLORS;
886
887 /* Create the buffer */
888 GraphicsConsoleBuffer = CreateConsoleScreenBuffer(GENERIC_READ | GENERIC_WRITE,
889 FILE_SHARE_READ | FILE_SHARE_WRITE,
890 NULL,
891 CONSOLE_GRAPHICS_BUFFER,
892 &GraphicsBufferInfo);
893 if (GraphicsConsoleBuffer == INVALID_HANDLE_VALUE) return FALSE;
894
895 /* Save the framebuffer address and mutex */
896 ConsoleFramebuffer = GraphicsBufferInfo.lpBitMap;
897 ConsoleMutex = GraphicsBufferInfo.hMutex;
898
899 /* Clear the framebuffer */
900 RtlZeroMemory(ConsoleFramebuffer, BitmapInfo->bmiHeader.biSizeImage);
901
902 /* Set the active buffer */
903 VgaSetActiveScreenBuffer(GraphicsConsoleBuffer);
904
905 /* Set the graphics mode palette */
906 SetConsolePalette(GraphicsConsoleBuffer,
907 PaletteHandle,
908 SYSPAL_NOSTATIC256);
909
910 /* Set the screen mode flag */
911 ScreenMode = GRAPHICS_MODE;
912
913 return TRUE;
914 }
915
916 static VOID VgaLeaveGraphicsMode(VOID)
917 {
918 /* Release the console framebuffer mutex */
919 ReleaseMutex(ConsoleMutex);
920
921 /* Switch back to the default console text buffer */
922 // VgaSetActiveScreenBuffer(TextConsoleBuffer);
923
924 /* Cleanup the video data */
925 CloseHandle(ConsoleMutex);
926 ConsoleMutex = NULL;
927 ConsoleFramebuffer = NULL;
928 CloseHandle(GraphicsConsoleBuffer);
929 GraphicsConsoleBuffer = NULL;
930
931 DoubleWidth = FALSE;
932 DoubleHeight = FALSE;
933 }
934
935 static BOOL VgaEnterTextMode(PCOORD Resolution)
936 {
937 /* Switch to the text buffer */
938 VgaSetActiveScreenBuffer(TextConsoleBuffer);
939
940 /* Adjust the text framebuffer if we changed the resolution */
941 if (TextResolution.X != Resolution->X ||
942 TextResolution.Y != Resolution->Y)
943 {
944 VgaDetachFromConsole(TRUE);
945
946 /*
947 * VgaAttachToConsoleInternal sets TextResolution to the
948 * new resolution and updates ConsoleInfo.
949 */
950 if (!VgaAttachToConsoleInternal(Resolution))
951 {
952 DisplayMessage(L"An unexpected error occurred!\n");
953 EmulatorTerminate();
954 return FALSE;
955 }
956 }
957 else
958 {
959 VgaUpdateCursorPosition();
960 }
961
962 /* The active framebuffer is now the text framebuffer */
963 ConsoleFramebuffer = TextFramebuffer;
964
965 /*
966 * Set the text mode palette.
967 *
968 * WARNING: This call should fail on Windows (and therefore
969 * we get the default palette and our external behaviour is
970 * just like Windows' one), but it should success on ReactOS
971 * (so that we get console palette changes even for text-mode
972 * screen-buffers, which is a new feature on ReactOS).
973 */
974 SetConsolePalette(TextConsoleBuffer,
975 TextPaletteHandle,
976 SYSPAL_NOSTATIC256);
977
978 /* Set the screen mode flag */
979 ScreenMode = TEXT_MODE;
980
981 return TRUE;
982 }
983
984 static VOID VgaLeaveTextMode(VOID)
985 {
986 /* Reset the active framebuffer */
987 ConsoleFramebuffer = NULL;
988 }
989
990 static VOID VgaChangeMode(VOID)
991 {
992 COORD NewResolution = VgaGetDisplayResolution();
993 SCREEN_MODE NewScreenMode =
994 !(VgaGcRegisters[VGA_GC_MISC_REG] & VGA_GC_MISC_NOALPHA) ? TEXT_MODE
995 : GRAPHICS_MODE;
996
997 /*
998 * No need to switch to a different screen mode + resolution
999 * if the new ones are the same as the old ones.
1000 */
1001 if ((ScreenMode == NewScreenMode) &&
1002 (CurrResolution.X == NewResolution.X && CurrResolution.Y == NewResolution.Y))
1003 {
1004 goto Quit;
1005 }
1006
1007 if (ScreenMode == GRAPHICS_MODE)
1008 {
1009 /* Leave the current graphics mode */
1010 VgaLeaveGraphicsMode();
1011 }
1012 else
1013 {
1014 /* Leave the current text mode */
1015 VgaLeaveTextMode();
1016 }
1017
1018 /* Update the current resolution */
1019 CurrResolution = NewResolution;
1020
1021 /* The new screen mode will be updated via the VgaEnterText/GraphicsMode functions */
1022
1023 /* Check if the new mode is alphanumeric */
1024 if (NewScreenMode == TEXT_MODE)
1025 {
1026 /* Enter new text mode */
1027 if (!VgaEnterTextMode(&CurrResolution))
1028 {
1029 DisplayMessage(L"An unexpected VGA error occurred while switching into text mode. Error: %u", GetLastError());
1030 EmulatorTerminate();
1031 return;
1032 }
1033 }
1034 else
1035 {
1036 /* Enter graphics mode */
1037 if (!VgaEnterGraphicsMode(&CurrResolution))
1038 {
1039 DisplayMessage(L"An unexpected VGA error occurred while switching into graphics mode. Error: %u", GetLastError());
1040 EmulatorTerminate();
1041 return;
1042 }
1043 }
1044
1045 Quit:
1046
1047 /* Trigger a full update of the screen */
1048 NeedsUpdate = TRUE;
1049 UpdateRectangle.Left = 0;
1050 UpdateRectangle.Top = 0;
1051 UpdateRectangle.Right = CurrResolution.X;
1052 UpdateRectangle.Bottom = CurrResolution.Y;
1053
1054 /* Reset the mode change flag */
1055 ModeChanged = FALSE;
1056 }
1057
1058 static VOID VgaUpdateFramebuffer(VOID)
1059 {
1060 SHORT i, j, k;
1061 DWORD AddressSize = VgaGetAddressSize();
1062 DWORD ScanlineSize = (DWORD)VgaCrtcRegisters[VGA_CRTC_OFFSET_REG] * 2;
1063 BYTE PresetRowScan = VgaCrtcRegisters[VGA_CRTC_PRESET_ROW_SCAN_REG] & 0x1F;
1064 DWORD Address = MAKEWORD(VgaCrtcRegisters[VGA_CRTC_START_ADDR_LOW_REG],
1065 VgaCrtcRegisters[VGA_CRTC_START_ADDR_HIGH_REG])
1066 + PresetRowScan * ScanlineSize
1067 + ((VgaCrtcRegisters[VGA_CRTC_PRESET_ROW_SCAN_REG] >> 5) & 3);
1068
1069 /*
1070 * If console framebuffer is NULL, that means something went wrong
1071 * earlier and this is the final display refresh.
1072 */
1073 if (ConsoleFramebuffer == NULL) return;
1074
1075 /* Check if we are in text or graphics mode */
1076 if (ScreenMode == GRAPHICS_MODE)
1077 {
1078 /* Graphics mode */
1079 PBYTE GraphicsBuffer = (PBYTE)ConsoleFramebuffer;
1080 DWORD InterlaceHighBit = VGA_INTERLACE_HIGH_BIT;
1081 SHORT X;
1082
1083 /*
1084 * Synchronize access to the graphics framebuffer
1085 * with the console framebuffer mutex.
1086 */
1087 WaitForSingleObject(ConsoleMutex, INFINITE);
1088
1089 /* Shift the high bit right by 1 in odd/even mode */
1090 if (VgaGcRegisters[VGA_GC_MODE_REG] & VGA_GC_MODE_OE)
1091 {
1092 InterlaceHighBit >>= 1;
1093 }
1094
1095 /* Loop through the scanlines */
1096 for (i = 0; i < CurrResolution.Y; i++)
1097 {
1098 if ((VgaGcRegisters[VGA_GC_MISC_REG] & VGA_GC_MISC_OE) && (i & 1))
1099 {
1100 /* Odd-numbered line in interlaced mode - set the high bit */
1101 Address |= InterlaceHighBit;
1102 }
1103
1104 /* Loop through the pixels */
1105 for (j = 0; j < CurrResolution.X; j++)
1106 {
1107 BYTE PixelData = 0;
1108
1109 /* Apply horizontal pixel panning */
1110 if (VgaAcRegisters[VGA_AC_CONTROL_REG] & VGA_AC_CONTROL_8BIT)
1111 {
1112 X = j + ((VgaAcRegisters[VGA_AC_HORZ_PANNING_REG] & 0x0F) >> 1);
1113 }
1114 else
1115 {
1116 X = j + (VgaAcRegisters[VGA_AC_HORZ_PANNING_REG] & 0x0F);
1117 }
1118
1119 /* Check the shifting mode */
1120 if (VgaGcRegisters[VGA_GC_MODE_REG] & VGA_GC_MODE_SHIFT256)
1121 {
1122 /* 4 bits shifted from each plane */
1123
1124 /* Check if this is 16 or 256 color mode */
1125 if (VgaAcRegisters[VGA_AC_CONTROL_REG] & VGA_AC_CONTROL_8BIT)
1126 {
1127 /* One byte per pixel */
1128 PixelData = VgaMemory[(X % VGA_NUM_BANKS) * VGA_BANK_SIZE
1129 + LOWORD((Address + (X / VGA_NUM_BANKS))
1130 * AddressSize)];
1131 }
1132 else
1133 {
1134 /* 4-bits per pixel */
1135
1136 PixelData = VgaMemory[(X % VGA_NUM_BANKS) * VGA_BANK_SIZE
1137 + LOWORD((Address + (X / (VGA_NUM_BANKS * 2)))
1138 * AddressSize)];
1139
1140 /* Check if we should use the highest 4 bits or lowest 4 */
1141 if (((X / VGA_NUM_BANKS) % 2) == 0)
1142 {
1143 /* Highest 4 */
1144 PixelData >>= 4;
1145 }
1146 else
1147 {
1148 /* Lowest 4 */
1149 PixelData &= 0x0F;
1150 }
1151 }
1152 }
1153 else if (VgaGcRegisters[VGA_GC_MODE_REG] & VGA_GC_MODE_SHIFTREG)
1154 {
1155 /* Check if this is 16 or 256 color mode */
1156 if (VgaAcRegisters[VGA_AC_CONTROL_REG] & VGA_AC_CONTROL_8BIT)
1157 {
1158 // TODO: NOT IMPLEMENTED
1159 DPRINT1("8-bit interleaved mode is not implemented!\n");
1160 }
1161 else
1162 {
1163 /*
1164 * 2 bits shifted from plane 0 and 2 for the first 4 pixels,
1165 * then 2 bits shifted from plane 1 and 3 for the next 4
1166 */
1167 DWORD BankNumber = (X / 4) % 2;
1168 DWORD Offset = Address + (X / 8);
1169 BYTE LowPlaneData = VgaMemory[BankNumber * VGA_BANK_SIZE + LOWORD(Offset * AddressSize)];
1170 BYTE HighPlaneData = VgaMemory[(BankNumber + 2) * VGA_BANK_SIZE + LOWORD(Offset * AddressSize)];
1171
1172 /* Extract the two bits from each plane */
1173 LowPlaneData = (LowPlaneData >> (6 - ((X % 4) * 2))) & 0x03;
1174 HighPlaneData = (HighPlaneData >> (6 - ((X % 4) * 2))) & 0x03;
1175
1176 /* Combine them into the pixel */
1177 PixelData = LowPlaneData | (HighPlaneData << 2);
1178 }
1179 }
1180 else
1181 {
1182 /* 1 bit shifted from each plane */
1183
1184 /* Check if this is 16 or 256 color mode */
1185 if (VgaAcRegisters[VGA_AC_CONTROL_REG] & VGA_AC_CONTROL_8BIT)
1186 {
1187 /* 8 bits per pixel, 2 on each plane */
1188
1189 for (k = 0; k < VGA_NUM_BANKS; k++)
1190 {
1191 /* The data is on plane k, 4 pixels per byte */
1192 BYTE PlaneData = VgaMemory[k * VGA_BANK_SIZE
1193 + LOWORD((Address + (X / VGA_NUM_BANKS))
1194 * AddressSize)];
1195
1196 /* The mask of the first bit in the pair */
1197 BYTE BitMask = 1 << (((3 - (X % VGA_NUM_BANKS)) * 2) + 1);
1198
1199 /* Bits 0, 1, 2 and 3 come from the first bit of the pair */
1200 if (PlaneData & BitMask) PixelData |= 1 << k;
1201
1202 /* Bits 4, 5, 6 and 7 come from the second bit of the pair */
1203 if (PlaneData & (BitMask >> 1)) PixelData |= 1 << (k + 4);
1204 }
1205 }
1206 else
1207 {
1208 /* 4 bits per pixel, 1 on each plane */
1209
1210 for (k = 0; k < VGA_NUM_BANKS; k++)
1211 {
1212 BYTE PlaneData = VgaMemory[k * VGA_BANK_SIZE
1213 + LOWORD((Address + (X / (VGA_NUM_BANKS * 2)))
1214 * AddressSize)];
1215
1216 /* If the bit on that plane is set, set it */
1217 if (PlaneData & (1 << (7 - (X % 8)))) PixelData |= 1 << k;
1218 }
1219 }
1220 }
1221
1222 if (!(VgaAcRegisters[VGA_AC_CONTROL_REG] & VGA_AC_CONTROL_8BIT))
1223 {
1224 /*
1225 * In 16 color mode, the value is an index to the AC registers
1226 * if external palette access is disabled, otherwise (in case
1227 * of palette loading) it is a blank pixel.
1228 */
1229 PixelData = (VgaAcPalDisable ? VgaAcRegisters[PixelData & 0x0F]
1230 : 0);
1231 }
1232
1233 /* Take into account DoubleVision mode when checking for pixel updates */
1234 if (DoubleWidth && DoubleHeight)
1235 {
1236 /* Now check if the resulting pixel data has changed */
1237 if (GraphicsBuffer[(i * 2 * CurrResolution.X * 2) + (j * 2)] != PixelData)
1238 {
1239 /* Yes, write the new value */
1240 GraphicsBuffer[(i * 2 * CurrResolution.X * 2) + (j * 2)] = PixelData;
1241 GraphicsBuffer[(i * 2 * CurrResolution.X * 2) + (j * 2 + 1)] = PixelData;
1242 GraphicsBuffer[((i * 2 + 1) * CurrResolution.X * 2) + (j * 2)] = PixelData;
1243 GraphicsBuffer[((i * 2 + 1) * CurrResolution.X * 2) + (j * 2 + 1)] = PixelData;
1244
1245 /* Mark the specified pixel as changed */
1246 VgaMarkForUpdate(i, j);
1247 }
1248 }
1249 else if (DoubleWidth && !DoubleHeight)
1250 {
1251 /* Now check if the resulting pixel data has changed */
1252 if (GraphicsBuffer[(i * CurrResolution.X * 2) + (j * 2)] != PixelData)
1253 {
1254 /* Yes, write the new value */
1255 GraphicsBuffer[(i * CurrResolution.X * 2) + (j * 2)] = PixelData;
1256 GraphicsBuffer[(i * CurrResolution.X * 2) + (j * 2 + 1)] = PixelData;
1257
1258 /* Mark the specified pixel as changed */
1259 VgaMarkForUpdate(i, j);
1260 }
1261 }
1262 else if (!DoubleWidth && DoubleHeight)
1263 {
1264 /* Now check if the resulting pixel data has changed */
1265 if (GraphicsBuffer[(i * 2 * CurrResolution.X) + j] != PixelData)
1266 {
1267 /* Yes, write the new value */
1268 GraphicsBuffer[(i * 2 * CurrResolution.X) + j] = PixelData;
1269 GraphicsBuffer[((i * 2 + 1) * CurrResolution.X) + j] = PixelData;
1270
1271 /* Mark the specified pixel as changed */
1272 VgaMarkForUpdate(i, j);
1273 }
1274 }
1275 else // if (!DoubleWidth && !DoubleHeight)
1276 {
1277 /* Now check if the resulting pixel data has changed */
1278 if (GraphicsBuffer[i * CurrResolution.X + j] != PixelData)
1279 {
1280 /* Yes, write the new value */
1281 GraphicsBuffer[i * CurrResolution.X + j] = PixelData;
1282
1283 /* Mark the specified pixel as changed */
1284 VgaMarkForUpdate(i, j);
1285 }
1286 }
1287 }
1288
1289 if ((VgaGcRegisters[VGA_GC_MISC_REG] & VGA_GC_MISC_OE) && (i & 1))
1290 {
1291 /* Clear the high bit */
1292 Address &= ~InterlaceHighBit;
1293 }
1294
1295 if (!(VgaGcRegisters[VGA_GC_MISC_REG] & VGA_GC_MISC_OE) || (i & 1))
1296 {
1297 /* Move to the next scanline */
1298 Address += ScanlineSize;
1299 }
1300 }
1301
1302 /*
1303 * Release the console framebuffer mutex
1304 * so that we allow for repainting.
1305 */
1306 ReleaseMutex(ConsoleMutex);
1307 }
1308 else
1309 {
1310 /* Text mode */
1311 DWORD CurrentAddr;
1312 PCHAR_CELL CharBuffer = (PCHAR_CELL)ConsoleFramebuffer;
1313 CHAR_CELL CharInfo;
1314
1315 /*
1316 * Technically, the horizontal panning and preset row count should
1317 * affect text mode too. However, it works on pixels and not characters,
1318 * so we can't support it currently.
1319 */
1320
1321 /* Loop through the scanlines */
1322 for (i = 0; i < CurrResolution.Y; i++)
1323 {
1324 /* Loop through the characters */
1325 for (j = 0; j < CurrResolution.X; j++)
1326 {
1327 CurrentAddr = LOWORD((Address + j) * AddressSize);
1328
1329 /* Plane 0 holds the character itself */
1330 CharInfo.Char = VgaMemory[CurrentAddr];
1331
1332 /* Plane 1 holds the attribute */
1333 CharInfo.Attributes = VgaMemory[CurrentAddr + VGA_BANK_SIZE];
1334
1335 /* Now check if the resulting character data has changed */
1336 if ((CharBuffer[i * CurrResolution.X + j].Char != CharInfo.Char) ||
1337 (CharBuffer[i * CurrResolution.X + j].Attributes != CharInfo.Attributes))
1338 {
1339 /* Yes, write the new value */
1340 CharBuffer[i * CurrResolution.X + j] = CharInfo;
1341
1342 /* Mark the specified cell as changed */
1343 VgaMarkForUpdate(i, j);
1344 }
1345 }
1346
1347 /* Move to the next scanline */
1348 Address += ScanlineSize;
1349 }
1350 }
1351 }
1352
1353 static VOID VgaUpdateTextCursor(VOID)
1354 {
1355 COORD Position;
1356 CONSOLE_CURSOR_INFO CursorInfo;
1357
1358 BOOL CursorVisible = !(VgaCrtcRegisters[VGA_CRTC_CURSOR_START_REG] & 0x20);
1359 BYTE CursorStart = VgaCrtcRegisters[VGA_CRTC_CURSOR_START_REG] & 0x1F;
1360 BYTE CursorEnd = VgaCrtcRegisters[VGA_CRTC_CURSOR_END_REG] & 0x1F;
1361
1362 DWORD ScanlineSize = (DWORD)VgaCrtcRegisters[VGA_CRTC_OFFSET_REG] * 2;
1363 BYTE TextSize = 1 + (VgaCrtcRegisters[VGA_CRTC_MAX_SCAN_LINE_REG] & 0x1F);
1364 WORD Location = MAKEWORD(VgaCrtcRegisters[VGA_CRTC_CURSOR_LOC_LOW_REG],
1365 VgaCrtcRegisters[VGA_CRTC_CURSOR_LOC_HIGH_REG]);
1366
1367 /* Just return if we are not in text mode */
1368 if (ScreenMode != TEXT_MODE) return;
1369
1370 if (CursorStart < CursorEnd)
1371 {
1372 /* Visible cursor */
1373 CursorInfo.bVisible = CursorVisible;
1374 CursorInfo.dwSize = (100 * (CursorEnd - CursorStart)) / TextSize;
1375 }
1376 else
1377 {
1378 /* Hidden cursor */
1379 CursorInfo.bVisible = FALSE;
1380 CursorInfo.dwSize = 1; // The size needs to be non-null in order SetConsoleCursorInfo to succeed.
1381 }
1382
1383 /* Add the cursor skew to the location */
1384 Location += (VgaCrtcRegisters[VGA_CRTC_CURSOR_END_REG] >> 5) & 0x03;
1385
1386 /* Find the coordinates of the new position */
1387 Position.X = (SHORT)(Location % ScanlineSize);
1388 Position.Y = (SHORT)(Location / ScanlineSize);
1389
1390 DPRINT("VgaUpdateTextCursor: X = %d ; Y = %d\n", Position.X, Position.Y);
1391
1392 /* Update the physical cursor */
1393 SetConsoleCursorInfo(TextConsoleBuffer, &CursorInfo);
1394 SetConsoleCursorPosition(TextConsoleBuffer, Position);
1395
1396 /* Reset the cursor changed flag */
1397 CursorChanged = FALSE;
1398 }
1399
1400 static BYTE WINAPI VgaReadPort(USHORT Port)
1401 {
1402 DPRINT("VgaReadPort: Port 0x%X\n", Port);
1403
1404 switch (Port)
1405 {
1406 case VGA_MISC_READ:
1407 return VgaMiscRegister;
1408
1409 case VGA_INSTAT0_READ:
1410 return 0; // Not implemented
1411
1412 case VGA_INSTAT1_READ_MONO:
1413 case VGA_INSTAT1_READ_COLOR:
1414 {
1415 BYTE Result = 0;
1416 BOOLEAN Vsync = InVerticalRetrace;
1417 BOOLEAN Hsync = InHorizontalRetrace;
1418
1419 /* Reset the AC latch */
1420 VgaAcLatch = FALSE;
1421
1422 /* Reverse the polarity, if needed */
1423 if (VgaMiscRegister & VGA_MISC_VSYNCP) Vsync = !Vsync;
1424 if (VgaMiscRegister & VGA_MISC_HSYNCP) Hsync = !Hsync;
1425
1426 /* Set a flag if there is a vertical or horizontal retrace */
1427 if (Vsync || Hsync) Result |= VGA_STAT_DD;
1428
1429 /* Set an additional flag if there was a vertical retrace */
1430 if (Vsync) Result |= VGA_STAT_VRETRACE;
1431
1432 /* Clear the flags */
1433 InHorizontalRetrace = InVerticalRetrace = FALSE;
1434
1435 return Result;
1436 }
1437
1438 case VGA_FEATURE_READ:
1439 return VgaFeatureRegister;
1440
1441 case VGA_AC_INDEX:
1442 return VgaAcIndex;
1443
1444 case VGA_AC_READ:
1445 return VgaAcRegisters[VgaAcIndex];
1446
1447 case VGA_SEQ_INDEX:
1448 return VgaSeqIndex;
1449
1450 case VGA_SEQ_DATA:
1451 return VgaSeqRegisters[VgaSeqIndex];
1452
1453 case VGA_DAC_MASK:
1454 return VgaDacMask;
1455
1456 case VGA_DAC_READ_INDEX:
1457 /* This returns the read/write state */
1458 return (VgaDacReadWrite ? 0 : 3);
1459
1460 case VGA_DAC_WRITE_INDEX:
1461 return (VgaDacIndex / 3);
1462
1463 case VGA_DAC_DATA:
1464 {
1465 /* Ignore reads in write mode */
1466 if (!VgaDacReadWrite)
1467 {
1468 BYTE Data = VgaDacRegisters[VgaDacIndex++];
1469 VgaDacIndex %= VGA_PALETTE_SIZE;
1470 return Data;
1471 }
1472
1473 break;
1474 }
1475
1476 case VGA_CRTC_INDEX_MONO:
1477 case VGA_CRTC_INDEX_COLOR:
1478 return VgaCrtcIndex;
1479
1480 case VGA_CRTC_DATA_MONO:
1481 case VGA_CRTC_DATA_COLOR:
1482 return VgaCrtcRegisters[VgaCrtcIndex];
1483
1484 case VGA_GC_INDEX:
1485 return VgaGcIndex;
1486
1487 case VGA_GC_DATA:
1488 return VgaGcRegisters[VgaGcIndex];
1489
1490 default:
1491 DPRINT1("VgaReadPort: Unknown port 0x%X\n", Port);
1492 break;
1493 }
1494
1495 return 0;
1496 }
1497
1498 static inline VOID VgaWriteSequencer(BYTE Data)
1499 {
1500 ASSERT(VgaSeqIndex < VGA_SEQ_MAX_REG);
1501
1502 /* Save the value */
1503 VgaSeqRegisters[VgaSeqIndex] = Data;
1504 }
1505
1506 static inline VOID VgaWriteGc(BYTE Data)
1507 {
1508 ASSERT(VgaGcIndex < VGA_GC_MAX_REG);
1509
1510 /* Save the value */
1511 VgaGcRegisters[VgaGcIndex] = Data;
1512
1513 /* Check the index */
1514 switch (VgaGcIndex)
1515 {
1516 case VGA_GC_MISC_REG:
1517 {
1518 /* The GC misc register decides if it's text or graphics mode */
1519 ModeChanged = TRUE;
1520 break;
1521 }
1522 }
1523 }
1524
1525 static inline VOID VgaWriteCrtc(BYTE Data)
1526 {
1527 ASSERT(VgaGcIndex < VGA_CRTC_MAX_REG);
1528
1529 /* Save the value */
1530 VgaCrtcRegisters[VgaCrtcIndex] = Data;
1531
1532 /* Check the index */
1533 switch (VgaCrtcIndex)
1534 {
1535 case VGA_CRTC_END_HORZ_DISP_REG:
1536 case VGA_CRTC_VERT_DISP_END_REG:
1537 case VGA_CRTC_OVERFLOW_REG:
1538 case VGA_CRTC_MAX_SCAN_LINE_REG:
1539 {
1540 /* The video mode has changed */
1541 ModeChanged = TRUE;
1542 break;
1543 }
1544
1545 case VGA_CRTC_CURSOR_LOC_LOW_REG:
1546 case VGA_CRTC_CURSOR_LOC_HIGH_REG:
1547 case VGA_CRTC_CURSOR_START_REG:
1548 case VGA_CRTC_CURSOR_END_REG:
1549 {
1550 /* Set the cursor changed flag */
1551 CursorChanged = TRUE;
1552 break;
1553 }
1554 }
1555 }
1556
1557 static inline VOID VgaWriteDac(BYTE Data)
1558 {
1559 INT i, PaletteIndex;
1560 PALETTEENTRY Entry;
1561
1562 /* Set the value */
1563 VgaDacRegisters[VgaDacIndex] = Data;
1564
1565 /* Find the palette index */
1566 PaletteIndex = VgaDacIndex / 3;
1567
1568 /* Fill the entry structure */
1569 Entry.peRed = VGA_DAC_TO_COLOR(VgaDacRegisters[PaletteIndex * 3]);
1570 Entry.peGreen = VGA_DAC_TO_COLOR(VgaDacRegisters[PaletteIndex * 3 + 1]);
1571 Entry.peBlue = VGA_DAC_TO_COLOR(VgaDacRegisters[PaletteIndex * 3 + 2]);
1572 Entry.peFlags = 0;
1573
1574 /* Update the palette entry */
1575 SetPaletteEntries(PaletteHandle, PaletteIndex, 1, &Entry);
1576
1577 /* Check which text palette entries are affected */
1578 for (i = 0; i <= VGA_AC_PAL_F_REG; i++)
1579 {
1580 if (VgaAcRegisters[i] == PaletteIndex)
1581 {
1582 /* Update the text palette entry */
1583 SetPaletteEntries(TextPaletteHandle, i, 1, &Entry);
1584 }
1585 }
1586
1587 /* Set the palette changed flag */
1588 PaletteChanged = TRUE;
1589
1590 /* Update the index */
1591 VgaDacIndex++;
1592 VgaDacIndex %= VGA_PALETTE_SIZE;
1593 }
1594
1595 static inline VOID VgaWriteAc(BYTE Data)
1596 {
1597 PALETTEENTRY Entry;
1598
1599 ASSERT(VgaAcIndex < VGA_AC_MAX_REG);
1600
1601 /* Save the value */
1602 if (VgaAcIndex <= VGA_AC_PAL_F_REG)
1603 {
1604 if (VgaAcPalDisable) return;
1605
1606 // DbgPrint(" AC Palette Writing %d to index %d\n", Data, VgaAcIndex);
1607 if (VgaAcRegisters[VgaAcIndex] != Data)
1608 {
1609 /* Update the AC register */
1610 VgaAcRegisters[VgaAcIndex] = Data;
1611
1612 /* Fill the entry structure */
1613 Entry.peRed = VGA_DAC_TO_COLOR(VgaDacRegisters[Data * 3]);
1614 Entry.peGreen = VGA_DAC_TO_COLOR(VgaDacRegisters[Data * 3 + 1]);
1615 Entry.peBlue = VGA_DAC_TO_COLOR(VgaDacRegisters[Data * 3 + 2]);
1616 Entry.peFlags = 0;
1617
1618 /* Update the palette entry and set the palette change flag */
1619 SetPaletteEntries(TextPaletteHandle, VgaAcIndex, 1, &Entry);
1620 PaletteChanged = TRUE;
1621 }
1622 }
1623 else
1624 {
1625 VgaAcRegisters[VgaAcIndex] = Data;
1626 }
1627 }
1628
1629 static VOID WINAPI VgaWritePort(USHORT Port, BYTE Data)
1630 {
1631 DPRINT("VgaWritePort: Port 0x%X, Data 0x%02X\n", Port, Data);
1632
1633 switch (Port)
1634 {
1635 case VGA_MISC_WRITE:
1636 {
1637 VgaMiscRegister = Data;
1638
1639 if (VgaMiscRegister & 0x01)
1640 {
1641 /* Color emulation */
1642 DPRINT1("Color emulation\n");
1643
1644 /* Register the new I/O Ports */
1645 RegisterIoPort(0x3D4, VgaReadPort, VgaWritePort); // VGA_CRTC_INDEX_COLOR
1646 RegisterIoPort(0x3D5, VgaReadPort, VgaWritePort); // VGA_CRTC_DATA_COLOR
1647 RegisterIoPort(0x3DA, VgaReadPort, VgaWritePort); // VGA_INSTAT1_READ_COLOR, VGA_FEATURE_WRITE_COLOR
1648
1649 /* Unregister the old ones */
1650 UnregisterIoPort(0x3B4); // VGA_CRTC_INDEX_MONO
1651 UnregisterIoPort(0x3B5); // VGA_CRTC_DATA_MONO
1652 UnregisterIoPort(0x3BA); // VGA_INSTAT1_READ_MONO, VGA_FEATURE_WRITE_MONO
1653 }
1654 else
1655 {
1656 /* Monochrome emulation */
1657 DPRINT1("Monochrome emulation\n");
1658
1659 /* Register the new I/O Ports */
1660 RegisterIoPort(0x3B4, VgaReadPort, VgaWritePort); // VGA_CRTC_INDEX_MONO
1661 RegisterIoPort(0x3B5, VgaReadPort, VgaWritePort); // VGA_CRTC_DATA_MONO
1662 RegisterIoPort(0x3BA, VgaReadPort, VgaWritePort); // VGA_INSTAT1_READ_MONO, VGA_FEATURE_WRITE_MONO
1663
1664 /* Unregister the old ones */
1665 UnregisterIoPort(0x3D4); // VGA_CRTC_INDEX_COLOR
1666 UnregisterIoPort(0x3D5); // VGA_CRTC_DATA_COLOR
1667 UnregisterIoPort(0x3DA); // VGA_INSTAT1_READ_COLOR, VGA_FEATURE_WRITE_COLOR
1668 }
1669
1670 // if (VgaMiscRegister & 0x02) { /* Enable RAM access */ } else { /* Disable RAM access */ }
1671 break;
1672 }
1673
1674 case VGA_FEATURE_WRITE_MONO:
1675 case VGA_FEATURE_WRITE_COLOR:
1676 {
1677 VgaFeatureRegister = Data;
1678 break;
1679 }
1680
1681 case VGA_AC_INDEX:
1682 // case VGA_AC_WRITE:
1683 {
1684 if (!VgaAcLatch)
1685 {
1686 /* Change the index */
1687 BYTE Index = Data & 0x1F;
1688 if (Index < VGA_AC_MAX_REG) VgaAcIndex = Index;
1689
1690 /*
1691 * Change palette protection by checking for
1692 * the Palette Address Source bit.
1693 */
1694 VgaAcPalDisable = (Data & 0x20) ? TRUE : FALSE;
1695 }
1696 else
1697 {
1698 /* Write the data */
1699 VgaWriteAc(Data);
1700 }
1701
1702 /* Toggle the latch */
1703 VgaAcLatch = !VgaAcLatch;
1704 break;
1705 }
1706
1707 case VGA_SEQ_INDEX:
1708 {
1709 /* Set the sequencer index register */
1710 if (Data < VGA_SEQ_MAX_REG) VgaSeqIndex = Data;
1711 break;
1712 }
1713
1714 case VGA_SEQ_DATA:
1715 {
1716 /* Call the sequencer function */
1717 VgaWriteSequencer(Data);
1718 break;
1719 }
1720
1721 case VGA_DAC_MASK:
1722 {
1723 VgaDacMask = Data;
1724 break;
1725 }
1726
1727 case VGA_DAC_READ_INDEX:
1728 {
1729 VgaDacReadWrite = FALSE;
1730 VgaDacIndex = Data * 3;
1731 break;
1732 }
1733
1734 case VGA_DAC_WRITE_INDEX:
1735 {
1736 VgaDacReadWrite = TRUE;
1737 VgaDacIndex = Data * 3;
1738 break;
1739 }
1740
1741 case VGA_DAC_DATA:
1742 {
1743 /* Ignore writes in read mode */
1744 if (VgaDacReadWrite) VgaWriteDac(Data & 0x3F);
1745 break;
1746 }
1747
1748 case VGA_CRTC_INDEX_MONO:
1749 case VGA_CRTC_INDEX_COLOR:
1750 {
1751 /* Set the CRTC index register */
1752 if (Data < VGA_CRTC_MAX_REG) VgaCrtcIndex = Data;
1753 break;
1754 }
1755
1756 case VGA_CRTC_DATA_MONO:
1757 case VGA_CRTC_DATA_COLOR:
1758 {
1759 /* Call the CRTC function */
1760 VgaWriteCrtc(Data);
1761 break;
1762 }
1763
1764 case VGA_GC_INDEX:
1765 {
1766 /* Set the GC index register */
1767 if (Data < VGA_GC_MAX_REG) VgaGcIndex = Data;
1768 break;
1769 }
1770
1771 case VGA_GC_DATA:
1772 {
1773 /* Call the GC function */
1774 VgaWriteGc(Data);
1775 break;
1776 }
1777
1778 default:
1779 DPRINT1("VgaWritePort: Unknown port 0x%X, Data 0x%02X\n", Port, Data);
1780 break;
1781 }
1782 }
1783
1784 static VOID FASTCALL VgaVerticalRetrace(ULONGLONG ElapsedTime)
1785 {
1786 HANDLE ConsoleBufferHandle = NULL;
1787
1788 UNREFERENCED_PARAMETER(ElapsedTime);
1789
1790 /* Set the vertical retrace flag */
1791 InVerticalRetrace = TRUE;
1792
1793 /* If nothing has changed, just return */
1794 // if (!ModeChanged && !CursorChanged && !PaletteChanged && !NeedsUpdate)
1795 // return;
1796
1797 /* Change the display mode */
1798 if (ModeChanged) VgaChangeMode();
1799
1800 /* Change the text cursor appearance */
1801 if (CursorChanged) VgaUpdateTextCursor();
1802
1803 if (PaletteChanged)
1804 {
1805 /* Trigger a full update of the screen */
1806 NeedsUpdate = TRUE;
1807 UpdateRectangle.Left = 0;
1808 UpdateRectangle.Top = 0;
1809 UpdateRectangle.Right = CurrResolution.X;
1810 UpdateRectangle.Bottom = CurrResolution.Y;
1811
1812 PaletteChanged = FALSE;
1813 }
1814
1815 /* Update the contents of the framebuffer */
1816 VgaUpdateFramebuffer();
1817
1818 /* Ignore if there's nothing to update */
1819 if (!NeedsUpdate) return;
1820
1821 DPRINT("Updating screen rectangle (%d, %d, %d, %d)\n",
1822 UpdateRectangle.Left,
1823 UpdateRectangle.Top,
1824 UpdateRectangle.Right,
1825 UpdateRectangle.Bottom);
1826
1827 /* Check if we are in text or graphics mode */
1828 if (ScreenMode == GRAPHICS_MODE)
1829 {
1830 /* Graphics mode */
1831 ConsoleBufferHandle = GraphicsConsoleBuffer;
1832
1833 /* In DoubleVision mode, scale the update rectangle */
1834 if (DoubleWidth)
1835 {
1836 UpdateRectangle.Left *= 2;
1837 UpdateRectangle.Right = UpdateRectangle.Right * 2 + 1;
1838 }
1839 if (DoubleHeight)
1840 {
1841 UpdateRectangle.Top *= 2;
1842 UpdateRectangle.Bottom = UpdateRectangle.Bottom * 2 + 1;
1843 }
1844 }
1845 else
1846 {
1847 /* Text mode */
1848 ConsoleBufferHandle = TextConsoleBuffer;
1849 }
1850
1851 /* Redraw the screen */
1852 __InvalidateConsoleDIBits(ConsoleBufferHandle, &UpdateRectangle);
1853
1854 /* Clear the update flag */
1855 NeedsUpdate = FALSE;
1856 }
1857
1858 static VOID FASTCALL VgaHorizontalRetrace(ULONGLONG ElapsedTime)
1859 {
1860 UNREFERENCED_PARAMETER(ElapsedTime);
1861
1862 /* Set the flag */
1863 InHorizontalRetrace = TRUE;
1864 }
1865
1866 /* PUBLIC FUNCTIONS ***********************************************************/
1867
1868 COORD VgaGetDisplayResolution(VOID)
1869 {
1870 COORD Resolution;
1871 BYTE MaximumScanLine = 1 + (VgaCrtcRegisters[VGA_CRTC_MAX_SCAN_LINE_REG] & 0x1F);
1872
1873 /* The low 8 bits are in the display registers */
1874 Resolution.X = VgaCrtcRegisters[VGA_CRTC_END_HORZ_DISP_REG];
1875 Resolution.Y = VgaCrtcRegisters[VGA_CRTC_VERT_DISP_END_REG];
1876
1877 /* Set the top bits from the overflow register */
1878 if (VgaCrtcRegisters[VGA_CRTC_OVERFLOW_REG] & VGA_CRTC_OVERFLOW_VDE8)
1879 {
1880 Resolution.Y |= 1 << 8;
1881 }
1882 if (VgaCrtcRegisters[VGA_CRTC_OVERFLOW_REG] & VGA_CRTC_OVERFLOW_VDE9)
1883 {
1884 Resolution.Y |= 1 << 9;
1885 }
1886
1887 /* Increase the values by 1 */
1888 Resolution.X++;
1889 Resolution.Y++;
1890
1891 if (VgaGcRegisters[VGA_GC_MISC_REG] & VGA_GC_MISC_NOALPHA)
1892 {
1893 /* Multiply the horizontal resolution by the 9/8 dot mode */
1894 Resolution.X *= (VgaSeqRegisters[VGA_SEQ_CLOCK_REG] & VGA_SEQ_CLOCK_98DM)
1895 ? 8 : 9;
1896
1897 /* The horizontal resolution is halved in 8-bit mode */
1898 if (VgaAcRegisters[VGA_AC_CONTROL_REG] & VGA_AC_CONTROL_8BIT) Resolution.X /= 2;
1899 }
1900
1901 if (VgaCrtcRegisters[VGA_CRTC_MAX_SCAN_LINE_REG] & VGA_CRTC_MAXSCANLINE_DOUBLE)
1902 {
1903 /* Halve the vertical resolution */
1904 Resolution.Y >>= 1;
1905 }
1906 else
1907 {
1908 /* Divide the vertical resolution by the maximum scan line (== font size in text mode) */
1909 Resolution.Y /= MaximumScanLine;
1910 }
1911
1912 /* Return the resolution */
1913 return Resolution;
1914 }
1915
1916 BOOLEAN VgaGetDoubleVisionState(PBOOLEAN Horizontal, PBOOLEAN Vertical)
1917 {
1918 if (GraphicsConsoleBuffer == NULL) return FALSE;
1919 if (Horizontal) *Horizontal = DoubleWidth;
1920 if (Vertical) *Vertical = DoubleHeight;
1921 return TRUE;
1922 }
1923
1924 VOID VgaRefreshDisplay(VOID)
1925 {
1926 VgaVerticalRetrace(0);
1927 }
1928
1929 VOID NTAPI VgaReadMemory(ULONG Address, PVOID Buffer, ULONG Size)
1930 {
1931 DWORD i, j;
1932 DWORD VideoAddress;
1933 PUCHAR BufPtr = (PUCHAR)Buffer;
1934
1935 DPRINT("VgaReadMemory: Address 0x%08X, Size %lu\n", Address, Size);
1936
1937 /* Ignore if video RAM access is disabled */
1938 if ((VgaMiscRegister & VGA_MISC_RAM_ENABLED) == 0) return;
1939
1940 if (!(VgaGcRegisters[VGA_GC_MODE_REG] & VGA_GC_MODE_READ))
1941 {
1942 /* Loop through each byte */
1943 for (i = 0; i < Size; i++)
1944 {
1945 VideoAddress = VgaTranslateReadAddress(Address + i);
1946
1947 /* Copy the value to the buffer */
1948 BufPtr[i] = VgaMemory[VideoAddress];
1949 }
1950 }
1951 else
1952 {
1953 /* Loop through each byte */
1954 for (i = 0; i < Size; i++)
1955 {
1956 BYTE Result = 0xFF;
1957
1958 /* This should always return a plane 0 address for read mode 1 */
1959 VideoAddress = VgaTranslateReadAddress(Address + i);
1960
1961 for (j = 0; j < VGA_NUM_BANKS; j++)
1962 {
1963 /* Don't consider ignored banks */
1964 if (!(VgaGcRegisters[VGA_GC_COLOR_IGNORE_REG] & (1 << j))) continue;
1965
1966 if (VgaGcRegisters[VGA_GC_COLOR_COMPARE_REG] & (1 << j))
1967 {
1968 /* Comparing with 11111111 */
1969 Result &= VgaMemory[j * VGA_BANK_SIZE + LOWORD(VideoAddress)];
1970 }
1971 else
1972 {
1973 /* Comparing with 00000000 */
1974 Result &= ~(VgaMemory[j * VGA_BANK_SIZE + LOWORD(VideoAddress)]);
1975 }
1976 }
1977
1978 /* Copy the value to the buffer */
1979 BufPtr[i] = Result;
1980 }
1981 }
1982
1983 /* Load the latch registers */
1984 VgaLatchRegisters[0] = VgaMemory[LOWORD(VideoAddress)];
1985 VgaLatchRegisters[1] = VgaMemory[VGA_BANK_SIZE + LOWORD(VideoAddress)];
1986 VgaLatchRegisters[2] = VgaMemory[(2 * VGA_BANK_SIZE) + LOWORD(VideoAddress)];
1987 VgaLatchRegisters[3] = VgaMemory[(3 * VGA_BANK_SIZE) + LOWORD(VideoAddress)];
1988 }
1989
1990 BOOLEAN NTAPI VgaWriteMemory(ULONG Address, PVOID Buffer, ULONG Size)
1991 {
1992 DWORD i, j;
1993 DWORD VideoAddress;
1994 PUCHAR BufPtr = (PUCHAR)Buffer;
1995
1996 DPRINT("VgaWriteMemory: Address 0x%08X, Size %lu\n", Address, Size);
1997
1998 /* Ignore if video RAM access is disabled */
1999 if ((VgaMiscRegister & VGA_MISC_RAM_ENABLED) == 0) return TRUE;
2000
2001 /* Also ignore if write access to all planes is disabled */
2002 if ((VgaSeqRegisters[VGA_SEQ_MASK_REG] & 0x0F) == 0x00) return TRUE;
2003
2004 /* Loop through each byte */
2005 for (i = 0; i < Size; i++)
2006 {
2007 VideoAddress = VgaTranslateWriteAddress(Address + i);
2008
2009 for (j = 0; j < VGA_NUM_BANKS; j++)
2010 {
2011 /* Make sure the page is writeable */
2012 if (!(VgaSeqRegisters[VGA_SEQ_MASK_REG] & (1 << j))) continue;
2013
2014 /* Check if this is chain-4 mode */
2015 if (VgaSeqRegisters[VGA_SEQ_MEM_REG] & VGA_SEQ_MEM_C4)
2016 {
2017 if (((Address + i) & 0x03) != j)
2018 {
2019 /* This plane will not be accessed */
2020 continue;
2021 }
2022 }
2023
2024 /* Check if this is odd-even mode */
2025 if (VgaGcRegisters[VGA_GC_MODE_REG] & VGA_GC_MODE_OE)
2026 {
2027 if (((Address + i) & 0x01) != (j & 1))
2028 {
2029 /* This plane will not be accessed */
2030 continue;
2031 }
2032 }
2033
2034 /* Copy the value to the VGA memory */
2035 VgaMemory[VideoAddress + j * VGA_BANK_SIZE] = VgaTranslateByteForWriting(BufPtr[i], j);
2036 }
2037 }
2038
2039 return TRUE;
2040 }
2041
2042 VOID VgaClearMemory(VOID)
2043 {
2044 RtlZeroMemory(VgaMemory, sizeof(VgaMemory));
2045 }
2046
2047 VOID VgaWriteFont(UINT FontNumber, CONST UCHAR* FontData, UINT Height)
2048 {
2049 UINT i, j;
2050 PUCHAR FontMemory = (PUCHAR)&VgaMemory[VGA_BANK_SIZE * VGA_FONT_BANK + (FontNumber * VGA_FONT_SIZE)];
2051
2052 ASSERT(Height <= VGA_MAX_FONT_HEIGHT);
2053
2054 for (i = 0 ; i < VGA_FONT_CHARACTERS; i++)
2055 {
2056 /* Write the character */
2057 for (j = 0; j < Height; j++)
2058 {
2059 FontMemory[i * VGA_MAX_FONT_HEIGHT + j] = FontData[i * Height + j];
2060 }
2061
2062 /* Clear the unused part */
2063 for (j = Height; j < VGA_MAX_FONT_HEIGHT; j++)
2064 {
2065 FontMemory[i * VGA_MAX_FONT_HEIGHT + j] = 0;
2066 }
2067 }
2068 }
2069
2070 VOID ScreenEventHandler(PWINDOW_BUFFER_SIZE_RECORD ScreenEvent)
2071 {
2072 DPRINT1("Screen events not handled\n");
2073 }
2074
2075 BOOL VgaAttachToConsole(VOID)
2076 {
2077 //
2078 // FIXME: We should go back to the saved screen state
2079 //
2080 if (TextResolution.X == 0 || TextResolution.Y == 0)
2081 DPRINT1("VgaAttachToConsole -- TextResolution uninitialized\n");
2082
2083 if (TextResolution.X == 0) TextResolution.X = 80;
2084 if (TextResolution.Y == 0) TextResolution.Y = 25;
2085
2086 return VgaAttachToConsoleInternal(&TextResolution);
2087 }
2088
2089 VOID VgaDetachFromConsole(BOOL ChangingMode)
2090 {
2091 ULONG dummyLength;
2092 PVOID dummyPtr;
2093 COORD dummySize = {0};
2094
2095 //
2096 // FIXME: We should save the screen state
2097 //
2098
2099 __RegisterConsoleVDM(0,
2100 NULL,
2101 NULL,
2102 NULL,
2103 0,
2104 &dummyLength,
2105 &dummyPtr,
2106 NULL,
2107 0,
2108 dummySize,
2109 &dummyPtr);
2110
2111 TextFramebuffer = NULL;
2112
2113 if (!ChangingMode)
2114 {
2115 SMALL_RECT ConRect;
2116
2117 /* Restore the old screen buffer */
2118 VgaSetActiveScreenBuffer(TextConsoleBuffer);
2119
2120 /* Restore the original console size */
2121 ConRect.Left = 0;
2122 ConRect.Top = 0;
2123 ConRect.Right = ConRect.Left + OrgConsoleBufferInfo.srWindow.Right - OrgConsoleBufferInfo.srWindow.Left;
2124 ConRect.Bottom = ConRect.Top + OrgConsoleBufferInfo.srWindow.Bottom - OrgConsoleBufferInfo.srWindow.Top ;
2125 /*
2126 * See the following trick explanation in VgaAttachToConsoleInternal.
2127 */
2128 SetConsoleScreenBufferSize(TextConsoleBuffer, OrgConsoleBufferInfo.dwSize);
2129 SetConsoleWindowInfo(TextConsoleBuffer, TRUE, &ConRect);
2130 SetConsoleScreenBufferSize(TextConsoleBuffer, OrgConsoleBufferInfo.dwSize);
2131
2132 /* Restore the original cursor shape */
2133 SetConsoleCursorInfo(TextConsoleBuffer, &OrgConsoleCursorInfo);
2134 }
2135 }
2136
2137 BOOLEAN VgaInitialize(HANDLE TextHandle)
2138 {
2139 /* Save the default text-mode console output handle */
2140 if (!IsConsoleHandle(TextHandle)) return FALSE;
2141 TextConsoleBuffer = TextHandle;
2142
2143 /* Save the original cursor and console screen buffer information */
2144 if (!GetConsoleCursorInfo(TextConsoleBuffer, &OrgConsoleCursorInfo) ||
2145 !GetConsoleScreenBufferInfo(TextConsoleBuffer, &OrgConsoleBufferInfo))
2146 {
2147 return FALSE;
2148 }
2149 ConsoleInfo = OrgConsoleBufferInfo;
2150
2151 /* Initialize the VGA palette and fail if it isn't successfully created */
2152 if (!VgaInitializePalette()) return FALSE;
2153 /***/ VgaResetPalette(); /***/
2154
2155 /* Switch to the text buffer */
2156 VgaSetActiveScreenBuffer(TextConsoleBuffer);
2157
2158 /* Clear the VGA memory */
2159 VgaClearMemory();
2160
2161 /* Register the memory hook */
2162 MemInstallFastMemoryHook((PVOID)0xA0000, 0x20000, VgaReadMemory, VgaWriteMemory);
2163
2164 /* Register the I/O Ports */
2165 RegisterIoPort(0x3CC, VgaReadPort, NULL); // VGA_MISC_READ
2166 RegisterIoPort(0x3C2, VgaReadPort, VgaWritePort); // VGA_MISC_WRITE, VGA_INSTAT0_READ
2167 RegisterIoPort(0x3CA, VgaReadPort, NULL); // VGA_FEATURE_READ
2168 RegisterIoPort(0x3C0, VgaReadPort, VgaWritePort); // VGA_AC_INDEX, VGA_AC_WRITE
2169 RegisterIoPort(0x3C1, VgaReadPort, NULL); // VGA_AC_READ
2170 RegisterIoPort(0x3C4, VgaReadPort, VgaWritePort); // VGA_SEQ_INDEX
2171 RegisterIoPort(0x3C5, VgaReadPort, VgaWritePort); // VGA_SEQ_DATA
2172 RegisterIoPort(0x3C6, VgaReadPort, VgaWritePort); // VGA_DAC_MASK
2173 RegisterIoPort(0x3C7, VgaReadPort, VgaWritePort); // VGA_DAC_READ_INDEX
2174 RegisterIoPort(0x3C8, VgaReadPort, VgaWritePort); // VGA_DAC_WRITE_INDEX
2175 RegisterIoPort(0x3C9, VgaReadPort, VgaWritePort); // VGA_DAC_DATA
2176 RegisterIoPort(0x3CE, VgaReadPort, VgaWritePort); // VGA_GC_INDEX
2177 RegisterIoPort(0x3CF, VgaReadPort, VgaWritePort); // VGA_GC_DATA
2178
2179 /* CGA ports for compatibility, unimplemented */
2180 RegisterIoPort(0x3D8, VgaReadPort, VgaWritePort); // CGA_MODE_CTRL_REG
2181 RegisterIoPort(0x3D9, VgaReadPort, VgaWritePort); // CGA_PAL_CTRL_REG
2182
2183 HSyncTimer = CreateHardwareTimer(HARDWARE_TIMER_ENABLED, HZ_TO_NS(31469), VgaHorizontalRetrace);
2184 VSyncTimer = CreateHardwareTimer(HARDWARE_TIMER_ENABLED, HZ_TO_NS(60), VgaVerticalRetrace);
2185
2186 /* Return success */
2187 return TRUE;
2188 }
2189
2190 VOID VgaCleanup(VOID)
2191 {
2192 DestroyHardwareTimer(VSyncTimer);
2193 DestroyHardwareTimer(HSyncTimer);
2194
2195 if (ScreenMode == GRAPHICS_MODE)
2196 {
2197 /* Leave the current graphics mode */
2198 VgaLeaveGraphicsMode();
2199 }
2200 else
2201 {
2202 /* Leave the current text mode */
2203 VgaLeaveTextMode();
2204 }
2205
2206 VgaDetachFromConsole(FALSE);
2207 MemRemoveFastMemoryHook((PVOID)0xA0000, 0x20000);
2208
2209 CloseHandle(AnotherEvent);
2210 CloseHandle(EndEvent);
2211 CloseHandle(StartEvent);
2212 }
2213
2214 /* EOF */
A free Windows-compatible Operating System