4 * Copyright 1998 Ove Kåven
6 * This code hasn't been completely cleaned up yet.
19 #include <sys/types.h>
22 #include "wine/winbase16.h"
23 #include "wine/exception.h"
35 #include "../../loader/dos/dosmod.h"
36 #include "stackframe.h"
37 #include "debugtools.h"
39 DECLARE_DEBUG_CHANNEL(int);
40 DECLARE_DEBUG_CHANNEL(module);
41 DECLARE_DEBUG_CHANNEL(relay);
45 #ifdef HAVE_SYS_VM86_H
46 # include <sys/vm86.h>
48 #ifdef HAVE_SYS_MMAN_H
49 # include <sys/mman.h>
52 #define IF_CLR(ctx) ((ctx)->EFlags &= ~VIF_MASK)
53 #define IF_SET(ctx) ((ctx)->EFlags |= VIF_MASK)
54 #define IF_ENABLED(ctx) ((ctx)->EFlags & VIF_MASK)
55 #define SET_PEND(ctx) ((ctx)->EFlags |= VIP_MASK)
56 #define CLR_PEND(ctx) ((ctx)->EFlags &= ~VIP_MASK)
57 #define IS_PEND(ctx) ((ctx)->EFlags & VIP_MASK)
61 typedef struct _DOSEVENT {
65 struct _DOSEVENT *next;
66 } DOSEVENT, *LPDOSEVENT;
68 static struct _DOSEVENT *pending_event, *current_event;
69 static int sig_sent, entered;
70 static CONTEXT86 *current_context;
73 extern int read_pipe, write_pipe;
74 extern HANDLE hReadPipe;
75 extern pid_t dosmod_pid;
77 static void do_exception( int signal, CONTEXT86 *context )
80 if ((signal == SIGTRAP) || (signal == SIGHUP))
82 rec.ExceptionCode = EXCEPTION_BREAKPOINT;
83 rec.ExceptionFlags = EXCEPTION_CONTINUABLE;
87 rec.ExceptionCode = EXCEPTION_ILLEGAL_INSTRUCTION; /* generic error */
88 rec.ExceptionFlags = EH_NONCONTINUABLE;
90 rec.ExceptionRecord = NULL;
91 rec.ExceptionAddress = (LPVOID)context->Eip;
92 rec.NumberParameters = 0;
93 EXC_RtlRaiseException( &rec, context );
96 static void DOSVM_Dump( int fn, int sig, struct vm86plus_struct*VM86 )
101 switch (VM86_TYPE(fn)) {
103 printf("Trapped signal %d\n",sig); break;
105 printf("Trapped unhandled GPF\n"); break;
107 printf("Trapped INT %02x\n",VM86_ARG(fn)); break;
109 printf("Trapped STI\n"); break;
111 printf("Trapped due to pending PIC request\n"); break;
113 printf("Trapped debug request\n"); break;
115 printf("Trapped unknown VM86 type %d arg %d\n",VM86_TYPE(fn),VM86_ARG(fn)); break;
117 #define REGS VM86->regs
118 fprintf(stderr,"AX=%04lX CX=%04lX DX=%04lX BX=%04lX\n",REGS.eax,REGS.ecx,REGS.edx,REGS.ebx);
119 fprintf(stderr,"SI=%04lX DI=%04lX SP=%04lX BP=%04lX\n",REGS.esi,REGS.edi,REGS.esp,REGS.ebp);
120 fprintf(stderr,"CS=%04X DS=%04X ES=%04X SS=%04X\n",REGS.cs,REGS.ds,REGS.es,REGS.ss);
121 fprintf(stderr,"IP=%04lX EFLAGS=%08lX\n",REGS.eip,REGS.eflags);
123 inst = PTR_REAL_TO_LIN( REGS.cs, REGS.eip );
126 for (x=0; x<8; x++) printf(" %02x",inst[x]);
130 static int DOSVM_SimulateInt( int vect, CONTEXT86 *context, BOOL inwine )
132 FARPROC16 handler=INT_GetRMHandler(vect);
134 /* check for our real-mode hooks */
136 if (context->SegCs==DOSMEM_wrap_seg) {
137 /* exit from real-mode wrapper */
140 /* we could probably move some other dodgy stuff here too from dpmi.c */
142 /* check if the call is from our fake BIOS interrupt stubs */
143 if ((context->SegCs==0xf000) && !inwine) {
144 if (vect != (context->Eip/4)) {
145 TRACE_(int)("something fishy going on here (interrupt stub is %02lx)\n", context->Eip/4);
147 TRACE_(int)("builtin interrupt %02x has been branched to\n", vect);
148 INT_RealModeInterrupt(vect, context);
150 /* check if the call goes to an unhooked interrupt */
151 else if (SELECTOROF(handler)==0xf000) {
152 /* if so, call it directly */
153 TRACE_(int)("builtin interrupt %02x has been invoked (through vector %02x)\n", OFFSETOF(handler)/4, vect);
154 INT_RealModeInterrupt(OFFSETOF(handler)/4, context);
156 /* the interrupt is hooked, simulate interrupt in DOS space */
158 WORD*stack= PTR_REAL_TO_LIN( context->SegSs, context->Esp );
159 WORD flag=LOWORD(context->EFlags);
161 if (IF_ENABLED(context)) flag|=IF_MASK;
165 *(--stack)=context->SegCs;
166 *(--stack)=LOWORD(context->Eip);
168 context->SegCs=SELECTOROF(handler);
169 context->Eip=OFFSETOF(handler);
175 #define SHOULD_PEND(x) \
176 (x && ((!current_event) || (x->priority < current_event->priority)))
178 static void DOSVM_SendQueuedEvent(CONTEXT86 *context)
180 LPDOSEVENT event = pending_event;
182 if (SHOULD_PEND(event)) {
183 /* remove from "pending" list */
184 pending_event = event->next;
187 /* it's an IRQ, move it to "current" list */
188 event->next = current_event;
189 current_event = event;
190 TRACE_(int)("dispatching IRQ %d\n",event->irq);
191 /* note that if DOSVM_SimulateInt calls an internal interrupt directly,
192 * current_event might be cleared (and event freed) in this very call! */
193 DOSVM_SimulateInt((event->irq<8)?(event->irq+8):(event->irq-8+0x70),context,TRUE);
196 TRACE_(int)("dispatching callback event\n");
197 (*event->relay)(context,event->data);
201 if (!SHOULD_PEND(pending_event)) {
202 TRACE_(int)("clearing Pending flag\n");
207 static void DOSVM_SendQueuedEvents(CONTEXT86 *context)
209 /* we will send all queued events as long as interrupts are enabled,
210 * but IRQ events will disable interrupts again */
211 while (IS_PEND(context) && IF_ENABLED(context))
212 DOSVM_SendQueuedEvent(context);
215 void WINAPI DOSVM_QueueEvent( INT irq, INT priority, DOSRELAY relay, LPVOID data)
217 LPDOSEVENT event, cur, prev;
220 event = malloc(sizeof(DOSEVENT));
222 ERR_(int)("out of memory allocating event entry\n");
225 event->irq = irq; event->priority = priority;
226 event->relay = relay; event->data = data;
228 /* insert event into linked list, in order *after*
229 * all earlier events of higher or equal priority */
230 cur = pending_event; prev = NULL;
231 while (cur && cur->priority<=priority) {
236 if (prev) prev->next = event;
237 else pending_event = event;
239 /* get dosmod's attention to the new event, if necessary */
241 TRACE_(int)("new event queued, signalling dosmod\n");
242 kill(dosmod_pid,SIGUSR2);
245 TRACE_(int)("new event queued\n");
248 /* DOS subsystem not running */
249 /* (this probably means that we're running a win16 app
250 * which uses DPMI to thunk down to DOS services) */
252 /* callback event, perform it with dummy context */
254 memset(&context,0,sizeof(context));
255 (*relay)(&context,data);
257 ERR_(int)("IRQ without DOS task: should not happen");
262 #define CV do { CP(eax,Eax); CP(ecx,Ecx); CP(edx,Edx); CP(ebx,Ebx); \
263 CP(esi,Esi); CP(edi,Edi); CP(esp,Esp); CP(ebp,Ebp); \
264 CP(cs,SegCs); CP(ds,SegDs); CP(es,SegEs); \
265 CP(ss,SegSs); CP(fs,SegFs); CP(gs,SegGs); \
266 CP(eip,Eip); CP(eflags,EFlags); } while(0)
268 static int DOSVM_Process( int fn, int sig, struct vm86plus_struct*VM86 )
270 CONTEXT86 context, *old_context;
273 #define CP(x,y) context.y = VM86->regs.x
276 if (VM86_TYPE(fn)==VM86_UNKNOWN) {
277 ret=INSTR_EmulateInstruction(&context);
278 #define CP(x,y) VM86->regs.x = context.y
285 if (VM86->vm86plus.force_return_for_pic) {
289 /* linux doesn't preserve pending flag on return */
290 if (SHOULD_PEND(pending_event)) {
295 old_context = current_context;
296 current_context = &context;
298 switch (VM86_TYPE(fn)) {
300 TRACE_(int)("DOS module caught signal %d\n",sig);
301 if ((sig==SIGALRM) || (sig==SIGUSR2)) {
304 DOSVM_QueueEvent(0,DOS_PRIORITY_REALTIME,NULL,NULL);
307 TRACE_(int)("setting Pending flag, interrupts are currently %s\n",
308 IF_ENABLED(&context) ? "enabled" : "disabled");
310 DOSVM_SendQueuedEvents(&context);
312 TRACE_(int)("no events are pending, clearing Pending flag\n");
317 else if ((sig==SIGHUP) || (sig==SIGILL) || (sig==SIGSEGV)) {
318 do_exception( sig, &context );
320 DOSVM_Dump(fn,sig,VM86);
324 case VM86_UNKNOWN: /* unhandled GPF */
325 DOSVM_Dump(fn,sig,VM86);
326 do_exception( SIGSEGV, &context );
330 DPRINTF("Call DOS int 0x%02x (EAX=%08lx) ret=%04lx:%04lx\n",VM86_ARG(fn),context.Eax,context.SegCs,context.Eip);
331 ret=DOSVM_SimulateInt(VM86_ARG(fn),&context,FALSE);
333 DPRINTF("Ret DOS int 0x%02x (EAX=%08lx) ret=%04lx:%04lx\n",VM86_ARG(fn),context.Eax,context.SegCs,context.Eip);
337 /* case VM86_PICRETURN: */
338 TRACE_(int)("DOS task enabled interrupts %s events pending, sending events\n", IS_PEND(&context)?"with":"without");
339 DOSVM_SendQueuedEvents(&context);
342 do_exception( SIGTRAP, &context );
345 DOSVM_Dump(fn,sig,VM86);
349 current_context = old_context;
351 #define CP(x,y) VM86->regs.x = context.y
355 VM86->vm86plus.force_return_for_pic = IS_PEND(&context) ? 1 : 0;
361 static void DOSVM_ProcessConsole(void)
367 if (ReadConsoleInputA(GetStdHandle(STD_INPUT_HANDLE),&msg,1,&res)) {
368 switch (msg.EventType) {
370 scan = msg.Event.KeyEvent.wVirtualScanCode;
371 if (!msg.Event.KeyEvent.bKeyDown) scan |= 0x80;
373 /* check whether extended bit is set,
374 * and if so, queue the extension prefix */
375 if (msg.Event.KeyEvent.dwControlKeyState & ENHANCED_KEY) {
376 INT_Int09SendScan(0xE0,0);
378 INT_Int09SendScan(scan,msg.Event.KeyEvent.uChar.AsciiChar);
381 FIXME_(int)("unhandled console event: %d\n", msg.EventType);
386 static void DOSVM_ProcessMessage(MSG *msg)
390 TRACE_(int)("got message %04x, wparam=%08x, lparam=%08lx\n",msg->message,msg->wParam,msg->lParam);
391 if ((msg->message>=WM_MOUSEFIRST)&&
392 (msg->message<=WM_MOUSELAST)) {
393 INT_Int33Message(msg->message,msg->wParam,msg->lParam);
395 switch (msg->message) {
399 scan |= (msg->lParam >> 16) & 0x7f;
401 /* check whether extended bit is set,
402 * and if so, queue the extension prefix */
403 if (msg->lParam & 0x1000000) {
404 /* FIXME: some keys (function keys) have
405 * extended bit set even when they shouldn't,
406 * should check for them */
407 INT_Int09SendScan(0xE0,0);
409 INT_Int09SendScan(scan,0);
415 void WINAPI DOSVM_Wait( INT read_pipe, HANDLE hObject )
421 BOOL got_msg = FALSE;
423 objs[0]=GetStdHandle(STD_INPUT_HANDLE);
427 /* check for messages (waste time before the response check below) */
430 while (PeekMessageA(&msg,0,0,0,PM_REMOVE|PM_NOYIELD)) {
432 DOSVM_ProcessMessage(&msg);
433 /* we don't need a TranslateMessage here */
434 DispatchMessageA(&msg);
440 /* check for console input */
443 if (PeekConsoleInputA(objs[0],&msg,1,&num) && num) {
444 DOSVM_ProcessConsole();
448 if (read_pipe == -1) {
449 /* dispatch pending events */
450 if (SHOULD_PEND(pending_event)) {
451 CONTEXT86 context = *current_context;
454 DOSVM_SendQueuedEvents(&context);
459 struct timeval timeout={0,0};
460 /* quick check for response from dosmod
461 * (faster than doing the full blocking wait, if data already available) */
462 FD_ZERO(&readfds); FD_SET(read_pipe,&readfds);
463 if (select(read_pipe+1,&readfds,NULL,NULL,&timeout)>0)
466 /* nothing yet, block while waiting for something to do */
467 if (MsgWaitForMultipleObjects)
468 waitret = MsgWaitForMultipleObjects(objc,objs,FALSE,INFINITE,QS_ALLINPUT);
470 waitret = WaitForMultipleObjects(objc,objs,FALSE,INFINITE);
472 if (waitret==(DWORD)-1) {
473 ERR_(module)("dosvm wait error=%ld\n",GetLastError());
475 if ((read_pipe != -1) && hObject) {
476 if (waitret==(WAIT_OBJECT_0+1)) break;
478 if (waitret==WAIT_OBJECT_0)
479 goto chk_console_input;
483 INT WINAPI DOSVM_Enter( CONTEXT86 *context )
485 struct vm86plus_struct VM86;
488 memset(&VM86, 0, sizeof(VM86));
489 #define CP(x,y) VM86.regs.x = context->y
492 if (VM86.regs.eflags & IF_MASK)
493 VM86.regs.eflags |= VIF_MASK;
495 /* main exchange loop */
498 TRACE_(module)("thread is: %lx\n",GetCurrentThreadId());
501 /* transmit VM86 structure to dosmod task */
502 if (write(write_pipe,&stat,sizeof(stat))!=sizeof(stat)) {
503 ERR_(module)("dosmod sync lost, errno=%d, fd=%d, pid=%d\n",errno,write_pipe,getpid());
506 if (write(write_pipe,&VM86,sizeof(VM86))!=sizeof(VM86)) {
507 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
510 /* wait for response, doing other things in the meantime */
511 DOSVM_Wait(read_pipe, hReadPipe);
514 if ((len=read(read_pipe,&stat,sizeof(stat)))==sizeof(stat)) break;
515 if (((errno==EINTR)||(errno==EAGAIN))&&(len<=0)) {
516 WARN_(module)("rereading dosmod return code due to errno=%d, result=%d\n",errno,len);
519 ERR_(module)("dosmod sync lost reading return code, errno=%d, result=%d\n",errno,len);
522 TRACE_(module)("dosmod return code=%d\n",stat);
523 if (stat==DOSMOD_LEFTIDLE) {
527 if ((len=read(read_pipe,&VM86,sizeof(VM86)))==sizeof(VM86)) break;
528 if (((errno==EINTR)||(errno==EAGAIN))&&(len<=0)) {
529 WARN_(module)("rereading dosmod VM86 structure due to errno=%d, result=%d\n",errno,len);
532 ERR_(module)("dosmod sync lost reading VM86 structure, errno=%d, result=%d\n",errno,len);
535 if ((stat&0xff)==DOSMOD_SIGNAL) {
537 if ((len=read(read_pipe,&sig,sizeof(sig)))==sizeof(sig)) break;
538 if (((errno==EINTR)||(errno==EAGAIN))&&(len<=0)) {
539 WARN_(module)("rereading dosmod signal due to errno=%d, result=%d\n",errno,len);
542 ERR_(module)("dosmod sync lost reading signal, errno=%d, result=%d\n",errno,len);
547 } while (DOSVM_Process(stat,sig,&VM86)>=0);
550 #define CP(x,y) context->y = VM86.regs.x
556 void WINAPI DOSVM_PIC_ioport_out( WORD port, BYTE val)
560 if ((port==0x20) && (val==0x20)) {
562 /* EOI (End Of Interrupt) */
563 TRACE_(int)("received EOI for current IRQ, clearing\n");
564 event = current_event;
565 current_event = event->next;
567 (*event->relay)(NULL,event->data);
572 /* another event is pending, which we should probably
573 * be able to process now, so tell dosmod about it */
574 TRACE_(int)("another event pending, signalling dosmod\n");
575 kill(dosmod_pid,SIGUSR2);
579 WARN_(int)("EOI without active IRQ\n");
582 FIXME_(int)("unrecognized PIC command %02x\n",val);
586 void WINAPI DOSVM_SetTimer( UINT ticks )
588 int stat=DOSMOD_SET_TIMER;
592 /* the PC clocks ticks at 1193180 Hz */
594 tim.tv_usec=MulDiv(ticks,1000000,1193180);
596 if (!tim.tv_usec) tim.tv_usec=1;
598 if (write(write_pipe,&stat,sizeof(stat))!=sizeof(stat)) {
599 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
602 if (write(write_pipe,&tim,sizeof(tim))!=sizeof(tim)) {
603 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
606 /* there's no return */
610 UINT WINAPI DOSVM_GetTimer( void )
612 int stat=DOSMOD_GET_TIMER;
616 if (write(write_pipe,&stat,sizeof(stat))!=sizeof(stat)) {
617 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
622 if (read(read_pipe,&tim,sizeof(tim))==sizeof(tim)) break;
623 if ((errno==EINTR)||(errno==EAGAIN)) continue;
624 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
627 return MulDiv(tim.tv_usec,1193180,1000000);
632 #else /* !MZ_SUPPORTED */
634 INT WINAPI DOSVM_Enter( CONTEXT86 *context )
636 ERR_(module)("DOS realmode not supported on this architecture!\n");
640 void WINAPI DOSVM_Wait( INT read_pipe, HANDLE hObject) {}
641 void WINAPI DOSVM_PIC_ioport_out( WORD port, BYTE val) {}
642 void WINAPI DOSVM_SetTimer( UINT ticks ) {}
643 UINT WINAPI DOSVM_GetTimer( void ) { return 0; }
644 void WINAPI DOSVM_QueueEvent( INT irq, INT priority, DOSRELAY relay, LPVOID data)
647 /* callback event, perform it with dummy context */
649 memset(&context,0,sizeof(context));
650 (*relay)(&context,data);
652 ERR_(int)("IRQ without DOS task: should not happen");