#include <stdio.h>
#include <windows.h>
#include <vddsvc.h>
#include <debug.h>

Include dependency graph for testvdd.c:

Macros
#define	NDEBUG

#define	VDD_DBG VddDbgMsg

#define	NUM_PORTS 4

#define	PAGE_SIZE 0x1000

#define	PAGE_ROUND_DOWN(x) ( ((ULONG_PTR)(x)) & (~(PAGE_SIZE-1)) )

#define	PAGE_ROUND_UP(x) ( (((ULONG_PTR)(x)) + PAGE_SIZE-1) & (~(PAGE_SIZE-1)) )

#define	MEM_SEG_START 0x0000

#define	MEM_SIZE PAGE_SIZE

Functions
static VOID	VddDbgMsg (LPCSTR Format,...)

VOID WINAPI	PortInB (IN USHORT Port, OUT PUCHAR Data)

VOID WINAPI	PortOutB (IN USHORT Port, IN UCHAR Data)

VOID WINAPI	PortInW (IN USHORT Port, OUT PUSHORT Data)

VOID WINAPI	PortOutW (IN USHORT Port, IN USHORT Data)

VOID WINAPI	PortInsB (IN USHORT Port, OUT PUCHAR Data, IN USHORT Count)

VOID WINAPI	PortOutsB (IN USHORT Port, IN PUCHAR Data, IN USHORT Count)

VOID WINAPI	PortInsW (IN USHORT Port, OUT PUSHORT Data, IN USHORT Count)

VOID WINAPI	PortOutsW (IN USHORT Port, IN PUSHORT Data, IN USHORT Count)

VOID WINAPI	MemoryHandler (IN PVOID FaultAddress, IN ULONG RWMode)

PVOID	FindHookableMemory (IN USHORT StartSegment, IN ULONG StartOffset, OUT PUSHORT HookedSegment, OUT PULONG HookedOffset)

VOID WINAPI	Create1Handler (USHORT DosPDB)

VOID WINAPI	Create2Handler (USHORT DosPDB)

VOID WINAPI	Terminate1Handler (USHORT DosPDB)

VOID WINAPI	Terminate2Handler (USHORT DosPDB)

VOID WINAPI	Block1Handler (VOID)

VOID WINAPI	Block2Handler (VOID)

VOID WINAPI	Resume1Handler (VOID)

VOID WINAPI	Resume2Handler (VOID)

VOID WINAPI	TestVDDRegister (VOID)

VOID WINAPI	TestVDDUnRegister (VOID)

VOID WINAPI	TestVDDDispatch (VOID)

BOOLEAN	RegisterVDD (BOOLEAN Register)

BOOL WINAPI	DllMain (IN HINSTANCE hInstanceDll, IN DWORD dwReason, IN LPVOID lpReserved)

Variables
HANDLE	hVdd = NULL

VDD_IO_PORTRANGE	PortDefs [NUM_PORTS]

VDD_IO_HANDLERS	PortHandlers [NUM_PORTS]

USHORT	HookedSegment = 0x0000

ULONG	HookedOffset = 0x0000

PVOID	HookedAddress = NULL

Macro Definition Documentation

◆ MEM_SEG_START

#define MEM_SEG_START 0x0000

Definition at line 208 of file testvdd.c.

◆ MEM_SIZE

#define MEM_SIZE PAGE_SIZE

Definition at line 209 of file testvdd.c.

◆ NDEBUG

#define NDEBUG

Definition at line 15 of file testvdd.c.

◆ NUM_PORTS

#define NUM_PORTS 4

Definition at line 95 of file testvdd.c.

◆ PAGE_ROUND_DOWN

#define PAGE_ROUND_DOWN ( x ) ( ((ULONG_PTR)(x)) & (~(PAGE_SIZE-1)) )

Definition at line 199 of file testvdd.c.

◆ PAGE_ROUND_UP

