7 Mar
2015
7 Mar
'15
12:43 a.m.
Author: aandrejevic
Date: Sat Mar 7 00:43:17 2015
New Revision: 66596
URL: http://svn.reactos.org/svn/reactos?rev=66596&view=rev
Log:
[NTVDM]
Begin implementing Expanded Memory Space (EMS) support.
Added:
trunk/reactos/subsystems/mvdm/ntvdm/ems.c (with props)
trunk/reactos/subsystems/mvdm/ntvdm/ems.h (with props)
Modified:
trunk/reactos/subsystems/mvdm/ntvdm/CMakeLists.txt
trunk/reactos/subsystems/mvdm/ntvdm/emulator.c
Modified: trunk/reactos/subsystems/mvdm/ntvdm/CMakeLists.txt
URL:
http://svn.reactos.org/svn/reactos/trunk/reactos/subsystems/mvdm/ntvdm/CMak…
==============================================================================
--- trunk/reactos/subsystems/mvdm/ntvdm/CMakeLists.txt [iso-8859-1] (original)
+++ trunk/reactos/subsystems/mvdm/ntvdm/CMakeLists.txt [iso-8859-1] Sat Mar 7 00:43:17
2015
@@ -33,6 +33,7 @@
dos/mouse32.c
dos/dem.c
clock.c
+ ems.c
emulator.c
int32.c
io.c
Added: trunk/reactos/subsystems/mvdm/ntvdm/ems.c
URL:
http://svn.reactos.org/svn/reactos/trunk/reactos/subsystems/mvdm/ntvdm/ems.…
==============================================================================
--- trunk/reactos/subsystems/mvdm/ntvdm/ems.c (added)
+++ trunk/reactos/subsystems/mvdm/ntvdm/ems.c [iso-8859-1] Sat Mar 7 00:43:17 2015
@@ -0,0 +1,231 @@
+/*
+ * COPYRIGHT: GPLv2+ - See COPYING in the top level directory
+ * PROJECT: ReactOS Virtual DOS Machine
+ * FILE: ems.c
+ * PURPOSE: Expanded Memory Support
+ * PROGRAMMERS: Aleksandar Andrejevic <theflash AT sdf DOT lonestar DOT org>
+ */
+
+/* INCLUDES *******************************************************************/
+
+#define NDEBUG
+
+#include "bios/bios32/bios32p.h"
+#include <ndk/rtltypes.h>
+#include <ndk/rtlfuncs.h>
+#include "ems.h"
+
+/* PRIVATE VARIABLES **********************************************************/
+
+static RTL_BITMAP AllocBitmap;
+static ULONG BitmapBuffer[(EMS_TOTAL_PAGES + sizeof(ULONG) - 1) / sizeof(ULONG)];
+static EMS_PAGE PageTable[EMS_TOTAL_PAGES];
+static EMS_HANDLE HandleTable[EMS_MAX_HANDLES];
+static PVOID Mapping[EMS_PHYSICAL_PAGES] = { NULL };
+
+/* PRIVATE FUNCTIONS **********************************************************/
+
+static USHORT EmsFree(USHORT Handle)
+{
+ PLIST_ENTRY Entry;
+ PEMS_HANDLE HandleEntry = &HandleTable[Handle];
+
+ if (Handle >= EMS_MAX_HANDLES || !HandleEntry->Allocated)
+ {
+ return EMS_STATUS_INVALID_HANDLE;
+ }
+
+ for (Entry = HandleEntry->PageList.Flink;
+ Entry != &HandleEntry->PageList;
+ Entry = Entry->Flink)
+ {
+ PEMS_PAGE PageEntry = (PEMS_PAGE)CONTAINING_RECORD(Entry, EMS_PAGE, Entry);
+ ULONG PageNumber = (ULONG)(((ULONG_PTR)PageEntry - (ULONG_PTR)PageTable) /
sizeof(EMS_PAGE));
+
+ /* Free the page */
+ RtlClearBits(&AllocBitmap, PageNumber, 1);
+ }
+
+ HandleEntry->Allocated = FALSE;
+ HandleEntry->PageCount = 0;
+ InitializeListHead(&HandleEntry->PageList);
+
+ return EMS_STATUS_OK;
+}
+
+static UCHAR EmsAlloc(USHORT NumPages, PUSHORT Handle)
+{
+ ULONG i, CurrentIndex = 0;
+ PEMS_HANDLE HandleEntry;
+
+ if (NumPages == 0) return EMS_STATUS_ZERO_PAGES;
+
+ for (i = 0; i < EMS_MAX_HANDLES; i++)
+ {
+ HandleEntry = &HandleTable[i];
+ if (!HandleEntry->Allocated)
+ {
+ *Handle = i;
+ break;
+ }
+ }
+
+ if (i == EMS_MAX_HANDLES) return EMS_STATUS_NO_MORE_HANDLES;
+ HandleEntry->Allocated = TRUE;
+
+ while (HandleEntry->PageCount < NumPages)
+ {
+ ULONG RunStart;
+ ULONG RunSize = RtlFindNextForwardRunClear(&AllocBitmap, CurrentIndex,
&RunStart);
+
+ if (RunSize == 0)
+ {
+ /* Free what's been allocated already and report failure */
+ EmsFree(*Handle);
+ return EMS_STATUS_INSUFFICIENT_PAGES;
+ }
+ else if ((HandleEntry->PageCount + RunSize) > NumPages)
+ {
+ /* We don't need the entire run */
+ RunSize = NumPages - HandleEntry->PageCount;
+ }
+
+ CurrentIndex = RunStart + RunSize;
+ HandleEntry->PageCount += RunSize;
+ RtlSetBits(&AllocBitmap, RunStart, RunSize);
+
+ for (i = 0; i < RunSize; i++)
+ {
+ PageTable[RunStart + i].Handle = *Handle;
+ InsertTailList(&HandleEntry->PageList, &PageTable[RunStart +
i].Entry);
+ }
+ }
+
+ return EMS_STATUS_OK;
+}
+
+static USHORT EmsMap(USHORT Handle, UCHAR PhysicalPage, USHORT LogicalPage)
+{
+ PLIST_ENTRY Entry;
+ PEMS_PAGE PageEntry;
+ PEMS_HANDLE HandleEntry = &HandleTable[Handle];
+ ULONG PageNumber;
+
+ if (PhysicalPage >= EMS_PHYSICAL_PAGES) return EMS_STATUS_INV_PHYSICAL_PAGE;
+ if (LogicalPage == 0xFFFF)
+ {
+ /* Unmap */
+ Mapping[PhysicalPage] = NULL;
+ return EMS_STATUS_OK;
+ }
+
+ if (Handle >= EMS_MAX_HANDLES || !HandleEntry->Allocated) return
EMS_STATUS_INVALID_HANDLE;
+
+ Entry = HandleEntry->PageList.Flink;
+ while (LogicalPage)
+ {
+ if (Entry == &HandleEntry->PageList) break;
+
+ LogicalPage--;
+ Entry = Entry->Flink;
+ }
+
+ if (Entry == &HandleEntry->PageList) return EMS_STATUS_INV_LOGICAL_PAGE;
+
+ PageEntry = (PEMS_PAGE)CONTAINING_RECORD(Entry, EMS_PAGE, Entry);
+ PageNumber = (ULONG)(((ULONG_PTR)PageEntry - (ULONG_PTR)PageTable) /
sizeof(EMS_PAGE));
+ Mapping[PhysicalPage] = (PVOID)(EMS_ADDRESS + PageNumber * EMS_PAGE_SIZE);
+
+ return EMS_STATUS_OK;
+}
+
+static VOID WINAPI EmsIntHandler(LPWORD Stack)
+{
+ switch (getAH())
+ {
+ /* Get Manager Status */
+ case 0x40:
+ {
+ setAH(EMS_STATUS_OK);
+ break;
+ }
+
+ /* Get Page Frame Segment */
+ case 0x41:
+ {
+ setAH(EMS_STATUS_OK);
+ setBX(EMS_SEGMENT);
+ break;
+ }
+
+ /* Get Number Of Pages */
+ case 0x42:
+ {
+ setAH(EMS_STATUS_OK);
+ setBX(RtlNumberOfClearBits(&AllocBitmap));
+ setDX(EMS_TOTAL_PAGES);
+ break;
+ }
+
+ /* Get Handle And Allocate Memory */
+ case 0x43:
+ {
+ USHORT Handle;
+ UCHAR Status = EmsAlloc(getBX(), &Handle);
+
+ setAH(Status);
+ if (Status == EMS_STATUS_OK) setDX(Handle);
+ break;
+ }
+
+ /* Map Memory */
+ case 0x44:
+ {
+ setAH(EmsMap(getDX(), getAL(), getBX()));
+ break;
+ }
+
+ /* Release Handle And Memory */
+ case 0x45:
+ {
+ setAH(EmsFree(getDX()));
+ break;
+ }
+
+ default:
+ {
+ DPRINT1("EMS function AH = %02X NOT IMPLEMENTED\n", getAH());
+ setAH(EMS_STATUS_UNKNOWN_FUNCTION);
+ break;
+ }
+ }
+}
+
+/* PUBLIC FUNCTIONS ***********************************************************/
+
+VOID EmsReadMemory(ULONG Address, PVOID Buffer, ULONG Size)
+{
+ // TODO: NOT IMPLEMENTED
+ UNIMPLEMENTED;
+}
+
+VOID EmsWriteMemory(ULONG Address, PVOID Buffer, ULONG Size)
+{
+ // TODO: NOT IMPLEMENTED
+ UNIMPLEMENTED;
+}
+
+VOID EmsInitialize(VOID)
+{
+ ULONG i;
+ RtlInitializeBitMap(&AllocBitmap, BitmapBuffer, EMS_TOTAL_PAGES);
+
+ for (i = 0; i < EMS_MAX_HANDLES; i++)
+ {
+ HandleTable[i].Allocated = FALSE;
+ HandleTable[i].PageCount = 0;
+ InitializeListHead(&HandleTable[i].PageList);
+ }
+
+ RegisterBiosInt32(EMS_INTERRUPT_NUM, EmsIntHandler);
+}
Propchange: trunk/reactos/subsystems/mvdm/ntvdm/ems.c
------------------------------------------------------------------------------
svn:eol-style = native
Added: trunk/reactos/subsystems/mvdm/ntvdm/ems.h
URL:
http://svn.reactos.org/svn/reactos/trunk/reactos/subsystems/mvdm/ntvdm/ems.…
==============================================================================
--- trunk/reactos/subsystems/mvdm/ntvdm/ems.h (added)
+++ trunk/reactos/subsystems/mvdm/ntvdm/ems.h [iso-8859-1] Sat Mar 7 00:43:17 2015
@@ -0,0 +1,56 @@
+/*
+ * COPYRIGHT: GPLv2+ - See COPYING in the top level directory
+ * PROJECT: ReactOS Virtual DOS Machine
+ * FILE: ems.h
+ * PURPOSE: Expanded Memory Support
+ * PROGRAMMERS: Aleksandar Andrejevic <theflash AT sdf DOT lonestar DOT org>
+ */
+
+#ifndef _EMS_H_
+#define _EMS_H_
+
+/* DEFINITIONS ****************************************************************/
+
+#define EMS_INTERRUPT_NUM 0x67
+#define EMS_SEGMENT 0xE000
+#define EMS_MAX_HANDLES 16
+#define EMS_TOTAL_PAGES 256
+#define EMS_PAGE_BITS 14
+#define EMS_PAGE_SIZE (1 << EMS_PAGE_BITS)
+#define EMS_ADDRESS 0xA00000
+#define EMS_PHYSICAL_PAGES 4
+#define EMS_START_ADDRESS (EMS_SEGMENT << 4)
+#define EMS_END_ADDRESS (EMS_START_ADDRESS + EMS_PHYSICAL_PAGES * EMS_PAGE_SIZE)
+
+#define EMS_STATUS_OK 0x00
+#define EMS_STATUS_INTERNAL_ERROR 0x80
+#define EMS_STATUS_INVALID_HANDLE 0x83
+#define EMS_STATUS_NO_MORE_HANDLES 0x85
+#define EMS_STATUS_INSUFFICIENT_PAGES 0x88
+#define EMS_STATUS_ZERO_PAGES 0x89
+#define EMS_STATUS_INV_LOGICAL_PAGE 0x8A
+#define EMS_STATUS_INV_PHYSICAL_PAGE 0x8B
+#define EMS_STATUS_UNKNOWN_FUNCTION 0x8F
+
+typedef struct _EMS_HANDLE
+{
+ BOOLEAN Allocated;
+ USHORT PageCount;
+ LIST_ENTRY PageList;
+} EMS_HANDLE, *PEMS_HANDLE;
+
+typedef struct _EMS_PAGE
+{
+ LIST_ENTRY Entry;
+ USHORT Handle;
+} EMS_PAGE, *PEMS_PAGE;
+
+/* FUNCTIONS ******************************************************************/
+
+VOID EmsReadMemory(ULONG Address, PVOID Buffer, ULONG Size);
+VOID EmsWriteMemory(ULONG Address, PVOID Buffer, ULONG Size);
+VOID EmsInitialize(VOID);
+
+#endif // _EMS_H_
+
+/* EOF */
Propchange: trunk/reactos/subsystems/mvdm/ntvdm/ems.h
------------------------------------------------------------------------------
svn:eol-style = native
Modified: trunk/reactos/subsystems/mvdm/ntvdm/emulator.c
URL:
http://svn.reactos.org/svn/reactos/trunk/reactos/subsystems/mvdm/ntvdm/emul…
==============================================================================
--- trunk/reactos/subsystems/mvdm/ntvdm/emulator.c [iso-8859-1] (original)
+++ trunk/reactos/subsystems/mvdm/ntvdm/emulator.c [iso-8859-1] Sat Mar 7 00:43:17 2015
@@ -30,6 +30,7 @@
#include "hardware/sound/speaker.h"
#include "hardware/pit.h"
#include "hardware/video/vga.h"
+#include "ems.h"
#include "vddsup.h"
#include "io.h"
@@ -619,6 +620,9 @@
/* Initialize I/O ports */
/* Initialize RAM */
+ /* Initialize EMS */
+ EmsInitialize();
+
/* Initialize the CPU */
/* Initialize the internal clock */
3486
days inactive
3486
days old
0 comments
1 participants
participants (1)
-
aandrejevic＠svn.reactos.org