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"
33 #include "stackframe.h"
34 #include "debugtools.h"
36 DECLARE_DEBUG_CHANNEL(int)
37 DECLARE_DEBUG_CHANNEL(module)
38 DECLARE_DEBUG_CHANNEL(relay)
42 #ifdef HAVE_SYS_VM86_H
43 # include <sys/vm86.h>
45 #ifdef HAVE_SYS_MMAN_H
46 # include <sys/mman.h>
49 #define IF_CLR(ctx) EFL_reg(ctx) &= ~VIF_MASK
50 #define IF_ENABLED(ctx) (EFL_reg(ctx) & VIF_MASK)
51 #define SET_PEND(ctx) EFL_reg(ctx) |= VIP_MASK
52 #define CLR_PEND(ctx) EFL_reg(ctx) &= ~VIP_MASK
53 #define IS_PEND(ctx) (EFL_reg(ctx) & VIP_MASK)
57 static void do_exception( int signal, CONTEXT86 *context )
60 if ((signal == SIGTRAP) || (signal == SIGHUP))
62 rec.ExceptionCode = EXCEPTION_BREAKPOINT;
63 rec.ExceptionFlags = EXCEPTION_CONTINUABLE;
67 rec.ExceptionCode = EXCEPTION_ILLEGAL_INSTRUCTION; /* generic error */
68 rec.ExceptionFlags = EH_NONCONTINUABLE;
70 rec.ExceptionRecord = NULL;
71 rec.ExceptionAddress = (LPVOID)EIP_reg(context);
72 rec.NumberParameters = 0;
73 EXC_RtlRaiseException( &rec, context );
76 static void DOSVM_Dump( LPDOSTASK lpDosTask, int fn, int sig,
77 struct vm86plus_struct*VM86 )
83 switch (VM86_TYPE(fn)) {
85 printf("Trapped signal %d\n",sig); break;
87 printf("Trapped unhandled GPF\n"); break;
89 printf("Trapped INT %02x\n",VM86_ARG(fn)); break;
91 printf("Trapped STI\n"); break;
93 printf("Trapped due to pending PIC request\n"); break;
95 printf("Trapped debug request\n"); break;
97 printf("Trapped unknown VM86 type %d arg %d\n",VM86_TYPE(fn),VM86_ARG(fn)); break;
99 #define REGS VM86->regs
100 fprintf(stderr,"AX=%04lX CX=%04lX DX=%04lX BX=%04lX\n",REGS.eax,REGS.ecx,REGS.edx,REGS.ebx);
101 fprintf(stderr,"SI=%04lX DI=%04lX SP=%04lX BP=%04lX\n",REGS.esi,REGS.edi,REGS.esp,REGS.ebp);
102 fprintf(stderr,"CS=%04X DS=%04X ES=%04X SS=%04X\n",REGS.cs,REGS.ds,REGS.es,REGS.ss);
103 fprintf(stderr,"IP=%04lX EFLAGS=%08lX\n",REGS.eip,REGS.eflags);
105 iofs=((DWORD)REGS.cs<<4)+REGS.eip;
107 inst=(BYTE*)lpDosTask->img+iofs;
109 for (x=0; x<8; x++) printf(" %02x",inst[x]);
113 static int DOSVM_Int( int vect, CONTEXT86 *context, LPDOSTASK lpDosTask )
115 extern UINT16 DPMI_wrap_seg;
118 if (CS_reg(context)==DPMI_wrap_seg) {
119 /* exit from real-mode wrapper */
122 /* we could probably move some other dodgy stuff here too from dpmi.c */
124 INT_RealModeInterrupt(vect,context);
128 static void DOSVM_SimulateInt( int vect, CONTEXT86 *context, LPDOSTASK lpDosTask )
130 FARPROC16 handler=INT_GetRMHandler(vect);
132 if (SELECTOROF(handler)==0xf000) {
133 /* if internal interrupt, call it directly */
134 INT_RealModeInterrupt(vect,context);
136 WORD*stack=(WORD*)(V86BASE(context)+(((DWORD)SS_reg(context))<<4)+LOWORD(ESP_reg(context)));
137 WORD flag=LOWORD(EFL_reg(context));
139 if (IF_ENABLED(context)) flag|=IF_MASK;
143 *(--stack)=CS_reg(context);
144 *(--stack)=LOWORD(EIP_reg(context));
146 CS_reg(context)=SELECTOROF(handler);
147 EIP_reg(context)=OFFSETOF(handler);
152 #define SHOULD_PEND(x) \
153 (x && ((!lpDosTask->current) || (x->priority < lpDosTask->current->priority)))
155 static void DOSVM_SendQueuedEvent(CONTEXT86 *context, LPDOSTASK lpDosTask)
157 LPDOSEVENT event = lpDosTask->pending;
159 if (SHOULD_PEND(event)) {
160 /* remove from "pending" list */
161 lpDosTask->pending = event->next;
164 /* it's an IRQ, move it to "current" list */
165 event->next = lpDosTask->current;
166 lpDosTask->current = event;
167 TRACE_(int)("dispatching IRQ %d\n",event->irq);
168 /* note that if DOSVM_SimulateInt calls an internal interrupt directly,
169 * lpDosTask->current might be cleared (and event freed) in this very call! */
170 DOSVM_SimulateInt((event->irq<8)?(event->irq+8):(event->irq-8+0x70),context,lpDosTask);
173 TRACE_(int)("dispatching callback event\n");
174 (*event->relay)(lpDosTask,context,event->data);
178 if (!SHOULD_PEND(lpDosTask->pending)) {
179 TRACE_(int)("clearing Pending flag\n");
184 static void DOSVM_SendQueuedEvents(CONTEXT86 *context, LPDOSTASK lpDosTask)
186 /* we will send all queued events as long as interrupts are enabled,
187 * but IRQ events will disable interrupts again */
188 while (IS_PEND(context) && IF_ENABLED(context))
189 DOSVM_SendQueuedEvent(context,lpDosTask);
192 void DOSVM_QueueEvent( int irq, int priority, void (*relay)(LPDOSTASK,CONTEXT86*,void*), void *data)
194 LPDOSTASK lpDosTask = MZ_Current();
195 LPDOSEVENT event, cur, prev;
198 event = malloc(sizeof(DOSEVENT));
200 ERR_(int)("out of memory allocating event entry\n");
203 event->irq = irq; event->priority = priority;
204 event->relay = relay; event->data = data;
206 /* insert event into linked list, in order *after*
207 * all earlier events of higher or equal priority */
208 cur = lpDosTask->pending; prev = NULL;
209 while (cur && cur->priority<=priority) {
214 if (prev) prev->next = event;
215 else lpDosTask->pending = event;
217 /* get dosmod's attention to the new event, except for irq==0 where we already have it */
218 if (irq && !lpDosTask->sig_sent) {
219 TRACE_(int)("new event queued, signalling dosmod\n");
220 kill(lpDosTask->task,SIGUSR2);
221 lpDosTask->sig_sent++;
223 TRACE_(int)("new event queued\n");
228 #define CV CP(eax,EAX); CP(ecx,ECX); CP(edx,EDX); CP(ebx,EBX); \
229 CP(esi,ESI); CP(edi,EDI); CP(esp,ESP); CP(ebp,EBP); \
230 CP(cs,CS); CP(ds,DS); CP(es,ES); \
231 CP(ss,SS); CP(fs,FS); CP(gs,GS); \
232 CP(eip,EIP); CP(eflags,EFL)
234 static int DOSVM_Process( LPDOSTASK lpDosTask, int fn, int sig,
235 struct vm86plus_struct*VM86 )
240 #define CP(x,y) y##_reg(&context) = VM86->regs.x
243 if (VM86_TYPE(fn)==VM86_UNKNOWN) {
244 ret=INSTR_EmulateInstruction(&context);
245 #define CP(x,y) VM86->regs.x = y##_reg(&context)
251 (void*)V86BASE(&context)=lpDosTask->img;
253 if (VM86->vm86plus.force_return_for_pic) {
257 /* linux doesn't preserve pending flag on return */
258 if (SHOULD_PEND(lpDosTask->pending)) {
263 switch (VM86_TYPE(fn)) {
265 TRACE_(int)("DOS module caught signal %d\n",sig);
266 if ((sig==SIGALRM) || (sig==SIGUSR2)) {
268 DOSVM_QueueEvent(0,DOS_PRIORITY_REALTIME,NULL,NULL);
270 if (lpDosTask->pending) {
271 TRACE_(int)("setting Pending flag, interrupts are currently %s\n",
272 IF_ENABLED(&context) ? "enabled" : "disabled");
274 DOSVM_SendQueuedEvents(&context,lpDosTask);
276 TRACE_(int)("no events are pending, clearing Pending flag\n");
279 if (sig==SIGUSR2) lpDosTask->sig_sent--;
281 else if ((sig==SIGHUP) || (sig==SIGILL) || (sig==SIGSEGV)) {
282 do_exception( sig, &context );
284 DOSVM_Dump(lpDosTask,fn,sig,VM86);
288 case VM86_UNKNOWN: /* unhandled GPF */
289 DOSVM_Dump(lpDosTask,fn,sig,VM86);
290 do_exception( SIGSEGV, &context );
294 DPRINTF("Call DOS int 0x%02x (EAX=%08lx) ret=%04lx:%04lx\n",VM86_ARG(fn),context.Eax,context.SegCs,context.Eip);
295 ret=DOSVM_Int(VM86_ARG(fn),&context,lpDosTask);
297 DPRINTF("Ret DOS int 0x%02x (EAX=%08lx) ret=%04lx:%04lx\n",VM86_ARG(fn),context.Eax,context.SegCs,context.Eip);
301 TRACE_(int)("DOS task enabled interrupts with events pending, sending events\n");
302 DOSVM_SendQueuedEvents(&context,lpDosTask);
305 do_exception( SIGTRAP, &context );
308 DOSVM_Dump(lpDosTask,fn,sig,VM86);
312 #define CP(x,y) VM86->regs.x = y##_reg(&context)
316 VM86->vm86plus.force_return_for_pic = IS_PEND(&context) ? 1 : 0;
322 void DOSVM_ProcessMessage(LPDOSTASK lpDosTask,MSG *msg)
326 fprintf(stderr,"got message %04x, wparam=%08x, lparam=%08lx\n",msg->message,msg->wParam,msg->lParam);
327 if ((msg->message>=WM_MOUSEFIRST)&&
328 (msg->message<=WM_MOUSELAST)) {
329 INT_Int33Message(msg->message,msg->wParam,msg->lParam);
331 switch (msg->message) {
335 scan |= (msg->lParam >> 16) & 0x7f;
337 /* check whether extended bit is set,
338 * and if so, queue the extension prefix */
339 if (msg->lParam & 0x1000000) {
340 /* FIXME: some keys (function keys) have
341 * extended bit set even when they shouldn't,
342 * should check for them */
343 INT_Int09SendScan(0xE0);
345 INT_Int09SendScan(scan);
351 void DOSVM_Wait( int read_pipe, HANDLE hObject )
353 LPDOSTASK lpDosTask = MZ_Current();
356 BOOL got_msg = FALSE;
359 /* check for messages (waste time before the response check below) */
360 while (PeekMessageA(&msg,0,0,0,PM_REMOVE|PM_NOYIELD)) {
362 DOSVM_ProcessMessage(lpDosTask,&msg);
363 /* we don't need a TranslateMessage here */
364 DispatchMessageA(&msg);
367 if (read_pipe == -1) {
371 struct timeval timeout={0,0};
372 /* quick check for response from dosmod
373 * (faster than doing the full blocking wait, if data already available) */
374 FD_ZERO(&readfds); FD_SET(read_pipe,&readfds);
375 if (select(read_pipe+1,&readfds,NULL,NULL,&timeout)>0)
378 /* check for data from win32 console device */
380 /* nothing yet, block while waiting for something to do */
381 waitret=MsgWaitForMultipleObjects(1,&hObject,FALSE,INFINITE,QS_ALLINPUT);
382 if (waitret==(DWORD)-1) {
383 ERR_(module)("dosvm wait error=%ld\n",GetLastError());
385 if (read_pipe != -1) {
386 if (waitret==WAIT_OBJECT_0) break;
391 int DOSVM_Enter( CONTEXT86 *context )
393 LPDOSTASK lpDosTask = MZ_Current();
394 struct vm86plus_struct VM86;
398 /* MZ_CreateProcess or MZ_AllocDPMITask should have been called first */
399 ERR_(module)("dosmod has not been initialized!");
404 #define CP(x,y) VM86.regs.x = y##_reg(context)
407 if (VM86.regs.eflags & IF_MASK)
408 VM86.regs.eflags |= VIF_MASK;
411 /* allocate standard DOS handles */
412 FILE_InitProcessDosHandles();
414 memset(&VM86,0,sizeof(VM86));
415 VM86.regs.cs=lpDosTask->init_cs;
416 VM86.regs.eip=lpDosTask->init_ip;
417 VM86.regs.ss=lpDosTask->init_ss;
418 VM86.regs.esp=lpDosTask->init_sp;
419 VM86.regs.ds=lpDosTask->psp_seg;
420 VM86.regs.es=lpDosTask->psp_seg;
421 VM86.regs.eflags=VIF_MASK;
422 /* hmm, what else do we need? */
425 /* main exchange loop */
429 /* transmit VM86 structure to dosmod task */
430 if (write(lpDosTask->write_pipe,&stat,sizeof(stat))!=sizeof(stat)) {
431 ERR_(module)("dosmod sync lost, errno=%d, fd=%d, pid=%d\n",errno,lpDosTask->write_pipe,getpid());
434 if (write(lpDosTask->write_pipe,&VM86,sizeof(VM86))!=sizeof(VM86)) {
435 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
438 /* wait for response, doing other things in the meantime */
439 DOSVM_Wait(lpDosTask->read_pipe, lpDosTask->hReadPipe);
442 if ((len=read(lpDosTask->read_pipe,&stat,sizeof(stat)))==sizeof(stat)) break;
443 if (((errno==EINTR)||(errno==EAGAIN))&&(len<=0)) {
444 WARN_(module)("rereading dosmod return code due to errno=%d, result=%d\n",errno,len);
447 ERR_(module)("dosmod sync lost reading return code, errno=%d, result=%d\n",errno,len);
450 TRACE_(module)("dosmod return code=%d\n",stat);
452 if ((len=read(lpDosTask->read_pipe,&VM86,sizeof(VM86)))==sizeof(VM86)) break;
453 if (((errno==EINTR)||(errno==EAGAIN))&&(len<=0)) {
454 WARN_(module)("rereading dosmod VM86 structure due to errno=%d, result=%d\n",errno,len);
457 ERR_(module)("dosmod sync lost reading VM86 structure, errno=%d, result=%d\n",errno,len);
460 if ((stat&0xff)==DOSMOD_SIGNAL) {
462 if ((len=read(lpDosTask->read_pipe,&sig,sizeof(sig)))==sizeof(sig)) break;
463 if (((errno==EINTR)||(errno==EAGAIN))&&(len<=0)) {
464 WARN_(module)("rereading dosmod signal due to errno=%d, result=%d\n",errno,len);
467 ERR_(module)("dosmod sync lost reading signal, errno=%d, result=%d\n",errno,len);
472 } while (DOSVM_Process(lpDosTask,stat,sig,&VM86)>=0);
475 #define CP(x,y) y##_reg(context) = VM86.regs.x
482 void DOSVM_PIC_ioport_out( WORD port, BYTE val)
484 LPDOSTASK lpDosTask = MZ_Current();
488 if ((port==0x20) && (val==0x20)) {
489 if (lpDosTask->current) {
490 /* EOI (End Of Interrupt) */
491 TRACE_(int)("received EOI for current IRQ, clearing\n");
492 event = lpDosTask->current;
493 lpDosTask->current = event->next;
495 (*event->relay)(lpDosTask,NULL,event->data);
498 if (lpDosTask->pending &&
499 !lpDosTask->sig_sent) {
500 /* another event is pending, which we should probably
501 * be able to process now, so tell dosmod about it */
502 TRACE_(int)("another event pending, signalling dosmod\n");
503 kill(lpDosTask->task,SIGUSR2);
504 lpDosTask->sig_sent++;
507 WARN_(int)("EOI without active IRQ\n");
510 FIXME_(int)("unrecognized PIC command %02x\n",val);
515 void DOSVM_SetTimer( unsigned ticks )
517 LPDOSTASK lpDosTask = MZ_Current();
518 int stat=DOSMOD_SET_TIMER;
522 /* the PC clocks ticks at 1193180 Hz */
524 tim.tv_usec=((unsigned long long)ticks*1000000)/1193180;
526 if (!tim.tv_usec) tim.tv_usec=1;
528 if (write(lpDosTask->write_pipe,&stat,sizeof(stat))!=sizeof(stat)) {
529 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
532 if (write(lpDosTask->write_pipe,&tim,sizeof(tim))!=sizeof(tim)) {
533 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
536 /* there's no return */
540 unsigned DOSVM_GetTimer( void )
542 LPDOSTASK lpDosTask = MZ_Current();
543 int stat=DOSMOD_GET_TIMER;
547 if (write(lpDosTask->write_pipe,&stat,sizeof(stat))!=sizeof(stat)) {
548 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
553 if (read(lpDosTask->read_pipe,&tim,sizeof(tim))==sizeof(tim)) break;
554 if ((errno==EINTR)||(errno==EAGAIN)) continue;
555 ERR_(module)("dosmod sync lost, errno=%d\n",errno);
558 return ((unsigned long long)tim.tv_usec*1193180)/1000000;
563 void DOSVM_SetSystemData( int id, void *data )
565 LPDOSTASK lpDosTask = MZ_Current();
566 DOSSYSTEM *sys, *prev;
569 sys = lpDosTask->sys;
571 while (sys && (sys->id != id)) {
579 sys = malloc(sizeof(DOSSYSTEM));
583 if (prev) prev->next = sys;
584 else lpDosTask->sys = sys;
589 void* DOSVM_GetSystemData( int id )
591 LPDOSTASK lpDosTask = MZ_Current();
595 sys = lpDosTask->sys;
596 while (sys && (sys->id != id))
604 #else /* !MZ_SUPPORTED */
606 int DOSVM_Enter( CONTEXT86 *context )
608 ERR_(module)("DOS realmode not supported on this architecture!\n");
612 void DOSVM_Wait( int read_pipe, HANDLE hObject) {}
613 void DOSVM_PIC_ioport_out( WORD port, BYTE val) {}
614 void DOSVM_SetTimer( unsigned ticks ) {}
615 unsigned DOSVM_GetTimer( void ) { return 0; }
616 void DOSVM_SetSystemData( int id, void *data ) { free(data); }
617 void* DOSVM_GetSystemData( int id ) { return NULL; }
618 void DOSVM_QueueEvent( int irq, int priority, void (*relay)(LPDOSTASK,CONTEXT86*,void*), void *data) {}