#define PAGE_ROUND_UP ( x ) ( (((ULONG_PTR)(x)) + PAGE_SIZE-1) & (~(PAGE_SIZE-1)) )

Definition at line 204 of file testvdd.c.

◆ PAGE_SIZE

#define PAGE_SIZE 0x1000

Definition at line 195 of file testvdd.c.

◆ VDD_DBG

#define VDD_DBG VddDbgMsg

Definition at line 81 of file testvdd.c.

Function Documentation

◆ Block1Handler()

VOID WINAPI Block1Handler ( VOID )

Definition at line 321 of file testvdd.c.

{
    VDD_DBG("Block1Handler");
}

Referenced by RegisterVDD().

◆ Block2Handler()

VOID WINAPI Block2Handler ( VOID )

Definition at line 328 of file testvdd.c.

{
    VDD_DBG("Block2Handler");
}

Referenced by RegisterVDD().

◆ Create1Handler()

VOID WINAPI Create1Handler ( USHORT DosPDB )

Definition at line 293 of file testvdd.c.

{
    VDD_DBG("Create1Handler(0x%04x)", DosPDB);
}

Referenced by RegisterVDD().

◆ Create2Handler()

VOID WINAPI Create2Handler ( USHORT DosPDB )

Definition at line 300 of file testvdd.c.

{
    VDD_DBG("Create2Handler(0x%04x)", DosPDB);
}

Referenced by RegisterVDD().

◆ DllMain()

BOOL WINAPI DllMain	(	IN HINSTANCE	hInstanceDll,
		IN DWORD	dwReason,
		IN LPVOID	lpReserved
	)

@DllMain

Core routine of the Utility Manager's library.

Parameters

[in]	hDllInstance	The entry point instance of the library.
[in]	fdwReason	The reason argument to indicate the motive DllMain is being called.
[in]	lpvReserved	Reserved.

Returns: Returns TRUE when main call initialization has succeeded, FALSE otherwise.

Definition at line 476 of file testvdd.c.

{
    BOOLEAN Success;
 
    UNREFERENCED_PARAMETER(lpReserved);
 
    switch (dwReason)
    {
        case DLL_PROCESS_ATTACH:
        {
            VDD_DBG("DLL_PROCESS_ATTACH");
 
            /* Save our global VDD handle */
            hVdd = hInstanceDll;
 
            /* Register VDD */
            Success = RegisterVDD(TRUE);
            if (!Success) VDD_DBG("Failed to register the VDD...");
 
            break;
        }
 
        case DLL_PROCESS_DETACH:
        {
            VDD_DBG("DLL_PROCESS_DETACH");
 
            /* Unregister VDD */
            Success = RegisterVDD(FALSE);
            if (!Success) VDD_DBG("Failed to unregister the VDD...");
 
            break;
        }
 
        case DLL_THREAD_ATTACH:
        case DLL_THREAD_DETACH:
        default:
            break;
    }
 
    return TRUE;
}

◆ FindHookableMemory()

PVOID FindHookableMemory	(	IN USHORT	StartSegment,
		IN ULONG	StartOffset,
		OUT PUSHORT	HookedSegment,
		OUT PULONG	HookedOffset
	)

Definition at line 230 of file testvdd.c.

