| /* |
| * Copyright 1993 Bob Amstadt |
| * |
| * This library is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU Lesser General Public |
| * License as published by the Free Software Foundation; either |
| * version 2.1 of the License, or (at your option) any later version. |
| * |
| * This library is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| * Lesser General Public License for more details. |
| * |
| * You should have received a copy of the GNU Lesser General Public |
| * License along with this library; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| */ |
| |
| #include <stdlib.h> |
| #include "windef.h" |
| #include "wine/debug.h" |
| |
| WINE_DEFAULT_DEBUG_CHANNEL(int); |
| |
| struct Win87EmInfoStruct |
| { |
| unsigned short Version; |
| unsigned short SizeSaveArea; |
| unsigned short WinDataSeg; |
| unsigned short WinCodeSeg; |
| unsigned short Have80x87; |
| unsigned short Unused; |
| }; |
| |
| /* Implementing this is easy cause Linux and *BSD* ALWAYS have a numerical |
| * coprocessor. (either real or emulated on kernellevel) |
| */ |
| /* win87em.dll also sets interrupt vectors: 2 (NMI), 0x34 - 0x3f (emulator |
| * calls of standard libraries, see Ralph Browns interrupt list), 0x75 |
| * (int13 error reporting of coprocessor) |
| */ |
| |
| /* have a look at /usr/src/linux/arch/i386/math-emu/ *.[ch] for more info |
| * especially control_w.h and status_w.h |
| */ |
| /* FIXME: Still rather skeletal implementation only */ |
| |
| static BOOL Installed = 0; |
| static WORD RefCount = 0; |
| static WORD CtrlWord_1 = 0; |
| static WORD CtrlWord_2 = 0; |
| static WORD CtrlWord_Internal = 0; |
| static WORD StatusWord_1 = 0x000b; |
| static WORD StatusWord_2 = 0; |
| static WORD StatusWord_3 = 0; |
| static WORD StackTop = 175; |
| static WORD StackBottom = 0; |
| static WORD Inthandler02hVar = 1; |
| |
| static void WIN87_ClearCtrlWord( CONTEXT86 *context ) |
| { |
| context->Eax &= ~0xffff; /* set AX to 0 */ |
| if (Installed) |
| #ifdef __i386__ |
| __asm__("fclex"); |
| #else |
| ; |
| #endif |
| StatusWord_3 = StatusWord_2 = 0; |
| } |
| |
| static void WIN87_SetCtrlWord( CONTEXT86 *context ) |
| { |
| CtrlWord_1 = LOWORD(context->Eax); |
| context->Eax &= ~0x00c3; |
| if (Installed) { |
| CtrlWord_Internal = LOWORD(context->Eax); |
| #ifdef __i386__ |
| __asm__("wait;fldcw %0" : : "m" (CtrlWord_Internal)); |
| #endif |
| } |
| CtrlWord_2 = LOWORD(context->Eax); |
| } |
| |
| static void WIN87_Init( CONTEXT86 *context ) |
| { |
| if (Installed) { |
| #ifdef __i386__ |
| __asm__("fninit"); |
| __asm__("fninit"); |
| #endif |
| } |
| StackBottom = StackTop; |
| context->Eax = (context->Eax & ~0xffff) | 0x1332; |
| WIN87_SetCtrlWord(context); |
| WIN87_ClearCtrlWord(context); |
| } |
| |
| /*********************************************************************** |
| * _fpMath (WIN87EM.1) |
| */ |
| void WINAPI WIN87_fpmath( CONTEXT86 *context ) |
| { |
| TRACE("(cs:eip=%x:%lx es=%x bx=%04x ax=%04x dx=%04x)\n", |
| (WORD)context->SegCs, context->Eip, |
| (WORD)context->SegEs, (WORD)context->Ebx, |
| (WORD)context->Eax, (WORD)context->Edx ); |
| |
| switch(LOWORD(context->Ebx)) |
| { |
| case 0: /* install (increase instanceref) emulator, install NMI vector */ |
| RefCount++; |
| #if 0 |
| if (Installed) |
| InstallIntVecs02hAnd75h(); |
| #endif |
| WIN87_Init(context); |
| context->Eax &= ~0xffff; /* set AX to 0 */ |
| break; |
| |
| case 1: /* Init Emulator */ |
| WIN87_Init(context); |
| break; |
| |
| case 2: /* deinstall emulator (decrease instanceref), deinstall NMI vector |
| * if zero. Every '0' call should have a matching '2' call. |
| */ |
| WIN87_Init(context); |
| RefCount--; |
| #if 0 |
| if (!RefCount && Installed) |
| RestoreInt02h(); |
| #endif |
| |
| break; |
| |
| case 3: |
| /*INT_SetHandler(0x3E,MAKELONG(AX,DX));*/ |
| break; |
| |
| case 4: /* set control word (& ~(CW_Denormal|CW_Invalid)) */ |
| /* OUT: newset control word in AX */ |
| WIN87_SetCtrlWord(context); |
| break; |
| |
| case 5: /* return internal control word in AX */ |
| context->Eax = (context->Eax & ~0xffff) | CtrlWord_1; |
| break; |
| |
| case 6: /* round top of stack to integer using method AX & 0x0C00 */ |
| /* returns current controlword */ |
| { |
| DWORD dw=0; |
| WORD save,mask; |
| /* I don't know much about asm() programming. This could be |
| * wrong. |
| */ |
| #ifdef __i386__ |
| __asm__ __volatile__("fstcw %0;wait" : "=m" (save) : : "memory"); |
| __asm__ __volatile__("fstcw %0;wait" : "=m" (mask) : : "memory"); |
| __asm__ __volatile__("orw $0xC00,%0" : "=m" (mask) : : "memory"); |
| __asm__ __volatile__("fldcw %0;wait" : : "m" (mask)); |
| __asm__ __volatile__("frndint"); |
| __asm__ __volatile__("fist %0;wait" : "=m" (dw) : : "memory"); |
| __asm__ __volatile__("fldcw %0" : : "m" (save)); |
| #endif |
| TRACE("On top of stack is %ld\n",dw); |
| } |
| break; |
| |
| case 7: /* POP top of stack as integer into DX:AX */ |
| /* IN: AX&0x0C00 rounding protocol */ |
| /* OUT: DX:AX variable popped */ |
| { |
| DWORD dw=0; |
| /* I don't know much about asm() programming. This could be |
| * wrong. |
| */ |
| /* FIXME: could someone who really understands asm() fix this please? --AJ */ |
| /* __asm__("fistp %0;wait" : "=m" (dw) : : "memory"); */ |
| TRACE("On top of stack was %ld\n",dw); |
| context->Eax = (context->Eax & ~0xffff) | LOWORD(dw); |
| context->Edx = (context->Edx & ~0xffff) | HIWORD(dw); |
| } |
| break; |
| |
| case 8: /* restore internal status words from emulator status word */ |
| context->Eax &= ~0xffff; /* set AX to 0 */ |
| if (Installed) { |
| #ifdef __i386__ |
| __asm__("fstsw %0;wait" : "=m" (StatusWord_1)); |
| #endif |
| context->Eax |= StatusWord_1 & 0x3f; |
| } |
| context->Eax = (context->Eax | StatusWord_2) & ~0xe000; |
| StatusWord_2 = LOWORD(context->Eax); |
| break; |
| |
| case 9: /* clear emu control word and some other things */ |
| WIN87_ClearCtrlWord(context); |
| break; |
| |
| case 10: /* dunno. but looks like returning nr. of things on stack in AX */ |
| context->Eax &= ~0xffff; /* set AX to 0 */ |
| break; |
| |
| case 11: /* just returns the installed flag in DX:AX */ |
| context->Edx &= ~0xffff; /* set DX to 0 */ |
| context->Eax = (context->Eax & ~0xffff) | Installed; |
| break; |
| |
| case 12: /* save AX in some internal state var */ |
| Inthandler02hVar = LOWORD(context->Eax); |
| break; |
| |
| default: /* error. Say that loud and clear */ |
| FIXME("unhandled switch %d\n",LOWORD(context->Ebx)); |
| context->Eax |= 0xffff; |
| context->Edx |= 0xffff; |
| break; |
| } |
| } |
| |
| /*********************************************************************** |
| * __WinEm87Info (WIN87EM.3) |
| */ |
| void WINAPI WIN87_WinEm87Info(struct Win87EmInfoStruct *pWIS, |
| int cbWin87EmInfoStruct) |
| { |
| FIXME("(%p,%d), stub !\n",pWIS,cbWin87EmInfoStruct); |
| } |
| |
| /*********************************************************************** |
| * __WinEm87Restore (WIN87EM.4) |
| */ |
| void WINAPI WIN87_WinEm87Restore(void *pWin87EmSaveArea, |
| int cbWin87EmSaveArea) |
| { |
| FIXME("(%p,%d), stub !\n", |
| pWin87EmSaveArea,cbWin87EmSaveArea); |
| } |
| |
| /*********************************************************************** |
| * __WinEm87Save (WIN87EM.5) |
| */ |
| void WINAPI WIN87_WinEm87Save(void *pWin87EmSaveArea, int cbWin87EmSaveArea) |
| { |
| FIXME("(%p,%d), stub !\n", |
| pWin87EmSaveArea,cbWin87EmSaveArea); |
| } |
