op_helper.c 77.9 KB
Newer Older
1
#include "exec.h"
B
blueswir1 已提交
2
#include "host-utils.h"
B
blueswir1 已提交
3
#include "helper.h"
4

B
bellard 已提交
5
//#define DEBUG_PCALL
B
bellard 已提交
6
//#define DEBUG_MMU
7
//#define DEBUG_MXCC
B
blueswir1 已提交
8
//#define DEBUG_UNALIGNED
9
//#define DEBUG_UNASSIGNED
10
//#define DEBUG_ASI
B
bellard 已提交
11

12 13 14 15 16 17 18 19 20 21 22 23 24 25
#ifdef DEBUG_MMU
#define DPRINTF_MMU(fmt, args...) \
do { printf("MMU: " fmt , ##args); } while (0)
#else
#define DPRINTF_MMU(fmt, args...)
#endif

#ifdef DEBUG_MXCC
#define DPRINTF_MXCC(fmt, args...) \
do { printf("MXCC: " fmt , ##args); } while (0)
#else
#define DPRINTF_MXCC(fmt, args...)
#endif

26 27 28 29 30 31 32
#ifdef DEBUG_ASI
#define DPRINTF_ASI(fmt, args...) \
do { printf("ASI: " fmt , ##args); } while (0)
#else
#define DPRINTF_ASI(fmt, args...)
#endif

B
bellard 已提交
33 34 35 36
void raise_exception(int tt)
{
    env->exception_index = tt;
    cpu_loop_exit();
37
}
B
bellard 已提交
38

B
blueswir1 已提交
39
void helper_trap(target_ulong nb_trap)
40
{
B
blueswir1 已提交
41 42 43 44 45 46 47 48 49 50 51 52
    env->exception_index = TT_TRAP + (nb_trap & 0x7f);
    cpu_loop_exit();
}

void helper_trapcc(target_ulong nb_trap, target_ulong do_trap)
{
    if (do_trap) {
        env->exception_index = TT_TRAP + (nb_trap & 0x7f);
        cpu_loop_exit();
    }
}

B
blueswir1 已提交
53 54 55 56 57 58
void helper_check_align(target_ulong addr, uint32_t align)
{
    if (addr & align)
        raise_exception(TT_UNALIGNED);
}

59 60
#define F_HELPER(name, p) void helper_f##name##p(void)

B
blueswir1 已提交
61
#if defined(CONFIG_USER_ONLY)
62 63 64 65 66 67 68 69
#define F_BINOP(name)                                           \
    F_HELPER(name, s)                                           \
    {                                                           \
        FT0 = float32_ ## name (FT0, FT1, &env->fp_status);     \
    }                                                           \
    F_HELPER(name, d)                                           \
    {                                                           \
        DT0 = float64_ ## name (DT0, DT1, &env->fp_status);     \
B
blueswir1 已提交
70 71 72 73
    }                                                           \
    F_HELPER(name, q)                                           \
    {                                                           \
        QT0 = float128_ ## name (QT0, QT1, &env->fp_status);    \
74
    }
B
blueswir1 已提交
75 76 77 78 79 80 81 82 83 84 85
#else
#define F_BINOP(name)                                           \
    F_HELPER(name, s)                                           \
    {                                                           \
        FT0 = float32_ ## name (FT0, FT1, &env->fp_status);     \
    }                                                           \
    F_HELPER(name, d)                                           \
    {                                                           \
        DT0 = float64_ ## name (DT0, DT1, &env->fp_status);     \
    }
#endif
86 87 88 89 90 91 92 93

F_BINOP(add);
F_BINOP(sub);
F_BINOP(mul);
F_BINOP(div);
#undef F_BINOP

void helper_fsmuld(void)
B
blueswir1 已提交
94
{
95 96 97 98
    DT0 = float64_mul(float32_to_float64(FT0, &env->fp_status),
                      float32_to_float64(FT1, &env->fp_status),
                      &env->fp_status);
}
B
blueswir1 已提交
99

B
blueswir1 已提交
100 101 102 103 104 105 106 107 108
#if defined(CONFIG_USER_ONLY)
void helper_fdmulq(void)
{
    QT0 = float128_mul(float64_to_float128(DT0, &env->fp_status),
                       float64_to_float128(DT1, &env->fp_status),
                       &env->fp_status);
}
#endif

109 110 111
F_HELPER(neg, s)
{
    FT0 = float32_chs(FT1);
112 113
}

114 115
#ifdef TARGET_SPARC64
F_HELPER(neg, d)
116
{
117
    DT0 = float64_chs(DT1);
118
}
B
blueswir1 已提交
119 120 121 122 123 124 125

#if defined(CONFIG_USER_ONLY)
F_HELPER(neg, q)
{
    QT0 = float128_chs(QT1);
}
#endif
126 127 128 129
#endif

/* Integer to float conversion.  */
F_HELPER(ito, s)
B
bellard 已提交
130
{
T
ths 已提交
131
    FT0 = int32_to_float32(*((int32_t *)&FT1), &env->fp_status);
B
bellard 已提交
132 133
}

134
F_HELPER(ito, d)
B
bellard 已提交
135
{
T
ths 已提交
136
    DT0 = int32_to_float64(*((int32_t *)&FT1), &env->fp_status);
B
bellard 已提交
137
}
138

B
blueswir1 已提交
139 140 141 142 143 144 145
#if defined(CONFIG_USER_ONLY)
F_HELPER(ito, q)
{
    QT0 = int32_to_float128(*((int32_t *)&FT1), &env->fp_status);
}
#endif

B
blueswir1 已提交
146
#ifdef TARGET_SPARC64
147
F_HELPER(xto, s)
B
blueswir1 已提交
148 149 150 151
{
    FT0 = int64_to_float32(*((int64_t *)&DT1), &env->fp_status);
}

152
F_HELPER(xto, d)
B
blueswir1 已提交
153 154 155
{
    DT0 = int64_to_float64(*((int64_t *)&DT1), &env->fp_status);
}
B
blueswir1 已提交
156 157 158 159 160 161
#if defined(CONFIG_USER_ONLY)
F_HELPER(xto, q)
{
    QT0 = int64_to_float128(*((int64_t *)&DT1), &env->fp_status);
}
#endif
162 163 164 165 166 167 168 169 170 171 172 173 174
#endif
#undef F_HELPER

/* floating point conversion */
void helper_fdtos(void)
{
    FT0 = float64_to_float32(DT1, &env->fp_status);
}

void helper_fstod(void)
{
    DT0 = float32_to_float64(FT1, &env->fp_status);
}
175

B
blueswir1 已提交
176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197
#if defined(CONFIG_USER_ONLY)
void helper_fqtos(void)
{
    FT0 = float128_to_float32(QT1, &env->fp_status);
}

void helper_fstoq(void)
{
    QT0 = float32_to_float128(FT1, &env->fp_status);
}

void helper_fqtod(void)
{
    DT0 = float128_to_float64(QT1, &env->fp_status);
}

void helper_fdtoq(void)
{
    QT0 = float64_to_float128(DT1, &env->fp_status);
}
#endif

198 199 200 201 202 203 204 205 206 207 208
/* Float to integer conversion.  */
void helper_fstoi(void)
{
    *((int32_t *)&FT0) = float32_to_int32_round_to_zero(FT1, &env->fp_status);
}

void helper_fdtoi(void)
{
    *((int32_t *)&FT0) = float64_to_int32_round_to_zero(DT1, &env->fp_status);
}

B
blueswir1 已提交
209 210 211 212 213 214 215
#if defined(CONFIG_USER_ONLY)
void helper_fqtoi(void)
{
    *((int32_t *)&FT0) = float128_to_int32_round_to_zero(QT1, &env->fp_status);
}
#endif

216 217 218 219 220 221 222 223 224 225 226
#ifdef TARGET_SPARC64
void helper_fstox(void)
{
    *((int64_t *)&DT0) = float32_to_int64_round_to_zero(FT1, &env->fp_status);
}

void helper_fdtox(void)
{
    *((int64_t *)&DT0) = float64_to_int64_round_to_zero(DT1, &env->fp_status);
}

B
blueswir1 已提交
227 228 229 230 231 232 233
#if defined(CONFIG_USER_ONLY)
void helper_fqtox(void)
{
    *((int64_t *)&DT0) = float128_to_int64_round_to_zero(QT1, &env->fp_status);
}
#endif

234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710
void helper_faligndata(void)
{
    uint64_t tmp;

    tmp = (*((uint64_t *)&DT0)) << ((env->gsr & 7) * 8);
    tmp |= (*((uint64_t *)&DT1)) >> (64 - (env->gsr & 7) * 8);
    *((uint64_t *)&DT0) = tmp;
}

void helper_movl_FT0_0(void)
{
    *((uint32_t *)&FT0) = 0;
}

void helper_movl_DT0_0(void)
{
    *((uint64_t *)&DT0) = 0;
}

void helper_movl_FT0_1(void)
{
    *((uint32_t *)&FT0) = 0xffffffff;
}

void helper_movl_DT0_1(void)
{
    *((uint64_t *)&DT0) = 0xffffffffffffffffULL;
}

void helper_fnot(void)
{
    *(uint64_t *)&DT0 = ~*(uint64_t *)&DT1;
}

void helper_fnots(void)
{
    *(uint32_t *)&FT0 = ~*(uint32_t *)&FT1;
}

void helper_fnor(void)
{
    *(uint64_t *)&DT0 = ~(*(uint64_t *)&DT0 | *(uint64_t *)&DT1);
}

void helper_fnors(void)
{
    *(uint32_t *)&FT0 = ~(*(uint32_t *)&FT0 | *(uint32_t *)&FT1);
}

void helper_for(void)
{
    *(uint64_t *)&DT0 |= *(uint64_t *)&DT1;
}

void helper_fors(void)
{
    *(uint32_t *)&FT0 |= *(uint32_t *)&FT1;
}

void helper_fxor(void)
{
    *(uint64_t *)&DT0 ^= *(uint64_t *)&DT1;
}

void helper_fxors(void)
{
    *(uint32_t *)&FT0 ^= *(uint32_t *)&FT1;
}

void helper_fand(void)
{
    *(uint64_t *)&DT0 &= *(uint64_t *)&DT1;
}

void helper_fands(void)
{
    *(uint32_t *)&FT0 &= *(uint32_t *)&FT1;
}

void helper_fornot(void)
{
    *(uint64_t *)&DT0 = *(uint64_t *)&DT0 | ~*(uint64_t *)&DT1;
}

void helper_fornots(void)
{
    *(uint32_t *)&FT0 = *(uint32_t *)&FT0 | ~*(uint32_t *)&FT1;
}

void helper_fandnot(void)
{
    *(uint64_t *)&DT0 = *(uint64_t *)&DT0 & ~*(uint64_t *)&DT1;
}

void helper_fandnots(void)
{
    *(uint32_t *)&FT0 = *(uint32_t *)&FT0 & ~*(uint32_t *)&FT1;
}

void helper_fnand(void)
{
    *(uint64_t *)&DT0 = ~(*(uint64_t *)&DT0 & *(uint64_t *)&DT1);
}

void helper_fnands(void)
{
    *(uint32_t *)&FT0 = ~(*(uint32_t *)&FT0 & *(uint32_t *)&FT1);
}

void helper_fxnor(void)
{
    *(uint64_t *)&DT0 ^= ~*(uint64_t *)&DT1;
}

void helper_fxnors(void)
{
    *(uint32_t *)&FT0 ^= ~*(uint32_t *)&FT1;
}

#ifdef WORDS_BIGENDIAN
#define VIS_B64(n) b[7 - (n)]
#define VIS_W64(n) w[3 - (n)]
#define VIS_SW64(n) sw[3 - (n)]
#define VIS_L64(n) l[1 - (n)]
#define VIS_B32(n) b[3 - (n)]
#define VIS_W32(n) w[1 - (n)]
#else
#define VIS_B64(n) b[n]
#define VIS_W64(n) w[n]
#define VIS_SW64(n) sw[n]
#define VIS_L64(n) l[n]
#define VIS_B32(n) b[n]
#define VIS_W32(n) w[n]
#endif

typedef union {
    uint8_t b[8];
    uint16_t w[4];
    int16_t sw[4];
    uint32_t l[2];
    float64 d;
} vis64;

typedef union {
    uint8_t b[4];
    uint16_t w[2];
    uint32_t l;
    float32 f;
} vis32;

void helper_fpmerge(void)
{
    vis64 s, d;

    s.d = DT0;
    d.d = DT1;

    // Reverse calculation order to handle overlap
    d.VIS_B64(7) = s.VIS_B64(3);
    d.VIS_B64(6) = d.VIS_B64(3);
    d.VIS_B64(5) = s.VIS_B64(2);
    d.VIS_B64(4) = d.VIS_B64(2);
    d.VIS_B64(3) = s.VIS_B64(1);
    d.VIS_B64(2) = d.VIS_B64(1);
    d.VIS_B64(1) = s.VIS_B64(0);
    //d.VIS_B64(0) = d.VIS_B64(0);

    DT0 = d.d;
}

void helper_fmul8x16(void)
{
    vis64 s, d;
    uint32_t tmp;

    s.d = DT0;
    d.d = DT1;

#define PMUL(r)                                                 \
    tmp = (int32_t)d.VIS_SW64(r) * (int32_t)s.VIS_B64(r);       \
    if ((tmp & 0xff) > 0x7f)                                    \
        tmp += 0x100;                                           \
    d.VIS_W64(r) = tmp >> 8;

    PMUL(0);
    PMUL(1);
    PMUL(2);
    PMUL(3);
#undef PMUL

    DT0 = d.d;
}

void helper_fmul8x16al(void)
{
    vis64 s, d;
    uint32_t tmp;

    s.d = DT0;
    d.d = DT1;

#define PMUL(r)                                                 \
    tmp = (int32_t)d.VIS_SW64(1) * (int32_t)s.VIS_B64(r);       \
    if ((tmp & 0xff) > 0x7f)                                    \
        tmp += 0x100;                                           \
    d.VIS_W64(r) = tmp >> 8;

    PMUL(0);
    PMUL(1);
    PMUL(2);
    PMUL(3);
#undef PMUL

    DT0 = d.d;
}

void helper_fmul8x16au(void)
{
    vis64 s, d;
    uint32_t tmp;

    s.d = DT0;
    d.d = DT1;

#define PMUL(r)                                                 \
    tmp = (int32_t)d.VIS_SW64(0) * (int32_t)s.VIS_B64(r);       \
    if ((tmp & 0xff) > 0x7f)                                    \
        tmp += 0x100;                                           \
    d.VIS_W64(r) = tmp >> 8;

    PMUL(0);
    PMUL(1);
    PMUL(2);
    PMUL(3);
#undef PMUL

    DT0 = d.d;
}

void helper_fmul8sux16(void)
{
    vis64 s, d;
    uint32_t tmp;

    s.d = DT0;
    d.d = DT1;

#define PMUL(r)                                                         \
    tmp = (int32_t)d.VIS_SW64(r) * ((int32_t)s.VIS_SW64(r) >> 8);       \
    if ((tmp & 0xff) > 0x7f)                                            \
        tmp += 0x100;                                                   \
    d.VIS_W64(r) = tmp >> 8;

    PMUL(0);
    PMUL(1);
    PMUL(2);
    PMUL(3);
#undef PMUL

    DT0 = d.d;
}

void helper_fmul8ulx16(void)
{
    vis64 s, d;
    uint32_t tmp;

    s.d = DT0;
    d.d = DT1;

#define PMUL(r)                                                         \
    tmp = (int32_t)d.VIS_SW64(r) * ((uint32_t)s.VIS_B64(r * 2));        \
    if ((tmp & 0xff) > 0x7f)                                            \
        tmp += 0x100;                                                   \
    d.VIS_W64(r) = tmp >> 8;

    PMUL(0);
    PMUL(1);
    PMUL(2);
    PMUL(3);
#undef PMUL

    DT0 = d.d;
}

void helper_fmuld8sux16(void)
{
    vis64 s, d;
    uint32_t tmp;

    s.d = DT0;
    d.d = DT1;

#define PMUL(r)                                                         \
    tmp = (int32_t)d.VIS_SW64(r) * ((int32_t)s.VIS_SW64(r) >> 8);       \
    if ((tmp & 0xff) > 0x7f)                                            \
        tmp += 0x100;                                                   \
    d.VIS_L64(r) = tmp;

    // Reverse calculation order to handle overlap
    PMUL(1);
    PMUL(0);
#undef PMUL

    DT0 = d.d;
}

void helper_fmuld8ulx16(void)
{
    vis64 s, d;
    uint32_t tmp;

    s.d = DT0;
    d.d = DT1;

#define PMUL(r)                                                         \
    tmp = (int32_t)d.VIS_SW64(r) * ((uint32_t)s.VIS_B64(r * 2));        \
    if ((tmp & 0xff) > 0x7f)                                            \
        tmp += 0x100;                                                   \
    d.VIS_L64(r) = tmp;

    // Reverse calculation order to handle overlap
    PMUL(1);
    PMUL(0);
#undef PMUL

    DT0 = d.d;
}

void helper_fexpand(void)
{
    vis32 s;
    vis64 d;

    s.l = (uint32_t)(*(uint64_t *)&DT0 & 0xffffffff);
    d.d = DT1;
    d.VIS_L64(0) = s.VIS_W32(0) << 4;
    d.VIS_L64(1) = s.VIS_W32(1) << 4;
    d.VIS_L64(2) = s.VIS_W32(2) << 4;
    d.VIS_L64(3) = s.VIS_W32(3) << 4;

    DT0 = d.d;
}

#define VIS_HELPER(name, F)                             \
    void name##16(void)                                 \
    {                                                   \
        vis64 s, d;                                     \
                                                        \
        s.d = DT0;                                      \
        d.d = DT1;                                      \
                                                        \
        d.VIS_W64(0) = F(d.VIS_W64(0), s.VIS_W64(0));   \
        d.VIS_W64(1) = F(d.VIS_W64(1), s.VIS_W64(1));   \
        d.VIS_W64(2) = F(d.VIS_W64(2), s.VIS_W64(2));   \
        d.VIS_W64(3) = F(d.VIS_W64(3), s.VIS_W64(3));   \
                                                        \
        DT0 = d.d;                                      \
    }                                                   \
                                                        \
    void name##16s(void)                                \
    {                                                   \
        vis32 s, d;                                     \
                                                        \
        s.f = FT0;                                      \
        d.f = FT1;                                      \
                                                        \
        d.VIS_W32(0) = F(d.VIS_W32(0), s.VIS_W32(0));   \
        d.VIS_W32(1) = F(d.VIS_W32(1), s.VIS_W32(1));   \
                                                        \
        FT0 = d.f;                                      \
    }                                                   \
                                                        \
    void name##32(void)                                 \
    {                                                   \
        vis64 s, d;                                     \
                                                        \
        s.d = DT0;                                      \
        d.d = DT1;                                      \
                                                        \
        d.VIS_L64(0) = F(d.VIS_L64(0), s.VIS_L64(0));   \
        d.VIS_L64(1) = F(d.VIS_L64(1), s.VIS_L64(1));   \
                                                        \
        DT0 = d.d;                                      \
    }                                                   \
                                                        \
    void name##32s(void)                                \
    {                                                   \
        vis32 s, d;                                     \
                                                        \
        s.f = FT0;                                      \
        d.f = FT1;                                      \
                                                        \
        d.l = F(d.l, s.l);                              \
                                                        \
        FT0 = d.f;                                      \
    }

#define FADD(a, b) ((a) + (b))
#define FSUB(a, b) ((a) - (b))
VIS_HELPER(helper_fpadd, FADD)
VIS_HELPER(helper_fpsub, FSUB)

#define VIS_CMPHELPER(name, F)                                        \
    void name##16(void)                                           \
    {                                                             \
        vis64 s, d;                                               \
                                                                  \
        s.d = DT0;                                                \
        d.d = DT1;                                                \
                                                                  \
        d.VIS_W64(0) = F(d.VIS_W64(0), s.VIS_W64(0))? 1: 0;       \
        d.VIS_W64(0) |= F(d.VIS_W64(1), s.VIS_W64(1))? 2: 0;      \
        d.VIS_W64(0) |= F(d.VIS_W64(2), s.VIS_W64(2))? 4: 0;      \
        d.VIS_W64(0) |= F(d.VIS_W64(3), s.VIS_W64(3))? 8: 0;      \
                                                                  \
        DT0 = d.d;                                                \
    }                                                             \
                                                                  \
    void name##32(void)                                           \
    {                                                             \
        vis64 s, d;                                               \
                                                                  \
        s.d = DT0;                                                \
        d.d = DT1;                                                \
                                                                  \
        d.VIS_L64(0) = F(d.VIS_L64(0), s.VIS_L64(0))? 1: 0;       \
        d.VIS_L64(0) |= F(d.VIS_L64(1), s.VIS_L64(1))? 2: 0;      \
                                                                  \
        DT0 = d.d;                                                \
    }

#define FCMPGT(a, b) ((a) > (b))
#define FCMPEQ(a, b) ((a) == (b))
#define FCMPLE(a, b) ((a) <= (b))
#define FCMPNE(a, b) ((a) != (b))

VIS_CMPHELPER(helper_fcmpgt, FCMPGT)
VIS_CMPHELPER(helper_fcmpeq, FCMPEQ)
VIS_CMPHELPER(helper_fcmple, FCMPLE)
VIS_CMPHELPER(helper_fcmpne, FCMPNE)
#endif

void helper_check_ieee_exceptions(void)
{
    target_ulong status;

    status = get_float_exception_flags(&env->fp_status);
    if (status) {
        /* Copy IEEE 754 flags into FSR */
        if (status & float_flag_invalid)
            env->fsr |= FSR_NVC;
        if (status & float_flag_overflow)
            env->fsr |= FSR_OFC;
        if (status & float_flag_underflow)
            env->fsr |= FSR_UFC;
        if (status & float_flag_divbyzero)
            env->fsr |= FSR_DZC;
        if (status & float_flag_inexact)
            env->fsr |= FSR_NXC;

        if ((env->fsr & FSR_CEXC_MASK) & ((env->fsr & FSR_TEM_MASK) >> 23)) {
            /* Unmasked exception, generate a trap */
            env->fsr |= FSR_FTT_IEEE_EXCP;
            raise_exception(TT_FP_EXCP);
        } else {
            /* Accumulate exceptions */
            env->fsr |= (env->fsr & FSR_CEXC_MASK) << 5;
        }
    }
}

void helper_clear_float_exceptions(void)
{
    set_float_exception_flags(0, &env->fp_status);
}

711
void helper_fabss(void)
712
{
B
bellard 已提交
713
    FT0 = float32_abs(FT1);
714 715
}

B
bellard 已提交
716
#ifdef TARGET_SPARC64
717
void helper_fabsd(void)
B
bellard 已提交
718 719 720
{
    DT0 = float64_abs(DT1);
}
B
blueswir1 已提交
721 722 723 724 725 726 727

#if defined(CONFIG_USER_ONLY)
void helper_fabsq(void)
{
    QT0 = float128_abs(QT1);
}
#endif
B
bellard 已提交
728 729
#endif

730
void helper_fsqrts(void)
731
{
B
bellard 已提交
732
    FT0 = float32_sqrt(FT1, &env->fp_status);
733 734
}

735
void helper_fsqrtd(void)
736
{
B
bellard 已提交
737
    DT0 = float64_sqrt(DT1, &env->fp_status);
738 739
}

B
blueswir1 已提交
740 741 742 743 744 745 746
#if defined(CONFIG_USER_ONLY)
void helper_fsqrtq(void)
{
    QT0 = float128_sqrt(QT1, &env->fp_status);
}
#endif

747
#define GEN_FCMP(name, size, reg1, reg2, FS, TRAP)                      \
748
    void glue(helper_, name) (void)                                     \
B
bellard 已提交
749
    {                                                                   \
B
blueswir1 已提交
750 751
        target_ulong new_fsr;                                           \
                                                                        \
B
bellard 已提交
752 753 754
        env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                     \
        switch (glue(size, _compare) (reg1, reg2, &env->fp_status)) {   \
        case float_relation_unordered:                                  \
B
blueswir1 已提交
755
            new_fsr = (FSR_FCC1 | FSR_FCC0) << FS;                      \
756
            if ((env->fsr & FSR_NVM) || TRAP) {                         \
B
blueswir1 已提交
757
                env->fsr |= new_fsr;                                    \
758 759
                env->fsr |= FSR_NVC;                                    \
                env->fsr |= FSR_FTT_IEEE_EXCP;                          \
B
bellard 已提交
760 761 762 763 764 765
                raise_exception(TT_FP_EXCP);                            \
            } else {                                                    \
                env->fsr |= FSR_NVA;                                    \
            }                                                           \
            break;                                                      \
        case float_relation_less:                                       \
B
blueswir1 已提交
766
            new_fsr = FSR_FCC0 << FS;                                   \
B
bellard 已提交
767 768
            break;                                                      \
        case float_relation_greater:                                    \
B
blueswir1 已提交
769
            new_fsr = FSR_FCC1 << FS;                                   \
B
bellard 已提交
770 771
            break;                                                      \
        default:                                                        \
B
blueswir1 已提交
772
            new_fsr = 0;                                                \
B
bellard 已提交
773 774
            break;                                                      \
        }                                                               \
B
blueswir1 已提交
775
        env->fsr |= new_fsr;                                            \
776 777
    }

778 779 780 781 782
GEN_FCMP(fcmps, float32, FT0, FT1, 0, 0);
GEN_FCMP(fcmpd, float64, DT0, DT1, 0, 0);

GEN_FCMP(fcmpes, float32, FT0, FT1, 0, 1);
GEN_FCMP(fcmped, float64, DT0, DT1, 0, 1);
B
bellard 已提交
783

B
blueswir1 已提交
784 785 786 787 788
#ifdef CONFIG_USER_ONLY
GEN_FCMP(fcmpq, float128, QT0, QT1, 0, 0);
GEN_FCMP(fcmpeq, float128, QT0, QT1, 0, 1);
#endif

B
bellard 已提交
789
#ifdef TARGET_SPARC64
790 791 792 793 794 795 796 797 798 799 800
GEN_FCMP(fcmps_fcc1, float32, FT0, FT1, 22, 0);
GEN_FCMP(fcmpd_fcc1, float64, DT0, DT1, 22, 0);

GEN_FCMP(fcmps_fcc2, float32, FT0, FT1, 24, 0);
GEN_FCMP(fcmpd_fcc2, float64, DT0, DT1, 24, 0);

GEN_FCMP(fcmps_fcc3, float32, FT0, FT1, 26, 0);
GEN_FCMP(fcmpd_fcc3, float64, DT0, DT1, 26, 0);

GEN_FCMP(fcmpes_fcc1, float32, FT0, FT1, 22, 1);
GEN_FCMP(fcmped_fcc1, float64, DT0, DT1, 22, 1);
B
bellard 已提交
801

802 803
GEN_FCMP(fcmpes_fcc2, float32, FT0, FT1, 24, 1);
GEN_FCMP(fcmped_fcc2, float64, DT0, DT1, 24, 1);
B
bellard 已提交
804

805 806
GEN_FCMP(fcmpes_fcc3, float32, FT0, FT1, 26, 1);
GEN_FCMP(fcmped_fcc3, float64, DT0, DT1, 26, 1);
B
blueswir1 已提交
807 808 809 810 811 812 813 814
#ifdef CONFIG_USER_ONLY
GEN_FCMP(fcmpq_fcc1, float128, QT0, QT1, 22, 0);
GEN_FCMP(fcmpq_fcc2, float128, QT0, QT1, 24, 0);
GEN_FCMP(fcmpq_fcc3, float128, QT0, QT1, 26, 0);
GEN_FCMP(fcmpeq_fcc1, float128, QT0, QT1, 22, 1);
GEN_FCMP(fcmpeq_fcc2, float128, QT0, QT1, 24, 1);
GEN_FCMP(fcmpeq_fcc3, float128, QT0, QT1, 26, 1);
#endif
B
bellard 已提交
815 816
#endif

B
blueswir1 已提交
817
#if !defined(TARGET_SPARC64) && !defined(CONFIG_USER_ONLY) && defined(DEBUG_MXCC)
818 819 820 821 822 823 824 825 826 827 828
static void dump_mxcc(CPUState *env)
{
    printf("mxccdata: %016llx %016llx %016llx %016llx\n",
        env->mxccdata[0], env->mxccdata[1], env->mxccdata[2], env->mxccdata[3]);
    printf("mxccregs: %016llx %016llx %016llx %016llx\n"
           "          %016llx %016llx %016llx %016llx\n",
        env->mxccregs[0], env->mxccregs[1], env->mxccregs[2], env->mxccregs[3],
        env->mxccregs[4], env->mxccregs[5], env->mxccregs[6], env->mxccregs[7]);
}
#endif

B
blueswir1 已提交
829 830 831 832
#if (defined(TARGET_SPARC64) || !defined(CONFIG_USER_ONLY)) \
    && defined(DEBUG_ASI)
static void dump_asi(const char *txt, target_ulong addr, int asi, int size,
                     uint64_t r1)
833 834 835 836
{
    switch (size)
    {
    case 1:
B
blueswir1 已提交
837 838
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %02" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xff);
839 840
        break;
    case 2:
B
blueswir1 已提交
841 842
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %04" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xffff);
843 844
        break;
    case 4:
B
blueswir1 已提交
845 846
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %08" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xffffffff);
847 848
        break;
    case 8:
B
blueswir1 已提交
849 850
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %016" PRIx64 "\n", txt,
                    addr, asi, r1);
851 852 853 854 855
        break;
    }
}
#endif

B
blueswir1 已提交
856 857 858
#ifndef TARGET_SPARC64
#ifndef CONFIG_USER_ONLY
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
859
{
B
blueswir1 已提交
860
    uint64_t ret = 0;
861
#if defined(DEBUG_MXCC) || defined(DEBUG_ASI)
B
blueswir1 已提交
862
    uint32_t last_addr = addr;
863
#endif
B
bellard 已提交
864 865

    switch (asi) {
866
    case 2: /* SuperSparc MXCC registers */
B
blueswir1 已提交
867
        switch (addr) {
868
        case 0x01c00a00: /* MXCC control register */
B
blueswir1 已提交
869 870 871 872
            if (size == 8)
                ret = env->mxccregs[3];
            else
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
873 874 875 876 877
            break;
        case 0x01c00a04: /* MXCC control register */
            if (size == 4)
                ret = env->mxccregs[3];
            else
B
blueswir1 已提交
878
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
879
            break;
880 881
        case 0x01c00c00: /* Module reset register */
            if (size == 8) {
B
blueswir1 已提交
882
                ret = env->mxccregs[5];
883 884
                // should we do something here?
            } else
B
blueswir1 已提交
885
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
886
            break;
887
        case 0x01c00f00: /* MBus port address register */
B
blueswir1 已提交
888 889 890 891
            if (size == 8)
                ret = env->mxccregs[7];
            else
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
892 893
            break;
        default:
B
blueswir1 已提交
894
            DPRINTF_MXCC("%08x: unimplemented address, size: %d\n", addr, size);
895 896
            break;
        }
B
blueswir1 已提交
897 898
        DPRINTF_MXCC("asi = %d, size = %d, sign = %d, addr = %08x -> ret = %08x,"
                     "addr = %08x\n", asi, size, sign, last_addr, ret, addr);
899 900 901
#ifdef DEBUG_MXCC
        dump_mxcc(env);
#endif
902
        break;
903
    case 3: /* MMU probe */
B
blueswir1 已提交
904 905 906
        {
            int mmulev;

B
blueswir1 已提交
907
            mmulev = (addr >> 8) & 15;
B
blueswir1 已提交
908 909
            if (mmulev > 4)
                ret = 0;
B
blueswir1 已提交
910 911 912 913
            else
                ret = mmu_probe(env, addr, mmulev);
            DPRINTF_MMU("mmu_probe: 0x%08x (lev %d) -> 0x%08" PRIx64 "\n",
                        addr, mmulev, ret);
B
blueswir1 已提交
914 915
        }
        break;
916
    case 4: /* read MMU regs */
B
blueswir1 已提交
917
        {
B
blueswir1 已提交
918
            int reg = (addr >> 8) & 0x1f;
919

B
blueswir1 已提交
920 921
            ret = env->mmuregs[reg];
            if (reg == 3) /* Fault status cleared on read */
B
blueswir1 已提交
922 923 924 925 926
                env->mmuregs[3] = 0;
            else if (reg == 0x13) /* Fault status read */
                ret = env->mmuregs[3];
            else if (reg == 0x14) /* Fault address read */
                ret = env->mmuregs[4];
B
blueswir1 已提交
927
            DPRINTF_MMU("mmu_read: reg[%d] = 0x%08" PRIx64 "\n", reg, ret);
B
blueswir1 已提交
928 929
        }
        break;
B
blueswir1 已提交
930 931 932 933
    case 5: // Turbosparc ITLB Diagnostic
    case 6: // Turbosparc DTLB Diagnostic
    case 7: // Turbosparc IOTLB Diagnostic
        break;
934 935 936
    case 9: /* Supervisor code access */
        switch(size) {
        case 1:
B
blueswir1 已提交
937
            ret = ldub_code(addr);
938 939
            break;
        case 2:
B
blueswir1 已提交
940
            ret = lduw_code(addr & ~1);
941 942 943
            break;
        default:
        case 4:
B
blueswir1 已提交
944
            ret = ldl_code(addr & ~3);
945 946
            break;
        case 8:
B
blueswir1 已提交
947
            ret = ldq_code(addr & ~7);
948 949 950
            break;
        }
        break;
951 952 953
    case 0xa: /* User data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
954
            ret = ldub_user(addr);
955 956
            break;
        case 2:
B
blueswir1 已提交
957
            ret = lduw_user(addr & ~1);
958 959 960
            break;
        default:
        case 4:
B
blueswir1 已提交
961
            ret = ldl_user(addr & ~3);
962 963
            break;
        case 8:
B
blueswir1 已提交
964
            ret = ldq_user(addr & ~7);
965 966 967 968 969 970
            break;
        }
        break;
    case 0xb: /* Supervisor data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
971
            ret = ldub_kernel(addr);
972 973
            break;
        case 2:
B
blueswir1 已提交
974
            ret = lduw_kernel(addr & ~1);
975 976 977
            break;
        default:
        case 4:
B
blueswir1 已提交
978
            ret = ldl_kernel(addr & ~3);
979 980
            break;
        case 8:
B
blueswir1 已提交
981
            ret = ldq_kernel(addr & ~7);
982 983 984
            break;
        }
        break;
985 986 987 988 989 990
    case 0xc: /* I-cache tag */
    case 0xd: /* I-cache data */
    case 0xe: /* D-cache tag */
    case 0xf: /* D-cache data */
        break;
    case 0x20: /* MMU passthrough */
B
bellard 已提交
991 992
        switch(size) {
        case 1:
B
blueswir1 已提交
993
            ret = ldub_phys(addr);
B
bellard 已提交
994 995
            break;
        case 2:
B
blueswir1 已提交
996
            ret = lduw_phys(addr & ~1);
B
bellard 已提交
997 998 999
            break;
        default:
        case 4:
B
blueswir1 已提交
1000
            ret = ldl_phys(addr & ~3);
B
bellard 已提交
1001
            break;
B
bellard 已提交
1002
        case 8:
B
blueswir1 已提交
1003
            ret = ldq_phys(addr & ~7);
B
blueswir1 已提交
1004
            break;
B
bellard 已提交
1005
        }
B
blueswir1 已提交
1006
        break;
1007
    case 0x21 ... 0x2f: /* MMU passthrough, 0x100000000 to 0xfffffffff */
1008 1009
        switch(size) {
        case 1:
B
blueswir1 已提交
1010
            ret = ldub_phys((target_phys_addr_t)addr
1011 1012 1013
                            | ((target_phys_addr_t)(asi & 0xf) << 32));
            break;
        case 2:
B
blueswir1 已提交
1014
            ret = lduw_phys((target_phys_addr_t)(addr & ~1)
1015 1016 1017 1018
                            | ((target_phys_addr_t)(asi & 0xf) << 32));
            break;
        default:
        case 4:
B
blueswir1 已提交
1019
            ret = ldl_phys((target_phys_addr_t)(addr & ~3)
1020 1021 1022
                           | ((target_phys_addr_t)(asi & 0xf) << 32));
            break;
        case 8:
B
blueswir1 已提交
1023
            ret = ldq_phys((target_phys_addr_t)(addr & ~7)
1024
                           | ((target_phys_addr_t)(asi & 0xf) << 32));
B
blueswir1 已提交
1025
            break;
1026
        }
B
blueswir1 已提交
1027
        break;
B
blueswir1 已提交
1028 1029 1030
    case 0x30: // Turbosparc secondary cache diagnostic
    case 0x31: // Turbosparc RAM snoop
    case 0x32: // Turbosparc page table descriptor diagnostic
B
blueswir1 已提交
1031 1032 1033
    case 0x39: /* data cache diagnostic register */
        ret = 0;
        break;
B
blueswir1 已提交
1034
    case 8: /* User code access, XXX */
1035
    default:
B
blueswir1 已提交
1036
        do_unassigned_access(addr, 0, 0, asi);
B
blueswir1 已提交
1037 1038
        ret = 0;
        break;
1039
    }
1040 1041 1042
    if (sign) {
        switch(size) {
        case 1:
B
blueswir1 已提交
1043
            ret = (int8_t) ret;
B
blueswir1 已提交
1044
            break;
1045
        case 2:
B
blueswir1 已提交
1046 1047 1048 1049
            ret = (int16_t) ret;
            break;
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
1050
            break;
1051 1052 1053 1054
        default:
            break;
        }
    }
1055
#ifdef DEBUG_ASI
B
blueswir1 已提交
1056
    dump_asi("read ", last_addr, asi, size, ret);
1057
#endif
B
blueswir1 已提交
1058
    return ret;
1059 1060
}

B
blueswir1 已提交
1061
void helper_st_asi(target_ulong addr, uint64_t val, int asi, int size)
1062 1063
{
    switch(asi) {
1064
    case 2: /* SuperSparc MXCC registers */
B
blueswir1 已提交
1065
        switch (addr) {
1066 1067
        case 0x01c00000: /* MXCC stream data register 0 */
            if (size == 8)
B
blueswir1 已提交
1068
                env->mxccdata[0] = val;
1069
            else
B
blueswir1 已提交
1070
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1071 1072 1073
            break;
        case 0x01c00008: /* MXCC stream data register 1 */
            if (size == 8)
B
blueswir1 已提交
1074
                env->mxccdata[1] = val;
1075
            else
B
blueswir1 已提交
1076
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1077 1078 1079
            break;
        case 0x01c00010: /* MXCC stream data register 2 */
            if (size == 8)
B
blueswir1 已提交
1080
                env->mxccdata[2] = val;
1081
            else
B
blueswir1 已提交
1082
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1083 1084 1085
            break;
        case 0x01c00018: /* MXCC stream data register 3 */
            if (size == 8)
B
blueswir1 已提交
1086
                env->mxccdata[3] = val;
1087
            else
B
blueswir1 已提交
1088
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1089 1090 1091
            break;
        case 0x01c00100: /* MXCC stream source */
            if (size == 8)
B
blueswir1 已提交
1092
                env->mxccregs[0] = val;
1093
            else
B
blueswir1 已提交
1094
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1095 1096 1097 1098 1099 1100 1101
            env->mxccdata[0] = ldq_phys((env->mxccregs[0] & 0xffffffffULL) +  0);
            env->mxccdata[1] = ldq_phys((env->mxccregs[0] & 0xffffffffULL) +  8);
            env->mxccdata[2] = ldq_phys((env->mxccregs[0] & 0xffffffffULL) + 16);
            env->mxccdata[3] = ldq_phys((env->mxccregs[0] & 0xffffffffULL) + 24);
            break;
        case 0x01c00200: /* MXCC stream destination */
            if (size == 8)
B
blueswir1 已提交
1102
                env->mxccregs[1] = val;
1103
            else
B
blueswir1 已提交
1104
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1105 1106 1107 1108 1109 1110 1111
            stq_phys((env->mxccregs[1] & 0xffffffffULL) +  0, env->mxccdata[0]);
            stq_phys((env->mxccregs[1] & 0xffffffffULL) +  8, env->mxccdata[1]);
            stq_phys((env->mxccregs[1] & 0xffffffffULL) + 16, env->mxccdata[2]);
            stq_phys((env->mxccregs[1] & 0xffffffffULL) + 24, env->mxccdata[3]);
            break;
        case 0x01c00a00: /* MXCC control register */
            if (size == 8)
B
blueswir1 已提交
1112
                env->mxccregs[3] = val;
1113
            else
B
blueswir1 已提交
1114
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1115 1116 1117
            break;
        case 0x01c00a04: /* MXCC control register */
            if (size == 4)
B
blueswir1 已提交
1118
                env->mxccregs[3] = (env->mxccregs[0xa] & 0xffffffff00000000ULL) | val;
1119
            else
B
blueswir1 已提交
1120
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1121 1122
            break;
        case 0x01c00e00: /* MXCC error register  */
1123
            // writing a 1 bit clears the error
1124
            if (size == 8)
B
blueswir1 已提交
1125
                env->mxccregs[6] &= ~val;
1126
            else
B
blueswir1 已提交
1127
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1128 1129 1130
            break;
        case 0x01c00f00: /* MBus port address register */
            if (size == 8)
B
blueswir1 已提交
1131
                env->mxccregs[7] = val;
1132
            else
B
blueswir1 已提交
1133
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr, size);
1134 1135
            break;
        default:
B
blueswir1 已提交
1136
            DPRINTF_MXCC("%08x: unimplemented address, size: %d\n", addr, size);
1137 1138
            break;
        }
B
blueswir1 已提交
1139
        DPRINTF_MXCC("asi = %d, size = %d, addr = %08x, val = %08x\n", asi, size, addr, val);
1140 1141 1142
#ifdef DEBUG_MXCC
        dump_mxcc(env);
#endif
1143
        break;
1144
    case 3: /* MMU flush */
B
blueswir1 已提交
1145 1146
        {
            int mmulev;
B
bellard 已提交
1147

B
blueswir1 已提交
1148
            mmulev = (addr >> 8) & 15;
1149
            DPRINTF_MMU("mmu flush level %d\n", mmulev);
B
blueswir1 已提交
1150 1151
            switch (mmulev) {
            case 0: // flush page
B
blueswir1 已提交
1152
                tlb_flush_page(env, addr & 0xfffff000);
B
blueswir1 已提交
1153 1154 1155 1156 1157 1158 1159 1160 1161 1162
                break;
            case 1: // flush segment (256k)
            case 2: // flush region (16M)
            case 3: // flush context (4G)
            case 4: // flush entire
                tlb_flush(env, 1);
                break;
            default:
                break;
            }
B
bellard 已提交
1163
#ifdef DEBUG_MMU
B
blueswir1 已提交
1164
            dump_mmu(env);
B
bellard 已提交
1165
#endif
B
blueswir1 已提交
1166
        }
1167
        break;
1168
    case 4: /* write MMU regs */
B
blueswir1 已提交
1169
        {
B
blueswir1 已提交
1170
            int reg = (addr >> 8) & 0x1f;
B
blueswir1 已提交
1171
            uint32_t oldreg;
1172

B
blueswir1 已提交
1173
            oldreg = env->mmuregs[reg];
B
bellard 已提交
1174
            switch(reg) {
1175
            case 0: // Control Register
B
blueswir1 已提交
1176
                env->mmuregs[reg] = (env->mmuregs[reg] & 0xff000000) |
B
blueswir1 已提交
1177
                                    (val & 0x00ffffff);
B
blueswir1 已提交
1178 1179
                // Mappings generated during no-fault mode or MMU
                // disabled mode are invalid in normal mode
B
blueswir1 已提交
1180 1181
                if ((oldreg & (MMU_E | MMU_NF | env->mmu_bm)) !=
                    (env->mmuregs[reg] & (MMU_E | MMU_NF | env->mmu_bm)))
B
bellard 已提交
1182 1183
                    tlb_flush(env, 1);
                break;
1184
            case 1: // Context Table Pointer Register
B
blueswir1 已提交
1185
                env->mmuregs[reg] = val & env->mmu_ctpr_mask;
1186 1187
                break;
            case 2: // Context Register
B
blueswir1 已提交
1188
                env->mmuregs[reg] = val & env->mmu_cxr_mask;
B
bellard 已提交
1189 1190 1191 1192 1193 1194
                if (oldreg != env->mmuregs[reg]) {
                    /* we flush when the MMU context changes because
                       QEMU has no MMU context support */
                    tlb_flush(env, 1);
                }
                break;
1195 1196 1197 1198
            case 3: // Synchronous Fault Status Register with Clear
            case 4: // Synchronous Fault Address Register
                break;
            case 0x10: // TLB Replacement Control Register
B
blueswir1 已提交
1199
                env->mmuregs[reg] = val & env->mmu_trcr_mask;
B
bellard 已提交
1200
                break;
1201
            case 0x13: // Synchronous Fault Status Register with Read and Clear
B
blueswir1 已提交
1202
                env->mmuregs[3] = val & env->mmu_sfsr_mask;
B
blueswir1 已提交
1203
                break;
1204
            case 0x14: // Synchronous Fault Address Register
B
blueswir1 已提交
1205
                env->mmuregs[4] = val;
B
blueswir1 已提交
1206
                break;
B
bellard 已提交
1207
            default:
B
blueswir1 已提交
1208
                env->mmuregs[reg] = val;
B
bellard 已提交
1209 1210 1211
                break;
            }
            if (oldreg != env->mmuregs[reg]) {
1212
                DPRINTF_MMU("mmu change reg[%d]: 0x%08x -> 0x%08x\n", reg, oldreg, env->mmuregs[reg]);
B
bellard 已提交
1213
            }
1214
#ifdef DEBUG_MMU
B
blueswir1 已提交
1215
            dump_mmu(env);
B
bellard 已提交
1216
#endif
B
blueswir1 已提交
1217
        }
1218
        break;
B
blueswir1 已提交
1219 1220 1221 1222
    case 5: // Turbosparc ITLB Diagnostic
    case 6: // Turbosparc DTLB Diagnostic
    case 7: // Turbosparc IOTLB Diagnostic
        break;
1223 1224 1225
    case 0xa: /* User data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
1226
            stb_user(addr, val);
1227 1228
            break;
        case 2:
B
blueswir1 已提交
1229
            stw_user(addr & ~1, val);
1230 1231 1232
            break;
        default:
        case 4:
B
blueswir1 已提交
1233
            stl_user(addr & ~3, val);
1234 1235
            break;
        case 8:
B
blueswir1 已提交
1236
            stq_user(addr & ~7, val);
1237 1238 1239 1240 1241 1242
            break;
        }
        break;
    case 0xb: /* Supervisor data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
1243
            stb_kernel(addr, val);
1244 1245
            break;
        case 2:
B
blueswir1 已提交
1246
            stw_kernel(addr & ~1, val);
1247 1248 1249
            break;
        default:
        case 4:
B
blueswir1 已提交
1250
            stl_kernel(addr & ~3, val);
1251 1252
            break;
        case 8:
B
blueswir1 已提交
1253
            stq_kernel(addr & ~7, val);
1254 1255 1256
            break;
        }
        break;
1257 1258 1259 1260 1261 1262 1263 1264 1265 1266
    case 0xc: /* I-cache tag */
    case 0xd: /* I-cache data */
    case 0xe: /* D-cache tag */
    case 0xf: /* D-cache data */
    case 0x10: /* I/D-cache flush page */
    case 0x11: /* I/D-cache flush segment */
    case 0x12: /* I/D-cache flush region */
    case 0x13: /* I/D-cache flush context */
    case 0x14: /* I/D-cache flush user */
        break;
B
bellard 已提交
1267
    case 0x17: /* Block copy, sta access */
B
blueswir1 已提交
1268
        {
B
blueswir1 已提交
1269 1270
            // val = src
            // addr = dst
B
blueswir1 已提交
1271
            // copy 32 bytes
1272
            unsigned int i;
B
blueswir1 已提交
1273
            uint32_t src = val & ~3, dst = addr & ~3, temp;
1274

1275 1276 1277 1278
            for (i = 0; i < 32; i += 4, src += 4, dst += 4) {
                temp = ldl_kernel(src);
                stl_kernel(dst, temp);
            }
B
blueswir1 已提交
1279
        }
1280
        break;
B
bellard 已提交
1281
    case 0x1f: /* Block fill, stda access */
B
blueswir1 已提交
1282
        {
B
blueswir1 已提交
1283 1284
            // addr = dst
            // fill 32 bytes with val
1285
            unsigned int i;
B
blueswir1 已提交
1286
            uint32_t dst = addr & 7;
1287 1288 1289

            for (i = 0; i < 32; i += 8, dst += 8)
                stq_kernel(dst, val);
B
blueswir1 已提交
1290
        }
1291
        break;
1292
    case 0x20: /* MMU passthrough */
B
blueswir1 已提交
1293
        {
B
bellard 已提交
1294 1295
            switch(size) {
            case 1:
B
blueswir1 已提交
1296
                stb_phys(addr, val);
B
bellard 已提交
1297 1298
                break;
            case 2:
B
blueswir1 已提交
1299
                stw_phys(addr & ~1, val);
B
bellard 已提交
1300 1301 1302
                break;
            case 4:
            default:
B
blueswir1 已提交
1303
                stl_phys(addr & ~3, val);
B
bellard 已提交
1304
                break;
B
bellard 已提交
1305
            case 8:
B
blueswir1 已提交
1306
                stq_phys(addr & ~7, val);
B
bellard 已提交
1307
                break;
B
bellard 已提交
1308
            }
B
blueswir1 已提交
1309
        }
1310
        break;
B
blueswir1 已提交
1311
    case 0x21 ... 0x2f: /* MMU passthrough, 0x100000000 to 0xfffffffff */
B
blueswir1 已提交
1312
        {
1313 1314
            switch(size) {
            case 1:
B
blueswir1 已提交
1315 1316
                stb_phys((target_phys_addr_t)addr
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
1317 1318
                break;
            case 2:
B
blueswir1 已提交
1319 1320
                stw_phys((target_phys_addr_t)(addr & ~1)
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
1321 1322 1323
                break;
            case 4:
            default:
B
blueswir1 已提交
1324 1325
                stl_phys((target_phys_addr_t)(addr & ~3)
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
1326 1327
                break;
            case 8:
B
blueswir1 已提交
1328 1329
                stq_phys((target_phys_addr_t)(addr & ~7)
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
1330 1331
                break;
            }
B
blueswir1 已提交
1332
        }
1333
        break;
B
blueswir1 已提交
1334 1335 1336 1337
    case 0x30: // store buffer tags or Turbosparc secondary cache diagnostic
    case 0x31: // store buffer data, Ross RT620 I-cache flush or
               // Turbosparc snoop RAM
    case 0x32: // store buffer control or Turbosparc page table descriptor diagnostic
1338 1339
    case 0x36: /* I-cache flash clear */
    case 0x37: /* D-cache flash clear */
B
blueswir1 已提交
1340 1341
    case 0x38: /* breakpoint diagnostics */
    case 0x4c: /* breakpoint action */
1342
        break;
B
blueswir1 已提交
1343
    case 8: /* User code access, XXX */
1344
    case 9: /* Supervisor code access, XXX */
1345
    default:
B
blueswir1 已提交
1346
        do_unassigned_access(addr, 1, 0, asi);
1347
        break;
1348
    }
1349
#ifdef DEBUG_ASI
B
blueswir1 已提交
1350
    dump_asi("write", addr, asi, size, val);
1351
#endif
1352 1353
}

1354 1355 1356 1357
#endif /* CONFIG_USER_ONLY */
#else /* TARGET_SPARC64 */

#ifdef CONFIG_USER_ONLY
B
blueswir1 已提交
1358
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
1359 1360
{
    uint64_t ret = 0;
B
blueswir1 已提交
1361 1362 1363
#if defined(DEBUG_ASI)
    target_ulong last_addr = addr;
#endif
1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375

    if (asi < 0x80)
        raise_exception(TT_PRIV_ACT);

    switch (asi) {
    case 0x80: // Primary
    case 0x82: // Primary no-fault
    case 0x88: // Primary LE
    case 0x8a: // Primary no-fault LE
        {
            switch(size) {
            case 1:
B
blueswir1 已提交
1376
                ret = ldub_raw(addr);
1377 1378
                break;
            case 2:
B
blueswir1 已提交
1379
                ret = lduw_raw(addr & ~1);
1380 1381
                break;
            case 4:
B
blueswir1 已提交
1382
                ret = ldl_raw(addr & ~3);
1383 1384 1385
                break;
            default:
            case 8:
B
blueswir1 已提交
1386
                ret = ldq_raw(addr & ~7);
1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409
                break;
            }
        }
        break;
    case 0x81: // Secondary
    case 0x83: // Secondary no-fault
    case 0x89: // Secondary LE
    case 0x8b: // Secondary no-fault LE
        // XXX
        break;
    default:
        break;
    }

    /* Convert from little endian */
    switch (asi) {
    case 0x88: // Primary LE
    case 0x89: // Secondary LE
    case 0x8a: // Primary no-fault LE
    case 0x8b: // Secondary no-fault LE
        switch(size) {
        case 2:
            ret = bswap16(ret);
B
blueswir1 已提交
1410
            break;
1411 1412
        case 4:
            ret = bswap32(ret);
B
blueswir1 已提交
1413
            break;
1414 1415
        case 8:
            ret = bswap64(ret);
B
blueswir1 已提交
1416
            break;
1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428
        default:
            break;
        }
    default:
        break;
    }

    /* Convert to signed number */
    if (sign) {
        switch(size) {
        case 1:
            ret = (int8_t) ret;
B
blueswir1 已提交
1429
            break;
1430 1431
        case 2:
            ret = (int16_t) ret;
B
blueswir1 已提交
1432
            break;
1433 1434
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
1435
            break;
1436 1437 1438 1439
        default:
            break;
        }
    }
B
blueswir1 已提交
1440 1441 1442 1443
#ifdef DEBUG_ASI
    dump_asi("read ", last_addr, asi, size, ret);
#endif
    return ret;
1444 1445
}

B
blueswir1 已提交
1446
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
1447
{
B
blueswir1 已提交
1448 1449 1450
#ifdef DEBUG_ASI
    dump_asi("write", addr, asi, size, val);
#endif
1451 1452 1453 1454 1455 1456 1457 1458 1459
    if (asi < 0x80)
        raise_exception(TT_PRIV_ACT);

    /* Convert to little endian */
    switch (asi) {
    case 0x88: // Primary LE
    case 0x89: // Secondary LE
        switch(size) {
        case 2:
B
blueswir1 已提交
1460
            addr = bswap16(addr);
B
blueswir1 已提交
1461
            break;
1462
        case 4:
B
blueswir1 已提交
1463
            addr = bswap32(addr);
B
blueswir1 已提交
1464
            break;
1465
        case 8:
B
blueswir1 已提交
1466
            addr = bswap64(addr);
B
blueswir1 已提交
1467
            break;
1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480
        default:
            break;
        }
    default:
        break;
    }

    switch(asi) {
    case 0x80: // Primary
    case 0x88: // Primary LE
        {
            switch(size) {
            case 1:
B
blueswir1 已提交
1481
                stb_raw(addr, val);
1482 1483
                break;
            case 2:
B
blueswir1 已提交
1484
                stw_raw(addr & ~1, val);
1485 1486
                break;
            case 4:
B
blueswir1 已提交
1487
                stl_raw(addr & ~3, val);
1488 1489 1490
                break;
            case 8:
            default:
B
blueswir1 已提交
1491
                stq_raw(addr & ~7, val);
1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505
                break;
            }
        }
        break;
    case 0x81: // Secondary
    case 0x89: // Secondary LE
        // XXX
        return;

    case 0x82: // Primary no-fault, RO
    case 0x83: // Secondary no-fault, RO
    case 0x8a: // Primary no-fault LE, RO
    case 0x8b: // Secondary no-fault LE, RO
    default:
B
blueswir1 已提交
1506
        do_unassigned_access(addr, 1, 0, 1);
1507 1508 1509 1510 1511
        return;
    }
}

#else /* CONFIG_USER_ONLY */
B
bellard 已提交
1512

B
blueswir1 已提交
1513
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
B
bellard 已提交
1514
{
B
bellard 已提交
1515
    uint64_t ret = 0;
B
blueswir1 已提交
1516 1517 1518
#if defined(DEBUG_ASI)
    target_ulong last_addr = addr;
#endif
B
bellard 已提交
1519

B
blueswir1 已提交
1520
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
B
blueswir1 已提交
1521
        || (asi >= 0x30 && asi < 0x80 && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
1522
        raise_exception(TT_PRIV_ACT);
B
bellard 已提交
1523 1524

    switch (asi) {
1525 1526 1527 1528 1529 1530 1531
    case 0x10: // As if user primary
    case 0x18: // As if user primary LE
    case 0x80: // Primary
    case 0x82: // Primary no-fault
    case 0x88: // Primary LE
    case 0x8a: // Primary no-fault LE
        if ((asi & 0x80) && (env->pstate & PS_PRIV)) {
B
blueswir1 已提交
1532 1533 1534
            if (env->hpstate & HS_PRIV) {
                switch(size) {
                case 1:
B
blueswir1 已提交
1535
                    ret = ldub_hypv(addr);
B
blueswir1 已提交
1536 1537
                    break;
                case 2:
B
blueswir1 已提交
1538
                    ret = lduw_hypv(addr & ~1);
B
blueswir1 已提交
1539 1540
                    break;
                case 4:
B
blueswir1 已提交
1541
                    ret = ldl_hypv(addr & ~3);
B
blueswir1 已提交
1542 1543 1544
                    break;
                default:
                case 8:
B
blueswir1 已提交
1545
                    ret = ldq_hypv(addr & ~7);
B
blueswir1 已提交
1546 1547 1548 1549 1550
                    break;
                }
            } else {
                switch(size) {
                case 1:
B
blueswir1 已提交
1551
                    ret = ldub_kernel(addr);
B
blueswir1 已提交
1552 1553
                    break;
                case 2:
B
blueswir1 已提交
1554
                    ret = lduw_kernel(addr & ~1);
B
blueswir1 已提交
1555 1556
                    break;
                case 4:
B
blueswir1 已提交
1557
                    ret = ldl_kernel(addr & ~3);
B
blueswir1 已提交
1558 1559 1560
                    break;
                default:
                case 8:
B
blueswir1 已提交
1561
                    ret = ldq_kernel(addr & ~7);
B
blueswir1 已提交
1562 1563
                    break;
                }
1564 1565 1566 1567
            }
        } else {
            switch(size) {
            case 1:
B
blueswir1 已提交
1568
                ret = ldub_user(addr);
1569 1570
                break;
            case 2:
B
blueswir1 已提交
1571
                ret = lduw_user(addr & ~1);
1572 1573
                break;
            case 4:
B
blueswir1 已提交
1574
                ret = ldl_user(addr & ~3);
1575 1576 1577
                break;
            default:
            case 8:
B
blueswir1 已提交
1578
                ret = ldq_user(addr & ~7);
1579 1580 1581 1582
                break;
            }
        }
        break;
B
bellard 已提交
1583 1584
    case 0x14: // Bypass
    case 0x15: // Bypass, non-cacheable
1585 1586
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
B
blueswir1 已提交
1587
        {
B
bellard 已提交
1588 1589
            switch(size) {
            case 1:
B
blueswir1 已提交
1590
                ret = ldub_phys(addr);
B
bellard 已提交
1591 1592
                break;
            case 2:
B
blueswir1 已提交
1593
                ret = lduw_phys(addr & ~1);
B
bellard 已提交
1594 1595
                break;
            case 4:
B
blueswir1 已提交
1596
                ret = ldl_phys(addr & ~3);
B
bellard 已提交
1597 1598 1599
                break;
            default:
            case 8:
B
blueswir1 已提交
1600
                ret = ldq_phys(addr & ~7);
B
bellard 已提交
1601 1602
                break;
            }
B
blueswir1 已提交
1603 1604
            break;
        }
B
bellard 已提交
1605 1606 1607 1608 1609 1610 1611
    case 0x04: // Nucleus
    case 0x0c: // Nucleus Little Endian (LE)
    case 0x11: // As if user secondary
    case 0x19: // As if user secondary LE
    case 0x24: // Nucleus quad LDD 128 bit atomic
    case 0x2c: // Nucleus quad LDD 128 bit atomic
    case 0x4a: // UPA config
1612
    case 0x81: // Secondary
B
bellard 已提交
1613 1614 1615
    case 0x83: // Secondary no-fault
    case 0x89: // Secondary LE
    case 0x8b: // Secondary no-fault LE
B
blueswir1 已提交
1616 1617
        // XXX
        break;
B
bellard 已提交
1618
    case 0x45: // LSU
B
blueswir1 已提交
1619 1620
        ret = env->lsu;
        break;
B
bellard 已提交
1621
    case 0x50: // I-MMU regs
B
blueswir1 已提交
1622
        {
B
blueswir1 已提交
1623
            int reg = (addr >> 3) & 0xf;
B
bellard 已提交
1624

B
blueswir1 已提交
1625 1626 1627
            ret = env->immuregs[reg];
            break;
        }
B
bellard 已提交
1628 1629 1630
    case 0x51: // I-MMU 8k TSB pointer
    case 0x52: // I-MMU 64k TSB pointer
    case 0x55: // I-MMU data access
B
blueswir1 已提交
1631 1632
        // XXX
        break;
B
bellard 已提交
1633
    case 0x56: // I-MMU tag read
B
blueswir1 已提交
1634 1635 1636 1637 1638 1639
        {
            unsigned int i;

            for (i = 0; i < 64; i++) {
                // Valid, ctx match, vaddr match
                if ((env->itlb_tte[i] & 0x8000000000000000ULL) != 0 &&
B
blueswir1 已提交
1640
                    env->itlb_tag[i] == addr) {
B
blueswir1 已提交
1641 1642 1643 1644 1645 1646
                    ret = env->itlb_tag[i];
                    break;
                }
            }
            break;
        }
B
bellard 已提交
1647
    case 0x58: // D-MMU regs
B
blueswir1 已提交
1648
        {
B
blueswir1 已提交
1649
            int reg = (addr >> 3) & 0xf;
B
bellard 已提交
1650

B
blueswir1 已提交
1651 1652 1653
            ret = env->dmmuregs[reg];
            break;
        }
B
bellard 已提交
1654
    case 0x5e: // D-MMU tag read
B
blueswir1 已提交
1655 1656 1657 1658 1659 1660
        {
            unsigned int i;

            for (i = 0; i < 64; i++) {
                // Valid, ctx match, vaddr match
                if ((env->dtlb_tte[i] & 0x8000000000000000ULL) != 0 &&
B
blueswir1 已提交
1661
                    env->dtlb_tag[i] == addr) {
B
blueswir1 已提交
1662 1663 1664 1665 1666 1667
                    ret = env->dtlb_tag[i];
                    break;
                }
            }
            break;
        }
B
bellard 已提交
1668 1669 1670 1671
    case 0x59: // D-MMU 8k TSB pointer
    case 0x5a: // D-MMU 64k TSB pointer
    case 0x5b: // D-MMU data pointer
    case 0x5d: // D-MMU data access
B
bellard 已提交
1672 1673 1674
    case 0x48: // Interrupt dispatch, RO
    case 0x49: // Interrupt data receive
    case 0x7f: // Incoming interrupt vector, RO
B
blueswir1 已提交
1675 1676
        // XXX
        break;
B
bellard 已提交
1677 1678 1679 1680
    case 0x54: // I-MMU data in, WO
    case 0x57: // I-MMU demap, WO
    case 0x5c: // D-MMU data in, WO
    case 0x5f: // D-MMU demap, WO
B
bellard 已提交
1681
    case 0x77: // Interrupt vector, WO
B
bellard 已提交
1682
    default:
B
blueswir1 已提交
1683
        do_unassigned_access(addr, 0, 0, 1);
B
blueswir1 已提交
1684 1685
        ret = 0;
        break;
B
bellard 已提交
1686
    }
1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701

    /* Convert from little endian */
    switch (asi) {
    case 0x0c: // Nucleus Little Endian (LE)
    case 0x18: // As if user primary LE
    case 0x19: // As if user secondary LE
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
    case 0x88: // Primary LE
    case 0x89: // Secondary LE
    case 0x8a: // Primary no-fault LE
    case 0x8b: // Secondary no-fault LE
        switch(size) {
        case 2:
            ret = bswap16(ret);
B
blueswir1 已提交
1702
            break;
1703 1704
        case 4:
            ret = bswap32(ret);
B
blueswir1 已提交
1705
            break;
1706 1707
        case 8:
            ret = bswap64(ret);
B
blueswir1 已提交
1708
            break;
1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720
        default:
            break;
        }
    default:
        break;
    }

    /* Convert to signed number */
    if (sign) {
        switch(size) {
        case 1:
            ret = (int8_t) ret;
B
blueswir1 已提交
1721
            break;
1722 1723
        case 2:
            ret = (int16_t) ret;
B
blueswir1 已提交
1724
            break;
1725 1726
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
1727
            break;
1728 1729 1730 1731
        default:
            break;
        }
    }
B
blueswir1 已提交
1732 1733 1734 1735
#ifdef DEBUG_ASI
    dump_asi("read ", last_addr, asi, size, ret);
#endif
    return ret;
B
bellard 已提交
1736 1737
}

B
blueswir1 已提交
1738
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
B
bellard 已提交
1739
{
B
blueswir1 已提交
1740 1741 1742
#ifdef DEBUG_ASI
    dump_asi("write", addr, asi, size, val);
#endif
B
blueswir1 已提交
1743
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
B
blueswir1 已提交
1744
        || (asi >= 0x30 && asi < 0x80 && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
1745
        raise_exception(TT_PRIV_ACT);
B
bellard 已提交
1746

1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757
    /* Convert to little endian */
    switch (asi) {
    case 0x0c: // Nucleus Little Endian (LE)
    case 0x18: // As if user primary LE
    case 0x19: // As if user secondary LE
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
    case 0x88: // Primary LE
    case 0x89: // Secondary LE
        switch(size) {
        case 2:
B
blueswir1 已提交
1758
            addr = bswap16(addr);
B
blueswir1 已提交
1759
            break;
1760
        case 4:
B
blueswir1 已提交
1761
            addr = bswap32(addr);
B
blueswir1 已提交
1762
            break;
1763
        case 8:
B
blueswir1 已提交
1764
            addr = bswap64(addr);
B
blueswir1 已提交
1765
            break;
1766 1767 1768 1769 1770 1771 1772
        default:
            break;
        }
    default:
        break;
    }

B
bellard 已提交
1773
    switch(asi) {
1774 1775 1776 1777 1778
    case 0x10: // As if user primary
    case 0x18: // As if user primary LE
    case 0x80: // Primary
    case 0x88: // Primary LE
        if ((asi & 0x80) && (env->pstate & PS_PRIV)) {
B
blueswir1 已提交
1779 1780 1781
            if (env->hpstate & HS_PRIV) {
                switch(size) {
                case 1:
B
blueswir1 已提交
1782
                    stb_hypv(addr, val);
B
blueswir1 已提交
1783 1784
                    break;
                case 2:
B
blueswir1 已提交
1785
                    stw_hypv(addr & ~1, val);
B
blueswir1 已提交
1786 1787
                    break;
                case 4:
B
blueswir1 已提交
1788
                    stl_hypv(addr & ~3, val);
B
blueswir1 已提交
1789 1790 1791
                    break;
                case 8:
                default:
B
blueswir1 已提交
1792
                    stq_hypv(addr & ~7, val);
B
blueswir1 已提交
1793 1794 1795 1796 1797
                    break;
                }
            } else {
                switch(size) {
                case 1:
B
blueswir1 已提交
1798
                    stb_kernel(addr, val);
B
blueswir1 已提交
1799 1800
                    break;
                case 2:
B
blueswir1 已提交
1801
                    stw_kernel(addr & ~1, val);
B
blueswir1 已提交
1802 1803
                    break;
                case 4:
B
blueswir1 已提交
1804
                    stl_kernel(addr & ~3, val);
B
blueswir1 已提交
1805 1806 1807
                    break;
                case 8:
                default:
B
blueswir1 已提交
1808
                    stq_kernel(addr & ~7, val);
B
blueswir1 已提交
1809 1810
                    break;
                }
1811 1812 1813 1814
            }
        } else {
            switch(size) {
            case 1:
B
blueswir1 已提交
1815
                stb_user(addr, val);
1816 1817
                break;
            case 2:
B
blueswir1 已提交
1818
                stw_user(addr & ~1, val);
1819 1820
                break;
            case 4:
B
blueswir1 已提交
1821
                stl_user(addr & ~3, val);
1822 1823 1824
                break;
            case 8:
            default:
B
blueswir1 已提交
1825
                stq_user(addr & ~7, val);
1826 1827 1828 1829
                break;
            }
        }
        break;
B
bellard 已提交
1830 1831
    case 0x14: // Bypass
    case 0x15: // Bypass, non-cacheable
1832 1833
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
B
blueswir1 已提交
1834
        {
B
bellard 已提交
1835 1836
            switch(size) {
            case 1:
B
blueswir1 已提交
1837
                stb_phys(addr, val);
B
bellard 已提交
1838 1839
                break;
            case 2:
B
blueswir1 已提交
1840
                stw_phys(addr & ~1, val);
B
bellard 已提交
1841 1842
                break;
            case 4:
B
blueswir1 已提交
1843
                stl_phys(addr & ~3, val);
B
bellard 已提交
1844 1845 1846
                break;
            case 8:
            default:
B
blueswir1 已提交
1847
                stq_phys(addr & ~7, val);
B
bellard 已提交
1848 1849
                break;
            }
B
blueswir1 已提交
1850 1851
        }
        return;
B
bellard 已提交
1852 1853 1854 1855 1856 1857 1858
    case 0x04: // Nucleus
    case 0x0c: // Nucleus Little Endian (LE)
    case 0x11: // As if user secondary
    case 0x19: // As if user secondary LE
    case 0x24: // Nucleus quad LDD 128 bit atomic
    case 0x2c: // Nucleus quad LDD 128 bit atomic
    case 0x4a: // UPA config
B
blueswir1 已提交
1859
    case 0x81: // Secondary
B
bellard 已提交
1860
    case 0x89: // Secondary LE
B
blueswir1 已提交
1861 1862
        // XXX
        return;
B
bellard 已提交
1863
    case 0x45: // LSU
B
blueswir1 已提交
1864 1865 1866 1867
        {
            uint64_t oldreg;

            oldreg = env->lsu;
B
blueswir1 已提交
1868
            env->lsu = val & (DMMU_E | IMMU_E);
B
blueswir1 已提交
1869 1870 1871
            // Mappings generated during D/I MMU disabled mode are
            // invalid in normal mode
            if (oldreg != env->lsu) {
1872
                DPRINTF_MMU("LSU change: 0x%" PRIx64 " -> 0x%" PRIx64 "\n", oldreg, env->lsu);
B
bellard 已提交
1873
#ifdef DEBUG_MMU
B
blueswir1 已提交
1874
                dump_mmu(env);
B
bellard 已提交
1875
#endif
B
blueswir1 已提交
1876 1877 1878 1879
                tlb_flush(env, 1);
            }
            return;
        }
B
bellard 已提交
1880
    case 0x50: // I-MMU regs
B
blueswir1 已提交
1881
        {
B
blueswir1 已提交
1882
            int reg = (addr >> 3) & 0xf;
B
blueswir1 已提交
1883
            uint64_t oldreg;
1884

B
blueswir1 已提交
1885
            oldreg = env->immuregs[reg];
B
bellard 已提交
1886 1887 1888 1889 1890 1891 1892 1893 1894 1895
            switch(reg) {
            case 0: // RO
            case 4:
                return;
            case 1: // Not in I-MMU
            case 2:
            case 7:
            case 8:
                return;
            case 3: // SFSR
B
blueswir1 已提交
1896 1897
                if ((val & 1) == 0)
                    val = 0; // Clear SFSR
B
bellard 已提交
1898 1899 1900 1901 1902 1903
                break;
            case 5: // TSB access
            case 6: // Tag access
            default:
                break;
            }
B
blueswir1 已提交
1904
            env->immuregs[reg] = val;
B
bellard 已提交
1905
            if (oldreg != env->immuregs[reg]) {
1906
                DPRINTF_MMU("mmu change reg[%d]: 0x%08" PRIx64 " -> 0x%08" PRIx64 "\n", reg, oldreg, env->immuregs[reg]);
B
bellard 已提交
1907
            }
1908
#ifdef DEBUG_MMU
B
blueswir1 已提交
1909
            dump_mmu(env);
B
bellard 已提交
1910
#endif
B
blueswir1 已提交
1911 1912
            return;
        }
B
bellard 已提交
1913
    case 0x54: // I-MMU data in
B
blueswir1 已提交
1914 1915 1916 1917 1918 1919 1920
        {
            unsigned int i;

            // Try finding an invalid entry
            for (i = 0; i < 64; i++) {
                if ((env->itlb_tte[i] & 0x8000000000000000ULL) == 0) {
                    env->itlb_tag[i] = env->immuregs[6];
B
blueswir1 已提交
1921
                    env->itlb_tte[i] = val;
B
blueswir1 已提交
1922 1923 1924 1925 1926 1927 1928
                    return;
                }
            }
            // Try finding an unlocked entry
            for (i = 0; i < 64; i++) {
                if ((env->itlb_tte[i] & 0x40) == 0) {
                    env->itlb_tag[i] = env->immuregs[6];
B
blueswir1 已提交
1929
                    env->itlb_tte[i] = val;
B
blueswir1 已提交
1930 1931 1932 1933 1934 1935
                    return;
                }
            }
            // error state?
            return;
        }
B
bellard 已提交
1936
    case 0x55: // I-MMU data access
B
blueswir1 已提交
1937
        {
B
blueswir1 已提交
1938
            unsigned int i = (addr >> 3) & 0x3f;
B
bellard 已提交
1939

B
blueswir1 已提交
1940
            env->itlb_tag[i] = env->immuregs[6];
B
blueswir1 已提交
1941
            env->itlb_tte[i] = val;
B
blueswir1 已提交
1942 1943
            return;
        }
B
bellard 已提交
1944
    case 0x57: // I-MMU demap
B
blueswir1 已提交
1945 1946
        // XXX
        return;
B
bellard 已提交
1947
    case 0x58: // D-MMU regs
B
blueswir1 已提交
1948
        {
B
blueswir1 已提交
1949
            int reg = (addr >> 3) & 0xf;
B
blueswir1 已提交
1950
            uint64_t oldreg;
1951

B
blueswir1 已提交
1952
            oldreg = env->dmmuregs[reg];
B
bellard 已提交
1953 1954 1955 1956 1957
            switch(reg) {
            case 0: // RO
            case 4:
                return;
            case 3: // SFSR
B
blueswir1 已提交
1958 1959
                if ((val & 1) == 0) {
                    val = 0; // Clear SFSR, Fault address
B
blueswir1 已提交
1960 1961
                    env->dmmuregs[4] = 0;
                }
B
blueswir1 已提交
1962
                env->dmmuregs[reg] = val;
B
bellard 已提交
1963 1964 1965 1966 1967 1968 1969 1970 1971 1972
                break;
            case 1: // Primary context
            case 2: // Secondary context
            case 5: // TSB access
            case 6: // Tag access
            case 7: // Virtual Watchpoint
            case 8: // Physical Watchpoint
            default:
                break;
            }
B
blueswir1 已提交
1973
            env->dmmuregs[reg] = val;
B
bellard 已提交
1974
            if (oldreg != env->dmmuregs[reg]) {
1975
                DPRINTF_MMU("mmu change reg[%d]: 0x%08" PRIx64 " -> 0x%08" PRIx64 "\n", reg, oldreg, env->dmmuregs[reg]);
B
bellard 已提交
1976
            }
1977
#ifdef DEBUG_MMU
B
blueswir1 已提交
1978
            dump_mmu(env);
B
bellard 已提交
1979
#endif
B
blueswir1 已提交
1980 1981
            return;
        }
B
bellard 已提交
1982
    case 0x5c: // D-MMU data in
B
blueswir1 已提交
1983 1984 1985 1986 1987 1988 1989
        {
            unsigned int i;

            // Try finding an invalid entry
            for (i = 0; i < 64; i++) {
                if ((env->dtlb_tte[i] & 0x8000000000000000ULL) == 0) {
                    env->dtlb_tag[i] = env->dmmuregs[6];
B
blueswir1 已提交
1990
                    env->dtlb_tte[i] = val;
B
blueswir1 已提交
1991 1992 1993 1994 1995 1996 1997
                    return;
                }
            }
            // Try finding an unlocked entry
            for (i = 0; i < 64; i++) {
                if ((env->dtlb_tte[i] & 0x40) == 0) {
                    env->dtlb_tag[i] = env->dmmuregs[6];
B
blueswir1 已提交
1998
                    env->dtlb_tte[i] = val;
B
blueswir1 已提交
1999 2000 2001 2002 2003 2004
                    return;
                }
            }
            // error state?
            return;
        }
B
bellard 已提交
2005
    case 0x5d: // D-MMU data access
B
blueswir1 已提交
2006
        {
B
blueswir1 已提交
2007
            unsigned int i = (addr >> 3) & 0x3f;
B
bellard 已提交
2008

B
blueswir1 已提交
2009
            env->dtlb_tag[i] = env->dmmuregs[6];
B
blueswir1 已提交
2010
            env->dtlb_tte[i] = val;
B
blueswir1 已提交
2011 2012
            return;
        }
B
bellard 已提交
2013
    case 0x5f: // D-MMU demap
B
bellard 已提交
2014
    case 0x49: // Interrupt data receive
B
blueswir1 已提交
2015 2016
        // XXX
        return;
B
bellard 已提交
2017 2018 2019 2020 2021 2022 2023
    case 0x51: // I-MMU 8k TSB pointer, RO
    case 0x52: // I-MMU 64k TSB pointer, RO
    case 0x56: // I-MMU tag read, RO
    case 0x59: // D-MMU 8k TSB pointer, RO
    case 0x5a: // D-MMU 64k TSB pointer, RO
    case 0x5b: // D-MMU data pointer, RO
    case 0x5e: // D-MMU tag read, RO
B
bellard 已提交
2024 2025 2026 2027 2028 2029
    case 0x48: // Interrupt dispatch, RO
    case 0x7f: // Incoming interrupt vector, RO
    case 0x82: // Primary no-fault, RO
    case 0x83: // Secondary no-fault, RO
    case 0x8a: // Primary no-fault LE, RO
    case 0x8b: // Secondary no-fault LE, RO
B
bellard 已提交
2030
    default:
B
blueswir1 已提交
2031
        do_unassigned_access(addr, 1, 0, 1);
B
blueswir1 已提交
2032
        return;
B
bellard 已提交
2033 2034
    }
}
2035
#endif /* CONFIG_USER_ONLY */
2036

B
blueswir1 已提交
2037
void helper_ldf_asi(target_ulong addr, int asi, int size, int rd)
2038 2039
{
    unsigned int i;
B
blueswir1 已提交
2040
    target_ulong val;
2041 2042 2043 2044 2045 2046

    switch (asi) {
    case 0xf0: // Block load primary
    case 0xf1: // Block load secondary
    case 0xf8: // Block load primary LE
    case 0xf9: // Block load secondary LE
B
blueswir1 已提交
2047 2048 2049 2050
        if (rd & 7) {
            raise_exception(TT_ILL_INSN);
            return;
        }
B
blueswir1 已提交
2051
        if (addr & 0x3f) {
B
blueswir1 已提交
2052 2053 2054 2055
            raise_exception(TT_UNALIGNED);
            return;
        }
        for (i = 0; i < 16; i++) {
B
blueswir1 已提交
2056 2057
            *(uint32_t *)&env->fpr[rd++] = helper_ld_asi(addr, asi & 0x8f, 4, 0);
            addr += 4;
2058 2059 2060 2061 2062 2063 2064
        }

        return;
    default:
        break;
    }

B
blueswir1 已提交
2065
    val = helper_ld_asi(addr, asi, size, 0);
2066 2067 2068
    switch(size) {
    default:
    case 4:
B
blueswir1 已提交
2069
        *((uint32_t *)&FT0) = val;
2070 2071
        break;
    case 8:
B
blueswir1 已提交
2072
        *((int64_t *)&DT0) = val;
2073
        break;
B
blueswir1 已提交
2074 2075 2076 2077 2078
#if defined(CONFIG_USER_ONLY)
    case 16:
        // XXX
        break;
#endif
2079 2080 2081
    }
}

B
blueswir1 已提交
2082
void helper_stf_asi(target_ulong addr, int asi, int size, int rd)
2083 2084
{
    unsigned int i;
B
blueswir1 已提交
2085
    target_ulong val = 0;
2086 2087 2088 2089 2090 2091

    switch (asi) {
    case 0xf0: // Block store primary
    case 0xf1: // Block store secondary
    case 0xf8: // Block store primary LE
    case 0xf9: // Block store secondary LE
B
blueswir1 已提交
2092 2093 2094 2095
        if (rd & 7) {
            raise_exception(TT_ILL_INSN);
            return;
        }
B
blueswir1 已提交
2096
        if (addr & 0x3f) {
B
blueswir1 已提交
2097 2098 2099 2100
            raise_exception(TT_UNALIGNED);
            return;
        }
        for (i = 0; i < 16; i++) {
B
blueswir1 已提交
2101 2102 2103
            val = *(uint32_t *)&env->fpr[rd++];
            helper_st_asi(addr, val, asi & 0x8f, 4);
            addr += 4;
2104 2105 2106 2107 2108 2109 2110 2111 2112 2113
        }

        return;
    default:
        break;
    }

    switch(size) {
    default:
    case 4:
B
blueswir1 已提交
2114
        val = *((uint32_t *)&FT0);
2115 2116
        break;
    case 8:
B
blueswir1 已提交
2117
        val = *((int64_t *)&DT0);
2118
        break;
B
blueswir1 已提交
2119 2120 2121 2122 2123
#if defined(CONFIG_USER_ONLY)
    case 16:
        // XXX
        break;
#endif
2124
    }
B
blueswir1 已提交
2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138
    helper_st_asi(addr, val, asi, size);
}

target_ulong helper_cas_asi(target_ulong addr, target_ulong val1,
                            target_ulong val2, uint32_t asi)
{
    target_ulong ret;

    val1 &= 0xffffffffUL;
    ret = helper_ld_asi(addr, asi, 4, 0);
    ret &= 0xffffffffUL;
    if (val1 == ret)
        helper_st_asi(addr, val2 & 0xffffffffUL, asi, 4);
    return ret;
2139 2140
}

B
blueswir1 已提交
2141 2142 2143 2144 2145 2146 2147 2148 2149 2150
target_ulong helper_casx_asi(target_ulong addr, target_ulong val1,
                             target_ulong val2, uint32_t asi)
{
    target_ulong ret;

    ret = helper_ld_asi(addr, asi, 8, 0);
    if (val1 == ret)
        helper_st_asi(addr, val2, asi, 8);
    return ret;
}
2151
#endif /* TARGET_SPARC64 */
B
bellard 已提交
2152 2153

#ifndef TARGET_SPARC64
B
blueswir1 已提交
2154
void helper_rett(void)
2155
{
2156 2157
    unsigned int cwp;

2158 2159 2160
    if (env->psret == 1)
        raise_exception(TT_ILL_INSN);

2161
    env->psret = 1;
2162
    cwp = (env->cwp + 1) & (NWINDOWS - 1);
2163 2164 2165 2166 2167 2168
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_UNF);
    }
    set_cwp(cwp);
    env->psrs = env->psrps;
}
B
bellard 已提交
2169
#endif
2170

B
blueswir1 已提交
2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214
target_ulong helper_udiv(target_ulong a, target_ulong b)
{
    uint64_t x0;
    uint32_t x1;

    x0 = a | ((uint64_t) (env->y) << 32);
    x1 = b;

    if (x1 == 0) {
        raise_exception(TT_DIV_ZERO);
    }

    x0 = x0 / x1;
    if (x0 > 0xffffffff) {
        env->cc_src2 = 1;
        return 0xffffffff;
    } else {
        env->cc_src2 = 0;
        return x0;
    }
}

target_ulong helper_sdiv(target_ulong a, target_ulong b)
{
    int64_t x0;
    int32_t x1;

    x0 = a | ((int64_t) (env->y) << 32);
    x1 = b;

    if (x1 == 0) {
        raise_exception(TT_DIV_ZERO);
    }

    x0 = x0 / x1;
    if ((int32_t) x0 != x0) {
        env->cc_src2 = 1;
        return x0 < 0? 0x80000000: 0x7fffffff;
    } else {
        env->cc_src2 = 0;
        return x0;
    }
}

B
blueswir1 已提交
2215 2216 2217 2218 2219
uint64_t helper_pack64(target_ulong high, target_ulong low)
{
    return ((uint64_t)high << 32) | (uint64_t)(low & 0xffffffff);
}

B
bellard 已提交
2220
void helper_ldfsr(void)
2221
{
B
bellard 已提交
2222
    int rnd_mode;
B
blueswir1 已提交
2223 2224

    PUT_FSR32(env, *((uint32_t *) &FT0));
2225 2226
    switch (env->fsr & FSR_RD_MASK) {
    case FSR_RD_NEAREST:
B
bellard 已提交
2227
        rnd_mode = float_round_nearest_even;
B
blueswir1 已提交
2228
        break;
B
bellard 已提交
2229
    default:
2230
    case FSR_RD_ZERO:
B
bellard 已提交
2231
        rnd_mode = float_round_to_zero;
B
blueswir1 已提交
2232
        break;
2233
    case FSR_RD_POS:
B
bellard 已提交
2234
        rnd_mode = float_round_up;
B
blueswir1 已提交
2235
        break;
2236
    case FSR_RD_NEG:
B
bellard 已提交
2237
        rnd_mode = float_round_down;
B
blueswir1 已提交
2238
        break;
2239
    }
B
bellard 已提交
2240
    set_float_rounding_mode(rnd_mode, &env->fp_status);
2241
}
B
bellard 已提交
2242

B
blueswir1 已提交
2243 2244 2245 2246 2247 2248
void helper_stfsr(void)
{
    *((uint32_t *) &FT0) = GET_FSR32(env);
}

void helper_debug(void)
B
bellard 已提交
2249 2250 2251 2252
{
    env->exception_index = EXCP_DEBUG;
    cpu_loop_exit();
}
2253

B
bellard 已提交
2254
#ifndef TARGET_SPARC64
2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278
/* XXX: use another pointer for %iN registers to avoid slow wrapping
   handling ? */
void helper_save(void)
{
    uint32_t cwp;

    cwp = (env->cwp - 1) & (NWINDOWS - 1);
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_OVF);
    }
    set_cwp(cwp);
}

void helper_restore(void)
{
    uint32_t cwp;

    cwp = (env->cwp + 1) & (NWINDOWS - 1);
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_UNF);
    }
    set_cwp(cwp);
}

B
blueswir1 已提交
2279
void helper_wrpsr(target_ulong new_psr)
2280
{
B
blueswir1 已提交
2281
    if ((new_psr & PSR_CWP) >= NWINDOWS)
2282 2283
        raise_exception(TT_ILL_INSN);
    else
B
blueswir1 已提交
2284
        PUT_PSR(env, new_psr);
2285 2286
}

B
blueswir1 已提交
2287
target_ulong helper_rdpsr(void)
2288
{
B
blueswir1 已提交
2289
    return GET_PSR(env);
2290
}
B
bellard 已提交
2291 2292

#else
2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360
/* XXX: use another pointer for %iN registers to avoid slow wrapping
   handling ? */
void helper_save(void)
{
    uint32_t cwp;

    cwp = (env->cwp - 1) & (NWINDOWS - 1);
    if (env->cansave == 0) {
        raise_exception(TT_SPILL | (env->otherwin != 0 ?
                                    (TT_WOTHER | ((env->wstate & 0x38) >> 1)):
                                    ((env->wstate & 0x7) << 2)));
    } else {
        if (env->cleanwin - env->canrestore == 0) {
            // XXX Clean windows without trap
            raise_exception(TT_CLRWIN);
        } else {
            env->cansave--;
            env->canrestore++;
            set_cwp(cwp);
        }
    }
}

void helper_restore(void)
{
    uint32_t cwp;

    cwp = (env->cwp + 1) & (NWINDOWS - 1);
    if (env->canrestore == 0) {
        raise_exception(TT_FILL | (env->otherwin != 0 ?
                                   (TT_WOTHER | ((env->wstate & 0x38) >> 1)):
                                   ((env->wstate & 0x7) << 2)));
    } else {
        env->cansave++;
        env->canrestore--;
        set_cwp(cwp);
    }
}

void helper_flushw(void)
{
    if (env->cansave != NWINDOWS - 2) {
        raise_exception(TT_SPILL | (env->otherwin != 0 ?
                                    (TT_WOTHER | ((env->wstate & 0x38) >> 1)):
                                    ((env->wstate & 0x7) << 2)));
    }
}

void helper_saved(void)
{
    env->cansave++;
    if (env->otherwin == 0)
        env->canrestore--;
    else
        env->otherwin--;
}

void helper_restored(void)
{
    env->canrestore++;
    if (env->cleanwin < NWINDOWS - 1)
        env->cleanwin++;
    if (env->otherwin == 0)
        env->cansave--;
    else
        env->otherwin--;
}

B
blueswir1 已提交
2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381
target_ulong helper_rdccr(void)
{
    return GET_CCR(env);
}

void helper_wrccr(target_ulong new_ccr)
{
    PUT_CCR(env, new_ccr);
}

// CWP handling is reversed in V9, but we still use the V8 register
// order.
target_ulong helper_rdcwp(void)
{
    return GET_CWP64(env);
}

void helper_wrcwp(target_ulong new_cwp)
{
    PUT_CWP64(env, new_cwp);
}
B
bellard 已提交
2382

2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413
// This function uses non-native bit order
#define GET_FIELD(X, FROM, TO)                                  \
    ((X) >> (63 - (TO)) & ((1ULL << ((TO) - (FROM) + 1)) - 1))

// This function uses the order in the manuals, i.e. bit 0 is 2^0
#define GET_FIELD_SP(X, FROM, TO)               \
    GET_FIELD(X, 63 - (TO), 63 - (FROM))

target_ulong helper_array8(target_ulong pixel_addr, target_ulong cubesize)
{
    return (GET_FIELD_SP(pixel_addr, 60, 63) << (17 + 2 * cubesize)) |
        (GET_FIELD_SP(pixel_addr, 39, 39 + cubesize - 1) << (17 + cubesize)) |
        (GET_FIELD_SP(pixel_addr, 17 + cubesize - 1, 17) << 17) |
        (GET_FIELD_SP(pixel_addr, 56, 59) << 13) |
        (GET_FIELD_SP(pixel_addr, 35, 38) << 9) |
        (GET_FIELD_SP(pixel_addr, 13, 16) << 5) |
        (((pixel_addr >> 55) & 1) << 4) |
        (GET_FIELD_SP(pixel_addr, 33, 34) << 2) |
        GET_FIELD_SP(pixel_addr, 11, 12);
}

target_ulong helper_alignaddr(target_ulong addr, target_ulong offset)
{
    uint64_t tmp;

    tmp = addr + offset;
    env->gsr &= ~7ULL;
    env->gsr |= tmp & 7ULL;
    return tmp & ~7ULL;
}

B
blueswir1 已提交
2414
target_ulong helper_popc(target_ulong val)
B
bellard 已提交
2415
{
B
blueswir1 已提交
2416
    return ctpop64(val);
B
bellard 已提交
2417
}
B
bellard 已提交
2418 2419 2420 2421 2422 2423

static inline uint64_t *get_gregset(uint64_t pstate)
{
    switch (pstate) {
    default:
    case 0:
B
blueswir1 已提交
2424
        return env->bgregs;
B
bellard 已提交
2425
    case PS_AG:
B
blueswir1 已提交
2426
        return env->agregs;
B
bellard 已提交
2427
    case PS_MG:
B
blueswir1 已提交
2428
        return env->mgregs;
B
bellard 已提交
2429
    case PS_IG:
B
blueswir1 已提交
2430
        return env->igregs;
B
bellard 已提交
2431 2432 2433
    }
}

2434
static inline void change_pstate(uint64_t new_pstate)
B
bellard 已提交
2435
{
2436
    uint64_t pstate_regs, new_pstate_regs;
B
bellard 已提交
2437 2438 2439 2440 2441
    uint64_t *src, *dst;

    pstate_regs = env->pstate & 0xc01;
    new_pstate_regs = new_pstate & 0xc01;
    if (new_pstate_regs != pstate_regs) {
B
blueswir1 已提交
2442 2443 2444 2445 2446
        // Switch global register bank
        src = get_gregset(new_pstate_regs);
        dst = get_gregset(pstate_regs);
        memcpy32(dst, env->gregs);
        memcpy32(env->gregs, src);
B
bellard 已提交
2447 2448 2449 2450
    }
    env->pstate = new_pstate;
}

B
blueswir1 已提交
2451
void helper_wrpstate(target_ulong new_state)
2452
{
B
blueswir1 已提交
2453
    change_pstate(new_state & 0xf3f);
2454 2455
}

B
blueswir1 已提交
2456
void helper_done(void)
B
bellard 已提交
2457 2458
{
    env->tl--;
2459 2460 2461 2462 2463 2464 2465
    env->tsptr = &env->ts[env->tl];
    env->pc = env->tsptr->tpc;
    env->npc = env->tsptr->tnpc + 4;
    PUT_CCR(env, env->tsptr->tstate >> 32);
    env->asi = (env->tsptr->tstate >> 24) & 0xff;
    change_pstate((env->tsptr->tstate >> 8) & 0xf3f);
    PUT_CWP64(env, env->tsptr->tstate & 0xff);
B
bellard 已提交
2466 2467
}

B
blueswir1 已提交
2468
void helper_retry(void)
B
bellard 已提交
2469 2470
{
    env->tl--;
2471 2472 2473 2474 2475 2476 2477
    env->tsptr = &env->ts[env->tl];
    env->pc = env->tsptr->tpc;
    env->npc = env->tsptr->tnpc;
    PUT_CCR(env, env->tsptr->tstate >> 32);
    env->asi = (env->tsptr->tstate >> 24) & 0xff;
    change_pstate((env->tsptr->tstate >> 8) & 0xf3f);
    PUT_CWP64(env, env->tsptr->tstate & 0xff);
B
bellard 已提交
2478
}
B
bellard 已提交
2479
#endif
2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513

void set_cwp(int new_cwp)
{
    /* put the modified wrap registers at their proper location */
    if (env->cwp == (NWINDOWS - 1))
        memcpy32(env->regbase, env->regbase + NWINDOWS * 16);
    env->cwp = new_cwp;
    /* put the wrap registers at their temporary location */
    if (new_cwp == (NWINDOWS - 1))
        memcpy32(env->regbase + NWINDOWS * 16, env->regbase);
    env->regwptr = env->regbase + (new_cwp * 16);
    REGWPTR = env->regwptr;
}

void cpu_set_cwp(CPUState *env1, int new_cwp)
{
    CPUState *saved_env;
#ifdef reg_REGWPTR
    target_ulong *saved_regwptr;
#endif

    saved_env = env;
#ifdef reg_REGWPTR
    saved_regwptr = REGWPTR;
#endif
    env = env1;
    set_cwp(new_cwp);
    env = saved_env;
#ifdef reg_REGWPTR
    REGWPTR = saved_regwptr;
#endif
}

#ifdef TARGET_SPARC64
B
blueswir1 已提交
2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542 2543 2544 2545 2546 2547 2548 2549
#ifdef DEBUG_PCALL
static const char * const excp_names[0x50] = {
    [TT_TFAULT] = "Instruction Access Fault",
    [TT_TMISS] = "Instruction Access MMU Miss",
    [TT_CODE_ACCESS] = "Instruction Access Error",
    [TT_ILL_INSN] = "Illegal Instruction",
    [TT_PRIV_INSN] = "Privileged Instruction",
    [TT_NFPU_INSN] = "FPU Disabled",
    [TT_FP_EXCP] = "FPU Exception",
    [TT_TOVF] = "Tag Overflow",
    [TT_CLRWIN] = "Clean Windows",
    [TT_DIV_ZERO] = "Division By Zero",
    [TT_DFAULT] = "Data Access Fault",
    [TT_DMISS] = "Data Access MMU Miss",
    [TT_DATA_ACCESS] = "Data Access Error",
    [TT_DPROT] = "Data Protection Error",
    [TT_UNALIGNED] = "Unaligned Memory Access",
    [TT_PRIV_ACT] = "Privileged Action",
    [TT_EXTINT | 0x1] = "External Interrupt 1",
    [TT_EXTINT | 0x2] = "External Interrupt 2",
    [TT_EXTINT | 0x3] = "External Interrupt 3",
    [TT_EXTINT | 0x4] = "External Interrupt 4",
    [TT_EXTINT | 0x5] = "External Interrupt 5",
    [TT_EXTINT | 0x6] = "External Interrupt 6",
    [TT_EXTINT | 0x7] = "External Interrupt 7",
    [TT_EXTINT | 0x8] = "External Interrupt 8",
    [TT_EXTINT | 0x9] = "External Interrupt 9",
    [TT_EXTINT | 0xa] = "External Interrupt 10",
    [TT_EXTINT | 0xb] = "External Interrupt 11",
    [TT_EXTINT | 0xc] = "External Interrupt 12",
    [TT_EXTINT | 0xd] = "External Interrupt 13",
    [TT_EXTINT | 0xe] = "External Interrupt 14",
    [TT_EXTINT | 0xf] = "External Interrupt 15",
};
#endif

2550 2551 2552 2553
void do_interrupt(int intno)
{
#ifdef DEBUG_PCALL
    if (loglevel & CPU_LOG_INT) {
B
blueswir1 已提交
2554
        static int count;
B
blueswir1 已提交
2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573
        const char *name;

        if (intno < 0 || intno >= 0x180 || (intno > 0x4f && intno < 0x80))
            name = "Unknown";
        else if (intno >= 0x100)
            name = "Trap Instruction";
        else if (intno >= 0xc0)
            name = "Window Fill";
        else if (intno >= 0x80)
            name = "Window Spill";
        else {
            name = excp_names[intno];
            if (!name)
                name = "Unknown";
        }

        fprintf(logfile, "%6d: %s (v=%04x) pc=%016" PRIx64 " npc=%016" PRIx64
                " SP=%016" PRIx64 "\n",
                count, name, intno,
2574 2575
                env->pc,
                env->npc, env->regwptr[6]);
B
blueswir1 已提交
2576
        cpu_dump_state(env, logfile, fprintf, 0);
2577
#if 0
B
blueswir1 已提交
2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588
        {
            int i;
            uint8_t *ptr;

            fprintf(logfile, "       code=");
            ptr = (uint8_t *)env->pc;
            for(i = 0; i < 16; i++) {
                fprintf(logfile, " %02x", ldub(ptr + i));
            }
            fprintf(logfile, "\n");
        }
2589
#endif
B
blueswir1 已提交
2590
        count++;
2591 2592
    }
#endif
2593
#if !defined(CONFIG_USER_ONLY)
B
bellard 已提交
2594
    if (env->tl == MAXTL) {
B
bellard 已提交
2595
        cpu_abort(env, "Trap 0x%04x while trap level is MAXTL, Error state", env->exception_index);
B
blueswir1 已提交
2596
        return;
2597 2598
    }
#endif
2599 2600 2601 2602 2603 2604
    env->tsptr->tstate = ((uint64_t)GET_CCR(env) << 32) |
        ((env->asi & 0xff) << 24) | ((env->pstate & 0xf3f) << 8) |
        GET_CWP64(env);
    env->tsptr->tpc = env->pc;
    env->tsptr->tnpc = env->npc;
    env->tsptr->tt = intno;
2605 2606 2607 2608 2609 2610 2611 2612
    change_pstate(PS_PEF | PS_PRIV | PS_AG);

    if (intno == TT_CLRWIN)
        set_cwp((env->cwp - 1) & (NWINDOWS - 1));
    else if ((intno & 0x1c0) == TT_SPILL)
        set_cwp((env->cwp - env->cansave - 2) & (NWINDOWS - 1));
    else if ((intno & 0x1c0) == TT_FILL)
        set_cwp((env->cwp + 1) & (NWINDOWS - 1));
B
bellard 已提交
2613 2614 2615
    env->tbr &= ~0x7fffULL;
    env->tbr |= ((env->tl > 1) ? 1 << 14 : 0) | (intno << 5);
    if (env->tl < MAXTL - 1) {
B
blueswir1 已提交
2616
        env->tl++;
B
bellard 已提交
2617
    } else {
B
blueswir1 已提交
2618 2619 2620
        env->pstate |= PS_RED;
        if (env->tl != MAXTL)
            env->tl++;
B
bellard 已提交
2621
    }
2622
    env->tsptr = &env->ts[env->tl];
2623 2624 2625 2626 2627
    env->pc = env->tbr;
    env->npc = env->pc + 4;
    env->exception_index = 0;
}
#else
B
blueswir1 已提交
2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662
#ifdef DEBUG_PCALL
static const char * const excp_names[0x80] = {
    [TT_TFAULT] = "Instruction Access Fault",
    [TT_ILL_INSN] = "Illegal Instruction",
    [TT_PRIV_INSN] = "Privileged Instruction",
    [TT_NFPU_INSN] = "FPU Disabled",
    [TT_WIN_OVF] = "Window Overflow",
    [TT_WIN_UNF] = "Window Underflow",
    [TT_UNALIGNED] = "Unaligned Memory Access",
    [TT_FP_EXCP] = "FPU Exception",
    [TT_DFAULT] = "Data Access Fault",
    [TT_TOVF] = "Tag Overflow",
    [TT_EXTINT | 0x1] = "External Interrupt 1",
    [TT_EXTINT | 0x2] = "External Interrupt 2",
    [TT_EXTINT | 0x3] = "External Interrupt 3",
    [TT_EXTINT | 0x4] = "External Interrupt 4",
    [TT_EXTINT | 0x5] = "External Interrupt 5",
    [TT_EXTINT | 0x6] = "External Interrupt 6",
    [TT_EXTINT | 0x7] = "External Interrupt 7",
    [TT_EXTINT | 0x8] = "External Interrupt 8",
    [TT_EXTINT | 0x9] = "External Interrupt 9",
    [TT_EXTINT | 0xa] = "External Interrupt 10",
    [TT_EXTINT | 0xb] = "External Interrupt 11",
    [TT_EXTINT | 0xc] = "External Interrupt 12",
    [TT_EXTINT | 0xd] = "External Interrupt 13",
    [TT_EXTINT | 0xe] = "External Interrupt 14",
    [TT_EXTINT | 0xf] = "External Interrupt 15",
    [TT_TOVF] = "Tag Overflow",
    [TT_CODE_ACCESS] = "Instruction Access Error",
    [TT_DATA_ACCESS] = "Data Access Error",
    [TT_DIV_ZERO] = "Division By Zero",
    [TT_NCP_INSN] = "Coprocessor Disabled",
};
#endif

2663 2664 2665 2666 2667 2668
void do_interrupt(int intno)
{
    int cwp;

#ifdef DEBUG_PCALL
    if (loglevel & CPU_LOG_INT) {
B
blueswir1 已提交
2669
        static int count;
B
blueswir1 已提交
2670 2671 2672 2673 2674 2675 2676 2677 2678 2679 2680 2681 2682 2683
        const char *name;

        if (intno < 0 || intno >= 0x100)
            name = "Unknown";
        else if (intno >= 0x80)
            name = "Trap Instruction";
        else {
            name = excp_names[intno];
            if (!name)
                name = "Unknown";
        }

        fprintf(logfile, "%6d: %s (v=%02x) pc=%08x npc=%08x SP=%08x\n",
                count, name, intno,
2684 2685
                env->pc,
                env->npc, env->regwptr[6]);
B
blueswir1 已提交
2686
        cpu_dump_state(env, logfile, fprintf, 0);
2687
#if 0
B
blueswir1 已提交
2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698
        {
            int i;
            uint8_t *ptr;

            fprintf(logfile, "       code=");
            ptr = (uint8_t *)env->pc;
            for(i = 0; i < 16; i++) {
                fprintf(logfile, " %02x", ldub(ptr + i));
            }
            fprintf(logfile, "\n");
        }
2699
#endif
B
blueswir1 已提交
2700
        count++;
2701 2702
    }
#endif
2703
#if !defined(CONFIG_USER_ONLY)
2704
    if (env->psret == 0) {
B
bellard 已提交
2705
        cpu_abort(env, "Trap 0x%02x while interrupts disabled, Error state", env->exception_index);
B
blueswir1 已提交
2706
        return;
2707 2708 2709
    }
#endif
    env->psret = 0;
2710
    cwp = (env->cwp - 1) & (NWINDOWS - 1);
2711 2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722
    set_cwp(cwp);
    env->regwptr[9] = env->pc;
    env->regwptr[10] = env->npc;
    env->psrps = env->psrs;
    env->psrs = 1;
    env->tbr = (env->tbr & TBR_BASE_MASK) | (intno << 4);
    env->pc = env->tbr;
    env->npc = env->pc + 4;
    env->exception_index = 0;
}
#endif

2723
#if !defined(CONFIG_USER_ONLY)
2724

2725 2726 2727
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
                                void *retaddr);

2728
#define MMUSUFFIX _mmu
2729
#define ALIGNED_ONLY
2730 2731 2732 2733 2734
#ifdef __s390__
# define GETPC() ((void*)((unsigned long)__builtin_return_address(0) & 0x7fffffffUL))
#else
# define GETPC() (__builtin_return_address(0))
#endif
2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747

#define SHIFT 0
#include "softmmu_template.h"

#define SHIFT 1
#include "softmmu_template.h"

#define SHIFT 2
#include "softmmu_template.h"

#define SHIFT 3
#include "softmmu_template.h"

2748 2749 2750
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
                                void *retaddr)
{
B
blueswir1 已提交
2751 2752 2753 2754
#ifdef DEBUG_UNALIGNED
    printf("Unaligned access to 0x%x from 0x%x\n", addr, env->pc);
#endif
    raise_exception(TT_UNALIGNED);
2755
}
2756 2757 2758 2759 2760

/* try to fill the TLB and return an exception if error. If retaddr is
   NULL, it means that the function was called in C code (i.e. not
   from generated code or from helper.c) */
/* XXX: fix it to restore all registers */
2761
void tlb_fill(target_ulong addr, int is_write, int mmu_idx, void *retaddr)
2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772
{
    TranslationBlock *tb;
    int ret;
    unsigned long pc;
    CPUState *saved_env;

    /* XXX: hack to restore env in all cases, even if not called from
       generated code */
    saved_env = env;
    env = cpu_single_env;

2773
    ret = cpu_sparc_handle_mmu_fault(env, addr, is_write, mmu_idx, 1);
2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790
    if (ret) {
        if (retaddr) {
            /* now we have a real cpu fault */
            pc = (unsigned long)retaddr;
            tb = tb_find_pc(pc);
            if (tb) {
                /* the PC is inside the translated code. It means that we have
                   a virtual CPU fault */
                cpu_restore_state(tb, env, pc, (void *)T2);
            }
        }
        cpu_loop_exit();
    }
    env = saved_env;
}

#endif
2791 2792

#ifndef TARGET_SPARC64
2793
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
2794 2795 2796 2797 2798 2799 2800 2801
                          int is_asi)
{
    CPUState *saved_env;

    /* XXX: hack to restore env in all cases, even if not called from
       generated code */
    saved_env = env;
    env = cpu_single_env;
2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812
#ifdef DEBUG_UNASSIGNED
    if (is_asi)
        printf("Unassigned mem %s access to " TARGET_FMT_plx " asi 0x%02x from "
               TARGET_FMT_lx "\n",
               is_exec ? "exec" : is_write ? "write" : "read", addr, is_asi,
               env->pc);
    else
        printf("Unassigned mem %s access to " TARGET_FMT_plx " from "
               TARGET_FMT_lx "\n",
               is_exec ? "exec" : is_write ? "write" : "read", addr, env->pc);
#endif
2813
    if (env->mmuregs[3]) /* Fault status register */
B
blueswir1 已提交
2814
        env->mmuregs[3] = 1; /* overflow (not read before another fault) */
2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825
    if (is_asi)
        env->mmuregs[3] |= 1 << 16;
    if (env->psrs)
        env->mmuregs[3] |= 1 << 5;
    if (is_exec)
        env->mmuregs[3] |= 1 << 6;
    if (is_write)
        env->mmuregs[3] |= 1 << 7;
    env->mmuregs[3] |= (5 << 2) | 2;
    env->mmuregs[4] = addr; /* Fault address register */
    if ((env->mmuregs[0] & MMU_E) && !(env->mmuregs[0] & MMU_NF)) {
2826 2827 2828 2829
        if (is_exec)
            raise_exception(TT_CODE_ACCESS);
        else
            raise_exception(TT_DATA_ACCESS);
2830 2831 2832 2833
    }
    env = saved_env;
}
#else
2834
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
2835 2836 2837 2838 2839 2840 2841 2842 2843
                          int is_asi)
{
#ifdef DEBUG_UNASSIGNED
    CPUState *saved_env;

    /* XXX: hack to restore env in all cases, even if not called from
       generated code */
    saved_env = env;
    env = cpu_single_env;
2844
    printf("Unassigned mem access to " TARGET_FMT_plx " from " TARGET_FMT_lx "\n",
2845 2846 2847
           addr, env->pc);
    env = saved_env;
#endif
2848 2849 2850 2851
    if (is_exec)
        raise_exception(TT_CODE_ACCESS);
    else
        raise_exception(TT_DATA_ACCESS);
2852 2853
}
#endif
2854