dlls/kernel/win87em.c

   1 /*
   2  * Copyright 1993 Bob Amstadt
   3  *
   4  * This library is free software; you can redistribute it and/or
   5  * modify it under the terms of the GNU Lesser General Public
   6  * License as published by the Free Software Foundation; either
   7  * version 2.1 of the License, or (at your option) any later version.
   8  *
   9  * This library is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * Lesser General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU Lesser General Public
  15  * License along with this library; if not, write to the Free Software
  16  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  17  */
  18
  19 #include <stdlib.h>
  20 #include "windef.h"
  21 #include "wine/debug.h"
  22
  23 WINE_DEFAULT_DEBUG_CHANNEL(int);
  24
  25 struct Win87EmInfoStruct
  26 {
  27     unsigned short Version;
  28     unsigned short SizeSaveArea;
  29     unsigned short WinDataSeg;
  30     unsigned short WinCodeSeg;
  31     unsigned short Have80x87;
  32     unsigned short Unused;
  33 };
  34
  35 /* Implementing this is easy cause Linux and *BSD* ALWAYS have a numerical
  36  * coprocessor. (either real or emulated on kernellevel)
  37  */
  38 /* win87em.dll also sets interrupt vectors: 2 (NMI), 0x34 - 0x3f (emulator
  39  * calls of standard libraries, see Ralph Browns interrupt list), 0x75
  40  * (int13 error reporting of coprocessor)
  41  */
  42
  43 /* have a look at /usr/src/linux/arch/i386/math-emu/ *.[ch] for more info
  44  * especially control_w.h and status_w.h
  45  */
  46 /* FIXME: Still rather skeletal implementation only */
  47
  48 static BOOL Installed = 0;
  49 static WORD RefCount = 0;
  50 static WORD CtrlWord_1 = 0;
  51 static WORD CtrlWord_2 = 0;
  52 static WORD CtrlWord_Internal = 0;
  53 static WORD StatusWord_1 = 0x000b;
  54 static WORD StatusWord_2 = 0;
  55 static WORD StatusWord_3 = 0;
  56 static WORD StackTop = 175;
  57 static WORD StackBottom = 0;
  58 static WORD Inthandler02hVar = 1;
  59
  60 static void WIN87_ClearCtrlWord( CONTEXT86 *context )
  61 {
  62     context->Eax &= ~0xffff;  /* set AX to 0 */
  63     if (Installed)
  64 #ifdef __i386__
  65         __asm__("fclex");
  66 #else
  67         ;
  68 #endif
  69     StatusWord_3 = StatusWord_2 = 0;
  70 }
  71
  72 static void WIN87_SetCtrlWord( CONTEXT86 *context )
  73 {
  74     CtrlWord_1 = LOWORD(context->Eax);
  75     context->Eax &= ~0x00c3;
  76     if (Installed) {
  77         CtrlWord_Internal = LOWORD(context->Eax);
  78 #ifdef __i386__
  79         __asm__("wait;fldcw %0" : : "m" (CtrlWord_Internal));
  80 #endif
  81     }
  82     CtrlWord_2 = LOWORD(context->Eax);
  83 }
  84
  85 static void WIN87_Init( CONTEXT86 *context )
  86 {
  87     if (Installed) {
  88 #ifdef __i386__
  89         __asm__("fninit");
  90         __asm__("fninit");
  91 #endif
  92     }
  93     StackBottom = StackTop;
  94     context->Eax = (context->Eax & ~0xffff) | 0x1332;
  95     WIN87_SetCtrlWord(context);
  96     WIN87_ClearCtrlWord(context);
  97 }
  98
  99 /***********************************************************************
 100  *              _fpMath (WIN87EM.1)
 101  */
 102 void WINAPI WIN87_fpmath( CONTEXT86 *context )
 103 {
 104     TRACE("(cs:eip=%x:%lx es=%x bx=%04x ax=%04x dx=%04x)\n",
 105                  (WORD)context->SegCs, context->Eip,
 106                  (WORD)context->SegEs, (WORD)context->Ebx,
 107                  (WORD)context->Eax, (WORD)context->Edx );
 108
 109     switch(LOWORD(context->Ebx))
 110     {
 111     case 0: /* install (increase instanceref) emulator, install NMI vector */
 112         RefCount++;
 113 #if 0
 114         if (Installed)
 115             InstallIntVecs02hAnd75h();
 116 #endif
 117         WIN87_Init(context);
 118         context->Eax &= ~0xffff;  /* set AX to 0 */
 119         break;
 120
 121     case 1: /* Init Emulator */
 122         WIN87_Init(context);
 123         break;
 124
 125     case 2: /* deinstall emulator (decrease instanceref), deinstall NMI vector
 126              * if zero. Every '0' call should have a matching '2' call.
 127              */
 128         WIN87_Init(context);
 129         RefCount--;
 130 #if 0
 131         if (!RefCount && Installed)
 132             RestoreInt02h();
 133 #endif
 134
 135         break;
 136
 137     case 3:
 138         /*INT_SetHandler(0x3E,MAKELONG(AX,DX));*/
 139         break;
 140
 141     case 4: /* set control word (& ~(CW_Denormal|CW_Invalid)) */
 142         /* OUT: newset control word in AX */
 143         WIN87_SetCtrlWord(context);
 144         break;
 145
 146     case 5: /* return internal control word in AX */
 147         context->Eax = (context->Eax & ~0xffff) | CtrlWord_1;
 148         break;
 149
 150     case 6: /* round top of stack to integer using method AX & 0x0C00 */
 151         /* returns current controlword */
 152         {
 153             DWORD dw=0;
 154             WORD save,mask;
 155             /* I don't know much about asm() programming. This could be
 156              * wrong.
 157              */
 158 #ifdef __i386__
 159            __asm__ __volatile__("fstcw %0;wait" : "=m" (save) : : "memory");
 160            __asm__ __volatile__("fstcw %0;wait" : "=m" (mask) : : "memory");
 161            __asm__ __volatile__("orw $0xC00,%0" : "=m" (mask) : : "memory");
 162            __asm__ __volatile__("fldcw %0;wait" : : "m" (mask));
 163            __asm__ __volatile__("frndint");
 164            __asm__ __volatile__("fist %0;wait" : "=m" (dw) : : "memory");
 165            __asm__ __volatile__("fldcw %0" : : "m" (save));
 166 #endif
 167             TRACE("On top of stack is %ld\n",dw);
 168         }
 169         break;
 170
 171     case 7: /* POP top of stack as integer into DX:AX */
 172         /* IN: AX&0x0C00 rounding protocol */
 173         /* OUT: DX:AX variable popped */
 174         {
 175             DWORD dw=0;
 176             /* I don't know much about asm() programming. This could be
 177              * wrong.
 178              */
 179 /* FIXME: could someone who really understands asm() fix this please? --AJ */
 180 /*            __asm__("fistp %0;wait" : "=m" (dw) : : "memory"); */
 181             TRACE("On top of stack was %ld\n",dw);
 182             context->Eax = (context->Eax & ~0xffff) | LOWORD(dw);
 183             context->Edx = (context->Edx & ~0xffff) | HIWORD(dw);
 184         }
 185         break;
 186
 187     case 8: /* restore internal status words from emulator status word */
 188         context->Eax &= ~0xffff;  /* set AX to 0 */
 189         if (Installed) {
 190 #ifdef __i386__
 191             __asm__("fstsw %0;wait" : "=m" (StatusWord_1));
 192 #endif
 193             context->Eax |= StatusWord_1 & 0x3f;
 194         }
 195         context->Eax = (context->Eax | StatusWord_2) & ~0xe000;
 196         StatusWord_2 = LOWORD(context->Eax);
 197         break;
 198
 199     case 9: /* clear emu control word and some other things */
 200         WIN87_ClearCtrlWord(context);
 201         break;
 202
 203     case 10: /* dunno. but looks like returning nr. of things on stack in AX */
 204         context->Eax &= ~0xffff;  /* set AX to 0 */
 205         break;
 206
 207     case 11: /* just returns the installed flag in DX:AX */
 208         context->Edx &= ~0xffff;  /* set DX to 0 */
 209         context->Eax = (context->Eax & ~0xffff) | Installed;
 210         break;
 211
 212     case 12: /* save AX in some internal state var */
 213         Inthandler02hVar = LOWORD(context->Eax);
 214         break;
 215
 216     default: /* error. Say that loud and clear */
 217         FIXME("unhandled switch %d\n",LOWORD(context->Ebx));
 218         context->Eax |= 0xffff;
 219         context->Edx |= 0xffff;
 220         break;
 221     }
 222 }
 223
 224 /***********************************************************************
 225  *              __WinEm87Info (WIN87EM.3)
 226  */
 227 void WINAPI WIN87_WinEm87Info(struct Win87EmInfoStruct *pWIS,
 228                               int cbWin87EmInfoStruct)
 229 {
 230   FIXME("(%p,%d), stub !\n",pWIS,cbWin87EmInfoStruct);
 231 }
 232
 233 /***********************************************************************
 234  *              __WinEm87Restore (WIN87EM.4)
 235  */
 236 void WINAPI WIN87_WinEm87Restore(void *pWin87EmSaveArea,
 237                                  int cbWin87EmSaveArea)
 238 {
 239   FIXME("(%p,%d), stub !\n",
 240         pWin87EmSaveArea,cbWin87EmSaveArea);
 241 }
 242
 243 /***********************************************************************
 244  *              __WinEm87Save (WIN87EM.5)
 245  */
 246 void WINAPI WIN87_WinEm87Save(void *pWin87EmSaveArea, int cbWin87EmSaveArea)
 247 {
 248   FIXME("(%p,%d), stub !\n",
 249         pWin87EmSaveArea,cbWin87EmSaveArea);
 250 }