{
    BOOLEAN Success;
    PVOID  PhysMemStart = NULL;
    USHORT Segment = StartSegment;
    ULONG  Offset  = PAGE_ROUND_DOWN(StartOffset);
 
    *HookedSegment = 0x0000;
    *HookedOffset  = 0x0000;
 
    while (Segment <= 0xF000)
    {
        // PhysMemStart = GetVDMPointer(GetVDMAddress(Segment, Offset), MEM_SIZE, (getMSW() & MSW_PE));
        PhysMemStart = VdmMapFlat(Segment, Offset, getMODE());
 
        /* Try to hook this memory area... */
        Success = VDDInstallMemoryHook(hVdd, PhysMemStart, MEM_SIZE, MemoryHandler);
        if (!Success)
        {
            /* ... it didn't work. Free PhysMemStart, increase segment/offset and try again. */
            DPRINT1("%04lX:%08lX hooking failed, continue...\n", Segment, Offset);
 
            VdmUnmapFlat(Segment, Offset, PhysMemStart, getMODE());
            // FreeVDMPointer(GetVDMAddress(Segment, Offset), MEM_SIZE, PhysMemStart, (getMSW() & MSW_PE));
            PhysMemStart = NULL;
 
            Offset += MEM_SIZE;
            if (Offset + MEM_SIZE > 0xFFFF)
            {
                Segment += 0x1000;
                Offset = 0x0000;
            }
        }
        else
        {
            /* ... it worked. We'll free PhysMemStart later on. */
            DPRINT1("%04lX:%08lX hooking succeeded!\n", Segment, Offset);
            break;
        }
    }
 
    if (PhysMemStart)
    {
        VDD_DBG("We hooked at %04lX:%08lX (0x%p)", Segment, Offset, PhysMemStart);
        *HookedSegment = Segment;
        *HookedOffset  = Offset;
    }
    else
    {
        VDD_DBG("Hooking attempt failed!");
    }
 
    return PhysMemStart;
}

Referenced by RegisterVDD().

◆ MemoryHandler()

VOID WINAPI MemoryHandler	(	IN PVOID	FaultAddress,
		IN ULONG	RWMode
	)

Definition at line 217 of file testvdd.c.

{
    BOOLEAN Success = FALSE;
 
    VDD_DBG("MemoryHandler(0x%08x, %s)", FaultAddress, (RWMode == 1) ? "Write" : "Read");
    // VDDTerminateVDM();
 
    Success = VDDAllocMem(hVdd, HookedAddress, MEM_SIZE);
    if (!Success) VDD_DBG("Unable to allocate memory");
}

Referenced by FindHookableMemory(), and VDDInstallMemoryHook().

◆ PortInB()

VOID WINAPI PortInB	(	IN USHORT	Port,
		OUT PUCHAR	Data
	)

Definition at line 107 of file testvdd.c.

{
    *Data = 0;
    VDD_DBG("0x%08x (BYTE 0x%02x) <-- Port 0x%04x", Data, *Data, Port);
}

◆ PortInsB()

VOID WINAPI PortInsB	(	IN USHORT	Port,
		OUT PUCHAR	Data,
		IN USHORT	Count
	)

Definition at line 142 of file testvdd.c.

{
    VDD_DBG("0x%08x (BYTESTR[%u]) <-- Port 0x%04x", Data, Count, Port);
    while (Count--) *Data++ = 0;
}

◆ PortInsW()

VOID WINAPI PortInsW	(	IN USHORT	Port,
		OUT PUSHORT	Data,
		IN USHORT	Count
	)

Definition at line 161 of file testvdd.c.

{
    VDD_DBG("0x%08x (WORDSTR[%u]) <-- Port 0x%04x", Data, Count, Port);
    while (Count--) *Data++ = 0;
}

◆ PortInW()

VOID WINAPI PortInW	(	IN USHORT	Port,
		OUT PUSHORT	Data
	)

Definition at line 124 of file testvdd.c.

{
    *Data = 0;
    VDD_DBG("0x%08x (WORD 0x%04x) <-- Port 0x%04x", Data, *Data, Port);
}

◆ PortOutB()

VOID WINAPI PortOutB	(	IN USHORT	Port,
		IN UCHAR	Data
	)

Definition at line 116 of file testvdd.c.

{
    VDD_DBG("(BYTE 0x%02x) --> Port 0x%04x", Data, Port);
}

◆ PortOutsB()

VOID WINAPI PortOutsB	(	IN USHORT	Port,
		IN PUCHAR	Data,
		IN USHORT	Count
	)

Definition at line 152 of file testvdd.c.

