1 /* 2 * Linux/PA-RISC Project (http://www.parisc-linux.org/) 3 * 4 * Floating-point emulation code 5 * Copyright (C) 2001 Hewlett-Packard (Paul Bame) <bame@debian.org> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License as published by 9 * the Free Software Foundation; either version 2, or (at your option) 10 * any later version. 11 * 12 * This program is distributed in the hope that it will be useful, 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 * GNU General Public License for more details. 16 * 17 * You should have received a copy of the GNU General Public License 18 * along with this program; if not, write to the Free Software 19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 20 */ 21 /* 22 * BEGIN_DESC 23 * 24 * File: 25 * @(#) pa/fp/fpudispatch.c $Revision: 1.1 $ 26 * 27 * Purpose: 28 * <<please update with a synopsis of the functionality provided by this file>> 29 * 30 * External Interfaces: 31 * <<the following list was autogenerated, please review>> 32 * emfpudispatch(ir, dummy1, dummy2, fpregs) 33 * fpudispatch(ir, excp_code, holder, fpregs) 34 * 35 * Internal Interfaces: 36 * <<the following list was autogenerated, please review>> 37 * static u_int decode_06(u_int, u_int *) 38 * static u_int decode_0c(u_int, u_int, u_int, u_int *) 39 * static u_int decode_0e(u_int, u_int, u_int, u_int *) 40 * static u_int decode_26(u_int, u_int *) 41 * static u_int decode_2e(u_int, u_int *) 42 * static void update_status_cbit(u_int *, u_int, u_int, u_int) 43 * 44 * Theory: 45 * <<please update with a overview of the operation of this file>> 46 * 47 * END_DESC 48 */ 49 50 #define FPUDEBUG 0 51 52 #include "float.h" 53 #include <linux/kernel.h> 54 #include <asm/processor.h> 55 /* #include <sys/debug.h> */ 56 /* #include <machine/sys/mdep_private.h> */ 57 58 #define COPR_INST 0x30000000 59 60 /* 61 * definition of extru macro. If pos and len are constants, the compiler 62 * will generate an extru instruction when optimized 63 */ 64 #define extru(r,pos,len) (((r) >> (31-(pos))) & (( 1 << (len)) - 1)) 65 /* definitions of bit field locations in the instruction */ 66 #define fpmajorpos 5 67 #define fpr1pos 10 68 #define fpr2pos 15 69 #define fptpos 31 70 #define fpsubpos 18 71 #define fpclass1subpos 16 72 #define fpclasspos 22 73 #define fpfmtpos 20 74 #define fpdfpos 18 75 #define fpnulpos 26 76 /* 77 * the following are the extra bits for the 0E major op 78 */ 79 #define fpxr1pos 24 80 #define fpxr2pos 19 81 #define fpxtpos 25 82 #define fpxpos 23 83 #define fp0efmtpos 20 84 /* 85 * the following are for the multi-ops 86 */ 87 #define fprm1pos 10 88 #define fprm2pos 15 89 #define fptmpos 31 90 #define fprapos 25 91 #define fptapos 20 92 #define fpmultifmt 26 93 /* 94 * the following are for the fused FP instructions 95 */ 96 /* fprm1pos 10 */ 97 /* fprm2pos 15 */ 98 #define fpraupos 18 99 #define fpxrm2pos 19 100 /* fpfmtpos 20 */ 101 #define fpralpos 23 102 #define fpxrm1pos 24 103 /* fpxtpos 25 */ 104 #define fpfusedsubop 26 105 /* fptpos 31 */ 106 107 /* 108 * offset to constant zero in the FP emulation registers 109 */ 110 #define fpzeroreg (32*sizeof(double)/sizeof(u_int)) 111 112 /* 113 * extract the major opcode from the instruction 114 */ 115 #define get_major(op) extru(op,fpmajorpos,6) 116 /* 117 * extract the two bit class field from the FP instruction. The class is at bit 118 * positions 21-22 119 */ 120 #define get_class(op) extru(op,fpclasspos,2) 121 /* 122 * extract the 3 bit subop field. For all but class 1 instructions, it is 123 * located at bit positions 16-18 124 */ 125 #define get_subop(op) extru(op,fpsubpos,3) 126 /* 127 * extract the 2 or 3 bit subop field from class 1 instructions. It is located 128 * at bit positions 15-16 (PA1.1) or 14-16 (PA2.0) 129 */ 130 #define get_subop1_PA1_1(op) extru(op,fpclass1subpos,2) /* PA89 (1.1) fmt */ 131 #define get_subop1_PA2_0(op) extru(op,fpclass1subpos,3) /* PA 2.0 fmt */ 132 133 /* definitions of unimplemented exceptions */ 134 #define MAJOR_0C_EXCP 0x09 135 #define MAJOR_0E_EXCP 0x0b 136 #define MAJOR_06_EXCP 0x03 137 #define MAJOR_26_EXCP 0x23 138 #define MAJOR_2E_EXCP 0x2b 139 #define PA83_UNIMP_EXCP 0x01 140 141 /* 142 * Special Defines for TIMEX specific code 143 */ 144 145 #define FPU_TYPE_FLAG_POS (EM_FPU_TYPE_OFFSET>>2) 146 #define TIMEX_ROLEX_FPU_MASK (TIMEX_EXTEN_FLAG|ROLEX_EXTEN_FLAG) 147 148 /* 149 * Static function definitions 150 */ 151 #define _PROTOTYPES 152 #if defined(_PROTOTYPES) || defined(_lint) 153 static u_int decode_0c(u_int, u_int, u_int, u_int *); 154 static u_int decode_0e(u_int, u_int, u_int, u_int *); 155 static u_int decode_06(u_int, u_int *); 156 static u_int decode_26(u_int, u_int *); 157 static u_int decode_2e(u_int, u_int *); 158 static void update_status_cbit(u_int *, u_int, u_int, u_int); 159 #else /* !_PROTOTYPES&&!_lint */ 160 static u_int decode_0c(); 161 static u_int decode_0e(); 162 static u_int decode_06(); 163 static u_int decode_26(); 164 static u_int decode_2e(); 165 static void update_status_cbit(); 166 #endif /* _PROTOTYPES&&!_lint */ 167 168 #define VASSERT(x) 169 170 static void parisc_linux_get_fpu_type(u_int fpregs[]) 171 { 172 /* on pa-linux the fpu type is not filled in by the 173 * caller; it is constructed here 174 */ 175 if (boot_cpu_data.cpu_type == pcxs) 176 fpregs[FPU_TYPE_FLAG_POS] = TIMEX_EXTEN_FLAG; 177 else if (boot_cpu_data.cpu_type == pcxt || 178 boot_cpu_data.cpu_type == pcxt_) 179 fpregs[FPU_TYPE_FLAG_POS] = ROLEX_EXTEN_FLAG; 180 else if (boot_cpu_data.cpu_type >= pcxu) 181 fpregs[FPU_TYPE_FLAG_POS] = PA2_0_FPU_FLAG; 182 } 183 184 /* 185 * this routine will decode the excepting floating point instruction and 186 * call the approiate emulation routine. 187 * It is called by decode_fpu with the following parameters: 188 * fpudispatch(current_ir, unimplemented_code, 0, &Fpu_register) 189 * where current_ir is the instruction to be emulated, 190 * unimplemented_code is the exception_code that the hardware generated 191 * and &Fpu_register is the address of emulated FP reg 0. 192 */ 193 u_int 194 fpudispatch(u_int ir, u_int excp_code, u_int holder, u_int fpregs[]) 195 { 196 u_int class, subop; 197 u_int fpu_type_flags; 198 199 /* All FP emulation code assumes that ints are 4-bytes in length */ 200 VASSERT(sizeof(int) == 4); 201 202 parisc_linux_get_fpu_type(fpregs); 203 204 fpu_type_flags=fpregs[FPU_TYPE_FLAG_POS]; /* get fpu type flags */ 205 206 class = get_class(ir); 207 if (class == 1) { 208 if (fpu_type_flags & PA2_0_FPU_FLAG) 209 subop = get_subop1_PA2_0(ir); 210 else 211 subop = get_subop1_PA1_1(ir); 212 } 213 else 214 subop = get_subop(ir); 215 216 if (FPUDEBUG) printk("class %d subop %d\n", class, subop); 217 218 switch (excp_code) { 219 case MAJOR_0C_EXCP: 220 case PA83_UNIMP_EXCP: 221 return(decode_0c(ir,class,subop,fpregs)); 222 case MAJOR_0E_EXCP: 223 return(decode_0e(ir,class,subop,fpregs)); 224 case MAJOR_06_EXCP: 225 return(decode_06(ir,fpregs)); 226 case MAJOR_26_EXCP: 227 return(decode_26(ir,fpregs)); 228 case MAJOR_2E_EXCP: 229 return(decode_2e(ir,fpregs)); 230 default: 231 /* "crashme Night Gallery painting nr 2. (asm_crash.s). 232 * This was fixed for multi-user kernels, but 233 * workstation kernels had a panic here. This allowed 234 * any arbitrary user to panic the kernel by executing 235 * setting the FP exception registers to strange values 236 * and generating an emulation trap. The emulation and 237 * exception code must never be able to panic the 238 * kernel. 239 */ 240 return(UNIMPLEMENTEDEXCEPTION); 241 } 242 } 243 244 /* 245 * this routine is called by $emulation_trap to emulate a coprocessor 246 * instruction if one doesn't exist 247 */ 248 u_int 249 emfpudispatch(u_int ir, u_int dummy1, u_int dummy2, u_int fpregs[]) 250 { 251 u_int class, subop, major; 252 u_int fpu_type_flags; 253 254 /* All FP emulation code assumes that ints are 4-bytes in length */ 255 VASSERT(sizeof(int) == 4); 256 257 fpu_type_flags=fpregs[FPU_TYPE_FLAG_POS]; /* get fpu type flags */ 258 259 major = get_major(ir); 260 class = get_class(ir); 261 if (class == 1) { 262 if (fpu_type_flags & PA2_0_FPU_FLAG) 263 subop = get_subop1_PA2_0(ir); 264 else 265 subop = get_subop1_PA1_1(ir); 266 } 267 else 268 subop = get_subop(ir); 269 switch (major) { 270 case 0x0C: 271 return(decode_0c(ir,class,subop,fpregs)); 272 case 0x0E: 273 return(decode_0e(ir,class,subop,fpregs)); 274 case 0x06: 275 return(decode_06(ir,fpregs)); 276 case 0x26: 277 return(decode_26(ir,fpregs)); 278 case 0x2E: 279 return(decode_2e(ir,fpregs)); 280 default: 281 return(PA83_UNIMP_EXCP); 282 } 283 } 284 285 286 static u_int 287 decode_0c(u_int ir, u_int class, u_int subop, u_int fpregs[]) 288 { 289 u_int r1,r2,t; /* operand register offsets */ 290 u_int fmt; /* also sf for class 1 conversions */ 291 u_int df; /* for class 1 conversions */ 292 u_int *status; 293 u_int retval, local_status; 294 u_int fpu_type_flags; 295 296 if (ir == COPR_INST) { 297 fpregs[0] = EMULATION_VERSION << 11; 298 return(NOEXCEPTION); 299 } 300 status = &fpregs[0]; /* fp status register */ 301 local_status = fpregs[0]; /* and local copy */ 302 r1 = extru(ir,fpr1pos,5) * sizeof(double)/sizeof(u_int); 303 if (r1 == 0) /* map fr0 source to constant zero */ 304 r1 = fpzeroreg; 305 t = extru(ir,fptpos,5) * sizeof(double)/sizeof(u_int); 306 if (t == 0 && class != 2) /* don't allow fr0 as a dest */ 307 return(MAJOR_0C_EXCP); 308 fmt = extru(ir,fpfmtpos,2); /* get fmt completer */ 309 310 switch (class) { 311 case 0: 312 switch (subop) { 313 case 0: /* COPR 0,0 emulated above*/ 314 case 1: 315 return(MAJOR_0C_EXCP); 316 case 2: /* FCPY */ 317 switch (fmt) { 318 case 2: /* illegal */ 319 return(MAJOR_0C_EXCP); 320 case 3: /* quad */ 321 t &= ~3; /* force to even reg #s */ 322 r1 &= ~3; 323 fpregs[t+3] = fpregs[r1+3]; 324 fpregs[t+2] = fpregs[r1+2]; 325 case 1: /* double */ 326 fpregs[t+1] = fpregs[r1+1]; 327 case 0: /* single */ 328 fpregs[t] = fpregs[r1]; 329 return(NOEXCEPTION); 330 } 331 case 3: /* FABS */ 332 switch (fmt) { 333 case 2: /* illegal */ 334 return(MAJOR_0C_EXCP); 335 case 3: /* quad */ 336 t &= ~3; /* force to even reg #s */ 337 r1 &= ~3; 338 fpregs[t+3] = fpregs[r1+3]; 339 fpregs[t+2] = fpregs[r1+2]; 340 case 1: /* double */ 341 fpregs[t+1] = fpregs[r1+1]; 342 case 0: /* single */ 343 /* copy and clear sign bit */ 344 fpregs[t] = fpregs[r1] & 0x7fffffff; 345 return(NOEXCEPTION); 346 } 347 case 6: /* FNEG */ 348 switch (fmt) { 349 case 2: /* illegal */ 350 return(MAJOR_0C_EXCP); 351 case 3: /* quad */ 352 t &= ~3; /* force to even reg #s */ 353 r1 &= ~3; 354 fpregs[t+3] = fpregs[r1+3]; 355 fpregs[t+2] = fpregs[r1+2]; 356 case 1: /* double */ 357 fpregs[t+1] = fpregs[r1+1]; 358 case 0: /* single */ 359 /* copy and invert sign bit */ 360 fpregs[t] = fpregs[r1] ^ 0x80000000; 361 return(NOEXCEPTION); 362 } 363 case 7: /* FNEGABS */ 364 switch (fmt) { 365 case 2: /* illegal */ 366 return(MAJOR_0C_EXCP); 367 case 3: /* quad */ 368 t &= ~3; /* force to even reg #s */ 369 r1 &= ~3; 370 fpregs[t+3] = fpregs[r1+3]; 371 fpregs[t+2] = fpregs[r1+2]; 372 case 1: /* double */ 373 fpregs[t+1] = fpregs[r1+1]; 374 case 0: /* single */ 375 /* copy and set sign bit */ 376 fpregs[t] = fpregs[r1] | 0x80000000; 377 return(NOEXCEPTION); 378 } 379 case 4: /* FSQRT */ 380 switch (fmt) { 381 case 0: 382 return(sgl_fsqrt(&fpregs[r1],0, 383 &fpregs[t],status)); 384 case 1: 385 return(dbl_fsqrt(&fpregs[r1],0, 386 &fpregs[t],status)); 387 case 2: 388 case 3: /* quad not implemented */ 389 return(MAJOR_0C_EXCP); 390 } 391 case 5: /* FRND */ 392 switch (fmt) { 393 case 0: 394 return(sgl_frnd(&fpregs[r1],0, 395 &fpregs[t],status)); 396 case 1: 397 return(dbl_frnd(&fpregs[r1],0, 398 &fpregs[t],status)); 399 case 2: 400 case 3: /* quad not implemented */ 401 return(MAJOR_0C_EXCP); 402 } 403 } /* end of switch (subop) */ 404 405 case 1: /* class 1 */ 406 df = extru(ir,fpdfpos,2); /* get dest format */ 407 if ((df & 2) || (fmt & 2)) { 408 /* 409 * fmt's 2 and 3 are illegal of not implemented 410 * quad conversions 411 */ 412 return(MAJOR_0C_EXCP); 413 } 414 /* 415 * encode source and dest formats into 2 bits. 416 * high bit is source, low bit is dest. 417 * bit = 1 --> double precision 418 */ 419 fmt = (fmt << 1) | df; 420 switch (subop) { 421 case 0: /* FCNVFF */ 422 switch(fmt) { 423 case 0: /* sgl/sgl */ 424 return(MAJOR_0C_EXCP); 425 case 1: /* sgl/dbl */ 426 return(sgl_to_dbl_fcnvff(&fpregs[r1],0, 427 &fpregs[t],status)); 428 case 2: /* dbl/sgl */ 429 return(dbl_to_sgl_fcnvff(&fpregs[r1],0, 430 &fpregs[t],status)); 431 case 3: /* dbl/dbl */ 432 return(MAJOR_0C_EXCP); 433 } 434 case 1: /* FCNVXF */ 435 switch(fmt) { 436 case 0: /* sgl/sgl */ 437 return(sgl_to_sgl_fcnvxf(&fpregs[r1],0, 438 &fpregs[t],status)); 439 case 1: /* sgl/dbl */ 440 return(sgl_to_dbl_fcnvxf(&fpregs[r1],0, 441 &fpregs[t],status)); 442 case 2: /* dbl/sgl */ 443 return(dbl_to_sgl_fcnvxf(&fpregs[r1],0, 444 &fpregs[t],status)); 445 case 3: /* dbl/dbl */ 446 return(dbl_to_dbl_fcnvxf(&fpregs[r1],0, 447 &fpregs[t],status)); 448 } 449 case 2: /* FCNVFX */ 450 switch(fmt) { 451 case 0: /* sgl/sgl */ 452 return(sgl_to_sgl_fcnvfx(&fpregs[r1],0, 453 &fpregs[t],status)); 454 case 1: /* sgl/dbl */ 455 return(sgl_to_dbl_fcnvfx(&fpregs[r1],0, 456 &fpregs[t],status)); 457 case 2: /* dbl/sgl */ 458 return(dbl_to_sgl_fcnvfx(&fpregs[r1],0, 459 &fpregs[t],status)); 460 case 3: /* dbl/dbl */ 461 return(dbl_to_dbl_fcnvfx(&fpregs[r1],0, 462 &fpregs[t],status)); 463 } 464 case 3: /* FCNVFXT */ 465 switch(fmt) { 466 case 0: /* sgl/sgl */ 467 return(sgl_to_sgl_fcnvfxt(&fpregs[r1],0, 468 &fpregs[t],status)); 469 case 1: /* sgl/dbl */ 470 return(sgl_to_dbl_fcnvfxt(&fpregs[r1],0, 471 &fpregs[t],status)); 472 case 2: /* dbl/sgl */ 473 return(dbl_to_sgl_fcnvfxt(&fpregs[r1],0, 474 &fpregs[t],status)); 475 case 3: /* dbl/dbl */ 476 return(dbl_to_dbl_fcnvfxt(&fpregs[r1],0, 477 &fpregs[t],status)); 478 } 479 case 5: /* FCNVUF (PA2.0 only) */ 480 switch(fmt) { 481 case 0: /* sgl/sgl */ 482 return(sgl_to_sgl_fcnvuf(&fpregs[r1],0, 483 &fpregs[t],status)); 484 case 1: /* sgl/dbl */ 485 return(sgl_to_dbl_fcnvuf(&fpregs[r1],0, 486 &fpregs[t],status)); 487 case 2: /* dbl/sgl */ 488 return(dbl_to_sgl_fcnvuf(&fpregs[r1],0, 489 &fpregs[t],status)); 490 case 3: /* dbl/dbl */ 491 return(dbl_to_dbl_fcnvuf(&fpregs[r1],0, 492 &fpregs[t],status)); 493 } 494 case 6: /* FCNVFU (PA2.0 only) */ 495 switch(fmt) { 496 case 0: /* sgl/sgl */ 497 return(sgl_to_sgl_fcnvfu(&fpregs[r1],0, 498 &fpregs[t],status)); 499 case 1: /* sgl/dbl */ 500 return(sgl_to_dbl_fcnvfu(&fpregs[r1],0, 501 &fpregs[t],status)); 502 case 2: /* dbl/sgl */ 503 return(dbl_to_sgl_fcnvfu(&fpregs[r1],0, 504 &fpregs[t],status)); 505 case 3: /* dbl/dbl */ 506 return(dbl_to_dbl_fcnvfu(&fpregs[r1],0, 507 &fpregs[t],status)); 508 } 509 case 7: /* FCNVFUT (PA2.0 only) */ 510 switch(fmt) { 511 case 0: /* sgl/sgl */ 512 return(sgl_to_sgl_fcnvfut(&fpregs[r1],0, 513 &fpregs[t],status)); 514 case 1: /* sgl/dbl */ 515 return(sgl_to_dbl_fcnvfut(&fpregs[r1],0, 516 &fpregs[t],status)); 517 case 2: /* dbl/sgl */ 518 return(dbl_to_sgl_fcnvfut(&fpregs[r1],0, 519 &fpregs[t],status)); 520 case 3: /* dbl/dbl */ 521 return(dbl_to_dbl_fcnvfut(&fpregs[r1],0, 522 &fpregs[t],status)); 523 } 524 case 4: /* undefined */ 525 return(MAJOR_0C_EXCP); 526 } /* end of switch subop */ 527 528 case 2: /* class 2 */ 529 fpu_type_flags=fpregs[FPU_TYPE_FLAG_POS]; 530 r2 = extru(ir, fpr2pos, 5) * sizeof(double)/sizeof(u_int); 531 if (r2 == 0) 532 r2 = fpzeroreg; 533 if (fpu_type_flags & PA2_0_FPU_FLAG) { 534 /* FTEST if nullify bit set, otherwise FCMP */ 535 if (extru(ir, fpnulpos, 1)) { /* FTEST */ 536 switch (fmt) { 537 case 0: 538 /* 539 * arg0 is not used 540 * second param is the t field used for 541 * ftest,acc and ftest,rej 542 * third param is the subop (y-field) 543 */ 544 BUG(); 545 /* Unsupported 546 * return(ftest(0L,extru(ir,fptpos,5), 547 * &fpregs[0],subop)); 548 */ 549 case 1: 550 case 2: 551 case 3: 552 return(MAJOR_0C_EXCP); 553 } 554 } else { /* FCMP */ 555 switch (fmt) { 556 case 0: 557 retval = sgl_fcmp(&fpregs[r1], 558 &fpregs[r2],extru(ir,fptpos,5), 559 &local_status); 560 update_status_cbit(status,local_status, 561 fpu_type_flags, subop); 562 return(retval); 563 case 1: 564 retval = dbl_fcmp(&fpregs[r1], 565 &fpregs[r2],extru(ir,fptpos,5), 566 &local_status); 567 update_status_cbit(status,local_status, 568 fpu_type_flags, subop); 569 return(retval); 570 case 2: /* illegal */ 571 case 3: /* quad not implemented */ 572 return(MAJOR_0C_EXCP); 573 } 574 } 575 } /* end of if for PA2.0 */ 576 else { /* PA1.0 & PA1.1 */ 577 switch (subop) { 578 case 2: 579 case 3: 580 case 4: 581 case 5: 582 case 6: 583 case 7: 584 return(MAJOR_0C_EXCP); 585 case 0: /* FCMP */ 586 switch (fmt) { 587 case 0: 588 retval = sgl_fcmp(&fpregs[r1], 589 &fpregs[r2],extru(ir,fptpos,5), 590 &local_status); 591 update_status_cbit(status,local_status, 592 fpu_type_flags, subop); 593 return(retval); 594 case 1: 595 retval = dbl_fcmp(&fpregs[r1], 596 &fpregs[r2],extru(ir,fptpos,5), 597 &local_status); 598 update_status_cbit(status,local_status, 599 fpu_type_flags, subop); 600 return(retval); 601 case 2: /* illegal */ 602 case 3: /* quad not implemented */ 603 return(MAJOR_0C_EXCP); 604 } 605 case 1: /* FTEST */ 606 switch (fmt) { 607 case 0: 608 /* 609 * arg0 is not used 610 * second param is the t field used for 611 * ftest,acc and ftest,rej 612 * third param is the subop (y-field) 613 */ 614 BUG(); 615 /* unsupported 616 * return(ftest(0L,extru(ir,fptpos,5), 617 * &fpregs[0],subop)); 618 */ 619 case 1: 620 case 2: 621 case 3: 622 return(MAJOR_0C_EXCP); 623 } 624 } /* end of switch subop */ 625 } /* end of else for PA1.0 & PA1.1 */ 626 case 3: /* class 3 */ 627 r2 = extru(ir,fpr2pos,5) * sizeof(double)/sizeof(u_int); 628 if (r2 == 0) 629 r2 = fpzeroreg; 630 switch (subop) { 631 case 5: 632 case 6: 633 case 7: 634 return(MAJOR_0C_EXCP); 635 636 case 0: /* FADD */ 637 switch (fmt) { 638 case 0: 639 return(sgl_fadd(&fpregs[r1],&fpregs[r2], 640 &fpregs[t],status)); 641 case 1: 642 return(dbl_fadd(&fpregs[r1],&fpregs[r2], 643 &fpregs[t],status)); 644 case 2: /* illegal */ 645 case 3: /* quad not implemented */ 646 return(MAJOR_0C_EXCP); 647 } 648 case 1: /* FSUB */ 649 switch (fmt) { 650 case 0: 651 return(sgl_fsub(&fpregs[r1],&fpregs[r2], 652 &fpregs[t],status)); 653 case 1: 654 return(dbl_fsub(&fpregs[r1],&fpregs[r2], 655 &fpregs[t],status)); 656 case 2: /* illegal */ 657 case 3: /* quad not implemented */ 658 return(MAJOR_0C_EXCP); 659 } 660 case 2: /* FMPY */ 661 switch (fmt) { 662 case 0: 663 return(sgl_fmpy(&fpregs[r1],&fpregs[r2], 664 &fpregs[t],status)); 665 case 1: 666 return(dbl_fmpy(&fpregs[r1],&fpregs[r2], 667 &fpregs[t],status)); 668 case 2: /* illegal */ 669 case 3: /* quad not implemented */ 670 return(MAJOR_0C_EXCP); 671 } 672 case 3: /* FDIV */ 673 switch (fmt) { 674 case 0: 675 return(sgl_fdiv(&fpregs[r1],&fpregs[r2], 676 &fpregs[t],status)); 677 case 1: 678 return(dbl_fdiv(&fpregs[r1],&fpregs[r2], 679 &fpregs[t],status)); 680 case 2: /* illegal */ 681 case 3: /* quad not implemented */ 682 return(MAJOR_0C_EXCP); 683 } 684 case 4: /* FREM */ 685 switch (fmt) { 686 case 0: 687 return(sgl_frem(&fpregs[r1],&fpregs[r2], 688 &fpregs[t],status)); 689 case 1: 690 return(dbl_frem(&fpregs[r1],&fpregs[r2], 691 &fpregs[t],status)); 692 case 2: /* illegal */ 693 case 3: /* quad not implemented */ 694 return(MAJOR_0C_EXCP); 695 } 696 } /* end of class 3 switch */ 697 } /* end of switch(class) */ 698 699 /* If we get here, something is really wrong! */ 700 return(MAJOR_0C_EXCP); 701 } 702 703 static u_int 704 decode_0e(ir,class,subop,fpregs) 705 u_int ir,class,subop; 706 u_int fpregs[]; 707 { 708 u_int r1,r2,t; /* operand register offsets */ 709 u_int fmt; /* also sf for class 1 conversions */ 710 u_int df; /* dest format for class 1 conversions */ 711 u_int *status; 712 u_int retval, local_status; 713 u_int fpu_type_flags; 714 715 status = &fpregs[0]; 716 local_status = fpregs[0]; 717 r1 = ((extru(ir,fpr1pos,5)<<1)|(extru(ir,fpxr1pos,1))); 718 if (r1 == 0) 719 r1 = fpzeroreg; 720 t = ((extru(ir,fptpos,5)<<1)|(extru(ir,fpxtpos,1))); 721 if (t == 0 && class != 2) 722 return(MAJOR_0E_EXCP); 723 if (class < 2) /* class 0 or 1 has 2 bit fmt */ 724 fmt = extru(ir,fpfmtpos,2); 725 else /* class 2 and 3 have 1 bit fmt */ 726 fmt = extru(ir,fp0efmtpos,1); 727 /* 728 * An undefined combination, double precision accessing the 729 * right half of a FPR, can get us into trouble. 730 * Let's just force proper alignment on it. 731 */ 732 if (fmt == DBL) { 733 r1 &= ~1; 734 if (class != 1) 735 t &= ~1; 736 } 737 738 switch (class) { 739 case 0: 740 switch (subop) { 741 case 0: /* unimplemented */ 742 case 1: 743 return(MAJOR_0E_EXCP); 744 case 2: /* FCPY */ 745 switch (fmt) { 746 case 2: 747 case 3: 748 return(MAJOR_0E_EXCP); 749 case 1: /* double */ 750 fpregs[t+1] = fpregs[r1+1]; 751 case 0: /* single */ 752 fpregs[t] = fpregs[r1]; 753 return(NOEXCEPTION); 754 } 755 case 3: /* FABS */ 756 switch (fmt) { 757 case 2: 758 case 3: 759 return(MAJOR_0E_EXCP); 760 case 1: /* double */ 761 fpregs[t+1] = fpregs[r1+1]; 762 case 0: /* single */ 763 fpregs[t] = fpregs[r1] & 0x7fffffff; 764 return(NOEXCEPTION); 765 } 766 case 6: /* FNEG */ 767 switch (fmt) { 768 case 2: 769 case 3: 770 return(MAJOR_0E_EXCP); 771 case 1: /* double */ 772 fpregs[t+1] = fpregs[r1+1]; 773 case 0: /* single */ 774 fpregs[t] = fpregs[r1] ^ 0x80000000; 775 return(NOEXCEPTION); 776 } 777 case 7: /* FNEGABS */ 778 switch (fmt) { 779 case 2: 780 case 3: 781 return(MAJOR_0E_EXCP); 782 case 1: /* double */ 783 fpregs[t+1] = fpregs[r1+1]; 784 case 0: /* single */ 785 fpregs[t] = fpregs[r1] | 0x80000000; 786 return(NOEXCEPTION); 787 } 788 case 4: /* FSQRT */ 789 switch (fmt) { 790 case 0: 791 return(sgl_fsqrt(&fpregs[r1],0, 792 &fpregs[t], status)); 793 case 1: 794 return(dbl_fsqrt(&fpregs[r1],0, 795 &fpregs[t], status)); 796 case 2: 797 case 3: 798 return(MAJOR_0E_EXCP); 799 } 800 case 5: /* FRMD */ 801 switch (fmt) { 802 case 0: 803 return(sgl_frnd(&fpregs[r1],0, 804 &fpregs[t], status)); 805 case 1: 806 return(dbl_frnd(&fpregs[r1],0, 807 &fpregs[t], status)); 808 case 2: 809 case 3: 810 return(MAJOR_0E_EXCP); 811 } 812 } /* end of switch (subop */ 813 814 case 1: /* class 1 */ 815 df = extru(ir,fpdfpos,2); /* get dest format */ 816 /* 817 * Fix Crashme problem (writing to 31R in double precision) 818 * here too. 819 */ 820 if (df == DBL) { 821 t &= ~1; 822 } 823 if ((df & 2) || (fmt & 2)) 824 return(MAJOR_0E_EXCP); 825 826 fmt = (fmt << 1) | df; 827 switch (subop) { 828 case 0: /* FCNVFF */ 829 switch(fmt) { 830 case 0: /* sgl/sgl */ 831 return(MAJOR_0E_EXCP); 832 case 1: /* sgl/dbl */ 833 return(sgl_to_dbl_fcnvff(&fpregs[r1],0, 834 &fpregs[t],status)); 835 case 2: /* dbl/sgl */ 836 return(dbl_to_sgl_fcnvff(&fpregs[r1],0, 837 &fpregs[t],status)); 838 case 3: /* dbl/dbl */ 839 return(MAJOR_0E_EXCP); 840 } 841 case 1: /* FCNVXF */ 842 switch(fmt) { 843 case 0: /* sgl/sgl */ 844 return(sgl_to_sgl_fcnvxf(&fpregs[r1],0, 845 &fpregs[t],status)); 846 case 1: /* sgl/dbl */ 847 return(sgl_to_dbl_fcnvxf(&fpregs[r1],0, 848 &fpregs[t],status)); 849 case 2: /* dbl/sgl */ 850 return(dbl_to_sgl_fcnvxf(&fpregs[r1],0, 851 &fpregs[t],status)); 852 case 3: /* dbl/dbl */ 853 return(dbl_to_dbl_fcnvxf(&fpregs[r1],0, 854 &fpregs[t],status)); 855 } 856 case 2: /* FCNVFX */ 857 switch(fmt) { 858 case 0: /* sgl/sgl */ 859 return(sgl_to_sgl_fcnvfx(&fpregs[r1],0, 860 &fpregs[t],status)); 861 case 1: /* sgl/dbl */ 862 return(sgl_to_dbl_fcnvfx(&fpregs[r1],0, 863 &fpregs[t],status)); 864 case 2: /* dbl/sgl */ 865 return(dbl_to_sgl_fcnvfx(&fpregs[r1],0, 866 &fpregs[t],status)); 867 case 3: /* dbl/dbl */ 868 return(dbl_to_dbl_fcnvfx(&fpregs[r1],0, 869 &fpregs[t],status)); 870 } 871 case 3: /* FCNVFXT */ 872 switch(fmt) { 873 case 0: /* sgl/sgl */ 874 return(sgl_to_sgl_fcnvfxt(&fpregs[r1],0, 875 &fpregs[t],status)); 876 case 1: /* sgl/dbl */ 877 return(sgl_to_dbl_fcnvfxt(&fpregs[r1],0, 878 &fpregs[t],status)); 879 case 2: /* dbl/sgl */ 880 return(dbl_to_sgl_fcnvfxt(&fpregs[r1],0, 881 &fpregs[t],status)); 882 case 3: /* dbl/dbl */ 883 return(dbl_to_dbl_fcnvfxt(&fpregs[r1],0, 884 &fpregs[t],status)); 885 } 886 case 5: /* FCNVUF (PA2.0 only) */ 887 switch(fmt) { 888 case 0: /* sgl/sgl */ 889 return(sgl_to_sgl_fcnvuf(&fpregs[r1],0, 890 &fpregs[t],status)); 891 case 1: /* sgl/dbl */ 892 return(sgl_to_dbl_fcnvuf(&fpregs[r1],0, 893 &fpregs[t],status)); 894 case 2: /* dbl/sgl */ 895 return(dbl_to_sgl_fcnvuf(&fpregs[r1],0, 896 &fpregs[t],status)); 897 case 3: /* dbl/dbl */ 898 return(dbl_to_dbl_fcnvuf(&fpregs[r1],0, 899 &fpregs[t],status)); 900 } 901 case 6: /* FCNVFU (PA2.0 only) */ 902 switch(fmt) { 903 case 0: /* sgl/sgl */ 904 return(sgl_to_sgl_fcnvfu(&fpregs[r1],0, 905 &fpregs[t],status)); 906 case 1: /* sgl/dbl */ 907 return(sgl_to_dbl_fcnvfu(&fpregs[r1],0, 908 &fpregs[t],status)); 909 case 2: /* dbl/sgl */ 910 return(dbl_to_sgl_fcnvfu(&fpregs[r1],0, 911 &fpregs[t],status)); 912 case 3: /* dbl/dbl */ 913 return(dbl_to_dbl_fcnvfu(&fpregs[r1],0, 914 &fpregs[t],status)); 915 } 916 case 7: /* FCNVFUT (PA2.0 only) */ 917 switch(fmt) { 918 case 0: /* sgl/sgl */ 919 return(sgl_to_sgl_fcnvfut(&fpregs[r1],0, 920 &fpregs[t],status)); 921 case 1: /* sgl/dbl */ 922 return(sgl_to_dbl_fcnvfut(&fpregs[r1],0, 923 &fpregs[t],status)); 924 case 2: /* dbl/sgl */ 925 return(dbl_to_sgl_fcnvfut(&fpregs[r1],0, 926 &fpregs[t],status)); 927 case 3: /* dbl/dbl */ 928 return(dbl_to_dbl_fcnvfut(&fpregs[r1],0, 929 &fpregs[t],status)); 930 } 931 case 4: /* undefined */ 932 return(MAJOR_0C_EXCP); 933 } /* end of switch subop */ 934 case 2: /* class 2 */ 935 /* 936 * Be careful out there. 937 * Crashme can generate cases where FR31R is specified 938 * as the source or target of a double precision operation. 939 * Since we just pass the address of the floating-point 940 * register to the emulation routines, this can cause 941 * corruption of fpzeroreg. 942 */ 943 if (fmt == DBL) 944 r2 = (extru(ir,fpr2pos,5)<<1); 945 else 946 r2 = ((extru(ir,fpr2pos,5)<<1)|(extru(ir,fpxr2pos,1))); 947 fpu_type_flags=fpregs[FPU_TYPE_FLAG_POS]; 948 if (r2 == 0) 949 r2 = fpzeroreg; 950 if (fpu_type_flags & PA2_0_FPU_FLAG) { 951 /* FTEST if nullify bit set, otherwise FCMP */ 952 if (extru(ir, fpnulpos, 1)) { /* FTEST */ 953 /* not legal */ 954 return(MAJOR_0E_EXCP); 955 } else { /* FCMP */ 956 switch (fmt) { 957 /* 958 * fmt is only 1 bit long 959 */ 960 case 0: 961 retval = sgl_fcmp(&fpregs[r1], 962 &fpregs[r2],extru(ir,fptpos,5), 963 &local_status); 964 update_status_cbit(status,local_status, 965 fpu_type_flags, subop); 966 return(retval); 967 case 1: 968 retval = dbl_fcmp(&fpregs[r1], 969 &fpregs[r2],extru(ir,fptpos,5), 970 &local_status); 971 update_status_cbit(status,local_status, 972 fpu_type_flags, subop); 973 return(retval); 974 } 975 } 976 } /* end of if for PA2.0 */ 977 else { /* PA1.0 & PA1.1 */ 978 switch (subop) { 979 case 1: 980 case 2: 981 case 3: 982 case 4: 983 case 5: 984 case 6: 985 case 7: 986 return(MAJOR_0E_EXCP); 987 case 0: /* FCMP */ 988 switch (fmt) { 989 /* 990 * fmt is only 1 bit long 991 */ 992 case 0: 993 retval = sgl_fcmp(&fpregs[r1], 994 &fpregs[r2],extru(ir,fptpos,5), 995 &local_status); 996 update_status_cbit(status,local_status, 997 fpu_type_flags, subop); 998 return(retval); 999 case 1: 1000 retval = dbl_fcmp(&fpregs[r1], 1001 &fpregs[r2],extru(ir,fptpos,5), 1002 &local_status); 1003 update_status_cbit(status,local_status, 1004 fpu_type_flags, subop); 1005 return(retval); 1006 } 1007 } /* end of switch subop */ 1008 } /* end of else for PA1.0 & PA1.1 */ 1009 case 3: /* class 3 */ 1010 /* 1011 * Be careful out there. 1012 * Crashme can generate cases where FR31R is specified 1013 * as the source or target of a double precision operation. 1014 * Since we just pass the address of the floating-point 1015 * register to the emulation routines, this can cause 1016 * corruption of fpzeroreg. 1017 */ 1018 if (fmt == DBL) 1019 r2 = (extru(ir,fpr2pos,5)<<1); 1020 else 1021 r2 = ((extru(ir,fpr2pos,5)<<1)|(extru(ir,fpxr2pos,1))); 1022 if (r2 == 0) 1023 r2 = fpzeroreg; 1024 switch (subop) { 1025 case 5: 1026 case 6: 1027 case 7: 1028 return(MAJOR_0E_EXCP); 1029 1030 /* 1031 * Note that fmt is only 1 bit for class 3 */ 1032 case 0: /* FADD */ 1033 switch (fmt) { 1034 case 0: 1035 return(sgl_fadd(&fpregs[r1],&fpregs[r2], 1036 &fpregs[t],status)); 1037 case 1: 1038 return(dbl_fadd(&fpregs[r1],&fpregs[r2], 1039 &fpregs[t],status)); 1040 } 1041 case 1: /* FSUB */ 1042 switch (fmt) { 1043 case 0: 1044 return(sgl_fsub(&fpregs[r1],&fpregs[r2], 1045 &fpregs[t],status)); 1046 case 1: 1047 return(dbl_fsub(&fpregs[r1],&fpregs[r2], 1048 &fpregs[t],status)); 1049 } 1050 case 2: /* FMPY or XMPYU */ 1051 /* 1052 * check for integer multiply (x bit set) 1053 */ 1054 if (extru(ir,fpxpos,1)) { 1055 /* 1056 * emulate XMPYU 1057 */ 1058 switch (fmt) { 1059 case 0: 1060 /* 1061 * bad instruction if t specifies 1062 * the right half of a register 1063 */ 1064 if (t & 1) 1065 return(MAJOR_0E_EXCP); 1066 BUG(); 1067 /* unsupported 1068 * impyu(&fpregs[r1],&fpregs[r2], 1069 * &fpregs[t]); 1070 */ 1071 return(NOEXCEPTION); 1072 case 1: 1073 return(MAJOR_0E_EXCP); 1074 } 1075 } 1076 else { /* FMPY */ 1077 switch (fmt) { 1078 case 0: 1079 return(sgl_fmpy(&fpregs[r1], 1080 &fpregs[r2],&fpregs[t],status)); 1081 case 1: 1082 return(dbl_fmpy(&fpregs[r1], 1083 &fpregs[r2],&fpregs[t],status)); 1084 } 1085 } 1086 case 3: /* FDIV */ 1087 switch (fmt) { 1088 case 0: 1089 return(sgl_fdiv(&fpregs[r1],&fpregs[r2], 1090 &fpregs[t],status)); 1091 case 1: 1092 return(dbl_fdiv(&fpregs[r1],&fpregs[r2], 1093 &fpregs[t],status)); 1094 } 1095 case 4: /* FREM */ 1096 switch (fmt) { 1097 case 0: 1098 return(sgl_frem(&fpregs[r1],&fpregs[r2], 1099 &fpregs[t],status)); 1100 case 1: 1101 return(dbl_frem(&fpregs[r1],&fpregs[r2], 1102 &fpregs[t],status)); 1103 } 1104 } /* end of class 3 switch */ 1105 } /* end of switch(class) */ 1106 1107 /* If we get here, something is really wrong! */ 1108 return(MAJOR_0E_EXCP); 1109 } 1110 1111 1112 /* 1113 * routine to decode the 06 (FMPYADD and FMPYCFXT) instruction 1114 */ 1115 static u_int 1116 decode_06(ir,fpregs) 1117 u_int ir; 1118 u_int fpregs[]; 1119 { 1120 u_int rm1, rm2, tm, ra, ta; /* operands */ 1121 u_int fmt; 1122 u_int error = 0; 1123 u_int status; 1124 u_int fpu_type_flags; 1125 union { 1126 double dbl; 1127 float flt; 1128 struct { u_int i1; u_int i2; } ints; 1129 } mtmp, atmp; 1130 1131 1132 status = fpregs[0]; /* use a local copy of status reg */ 1133 fpu_type_flags=fpregs[FPU_TYPE_FLAG_POS]; /* get fpu type flags */ 1134 fmt = extru(ir, fpmultifmt, 1); /* get sgl/dbl flag */ 1135 if (fmt == 0) { /* DBL */ 1136 rm1 = extru(ir, fprm1pos, 5) * sizeof(double)/sizeof(u_int); 1137 if (rm1 == 0) 1138 rm1 = fpzeroreg; 1139 rm2 = extru(ir, fprm2pos, 5) * sizeof(double)/sizeof(u_int); 1140 if (rm2 == 0) 1141 rm2 = fpzeroreg; 1142 tm = extru(ir, fptmpos, 5) * sizeof(double)/sizeof(u_int); 1143 if (tm == 0) 1144 return(MAJOR_06_EXCP); 1145 ra = extru(ir, fprapos, 5) * sizeof(double)/sizeof(u_int); 1146 ta = extru(ir, fptapos, 5) * sizeof(double)/sizeof(u_int); 1147 if (ta == 0) 1148 return(MAJOR_06_EXCP); 1149 1150 if (fpu_type_flags & TIMEX_ROLEX_FPU_MASK) { 1151 1152 if (ra == 0) { 1153 /* special case FMPYCFXT, see sgl case below */ 1154 if (dbl_fmpy(&fpregs[rm1],&fpregs[rm2], 1155 &mtmp.ints.i1,&status)) 1156 error = 1; 1157 if (dbl_to_sgl_fcnvfxt(&fpregs[ta], 1158 &atmp.ints.i1,&atmp.ints.i1,&status)) 1159 error = 1; 1160 } 1161 else { 1162 1163 if (dbl_fmpy(&fpregs[rm1],&fpregs[rm2],&mtmp.ints.i1, 1164 &status)) 1165 error = 1; 1166 if (dbl_fadd(&fpregs[ta], &fpregs[ra], &atmp.ints.i1, 1167 &status)) 1168 error = 1; 1169 } 1170 } 1171 1172 else 1173 1174 { 1175 if (ra == 0) 1176 ra = fpzeroreg; 1177 1178 if (dbl_fmpy(&fpregs[rm1],&fpregs[rm2],&mtmp.ints.i1, 1179 &status)) 1180 error = 1; 1181 if (dbl_fadd(&fpregs[ta], &fpregs[ra], &atmp.ints.i1, 1182 &status)) 1183 error = 1; 1184 1185 } 1186 1187 if (error) 1188 return(MAJOR_06_EXCP); 1189 else { 1190 /* copy results */ 1191 fpregs[tm] = mtmp.ints.i1; 1192 fpregs[tm+1] = mtmp.ints.i2; 1193 fpregs[ta] = atmp.ints.i1; 1194 fpregs[ta+1] = atmp.ints.i2; 1195 fpregs[0] = status; 1196 return(NOEXCEPTION); 1197 } 1198 } 1199 else { /* SGL */ 1200 /* 1201 * calculate offsets for single precision numbers 1202 * See table 6-14 in PA-89 architecture for mapping 1203 */ 1204 rm1 = (extru(ir,fprm1pos,4) | 0x10 ) << 1; /* get offset */ 1205 rm1 |= extru(ir,fprm1pos-4,1); /* add right word offset */ 1206 1207 rm2 = (extru(ir,fprm2pos,4) | 0x10 ) << 1; /* get offset */ 1208 rm2 |= extru(ir,fprm2pos-4,1); /* add right word offset */ 1209 1210 tm = (extru(ir,fptmpos,4) | 0x10 ) << 1; /* get offset */ 1211 tm |= extru(ir,fptmpos-4,1); /* add right word offset */ 1212 1213 ra = (extru(ir,fprapos,4) | 0x10 ) << 1; /* get offset */ 1214 ra |= extru(ir,fprapos-4,1); /* add right word offset */ 1215 1216 ta = (extru(ir,fptapos,4) | 0x10 ) << 1; /* get offset */ 1217 ta |= extru(ir,fptapos-4,1); /* add right word offset */ 1218 1219 if (ra == 0x20 &&(fpu_type_flags & TIMEX_ROLEX_FPU_MASK)) { 1220 /* special case FMPYCFXT (really 0) 1221 * This instruction is only present on the Timex and 1222 * Rolex fpu's in so if it is the special case and 1223 * one of these fpu's we run the FMPYCFXT instruction 1224 */ 1225 if (sgl_fmpy(&fpregs[rm1],&fpregs[rm2],&mtmp.ints.i1, 1226 &status)) 1227 error = 1; 1228 if (sgl_to_sgl_fcnvfxt(&fpregs[ta],&atmp.ints.i1, 1229 &atmp.ints.i1,&status)) 1230 error = 1; 1231 } 1232 else { 1233 if (sgl_fmpy(&fpregs[rm1],&fpregs[rm2],&mtmp.ints.i1, 1234 &status)) 1235 error = 1; 1236 if (sgl_fadd(&fpregs[ta], &fpregs[ra], &atmp.ints.i1, 1237 &status)) 1238 error = 1; 1239 } 1240 if (error) 1241 return(MAJOR_06_EXCP); 1242 else { 1243 /* copy results */ 1244 fpregs[tm] = mtmp.ints.i1; 1245 fpregs[ta] = atmp.ints.i1; 1246 fpregs[0] = status; 1247 return(NOEXCEPTION); 1248 } 1249 } 1250 } 1251 1252 /* 1253 * routine to decode the 26 (FMPYSUB) instruction 1254 */ 1255 static u_int 1256 decode_26(ir,fpregs) 1257 u_int ir; 1258 u_int fpregs[]; 1259 { 1260 u_int rm1, rm2, tm, ra, ta; /* operands */ 1261 u_int fmt; 1262 u_int error = 0; 1263 u_int status; 1264 union { 1265 double dbl; 1266 float flt; 1267 struct { u_int i1; u_int i2; } ints; 1268 } mtmp, atmp; 1269 1270 1271 status = fpregs[0]; 1272 fmt = extru(ir, fpmultifmt, 1); /* get sgl/dbl flag */ 1273 if (fmt == 0) { /* DBL */ 1274 rm1 = extru(ir, fprm1pos, 5) * sizeof(double)/sizeof(u_int); 1275 if (rm1 == 0) 1276 rm1 = fpzeroreg; 1277 rm2 = extru(ir, fprm2pos, 5) * sizeof(double)/sizeof(u_int); 1278 if (rm2 == 0) 1279 rm2 = fpzeroreg; 1280 tm = extru(ir, fptmpos, 5) * sizeof(double)/sizeof(u_int); 1281 if (tm == 0) 1282 return(MAJOR_26_EXCP); 1283 ra = extru(ir, fprapos, 5) * sizeof(double)/sizeof(u_int); 1284 if (ra == 0) 1285 return(MAJOR_26_EXCP); 1286 ta = extru(ir, fptapos, 5) * sizeof(double)/sizeof(u_int); 1287 if (ta == 0) 1288 return(MAJOR_26_EXCP); 1289 1290 if (dbl_fmpy(&fpregs[rm1],&fpregs[rm2],&mtmp.ints.i1,&status)) 1291 error = 1; 1292 if (dbl_fsub(&fpregs[ta], &fpregs[ra], &atmp.ints.i1,&status)) 1293 error = 1; 1294 if (error) 1295 return(MAJOR_26_EXCP); 1296 else { 1297 /* copy results */ 1298 fpregs[tm] = mtmp.ints.i1; 1299 fpregs[tm+1] = mtmp.ints.i2; 1300 fpregs[ta] = atmp.ints.i1; 1301 fpregs[ta+1] = atmp.ints.i2; 1302 fpregs[0] = status; 1303 return(NOEXCEPTION); 1304 } 1305 } 1306 else { /* SGL */ 1307 /* 1308 * calculate offsets for single precision numbers 1309 * See table 6-14 in PA-89 architecture for mapping 1310 */ 1311 rm1 = (extru(ir,fprm1pos,4) | 0x10 ) << 1; /* get offset */ 1312 rm1 |= extru(ir,fprm1pos-4,1); /* add right word offset */ 1313 1314 rm2 = (extru(ir,fprm2pos,4) | 0x10 ) << 1; /* get offset */ 1315 rm2 |= extru(ir,fprm2pos-4,1); /* add right word offset */ 1316 1317 tm = (extru(ir,fptmpos,4) | 0x10 ) << 1; /* get offset */ 1318 tm |= extru(ir,fptmpos-4,1); /* add right word offset */ 1319 1320 ra = (extru(ir,fprapos,4) | 0x10 ) << 1; /* get offset */ 1321 ra |= extru(ir,fprapos-4,1); /* add right word offset */ 1322 1323 ta = (extru(ir,fptapos,4) | 0x10 ) << 1; /* get offset */ 1324 ta |= extru(ir,fptapos-4,1); /* add right word offset */ 1325 1326 if (sgl_fmpy(&fpregs[rm1],&fpregs[rm2],&mtmp.ints.i1,&status)) 1327 error = 1; 1328 if (sgl_fsub(&fpregs[ta], &fpregs[ra], &atmp.ints.i1,&status)) 1329 error = 1; 1330 if (error) 1331 return(MAJOR_26_EXCP); 1332 else { 1333 /* copy results */ 1334 fpregs[tm] = mtmp.ints.i1; 1335 fpregs[ta] = atmp.ints.i1; 1336 fpregs[0] = status; 1337 return(NOEXCEPTION); 1338 } 1339 } 1340 1341 } 1342 1343 /* 1344 * routine to decode the 2E (FMPYFADD,FMPYNFADD) instructions 1345 */ 1346 static u_int 1347 decode_2e(ir,fpregs) 1348 u_int ir; 1349 u_int fpregs[]; 1350 { 1351 u_int rm1, rm2, ra, t; /* operands */ 1352 u_int fmt; 1353 1354 fmt = extru(ir,fpfmtpos,1); /* get fmt completer */ 1355 if (fmt == DBL) { /* DBL */ 1356 rm1 = extru(ir,fprm1pos,5) * sizeof(double)/sizeof(u_int); 1357 if (rm1 == 0) 1358 rm1 = fpzeroreg; 1359 rm2 = extru(ir,fprm2pos,5) * sizeof(double)/sizeof(u_int); 1360 if (rm2 == 0) 1361 rm2 = fpzeroreg; 1362 ra = ((extru(ir,fpraupos,3)<<2)|(extru(ir,fpralpos,3)>>1)) * 1363 sizeof(double)/sizeof(u_int); 1364 if (ra == 0) 1365 ra = fpzeroreg; 1366 t = extru(ir,fptpos,5) * sizeof(double)/sizeof(u_int); 1367 if (t == 0) 1368 return(MAJOR_2E_EXCP); 1369 1370 if (extru(ir,fpfusedsubop,1)) { /* fmpyfadd or fmpynfadd? */ 1371 return(dbl_fmpynfadd(&fpregs[rm1], &fpregs[rm2], 1372 &fpregs[ra], &fpregs[0], &fpregs[t])); 1373 } else { 1374 return(dbl_fmpyfadd(&fpregs[rm1], &fpregs[rm2], 1375 &fpregs[ra], &fpregs[0], &fpregs[t])); 1376 } 1377 } /* end DBL */ 1378 else { /* SGL */ 1379 rm1 = (extru(ir,fprm1pos,5)<<1)|(extru(ir,fpxrm1pos,1)); 1380 if (rm1 == 0) 1381 rm1 = fpzeroreg; 1382 rm2 = (extru(ir,fprm2pos,5)<<1)|(extru(ir,fpxrm2pos,1)); 1383 if (rm2 == 0) 1384 rm2 = fpzeroreg; 1385 ra = (extru(ir,fpraupos,3)<<3)|extru(ir,fpralpos,3); 1386 if (ra == 0) 1387 ra = fpzeroreg; 1388 t = ((extru(ir,fptpos,5)<<1)|(extru(ir,fpxtpos,1))); 1389 if (t == 0) 1390 return(MAJOR_2E_EXCP); 1391 1392 if (extru(ir,fpfusedsubop,1)) { /* fmpyfadd or fmpynfadd? */ 1393 return(sgl_fmpynfadd(&fpregs[rm1], &fpregs[rm2], 1394 &fpregs[ra], &fpregs[0], &fpregs[t])); 1395 } else { 1396 return(sgl_fmpyfadd(&fpregs[rm1], &fpregs[rm2], 1397 &fpregs[ra], &fpregs[0], &fpregs[t])); 1398 } 1399 } /* end SGL */ 1400 } 1401 1402 /* 1403 * update_status_cbit 1404 * 1405 * This routine returns the correct FP status register value in 1406 * *status, based on the C-bit & V-bit returned by the FCMP 1407 * emulation routine in new_status. The architecture type 1408 * (PA83, PA89 or PA2.0) is available in fpu_type. The y_field 1409 * and the architecture type are used to determine what flavor 1410 * of FCMP is being emulated. 1411 */ 1412 static void 1413 update_status_cbit(status, new_status, fpu_type, y_field) 1414 u_int *status, new_status; 1415 u_int fpu_type; 1416 u_int y_field; 1417 { 1418 /* 1419 * For PA89 FPU's which implement the Compare Queue and 1420 * for PA2.0 FPU's, update the Compare Queue if the y-field = 0, 1421 * otherwise update the specified bit in the Compare Array. 1422 * Note that the y-field will always be 0 for non-PA2.0 FPU's. 1423 */ 1424 if ((fpu_type & TIMEX_EXTEN_FLAG) || 1425 (fpu_type & ROLEX_EXTEN_FLAG) || 1426 (fpu_type & PA2_0_FPU_FLAG)) { 1427 if (y_field == 0) { 1428 *status = ((*status & 0x04000000) >> 5) | /* old Cbit */ 1429 ((*status & 0x003ff000) >> 1) | /* old CQ */ 1430 (new_status & 0xffc007ff); /* all other bits*/ 1431 } else { 1432 *status = (*status & 0x04000000) | /* old Cbit */ 1433 ((new_status & 0x04000000) >> (y_field+4)) | 1434 (new_status & ~0x04000000 & /* other bits */ 1435 ~(0x04000000 >> (y_field+4))); 1436 } 1437 } 1438 /* if PA83, just update the C-bit */ 1439 else { 1440 *status = new_status; 1441 } 1442 } 1443