kernel32: Add stub for GetConsoleKeyboardLayoutNameW.
[wine] / dlls / winedos / int31.c
1 /*
2  * DPMI 0.9 emulation
3  *
4  * Copyright 1995 Alexandre Julliard
5  *
6  * This library is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * License as published by the Free Software Foundation; either
9  * version 2.1 of the License, or (at your option) any later version.
10  *
11  * This library is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License along with this library; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
19  */
20
21 #include "config.h"
22 #include "wine/port.h"
23
24 #include <stdarg.h>
25
26 #include "windef.h"
27 #include "winbase.h"
28 #include "wine/winbase16.h"
29 #include "wownt32.h"
30 #include "dosexe.h"
31
32 #include "excpt.h"
33 #include "wine/debug.h"
34 #include "wine/exception.h"
35 #include "thread.h"
36
37 WINE_DEFAULT_DEBUG_CHANNEL(int31);
38
39 /* Structure for real-mode callbacks */
40 typedef struct
41 {
42     DWORD edi;
43     DWORD esi;
44     DWORD ebp;
45     DWORD reserved;
46     DWORD ebx;
47     DWORD edx;
48     DWORD ecx;
49     DWORD eax;
50     WORD  fl;
51     WORD  es;
52     WORD  ds;
53     WORD  fs;
54     WORD  gs;
55     WORD  ip;
56     WORD  cs;
57     WORD  sp;
58     WORD  ss;
59 } REALMODECALL;
60
61 typedef struct tagRMCB {
62     DWORD address;
63     DWORD proc_ofs,proc_sel;
64     DWORD regs_ofs,regs_sel;
65     struct tagRMCB *next;
66 } RMCB;
67
68 static RMCB *FirstRMCB = NULL;
69 static WORD dpmi_flag;
70 static void* lastvalloced = NULL;
71 static BYTE DPMI_retval;
72
73 /**********************************************************************
74  *          DOSVM_IsDos32
75  * 
76  * Return TRUE if we are in 32-bit protected mode DOS process.
77  */
78 BOOL DOSVM_IsDos32(void)
79 {
80   return (dpmi_flag & 1) ? TRUE : FALSE;
81 }
82
83
84 /**********************************************************************
85  *          alloc_pm_selector
86  *
87  * Allocate a 64k sized selector corresponding to a real mode segment.
88  */
89 static WORD alloc_pm_selector( WORD seg, unsigned char flags )
90 {
91     WORD sel = wine_ldt_alloc_entries( 1 );
92
93     if (sel)
94     {
95         LDT_ENTRY entry;
96         wine_ldt_set_base( &entry, (void *)(seg << 4) );
97         wine_ldt_set_limit( &entry, 0xffff );
98         wine_ldt_set_flags( &entry, flags );
99         wine_ldt_set_entry( sel, &entry );
100     }
101     return sel;
102 }
103
104
105 /**********************************************************************
106  *          dpmi_exception_handler
107  *
108  * Handle EXCEPTION_VM86_STI exceptions generated
109  * when there are pending asynchronous events.
110  */
111 static WINE_EXCEPTION_FILTER(dpmi_exception_handler)
112 {
113 #ifdef __i386__
114     EXCEPTION_RECORD *rec = GetExceptionInformation()->ExceptionRecord;
115     CONTEXT *context = GetExceptionInformation()->ContextRecord;
116
117     if (rec->ExceptionCode == EXCEPTION_VM86_STI)
118     {
119         if (ISV86(context))
120             ERR( "Real mode STI caught by protected mode handler!\n" );
121         DOSVM_SendQueuedEvents(context);
122         return EXCEPTION_CONTINUE_EXECUTION;
123     }
124     else if (rec->ExceptionCode == EXCEPTION_VM86_INTx)
125     {
126         if (ISV86(context))
127             ERR( "Real mode INTx caught by protected mode handler!\n" );
128         DPMI_retval = (BYTE)rec->ExceptionInformation[0];
129         return EXCEPTION_EXECUTE_HANDLER;
130     }
131
132 #endif
133     return EXCEPTION_CONTINUE_SEARCH;
134 }
135
136
137 /**********************************************************************
138  *          INT_GetRealModeContext
139  */
140 static void INT_GetRealModeContext( REALMODECALL *call, CONTEXT86 *context )
141 {
142     context->Eax    = call->eax;
143     context->Ebx    = call->ebx;
144     context->Ecx    = call->ecx;
145     context->Edx    = call->edx;
146     context->Esi    = call->esi;
147     context->Edi    = call->edi;
148     context->Ebp    = call->ebp;
149     context->EFlags = call->fl | V86_FLAG;
150     context->Eip    = call->ip;
151     context->Esp    = call->sp;
152     context->SegCs  = call->cs;
153     context->SegDs  = call->ds;
154     context->SegEs  = call->es;
155     context->SegFs  = call->fs;
156     context->SegGs  = call->gs;
157     context->SegSs  = call->ss;
158 }
159
160
161 /**********************************************************************
162  *          INT_SetRealModeContext
163  */
164 static void INT_SetRealModeContext( REALMODECALL *call, CONTEXT86 *context )
165 {
166     call->eax = context->Eax;
167     call->ebx = context->Ebx;
168     call->ecx = context->Ecx;
169     call->edx = context->Edx;
170     call->esi = context->Esi;
171     call->edi = context->Edi;
172     call->ebp = context->Ebp;
173     call->fl  = LOWORD(context->EFlags);
174     call->ip  = LOWORD(context->Eip);
175     call->sp  = LOWORD(context->Esp);
176     call->cs  = context->SegCs;
177     call->ds  = context->SegDs;
178     call->es  = context->SegEs;
179     call->fs  = context->SegFs;
180     call->gs  = context->SegGs;
181     call->ss  = context->SegSs;
182 }
183
184 /**********************************************************************
185  *          DPMI_xalloc
186  * special virtualalloc, allocates lineary monoton growing memory.
187  * (the usual VirtualAlloc does not satisfy that restriction)
188  */
189 static LPVOID DPMI_xalloc( DWORD len ) 
190 {
191     LPVOID  ret;
192     LPVOID  oldlastv = lastvalloced;
193
194     if (lastvalloced) 
195     {
196         int xflag = 0;
197
198         ret = NULL;
199         while (!ret) 
200         {
201             ret = VirtualAlloc( lastvalloced, len,
202                                 MEM_COMMIT|MEM_RESERVE, PAGE_EXECUTE_READWRITE );
203             if (!ret)
204                 lastvalloced = (char *) lastvalloced + 0x10000;
205
206             /* we failed to allocate one in the first round.
207              * try non-linear
208              */
209             if (!xflag && (lastvalloced<oldlastv)) 
210             { 
211                 /* wrapped */
212                 FIXME( "failed to allocate linearly growing memory (%d bytes), "
213                        "using non-linear growing...\n", len );
214                 xflag++;
215             }
216
217             /* if we even fail to allocate something in the next
218              * round, return NULL
219              */
220             if ((xflag==1) && (lastvalloced >= oldlastv))
221                 xflag++;
222
223             if ((xflag==2) && (lastvalloced < oldlastv)) {
224                 FIXME( "failed to allocate any memory of %d bytes!\n", len );
225                 return NULL;
226             }
227         }
228     } 
229     else
230     {
231         ret = VirtualAlloc( NULL, len, 
232                             MEM_COMMIT|MEM_RESERVE, PAGE_EXECUTE_READWRITE );
233     }
234
235     lastvalloced = (LPVOID)(((DWORD)ret+len+0xffff)&~0xffff);
236     return ret;
237 }
238
239 /**********************************************************************
240  *          DPMI_xfree
241  */
242 static void DPMI_xfree( LPVOID ptr ) 
243 {
244     VirtualFree( ptr, 0, MEM_RELEASE );
245 }
246
247 /**********************************************************************
248  *          DPMI_xrealloc
249  *
250  * FIXME: perhaps we could grow this mapped area... 
251  */
252 static LPVOID DPMI_xrealloc( LPVOID ptr, DWORD newsize ) 
253 {
254     MEMORY_BASIC_INFORMATION        mbi;
255     LPVOID                          newptr;
256
257     newptr = DPMI_xalloc( newsize );
258     if (ptr) 
259     {
260         if (!VirtualQuery(ptr,&mbi,sizeof(mbi))) 
261         {
262             FIXME( "realloc of DPMI_xallocd region %p?\n", ptr );
263             return NULL;
264         }
265
266         if (mbi.State == MEM_FREE) 
267         {
268             FIXME( "realloc of DPMI_xallocd region %p?\n", ptr );
269             return NULL;
270         }
271
272         /* We do not shrink allocated memory. most reallocs
273          * only do grows anyway
274          */
275         if (newsize <= mbi.RegionSize)
276             return ptr;
277
278         memcpy( newptr, ptr, mbi.RegionSize );
279         DPMI_xfree( ptr );
280     }
281
282     return newptr;
283 }
284
285
286 #ifdef __i386__
287
288 void DPMI_CallRMCB32(RMCB *rmcb, UINT16 ss, DWORD esp, UINT16*es, DWORD*edi)
289 #if 0 /* original code, which early gccs puke on */
290 {
291     int _clobber;
292     __asm__ __volatile__(
293         "pushl %%ebp\n"
294         "pushl %%ebx\n"
295         "pushl %%es\n"
296         "pushl %%ds\n"
297         "pushfl\n"
298         "mov %7,%%es\n"
299         "mov %5,%%ds\n"
300         ".byte 0x36, 0xff, 0x18\n" /* lcall *%ss:(%eax) */
301         "popl %%ds\n"
302         "mov %%es,%0\n"
303         "popl %%es\n"
304         "popl %%ebx\n"
305         "popl %%ebp\n"
306     : "=d" (*es), "=D" (*edi), "=S" (_clobber), "=a" (_clobber), "=c" (_clobber)
307     : "0" (ss), "2" (esp),
308       "4" (rmcb->regs_sel), "1" (rmcb->regs_ofs),
309       "3" (&rmcb->proc_ofs) );
310 }
311 #else /* code generated by a gcc new enough */
312 ;
313 __ASM_GLOBAL_FUNC(DPMI_CallRMCB32,
314     "pushl %ebp\n\t"
315     "movl %esp,%ebp\n\t"
316     "pushl %edi\n\t"
317     "pushl %esi\n\t"
318     "movl 0x8(%ebp),%eax\n\t"
319     "movl 0x10(%ebp),%esi\n\t"
320     "movl 0xc(%ebp),%edx\n\t"
321     "movl 0x10(%eax),%ecx\n\t"
322     "movl 0xc(%eax),%edi\n\t"
323     "addl $0x4,%eax\n\t"
324     "pushl %ebp\n\t"
325     "pushl %ebx\n\t"
326     "pushl %es\n\t"
327     "pushl %ds\n\t"
328     "pushfl\n\t"
329     "mov %cx,%es\n\t"
330     "mov %dx,%ds\n\t"
331     ".byte 0x36, 0xff, 0x18\n\t" /* lcall *%ss:(%eax) */
332     "popl %ds\n\t"
333     "mov %es,%dx\n\t"
334     "popl %es\n\t"
335     "popl %ebx\n\t"
336     "popl %ebp\n\t"
337     "movl 0x14(%ebp),%eax\n\t"
338     "movw %dx,(%eax)\n\t"
339     "movl 0x18(%ebp),%edx\n\t"
340     "movl %edi,(%edx)\n\t"
341     "popl %esi\n\t"
342     "popl %edi\n\t"
343     "leave\n\t"
344     "ret")
345 #endif
346
347 #endif /* __i386__ */
348
349 /**********************************************************************
350  *          DPMI_CallRMCBProc
351  *
352  * This routine does the hard work of calling a callback procedure.
353  */
354 static void DPMI_CallRMCBProc( CONTEXT86 *context, RMCB *rmcb, WORD flag )
355 {
356     DWORD old_vif = NtCurrentTeb()->dpmi_vif;
357
358     /* Disable virtual interrupts. */
359     NtCurrentTeb()->dpmi_vif = 0;
360
361     if (wine_ldt_is_system( rmcb->proc_sel )) {
362         /* Wine-internal RMCB, call directly */
363         ((RMCBPROC)rmcb->proc_ofs)(context);
364     } else __TRY {
365 #ifdef __i386__
366         UINT16 ss,es;
367         DWORD esp,edi;
368
369         INT_SetRealModeContext(MapSL(MAKESEGPTR( rmcb->regs_sel, rmcb->regs_ofs )), context);
370         ss = alloc_pm_selector( context->SegSs, WINE_LDT_FLAGS_DATA );
371         esp = context->Esp;
372
373         FIXME("untested!\n");
374
375         /* The called proc ends with an IRET, and takes these parameters:
376          * DS:ESI = pointer to real-mode SS:SP
377          * ES:EDI = pointer to real-mode call structure
378          * It returns:
379          * ES:EDI = pointer to real-mode call structure (may be a copy)
380          * It is the proc's responsibility to change the return CS:IP in the
381          * real-mode call structure. */
382         if (flag & 1) {
383             /* 32-bit DPMI client */
384             DPMI_CallRMCB32(rmcb, ss, esp, &es, &edi);
385         } else {
386             /* 16-bit DPMI client */
387             CONTEXT86 ctx = *context;
388             ctx.SegCs = rmcb->proc_sel;
389             ctx.Eip   = rmcb->proc_ofs;
390             ctx.SegDs = ss;
391             ctx.Esi   = esp;
392             ctx.SegEs = rmcb->regs_sel;
393             ctx.Edi   = rmcb->regs_ofs;
394             /* FIXME: I'm pretty sure this isn't right - should push flags first */
395             WOWCallback16Ex( 0, WCB16_REGS, 0, NULL, (DWORD *)&ctx );
396             es = ctx.SegEs;
397             edi = ctx.Edi;
398         }
399         wine_ldt_free_entries( ss, 1 );
400         INT_GetRealModeContext( MapSL( MAKESEGPTR( es, edi )), context);
401 #else
402         ERR("RMCBs only implemented for i386\n");
403 #endif
404     } __EXCEPT(dpmi_exception_handler) { } __ENDTRY
405         
406     /* Restore virtual interrupt flag. */
407     NtCurrentTeb()->dpmi_vif = old_vif;                                 
408 }
409
410
411 /**********************************************************************
412  *          DPMI_CallRMProc
413  *
414  * This routine does the hard work of calling a real mode procedure.
415  */
416 int DPMI_CallRMProc( CONTEXT86 *context, LPWORD stack, int args, int iret )
417 {
418     LPWORD stack16;
419     LPVOID addr = NULL; /* avoid gcc warning */
420     RMCB *CurrRMCB;
421     int alloc = 0, already = 0;
422     BYTE *code;
423
424     TRACE("EAX=%08x EBX=%08x ECX=%08x EDX=%08x\n",
425                  context->Eax, context->Ebx, context->Ecx, context->Edx );
426     TRACE("ESI=%08x EDI=%08x ES=%04x DS=%04x CS:IP=%04x:%04x, %d WORD arguments, %s\n",
427                  context->Esi, context->Edi, context->SegEs, context->SegDs,
428                  context->SegCs, LOWORD(context->Eip), args, iret?"IRET":"FAR" );
429
430 callrmproc_again:
431
432 /* there might be some code that just jumps to RMCBs or the like,
433    in which case following the jumps here might get us to a shortcut */
434     code = CTX_SEG_OFF_TO_LIN(context, context->SegCs, context->Eip);
435     switch (*code) {
436     case 0xe9: /* JMP NEAR */
437       context->Eip += 3 + *(WORD *)(code+1);
438       /* yeah, I know these gotos don't look good... */
439       goto callrmproc_again;
440     case 0xea: /* JMP FAR */
441       context->Eip = *(WORD *)(code+1);
442       context->SegCs = *(WORD *)(code+3);
443       /* ...but since the label is there anyway... */
444       goto callrmproc_again;
445     case 0xeb: /* JMP SHORT */
446       context->Eip += 2 + *(signed char *)(code+1);
447       /* ...because of other gotos below, so... */
448       goto callrmproc_again;
449     }
450
451 /* shortcut for chaining to internal interrupt handlers */
452     if ((context->SegCs == 0xF000) && iret)
453     {
454         DOSVM_CallBuiltinHandler( context, LOWORD(context->Eip)/4 );
455         return 0;
456     }
457
458 /* shortcut for RMCBs */
459     CurrRMCB = FirstRMCB;
460
461     while (CurrRMCB && (HIWORD(CurrRMCB->address) != context->SegCs))
462         CurrRMCB = CurrRMCB->next;
463
464     if (!CurrRMCB && !MZ_Current())
465     {
466         FIXME("DPMI real-mode call using DOS VM task system, not fully tested!\n");
467         TRACE("creating VM86 task\n");
468         MZ_AllocDPMITask();
469     }
470     if (!already) {
471         if (!context->SegSs) {
472             alloc = 1; /* allocate default stack */
473             stack16 = addr = DOSMEM_AllocBlock( 64, (UINT16 *)&(context->SegSs) );
474             context->Esp = 64-2;
475             stack16 += 32-1;
476             if (!addr) {
477                 ERR("could not allocate default stack\n");
478                 return 1;
479             }
480         } else {
481             stack16 = CTX_SEG_OFF_TO_LIN(context, context->SegSs, context->Esp);
482         }
483         context->Esp -= (args + (iret?1:0)) * sizeof(WORD);
484         stack16 -= args;
485         if (args) memcpy(stack16, stack, args*sizeof(WORD) );
486         /* push flags if iret */
487         if (iret) {
488             stack16--; args++;
489             *stack16 = LOWORD(context->EFlags);
490         }
491         /* push return address (return to interrupt wrapper) */
492         *(--stack16) = DOSVM_dpmi_segments->wrap_seg;
493         *(--stack16) = 0;
494         /* adjust stack */
495         context->Esp -= 2*sizeof(WORD);
496         already = 1;
497     }
498
499     if (CurrRMCB) {
500         /* RMCB call, invoke protected-mode handler directly */
501         DPMI_CallRMCBProc(context, CurrRMCB, dpmi_flag);
502         /* check if we returned to where we thought we would */
503         if ((context->SegCs != DOSVM_dpmi_segments->wrap_seg) ||
504             (LOWORD(context->Eip) != 0)) {
505             /* we need to continue at different address in real-mode space,
506                so we need to set it all up for real mode again */
507             goto callrmproc_again;
508         }
509     } else {
510         TRACE("entering real mode...\n");
511         DOSVM_Enter( context );
512         TRACE("returned from real-mode call\n");
513     }
514     if (alloc) DOSMEM_FreeBlock( addr );
515     return 0;
516 }
517
518
519 /**********************************************************************
520  *          CallRMInt
521  */
522 static void DOSVM_CallRMInt( CONTEXT86 *context )
523 {
524     CONTEXT86 realmode_ctx;
525     FARPROC16 rm_int = DOSVM_GetRMHandler( BL_reg(context) );
526     REALMODECALL *call = CTX_SEG_OFF_TO_LIN( context, 
527                                              context->SegEs, 
528                                              context->Edi );
529     INT_GetRealModeContext( call, &realmode_ctx );
530
531     /* we need to check if a real-mode program has hooked the interrupt */
532     if (HIWORD(rm_int)!=0xF000) {
533         /* yup, which means we need to switch to real mode... */
534         realmode_ctx.SegCs = HIWORD(rm_int);
535         realmode_ctx.Eip   = LOWORD(rm_int);
536         if (DPMI_CallRMProc( &realmode_ctx, NULL, 0, TRUE))
537           SET_CFLAG(context);
538     } else {
539         RESET_CFLAG(context);
540         /* use the IP we have instead of BL_reg, in case some apps
541            decide to move interrupts around for whatever reason... */
542         DOSVM_CallBuiltinHandler( &realmode_ctx, LOWORD(rm_int)/4 );
543     }
544     INT_SetRealModeContext( call, &realmode_ctx );
545 }
546
547
548 /**********************************************************************
549  *          CallRMProc
550  */
551 static void DOSVM_CallRMProc( CONTEXT86 *context, int iret )
552 {
553     REALMODECALL *p = CTX_SEG_OFF_TO_LIN( context, 
554                                           context->SegEs, 
555                                           context->Edi );
556     CONTEXT86 context16;
557
558     TRACE("RealModeCall: EAX=%08x EBX=%08x ECX=%08x EDX=%08x\n",
559           p->eax, p->ebx, p->ecx, p->edx);
560     TRACE("              ESI=%08x EDI=%08x ES=%04x DS=%04x CS:IP=%04x:%04x, %d WORD arguments, %s\n",
561           p->esi, p->edi, p->es, p->ds, p->cs, p->ip, CX_reg(context), iret?"IRET":"FAR" );
562
563     if (!(p->cs) && !(p->ip)) { /* remove this check
564                                    if Int21/6501 case map function
565                                    has been implemented */
566         SET_CFLAG(context);
567         return;
568      }
569     INT_GetRealModeContext(p, &context16);
570     DPMI_CallRMProc( &context16, ((LPWORD)MapSL(MAKESEGPTR(context->SegSs, LOWORD(context->Esp))))+3,
571                      CX_reg(context), iret );
572     INT_SetRealModeContext(p, &context16);
573 }
574
575
576 /* (see dosmem.c, function DOSMEM_InitDPMI) */
577 static void StartPM( CONTEXT86 *context )
578 {
579     UINT16 cs, ss, ds, es;
580     CONTEXT86 pm_ctx;
581     DWORD psp_ofs = (DWORD)(DOSVM_psp<<4);
582     PDB16 *psp = (PDB16 *)psp_ofs;
583     HANDLE16 env_seg = psp->environment;
584     unsigned char selflags = WINE_LDT_FLAGS_DATA;
585
586     RESET_CFLAG(context);
587     dpmi_flag = AX_reg(context);
588 /* our mode switch wrapper have placed the desired CS into DX */
589     cs = alloc_pm_selector( context->Edx, WINE_LDT_FLAGS_CODE );
590 /* due to a flaw in some CPUs (at least mine), it is best to mark stack segments as 32-bit if they
591    can be used in 32-bit code. Otherwise, these CPUs may not set the high word of esp during a
592    ring transition (from kernel code) to the 16-bit stack, and this causes trouble if executing
593    32-bit code using this stack. */
594     if (dpmi_flag & 1) selflags |= WINE_LDT_FLAGS_32BIT;
595     ss = alloc_pm_selector( context->SegSs, selflags );
596 /* do the same for the data segments, just in case */
597     if (context->SegDs == context->SegSs) ds = ss;
598     else ds = alloc_pm_selector( context->SegDs, selflags );
599     es = alloc_pm_selector( DOSVM_psp, selflags );
600 /* convert environment pointer, as the spec says, but we're a bit lazy about the size here... */
601     psp->environment = alloc_pm_selector( env_seg, WINE_LDT_FLAGS_DATA );
602
603     pm_ctx = *context;
604     pm_ctx.SegCs = DOSVM_dpmi_segments->dpmi_sel;
605 /* our mode switch wrapper expects the new CS in DX, and the new SS in AX */
606     pm_ctx.Eax   = ss;
607     pm_ctx.Edx   = cs;
608     pm_ctx.SegDs = ds;
609     pm_ctx.SegEs = es;
610     pm_ctx.SegFs = wine_get_fs();
611     pm_ctx.SegGs = wine_get_gs();
612     pm_ctx.EFlags &= ~V86_FLAG;
613
614     TRACE("DOS program is now entering %d-bit protected mode\n", 
615           DOSVM_IsDos32() ? 32 : 16);
616
617     __TRY 
618     {
619         WOWCallback16Ex( 0, WCB16_REGS, 0, NULL, (DWORD *)&pm_ctx );
620     } 
621     __EXCEPT(dpmi_exception_handler) 
622     { 
623     } 
624     __ENDTRY
625
626     TRACE( "Protected mode DOS program is terminating\n" );
627
628     /*
629      * FIXME: Instead of calling ExitThread, we should release all
630      *        allocated protected mode resources and call MZ_Exit
631      *        using real mode context. See DPMI specification.
632      */
633     ExitThread( DPMI_retval );
634
635 #if 0
636     wine_ldt_free_entries( psp->environment, 1 );
637     psp->environment = env_seg;
638     wine_ldt_free_entries(es,1);
639     if (ds != ss) wine_ldt_free_entries(ds,1);
640     wine_ldt_free_entries(ss,1);
641     wine_ldt_free_entries(cs,1);
642 #endif
643 }
644
645 static RMCB *DPMI_AllocRMCB( void )
646 {
647     RMCB *NewRMCB = HeapAlloc(GetProcessHeap(), 0, sizeof(RMCB));
648     UINT16 uParagraph;
649
650     if (NewRMCB)
651     {
652         LPVOID RMCBmem = DOSMEM_AllocBlock(4, &uParagraph);
653         LPBYTE p = RMCBmem;
654
655         *p++ = 0xcd; /* RMCB: */
656         *p++ = 0x31; /* int $0x31 */
657 /* it is the called procedure's task to change the return CS:EIP
658    the DPMI 0.9 spec states that if it doesn't, it will be called again */
659         *p++ = 0xeb;
660         *p++ = 0xfc; /* jmp RMCB */
661         NewRMCB->address = MAKELONG(0, uParagraph);
662         NewRMCB->next = FirstRMCB;
663         FirstRMCB = NewRMCB;
664     }
665     return NewRMCB;
666 }
667
668
669 FARPROC16 WINAPI DPMI_AllocInternalRMCB( RMCBPROC proc )
670 {
671     RMCB *NewRMCB = DPMI_AllocRMCB();
672
673     if (NewRMCB) {
674         NewRMCB->proc_ofs = (DWORD)proc;
675         NewRMCB->proc_sel = 0;
676         NewRMCB->regs_ofs = 0;
677         NewRMCB->regs_sel = 0;
678         return (FARPROC16)(NewRMCB->address);
679     }
680     return NULL;
681 }
682
683
684 static int DPMI_FreeRMCB( DWORD address )
685 {
686     RMCB *CurrRMCB = FirstRMCB;
687     RMCB *PrevRMCB = NULL;
688
689     while (CurrRMCB && (CurrRMCB->address != address))
690     {
691         PrevRMCB = CurrRMCB;
692         CurrRMCB = CurrRMCB->next;
693     }
694     if (CurrRMCB)
695     {
696         if (PrevRMCB)
697         PrevRMCB->next = CurrRMCB->next;
698             else
699         FirstRMCB = CurrRMCB->next;
700         DOSMEM_FreeBlock(PTR_REAL_TO_LIN(SELECTOROF(CurrRMCB->address),OFFSETOF(CurrRMCB->address)));
701         HeapFree(GetProcessHeap(), 0, CurrRMCB);
702         return 0;
703     }
704     return 1;
705 }
706
707
708 void WINAPI DPMI_FreeInternalRMCB( FARPROC16 proc )
709 {
710     DPMI_FreeRMCB( (DWORD)proc );
711 }
712
713
714 /**********************************************************************
715  *          DOSVM_RawModeSwitchHandler
716  *
717  * DPMI Raw Mode Switch handler
718  */
719 void WINAPI DOSVM_RawModeSwitchHandler( CONTEXT86 *context )
720 {
721   CONTEXT86 rm_ctx;
722   int ret;
723
724   /* initialize real-mode context as per spec */
725   memset(&rm_ctx, 0, sizeof(rm_ctx));
726   rm_ctx.SegDs  = AX_reg(context);
727   rm_ctx.SegEs  = CX_reg(context);
728   rm_ctx.SegSs  = DX_reg(context);
729   rm_ctx.Esp    = context->Ebx;
730   rm_ctx.SegCs  = SI_reg(context);
731   rm_ctx.Eip    = context->Edi;
732   rm_ctx.Ebp    = context->Ebp;
733   rm_ctx.SegFs  = 0;
734   rm_ctx.SegGs  = 0;
735
736   /* Copy interrupt state. */
737   if (NtCurrentTeb()->dpmi_vif)
738       rm_ctx.EFlags = V86_FLAG | VIF_MASK;
739   else
740       rm_ctx.EFlags = V86_FLAG;
741
742   /* enter real mode again */
743   TRACE("re-entering real mode at %04x:%04x\n",rm_ctx.SegCs,rm_ctx.Eip);
744   ret = DOSVM_Enter( &rm_ctx );
745   /* when the real-mode stuff call its mode switch address,
746      DOSVM_Enter will return and we will continue here */
747
748   if (ret<0) {
749     ERR("Sync lost!\n");
750     /* if the sync was lost, there's no way to recover */
751     ExitProcess(1);
752   }
753
754   /* alter protected-mode context as per spec */
755   context->SegDs   = LOWORD(rm_ctx.Eax);
756   context->SegEs   = LOWORD(rm_ctx.Ecx);
757   context->SegSs   = LOWORD(rm_ctx.Edx);
758   context->Esp     = rm_ctx.Ebx;
759   context->SegCs   = LOWORD(rm_ctx.Esi);
760   context->Eip     = rm_ctx.Edi;
761   context->Ebp     = rm_ctx.Ebp;
762   context->SegFs   = 0;
763   context->SegGs   = 0;
764
765   /* Copy interrupt state. */
766   if (rm_ctx.EFlags & VIF_MASK)
767       NtCurrentTeb()->dpmi_vif = 1;
768   else
769       NtCurrentTeb()->dpmi_vif = 0;
770
771   /* Return to new address and hope that we didn't mess up */
772   TRACE("re-entering protected mode at %04x:%08x\n",
773       context->SegCs, context->Eip);
774 }
775
776
777 /**********************************************************************
778  *          AllocRMCB
779  */
780 static void DOSVM_AllocRMCB( CONTEXT86 *context )
781 {
782     RMCB *NewRMCB = DPMI_AllocRMCB();
783
784     TRACE("Function to call: %04x:%04x\n", (WORD)context->SegDs, SI_reg(context) );
785
786     if (NewRMCB)
787     {
788        NewRMCB->proc_ofs = DOSVM_IsDos32() ? context->Esi : LOWORD(context->Esi);
789         NewRMCB->proc_sel = context->SegDs;
790        NewRMCB->regs_ofs = DOSVM_IsDos32() ? context->Edi : LOWORD(context->Edi);
791         NewRMCB->regs_sel = context->SegEs;
792         SET_CX( context, HIWORD(NewRMCB->address) );
793         SET_DX( context, LOWORD(NewRMCB->address) );
794     }
795     else
796     {
797         SET_AX( context, 0x8015 ); /* callback unavailable */
798         SET_CFLAG(context);
799     }
800 }
801
802
803 /**********************************************************************
804  *          FreeRMCB
805  */
806 static void DOSVM_FreeRMCB( CONTEXT86 *context )
807 {
808     FIXME("callback address: %04x:%04x\n",
809           CX_reg(context), DX_reg(context));
810
811     if (DPMI_FreeRMCB(MAKELONG(DX_reg(context), CX_reg(context)))) {
812         SET_AX( context, 0x8024 ); /* invalid callback address */
813         SET_CFLAG(context);
814     }
815 }
816
817
818 /**********************************************************************
819  *         DOSVM_CheckWrappers
820  *
821  * Check if this was really a wrapper call instead of an interrupt.
822  */
823 BOOL DOSVM_CheckWrappers( CONTEXT86 *context )
824 {
825     if (context->SegCs==DOSVM_dpmi_segments->dpmi_seg) {
826         /* This is the protected mode switch */
827         StartPM(context);
828         return TRUE;
829     }
830     else if (context->SegCs==DOSVM_dpmi_segments->xms_seg)
831     {
832         /* This is the XMS driver entry point */
833         XMS_Handler(context);
834         return TRUE;
835     }
836     else
837     {
838         /* Check for RMCB */
839         RMCB *CurrRMCB = FirstRMCB;
840
841         while (CurrRMCB && (HIWORD(CurrRMCB->address) != context->SegCs))
842             CurrRMCB = CurrRMCB->next;
843
844         if (CurrRMCB) {
845             /* RMCB call, propagate to protected-mode handler */
846             DPMI_CallRMCBProc(context, CurrRMCB, dpmi_flag);
847             return TRUE;
848         }
849     }
850
851     return FALSE;
852 }
853
854 /**********************************************************************
855  *         DOSVM_Int31Handler (WINEDOS16.149)
856  *
857  * Handler for int 31h (DPMI).
858  */
859 void WINAPI DOSVM_Int31Handler( CONTEXT86 *context )
860 {
861     RESET_CFLAG(context);
862     switch(AX_reg(context))
863     {
864     case 0x0000:  /* Allocate LDT descriptors */
865         TRACE( "allocate LDT descriptors (%d)\n", CX_reg(context) );
866         {
867             WORD sel =  AllocSelectorArray16( CX_reg(context) );
868             if(!sel) 
869             {
870                TRACE( "failed\n" );
871                SET_AX( context, 0x8011 ); /* descriptor unavailable */
872                SET_CFLAG( context );
873             } 
874             else 
875             { 
876                 TRACE( "success, array starts at 0x%04x\n", sel );
877                 SET_AX( context, sel );      
878             }
879         }
880         break;
881
882     case 0x0001:  /* Free LDT descriptor */
883         TRACE( "free LDT descriptor (0x%04x)\n", BX_reg(context) );
884         if (FreeSelector16( BX_reg(context) ))
885         {
886             SET_AX( context, 0x8022 );  /* invalid selector */
887             SET_CFLAG( context );
888         }
889         else
890         {
891             /* If a segment register contains the selector being freed, */
892             /* set it to zero. */
893             if (!((context->SegDs^BX_reg(context)) & ~3)) context->SegDs = 0;
894             if (!((context->SegEs^BX_reg(context)) & ~3)) context->SegEs = 0;
895             if (!((context->SegFs^BX_reg(context)) & ~3)) context->SegFs = 0;
896             if (!((context->SegGs^BX_reg(context)) & ~3)) context->SegGs = 0;
897         }
898         break;
899
900     case 0x0002:  /* Real mode segment to descriptor */
901         TRACE( "real mode segment to descriptor (0x%04x)\n", BX_reg(context) );
902         {
903             WORD entryPoint = 0;  /* KERNEL entry point for descriptor */
904             switch(BX_reg(context))
905             {
906             case 0x0000: entryPoint = 183; break;  /* __0000H */
907             case 0x0040: entryPoint = 193; break;  /* __0040H */
908             case 0xa000: entryPoint = 174; break;  /* __A000H */
909             case 0xb000: entryPoint = 181; break;  /* __B000H */
910             case 0xb800: entryPoint = 182; break;  /* __B800H */
911             case 0xc000: entryPoint = 195; break;  /* __C000H */
912             case 0xd000: entryPoint = 179; break;  /* __D000H */
913             case 0xe000: entryPoint = 190; break;  /* __E000H */
914             case 0xf000: entryPoint = 194; break;  /* __F000H */
915             default:
916                 FIXME("Real mode segment (%x) to descriptor: no longer supported\n",
917                       BX_reg(context));
918                 SET_CFLAG( context );
919                 break;
920             }
921             if (entryPoint)
922             {
923                 FARPROC16 proc = GetProcAddress16( GetModuleHandle16( "KERNEL" ),
924                                                    (LPCSTR)(ULONG_PTR)entryPoint );
925                 SET_AX( context, LOWORD(proc) );
926             }
927         }
928         break;
929
930     case 0x0003:  /* Get next selector increment */
931         TRACE("get selector increment (__AHINCR)\n");
932         context->Eax = __AHINCR;
933         break;
934
935     case 0x0004:  /* Lock selector (not supported) */
936         FIXME("lock selector not supported\n");
937         context->Eax = 0;  /* FIXME: is this a correct return value? */
938         break;
939
940     case 0x0005:  /* Unlock selector (not supported) */
941         FIXME("unlock selector not supported\n");
942         context->Eax = 0;  /* FIXME: is this a correct return value? */
943         break;
944
945     case 0x0006:  /* Get selector base address */
946         TRACE( "get selector base address (0x%04x)\n", BX_reg(context) );
947         {
948             LDT_ENTRY entry;
949             WORD sel = BX_reg(context);
950             wine_ldt_get_entry( sel, &entry );
951             if (wine_ldt_is_empty(&entry))
952             {
953                 context->Eax = 0x8022;  /* invalid selector */
954                 SET_CFLAG(context);
955             }
956             else
957             {
958                 void *base = wine_ldt_get_base(&entry);
959                 SET_CX( context, HIWORD(base) );
960                 SET_DX( context, LOWORD(base) );
961             }
962         }
963         break;
964
965     case 0x0007:  /* Set selector base address */
966         {
967             DWORD base = MAKELONG( DX_reg(context), CX_reg(context) );
968             WORD  sel = BX_reg(context);
969             TRACE( "set selector base address (0x%04x,0x%08x)\n", sel, base );
970
971             /* check if Win16 app wants to access lower 64K of DOS memory */
972             if (base < 0x10000 && DOSVM_IsWin16())
973                 DOSMEM_MapDosLayout();
974
975             SetSelectorBase( sel, base );
976         }
977         break;
978
979     case 0x0008:  /* Set selector limit */
980         {
981             DWORD limit = MAKELONG( DX_reg(context), CX_reg(context) );
982             TRACE( "set selector limit (0x%04x,0x%08x)\n",
983                    BX_reg(context), limit );
984             SetSelectorLimit16( BX_reg(context), limit );
985         }
986         break;
987
988     case 0x0009:  /* Set selector access rights */
989         TRACE( "set selector access rights(0x%04x,0x%04x)\n",
990                BX_reg(context), CX_reg(context) );
991         SelectorAccessRights16( BX_reg(context), 1, CX_reg(context) );
992         break;
993
994     case 0x000a:  /* Allocate selector alias */
995         TRACE( "allocate selector alias (0x%04x)\n", BX_reg(context) );
996         SET_AX( context, AllocCStoDSAlias16( BX_reg(context) ) );
997         if (!AX_reg(context))
998         {
999             SET_AX( context, 0x8011 );  /* descriptor unavailable */
1000             SET_CFLAG(context);
1001         }
1002         break;
1003
1004     case 0x000b:  /* Get descriptor */
1005         TRACE( "get descriptor (0x%04x)\n", BX_reg(context) );
1006         {
1007             LDT_ENTRY *entry = (LDT_ENTRY*)CTX_SEG_OFF_TO_LIN( context,
1008                                                                context->SegEs, 
1009                                                                context->Edi );
1010             wine_ldt_get_entry( BX_reg(context), entry );
1011         }
1012         break;
1013
1014     case 0x000c:  /* Set descriptor */
1015         TRACE( "set descriptor (0x%04x)\n", BX_reg(context) );
1016         {
1017             LDT_ENTRY *entry = (LDT_ENTRY*)CTX_SEG_OFF_TO_LIN( context,
1018                                                                context->SegEs, 
1019                                                                context->Edi );
1020             wine_ldt_set_entry( BX_reg(context), entry );
1021         }
1022         break;
1023
1024     case 0x000d:  /* Allocate specific LDT descriptor */
1025         FIXME( "allocate descriptor (0x%04x), stub!\n", BX_reg(context) );
1026         SET_AX( context, 0x8011 ); /* descriptor unavailable */
1027         SET_CFLAG( context );
1028         break;
1029
1030     case 0x000e:  /* Get Multiple Descriptors (1.0) */
1031         FIXME( "get multiple descriptors - unimplemented\n" );
1032         break;
1033
1034     case 0x000f:  /* Set Multiple Descriptors (1.0) */
1035         FIXME( "set multiple descriptors - unimplemented\n" );
1036         break;
1037
1038     case 0x0100:  /* Allocate DOS memory block */
1039         TRACE( "allocate DOS memory block (0x%x paragraphs)\n", BX_reg(context) );
1040         {
1041             DWORD dw = GlobalDOSAlloc16( (DWORD)BX_reg(context) << 4 );
1042             if (dw) {
1043                 SET_AX( context, HIWORD(dw) );
1044                 SET_DX( context, LOWORD(dw) );
1045             } else {
1046                 SET_AX( context, 0x0008 ); /* insufficient memory */
1047                 SET_BX( context, DOSMEM_Available() >> 4 );
1048                 SET_CFLAG(context);
1049             }
1050             break;
1051         }
1052
1053     case 0x0101:  /* Free DOS memory block */
1054         TRACE( "free DOS memory block (0x%04x)\n", DX_reg(context) );
1055         {
1056             WORD error = GlobalDOSFree16( DX_reg(context) );
1057             if (error) {
1058                 SET_AX( context, 0x0009 ); /* memory block address invalid */
1059                 SET_CFLAG( context );
1060             }
1061         }
1062         break;
1063
1064     case 0x0102: /* Resize DOS Memory Block */
1065         FIXME( "resize DOS memory block (0x%04x, 0x%x paragraphs) - unimplemented\n", 
1066                DX_reg(context), BX_reg(context) );
1067         break;
1068
1069     case 0x0200: /* get real mode interrupt vector */
1070         TRACE( "get realmode interupt vector (0x%02x)\n",
1071                BL_reg(context) );
1072         {
1073             FARPROC16 proc = DOSVM_GetRMHandler( BL_reg(context) );
1074             SET_CX( context, SELECTOROF(proc) );
1075             SET_DX( context, OFFSETOF(proc) );
1076         }
1077         break;
1078
1079     case 0x0201: /* set real mode interrupt vector */
1080         TRACE( "set realmode interrupt vector (0x%02x, 0x%04x:0x%04x)\n", 
1081                BL_reg(context), CX_reg(context), DX_reg(context) );
1082         DOSVM_SetRMHandler( BL_reg(context), 
1083                             (FARPROC16)MAKESEGPTR(CX_reg(context), DX_reg(context)) );
1084         break;
1085
1086     case 0x0202:  /* Get Processor Exception Handler Vector */
1087         FIXME( "Get Processor Exception Handler Vector (0x%02x)\n",
1088                BL_reg(context) );
1089         if (DOSVM_IsDos32()) 
1090         {
1091             SET_CX( context, 0 );
1092             context->Edx = 0;
1093         } 
1094         else 
1095         {
1096             SET_CX( context, 0 );
1097             SET_DX( context, 0 );
1098         }
1099         break;
1100
1101     case 0x0203:  /* Set Processor Exception Handler Vector */
1102          FIXME( "Set Processor Exception Handler Vector (0x%02x)\n",
1103                 BL_reg(context) );
1104          break;
1105
1106     case 0x0204:  /* Get protected mode interrupt vector */
1107         TRACE("get protected mode interrupt handler (0x%02x)\n",
1108               BL_reg(context));
1109         if (DOSVM_IsDos32()) 
1110         {
1111             FARPROC48 handler = DOSVM_GetPMHandler48( BL_reg(context) );
1112             SET_CX( context, handler.selector );
1113             context->Edx = handler.offset;
1114         } 
1115         else 
1116         {
1117             FARPROC16 handler = DOSVM_GetPMHandler16( BL_reg(context) );
1118             SET_CX( context, SELECTOROF(handler) );
1119             SET_DX( context, OFFSETOF(handler) );
1120         }
1121         break;
1122
1123     case 0x0205:  /* Set protected mode interrupt vector */
1124         TRACE("set protected mode interrupt handler (0x%02x,0x%04x:0x%08x)\n",
1125               BL_reg(context), CX_reg(context), context->Edx);
1126         if (DOSVM_IsDos32()) 
1127         {
1128             FARPROC48 handler;
1129             handler.selector = CX_reg(context);
1130             handler.offset = context->Edx;
1131             DOSVM_SetPMHandler48( BL_reg(context), handler );
1132         } 
1133         else 
1134         {
1135             FARPROC16 handler;
1136             handler = (FARPROC16)MAKESEGPTR( CX_reg(context), DX_reg(context)); 
1137             DOSVM_SetPMHandler16( BL_reg(context), handler );
1138         }
1139         break;
1140
1141     case 0x0300:  /* Simulate real mode interrupt */
1142         TRACE( "Simulate real mode interrupt %02x.\n", BL_reg(context));
1143         DOSVM_CallRMInt( context );
1144         break;
1145
1146     case 0x0301:  /* Call real mode procedure with far return */
1147         TRACE( "Call real mode procedure with far return.\n" );
1148         DOSVM_CallRMProc( context, FALSE );
1149         break;
1150
1151     case 0x0302:  /* Call real mode procedure with interrupt return */
1152         TRACE( "Call real mode procedure with interrupt return.\n" );
1153         DOSVM_CallRMProc( context, TRUE );
1154         break;
1155
1156     case 0x0303:  /* Allocate Real Mode Callback Address */
1157         TRACE( "Allocate real mode callback address.\n" );
1158         DOSVM_AllocRMCB( context );
1159         break;
1160
1161     case 0x0304:  /* Free Real Mode Callback Address */
1162         TRACE( "Free real mode callback address.\n" );
1163         DOSVM_FreeRMCB( context );
1164         break;
1165
1166     case 0x0305:  /* Get State Save/Restore Addresses */
1167         TRACE("get state save/restore addresses\n");
1168         /* we probably won't need this kind of state saving */
1169         SET_AX( context, 0 );
1170
1171         /* real mode: just point to the lret */
1172         SET_BX( context, DOSVM_dpmi_segments->wrap_seg );
1173         SET_CX( context, 2 );
1174
1175         /* protected mode: don't have any handler yet... */
1176         /* FIXME: Use DI in 16-bit DPMI and EDI in 32-bit DPMI */
1177         FIXME("no protected-mode dummy state save/restore handler yet\n");
1178         SET_SI( context, 0 );
1179         context->Edi = 0;
1180         break;
1181
1182     case 0x0306:  /* Get Raw Mode Switch Addresses */
1183         TRACE("get raw mode switch addresses\n");
1184
1185         /* real mode, point to standard DPMI return wrapper */
1186         SET_BX( context, DOSVM_dpmi_segments->wrap_seg );
1187         SET_CX( context, 0 );
1188
1189         /* protected mode, point to DPMI call wrapper */
1190         /* FIXME: Use DI in 16-bit DPMI and EDI in 32-bit DPMI */
1191         /* FIXME: Doesn't work in DPMI32... */
1192         SET_SI( context, DOSVM_dpmi_segments->dpmi_sel );
1193         context->Edi = 8; /* offset of the INT 0x31 call */
1194         break;
1195
1196     case 0x0400:  /* Get DPMI version */
1197         TRACE("get DPMI version\n");
1198         {
1199             SYSTEM_INFO si;
1200
1201             GetSystemInfo(&si);
1202             SET_AX( context, 0x005a );  /* DPMI version 0.90 */
1203             SET_BX( context, 0x0005 );  /* Flags: 32-bit, virtual memory */
1204             SET_CL( context, si.wProcessorLevel );
1205             SET_DX( context, 0x0870 );  /* Master/slave interrupt controller base */
1206         }
1207         break;
1208
1209     case 0x0401:  /* Get DPMI Capabilities (1.0) */
1210         FIXME( "get dpmi capabilities - unimplemented\n");
1211         break;
1212
1213     case 0x0500:  /* Get free memory information */
1214         TRACE("get free memory information\n");
1215         {
1216             MEMORYSTATUS status;
1217
1218             /* the layout is just the same as MEMMANINFO, but without
1219              * the dwSize entry.
1220              */
1221             struct
1222             {
1223                 DWORD dwLargestFreeBlock;
1224                 DWORD dwMaxPagesAvailable;
1225                 DWORD dwMaxPagesLockable;
1226                 DWORD dwTotalLinearSpace;
1227                 DWORD dwTotalUnlockedPages;
1228                 DWORD dwFreePages;
1229                 DWORD dwTotalPages;
1230                 DWORD dwFreeLinearSpace;
1231                 DWORD dwSwapFilePages;
1232                 WORD  wPageSize;
1233             } *info = CTX_SEG_OFF_TO_LIN( context, context->SegEs, context->Edi );
1234
1235             GlobalMemoryStatus( &status );
1236             info->wPageSize            = getpagesize();
1237             info->dwLargestFreeBlock   = status.dwAvailVirtual;
1238             info->dwMaxPagesAvailable  = info->dwLargestFreeBlock / info->wPageSize;
1239             info->dwMaxPagesLockable   = info->dwMaxPagesAvailable;
1240             info->dwTotalLinearSpace   = status.dwTotalVirtual / info->wPageSize;
1241             info->dwTotalUnlockedPages = info->dwTotalLinearSpace;
1242             info->dwFreePages          = info->dwMaxPagesAvailable;
1243             info->dwTotalPages         = info->dwTotalLinearSpace;
1244             info->dwFreeLinearSpace    = info->dwMaxPagesAvailable;
1245             info->dwSwapFilePages      = status.dwTotalPageFile / info->wPageSize;
1246             break;
1247         }
1248
1249     case 0x0501:  /* Allocate memory block */
1250         {
1251             DWORD size = MAKELONG( CX_reg(context), BX_reg(context) );
1252             BYTE *ptr;
1253
1254             TRACE( "allocate memory block (%d bytes)\n", size );
1255
1256             ptr = DPMI_xalloc( size );
1257             if (!ptr)
1258             {
1259                 SET_AX( context, 0x8012 );  /* linear memory not available */
1260                 SET_CFLAG(context);
1261             } 
1262             else 
1263             {
1264                 SET_BX( context, HIWORD(ptr) );
1265                 SET_CX( context, LOWORD(ptr) );
1266                 SET_SI( context, HIWORD(ptr) );
1267                 SET_DI( context, LOWORD(ptr) );
1268             }
1269             break;
1270         }
1271
1272     case 0x0502:  /* Free memory block */
1273         {
1274             DWORD handle = MAKELONG( DI_reg(context), SI_reg(context) );
1275             TRACE( "free memory block (0x%08x)\n", handle );
1276             DPMI_xfree( (void *)handle );
1277         }
1278         break;
1279
1280     case 0x0503:  /* Resize memory block */
1281         {
1282             DWORD size = MAKELONG( CX_reg(context), BX_reg(context) );
1283             DWORD handle = MAKELONG( DI_reg(context), SI_reg(context) );
1284             BYTE *ptr;
1285
1286             TRACE( "resize memory block (0x%08x, %d bytes)\n", handle, size );
1287
1288             ptr = DPMI_xrealloc( (void *)handle, size );
1289             if (!ptr)
1290             {
1291                 SET_AX( context, 0x8012 );  /* linear memory not available */
1292                 SET_CFLAG(context);
1293             } else {
1294                 SET_BX( context, HIWORD(ptr) );
1295                 SET_CX( context, LOWORD(ptr) );
1296                 SET_SI( context, HIWORD(ptr) );
1297                 SET_DI( context, LOWORD(ptr) );
1298             }
1299         }
1300         break;
1301
1302     case 0x0507:  /* Set page attributes (1.0) */
1303         FIXME( "set page attributes - unimplemented\n" );
1304         break;  /* Just ignore it */
1305
1306     case 0x0600:  /* Lock linear region */
1307         TRACE( "lock linear region - ignored (no paging)\n" );
1308         break;
1309
1310     case 0x0601:  /* Unlock linear region */
1311         TRACE( "unlock linear region - ignored (no paging)\n" );
1312         break;
1313
1314     case 0x0602:  /* Mark real mode region as pageable */
1315         TRACE( "mark real mode region as pageable - ignored (no paging)\n" );
1316         break;
1317
1318     case 0x0603:  /* Relock real mode region */
1319         TRACE( "relock real mode region - ignored (no paging)\n" );
1320         break;
1321
1322     case 0x0604:  /* Get page size */
1323         TRACE("get pagesize\n");
1324         SET_BX( context, HIWORD(getpagesize()) );
1325         SET_CX( context, LOWORD(getpagesize()) );
1326         break;
1327
1328     case 0x0700: /* Mark pages as paging candidates */
1329         TRACE( "mark pages as paging candidates - ignored (no paging)\n" );
1330         break;
1331
1332     case 0x0701: /* Discard pages */
1333         TRACE( "discard pages - ignored (no paging)\n" );
1334         break;
1335
1336     case 0x0702:  /* Mark page as demand-paging candidate */
1337         TRACE( "mark page as demand-paging candidate - ignored (no paging)\n" );
1338         break;
1339
1340     case 0x0703:  /* Discard page contents */
1341         TRACE( "discard page contents - ignored (no paging)\n" );
1342         break;
1343
1344     case 0x0800:  /* Physical address mapping */
1345         FIXME( "physical address mapping (0x%08x) - unimplemented\n",
1346                MAKELONG(CX_reg(context),BX_reg(context)) );
1347         break;
1348
1349     case 0x0900:  /* Get and Disable Virtual Interrupt State */
1350         TRACE( "Get and Disable Virtual Interrupt State: %d\n",
1351                NtCurrentTeb()->dpmi_vif );
1352         SET_AL( context, NtCurrentTeb()->dpmi_vif ? 1 : 0 );
1353         NtCurrentTeb()->dpmi_vif = 0;
1354         break;
1355
1356     case 0x0901:  /* Get and Enable Virtual Interrupt State */
1357         TRACE( "Get and Enable Virtual Interrupt State: %d\n",
1358                NtCurrentTeb()->dpmi_vif );
1359         SET_AL( context, NtCurrentTeb()->dpmi_vif ? 1 : 0 );
1360         NtCurrentTeb()->dpmi_vif = 1;
1361         break;
1362
1363     case 0x0902:  /* Get Virtual Interrupt State */
1364         TRACE( "Get Virtual Interrupt State: %d\n",
1365                NtCurrentTeb()->dpmi_vif );
1366         SET_AL( context, NtCurrentTeb()->dpmi_vif ? 1 : 0 );
1367         break;
1368
1369     case 0x0e00:  /* Get Coprocessor Status (1.0) */
1370         /*
1371          * Return status in AX bits:
1372          * B0    - MPv (MP bit in the virtual MSW/CR0)
1373          *         0 = numeric coprocessor is disabled for this client
1374          *         1 = numeric coprocessor is enabled for this client
1375          * B1    - EMv (EM bit in the virtual MSW/CR0)
1376          *         0 = client is not emulating coprocessor instructions
1377          *         1 = client is emulating coprocessor instructions
1378          * B2    - MPr (MP bit from the actual MSW/CR0)
1379          *         0 = numeric coprocessor is not present
1380          *         1 = numeric coprocessor is present
1381          * B3    - EMr (EM bit from the actual MSW/CR0)
1382          *         0 = host is not emulating coprocessor instructions
1383          *         1 = host is emulating coprocessor instructions
1384          * B4-B7 - coprocessor type
1385          *         00H = no coprocessor
1386          *         02H = 80287
1387          *         03H = 80387
1388          *         04H = 80486 with numeric coprocessor
1389          *         05H-0FH = reserved for future numeric processors
1390          */
1391         TRACE( "Get Coprocessor Status\n" );
1392         SET_AX( context, 69 ); /* 486, coprocessor present and enabled */ 
1393         break;
1394
1395     case 0x0e01: /* Set Coprocessor Emulation (1.0) */
1396         /*
1397          * See function 0x0e00.
1398          * BX bit B0 is new value for MPv.
1399          * BX bit B1 is new value for EMv.
1400          */
1401         if (BX_reg(context) != 1)
1402             FIXME( "Set Coprocessor Emulation to %d - unimplemented\n", 
1403                    BX_reg(context) );
1404         else
1405             TRACE( "Set Coprocessor Emulation - ignored\n" );
1406         break;
1407
1408     default:
1409         INT_BARF( context, 0x31 );
1410         SET_AX( context, 0x8001 );  /* unsupported function */
1411         SET_CFLAG(context);
1412         break;
1413     }  
1414 }