{
    VDD_DBG("0x%08x (BYTESTR[%u]) --> Port 0x%04x", Data, Count, Port);
}

◆ PortOutsW()

VOID WINAPI PortOutsW	(	IN USHORT	Port,
		IN PUSHORT	Data,
		IN USHORT	Count
	)

Definition at line 171 of file testvdd.c.

{
    VDD_DBG("0x%08x (WORDSTR[%u]) --> Port 0x%04x", Data, Count, Port);
}

◆ PortOutW()

VOID WINAPI PortOutW	(	IN USHORT	Port,
		IN USHORT	Data
	)

Definition at line 133 of file testvdd.c.

{
    VDD_DBG("(WORD 0x%04x) --> Port 0x%04x", Data, Port);
}

◆ RegisterVDD()

BOOLEAN RegisterVDD ( BOOLEAN Register )

Definition at line 381 of file testvdd.c.

{
    BOOLEAN Success = FALSE;
 
    if (Register)
    {
        /* Hook some IO ports */
        VDD_DBG("VDDInstallIOHook");
        Success = VDDInstallIOHook(hVdd, NUM_PORTS, PortDefs, PortHandlers);
        if (!Success)
        {
            VDD_DBG("Unable to hook IO ports, terminate...");
            VDDTerminateVDM();
        }
 
        /* Add a memory handler */
        VDD_DBG("FindHookableMemory");
        HookedAddress = FindHookableMemory(MEM_SEG_START, 0x0000,
                                           &HookedSegment, &HookedOffset);
        if (HookedAddress == NULL)
        {
            VDD_DBG("Unable to install memory handler, terminate...");
            VDDTerminateVDM();
        }
 
        /* Add some user hooks -- Test order of initialization and calling */
        VDD_DBG("VDDInstallUserHook (1)");
        Success = VDDInstallUserHook(hVdd,
                                     Create1Handler,
                                     Terminate1Handler,
                                     Block1Handler,
                                     Resume1Handler);
        if (!Success)
        {
            VDD_DBG("Unable to install user hooks (1)...");
        }
 
        VDD_DBG("VDDInstallUserHook (2)");
        Success = VDDInstallUserHook(hVdd,
                                     Create2Handler,
                                     Terminate2Handler,
                                     Block2Handler,
                                     Resume2Handler);
        if (!Success)
        {
            VDD_DBG("Unable to install user hooks (2)...");
        }
 
        /* We have finished! */
        VDD_DBG("Initialization finished!");
    }
    else
    {
        /* Remove the user hooks */
        VDD_DBG("VDDDeInstallUserHook (1)");
        Success = VDDDeInstallUserHook(hVdd);
        if (!Success) VDD_DBG("Unable to uninstall user hooks (1)");
 
        // TODO: See which hooks are still existing there...
 
        VDD_DBG("VDDDeInstallUserHook (2)");
        Success = VDDDeInstallUserHook(hVdd);
        if (!Success) VDD_DBG("Unable to uninstall user hooks (2)");
 
        VDD_DBG("VDDDeInstallUserHook (3)");
        Success = VDDDeInstallUserHook(hVdd);
        if (!Success) VDD_DBG("EXPECTED ERROR: Unable to uninstall user hooks (3)");
        else          VDD_DBG("UNEXPECTED ERROR: Uninstalling user hooks (3) succeeded?!");
 
        /* Uninstall the memory handler */
        Success = VDDFreeMem(hVdd, HookedAddress, MEM_SIZE);
        if (!Success) VDD_DBG("Unable to free memory");
 
        VDD_DBG("VDDDeInstallMemoryHook");
        Success = VDDDeInstallMemoryHook(hVdd, HookedAddress, MEM_SIZE);
        if (!Success) VDD_DBG("Memory handler uninstall failed");
 
        VDD_DBG("VdmUnmapFlat");
        Success = VdmUnmapFlat(HookedSegment, HookedOffset, HookedAddress, getMODE());
        // FreeVDMPointer(GetVDMAddress(HookedSegment, HookedOffset), MEM_SIZE, HookedAddress, (getMSW() & MSW_PE));
        if (!Success) VDD_DBG("VdmUnmapFlat failed!");
 
        /* Deregister the hooked IO ports */
        VDD_DBG("VDDDeInstallIOHook");
        VDDDeInstallIOHook(hVdd, NUM_PORTS, PortDefs);
 
        VDD_DBG("Cleanup finished!");
        Success = TRUE;
    }
 
    return Success;
}

