Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /*---------------------------------------------------------------------------+ |
| 2 | | fpu_entry.c | |
| 3 | | | |
| 4 | | The entry functions for wm-FPU-emu | |
| 5 | | | |
| 6 | | Copyright (C) 1992,1993,1994,1996,1997 | |
| 7 | | W. Metzenthen, 22 Parker St, Ormond, Vic 3163, Australia | |
| 8 | | E-mail billm@suburbia.net | |
| 9 | | | |
| 10 | | See the files "README" and "COPYING" for further copyright and warranty | |
| 11 | | information. | |
| 12 | | | |
| 13 | +---------------------------------------------------------------------------*/ |
| 14 | |
| 15 | /*---------------------------------------------------------------------------+ |
| 16 | | Note: | |
| 17 | | The file contains code which accesses user memory. | |
| 18 | | Emulator static data may change when user memory is accessed, due to | |
| 19 | | other processes using the emulator while swapping is in progress. | |
| 20 | +---------------------------------------------------------------------------*/ |
| 21 | |
| 22 | /*---------------------------------------------------------------------------+ |
| 23 | | math_emulate(), restore_i387_soft() and save_i387_soft() are the only | |
| 24 | | entry points for wm-FPU-emu. | |
| 25 | +---------------------------------------------------------------------------*/ |
| 26 | |
| 27 | #include <linux/signal.h> |
| 28 | #include <linux/ptrace.h> |
| 29 | |
| 30 | #include <asm/uaccess.h> |
| 31 | #include <asm/desc.h> |
| 32 | |
| 33 | #include "fpu_system.h" |
| 34 | #include "fpu_emu.h" |
| 35 | #include "exception.h" |
| 36 | #include "control_w.h" |
| 37 | #include "status_w.h" |
| 38 | |
| 39 | #define __BAD__ FPU_illegal /* Illegal on an 80486, causes SIGILL */ |
| 40 | |
| 41 | #ifndef NO_UNDOC_CODE /* Un-documented FPU op-codes supported by default. */ |
| 42 | |
| 43 | /* WARNING: These codes are not documented by Intel in their 80486 manual |
| 44 | and may not work on FPU clones or later Intel FPUs. */ |
| 45 | |
| 46 | /* Changes to support the un-doc codes provided by Linus Torvalds. */ |
| 47 | |
| 48 | #define _d9_d8_ fstp_i /* unofficial code (19) */ |
| 49 | #define _dc_d0_ fcom_st /* unofficial code (14) */ |
| 50 | #define _dc_d8_ fcompst /* unofficial code (1c) */ |
| 51 | #define _dd_c8_ fxch_i /* unofficial code (0d) */ |
| 52 | #define _de_d0_ fcompst /* unofficial code (16) */ |
| 53 | #define _df_c0_ ffreep /* unofficial code (07) ffree + pop */ |
| 54 | #define _df_c8_ fxch_i /* unofficial code (0f) */ |
| 55 | #define _df_d0_ fstp_i /* unofficial code (17) */ |
| 56 | #define _df_d8_ fstp_i /* unofficial code (1f) */ |
| 57 | |
| 58 | static FUNC const st_instr_table[64] = { |
| 59 | fadd__, fld_i_, __BAD__, __BAD__, fadd_i, ffree_, faddp_, _df_c0_, |
| 60 | fmul__, fxch_i, __BAD__, __BAD__, fmul_i, _dd_c8_, fmulp_, _df_c8_, |
| 61 | fcom_st, fp_nop, __BAD__, __BAD__, _dc_d0_, fst_i_, _de_d0_, _df_d0_, |
| 62 | fcompst, _d9_d8_, __BAD__, __BAD__, _dc_d8_, fstp_i, fcompp, _df_d8_, |
| 63 | fsub__, FPU_etc, __BAD__, finit_, fsubri, fucom_, fsubrp, fstsw_, |
| 64 | fsubr_, fconst, fucompp, __BAD__, fsub_i, fucomp, fsubp_, __BAD__, |
| 65 | fdiv__, FPU_triga, __BAD__, __BAD__, fdivri, __BAD__, fdivrp, __BAD__, |
| 66 | fdivr_, FPU_trigb, __BAD__, __BAD__, fdiv_i, __BAD__, fdivp_, __BAD__, |
| 67 | }; |
| 68 | |
| 69 | #else /* Support only documented FPU op-codes */ |
| 70 | |
| 71 | static FUNC const st_instr_table[64] = { |
| 72 | fadd__, fld_i_, __BAD__, __BAD__, fadd_i, ffree_, faddp_, __BAD__, |
| 73 | fmul__, fxch_i, __BAD__, __BAD__, fmul_i, __BAD__, fmulp_, __BAD__, |
| 74 | fcom_st, fp_nop, __BAD__, __BAD__, __BAD__, fst_i_, __BAD__, __BAD__, |
| 75 | fcompst, __BAD__, __BAD__, __BAD__, __BAD__, fstp_i, fcompp, __BAD__, |
| 76 | fsub__, FPU_etc, __BAD__, finit_, fsubri, fucom_, fsubrp, fstsw_, |
| 77 | fsubr_, fconst, fucompp, __BAD__, fsub_i, fucomp, fsubp_, __BAD__, |
| 78 | fdiv__, FPU_triga, __BAD__, __BAD__, fdivri, __BAD__, fdivrp, __BAD__, |
| 79 | fdivr_, FPU_trigb, __BAD__, __BAD__, fdiv_i, __BAD__, fdivp_, __BAD__, |
| 80 | }; |
| 81 | |
| 82 | #endif /* NO_UNDOC_CODE */ |
| 83 | |
| 84 | |
| 85 | #define _NONE_ 0 /* Take no special action */ |
| 86 | #define _REG0_ 1 /* Need to check for not empty st(0) */ |
| 87 | #define _REGI_ 2 /* Need to check for not empty st(0) and st(rm) */ |
| 88 | #define _REGi_ 0 /* Uses st(rm) */ |
| 89 | #define _PUSH_ 3 /* Need to check for space to push onto stack */ |
| 90 | #define _null_ 4 /* Function illegal or not implemented */ |
| 91 | #define _REGIi 5 /* Uses st(0) and st(rm), result to st(rm) */ |
| 92 | #define _REGIp 6 /* Uses st(0) and st(rm), result to st(rm) then pop */ |
| 93 | #define _REGIc 0 /* Compare st(0) and st(rm) */ |
| 94 | #define _REGIn 0 /* Uses st(0) and st(rm), but handle checks later */ |
| 95 | |
| 96 | #ifndef NO_UNDOC_CODE |
| 97 | |
| 98 | /* Un-documented FPU op-codes supported by default. (see above) */ |
| 99 | |
| 100 | static u_char const type_table[64] = { |
| 101 | _REGI_, _NONE_, _null_, _null_, _REGIi, _REGi_, _REGIp, _REGi_, |
| 102 | _REGI_, _REGIn, _null_, _null_, _REGIi, _REGI_, _REGIp, _REGI_, |
| 103 | _REGIc, _NONE_, _null_, _null_, _REGIc, _REG0_, _REGIc, _REG0_, |
| 104 | _REGIc, _REG0_, _null_, _null_, _REGIc, _REG0_, _REGIc, _REG0_, |
| 105 | _REGI_, _NONE_, _null_, _NONE_, _REGIi, _REGIc, _REGIp, _NONE_, |
| 106 | _REGI_, _NONE_, _REGIc, _null_, _REGIi, _REGIc, _REGIp, _null_, |
| 107 | _REGI_, _NONE_, _null_, _null_, _REGIi, _null_, _REGIp, _null_, |
| 108 | _REGI_, _NONE_, _null_, _null_, _REGIi, _null_, _REGIp, _null_ |
| 109 | }; |
| 110 | |
| 111 | #else /* Support only documented FPU op-codes */ |
| 112 | |
| 113 | static u_char const type_table[64] = { |
| 114 | _REGI_, _NONE_, _null_, _null_, _REGIi, _REGi_, _REGIp, _null_, |
| 115 | _REGI_, _REGIn, _null_, _null_, _REGIi, _null_, _REGIp, _null_, |
| 116 | _REGIc, _NONE_, _null_, _null_, _null_, _REG0_, _null_, _null_, |
| 117 | _REGIc, _null_, _null_, _null_, _null_, _REG0_, _REGIc, _null_, |
| 118 | _REGI_, _NONE_, _null_, _NONE_, _REGIi, _REGIc, _REGIp, _NONE_, |
| 119 | _REGI_, _NONE_, _REGIc, _null_, _REGIi, _REGIc, _REGIp, _null_, |
| 120 | _REGI_, _NONE_, _null_, _null_, _REGIi, _null_, _REGIp, _null_, |
| 121 | _REGI_, _NONE_, _null_, _null_, _REGIi, _null_, _REGIp, _null_ |
| 122 | }; |
| 123 | |
| 124 | #endif /* NO_UNDOC_CODE */ |
| 125 | |
| 126 | |
| 127 | #ifdef RE_ENTRANT_CHECKING |
| 128 | u_char emulating=0; |
| 129 | #endif /* RE_ENTRANT_CHECKING */ |
| 130 | |
| 131 | static int valid_prefix(u_char *Byte, u_char __user **fpu_eip, |
| 132 | overrides *override); |
| 133 | |
| 134 | asmlinkage void math_emulate(long arg) |
| 135 | { |
| 136 | u_char FPU_modrm, byte1; |
| 137 | unsigned short code; |
| 138 | fpu_addr_modes addr_modes; |
| 139 | int unmasked; |
| 140 | FPU_REG loaded_data; |
| 141 | FPU_REG *st0_ptr; |
| 142 | u_char loaded_tag, st0_tag; |
| 143 | void __user *data_address; |
| 144 | struct address data_sel_off; |
| 145 | struct address entry_sel_off; |
| 146 | unsigned long code_base = 0; |
| 147 | unsigned long code_limit = 0; /* Initialized to stop compiler warnings */ |
| 148 | struct desc_struct code_descriptor; |
| 149 | |
| 150 | #ifdef RE_ENTRANT_CHECKING |
| 151 | if ( emulating ) |
| 152 | { |
| 153 | printk("ERROR: wm-FPU-emu is not RE-ENTRANT!\n"); |
| 154 | } |
| 155 | RE_ENTRANT_CHECK_ON; |
| 156 | #endif /* RE_ENTRANT_CHECKING */ |
| 157 | |
| 158 | if (!used_math()) |
| 159 | { |
| 160 | finit(); |
| 161 | set_used_math(); |
| 162 | } |
| 163 | |
| 164 | SETUP_DATA_AREA(arg); |
| 165 | |
| 166 | FPU_ORIG_EIP = FPU_EIP; |
| 167 | |
| 168 | if ( (FPU_EFLAGS & 0x00020000) != 0 ) |
| 169 | { |
| 170 | /* Virtual 8086 mode */ |
| 171 | addr_modes.default_mode = VM86; |
| 172 | FPU_EIP += code_base = FPU_CS << 4; |
| 173 | code_limit = code_base + 0xffff; /* Assumes code_base <= 0xffff0000 */ |
| 174 | } |
| 175 | else if ( FPU_CS == __USER_CS && FPU_DS == __USER_DS ) |
| 176 | { |
| 177 | addr_modes.default_mode = 0; |
| 178 | } |
| 179 | else if ( FPU_CS == __KERNEL_CS ) |
| 180 | { |
| 181 | printk("math_emulate: %04x:%08lx\n",FPU_CS,FPU_EIP); |
| 182 | panic("Math emulation needed in kernel"); |
| 183 | } |
| 184 | else |
| 185 | { |
| 186 | |
| 187 | if ( (FPU_CS & 4) != 4 ) /* Must be in the LDT */ |
| 188 | { |
| 189 | /* Can only handle segmented addressing via the LDT |
| 190 | for now, and it must be 16 bit */ |
| 191 | printk("FPU emulator: Unsupported addressing mode\n"); |
| 192 | math_abort(FPU_info, SIGILL); |
| 193 | } |
| 194 | |
| 195 | code_descriptor = LDT_DESCRIPTOR(FPU_CS); |
| 196 | if ( SEG_D_SIZE(code_descriptor) ) |
| 197 | { |
| 198 | /* The above test may be wrong, the book is not clear */ |
| 199 | /* Segmented 32 bit protected mode */ |
| 200 | addr_modes.default_mode = SEG32; |
| 201 | } |
| 202 | else |
| 203 | { |
| 204 | /* 16 bit protected mode */ |
| 205 | addr_modes.default_mode = PM16; |
| 206 | } |
| 207 | FPU_EIP += code_base = SEG_BASE_ADDR(code_descriptor); |
| 208 | code_limit = code_base |
| 209 | + (SEG_LIMIT(code_descriptor)+1) * SEG_GRANULARITY(code_descriptor) |
| 210 | - 1; |
| 211 | if ( code_limit < code_base ) code_limit = 0xffffffff; |
| 212 | } |
| 213 | |
| 214 | FPU_lookahead = 1; |
| 215 | if (current->ptrace & PT_PTRACED) |
| 216 | FPU_lookahead = 0; |
| 217 | |
| 218 | if ( !valid_prefix(&byte1, (u_char __user **)&FPU_EIP, |
| 219 | &addr_modes.override) ) |
| 220 | { |
| 221 | RE_ENTRANT_CHECK_OFF; |
| 222 | printk("FPU emulator: Unknown prefix byte 0x%02x, probably due to\n" |
| 223 | "FPU emulator: self-modifying code! (emulation impossible)\n", |
| 224 | byte1); |
| 225 | RE_ENTRANT_CHECK_ON; |
| 226 | EXCEPTION(EX_INTERNAL|0x126); |
| 227 | math_abort(FPU_info,SIGILL); |
| 228 | } |
| 229 | |
| 230 | do_another_FPU_instruction: |
| 231 | |
| 232 | no_ip_update = 0; |
| 233 | |
| 234 | FPU_EIP++; /* We have fetched the prefix and first code bytes. */ |
| 235 | |
| 236 | if ( addr_modes.default_mode ) |
| 237 | { |
| 238 | /* This checks for the minimum instruction bytes. |
| 239 | We also need to check any extra (address mode) code access. */ |
| 240 | if ( FPU_EIP > code_limit ) |
| 241 | math_abort(FPU_info,SIGSEGV); |
| 242 | } |
| 243 | |
| 244 | if ( (byte1 & 0xf8) != 0xd8 ) |
| 245 | { |
| 246 | if ( byte1 == FWAIT_OPCODE ) |
| 247 | { |
| 248 | if (partial_status & SW_Summary) |
| 249 | goto do_the_FPU_interrupt; |
| 250 | else |
| 251 | goto FPU_fwait_done; |
| 252 | } |
| 253 | #ifdef PARANOID |
| 254 | EXCEPTION(EX_INTERNAL|0x128); |
| 255 | math_abort(FPU_info,SIGILL); |
| 256 | #endif /* PARANOID */ |
| 257 | } |
| 258 | |
| 259 | RE_ENTRANT_CHECK_OFF; |
| 260 | FPU_code_access_ok(1); |
| 261 | FPU_get_user(FPU_modrm, (u_char __user *) FPU_EIP); |
| 262 | RE_ENTRANT_CHECK_ON; |
| 263 | FPU_EIP++; |
| 264 | |
| 265 | if (partial_status & SW_Summary) |
| 266 | { |
| 267 | /* Ignore the error for now if the current instruction is a no-wait |
| 268 | control instruction */ |
| 269 | /* The 80486 manual contradicts itself on this topic, |
| 270 | but a real 80486 uses the following instructions: |
| 271 | fninit, fnstenv, fnsave, fnstsw, fnstenv, fnclex. |
| 272 | */ |
| 273 | code = (FPU_modrm << 8) | byte1; |
| 274 | if ( ! ( (((code & 0xf803) == 0xe003) || /* fnclex, fninit, fnstsw */ |
| 275 | (((code & 0x3003) == 0x3001) && /* fnsave, fnstcw, fnstenv, |
| 276 | fnstsw */ |
| 277 | ((code & 0xc000) != 0xc000))) ) ) |
| 278 | { |
| 279 | /* |
| 280 | * We need to simulate the action of the kernel to FPU |
| 281 | * interrupts here. |
| 282 | */ |
| 283 | do_the_FPU_interrupt: |
| 284 | |
| 285 | FPU_EIP = FPU_ORIG_EIP; /* Point to current FPU instruction. */ |
| 286 | |
| 287 | RE_ENTRANT_CHECK_OFF; |
| 288 | current->thread.trap_no = 16; |
| 289 | current->thread.error_code = 0; |
| 290 | send_sig(SIGFPE, current, 1); |
| 291 | return; |
| 292 | } |
| 293 | } |
| 294 | |
| 295 | entry_sel_off.offset = FPU_ORIG_EIP; |
| 296 | entry_sel_off.selector = FPU_CS; |
| 297 | entry_sel_off.opcode = (byte1 << 8) | FPU_modrm; |
| 298 | |
| 299 | FPU_rm = FPU_modrm & 7; |
| 300 | |
| 301 | if ( FPU_modrm < 0300 ) |
| 302 | { |
| 303 | /* All of these instructions use the mod/rm byte to get a data address */ |
| 304 | |
| 305 | if ( (addr_modes.default_mode & SIXTEEN) |
| 306 | ^ (addr_modes.override.address_size == ADDR_SIZE_PREFIX) ) |
| 307 | data_address = FPU_get_address_16(FPU_modrm, &FPU_EIP, &data_sel_off, |
| 308 | addr_modes); |
| 309 | else |
| 310 | data_address = FPU_get_address(FPU_modrm, &FPU_EIP, &data_sel_off, |
| 311 | addr_modes); |
| 312 | |
| 313 | if ( addr_modes.default_mode ) |
| 314 | { |
| 315 | if ( FPU_EIP-1 > code_limit ) |
| 316 | math_abort(FPU_info,SIGSEGV); |
| 317 | } |
| 318 | |
| 319 | if ( !(byte1 & 1) ) |
| 320 | { |
| 321 | unsigned short status1 = partial_status; |
| 322 | |
| 323 | st0_ptr = &st(0); |
| 324 | st0_tag = FPU_gettag0(); |
| 325 | |
| 326 | /* Stack underflow has priority */ |
| 327 | if ( NOT_EMPTY_ST0 ) |
| 328 | { |
| 329 | if ( addr_modes.default_mode & PROTECTED ) |
| 330 | { |
| 331 | /* This table works for 16 and 32 bit protected mode */ |
| 332 | if ( access_limit < data_sizes_16[(byte1 >> 1) & 3] ) |
| 333 | math_abort(FPU_info,SIGSEGV); |
| 334 | } |
| 335 | |
| 336 | unmasked = 0; /* Do this here to stop compiler warnings. */ |
| 337 | switch ( (byte1 >> 1) & 3 ) |
| 338 | { |
| 339 | case 0: |
| 340 | unmasked = FPU_load_single((float __user *)data_address, |
| 341 | &loaded_data); |
| 342 | loaded_tag = unmasked & 0xff; |
| 343 | unmasked &= ~0xff; |
| 344 | break; |
| 345 | case 1: |
| 346 | loaded_tag = FPU_load_int32((long __user *)data_address, &loaded_data); |
| 347 | break; |
| 348 | case 2: |
| 349 | unmasked = FPU_load_double((double __user *)data_address, |
| 350 | &loaded_data); |
| 351 | loaded_tag = unmasked & 0xff; |
| 352 | unmasked &= ~0xff; |
| 353 | break; |
| 354 | case 3: |
| 355 | default: /* Used here to suppress gcc warnings. */ |
| 356 | loaded_tag = FPU_load_int16((short __user *)data_address, &loaded_data); |
| 357 | break; |
| 358 | } |
| 359 | |
| 360 | /* No more access to user memory, it is safe |
| 361 | to use static data now */ |
| 362 | |
| 363 | /* NaN operands have the next priority. */ |
| 364 | /* We have to delay looking at st(0) until after |
| 365 | loading the data, because that data might contain an SNaN */ |
| 366 | if ( ((st0_tag == TAG_Special) && isNaN(st0_ptr)) || |
| 367 | ((loaded_tag == TAG_Special) && isNaN(&loaded_data)) ) |
| 368 | { |
| 369 | /* Restore the status word; we might have loaded a |
| 370 | denormal. */ |
| 371 | partial_status = status1; |
| 372 | if ( (FPU_modrm & 0x30) == 0x10 ) |
| 373 | { |
| 374 | /* fcom or fcomp */ |
| 375 | EXCEPTION(EX_Invalid); |
| 376 | setcc(SW_C3 | SW_C2 | SW_C0); |
| 377 | if ( (FPU_modrm & 0x08) && (control_word & CW_Invalid) ) |
| 378 | FPU_pop(); /* fcomp, masked, so we pop. */ |
| 379 | } |
| 380 | else |
| 381 | { |
| 382 | if ( loaded_tag == TAG_Special ) |
| 383 | loaded_tag = FPU_Special(&loaded_data); |
| 384 | #ifdef PECULIAR_486 |
| 385 | /* This is not really needed, but gives behaviour |
| 386 | identical to an 80486 */ |
| 387 | if ( (FPU_modrm & 0x28) == 0x20 ) |
| 388 | /* fdiv or fsub */ |
| 389 | real_2op_NaN(&loaded_data, loaded_tag, 0, &loaded_data); |
| 390 | else |
| 391 | #endif /* PECULIAR_486 */ |
| 392 | /* fadd, fdivr, fmul, or fsubr */ |
| 393 | real_2op_NaN(&loaded_data, loaded_tag, 0, st0_ptr); |
| 394 | } |
| 395 | goto reg_mem_instr_done; |
| 396 | } |
| 397 | |
| 398 | if ( unmasked && !((FPU_modrm & 0x30) == 0x10) ) |
| 399 | { |
| 400 | /* Is not a comparison instruction. */ |
| 401 | if ( (FPU_modrm & 0x38) == 0x38 ) |
| 402 | { |
| 403 | /* fdivr */ |
| 404 | if ( (st0_tag == TAG_Zero) && |
| 405 | ((loaded_tag == TAG_Valid) |
| 406 | || (loaded_tag == TAG_Special |
| 407 | && isdenormal(&loaded_data))) ) |
| 408 | { |
| 409 | if ( FPU_divide_by_zero(0, getsign(&loaded_data)) |
| 410 | < 0 ) |
| 411 | { |
| 412 | /* We use the fact here that the unmasked |
| 413 | exception in the loaded data was for a |
| 414 | denormal operand */ |
| 415 | /* Restore the state of the denormal op bit */ |
| 416 | partial_status &= ~SW_Denorm_Op; |
| 417 | partial_status |= status1 & SW_Denorm_Op; |
| 418 | } |
| 419 | else |
| 420 | setsign(st0_ptr, getsign(&loaded_data)); |
| 421 | } |
| 422 | } |
| 423 | goto reg_mem_instr_done; |
| 424 | } |
| 425 | |
| 426 | switch ( (FPU_modrm >> 3) & 7 ) |
| 427 | { |
| 428 | case 0: /* fadd */ |
| 429 | clear_C1(); |
| 430 | FPU_add(&loaded_data, loaded_tag, 0, control_word); |
| 431 | break; |
| 432 | case 1: /* fmul */ |
| 433 | clear_C1(); |
| 434 | FPU_mul(&loaded_data, loaded_tag, 0, control_word); |
| 435 | break; |
| 436 | case 2: /* fcom */ |
| 437 | FPU_compare_st_data(&loaded_data, loaded_tag); |
| 438 | break; |
| 439 | case 3: /* fcomp */ |
| 440 | if ( !FPU_compare_st_data(&loaded_data, loaded_tag) |
| 441 | && !unmasked ) |
| 442 | FPU_pop(); |
| 443 | break; |
| 444 | case 4: /* fsub */ |
| 445 | clear_C1(); |
| 446 | FPU_sub(LOADED|loaded_tag, (int)&loaded_data, control_word); |
| 447 | break; |
| 448 | case 5: /* fsubr */ |
| 449 | clear_C1(); |
| 450 | FPU_sub(REV|LOADED|loaded_tag, (int)&loaded_data, control_word); |
| 451 | break; |
| 452 | case 6: /* fdiv */ |
| 453 | clear_C1(); |
| 454 | FPU_div(LOADED|loaded_tag, (int)&loaded_data, control_word); |
| 455 | break; |
| 456 | case 7: /* fdivr */ |
| 457 | clear_C1(); |
| 458 | if ( st0_tag == TAG_Zero ) |
| 459 | partial_status = status1; /* Undo any denorm tag, |
| 460 | zero-divide has priority. */ |
| 461 | FPU_div(REV|LOADED|loaded_tag, (int)&loaded_data, control_word); |
| 462 | break; |
| 463 | } |
| 464 | } |
| 465 | else |
| 466 | { |
| 467 | if ( (FPU_modrm & 0x30) == 0x10 ) |
| 468 | { |
| 469 | /* The instruction is fcom or fcomp */ |
| 470 | EXCEPTION(EX_StackUnder); |
| 471 | setcc(SW_C3 | SW_C2 | SW_C0); |
| 472 | if ( (FPU_modrm & 0x08) && (control_word & CW_Invalid) ) |
| 473 | FPU_pop(); /* fcomp */ |
| 474 | } |
| 475 | else |
| 476 | FPU_stack_underflow(); |
| 477 | } |
| 478 | reg_mem_instr_done: |
| 479 | operand_address = data_sel_off; |
| 480 | } |
| 481 | else |
| 482 | { |
| 483 | if ( !(no_ip_update = |
| 484 | FPU_load_store(((FPU_modrm & 0x38) | (byte1 & 6)) >> 1, |
| 485 | addr_modes, data_address)) ) |
| 486 | { |
| 487 | operand_address = data_sel_off; |
| 488 | } |
| 489 | } |
| 490 | |
| 491 | } |
| 492 | else |
| 493 | { |
| 494 | /* None of these instructions access user memory */ |
| 495 | u_char instr_index = (FPU_modrm & 0x38) | (byte1 & 7); |
| 496 | |
| 497 | #ifdef PECULIAR_486 |
| 498 | /* This is supposed to be undefined, but a real 80486 seems |
| 499 | to do this: */ |
| 500 | operand_address.offset = 0; |
| 501 | operand_address.selector = FPU_DS; |
| 502 | #endif /* PECULIAR_486 */ |
| 503 | |
| 504 | st0_ptr = &st(0); |
| 505 | st0_tag = FPU_gettag0(); |
| 506 | switch ( type_table[(int) instr_index] ) |
| 507 | { |
| 508 | case _NONE_: /* also _REGIc: _REGIn */ |
| 509 | break; |
| 510 | case _REG0_: |
| 511 | if ( !NOT_EMPTY_ST0 ) |
| 512 | { |
| 513 | FPU_stack_underflow(); |
| 514 | goto FPU_instruction_done; |
| 515 | } |
| 516 | break; |
| 517 | case _REGIi: |
| 518 | if ( !NOT_EMPTY_ST0 || !NOT_EMPTY(FPU_rm) ) |
| 519 | { |
| 520 | FPU_stack_underflow_i(FPU_rm); |
| 521 | goto FPU_instruction_done; |
| 522 | } |
| 523 | break; |
| 524 | case _REGIp: |
| 525 | if ( !NOT_EMPTY_ST0 || !NOT_EMPTY(FPU_rm) ) |
| 526 | { |
| 527 | FPU_stack_underflow_pop(FPU_rm); |
| 528 | goto FPU_instruction_done; |
| 529 | } |
| 530 | break; |
| 531 | case _REGI_: |
| 532 | if ( !NOT_EMPTY_ST0 || !NOT_EMPTY(FPU_rm) ) |
| 533 | { |
| 534 | FPU_stack_underflow(); |
| 535 | goto FPU_instruction_done; |
| 536 | } |
| 537 | break; |
| 538 | case _PUSH_: /* Only used by the fld st(i) instruction */ |
| 539 | break; |
| 540 | case _null_: |
| 541 | FPU_illegal(); |
| 542 | goto FPU_instruction_done; |
| 543 | default: |
| 544 | EXCEPTION(EX_INTERNAL|0x111); |
| 545 | goto FPU_instruction_done; |
| 546 | } |
| 547 | (*st_instr_table[(int) instr_index])(); |
| 548 | |
| 549 | FPU_instruction_done: |
| 550 | ; |
| 551 | } |
| 552 | |
| 553 | if ( ! no_ip_update ) |
| 554 | instruction_address = entry_sel_off; |
| 555 | |
| 556 | FPU_fwait_done: |
| 557 | |
| 558 | #ifdef DEBUG |
| 559 | RE_ENTRANT_CHECK_OFF; |
| 560 | FPU_printall(); |
| 561 | RE_ENTRANT_CHECK_ON; |
| 562 | #endif /* DEBUG */ |
| 563 | |
| 564 | if (FPU_lookahead && !need_resched()) |
| 565 | { |
| 566 | FPU_ORIG_EIP = FPU_EIP - code_base; |
| 567 | if ( valid_prefix(&byte1, (u_char __user **)&FPU_EIP, |
| 568 | &addr_modes.override) ) |
| 569 | goto do_another_FPU_instruction; |
| 570 | } |
| 571 | |
| 572 | if ( addr_modes.default_mode ) |
| 573 | FPU_EIP -= code_base; |
| 574 | |
| 575 | RE_ENTRANT_CHECK_OFF; |
| 576 | } |
| 577 | |
| 578 | |
| 579 | /* Support for prefix bytes is not yet complete. To properly handle |
| 580 | all prefix bytes, further changes are needed in the emulator code |
| 581 | which accesses user address space. Access to separate segments is |
| 582 | important for msdos emulation. */ |
| 583 | static int valid_prefix(u_char *Byte, u_char __user **fpu_eip, |
| 584 | overrides *override) |
| 585 | { |
| 586 | u_char byte; |
| 587 | u_char __user *ip = *fpu_eip; |
| 588 | |
| 589 | *override = (overrides) { 0, 0, PREFIX_DEFAULT }; /* defaults */ |
| 590 | |
| 591 | RE_ENTRANT_CHECK_OFF; |
| 592 | FPU_code_access_ok(1); |
| 593 | FPU_get_user(byte, ip); |
| 594 | RE_ENTRANT_CHECK_ON; |
| 595 | |
| 596 | while ( 1 ) |
| 597 | { |
| 598 | switch ( byte ) |
| 599 | { |
| 600 | case ADDR_SIZE_PREFIX: |
| 601 | override->address_size = ADDR_SIZE_PREFIX; |
| 602 | goto do_next_byte; |
| 603 | |
| 604 | case OP_SIZE_PREFIX: |
| 605 | override->operand_size = OP_SIZE_PREFIX; |
| 606 | goto do_next_byte; |
| 607 | |
| 608 | case PREFIX_CS: |
| 609 | override->segment = PREFIX_CS_; |
| 610 | goto do_next_byte; |
| 611 | case PREFIX_ES: |
| 612 | override->segment = PREFIX_ES_; |
| 613 | goto do_next_byte; |
| 614 | case PREFIX_SS: |
| 615 | override->segment = PREFIX_SS_; |
| 616 | goto do_next_byte; |
| 617 | case PREFIX_FS: |
| 618 | override->segment = PREFIX_FS_; |
| 619 | goto do_next_byte; |
| 620 | case PREFIX_GS: |
| 621 | override->segment = PREFIX_GS_; |
| 622 | goto do_next_byte; |
| 623 | case PREFIX_DS: |
| 624 | override->segment = PREFIX_DS_; |
| 625 | goto do_next_byte; |
| 626 | |
| 627 | /* lock is not a valid prefix for FPU instructions, |
| 628 | let the cpu handle it to generate a SIGILL. */ |
| 629 | /* case PREFIX_LOCK: */ |
| 630 | |
| 631 | /* rep.. prefixes have no meaning for FPU instructions */ |
| 632 | case PREFIX_REPE: |
| 633 | case PREFIX_REPNE: |
| 634 | |
| 635 | do_next_byte: |
| 636 | ip++; |
| 637 | RE_ENTRANT_CHECK_OFF; |
| 638 | FPU_code_access_ok(1); |
| 639 | FPU_get_user(byte, ip); |
| 640 | RE_ENTRANT_CHECK_ON; |
| 641 | break; |
| 642 | case FWAIT_OPCODE: |
| 643 | *Byte = byte; |
| 644 | return 1; |
| 645 | default: |
| 646 | if ( (byte & 0xf8) == 0xd8 ) |
| 647 | { |
| 648 | *Byte = byte; |
| 649 | *fpu_eip = ip; |
| 650 | return 1; |
| 651 | } |
| 652 | else |
| 653 | { |
| 654 | /* Not a valid sequence of prefix bytes followed by |
| 655 | an FPU instruction. */ |
| 656 | *Byte = byte; /* Needed for error message. */ |
| 657 | return 0; |
| 658 | } |
| 659 | } |
| 660 | } |
| 661 | } |
| 662 | |
| 663 | |
| 664 | void math_abort(struct info * info, unsigned int signal) |
| 665 | { |
| 666 | FPU_EIP = FPU_ORIG_EIP; |
| 667 | current->thread.trap_no = 16; |
| 668 | current->thread.error_code = 0; |
| 669 | send_sig(signal,current,1); |
| 670 | RE_ENTRANT_CHECK_OFF; |
| 671 | __asm__("movl %0,%%esp ; ret": :"g" (((long) info)-4)); |
| 672 | #ifdef PARANOID |
| 673 | printk("ERROR: wm-FPU-emu math_abort failed!\n"); |
| 674 | #endif /* PARANOID */ |
| 675 | } |
| 676 | |
| 677 | |
| 678 | |
| 679 | #define S387 ((struct i387_soft_struct *)s387) |
| 680 | #define sstatus_word() \ |
| 681 | ((S387->swd & ~SW_Top & 0xffff) | ((S387->ftop << SW_Top_Shift) & SW_Top)) |
| 682 | |
| 683 | int restore_i387_soft(void *s387, struct _fpstate __user *buf) |
| 684 | { |
| 685 | u_char __user *d = (u_char __user *)buf; |
| 686 | int offset, other, i, tags, regnr, tag, newtop; |
| 687 | |
| 688 | RE_ENTRANT_CHECK_OFF; |
| 689 | FPU_access_ok(VERIFY_READ, d, 7*4 + 8*10); |
| 690 | if (__copy_from_user(&S387->cwd, d, 7*4)) |
| 691 | return -1; |
| 692 | RE_ENTRANT_CHECK_ON; |
| 693 | |
| 694 | d += 7*4; |
| 695 | |
| 696 | S387->ftop = (S387->swd >> SW_Top_Shift) & 7; |
| 697 | offset = (S387->ftop & 7) * 10; |
| 698 | other = 80 - offset; |
| 699 | |
| 700 | RE_ENTRANT_CHECK_OFF; |
| 701 | /* Copy all registers in stack order. */ |
| 702 | if (__copy_from_user(((u_char *)&S387->st_space)+offset, d, other)) |
| 703 | return -1; |
| 704 | if ( offset ) |
| 705 | if (__copy_from_user((u_char *)&S387->st_space, d+other, offset)) |
| 706 | return -1; |
| 707 | RE_ENTRANT_CHECK_ON; |
| 708 | |
| 709 | /* The tags may need to be corrected now. */ |
| 710 | tags = S387->twd; |
| 711 | newtop = S387->ftop; |
| 712 | for ( i = 0; i < 8; i++ ) |
| 713 | { |
| 714 | regnr = (i+newtop) & 7; |
| 715 | if ( ((tags >> ((regnr & 7)*2)) & 3) != TAG_Empty ) |
| 716 | { |
| 717 | /* The loaded data over-rides all other cases. */ |
| 718 | tag = FPU_tagof((FPU_REG *)((u_char *)S387->st_space + 10*regnr)); |
| 719 | tags &= ~(3 << (regnr*2)); |
| 720 | tags |= (tag & 3) << (regnr*2); |
| 721 | } |
| 722 | } |
| 723 | S387->twd = tags; |
| 724 | |
| 725 | return 0; |
| 726 | } |
| 727 | |
| 728 | |
| 729 | int save_i387_soft(void *s387, struct _fpstate __user * buf) |
| 730 | { |
| 731 | u_char __user *d = (u_char __user *)buf; |
| 732 | int offset = (S387->ftop & 7) * 10, other = 80 - offset; |
| 733 | |
| 734 | RE_ENTRANT_CHECK_OFF; |
| 735 | FPU_access_ok(VERIFY_WRITE, d, 7*4 + 8*10); |
| 736 | #ifdef PECULIAR_486 |
| 737 | S387->cwd &= ~0xe080; |
| 738 | /* An 80486 sets nearly all of the reserved bits to 1. */ |
| 739 | S387->cwd |= 0xffff0040; |
| 740 | S387->swd = sstatus_word() | 0xffff0000; |
| 741 | S387->twd |= 0xffff0000; |
| 742 | S387->fcs &= ~0xf8000000; |
| 743 | S387->fos |= 0xffff0000; |
| 744 | #endif /* PECULIAR_486 */ |
| 745 | __copy_to_user(d, &S387->cwd, 7*4); |
| 746 | RE_ENTRANT_CHECK_ON; |
| 747 | |
| 748 | d += 7*4; |
| 749 | |
| 750 | RE_ENTRANT_CHECK_OFF; |
| 751 | /* Copy all registers in stack order. */ |
| 752 | if (__copy_to_user(d, ((u_char *)&S387->st_space)+offset, other)) |
| 753 | return -1; |
| 754 | if ( offset ) |
| 755 | if (__copy_to_user(d+other, (u_char *)&S387->st_space, offset)) |
| 756 | return -1 |
| 757 | RE_ENTRANT_CHECK_ON; |
| 758 | |
| 759 | return 1; |
| 760 | } |