summaryrefslogtreecommitdiffstats
path: root/private/mvdm/sim32/sim32.c
diff options
context:
space:
mode:
Diffstat (limited to 'private/mvdm/sim32/sim32.c')
-rw-r--r--private/mvdm/sim32/sim32.c367
1 files changed, 367 insertions, 0 deletions
diff --git a/private/mvdm/sim32/sim32.c b/private/mvdm/sim32/sim32.c
new file mode 100644
index 000000000..6028c6a83
--- /dev/null
+++ b/private/mvdm/sim32/sim32.c
@@ -0,0 +1,367 @@
+#include <nt.h>
+#include <ntddtx.h>
+#include <malloc.h>
+
+#include "sim32.h"
+
+UCHAR TransmitPkt[MAXSIZE];
+UCHAR ReceivePkt[MAXSIZE];
+
+HANDLE DeviceHandle;
+IO_STATUS_BLOCK IoStatusBlock;
+NTSTATUS Status;
+
+
+/*****************************************************************************
+*
+* Sim32GetVDMMemory
+*
+* This routine gets 'Size' bytes from WOW VDM starting at address
+* specified by 'Address'. These bytes are returned to the caller in
+* the Buffer (which is owned by the caller).
+*
+*****************************************************************************/
+
+
+USHORT Sim32GetVDMMemory (IN ULONG Address,
+ IN USHORT Size,
+ IN OUT PVOID Buffer)
+
+{
+ if (Size < MAXSIZE-11) {
+ TransmitPkt[0] = SOH;
+ TransmitPkt[1] = GETMEM;
+ TransmitPkt[2] = 11;
+ TransmitPkt[3] = 0;
+ TransmitPkt[4] = (UCHAR) FIRSTBYTE(Address);
+ TransmitPkt[5] = (UCHAR) SECONDBYTE(Address);
+ TransmitPkt[6] = (UCHAR) THIRDBYTE(Address);
+ TransmitPkt[7] = (UCHAR) FOURTHBYTE(Address);
+ TransmitPkt[8] = (UCHAR) FIRSTBYTE(Size);
+ TransmitPkt[9] = (UCHAR) SECONDBYTE(Size);
+ TransmitPkt[10] = EOT;
+
+ if (!Xceive((USHORT)(Size+5), 11)) {
+ DbgPrint ("Sim32GetVDMMemory.....BAD Memory \a\n");
+ return (BAD);
+ }
+
+ RtlMoveMemory(Buffer, &ReceivePkt[4], Size);
+
+ return(GOOD);
+
+ }
+ else {
+ DbgPrint ("Bad Packet Size %d\n", Size);
+ return (BADSIZE);
+ }
+}
+
+
+/*****************************************************************************
+*
+* Sim32SetVDMMemory
+*
+* This routine sets 'Size' bytes in WOW VDM starting at address
+* specified by 'Address' to the values in Buffer.
+*
+*****************************************************************************/
+
+
+USHORT Sim32SetVDMMemory (IN ULONG Address,
+ IN USHORT Size,
+ IN OUT PVOID Buffer)
+{
+ if (Size < MAXSIZE-11) {
+ TransmitPkt[0] = SOH;
+ TransmitPkt[1] = SETMEM;
+ TransmitPkt[2] = (UCHAR) (Size+11);
+ TransmitPkt[3] = 0;
+ TransmitPkt[4] = (UCHAR) FIRSTBYTE(Address);
+ TransmitPkt[5] = (UCHAR) SECONDBYTE(Address);
+ TransmitPkt[6] = (UCHAR) THIRDBYTE(Address);
+ TransmitPkt[7] = (UCHAR) FOURTHBYTE(Address);
+ TransmitPkt[8] = (UCHAR) FIRSTBYTE(Size);
+ TransmitPkt[9] = (UCHAR) SECONDBYTE(Size);
+ TransmitPkt[10+Size] = EOT;
+
+ RtlMoveMemory(&TransmitPkt[10], Buffer, Size);
+
+ if (!Xceive(7, (USHORT)(Size+11))) {
+ DbgPrint ("Sim32SetVDMMemory... could not set : \a\n");
+ return (BAD);
+ }
+
+ return(GOOD);
+
+ }
+ else {
+ DbgPrint ("Bad Packet Size %d\n", Size);
+ return (BADSIZE);
+ }
+}
+
+
+
+/*****************************************************************************
+*
+* Sim32GetVDMPSZPointer
+*
+* This routine returns a pointer to a null terminated string in the WOW
+* VDM at the specified address.
+*
+* This routine does the following,
+* allocates a sufficient size buffer,
+* gets the string from SIM16,
+* copies the string into buffer,
+* returns a pointer to the buffer.
+*
+*****************************************************************************/
+
+
+PSZ Sim32GetVDMPSZPointer (IN ULONG Address)
+{
+ USHORT Size;
+ PSZ Ptr;
+
+
+ TransmitPkt[0] = SOH;
+ TransmitPkt[1] = PSZLEN;
+ TransmitPkt[2] = 9;
+ TransmitPkt[3] = 0;
+ TransmitPkt[4] = (UCHAR) FIRSTBYTE(Address);
+ TransmitPkt[5] = (UCHAR) SECONDBYTE(Address);
+ TransmitPkt[6] = (UCHAR) THIRDBYTE(Address);
+ TransmitPkt[7] = (UCHAR) FOURTHBYTE(Address);
+ TransmitPkt[8] = EOT;
+
+ if (!Xceive(7, 9)) {
+ DbgPrint ("Sim32GetVDMPSZPointer.....Attempt to get PSZ length failed \a\a\n");
+ return NULL;
+ }
+
+ Size = *(PUSHORT)(ReceivePkt+4);
+
+
+ //
+ // allocate buffer to copy string into
+ //
+
+ Ptr = (PSZ) malloc(Size);
+
+ if (!Ptr) {
+ DbgPrint ("Sim32GetVDMPSZPointer..., malloc failed \a\a\n");
+ }
+
+
+ //
+ // get null terminated string
+ //
+
+ if (Size < MAXSIZE-11) {
+ TransmitPkt[1] = GETMEM;
+ TransmitPkt[2] = 11;
+ TransmitPkt[3] = 0;
+ TransmitPkt[8] = (UCHAR) FIRSTBYTE(Size);
+ TransmitPkt[9] = (UCHAR) SECONDBYTE(Size);
+ TransmitPkt[10] = EOT;
+
+ if (!Xceive((USHORT)(Size+5), 11)) {
+ DbgPrint ("Sim32GetVDMPSZPointer.....Unsuccessful \a\a\n");
+ return NULL;
+ }
+
+ RtlMoveMemory(Ptr, &ReceivePkt[4], Size);
+ } else {
+ DbgPrint ("Sim32GetVDMPSZPointer.....Size of the string too big Size = %d\a\a\n", Size);
+ return NULL;
+ }
+
+ return Ptr;
+
+}
+
+
+
+/*****************************************************************************
+*
+* Sim32FreeVDMPointer
+*
+* This routine frees the buffer which was allocated earlier.
+*
+*****************************************************************************/
+
+
+VOID Sim32FreeVDMPointer (PVOID Ptr)
+{
+ free (Ptr);
+}
+
+
+
+/*****************************************************************************
+*
+* Sim32SendSim16
+*
+* This routine specifies the stack of the WOW VDM task and asks the
+* WOW 16 to make that task run.
+*
+*****************************************************************************/
+
+
+USHORT Sim32SendSim16 (IN OUT ULONG *WOWStack)
+{
+ static USHORT fInit = 0;
+
+ if (fInit) {
+ TransmitPkt[0] = SOH;
+ TransmitPkt[1] = WAKEUP;
+ TransmitPkt[2] = 9;
+ TransmitPkt[3] = 0;
+ TransmitPkt[4] = (UCHAR) FIRSTBYTE(*WOWStack);
+ TransmitPkt[5] = (UCHAR) SECONDBYTE(*WOWStack);
+ TransmitPkt[6] = (UCHAR) THIRDBYTE(*WOWStack);
+ TransmitPkt[7] = (UCHAR) FOURTHBYTE(*WOWStack);
+ TransmitPkt[8] = EOT;
+
+ if (!Xceive(9, 9)) {
+ return (BAD);
+ }
+
+ *WOWStack = *(PULONG)(ReceivePkt+4);
+
+ return(GOOD);
+ }
+ else {
+ Initialize(9);
+ *WOWStack = *(PULONG)(ReceivePkt+4);
+ fInit = 1;
+ return (GOOD);
+ }
+}
+
+
+/*****************************************************************************
+*
+* Xceive
+*
+* This routine transmits a packet and waits for the data from the remote
+* side to come. When this routine returns, the ReceivePkt has the data
+* sent by the remote machine.
+*
+*****************************************************************************/
+
+
+USHORT Xceive(IN USHORT Length_In, IN USHORT Length_Out)
+{
+ BOOLEAN Done = FALSE;
+ USHORT i = 0;
+
+ while ((i < MAXTRY) && (!Done)) {
+
+ Status = NtDeviceIoControlFile(
+ DeviceHandle,
+ NULL,
+ NULL,
+ NULL,
+ &IoStatusBlock,
+ IOCTL_TRNXT_XCEIVE,
+ TransmitPkt,
+ (ULONG) Length_Out,
+ ReceivePkt,
+ (ULONG) Length_In
+ );
+
+ //
+ // check error condition
+ // if no error, then
+ //
+
+ if (ReceivePkt[0] == SOH) {
+ if (ReceivePkt[1] != NAK) {
+ i = *(PUSHORT)(ReceivePkt+2);
+ if (ReceivePkt[(--i)] == EOT) {
+ Done = TRUE;
+ }
+ else {
+ DbgPrint ("EOT is missing from the packet, *ERROR*, Do Not Proceed Further !\a\a\n");
+ }
+ }
+ else {
+ DbgPrint ("It is a NAK packet, *ERROR*, Do Not Proceed Further !\a\a\n");
+ }
+ }
+ else {
+ DbgPrint ("SOH is missing from the packet, *ERROR*, Do Not Proceed Further !\a\a\n");
+ }
+
+ if (!Done) {
+ i++;
+ DbgPrint ("\nSTOP STOP STOP !!!\a\a\a\a\a\n");
+ }
+ }
+
+ if (Done) {
+ return (GOOD);
+ }
+ else {
+ return (BAD);
+ }
+
+}
+
+void Initialize (IN USHORT Length_In)
+{
+ OBJECT_ATTRIBUTES ObjectAttributes;
+
+ STRING DeviceName;
+ USHORT j;
+ char TestPkt[] = "WOW 32 Simulator on NT\n\r";
+
+ RtlInitString(&DeviceName, "\\Device\\Serial1");
+
+ //
+ // set attributes
+ //
+
+ ObjectAttributes.Length = sizeof(OBJECT_ATTRIBUTES);
+ ObjectAttributes.RootDirectory = NULL;
+ ObjectAttributes.ObjectName = &DeviceName;
+ ObjectAttributes.Attributes = OBJ_INHERIT;
+ ObjectAttributes.SecuriAR) SECONDBYTE(Size);
+ TransmitPkt[10] = EOT;
+
+ if (!Xceive((USHORT)(Size+5), 11)) {
+ DbgPrint ("Sim32GetVDMPSZPointer.....Unsuccessful \a\a\n");
+ return NULL;
+ }
+
+ RtlMoveMemory(Ptr, &ReceivePkt[4], Size);
+ } else {
+ DbgPrint ("Sim32GetVDMPSZPointer.....Size of the string too big Size = %d\a\a\n", Size);
+ return NULL;
+ }
+
+ return Ptr;
+
+}
+
+
+
+/*****************************************************************************
+*
+* Sim32FreeVDMPointer
+*
+* This routine frees the buffer which was allocated earlier.
+*
+*****************************************************************************/
+
+
+VOID Sim32FreeVDMPointer (PVOID Ptr)
+{
+ free (Ptr);
+}
+
+
+
+/******************************
generated by cgit v1.2.3 (git 2.25.1) at 2024-07-29 13:02:02 +0200