Referenced by DllMain().

◆ Resume1Handler()

VOID WINAPI Resume1Handler ( VOID )

Definition at line 335 of file testvdd.c.

{
    VDD_DBG("Resume1Handler");
}

Referenced by RegisterVDD().

◆ Resume2Handler()

VOID WINAPI Resume2Handler ( VOID )

Definition at line 342 of file testvdd.c.

{
    VDD_DBG("Resume2Handler");
}

Referenced by RegisterVDD().

◆ Terminate1Handler()

VOID WINAPI Terminate1Handler ( USHORT DosPDB )

Definition at line 307 of file testvdd.c.

{
    VDD_DBG("Terminate1Handler(0x%04x)", DosPDB);
}

Referenced by RegisterVDD().

◆ Terminate2Handler()

VOID WINAPI Terminate2Handler ( USHORT DosPDB )

Definition at line 314 of file testvdd.c.

{
    VDD_DBG("Terminate2Handler(0x%04x)", DosPDB);
}

Referenced by RegisterVDD().

◆ TestVDDDispatch()

VOID WINAPI TestVDDDispatch ( VOID )

Definition at line 372 of file testvdd.c.

{
    VDD_DBG("TestVDDDispatch");
 
    /* Clear the Carry Flag: success */
    setCF(0);
}

◆ TestVDDRegister()

VOID WINAPI TestVDDRegister ( VOID )

Definition at line 352 of file testvdd.c.

{
    VDD_DBG("TestVDDRegister");
 
    /* Clear the Carry Flag: success */
    setCF(0);
}

◆ TestVDDUnRegister()

VOID WINAPI TestVDDUnRegister ( VOID )

Definition at line 362 of file testvdd.c.

{
    VDD_DBG("TestVDDUnRegister");
 
    /* Clear the Carry Flag: success */
    setCF(0);
}

◆ VddDbgMsg()

static VOID VddDbgMsg	(	LPCSTR	Format,
			...
	)

static

Definition at line 35 of file testvdd.c.

    {
    #ifndef WIN2K_COMPLIANT
        CHAR  StaticBuffer[256];
        LPSTR Buffer = StaticBuffer; // Use the static buffer by default.
    #else
        CHAR  Buffer[2048]; // Large enough. If not, increase it by hand.
    #endif
        size_t MsgLen;
        va_list Parameters;
 
        va_start(Parameters, Format);
 
    #ifndef WIN2K_COMPLIANT
        /*
         * Retrieve the message length and if it is too long, allocate
         * an auxiliary buffer; otherwise use the static buffer.
         */
        MsgLen = _vscprintf(Format, Parameters) + 1; // NULL-terminated
        if (MsgLen > ARRAYSIZE(StaticBuffer))
        {
            Buffer = HeapAlloc(GetProcessHeap(), HEAP_ZERO_MEMORY, MsgLen * sizeof(WCHAR));
            if (Buffer == NULL)
            {
                /* Allocation failed, use the static buffer and display a suitable error message */
                Buffer = StaticBuffer;
                Format = "DisplayMessage()\nOriginal message is too long and allocating an auxiliary buffer failed.";
                MsgLen = strlen(Format);
            }
        }
    #else
        MsgLen = ARRAYSIZE(Buffer);
    #endif
 
        /* Display the message */
        _vsnprintf(Buffer, MsgLen, Format, Parameters);
        MessageBoxA(NULL, Buffer, "Test VDD", MB_OK);
 
    #ifndef WIN2K_COMPLIANT
        /* Free the buffer if needed */
        if (Buffer != StaticBuffer) HeapFree(GetProcessHeap(), 0, Buffer);
    #endif
 
        va_end(Parameters);
    }

