1 files changed, 354 insertions, 0 deletions

diff --git a/private/mvdm/vdmexts/debug.c b/private/mvdm/vdmexts/debug.c
new file mode 100644
index 000000000..3baa7e92b
--- /dev/null
+++ b/private/mvdm/vdmexts/debug.c
@@ -0,0 +1,354 @@
+/*++
+
+Copyright (c) 1991  Microsoft Corporation
+
+Module Name:
+
+    debug.c
+
+Abstract:
+
+    This file contains code to manage software breakpoints
+
+Author:
+
+    Neil Sandlin (neilsa) 1-Nov-1995
+
+Revision History:
+
+--*/
+
+#include <precomp.h>
+#pragma hdrstop
+#include <dpmi.h>
+#include <dbgsvc.h>
+#include <stdio.h>
+
+
+VOID
+DisableBreakPoint(
+    VDM_BREAKPOINT *pBP
+    )
+{
+    int mode;
+    ULONG lpAddress;
+    BYTE byte;
+
+    if (!(pBP->Flags & VDMBP_ENABLED)) {
+        return;
+    }
+
+    if (pBP->Flags & VDMBP_V86) {
+        mode = V86_MODE;
+    } else {
+        mode = PROT_MODE;
+    }
+
+    lpAddress = GetInfoFromSelector(pBP->Seg, mode, NULL) + GetIntelBase() + pBP->Offset;
+
+    if (READMEM((PVOID)lpAddress, &byte, 1)) {
+        if (byte == 0xcc) {
+            PRINTF("Writing %02X to %08X\n", pBP->Opcode, lpAddress);
+            WRITEMEM((PVOID)lpAddress, &pBP->Opcode, 1);
+        }
+    }
+
+    pBP->Flags &= ~VDMBP_ENABLED;
+}
+
+VOID
+EnableBreakPoint(
+    VDM_BREAKPOINT *pBP
+    )
+{
+    int mode;
+    ULONG lpAddress;
+    BYTE byte;
+
+    if (pBP->Flags & VDMBP_ENABLED) {
+        return;
+    }
+
+    if (pBP->Flags & VDMBP_V86) {
+        mode = V86_MODE;
+    } else {
+        mode = PROT_MODE;
+    }
+
+    lpAddress = GetInfoFromSelector(pBP->Seg, mode, NULL) + GetIntelBase() + pBP->Offset;
+
+    if (READMEM((PVOID)lpAddress, &byte, 1)) {
+        if (byte != 0xcc) {
+            static BYTE bpOp = 0xcc;
+
+            PRINTF("Writing %02X to %08X\n", bpOp, lpAddress);
+            WRITEMEM((PVOID)lpAddress, &bpOp, 1);
+            pBP->Opcode = byte;
+        }
+    } else {
+
+        PRINTF("Error enabling breakpoint at %04X:%08X\n", pBP->Seg, pBP->Offset);
+        return;
+    }
+
+    pBP->Flags |= VDMBP_ENABLED;
+}
+
+
+VOID
+UpdateBreakPoint(
+    int Cmd
+    )
+
+{
+    ULONG lpAddress;
+    VDM_BREAKPOINT VdmBreakPoint;
+    int BPNum;
+
+
+    lpAddress = (*GetExpression)("ntvdm!VdmBreakPoints");
+
+    if (!lpAddress) {
+        PRINTF("Could not find symbol ntvdm!VdmBreakPoints\n");
+        return;
+    }
+
+    if (!GetNextToken()) {
+        PRINTF("Please specify an breakpoint #\n");
+        return;
+    }
+    sscanf(lpArgumentString, "%d", &BPNum);
+
+    if (BPNum > MAX_VDM_BREAKPOINTS) {
+        PRINTF("Invalid breakpoint - %d\n", BPNum);
+    }
+
+    lpAddress += BPNum*sizeof(VDM_BREAKPOINT);
+
+    if (!READMEM((PVOID)lpAddress, &VdmBreakPoint, sizeof(VDM_BREAKPOINT))) {
+        PRINTF("Error reading BP memory\n");
+        return;
+    }
+
+    switch(Cmd) {
+
+        case 1:     // CLEAR
+
+            if (VdmBreakPoint.Flags & VDMBP_SET) {
+                if (VdmBreakPoint.Flags & VDMBP_ENABLED) {
+                    DisableBreakPoint(&VdmBreakPoint);
+                }
+                VdmBreakPoint.Flags &= ~VDMBP_SET;
+            }
+            break;
+
+        case 2:     // DISABLE
+
+            if (VdmBreakPoint.Flags & VDMBP_SET) {
+                if (VdmBreakPoint.Flags & VDMBP_ENABLED) {
+                    DisableBreakPoint(&VdmBreakPoint);
+                }
+            }
+            break;
+
+        case 3:     // ENABLE
+
+            if (VdmBreakPoint.Flags & VDMBP_SET) {
+                if (!(VdmBreakPoint.Flags & VDMBP_ENABLED)) {
+                    EnableBreakPoint(&VdmBreakPoint);
+                }
+            }
+            break;
+
+    }
+
+    WRITEMEM((PVOID)lpAddress, &VdmBreakPoint, sizeof(VDM_BREAKPOINT));
+}
+
+VOID
+bc(
+    CMD_ARGLIST
+    )
+{
+    CMD_INIT();
+    UpdateBreakPoint(1);
+}
+
+VOID
+bd(
+    CMD_ARGLIST
+    )
+{
+    CMD_INIT();
+    UpdateBreakPoint(2);
+}
+
+VOID
+be(
+    CMD_ARGLIST
+    )
+{
+    CMD_INIT();
+    UpdateBreakPoint(3);
+}
+
+
+VOID
+bl(
+    CMD_ARGLIST
+    )
+{
+    ULONG lpAddress;
+    VDM_BREAKPOINT VdmBreakPoint;
+    int BPNum;
+    int mode;
+    DWORD dist;
+    CHAR  sym_text[255];
+
+    CMD_INIT();
+
+    lpAddress = (*GetExpression)("ntvdm!VdmBreakPoints");
+
+    if (!lpAddress) {
+        PRINTF("Could not find symbol ntvdm!VdmBreakPoints\n");
+        return;
+    }
+
+    for (BPNum = 0; BPNum < MAX_VDM_BREAKPOINTS;
+                         BPNum++, lpAddress+=sizeof(VDM_BREAKPOINT)) {
+
+        if (!READMEM((PVOID)lpAddress, &VdmBreakPoint, sizeof(VDM_BREAKPOINT))) {
+            PRINTF("Error reading BP memory\n");
+            return;
+        }
+
+        if (VdmBreakPoint.Flags & VDMBP_SET) {
+
+            PRINTF("%d %s ", BPNum,
+                    (VdmBreakPoint.Flags & VDMBP_ENABLED) ? "e" : "d");
+
+            if (VdmBreakPoint.Flags & VDMBP_V86) {
+                mode = V86_MODE;
+                PRINTF("&");
+            } else {
+                mode = PROT_MODE;
+                PRINTF("#");
+            }
+
+            PRINTF("%04X:", VdmBreakPoint.Seg);
+
+            if (VdmBreakPoint.Offset > 0xffff) {
+                PRINTF("%08X", VdmBreakPoint.Offset);
+            } else {
+                PRINTF("%04X", VdmBreakPoint.Offset);
+            }
+
+            PRINTF("   %04X:***", VdmBreakPoint.Count);
+
+
+            if (FindSymbol(VdmBreakPoint.Seg, VdmBreakPoint.Offset,
+                           sym_text, &dist, BEFORE, mode )) {
+
+                if ( dist == 0 ) {
+                    PRINTF(" %s\n", sym_text );
+                } else {
+                    PRINTF(" %s+0x%lx\n", sym_text, dist );
+                }
+            }
+        }
+    }
+}
+
+
+VOID
+bp(
+    CMD_ARGLIST
+    )
+{
+    ULONG lpAddress, lpTmp;
+    VDM_BREAKPOINT VdmBreakPoint;
+    int BPNum;
+    VDMCONTEXT      ThreadContext;
+    WORD            selector;
+    ULONG           offset;
+    USHORT          count = 1;
+    int mode;
+    USHORT flags = 0;
+
+    CMD_INIT();
+
+    lpAddress = (*GetExpression)("ntvdm!VdmBreakPoints");
+
+    if (!lpAddress) {
+        PRINTF("Could not find symbol ntvdm!VdmBreakPoints\n");
+        return;
+    }
+
+    mode = GetContext( &ThreadContext );
+
+    if (!GetNextToken()) {
+        PRINTF("Please enter an address\n");
+        return;
+    }
+
+    if (!ParseIntelAddress(&mode, &selector, &offset)) {
+        return;
+    }
+
+    if (mode == V86_MODE) {
+        flags = VDMBP_V86;
+    }
+
+    //
+    // first see if it's set already
+    //
+    for (lpTmp = lpAddress, BPNum = 0; BPNum < MAX_VDM_BREAKPOINTS;
+                           BPNum++, lpTmp+=sizeof(VDM_BREAKPOINT)) {
+
+        if (!READMEM((PVOID)lpTmp, &VdmBreakPoint, sizeof(VDM_BREAKPOINT))) {
+            PRINTF("Error reading BP memory\n");
+            return;
+        }
+
+        if (VdmBreakPoint.Flags & VDMBP_SET) {
+            if ((VdmBreakPoint.Seg == selector) &&
+                (VdmBreakPoint.Offset == offset) &&
+                !(VdmBreakPoint.Flags ^ flags))
+                                                 {
+
+                VdmBreakPoint.Count = count;
+                VdmBreakPoint.Flags |= VDMBP_FLUSH;
+
+                if (!(VdmBreakPoint.Flags & VDMBP_ENABLED)) {
+                    EnableBreakPoint(&VdmBreakPoint);
+                }
+
+                WRITEMEM((PVOID)lpTmp, &VdmBreakPoint, sizeof(VDM_BREAKPOINT));
+                PRINTF("breakpoint %d redefined\n", BPNum);
+                return;
+
+            }
+        }
+    }
+
+
+    for (lpTmp = lpAddress, BPNum = 0; BPNum < MAX_VDM_BREAKPOINTS;
+                    BPNum++,lpTmp+=sizeof(VDM_BREAKPOINT)) {
+        if (!READMEM((PVOID)lpTmp, &VdmBreakPoint, sizeof(VDM_BREAKPOINT))) {
+            PRINTF("Error reading BP memory\n");
+            return;
+        }
+
+        if (!(VdmBreakPoint.Flags & VDMBP_SET)) {
+            VdmBreakPoint.Seg = selector;
+            VdmBreakPoint.Offset = offset;
+            VdmBreakPoint.Count = count;
+            VdmBreakPoint.Flags = VDMBP_SET | VDMBP_FLUSH;
+            EnableBreakPoint(&VdmBreakPoint);
+
+            WRITEMEM((PVOID)lpTmp, &VdmBreakPoint, sizeof(VDM_BREAKPOINT));
+            return;
+
+        }
+    }
+}