| /* | |
| * DPMI 0.9 emulation | |
| * | |
| * Copyright 1995 Alexandre Julliard | |
| */ | |
| #include <unistd.h> | |
| #include <string.h> | |
| #include "windows.h" | |
| #include "heap.h" | |
| #include "global.h" | |
| #include "ldt.h" | |
| #include "module.h" | |
| #include "miscemu.h" | |
| #include "drive.h" | |
| #include "msdos.h" | |
| #include "task.h" | |
| #include "dosexe.h" | |
| #include "toolhelp.h" | |
| #include "debug.h" | |
| #include "selectors.h" | |
| #include "thread.h" | |
| #include "process.h" | |
| #include "stackframe.h" | |
| #include "callback.h" | |
| #define DOS_GET_DRIVE(reg) ((reg) ? (reg) - 1 : DRIVE_GetCurrentDrive()) | |
| void CreateBPB(int drive, BYTE *data, BOOL16 limited); /* defined in int21.c */ | |
| static void* lastvalloced = NULL; | |
| /* Structure for real-mode callbacks */ | |
| typedef struct | |
| { | |
| DWORD edi; | |
| DWORD esi; | |
| DWORD ebp; | |
| DWORD reserved; | |
| DWORD ebx; | |
| DWORD edx; | |
| DWORD ecx; | |
| DWORD eax; | |
| WORD fl; | |
| WORD es; | |
| WORD ds; | |
| WORD fs; | |
| WORD gs; | |
| WORD ip; | |
| WORD cs; | |
| WORD sp; | |
| WORD ss; | |
| } REALMODECALL; | |
| typedef struct tagRMCB { | |
| DWORD address; | |
| DWORD proc_ofs,proc_sel; | |
| DWORD regs_ofs,regs_sel; | |
| struct tagRMCB *next; | |
| } RMCB; | |
| static RMCB *FirstRMCB = NULL; | |
| /********************************************************************** | |
| * DPMI_xalloc | |
| * special virtualalloc, allocates lineary monoton growing memory. | |
| * (the usual VirtualAlloc does not satisfy that restriction) | |
| */ | |
| static LPVOID | |
| DPMI_xalloc(int len) { | |
| LPVOID ret; | |
| LPVOID oldlastv = lastvalloced; | |
| if (lastvalloced) { | |
| int xflag = 0; | |
| ret = NULL; | |
| while (!ret) { | |
| ret=VirtualAlloc(lastvalloced,len,MEM_COMMIT|MEM_RESERVE,PAGE_EXECUTE_READWRITE); | |
| if (!ret) | |
| lastvalloced+=0x10000; | |
| /* we failed to allocate one in the first round. | |
| * try non-linear | |
| */ | |
| if (!xflag && (lastvalloced<oldlastv)) { /* wrapped */ | |
| FIXME(int31,"failed to allocate lineary growing memory (%d bytes), using non-linear growing...\n",len); | |
| xflag++; | |
| } | |
| /* if we even fail to allocate something in the next | |
| * round, return NULL | |
| */ | |
| if ((xflag==1) && (lastvalloced >= oldlastv)) | |
| xflag++; | |
| if ((xflag==2) && (lastvalloced < oldlastv)) { | |
| FIXME(int31,"failed to allocate any memory of %d bytes!\n",len); | |
| return NULL; | |
| } | |
| } | |
| } else | |
| ret=VirtualAlloc(NULL,len,MEM_COMMIT|MEM_RESERVE,PAGE_EXECUTE_READWRITE); | |
| lastvalloced = (LPVOID)(((DWORD)ret+len+0xffff)&~0xffff); | |
| return ret; | |
| } | |
| static void | |
| DPMI_xfree(LPVOID ptr) { | |
| VirtualFree(ptr,0,MEM_RELEASE); | |
| } | |
| /* FIXME: perhaps we could grow this mapped area... */ | |
| static LPVOID | |
| DPMI_xrealloc(LPVOID ptr,int newsize) { | |
| MEMORY_BASIC_INFORMATION mbi; | |
| LPVOID newptr; | |
| newptr = DPMI_xalloc(newsize); | |
| if (ptr) { | |
| if (!VirtualQuery(ptr,&mbi,sizeof(mbi))) { | |
| FIXME(int31,"realloc of DPMI_xallocd region %p?\n",ptr); | |
| return NULL; | |
| } | |
| if (mbi.State == MEM_FREE) { | |
| FIXME(int31,"realloc of DPMI_xallocd region %p?\n",ptr); | |
| return NULL; | |
| } | |
| /* We do not shrink allocated memory. most reallocs | |
| * only do grows anyway | |
| */ | |
| if (newsize<=mbi.RegionSize) | |
| return ptr; | |
| memcpy(newptr,ptr,mbi.RegionSize); | |
| DPMI_xfree(ptr); | |
| } | |
| return newptr; | |
| } | |
| /********************************************************************** | |
| * INT_GetRealModeContext | |
| */ | |
| static void INT_GetRealModeContext( REALMODECALL *call, CONTEXT *context ) | |
| { | |
| EAX_reg(context) = call->eax; | |
| EBX_reg(context) = call->ebx; | |
| ECX_reg(context) = call->ecx; | |
| EDX_reg(context) = call->edx; | |
| ESI_reg(context) = call->esi; | |
| EDI_reg(context) = call->edi; | |
| EBP_reg(context) = call->ebp; | |
| EFL_reg(context) = call->fl | V86_FLAG; | |
| EIP_reg(context) = call->ip; | |
| ESP_reg(context) = call->sp; | |
| CS_reg(context) = call->cs; | |
| DS_reg(context) = call->ds; | |
| ES_reg(context) = call->es; | |
| FS_reg(context) = call->fs; | |
| GS_reg(context) = call->gs; | |
| (char*)V86BASE(context) = DOSMEM_MemoryBase(0); | |
| } | |
| /********************************************************************** | |
| * INT_SetRealModeContext | |
| */ | |
| static void INT_SetRealModeContext( REALMODECALL *call, CONTEXT *context ) | |
| { | |
| call->eax = EAX_reg(context); | |
| call->ebx = EBX_reg(context); | |
| call->ecx = ECX_reg(context); | |
| call->edx = EDX_reg(context); | |
| call->esi = ESI_reg(context); | |
| call->edi = EDI_reg(context); | |
| call->ebp = EBP_reg(context); | |
| call->fl = FL_reg(context); | |
| call->ip = IP_reg(context); | |
| call->sp = SP_reg(context); | |
| call->cs = CS_reg(context); | |
| call->ds = DS_reg(context); | |
| call->es = ES_reg(context); | |
| call->fs = FS_reg(context); | |
| call->gs = GS_reg(context); | |
| } | |
| /********************************************************************** | |
| * DPMI_CallRMCBProc | |
| * | |
| * This routine does the hard work of calling a callback procedure. | |
| */ | |
| static void DPMI_CallRMCBProc( CONTEXT *context, RMCB *rmcb, WORD flag ) | |
| { | |
| if (IS_SELECTOR_SYSTEM( rmcb->proc_sel )) { | |
| /* Wine-internal RMCB, call directly */ | |
| ((RMCBPROC)rmcb->proc_ofs)(context); | |
| } else { | |
| #ifdef __i386__ | |
| UINT16 ss,es; | |
| DWORD edi; | |
| INT_SetRealModeContext((REALMODECALL *)PTR_SEG_OFF_TO_LIN( rmcb->regs_sel, rmcb->regs_ofs ), context); | |
| ss = SELECTOR_AllocBlock( DOSMEM_MemoryBase(0) + (DWORD)(SS_reg(context)<<4), 0x10000, SEGMENT_DATA, FALSE, FALSE ); | |
| FIXME(int31,"untested!\n"); | |
| /* The called proc ends with an IRET, and takes these parameters: | |
| * DS:ESI = pointer to real-mode SS:SP | |
| * ES:EDI = pointer to real-mode call structure | |
| * It returns: | |
| * ES:EDI = pointer to real-mode call structure (may be a copy) | |
| * It is the proc's responsibility to change the return CS:IP in the | |
| * real-mode call structure. */ | |
| if (flag & 1) { | |
| /* 32-bit DPMI client */ | |
| __asm__ __volatile__(" | |
| pushl %%es | |
| pushl %%ds | |
| pushfl | |
| movl %4,%%es | |
| movl %3,%%ds | |
| lcall %2 | |
| popl %%ds | |
| movl %%es,%0 | |
| popl %%es | |
| " | |
| : "=g" (es), "=D" (edi) | |
| : "m" (rmcb->proc_ofs), | |
| "g" (ss), "g" (rmcb->regs_sel), | |
| "S" (ESP_reg(context)), "D" (rmcb->regs_ofs) | |
| : "eax", "ecx", "edx", "esi", "ebp" ); | |
| } else { | |
| /* 16-bit DPMI client */ | |
| CONTEXT ctx = *context; | |
| CS_reg(&ctx) = rmcb->proc_sel; | |
| EIP_reg(&ctx) = rmcb->proc_ofs; | |
| DS_reg(&ctx) = ss; | |
| ESI_reg(&ctx) = ESP_reg(context); | |
| ES_reg(&ctx) = rmcb->regs_sel; | |
| EDI_reg(&ctx) = rmcb->regs_ofs; | |
| Callbacks->CallRegisterShortProc(&ctx, 2); | |
| es = ES_reg(&ctx); | |
| edi = EDI_reg(&ctx); | |
| } | |
| UnMapLS(PTR_SEG_OFF_TO_SEGPTR(ss,0)); | |
| INT_GetRealModeContext((REALMODECALL*)PTR_SEG_OFF_TO_LIN( es, edi ), context); | |
| #else | |
| ERR(int31,"RMCBs only implemented for i386\n"); | |
| #endif | |
| } | |
| } | |
| /********************************************************************** | |
| * DPMI_CallRMProc | |
| * | |
| * This routine does the hard work of calling a real mode procedure. | |
| */ | |
| int DPMI_CallRMProc( CONTEXT *context, LPWORD stack, int args, int iret ) | |
| { | |
| LPWORD stack16; | |
| THDB *thdb = THREAD_Current(); | |
| LPVOID addr = NULL; /* avoid gcc warning */ | |
| TDB *pTask = (TDB *)GlobalLock16( GetCurrentTask() ); | |
| NE_MODULE *pModule = pTask ? NE_GetPtr( pTask->hModule ) : NULL; | |
| RMCB *CurrRMCB; | |
| int alloc = 0, already = 0; | |
| WORD sel; | |
| SEGPTR seg_addr; | |
| GlobalUnlock16( GetCurrentTask() ); | |
| TRACE(int31, "EAX=%08lx EBX=%08lx ECX=%08lx EDX=%08lx\n", | |
| EAX_reg(context), EBX_reg(context), ECX_reg(context), EDX_reg(context) ); | |
| TRACE(int31, "ESI=%08lx EDI=%08lx ES=%04x DS=%04x CS:IP=%04x:%04x, %d WORD arguments, %s\n", | |
| ESI_reg(context), EDI_reg(context), ES_reg(context), DS_reg(context), | |
| CS_reg(context), IP_reg(context), args, iret?"IRET":"FAR" ); | |
| callrmproc_again: | |
| /* shortcut for chaining to internal interrupt handlers */ | |
| if ((CS_reg(context) == 0xF000) && iret) { | |
| return INT_RealModeInterrupt( IP_reg(context)/4, context); | |
| } | |
| /* shortcut for RMCBs */ | |
| CurrRMCB = FirstRMCB; | |
| while (CurrRMCB && (HIWORD(CurrRMCB->address) != CS_reg(context))) | |
| CurrRMCB = CurrRMCB->next; | |
| #ifdef MZ_SUPPORTED | |
| FIXME(int31,"DPMI real-mode call using DOS VM task system, not fully tested!\n"); | |
| if (!(CurrRMCB || pModule->lpDosTask)) { | |
| TRACE(int31,"creating VM86 task\n"); | |
| if (MZ_InitTask( MZ_AllocDPMITask( pModule->self ) ) < 32) { | |
| ERR(int31,"could not setup VM86 task\n"); | |
| return 1; | |
| } | |
| } | |
| if (!already) { | |
| if (!SS_reg(context)) { | |
| alloc = 1; /* allocate default stack */ | |
| stack16 = addr = DOSMEM_GetBlock( pModule->self, 64, &(SS_reg(context)) ); | |
| SP_reg(context) = 64-2; | |
| stack16 += 32-1; | |
| if (!addr) { | |
| ERR(int31,"could not allocate default stack\n"); | |
| return 1; | |
| } | |
| } else { | |
| stack16 = CTX_SEG_OFF_TO_LIN(context, SS_reg(context), ESP_reg(context)); | |
| } | |
| SP_reg(context) -= (args + (iret?1:0)) * sizeof(WORD); | |
| #else | |
| if (!already) { | |
| stack16 = THREAD_STACK16(thdb); | |
| #endif | |
| stack16 -= args; | |
| if (args) memcpy(stack16, stack, args*sizeof(WORD) ); | |
| /* push flags if iret */ | |
| if (iret) { | |
| stack16--; args++; | |
| *stack16 = FL_reg(context); | |
| } | |
| #ifdef MZ_SUPPORTED | |
| /* push return address (return to interrupt wrapper) */ | |
| *(--stack16) = pModule->lpDosTask->dpmi_seg; | |
| *(--stack16) = pModule->lpDosTask->wrap_ofs; | |
| /* adjust stack */ | |
| SP_reg(context) -= 2*sizeof(WORD); | |
| #endif | |
| already = 1; | |
| } | |
| if (CurrRMCB) { | |
| /* RMCB call, invoke protected-mode handler directly */ | |
| DPMI_CallRMCBProc(context, CurrRMCB, pModule->lpDosTask?pModule->lpDosTask->dpmi_flag:0); | |
| /* check if we returned to where we thought we would */ | |
| if ((CS_reg(context) != pModule->lpDosTask->dpmi_seg) || | |
| (IP_reg(context) != pModule->lpDosTask->wrap_ofs)) { | |
| /* we need to continue at different address in real-mode space, | |
| so we need to set it all up for real mode again */ | |
| goto callrmproc_again; | |
| } | |
| } else { | |
| #ifdef MZ_SUPPORTED | |
| #if 0 /* this was probably unnecessary */ | |
| /* push call address */ | |
| *(--stack16) = CS_reg(context); | |
| *(--stack16) = IP_reg(context); | |
| /* adjust stack */ | |
| SP_reg(context) -= 2*sizeof(WORD); | |
| /* set initial CS:IP to the wrapper's "lret" */ | |
| CS_reg(context) = pModule->lpDosTask->dpmi_seg; | |
| IP_reg(context) = pModule->lpDosTask->call_ofs; | |
| #endif | |
| TRACE(int31,"entering real mode...\n"); | |
| DOSVM_Enter( context ); | |
| TRACE(int31,"returned from real-mode call\n"); | |
| #else | |
| addr = CTX_SEG_OFF_TO_LIN(context, CS_reg(context), EIP_reg(context)); | |
| sel = SELECTOR_AllocBlock( addr, 0x10000, SEGMENT_CODE, FALSE, FALSE ); | |
| seg_addr = PTR_SEG_OFF_TO_SEGPTR( sel, 0 ); | |
| CS_reg(context) = HIWORD(seg_addr); | |
| IP_reg(context) = LOWORD(seg_addr); | |
| EBP_reg(context) = OFFSETOF( thdb->cur_stack ) | |
| + (WORD)&((STACK16FRAME*)0)->bp; | |
| Callbacks->CallRegisterShortProc(context, args*sizeof(WORD)); | |
| UnMapLS(seg_addr); | |
| #endif | |
| } | |
| if (alloc) DOSMEM_FreeBlock( pModule->self, addr ); | |
| return 0; | |
| } | |
| /********************************************************************** | |
| * CallRMInt | |
| */ | |
| static void CallRMInt( CONTEXT *context ) | |
| { | |
| CONTEXT realmode_ctx; | |
| FARPROC16 rm_int = INT_GetRMHandler( BL_reg(context) ); | |
| REALMODECALL *call = (REALMODECALL *)PTR_SEG_OFF_TO_LIN( ES_reg(context), | |
| DI_reg(context) ); | |
| INT_GetRealModeContext( call, &realmode_ctx ); | |
| /* we need to check if a real-mode program has hooked the interrupt */ | |
| if (HIWORD(rm_int)!=0xF000) { | |
| /* yup, which means we need to switch to real mode... */ | |
| CS_reg(&realmode_ctx) = HIWORD(rm_int); | |
| EIP_reg(&realmode_ctx) = LOWORD(rm_int); | |
| if (DPMI_CallRMProc( &realmode_ctx, NULL, 0, TRUE)) | |
| SET_CFLAG(context); | |
| } else { | |
| RESET_CFLAG(context); | |
| /* use the IP we have instead of BL_reg, in case some apps | |
| decide to move interrupts around for whatever reason... */ | |
| if (INT_RealModeInterrupt( LOWORD(rm_int)/4, &realmode_ctx )) | |
| SET_CFLAG(context); | |
| if (EFL_reg(context)&1) { | |
| FIXME(int31,"%02x: EAX=%08lx EBX=%08lx ECX=%08lx EDX=%08lx\n", | |
| BL_reg(context), EAX_reg(&realmode_ctx), EBX_reg(&realmode_ctx), | |
| ECX_reg(&realmode_ctx), EDX_reg(&realmode_ctx)); | |
| FIXME(int31," ESI=%08lx EDI=%08lx DS=%04lx ES=%04lx\n", | |
| ESI_reg(&realmode_ctx), EDI_reg(&realmode_ctx), | |
| DS_reg(&realmode_ctx), ES_reg(&realmode_ctx) ); | |
| } | |
| } | |
| INT_SetRealModeContext( call, &realmode_ctx ); | |
| } | |
| static void CallRMProc( CONTEXT *context, int iret ) | |
| { | |
| REALMODECALL *p = (REALMODECALL *)PTR_SEG_OFF_TO_LIN( ES_reg(context), DI_reg(context) ); | |
| CONTEXT context16; | |
| THDB *thdb = THREAD_Current(); | |
| WORD argsize, sel; | |
| LPVOID addr; | |
| SEGPTR seg_addr; | |
| TRACE(int31, "RealModeCall: EAX=%08lx EBX=%08lx ECX=%08lx EDX=%08lx\n", | |
| p->eax, p->ebx, p->ecx, p->edx); | |
| TRACE(int31, " ESI=%08lx EDI=%08lx ES=%04x DS=%04x CS:IP=%04x:%04x, %d WORD arguments, %s\n", | |
| p->esi, p->edi, p->es, p->ds, p->cs, p->ip, CX_reg(context), iret?"IRET":"FAR" ); | |
| if (!(p->cs) && !(p->ip)) { /* remove this check | |
| if Int21/6501 case map function | |
| has been implemented */ | |
| SET_CFLAG(context); | |
| return; | |
| } | |
| INT_GetRealModeContext(p, &context16); | |
| DPMI_CallRMProc( &context16, ((LPWORD)PTR_SEG_OFF_TO_LIN(SS_reg(context), SP_reg(context)))+3, | |
| CX_reg(context), iret ); | |
| INT_SetRealModeContext(p, &context16); | |
| } | |
| static void WINAPI RMCallbackProc( RMCB *rmcb ) | |
| { | |
| /* This routine should call DPMI_CallRMCBProc, but we don't have the | |
| register structure available - this is easily fixed by going through | |
| a Win16 register relay instead of calling RMCallbackProc "directly", | |
| but I won't bother at this time. */ | |
| FIXME(int31,"not properly supported on your architecture!\n"); | |
| } | |
| static RMCB *DPMI_AllocRMCB( void ) | |
| { | |
| RMCB *NewRMCB = HeapAlloc(GetProcessHeap(), 0, sizeof(RMCB)); | |
| UINT16 uParagraph; | |
| if (NewRMCB) | |
| { | |
| #ifdef MZ_SUPPORTED | |
| LPVOID RMCBmem = DOSMEM_GetBlock(0, 4, &uParagraph); | |
| LPBYTE p = RMCBmem; | |
| *p++ = 0xcd; /* RMCB: */ | |
| *p++ = 0x31; /* int $0x31 */ | |
| /* it is the called procedure's task to change the return CS:EIP | |
| the DPMI 0.9 spec states that if it doesn't, it will be called again */ | |
| *p++ = 0xeb; | |
| *p++ = 0xfc; /* jmp RMCB */ | |
| #else | |
| LPVOID RMCBmem = DOSMEM_GetBlock(0, 15, &uParagraph); | |
| LPBYTE p = RMCBmem; | |
| *p++ = 0x68; /* pushl */ | |
| *(LPVOID *)p = NewRMCB; | |
| p+=4; | |
| *p++ = 0x9a; /* lcall */ | |
| *(FARPROC16 *)p = (FARPROC16)RMCallbackProc; /* FIXME: register relay */ | |
| p+=4; | |
| GET_CS(*(WORD *)p); | |
| p+=2; | |
| *p++=0xc3; /* lret (FIXME?) */ | |
| #endif | |
| NewRMCB->address = MAKELONG(0, uParagraph); | |
| NewRMCB->next = FirstRMCB; | |
| FirstRMCB = NewRMCB; | |
| } | |
| return NewRMCB; | |
| } | |
| static void AllocRMCB( CONTEXT *context ) | |
| { | |
| RMCB *NewRMCB = DPMI_AllocRMCB(); | |
| REALMODECALL *p = (REALMODECALL *)PTR_SEG_OFF_TO_LIN( ES_reg(context), DI_reg(context) ); | |
| TRACE(int31, "Function to call: %04x:%04x\n", (WORD)DS_reg(context), SI_reg(context) ); | |
| if (NewRMCB) | |
| { | |
| /* FIXME: if 32-bit DPMI client, use ESI and EDI */ | |
| NewRMCB->proc_ofs = SI_reg(context); | |
| NewRMCB->proc_sel = DS_reg(context); | |
| NewRMCB->regs_ofs = DI_reg(context); | |
| NewRMCB->regs_sel = ES_reg(context); | |
| CX_reg(context) = HIWORD(NewRMCB->address); | |
| DX_reg(context) = LOWORD(NewRMCB->address); | |
| } | |
| else | |
| { | |
| AX_reg(context) = 0x8015; /* callback unavailable */ | |
| SET_CFLAG(context); | |
| } | |
| } | |
| FARPROC16 WINAPI DPMI_AllocInternalRMCB( RMCBPROC proc ) | |
| { | |
| RMCB *NewRMCB = DPMI_AllocRMCB(); | |
| if (NewRMCB) { | |
| NewRMCB->proc_ofs = (DWORD)proc; | |
| NewRMCB->proc_sel = 0; | |
| NewRMCB->regs_ofs = 0; | |
| NewRMCB->regs_sel = 0; | |
| return (FARPROC16)(NewRMCB->address); | |
| } | |
| return NULL; | |
| } | |
| static int DPMI_FreeRMCB( DWORD address ) | |
| { | |
| RMCB *CurrRMCB = FirstRMCB; | |
| RMCB *PrevRMCB = NULL; | |
| while (CurrRMCB && (CurrRMCB->address != address)) | |
| { | |
| PrevRMCB = CurrRMCB; | |
| CurrRMCB = CurrRMCB->next; | |
| } | |
| if (CurrRMCB) | |
| { | |
| if (PrevRMCB) | |
| PrevRMCB->next = CurrRMCB->next; | |
| else | |
| FirstRMCB = CurrRMCB->next; | |
| DOSMEM_FreeBlock(0, DOSMEM_MapRealToLinear(CurrRMCB->address)); | |
| HeapFree(GetProcessHeap(), 0, CurrRMCB); | |
| return 0; | |
| } | |
| return 1; | |
| } | |
| static void FreeRMCB( CONTEXT *context ) | |
| { | |
| FIXME(int31, "callback address: %04x:%04x\n", | |
| CX_reg(context), DX_reg(context)); | |
| if (DPMI_FreeRMCB(MAKELONG(DX_reg(context), CX_reg(context)))) { | |
| AX_reg(context) = 0x8024; /* invalid callback address */ | |
| SET_CFLAG(context); | |
| } | |
| } | |
| void WINAPI DPMI_FreeInternalRMCB( FARPROC16 proc ) | |
| { | |
| DPMI_FreeRMCB( (DWORD)proc ); | |
| } | |
| #ifdef MZ_SUPPORTED | |
| /* (see loader/dos/module.c, function MZ_InitDPMI) */ | |
| static void StartPM( CONTEXT *context, LPDOSTASK lpDosTask ) | |
| { | |
| char *base = DOSMEM_MemoryBase(0); | |
| UINT16 cs, ss, ds, es; | |
| CONTEXT pm_ctx; | |
| RESET_CFLAG(context); | |
| lpDosTask->dpmi_flag = AX_reg(context); | |
| /* our mode switch wrapper have placed the desired CS into DX */ | |
| cs = SELECTOR_AllocBlock( base + (DWORD)(DX_reg(context)<<4), 0x10000, SEGMENT_CODE, FALSE, FALSE ); | |
| ss = SELECTOR_AllocBlock( base + (DWORD)(SS_reg(context)<<4), 0x10000, SEGMENT_DATA, FALSE, FALSE ); | |
| ds = SELECTOR_AllocBlock( base + (DWORD)(DS_reg(context)<<4), 0x10000, SEGMENT_DATA, FALSE, FALSE ); | |
| es = SELECTOR_AllocBlock( base + (DWORD)(lpDosTask->psp_seg<<4), 0x100, SEGMENT_DATA, FALSE, FALSE ); | |
| pm_ctx = *context; | |
| CS_reg(&pm_ctx) = lpDosTask->dpmi_sel; | |
| /* our mode switch wrapper expects the new CS in DX, and the new SS in AX */ | |
| AX_reg(&pm_ctx) = ss; | |
| DX_reg(&pm_ctx) = cs; | |
| DS_reg(&pm_ctx) = ds; | |
| ES_reg(&pm_ctx) = es; | |
| FS_reg(&pm_ctx) = 0; | |
| GS_reg(&pm_ctx) = 0; | |
| TRACE(int31,"DOS program is now entering protected mode\n"); | |
| Callbacks->CallRegisterShortProc(&pm_ctx, 0); | |
| /* in the current state of affairs, we won't ever actually return here... */ | |
| UnMapLS(PTR_SEG_OFF_TO_SEGPTR(es,0)); | |
| UnMapLS(PTR_SEG_OFF_TO_SEGPTR(ds,0)); | |
| UnMapLS(PTR_SEG_OFF_TO_SEGPTR(ss,0)); | |
| UnMapLS(PTR_SEG_OFF_TO_SEGPTR(cs,0)); | |
| } | |
| #endif | |
| /********************************************************************** | |
| * INT_Int31Handler | |
| * | |
| * Handler for int 31h (DPMI). | |
| */ | |
| void WINAPI INT_Int31Handler( CONTEXT *context ) | |
| { | |
| /* | |
| * Note: For Win32s processes, the whole linear address space is | |
| * shifted by 0x10000 relative to the OS linear address space. | |
| * See the comment in msdos/vxd.c. | |
| */ | |
| DWORD offset = W32S_APPLICATION() ? W32S_OFFSET : 0; | |
| DWORD dw; | |
| BYTE *ptr; | |
| TDB *pTask = (TDB *)GlobalLock16( GetCurrentTask() ); | |
| NE_MODULE *pModule = pTask ? NE_GetPtr( pTask->hModule ) : NULL; | |
| GlobalUnlock16( GetCurrentTask() ); | |
| #ifdef MZ_SUPPORTED | |
| if (ISV86(context) && pModule && pModule->lpDosTask) { | |
| /* Called from real mode, check if it's our wrapper */ | |
| TRACE(int31,"called from real mode\n"); | |
| if (CS_reg(context)==pModule->lpDosTask->dpmi_seg) { | |
| /* This is the protected mode switch */ | |
| StartPM(context,pModule->lpDosTask); | |
| return; | |
| } else | |
| if (CS_reg(context)==pModule->lpDosTask->xms_seg) { | |
| /* This is the XMS driver entry point */ | |
| XMS_Handler(context); | |
| return; | |
| } else | |
| { | |
| /* Check for RMCB */ | |
| RMCB *CurrRMCB = FirstRMCB; | |
| while (CurrRMCB && (HIWORD(CurrRMCB->address) != CS_reg(context))) | |
| CurrRMCB = CurrRMCB->next; | |
| if (CurrRMCB) { | |
| /* RMCB call, propagate to protected-mode handler */ | |
| DPMI_CallRMCBProc(context, CurrRMCB, pModule->lpDosTask->dpmi_flag); | |
| return; | |
| } | |
| } | |
| } | |
| #endif | |
| RESET_CFLAG(context); | |
| switch(AX_reg(context)) | |
| { | |
| case 0x0000: /* Allocate LDT descriptors */ | |
| TRACE(int31,"allocate LDT descriptors (%d)\n",CX_reg(context)); | |
| if (!(AX_reg(context) = AllocSelectorArray( CX_reg(context) ))) | |
| { | |
| TRACE(int31,"failed\n"); | |
| AX_reg(context) = 0x8011; /* descriptor unavailable */ | |
| SET_CFLAG(context); | |
| } | |
| TRACE(int31,"success, array starts at 0x%04x\n",AX_reg(context)); | |
| break; | |
| case 0x0001: /* Free LDT descriptor */ | |
| TRACE(int31,"free LDT descriptor (0x%04x)\n",BX_reg(context)); | |
| if (FreeSelector( BX_reg(context) )) | |
| { | |
| AX_reg(context) = 0x8022; /* invalid selector */ | |
| SET_CFLAG(context); | |
| } | |
| else | |
| { | |
| /* If a segment register contains the selector being freed, */ | |
| /* set it to zero. */ | |
| if (!((DS_reg(context)^BX_reg(context)) & ~3)) DS_reg(context) = 0; | |
| if (!((ES_reg(context)^BX_reg(context)) & ~3)) ES_reg(context) = 0; | |
| if (!((FS_reg(context)^BX_reg(context)) & ~3)) FS_reg(context) = 0; | |
| if (!((GS_reg(context)^BX_reg(context)) & ~3)) GS_reg(context) = 0; | |
| } | |
| break; | |
| case 0x0002: /* Real mode segment to descriptor */ | |
| TRACE(int31,"real mode segment to descriptor (0x%04x)\n",BX_reg(context)); | |
| { | |
| WORD entryPoint = 0; /* KERNEL entry point for descriptor */ | |
| switch(BX_reg(context)) | |
| { | |
| case 0x0000: entryPoint = 183; break; /* __0000H */ | |
| case 0x0040: entryPoint = 193; break; /* __0040H */ | |
| case 0xa000: entryPoint = 174; break; /* __A000H */ | |
| case 0xb000: entryPoint = 181; break; /* __B000H */ | |
| case 0xb800: entryPoint = 182; break; /* __B800H */ | |
| case 0xc000: entryPoint = 195; break; /* __C000H */ | |
| case 0xd000: entryPoint = 179; break; /* __D000H */ | |
| case 0xe000: entryPoint = 190; break; /* __E000H */ | |
| case 0xf000: entryPoint = 194; break; /* __F000H */ | |
| default: | |
| AX_reg(context) = DOSMEM_AllocSelector(BX_reg(context)); | |
| break; | |
| } | |
| if (entryPoint) | |
| AX_reg(context) = LOWORD(NE_GetEntryPoint( | |
| GetModuleHandle16( "KERNEL" ), | |
| entryPoint )); | |
| } | |
| break; | |
| case 0x0003: /* Get next selector increment */ | |
| TRACE(int31,"get selector increment (__AHINCR)\n"); | |
| AX_reg(context) = __AHINCR; | |
| break; | |
| case 0x0004: /* Lock selector (not supported) */ | |
| FIXME(int31,"lock selector not supported\n"); | |
| AX_reg(context) = 0; /* FIXME: is this a correct return value? */ | |
| break; | |
| case 0x0005: /* Unlock selector (not supported) */ | |
| FIXME(int31,"unlock selector not supported\n"); | |
| AX_reg(context) = 0; /* FIXME: is this a correct return value? */ | |
| break; | |
| case 0x0006: /* Get selector base address */ | |
| TRACE(int31,"get selector base address (0x%04x)\n",BX_reg(context)); | |
| if (!(dw = GetSelectorBase( BX_reg(context) ))) | |
| { | |
| AX_reg(context) = 0x8022; /* invalid selector */ | |
| SET_CFLAG(context); | |
| } | |
| else | |
| { | |
| #ifdef MZ_SUPPORTED | |
| if (pModule && pModule->lpDosTask) { | |
| DWORD base = (DWORD)DOSMEM_MemoryBase(pModule->self); | |
| if ((dw >= base) && (dw < base + 0x110000)) dw -= base; | |
| } | |
| #endif | |
| CX_reg(context) = HIWORD(W32S_WINE2APP(dw, offset)); | |
| DX_reg(context) = LOWORD(W32S_WINE2APP(dw, offset)); | |
| } | |
| break; | |
| case 0x0007: /* Set selector base address */ | |
| TRACE(int31, "set selector base address (0x%04x,0x%08lx)\n", | |
| BX_reg(context), | |
| W32S_APP2WINE(MAKELONG(DX_reg(context),CX_reg(context)), offset)); | |
| dw = W32S_APP2WINE(MAKELONG(DX_reg(context), CX_reg(context)), offset); | |
| #ifdef MZ_SUPPORTED | |
| /* well, what else could we possibly do? */ | |
| if (pModule && pModule->lpDosTask) { | |
| if (dw < 0x110000) dw += (DWORD)DOSMEM_MemoryBase(pModule->self); | |
| } | |
| #endif | |
| SetSelectorBase(BX_reg(context), dw); | |
| break; | |
| case 0x0008: /* Set selector limit */ | |
| TRACE(int31,"set selector limit (0x%04x,0x%08lx)\n",BX_reg(context),MAKELONG(DX_reg(context),CX_reg(context))); | |
| dw = MAKELONG( DX_reg(context), CX_reg(context) ); | |
| #ifdef MZ_SUPPORTED | |
| if (pModule && pModule->lpDosTask) { | |
| DWORD base = GetSelectorBase( BX_reg(context) ); | |
| if ((dw == 0xffffffff) || ((base < 0x110000) && (base + dw > 0x110000))) { | |
| AX_reg(context) = 0x8021; /* invalid value */ | |
| SET_CFLAG(context); | |
| break; | |
| } | |
| } | |
| #endif | |
| SetSelectorLimit( BX_reg(context), dw ); | |
| break; | |
| case 0x0009: /* Set selector access rights */ | |
| TRACE(int31,"set selector access rights(0x%04x,0x%04x)\n",BX_reg(context),CX_reg(context)); | |
| SelectorAccessRights( BX_reg(context), 1, CX_reg(context) ); | |
| break; | |
| case 0x000a: /* Allocate selector alias */ | |
| TRACE(int31,"allocate selector alias (0x%04x)\n",BX_reg(context)); | |
| if (!(AX_reg(context) = AllocCStoDSAlias( BX_reg(context) ))) | |
| { | |
| AX_reg(context) = 0x8011; /* descriptor unavailable */ | |
| SET_CFLAG(context); | |
| } | |
| break; | |
| case 0x000b: /* Get descriptor */ | |
| TRACE(int31,"get descriptor (0x%04x)\n",BX_reg(context)); | |
| { | |
| ldt_entry entry; | |
| LDT_GetEntry( SELECTOR_TO_ENTRY( BX_reg(context) ), &entry ); | |
| entry.base = W32S_WINE2APP(entry.base, offset); | |
| /* FIXME: should use ES:EDI for 32-bit clients */ | |
| LDT_EntryToBytes( PTR_SEG_OFF_TO_LIN( ES_reg(context), | |
| DI_reg(context) ), &entry ); | |
| } | |
| break; | |
| case 0x000c: /* Set descriptor */ | |
| TRACE(int31,"set descriptor (0x%04x)\n",BX_reg(context)); | |
| { | |
| ldt_entry entry; | |
| LDT_BytesToEntry( PTR_SEG_OFF_TO_LIN( ES_reg(context), | |
| DI_reg(context) ), &entry ); | |
| entry.base = W32S_APP2WINE(entry.base, offset); | |
| LDT_SetEntry( SELECTOR_TO_ENTRY( BX_reg(context) ), &entry ); | |
| } | |
| break; | |
| case 0x000d: /* Allocate specific LDT descriptor */ | |
| FIXME(int31,"allocate descriptor (0x%04x), stub!\n",BX_reg(context)); | |
| AX_reg(context) = 0x8011; /* descriptor unavailable */ | |
| SET_CFLAG(context); | |
| break; | |
| case 0x0100: /* Allocate DOS memory block */ | |
| TRACE(int31,"allocate DOS memory block (0x%x paragraphs)\n",BX_reg(context)); | |
| dw = GlobalDOSAlloc((DWORD)BX_reg(context)<<4); | |
| if (dw) { | |
| AX_reg(context) = HIWORD(dw); | |
| DX_reg(context) = LOWORD(dw); | |
| } else { | |
| AX_reg(context) = 0x0008; /* insufficient memory */ | |
| BX_reg(context) = DOSMEM_Available(0)>>4; | |
| SET_CFLAG(context); | |
| } | |
| break; | |
| case 0x0101: /* Free DOS memory block */ | |
| TRACE(int31,"free DOS memory block (0x%04x)\n",DX_reg(context)); | |
| dw = GlobalDOSFree(DX_reg(context)); | |
| if (!dw) { | |
| AX_reg(context) = 0x0009; /* memory block address invalid */ | |
| SET_CFLAG(context); | |
| } | |
| break; | |
| case 0x0200: /* get real mode interrupt vector */ | |
| FIXME(int31,"get realmode interupt vector(0x%02x) unimplemented.\n", | |
| BL_reg(context)); | |
| SET_CFLAG(context); | |
| break; | |
| case 0x0201: /* set real mode interrupt vector */ | |
| FIXME(int31, "set realmode interupt vector(0x%02x,0x%04x:0x%04x) unimplemented\n", BL_reg(context),CX_reg(context),DX_reg(context)); | |
| SET_CFLAG(context); | |
| break; | |
| case 0x0204: /* Get protected mode interrupt vector */ | |
| TRACE(int31,"get protected mode interrupt handler (0x%02x), stub!\n",BL_reg(context)); | |
| dw = (DWORD)INT_GetPMHandler( BL_reg(context) ); | |
| CX_reg(context) = HIWORD(dw); | |
| DX_reg(context) = LOWORD(dw); | |
| break; | |
| case 0x0205: /* Set protected mode interrupt vector */ | |
| TRACE(int31,"set protected mode interrupt handler (0x%02x,%p), stub!\n", | |
| BL_reg(context),PTR_SEG_OFF_TO_LIN(CX_reg(context),DX_reg(context))); | |
| INT_SetPMHandler( BL_reg(context), | |
| (FARPROC16)PTR_SEG_OFF_TO_SEGPTR( CX_reg(context), | |
| DX_reg(context) )); | |
| break; | |
| case 0x0300: /* Simulate real mode interrupt */ | |
| CallRMInt( context ); | |
| break; | |
| case 0x0301: /* Call real mode procedure with far return */ | |
| CallRMProc( context, FALSE ); | |
| break; | |
| case 0x0302: /* Call real mode procedure with interrupt return */ | |
| CallRMProc( context, TRUE ); | |
| break; | |
| case 0x0303: /* Allocate Real Mode Callback Address */ | |
| AllocRMCB( context ); | |
| break; | |
| case 0x0304: /* Free Real Mode Callback Address */ | |
| FreeRMCB( context ); | |
| break; | |
| case 0x0400: /* Get DPMI version */ | |
| TRACE(int31,"get DPMI version\n"); | |
| { | |
| SYSTEM_INFO si; | |
| GetSystemInfo(&si); | |
| AX_reg(context) = 0x005a; /* DPMI version 0.90 */ | |
| BX_reg(context) = 0x0005; /* Flags: 32-bit, virtual memory */ | |
| CL_reg(context) = si.wProcessorLevel; | |
| DX_reg(context) = 0x0102; /* Master/slave interrupt controller base*/ | |
| break; | |
| } | |
| case 0x0500: /* Get free memory information */ | |
| TRACE(int31,"get free memory information\n"); | |
| { | |
| MEMMANINFO mmi; | |
| mmi.dwSize = sizeof(mmi); | |
| MemManInfo(&mmi); | |
| ptr = (BYTE *)PTR_SEG_OFF_TO_LIN(ES_reg(context),DI_reg(context)); | |
| /* the layout is just the same as MEMMANINFO, but without | |
| * the dwSize entry. | |
| */ | |
| memcpy(ptr,((char*)&mmi)+4,sizeof(mmi)-4); | |
| break; | |
| } | |
| case 0x0501: /* Allocate memory block */ | |
| TRACE(int31,"allocate memory block (%ld)\n",MAKELONG(CX_reg(context),BX_reg(context))); | |
| if (!(ptr = (BYTE *)DPMI_xalloc(MAKELONG(CX_reg(context), BX_reg(context))))) | |
| { | |
| AX_reg(context) = 0x8012; /* linear memory not available */ | |
| SET_CFLAG(context); | |
| } else { | |
| BX_reg(context) = SI_reg(context) = HIWORD(W32S_WINE2APP(ptr, offset)); | |
| CX_reg(context) = DI_reg(context) = LOWORD(W32S_WINE2APP(ptr, offset)); | |
| } | |
| break; | |
| case 0x0502: /* Free memory block */ | |
| TRACE(int31, "free memory block (0x%08lx)\n", | |
| W32S_APP2WINE(MAKELONG(DI_reg(context),SI_reg(context)), offset)); | |
| DPMI_xfree( (void *)W32S_APP2WINE(MAKELONG(DI_reg(context), | |
| SI_reg(context)), offset) ); | |
| break; | |
| case 0x0503: /* Resize memory block */ | |
| TRACE(int31, "resize memory block (0x%08lx,%ld)\n", | |
| W32S_APP2WINE(MAKELONG(DI_reg(context),SI_reg(context)), offset), | |
| MAKELONG(CX_reg(context),BX_reg(context))); | |
| if (!(ptr = (BYTE *)DPMI_xrealloc( | |
| (void *)W32S_APP2WINE(MAKELONG(DI_reg(context),SI_reg(context)), offset), | |
| MAKELONG(CX_reg(context),BX_reg(context))))) | |
| { | |
| AX_reg(context) = 0x8012; /* linear memory not available */ | |
| SET_CFLAG(context); | |
| } else { | |
| BX_reg(context) = SI_reg(context) = HIWORD(W32S_WINE2APP(ptr, offset)); | |
| CX_reg(context) = DI_reg(context) = LOWORD(W32S_WINE2APP(ptr, offset)); | |
| } | |
| break; | |
| case 0x0507: /* Modify page attributes */ | |
| FIXME(int31,"modify page attributes unimplemented\n"); | |
| break; /* Just ignore it */ | |
| case 0x0600: /* Lock linear region */ | |
| FIXME(int31,"lock linear region unimplemented\n"); | |
| break; /* Just ignore it */ | |
| case 0x0601: /* Unlock linear region */ | |
| FIXME(int31,"unlock linear region unimplemented\n"); | |
| break; /* Just ignore it */ | |
| case 0x0602: /* Unlock real-mode region */ | |
| FIXME(int31,"unlock realmode region unimplemented\n"); | |
| break; /* Just ignore it */ | |
| case 0x0603: /* Lock real-mode region */ | |
| FIXME(int31,"lock realmode region unimplemented\n"); | |
| break; /* Just ignore it */ | |
| case 0x0604: /* Get page size */ | |
| TRACE(int31,"get pagesize\n"); | |
| BX_reg(context) = 0; | |
| CX_reg(context) = VIRTUAL_GetPageSize(); | |
| break; | |
| case 0x0702: /* Mark page as demand-paging candidate */ | |
| FIXME(int31,"mark page as demand-paging candidate\n"); | |
| break; /* Just ignore it */ | |
| case 0x0703: /* Discard page contents */ | |
| FIXME(int31,"discard page contents\n"); | |
| break; /* Just ignore it */ | |
| case 0x0800: /* Physical address mapping */ | |
| FIXME(int31,"map real to linear (0x%08lx)\n",MAKELONG(CX_reg(context),BX_reg(context))); | |
| if(!(ptr=DOSMEM_MapRealToLinear(MAKELONG(CX_reg(context),BX_reg(context))))) | |
| { | |
| AX_reg(context) = 0x8021; | |
| SET_CFLAG(context); | |
| } | |
| else | |
| { | |
| BX_reg(context) = HIWORD(W32S_WINE2APP(ptr, offset)); | |
| CX_reg(context) = LOWORD(W32S_WINE2APP(ptr, offset)); | |
| RESET_CFLAG(context); | |
| } | |
| break; | |
| default: | |
| INT_BARF( context, 0x31 ); | |
| AX_reg(context) = 0x8001; /* unsupported function */ | |
| SET_CFLAG(context); | |
| break; | |
| } | |
| } |