Variable Documentation

◆ HookedAddress

PVOID HookedAddress = NULL

Definition at line 213 of file testvdd.c.

Referenced by MemoryHandler(), and RegisterVDD().

◆ HookedOffset

ULONG HookedOffset = 0x0000

Definition at line 212 of file testvdd.c.

Referenced by FindHookableMemory(), and RegisterVDD().

◆ HookedSegment

USHORT HookedSegment = 0x0000

Definition at line 211 of file testvdd.c.

Referenced by FindHookableMemory(), and RegisterVDD().

◆ hVdd

HANDLE hVdd = NULL

Definition at line 87 of file testvdd.c.

Referenced by DllMain(), FindHookableMemory(), IOReadB(), IOReadD(), IOReadStrB(), IOReadStrD(), IOReadStrW(), IOReadW(), IOWriteB(), IOWriteD(), IOWriteStrB(), IOWriteStrD(), IOWriteStrW(), IOWriteW(), MemExceptionHandler(), MemoryHandler(), RegisterVDD(), VDDAllocMem(), VDDDeInstallIOHook(), VDDDeInstallMemoryHook(), VDDDeInstallUserHook(), VDDFreeMem(), VDDInstallIOHook(), VDDInstallMemoryHook(), VDDInstallUserHook(), VDDQueryDMA(), VDDRequestDMA(), and VDDSetDMA().

◆ PortDefs

VDD_IO_PORTRANGE PortDefs[NUM_PORTS]

Initial value:

=
{
    {0x3F8, 0x3FF},
    {0x2F8, 0x2FF},
    {0x3E8, 0x3EF},
    {0x2E8, 0x2EF}
}

Definition at line 97 of file testvdd.c.

Referenced by RegisterVDD().

◆ PortHandlers

VDD_IO_HANDLERS PortHandlers[NUM_PORTS]

Initial value:

=
{
    {PortInB, NULL   , NULL    , NULL    , PortOutB, NULL    , NULL     , NULL     },
    {PortInB, PortInW, NULL    , NULL    , PortOutB, PortOutW, NULL     , NULL     },
    {PortInB, NULL   , PortInsB, NULL    , PortOutB, NULL    , PortOutsB, NULL     },
    {PortInB, NULL   , NULL    , PortInsW, PortOutB, NULL    , NULL     , PortOutsW},
}

Definition at line 179 of file testvdd.c.

Referenced by RegisterVDD().

Macros

Functions

Variables

Macro Definition Documentation

◆ MEM_SEG_START

◆ MEM_SIZE

◆ NDEBUG

◆ NUM_PORTS

◆ PAGE_ROUND_DOWN

◆ PAGE_ROUND_UP

◆ PAGE_SIZE

◆ VDD_DBG

Function Documentation

◆ Block1Handler()

◆ Block2Handler()

◆ Create1Handler()

◆ Create2Handler()

◆ DllMain()

◆ FindHookableMemory()

◆ MemoryHandler()

◆ PortInB()

◆ PortInsB()

◆ PortInsW()

◆ PortInW()

◆ PortOutB()

◆ PortOutsB()

◆ PortOutsW()

◆ PortOutW()

◆ RegisterVDD()

◆ Resume1Handler()

◆ Resume2Handler()

◆ Terminate1Handler()

◆ Terminate2Handler()

◆ TestVDDDispatch()

◆ TestVDDRegister()

◆ TestVDDUnRegister()

◆ VddDbgMsg()

Variable Documentation

◆ HookedAddress

◆ HookedOffset

◆ HookedSegment

◆ hVdd

◆ PortDefs

◆ PortHandlers