[NTVDM]
[reactos.git] / subsystems / ntvdm / bios.c
1 /*
2 * COPYRIGHT: GPL - See COPYING in the top level directory
3 * PROJECT: ReactOS Virtual DOS Machine
4 * FILE: bios.c
5 * PURPOSE: VDM BIOS
6 * PROGRAMMERS: Aleksandar Andrejevic <theflash AT sdf DOT lonestar DOT org>
7 */
8
9 /* INCLUDES *******************************************************************/
10
11 #define NDEBUG
12
13 #include "bios.h"
14 #include "emulator.h"
15 #include "vga.h"
16 #include "pic.h"
17 #include "ps2.h"
18 #include "timer.h"
19
20 #include "registers.h"
21
22 /* PRIVATE VARIABLES **********************************************************/
23
24 PBIOS_DATA_AREA Bda;
25 static BYTE BiosKeyboardMap[256];
26 static HANDLE BiosConsoleInput = INVALID_HANDLE_VALUE;
27 static HANDLE BiosConsoleOutput = INVALID_HANDLE_VALUE;
28 static CONSOLE_SCREEN_BUFFER_INFO BiosSavedBufferInfo;
29
30 /*
31 * VGA Register Configurations for BIOS Video Modes
32 * The configurations come from DosBox.
33 */
34 static BYTE VideoMode_40x25_text[] =
35 {
36 /* Miscellaneous Register */
37 0x67,
38
39 /* Sequencer Registers */
40 0x00, 0x08, 0x03, 0x00, 0x07,
41
42 /* GC Registers */
43 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x0E, 0x0F, 0xFF,
44
45 /* CRTC Registers */
46 0x2D, 0x27, 0x28, 0x90, 0x2B, 0xA0, 0xBF, 0x1F, 0x00, 0x4F, 0x0D, 0x0E,
47 0x00, 0x00, 0x00, 0x00, 0x9C, 0x8E, 0x8F, 0x14, 0x1F, 0x96, 0xB9, 0xA3,
48 0xFF,
49
50 /* AC Registers */
51 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x14, 0x07, 0x38, 0x39, 0x3A, 0x3B,
52 0x3C, 0x3D, 0x3E, 0x3F, 0x0C, 0x00, 0x0F, 0x08, 0x00
53 };
54
55 static BYTE VideoMode_80x25_text[] =
56 {
57 /* Miscellaneous Register */
58 0x67,
59
60 /* Sequencer Registers */
61 0x00, 0x00, 0x03, 0x00, 0x07,
62
63 /* GC Registers */
64 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x0E, 0x0F, 0xFF,
65
66 /* CRTC Registers */
67 0x5F, 0x4F, 0x50, 0x82, 0x55, 0x81, 0xBF, 0x1F, 0x00, 0x4F, 0x0D, 0x0E,
68 0x00, 0x00, 0x00, 0x00, 0x9C, 0x8E, 0x8F, 0x28, 0x1F, 0x96, 0xB9, 0xA3,
69 0xFF,
70
71 /* AC Registers */
72 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x14, 0x07, 0x38, 0x39, 0x3A, 0x3B,
73 0x3C, 0x3D, 0x3E, 0x3F, 0x0C, 0x00, 0x0F, 0x08, 0x00
74 };
75
76 static BYTE VideoMode_320x200_4color[] =
77 {
78 /* Miscellaneous Register */
79 0x63,
80
81 /* Sequencer Registers */
82 0x00, 0x09, 0x00, 0x00, 0x02,
83
84 /* GC Registers */
85 0x00, 0x00, 0x00, 0x00, 0x00, 0x20, 0x0F, 0x0F, 0xFF,
86
87 /* CRTC Registers */
88 0x2D, 0x27, 0x28, 0x90, 0x2B, 0x80, 0xBF, 0x1F, 0x00, 0xC1, 0x00, 0x00,
89 0x00, 0x00, 0x00, 0x00, 0x9C, 0x8E, 0x8F, 0x14, 0x00, 0x96, 0xB9, 0xA2,
90 0xFF,
91
92 /* AC Registers */
93 0x00, 0x13, 0x15, 0x17, 0x02, 0x04, 0x06, 0x07, 0x10, 0x11, 0x12, 0x13,
94 0x14, 0x15, 0x16, 0x17, 0x01, 0x00, 0x0F, 0x00, 0x00
95 };
96
97 static BYTE VideoMode_640x200_2color[] =
98 {
99 /* Miscellaneous Register */
100 0x63,
101
102 /* Sequencer Registers */
103 0x00, 0x09, 0x0F, 0x00, 0x02,
104
105 /* GC Registers */
106 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0F, 0x0F, 0xFF,
107
108 /* CRTC Registers */
109 0x5F, 0x4F, 0x50, 0x82, 0x54, 0x80, 0xBF, 0x1F, 0x00, 0xC1, 0x00, 0x00,
110 0x00, 0x00, 0x00, 0x00, 0x9C, 0x8E, 0x8F, 0x28, 0x00, 0x96, 0xB9, 0xC2,
111 0xFF,
112
113 /* AC Registers */
114 0x00, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17,
115 0x17, 0x17, 0x17, 0x17, 0x01, 0x00, 0x01, 0x00, 0x00
116 };
117
118 static BYTE VideoMode_320x200_16color[] =
119 {
120 /* Miscellaneous Register */
121 0x63,
122
123 /* Sequencer Registers */
124 0x00, 0x09, 0x0F, 0x00, 0x02,
125
126 /* GC Registers */
127 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x05, 0x0F, 0xFF,
128
129 /* CRTC Registers */
130 0x2D, 0x27, 0x28, 0x90, 0x2B, 0x80, 0xBF, 0x1F, 0x00, 0xC0, 0x00, 0x00,
131 0x00, 0x00, 0x00, 0x00, 0x9C, 0x8E, 0x8F, 0x14, 0x00, 0x96, 0xB9, 0xE3,
132 0xFF,
133
134 /* AC Registers */
135 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x10, 0x11, 0x12, 0x13,
136 0x14, 0x15, 0x16, 0x17, 0x01, 0x00, 0x0F, 0x00, 0x00
137 };
138
139 static BYTE VideoMode_640x200_16color[] =
140 {
141 /* Miscellaneous Register */
142 0x63,
143
144 /* Sequencer Registers */
145 0x00, 0x01, 0x0F, 0x00, 0x02,
146
147 /* GC Registers */
148 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x05, 0x0F, 0xFF,
149
150 /* CRTC Registers */
151 0x5F, 0x4F, 0x50, 0x82, 0x54, 0x80, 0xBF, 0x1F, 0x00, 0xC0, 0x00, 0x00,
152 0x00, 0x00, 0x00, 0x00, 0x9C, 0x8E, 0x8F, 0x28, 0x00, 0x96, 0xB9, 0xE3,
153 0xFF,
154
155 /* AC Registers */
156 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x10, 0x11, 0x12, 0x13,
157 0x14, 0x15, 0x16, 0x17, 0x01, 0x00, 0x0F, 0x00, 0x00
158 };
159
160 static BYTE VideoMode_640x350_16color[] =
161 {
162 /* Miscellaneous Register */
163 0xA3,
164
165 /* Sequencer Registers */
166 0x00, 0x01, 0x0F, 0x00, 0x02,
167
168 /* GC Registers */
169 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x05, 0x0F, 0xFF,
170
171 /* CRTC Registers */
172 0x5F, 0x4F, 0x50, 0x82, 0x54, 0x80, 0xBF, 0x1F, 0x00, 0x40, 0x00, 0x00,
173 0x00, 0x00, 0x00, 0x00, 0x83, 0x85, 0x5D, 0x28, 0x0F, 0x63, 0xBA, 0xE3,
174 0xFF,
175
176 /* AC Registers */
177 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x14, 0x07, 0x38, 0x39, 0x3A, 0x3B,
178 0x3C, 0x3D, 0x3E, 0x3F, 0x01, 0x00, 0x0F, 0x00, 0x00
179 };
180
181 static BYTE VideoMode_640x480_2color[] =
182 {
183 /* Miscellaneous Register */
184 0xE3,
185
186 /* Sequencer Registers */
187 0x00, 0x01, 0x0F, 0x00, 0x02,
188
189 /* GC Registers */
190 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x05, 0x0F, 0xFF,
191
192 /* CRTC Registers */
193 0x5F, 0x4F, 0x50, 0x82, 0x54, 0x80, 0x0B, 0x3E, 0x00, 0x40, 0x00, 0x00,
194 0x00, 0x00, 0x00, 0x00, 0xEA, 0x8C, 0xDF, 0x28, 0x00, 0xE7, 0x04, 0xC3,
195 0xFF,
196
197 /* AC Registers */
198 0x00, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
199 0x3F, 0x3F, 0x3F, 0x3F, 0x01, 0x00, 0x0F, 0x00, 0x00
200 };
201
202 static BYTE VideoMode_640x480_16color[] =
203 {
204 /* Miscellaneous Register */
205 0xE3,
206
207 /* Sequencer Registers */
208 0x00, 0x01, 0x0F, 0x00, 0x02,
209
210 /* GC Registers */
211 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x05, 0x0F, 0xFF,
212
213 /* CRTC Registers */
214 0x5F, 0x4F, 0x50, 0x82, 0x54, 0x80, 0x0B, 0x3E, 0x00, 0x40, 0x00, 0x00,
215 0x00, 0x00, 0x00, 0x00, 0xEA, 0x8C, 0xDF, 0x28, 0x00, 0xE7, 0x04, 0xE3,
216 0xFF,
217
218 /* AC Registers */
219 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x14, 0x07, 0x38, 0x39, 0x3A, 0x3B,
220 0x3C, 0x3D, 0x3E, 0x3F, 0x01, 0x00, 0x0F, 0x00, 0x00
221 };
222
223 static BYTE VideoMode_320x200_256color[] =
224 {
225 /* Miscellaneous Register */
226 0x63,
227
228 /* Sequencer Registers */
229 0x00, 0x01, 0x0F, 0x00, 0x0E,
230
231 /* GC Registers */
232 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F, 0xFF,
233
234 /* CRTC Registers */
235 0x5F, 0x4F, 0x50, 0x82, 0x54, 0x80, 0xBF, 0x1F, 0x00, 0x41, 0x00, 0x00,
236 0x00, 0x00, 0x00, 0x00, 0x9C, 0x8E, 0x8F, 0x28, 0x40, 0x96, 0xB9, 0xA3,
237 0xFF,
238
239 /* AC Registers */
240 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B,
241 0x0C, 0x0D, 0x0E, 0x0F, 0x41, 0x00, 0x0F, 0x00, 0x00
242 };
243
244 static LPBYTE VideoModes[] =
245 {
246 VideoMode_40x25_text, /* Mode 00h */
247 VideoMode_40x25_text, /* Mode 01h */
248 VideoMode_80x25_text, /* Mode 02h */
249 VideoMode_80x25_text, /* Mode 03h */
250 VideoMode_320x200_4color, /* Mode 04h */
251 VideoMode_320x200_4color, /* Mode 05h */
252 VideoMode_640x200_2color, /* Mode 06h */
253 NULL, /* Mode 07h */
254 NULL, /* Mode 08h */
255 NULL, /* Mode 09h */
256 NULL, /* Mode 0Ah */
257 NULL, /* Mode 0Bh */
258 NULL, /* Mode 0Ch */
259 VideoMode_320x200_16color, /* Mode 0Dh */
260 VideoMode_640x200_16color, /* Mode 0Eh */
261 NULL, /* Mode 0Fh */
262 VideoMode_640x350_16color, /* Mode 10h */
263 VideoMode_640x480_2color, /* Mode 11h */
264 VideoMode_640x480_16color, /* Mode 12h */
265 VideoMode_320x200_256color, /* Mode 13h */
266 };
267
268 /* PRIVATE FUNCTIONS **********************************************************/
269
270 static BOOLEAN BiosKbdBufferPush(WORD Data)
271 {
272 /* Get the location of the element after the tail */
273 WORD NextElement = Bda->KeybdBufferTail + 2;
274
275 /* Wrap it around if it's at or beyond the end */
276 if (NextElement >= Bda->KeybdBufferEnd) NextElement = Bda->KeybdBufferStart;
277
278 /* If it's full, fail */
279 if (NextElement == Bda->KeybdBufferHead) return FALSE;
280
281 /* Put the value in the queue */
282 *((LPWORD)((ULONG_PTR)Bda + Bda->KeybdBufferTail)) = Data;
283 Bda->KeybdBufferTail += sizeof(WORD);
284
285 /* Check if we are at, or have passed, the end of the buffer */
286 if (Bda->KeybdBufferTail >= Bda->KeybdBufferEnd)
287 {
288 /* Return it to the beginning */
289 Bda->KeybdBufferTail = Bda->KeybdBufferStart;
290 }
291
292 /* Return success */
293 return TRUE;
294 }
295
296 static BOOLEAN BiosKbdBufferTop(LPWORD Data)
297 {
298 /* If it's empty, fail */
299 if (Bda->KeybdBufferHead == Bda->KeybdBufferTail) return FALSE;
300
301 /* Otherwise, get the value and return success */
302 *Data = *((LPWORD)((ULONG_PTR)Bda + Bda->KeybdBufferHead));
303
304 return TRUE;
305 }
306
307 static BOOLEAN BiosKbdBufferPop(VOID)
308 {
309 /* If it's empty, fail */
310 if (Bda->KeybdBufferHead == Bda->KeybdBufferTail) return FALSE;
311
312 /* Remove the value from the queue */
313 Bda->KeybdBufferHead += sizeof(WORD);
314
315 /* Check if we are at, or have passed, the end of the buffer */
316 if (Bda->KeybdBufferHead >= Bda->KeybdBufferEnd)
317 {
318 /* Return it to the beginning */
319 Bda->KeybdBufferHead = Bda->KeybdBufferStart;
320 }
321
322 /* Return success */
323 return TRUE;
324 }
325
326 static VOID BiosReadWindow(LPWORD Buffer, SMALL_RECT Rectangle, BYTE Page)
327 {
328 INT i, j;
329 INT Counter = 0;
330 WORD Character;
331 DWORD VideoAddress = TO_LINEAR(TEXT_VIDEO_SEG, Page * Bda->VideoPageSize);
332
333 for (i = Rectangle.Top; i <= Rectangle.Bottom; i++)
334 {
335 for (j = Rectangle.Left; j <= Rectangle.Right; j++)
336 {
337 /* Read from video memory */
338 VgaReadMemory(VideoAddress + (i * Bda->ScreenColumns + j) * sizeof(WORD),
339 (LPVOID)&Character,
340 sizeof(WORD));
341
342 /* Write the data to the buffer in row order */
343 Buffer[Counter++] = Character;
344 }
345 }
346 }
347
348 static VOID BiosWriteWindow(LPWORD Buffer, SMALL_RECT Rectangle, BYTE Page)
349 {
350 INT i, j;
351 INT Counter = 0;
352 WORD Character;
353 DWORD VideoAddress = TO_LINEAR(TEXT_VIDEO_SEG, Page * Bda->VideoPageSize);
354
355 for (i = Rectangle.Top; i <= Rectangle.Bottom; i++)
356 {
357 for (j = Rectangle.Left; j <= Rectangle.Right; j++)
358 {
359 Character = Buffer[Counter++];
360
361 /* Write to video memory */
362 VgaWriteMemory(VideoAddress + (i * Bda->ScreenColumns + j) * sizeof(WORD),
363 (LPVOID)&Character,
364 sizeof(WORD));
365 }
366 }
367 }
368
369 /* PUBLIC FUNCTIONS ***********************************************************/
370
371 BYTE BiosGetVideoMode(VOID)
372 {
373 return Bda->VideoMode;
374 }
375
376 BOOLEAN BiosSetVideoMode(BYTE ModeNumber)
377 {
378 INT i;
379 COORD Resolution;
380 LPBYTE Values = VideoModes[ModeNumber];
381
382 if (Values == NULL) return FALSE;
383
384 /* Write the misc register */
385 VgaWritePort(VGA_MISC_WRITE, *(Values++));
386
387 /* Write the sequencer registers */
388 for (i = 0; i < VGA_SEQ_MAX_REG; i++)
389 {
390 VgaWritePort(VGA_SEQ_INDEX, i);
391 VgaWritePort(VGA_SEQ_DATA, *(Values++));
392 }
393
394 /* Write the GC registers */
395 for (i = 0; i < VGA_GC_MAX_REG; i++)
396 {
397 VgaWritePort(VGA_GC_INDEX, i);
398 VgaWritePort(VGA_GC_DATA, *(Values++));
399 }
400
401 /* Write the CRTC registers */
402 for (i = 0; i < VGA_CRTC_MAX_REG; i++)
403 {
404 VgaWritePort(VGA_CRTC_INDEX, i);
405 VgaWritePort(VGA_CRTC_DATA, *(Values++));
406 }
407
408 /* Write the AC registers */
409 for (i = 0; i < VGA_AC_MAX_REG; i++)
410 {
411 VgaWritePort(VGA_AC_INDEX, i);
412 VgaWritePort(VGA_AC_WRITE, *(Values++));
413 }
414
415 /* Update the values in the BDA */
416 Bda->VideoMode = ModeNumber;
417 Bda->VideoPage = 0;
418 Bda->VideoPageSize = BIOS_PAGE_SIZE;
419 Bda->VideoPageOffset = 0;
420
421 /* Get the character height */
422 VgaWritePort(VGA_CRTC_INDEX, VGA_CRTC_MAX_SCAN_LINE_REG);
423 Bda->CharacterHeight = 1 + (VgaReadPort(VGA_CRTC_DATA) & 0x1F);
424
425 Resolution = VgaGetDisplayResolution();
426 Bda->ScreenColumns = Resolution.X;
427 Bda->ScreenRows = Resolution.Y - 1;
428
429 return TRUE;
430 }
431
432 BOOLEAN BiosSetVideoPage(BYTE PageNumber)
433 {
434 /* Check if the page exists */
435 if (PageNumber >= BIOS_MAX_PAGES) return FALSE;
436
437 /* Check if this is the same page */
438 if (PageNumber == Bda->VideoPage) return TRUE;
439
440 /* Set the values in the BDA */
441 Bda->VideoPage = PageNumber;
442 Bda->VideoPageSize = BIOS_PAGE_SIZE;
443 Bda->VideoPageOffset = PageNumber * BIOS_PAGE_SIZE;
444
445 /* Set the start address in the CRTC */
446 VgaWritePort(VGA_CRTC_INDEX, VGA_CRTC_CURSOR_LOC_LOW_REG);
447 VgaWritePort(VGA_CRTC_DATA , LOBYTE(Bda->VideoPageOffset));
448 VgaWritePort(VGA_CRTC_INDEX, VGA_CRTC_CURSOR_LOC_HIGH_REG);
449 VgaWritePort(VGA_CRTC_DATA , HIBYTE(Bda->VideoPageOffset));
450
451 return TRUE;
452 }
453
454 BOOLEAN BiosInitialize(VOID)
455 {
456 INT i;
457 WORD Offset = 0;
458 LPWORD IntVecTable = (LPWORD)((ULONG_PTR)BaseAddress);
459 LPBYTE BiosCode = (LPBYTE)((ULONG_PTR)BaseAddress + TO_LINEAR(BIOS_SEGMENT, 0));
460
461 /* Initialize the BDA */
462 Bda = (PBIOS_DATA_AREA)((ULONG_PTR)BaseAddress + TO_LINEAR(BDA_SEGMENT, 0));
463 Bda->EquipmentList = BIOS_EQUIPMENT_LIST;
464 Bda->KeybdBufferStart = FIELD_OFFSET(BIOS_DATA_AREA, KeybdBuffer);
465 Bda->KeybdBufferEnd = Bda->KeybdBufferStart + BIOS_KBD_BUFFER_SIZE * sizeof(WORD);
466
467 /* Generate ISR stubs and fill the IVT */
468 for (i = 0; i < 256; i++)
469 {
470 IntVecTable[i * 2] = Offset;
471 IntVecTable[i * 2 + 1] = BIOS_SEGMENT;
472
473 BiosCode[Offset++] = 0xFB; // sti
474
475 BiosCode[Offset++] = 0x6A; // push i
476 BiosCode[Offset++] = (BYTE)i;
477
478 BiosCode[Offset++] = 0x6A; // push 0
479 BiosCode[Offset++] = 0x00;
480
481 BiosCode[Offset++] = 0xF8; // clc
482
483 BiosCode[Offset++] = LOBYTE(EMULATOR_BOP); // BOP sequence
484 BiosCode[Offset++] = HIBYTE(EMULATOR_BOP);
485 BiosCode[Offset++] = LOBYTE(EMULATOR_INT_BOP);
486 BiosCode[Offset++] = HIBYTE(EMULATOR_INT_BOP);
487
488 BiosCode[Offset++] = 0x73; // jnc +3
489 BiosCode[Offset++] = 0x03;
490
491 // HACK: The following instruction should be HLT!
492 BiosCode[Offset++] = 0x90; // nop
493
494 BiosCode[Offset++] = 0xEB; // jmp -10
495 BiosCode[Offset++] = 0xF6;
496
497 BiosCode[Offset++] = 0x83; // add sp, 4
498 BiosCode[Offset++] = 0xC4;
499 BiosCode[Offset++] = 0x04;
500
501 BiosCode[Offset++] = 0xCF; // iret
502 }
503
504 /* Get the input handle to the real console, and check for success */
505 BiosConsoleInput = CreateFileW(L"CONIN$",
506 GENERIC_READ | GENERIC_WRITE,
507 FILE_SHARE_READ | FILE_SHARE_WRITE,
508 NULL,
509 OPEN_EXISTING,
510 0,
511 NULL);
512 if (BiosConsoleInput == INVALID_HANDLE_VALUE)
513 {
514 return FALSE;
515 }
516
517 /* Get the output handle to the real console, and check for success */
518 BiosConsoleOutput = CreateFileW(L"CONOUT$",
519 GENERIC_READ | GENERIC_WRITE,
520 FILE_SHARE_READ | FILE_SHARE_WRITE,
521 NULL,
522 OPEN_EXISTING,
523 0,
524 NULL);
525 if (BiosConsoleOutput == INVALID_HANDLE_VALUE)
526 {
527 CloseHandle(BiosConsoleInput);
528 return FALSE;
529 }
530
531 /* Save the console screen buffer information */
532 if (!GetConsoleScreenBufferInfo(BiosConsoleOutput, &BiosSavedBufferInfo))
533 {
534 CloseHandle(BiosConsoleOutput);
535 CloseHandle(BiosConsoleInput);
536 return FALSE;
537 }
538
539 /* Initialize VGA */
540 if (!VgaInitialize(BiosConsoleOutput))
541 {
542 CloseHandle(BiosConsoleOutput);
543 CloseHandle(BiosConsoleInput);
544 return FALSE;
545 }
546
547 /* Update the cursor position */
548 BiosSetCursorPosition(BiosSavedBufferInfo.dwCursorPosition.Y,
549 BiosSavedBufferInfo.dwCursorPosition.X,
550 0);
551
552 /* Set the console input mode */
553 SetConsoleMode(BiosConsoleInput, ENABLE_MOUSE_INPUT | ENABLE_PROCESSED_INPUT);
554
555 /* Initialize the PIC */
556 PicWriteCommand(PIC_MASTER_CMD, PIC_ICW1 | PIC_ICW1_ICW4);
557 PicWriteCommand(PIC_SLAVE_CMD , PIC_ICW1 | PIC_ICW1_ICW4);
558
559 /* Set the interrupt offsets */
560 PicWriteData(PIC_MASTER_DATA, BIOS_PIC_MASTER_INT);
561 PicWriteData(PIC_SLAVE_DATA , BIOS_PIC_SLAVE_INT);
562
563 /* Tell the master PIC there is a slave at IRQ 2 */
564 PicWriteData(PIC_MASTER_DATA, 1 << 2);
565 PicWriteData(PIC_SLAVE_DATA , 2);
566
567 /* Make sure the PIC is in 8086 mode */
568 PicWriteData(PIC_MASTER_DATA, PIC_ICW4_8086);
569 PicWriteData(PIC_SLAVE_DATA , PIC_ICW4_8086);
570
571 /* Clear the masks for both PICs */
572 PicWriteData(PIC_MASTER_DATA, 0x00);
573 PicWriteData(PIC_SLAVE_DATA , 0x00);
574
575 PitWriteCommand(0x34);
576 PitWriteData(0, 0x00);
577 PitWriteData(0, 0x00);
578
579 return TRUE;
580 }
581
582 VOID BiosCleanup(VOID)
583 {
584 /* Restore the old screen buffer */
585 SetConsoleActiveScreenBuffer(BiosConsoleOutput);
586
587 /* Restore the screen buffer size */
588 SetConsoleScreenBufferSize(BiosConsoleOutput, BiosSavedBufferInfo.dwSize);
589
590 /* Close the console handles */
591 if (BiosConsoleOutput != INVALID_HANDLE_VALUE) CloseHandle(BiosConsoleOutput);
592 if (BiosConsoleInput != INVALID_HANDLE_VALUE) CloseHandle(BiosConsoleInput);
593 }
594
595 WORD BiosPeekCharacter(VOID)
596 {
597 WORD CharacterData;
598
599 /* Check if there is a key available */
600 if (Bda->KeybdBufferHead == Bda->KeybdBufferTail) return 0xFFFF;
601
602 /* Get the key from the queue, but don't remove it */
603 BiosKbdBufferTop(&CharacterData);
604
605 return CharacterData;
606 }
607
608 WORD BiosGetCharacter(VOID)
609 {
610 WORD CharacterData = 0;
611
612 /* Check if there is a key available */
613 if (Bda->KeybdBufferHead != Bda->KeybdBufferTail)
614 {
615 /* Get the key from the queue, and remove it */
616 BiosKbdBufferTop(&CharacterData);
617 BiosKbdBufferPop();
618 }
619 else
620 {
621 /* Set the handler CF to repeat the BOP */
622 EmulatorSetFlag(EMULATOR_FLAG_CF);
623 }
624
625 return CharacterData;
626 }
627
628 VOID BiosSetCursorPosition(BYTE Row, BYTE Column, BYTE Page)
629 {
630 /* Make sure the selected video page is valid */
631 if (Page >= BIOS_MAX_PAGES) return;
632
633 /* Update the position in the BDA */
634 Bda->CursorPosition[Page] = (Row << 8) | Column;
635
636 /* Check if this is the current video page */
637 if (Page == Bda->VideoPage)
638 {
639 WORD Offset = Row * Bda->ScreenColumns + Column;
640
641 /* Modify the CRTC registers */
642 VgaWritePort(VGA_CRTC_INDEX, VGA_CRTC_CURSOR_LOC_LOW_REG);
643 VgaWritePort(VGA_CRTC_DATA , LOBYTE(Offset));
644 VgaWritePort(VGA_CRTC_INDEX, VGA_CRTC_CURSOR_LOC_HIGH_REG);
645 VgaWritePort(VGA_CRTC_DATA , HIBYTE(Offset));
646 }
647 }
648
649 BOOLEAN BiosScrollWindow(INT Direction,
650 DWORD Amount,
651 SMALL_RECT Rectangle,
652 BYTE Page,
653 BYTE FillAttribute)
654 {
655 DWORD i;
656 LPWORD WindowData;
657 DWORD WindowSize = (Rectangle.Bottom - Rectangle.Top + 1)
658 * (Rectangle.Right - Rectangle.Left + 1);
659
660 /* Allocate a buffer for the window */
661 WindowData = (LPWORD)HeapAlloc(GetProcessHeap(),
662 HEAP_ZERO_MEMORY,
663 WindowSize * sizeof(WORD));
664 if (WindowData == NULL) return FALSE;
665
666 /* Read the window data */
667 BiosReadWindow(WindowData, Rectangle, Page);
668
669 if (Amount == 0)
670 {
671 /* Fill the window */
672 for (i = 0; i < WindowSize; i++)
673 {
674 WindowData[i] = ' ' | (FillAttribute << 8);
675 }
676
677 goto Done;
678 }
679
680 // TODO: Scroll the window!
681
682 Done:
683 /* Write back the window data */
684 BiosWriteWindow(WindowData, Rectangle, Page);
685
686 /* Free the window buffer */
687 HeapFree(GetProcessHeap(), 0, WindowData);
688
689 return TRUE;
690 }
691
692 VOID BiosPrintCharacter(CHAR Character, BYTE Attribute, BYTE Page)
693 {
694 WORD CharData = (Attribute << 8) | Character;
695 BYTE Row, Column;
696
697 /* Make sure the page exists */
698 if (Page >= BIOS_MAX_PAGES) return;
699
700 /* Get the cursor location */
701 Row = HIBYTE(Bda->CursorPosition[Page]);
702 Column = LOBYTE(Bda->CursorPosition[Page]);
703
704 if (Character == '\a')
705 {
706 /* Bell control character */
707 // NOTE: We may use what the terminal emulator offers to us...
708 Beep(800, 200);
709 return;
710 }
711 else if (Character == '\b')
712 {
713 /* Backspace control character */
714 if (Column > 0)
715 {
716 Column--;
717 }
718 else if (Row > 0)
719 {
720 Column = Bda->ScreenColumns - 1;
721 Row--;
722 }
723
724 /* Erase the existing character */
725 CharData = (Attribute << 8) | ' ';
726 VgaWriteMemory(TO_LINEAR(TEXT_VIDEO_SEG,
727 Page * Bda->VideoPageSize
728 + (Row * Bda->ScreenColumns + Column) * sizeof(WORD)),
729 (LPVOID)&CharData,
730 sizeof(WORD));
731 }
732 else if (Character == '\n')
733 {
734 /* Line Feed control character */
735 Row++;
736 }
737 else if (Character == '\r')
738 {
739 /* Carriage Return control character */
740 Column = 0;
741 }
742 else
743 {
744 /* Default character */
745
746 /* Write the character */
747 VgaWriteMemory(TO_LINEAR(TEXT_VIDEO_SEG,
748 Page * Bda->VideoPageSize
749 + (Row * Bda->ScreenColumns + Column) * sizeof(WORD)),
750 (LPVOID)&CharData,
751 sizeof(WORD));
752
753 /* Advance the cursor */
754 Column++;
755 }
756
757 /* Check if it passed the end of the row */
758 if (Column >= Bda->ScreenColumns)
759 {
760 /* Return to the first column and go to the next line */
761 Column = 0;
762 Row++;
763 }
764
765 /* Scroll the screen up if needed */
766 if (Row > Bda->ScreenRows)
767 {
768 /* The screen must be scrolled up */
769 SMALL_RECT Rectangle = { 0, 0, Bda->ScreenColumns - 1, Bda->ScreenRows };
770
771 BiosScrollWindow(SCROLL_DIRECTION_UP,
772 1,
773 Rectangle,
774 Page,
775 DEFAULT_ATTRIBUTE);
776 }
777
778 /* Set the cursor position */
779 BiosSetCursorPosition(Row, Column, Page);
780 }
781
782 VOID BiosVideoService(LPWORD Stack)
783 {
784 DWORD Eax = EmulatorGetRegister(EMULATOR_REG_AX);
785 DWORD Ecx = EmulatorGetRegister(EMULATOR_REG_CX);
786 DWORD Edx = EmulatorGetRegister(EMULATOR_REG_DX);
787 DWORD Ebx = EmulatorGetRegister(EMULATOR_REG_BX);
788
789 switch (HIBYTE(Eax))
790 {
791 /* Set Video Mode */
792 case 0x00:
793 {
794 BiosSetVideoMode(LOBYTE(Eax));
795 VgaClearMemory();
796 break;
797 }
798
799 /* Set Text-Mode Cursor Shape */
800 case 0x01:
801 {
802 /* Update the BDA */
803 Bda->CursorStartLine = HIBYTE(Ecx);
804 Bda->CursorEndLine = LOBYTE(Ecx);
805
806 /* Modify the CRTC registers */
807 VgaWritePort(VGA_CRTC_INDEX, VGA_CRTC_CURSOR_START_REG);
808 VgaWritePort(VGA_CRTC_DATA , Bda->CursorStartLine);
809 VgaWritePort(VGA_CRTC_INDEX, VGA_CRTC_CURSOR_END_REG);
810 VgaWritePort(VGA_CRTC_DATA , Bda->CursorEndLine);
811
812 break;
813 }
814
815 /* Set Cursor Position */
816 case 0x02:
817 {
818 BiosSetCursorPosition(HIBYTE(Edx), LOBYTE(Edx), HIBYTE(Ebx));
819 break;
820 }
821
822 /* Get Cursor Position */
823 case 0x03:
824 {
825 /* Make sure the selected video page exists */
826 if (HIBYTE(Ebx) >= BIOS_MAX_PAGES) break;
827
828 /* Return the result */
829 EmulatorSetRegister(EMULATOR_REG_AX, 0);
830 EmulatorSetRegister(EMULATOR_REG_CX,
831 (Bda->CursorStartLine << 8) | Bda->CursorEndLine);
832 EmulatorSetRegister(EMULATOR_REG_DX, Bda->CursorPosition[HIBYTE(Ebx)]);
833
834 break;
835 }
836
837 /* Query Light Pen */
838 case 0x04:
839 {
840 /*
841 * On modern BIOSes, this function returns 0
842 * so that we can ignore the other registers.
843 */
844 EmulatorSetRegister(EMULATOR_REG_AX, 0);
845 break;
846 }
847
848 /* Select Active Display Page */
849 case 0x05:
850 {
851 BiosSetVideoPage(LOBYTE(Eax));
852 break;
853 }
854
855 /* Scroll Window Up/Down */
856 case 0x06:
857 case 0x07:
858 {
859 SMALL_RECT Rectangle =
860 {
861 LOBYTE(Ecx),
862 HIBYTE(Ecx),
863 LOBYTE(Edx),
864 HIBYTE(Edx)
865 };
866
867 /* Call the internal function */
868 BiosScrollWindow((HIBYTE(Eax) == 0x06) ? SCROLL_DIRECTION_UP
869 : SCROLL_DIRECTION_DOWN,
870 LOBYTE(Eax),
871 Rectangle,
872 Bda->VideoPage,
873 HIBYTE(Ebx));
874
875 break;
876 }
877
878 /* Read/Write Character From Cursor Position */
879 case 0x08:
880 case 0x09:
881 case 0x0A:
882 {
883 WORD CharacterData = MAKEWORD(LOBYTE(Eax), LOBYTE(Ebx));
884 BYTE Page = HIBYTE(Ebx);
885 DWORD Offset;
886
887 /* Check if the page exists */
888 if (Page >= BIOS_MAX_PAGES) break;
889
890 /* Find the offset of the character */
891 Offset = Page * Bda->VideoPageSize
892 + (HIBYTE(Bda->CursorPosition[Page]) * Bda->ScreenColumns
893 + LOBYTE(Bda->CursorPosition[Page])) * 2;
894
895 if (HIBYTE(Eax) == 0x08)
896 {
897 /* Read from the video memory */
898 VgaReadMemory(TO_LINEAR(TEXT_VIDEO_SEG, Offset),
899 (LPVOID)&CharacterData,
900 sizeof(WORD));
901
902 /* Return the character in AX */
903 EmulatorSetRegister(EMULATOR_REG_AX, CharacterData);
904 }
905 else
906 {
907 /* Write to video memory */
908 VgaWriteMemory(TO_LINEAR(TEXT_VIDEO_SEG, Offset),
909 (LPVOID)&CharacterData,
910 (HIBYTE(Ebx) == 0x09) ? sizeof(WORD) : sizeof(BYTE));
911 }
912
913 break;
914 }
915
916 /* Teletype Output */
917 case 0x0E:
918 {
919 BiosPrintCharacter(LOBYTE(Eax), LOBYTE(Ebx), HIBYTE(Ebx));
920 break;
921 }
922
923 /* Get Current Video Mode */
924 case 0x0F:
925 {
926 EmulatorSetRegister(EMULATOR_REG_AX,
927 MAKEWORD(Bda->VideoMode, Bda->ScreenColumns));
928 EmulatorSetRegister(EMULATOR_REG_BX,
929 MAKEWORD(LOBYTE(Ebx), Bda->VideoPage));
930
931 break;
932 }
933
934 /* Scroll Window */
935 case 0x12:
936 {
937 SMALL_RECT Rectangle =
938 {
939 LOBYTE(Ecx),
940 HIBYTE(Ecx),
941 LOBYTE(Edx),
942 HIBYTE(Edx)
943 };
944
945 /* Call the internal function */
946 BiosScrollWindow(LOBYTE(Ebx),
947 LOBYTE(Eax),
948 Rectangle,
949 Bda->VideoPage,
950 DEFAULT_ATTRIBUTE);
951
952 break;
953 }
954
955 /* Display combination code */
956 case 0x1A:
957 {
958 switch(LOBYTE(Eax))
959 {
960 case 0x00: /* Get Display combiantion code */
961 EmulatorSetRegister(EMULATOR_REG_AX, MAKEWORD(0x1A, 0x1A));
962 EmulatorSetRegister(EMULATOR_REG_BX, MAKEWORD(0x08, 0x0)); /* VGA w/ color analog display */
963 break;
964 case 0x01: /* Set Display combination code */
965 DPRINT1("Set Display combination code - Unsupported\n");
966 break;
967 default:
968 break;
969 }
970 break;
971 }
972
973 default:
974 {
975 DPRINT1("BIOS Function INT 10h, AH = 0x%02X NOT IMPLEMENTED\n",
976 HIBYTE(Eax));
977 }
978 }
979 }
980
981 VOID BiosKeyboardService(LPWORD Stack)
982 {
983 DWORD Eax = EmulatorGetRegister(EMULATOR_REG_AX);
984
985 switch (HIBYTE(Eax))
986 {
987 /* Wait for keystroke and read */
988 case 0x00:
989 /* Wait for extended keystroke and read */
990 case 0x10: // FIXME: Temporarily do the same as INT 16h, 00h
991 {
992 /* Read the character (and wait if necessary) */
993 EmulatorSetRegister(EMULATOR_REG_AX, BiosGetCharacter());
994 break;
995 }
996
997 /* Get keystroke status */
998 case 0x01:
999 /* Get extended keystroke status */
1000 case 0x11: // FIXME: Temporarily do the same as INT 16h, 01h
1001 {
1002 WORD Data = BiosPeekCharacter();
1003
1004 if (Data != 0xFFFF)
1005 {
1006 /* There is a character, clear ZF and return it */
1007 EmulatorSetRegister(EMULATOR_REG_AX, Data);
1008 Stack[STACK_FLAGS] &= ~EMULATOR_FLAG_ZF;
1009 }
1010 else
1011 {
1012 /* No character, set ZF */
1013 Stack[STACK_FLAGS] |= EMULATOR_FLAG_ZF;
1014 }
1015
1016 break;
1017 }
1018
1019 /* Get shift status */
1020 case 0x02:
1021 {
1022 /* Return the lower byte of the keyboard shift status word */
1023 setAL(LOBYTE(Bda->KeybdShiftFlags));
1024 break;
1025 }
1026
1027 /* Reserved */
1028 case 0x04:
1029 {
1030 DPRINT1("BIOS Function INT 16h, AH = 0x04 is RESERVED\n");
1031 break;
1032 }
1033
1034 /* Push keystroke */
1035 case 0x05:
1036 {
1037 /* Return 0 if success, 1 if failure */
1038 setAL(BiosKbdBufferPush(getCX()) == FALSE);
1039 break;
1040 }
1041
1042 /* Get extended shift status */
1043 case 0x12:
1044 {
1045 /*
1046 * Be careful! The returned word is similar to Bda->KeybdShiftFlags
1047 * but the high byte is organized differently:
1048 * the bytes 2 and 3 of the high byte are not the same...
1049 */
1050 WORD KeybdShiftFlags = (Bda->KeybdShiftFlags & 0xF3FF);
1051
1052 /* Return the extended keyboard shift status word */
1053 setAX(KeybdShiftFlags);
1054 break;
1055 }
1056
1057 default:
1058 {
1059 DPRINT1("BIOS Function INT 16h, AH = 0x%02X NOT IMPLEMENTED\n",
1060 HIBYTE(Eax));
1061 }
1062 }
1063 }
1064
1065 VOID BiosTimeService(LPWORD Stack)
1066 {
1067 DWORD Eax = EmulatorGetRegister(EMULATOR_REG_AX);
1068 DWORD Ecx = EmulatorGetRegister(EMULATOR_REG_CX);
1069 DWORD Edx = EmulatorGetRegister(EMULATOR_REG_DX);
1070
1071 switch (HIBYTE(Eax))
1072 {
1073 case 0x00:
1074 {
1075 /* Set AL to 1 if midnight had passed, 0 otherwise */
1076 Eax &= 0xFFFFFF00;
1077 if (Bda->MidnightPassed) Eax |= 1;
1078
1079 /* Return the tick count in CX:DX */
1080 EmulatorSetRegister(EMULATOR_REG_AX, Eax);
1081 EmulatorSetRegister(EMULATOR_REG_CX, HIWORD(Bda->TickCounter));
1082 EmulatorSetRegister(EMULATOR_REG_DX, LOWORD(Bda->TickCounter));
1083
1084 /* Reset the midnight flag */
1085 Bda->MidnightPassed = FALSE;
1086
1087 break;
1088 }
1089
1090 case 0x01:
1091 {
1092 /* Set the tick count to CX:DX */
1093 Bda->TickCounter = MAKELONG(LOWORD(Edx), LOWORD(Ecx));
1094
1095 /* Reset the midnight flag */
1096 Bda->MidnightPassed = FALSE;
1097
1098 break;
1099 }
1100
1101 default:
1102 {
1103 DPRINT1("BIOS Function INT 1Ah, AH = 0x%02X NOT IMPLEMENTED\n",
1104 HIBYTE(Eax));
1105 }
1106 }
1107 }
1108
1109 VOID BiosSystemTimerInterrupt(LPWORD Stack)
1110 {
1111 /* Increase the system tick count */
1112 Bda->TickCounter++;
1113 }
1114
1115 VOID BiosEquipmentService(LPWORD Stack)
1116 {
1117 /* Return the equipment list */
1118 EmulatorSetRegister(EMULATOR_REG_AX, Bda->EquipmentList);
1119 }
1120
1121 VOID BiosHandleIrq(BYTE IrqNumber, LPWORD Stack)
1122 {
1123 switch (IrqNumber)
1124 {
1125 /* PIT IRQ */
1126 case 0:
1127 {
1128 /* Perform the system timer interrupt */
1129 EmulatorInterrupt(BIOS_SYS_TIMER_INTERRUPT);
1130
1131 break;
1132 }
1133
1134 /* Keyboard IRQ */
1135 case 1:
1136 {
1137 BYTE ScanCode, VirtualKey;
1138 WORD Character;
1139
1140 /* Loop while there is a scancode available */
1141 while (KeyboardReadStatus() & 1)
1142 {
1143 /* Get the scan code and virtual key code */
1144 ScanCode = KeyboardReadData();
1145 VirtualKey = MapVirtualKey(ScanCode & 0x7F, MAPVK_VSC_TO_VK);
1146
1147 /* Check if this is a key press or release */
1148 if (!(ScanCode & (1 << 7)))
1149 {
1150 /* Key press */
1151 if (VirtualKey == VK_NUMLOCK
1152 || VirtualKey == VK_CAPITAL
1153 || VirtualKey == VK_SCROLL
1154 || VirtualKey == VK_INSERT)
1155 {
1156 /* For toggle keys, toggle the lowest bit in the keyboard map */
1157 BiosKeyboardMap[VirtualKey] ^= ~(1 << 0);
1158 }
1159
1160 /* Set the highest bit */
1161 BiosKeyboardMap[VirtualKey] |= (1 << 7);
1162
1163 /* Find out which character this is */
1164 Character = 0;
1165 if (ToAscii(VirtualKey, ScanCode, BiosKeyboardMap, &Character, 0) == 0)
1166 {
1167 /* Not ASCII */
1168 Character = 0;
1169 }
1170
1171 /* Push it onto the BIOS keyboard queue */
1172 BiosKbdBufferPush((ScanCode << 8) | (Character & 0xFF));
1173
1174 }
1175 else
1176 {
1177 /* Key release, unset the highest bit */
1178 BiosKeyboardMap[VirtualKey] &= ~(1 << 7);
1179 }
1180 }
1181
1182 /* Clear the keyboard flags */
1183 Bda->KeybdShiftFlags = 0;
1184
1185 /* Set the appropriate flags based on the state */
1186 if (BiosKeyboardMap[VK_RSHIFT] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_RSHIFT;
1187 if (BiosKeyboardMap[VK_LSHIFT] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_LSHIFT;
1188 if (BiosKeyboardMap[VK_CONTROL] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_CTRL;
1189 if (BiosKeyboardMap[VK_MENU] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_ALT;
1190 if (BiosKeyboardMap[VK_SCROLL] & (1 << 0)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_SCROLL_ON;
1191 if (BiosKeyboardMap[VK_NUMLOCK] & (1 << 0)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_NUMLOCK_ON;
1192 if (BiosKeyboardMap[VK_CAPITAL] & (1 << 0)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_CAPSLOCK_ON;
1193 if (BiosKeyboardMap[VK_INSERT] & (1 << 0)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_INSERT_ON;
1194 if (BiosKeyboardMap[VK_RMENU] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_RALT;
1195 if (BiosKeyboardMap[VK_LMENU] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_LALT;
1196 if (BiosKeyboardMap[VK_SNAPSHOT] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_SYSRQ;
1197 if (BiosKeyboardMap[VK_PAUSE] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_PAUSE;
1198 if (BiosKeyboardMap[VK_SCROLL] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_SCROLL;
1199 if (BiosKeyboardMap[VK_NUMLOCK] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_NUMLOCK;
1200 if (BiosKeyboardMap[VK_CAPITAL] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_CAPSLOCK;
1201 if (BiosKeyboardMap[VK_INSERT] & (1 << 7)) Bda->KeybdShiftFlags |= BDA_KBDFLAG_INSERT;
1202
1203 break;
1204 }
1205 }
1206
1207 /* Send End-of-Interrupt to the PIC */
1208 if (IrqNumber > 8) PicWriteCommand(PIC_SLAVE_CMD, PIC_OCW2_EOI);
1209 PicWriteCommand(PIC_MASTER_CMD, PIC_OCW2_EOI);
1210 }
1211
1212 /* EOF */