op_helper.c 73.8 KB
Newer Older
1
#include "exec.h"
B
blueswir1 已提交
2
#include "host-utils.h"
B
blueswir1 已提交
3
#include "helper.h"
4 5 6
#if !defined(CONFIG_USER_ONLY)
#include "softmmu_exec.h"
#endif /* !defined(CONFIG_USER_ONLY) */
7

B
bellard 已提交
8
//#define DEBUG_MMU
9
//#define DEBUG_MXCC
B
blueswir1 已提交
10
//#define DEBUG_UNALIGNED
11
//#define DEBUG_UNASSIGNED
12
//#define DEBUG_ASI
B
bellard 已提交
13

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

#ifdef DEBUG_MXCC
#define DPRINTF_MXCC(fmt, args...) \
do { printf("MXCC: " fmt , ##args); } while (0)
#else
B
blueswir1 已提交
25
#define DPRINTF_MXCC(fmt, args...) do {} while (0)
26 27
#endif

28 29 30 31
#ifdef DEBUG_ASI
#define DPRINTF_ASI(fmt, args...) \
do { printf("ASI: " fmt , ##args); } while (0)
#else
B
blueswir1 已提交
32
#define DPRINTF_ASI(fmt, args...) do {} while (0)
33 34
#endif

35 36 37 38 39 40
#ifdef TARGET_ABI32
#define ABI32_MASK(addr) do { (addr) &= 0xffffffffULL; } while (0)
#else
#define ABI32_MASK(addr) do {} while (0)
#endif

B
bellard 已提交
41 42 43 44
void raise_exception(int tt)
{
    env->exception_index = tt;
    cpu_loop_exit();
45
}
B
bellard 已提交
46

B
blueswir1 已提交
47
void helper_trap(target_ulong nb_trap)
48
{
B
blueswir1 已提交
49 50 51 52 53 54 55 56 57 58 59 60
    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 已提交
61 62
void helper_check_align(target_ulong addr, uint32_t align)
{
63 64 65 66 67
    if (addr & align) {
#ifdef DEBUG_UNALIGNED
    printf("Unaligned access to 0x" TARGET_FMT_lx " from 0x" TARGET_FMT_lx
           "\n", addr, env->pc);
#endif
B
blueswir1 已提交
68
        raise_exception(TT_UNALIGNED);
69
    }
B
blueswir1 已提交
70 71
}

72 73 74 75 76 77 78 79 80 81
#define F_HELPER(name, p) void helper_f##name##p(void)

#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 已提交
82 83 84 85
    }                                                           \
    F_HELPER(name, q)                                           \
    {                                                           \
        QT0 = float128_ ## name (QT0, QT1, &env->fp_status);    \
86 87 88 89 90 91 92 93 94
    }

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

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

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

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

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

F_HELPER(neg, q)
{
    QT0 = float128_chs(QT1);
}
#endif
124 125 126

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

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

B
blueswir1 已提交
136 137 138 139 140
F_HELPER(ito, q)
{
    QT0 = int32_to_float128(*((int32_t *)&FT1), &env->fp_status);
}

B
blueswir1 已提交
141
#ifdef TARGET_SPARC64
142
F_HELPER(xto, s)
B
blueswir1 已提交
143 144 145 146
{
    FT0 = int64_to_float32(*((int64_t *)&DT1), &env->fp_status);
}

147
F_HELPER(xto, d)
B
blueswir1 已提交
148 149 150
{
    DT0 = int64_to_float64(*((int64_t *)&DT1), &env->fp_status);
}
B
blueswir1 已提交
151

B
blueswir1 已提交
152 153 154 155 156
F_HELPER(xto, q)
{
    QT0 = int64_to_float128(*((int64_t *)&DT1), &env->fp_status);
}
#endif
157 158 159 160 161 162 163 164 165 166 167 168
#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);
}
169

B
blueswir1 已提交
170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189
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);
}

190 191 192 193 194 195 196 197 198 199 200
/* 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 已提交
201 202 203 204 205
void helper_fqtoi(void)
{
    *((int32_t *)&FT0) = float128_to_int32_round_to_zero(QT1, &env->fp_status);
}

206 207 208 209 210 211 212 213 214 215 216
#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 已提交
217 218 219 220 221
void helper_fqtox(void)
{
    *((int64_t *)&DT0) = float128_to_int64_round_to_zero(QT1, &env->fp_status);
}

222 223 224 225 226 227 228 229 230 231 232 233 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
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);
}

699
void helper_fabss(void)
700
{
B
bellard 已提交
701
    FT0 = float32_abs(FT1);
702 703
}

B
bellard 已提交
704
#ifdef TARGET_SPARC64
705
void helper_fabsd(void)
B
bellard 已提交
706 707 708
{
    DT0 = float64_abs(DT1);
}
B
blueswir1 已提交
709 710 711 712 713 714

void helper_fabsq(void)
{
    QT0 = float128_abs(QT1);
}
#endif
B
bellard 已提交
715

716
void helper_fsqrts(void)
717
{
B
bellard 已提交
718
    FT0 = float32_sqrt(FT1, &env->fp_status);
719 720
}

721
void helper_fsqrtd(void)
722
{
B
bellard 已提交
723
    DT0 = float64_sqrt(DT1, &env->fp_status);
724 725
}

B
blueswir1 已提交
726 727 728 729 730
void helper_fsqrtq(void)
{
    QT0 = float128_sqrt(QT1, &env->fp_status);
}

731
#define GEN_FCMP(name, size, reg1, reg2, FS, TRAP)                      \
732
    void glue(helper_, name) (void)                                     \
B
bellard 已提交
733
    {                                                                   \
B
blueswir1 已提交
734 735
        target_ulong new_fsr;                                           \
                                                                        \
B
bellard 已提交
736 737 738
        env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                     \
        switch (glue(size, _compare) (reg1, reg2, &env->fp_status)) {   \
        case float_relation_unordered:                                  \
B
blueswir1 已提交
739
            new_fsr = (FSR_FCC1 | FSR_FCC0) << FS;                      \
740
            if ((env->fsr & FSR_NVM) || TRAP) {                         \
B
blueswir1 已提交
741
                env->fsr |= new_fsr;                                    \
742 743
                env->fsr |= FSR_NVC;                                    \
                env->fsr |= FSR_FTT_IEEE_EXCP;                          \
B
bellard 已提交
744 745 746 747 748 749
                raise_exception(TT_FP_EXCP);                            \
            } else {                                                    \
                env->fsr |= FSR_NVA;                                    \
            }                                                           \
            break;                                                      \
        case float_relation_less:                                       \
B
blueswir1 已提交
750
            new_fsr = FSR_FCC0 << FS;                                   \
B
bellard 已提交
751 752
            break;                                                      \
        case float_relation_greater:                                    \
B
blueswir1 已提交
753
            new_fsr = FSR_FCC1 << FS;                                   \
B
bellard 已提交
754 755
            break;                                                      \
        default:                                                        \
B
blueswir1 已提交
756
            new_fsr = 0;                                                \
B
bellard 已提交
757 758
            break;                                                      \
        }                                                               \
B
blueswir1 已提交
759
        env->fsr |= new_fsr;                                            \
760 761
    }

762 763 764 765 766
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 已提交
767

B
blueswir1 已提交
768 769 770
GEN_FCMP(fcmpq, float128, QT0, QT1, 0, 0);
GEN_FCMP(fcmpeq, float128, QT0, QT1, 0, 1);

B
bellard 已提交
771
#ifdef TARGET_SPARC64
772 773
GEN_FCMP(fcmps_fcc1, float32, FT0, FT1, 22, 0);
GEN_FCMP(fcmpd_fcc1, float64, DT0, DT1, 22, 0);
B
blueswir1 已提交
774
GEN_FCMP(fcmpq_fcc1, float128, QT0, QT1, 22, 0);
775 776 777

GEN_FCMP(fcmps_fcc2, float32, FT0, FT1, 24, 0);
GEN_FCMP(fcmpd_fcc2, float64, DT0, DT1, 24, 0);
B
blueswir1 已提交
778
GEN_FCMP(fcmpq_fcc2, float128, QT0, QT1, 24, 0);
779 780 781

GEN_FCMP(fcmps_fcc3, float32, FT0, FT1, 26, 0);
GEN_FCMP(fcmpd_fcc3, float64, DT0, DT1, 26, 0);
B
blueswir1 已提交
782
GEN_FCMP(fcmpq_fcc3, float128, QT0, QT1, 26, 0);
783 784 785

GEN_FCMP(fcmpes_fcc1, float32, FT0, FT1, 22, 1);
GEN_FCMP(fcmped_fcc1, float64, DT0, DT1, 22, 1);
B
blueswir1 已提交
786
GEN_FCMP(fcmpeq_fcc1, float128, QT0, QT1, 22, 1);
B
bellard 已提交
787

788 789
GEN_FCMP(fcmpes_fcc2, float32, FT0, FT1, 24, 1);
GEN_FCMP(fcmped_fcc2, float64, DT0, DT1, 24, 1);
B
blueswir1 已提交
790
GEN_FCMP(fcmpeq_fcc2, float128, QT0, QT1, 24, 1);
B
bellard 已提交
791

792 793
GEN_FCMP(fcmpes_fcc3, float32, FT0, FT1, 26, 1);
GEN_FCMP(fcmped_fcc3, float64, DT0, DT1, 26, 1);
B
blueswir1 已提交
794 795
GEN_FCMP(fcmpeq_fcc3, float128, QT0, QT1, 26, 1);
#endif
B
bellard 已提交
796

B
blueswir1 已提交
797 798
#if !defined(TARGET_SPARC64) && !defined(CONFIG_USER_ONLY) && \
    defined(DEBUG_MXCC)
799 800 801
static void dump_mxcc(CPUState *env)
{
    printf("mxccdata: %016llx %016llx %016llx %016llx\n",
B
blueswir1 已提交
802 803
           env->mxccdata[0], env->mxccdata[1],
           env->mxccdata[2], env->mxccdata[3]);
804 805
    printf("mxccregs: %016llx %016llx %016llx %016llx\n"
           "          %016llx %016llx %016llx %016llx\n",
B
blueswir1 已提交
806 807 808 809
           env->mxccregs[0], env->mxccregs[1],
           env->mxccregs[2], env->mxccregs[3],
           env->mxccregs[4], env->mxccregs[5],
           env->mxccregs[6], env->mxccregs[7]);
810 811 812
}
#endif

B
blueswir1 已提交
813 814 815 816
#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)
817 818 819 820
{
    switch (size)
    {
    case 1:
B
blueswir1 已提交
821 822
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %02" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xff);
823 824
        break;
    case 2:
B
blueswir1 已提交
825 826
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %04" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xffff);
827 828
        break;
    case 4:
B
blueswir1 已提交
829 830
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %08" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xffffffff);
831 832
        break;
    case 8:
B
blueswir1 已提交
833 834
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %016" PRIx64 "\n", txt,
                    addr, asi, r1);
835 836 837 838 839
        break;
    }
}
#endif

B
blueswir1 已提交
840 841 842
#ifndef TARGET_SPARC64
#ifndef CONFIG_USER_ONLY
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
843
{
B
blueswir1 已提交
844
    uint64_t ret = 0;
845
#if defined(DEBUG_MXCC) || defined(DEBUG_ASI)
B
blueswir1 已提交
846
    uint32_t last_addr = addr;
847
#endif
B
bellard 已提交
848

849
    helper_check_align(addr, size - 1);
B
bellard 已提交
850
    switch (asi) {
851
    case 2: /* SuperSparc MXCC registers */
B
blueswir1 已提交
852
        switch (addr) {
853
        case 0x01c00a00: /* MXCC control register */
B
blueswir1 已提交
854 855 856
            if (size == 8)
                ret = env->mxccregs[3];
            else
B
blueswir1 已提交
857 858
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
859 860 861 862 863
            break;
        case 0x01c00a04: /* MXCC control register */
            if (size == 4)
                ret = env->mxccregs[3];
            else
B
blueswir1 已提交
864 865
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
866
            break;
867 868
        case 0x01c00c00: /* Module reset register */
            if (size == 8) {
B
blueswir1 已提交
869
                ret = env->mxccregs[5];
870 871
                // should we do something here?
            } else
B
blueswir1 已提交
872 873
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
874
            break;
875
        case 0x01c00f00: /* MBus port address register */
B
blueswir1 已提交
876 877 878
            if (size == 8)
                ret = env->mxccregs[7];
            else
B
blueswir1 已提交
879 880
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
881 882
            break;
        default:
B
blueswir1 已提交
883 884
            DPRINTF_MXCC("%08x: unimplemented address, size: %d\n", addr,
                         size);
885 886
            break;
        }
B
blueswir1 已提交
887 888
        DPRINTF_MXCC("asi = %d, size = %d, sign = %d, "
                     "addr = %08x -> ret = %08x,"
B
blueswir1 已提交
889
                     "addr = %08x\n", asi, size, sign, last_addr, ret, addr);
890 891 892
#ifdef DEBUG_MXCC
        dump_mxcc(env);
#endif
893
        break;
894
    case 3: /* MMU probe */
B
blueswir1 已提交
895 896 897
        {
            int mmulev;

B
blueswir1 已提交
898
            mmulev = (addr >> 8) & 15;
B
blueswir1 已提交
899 900
            if (mmulev > 4)
                ret = 0;
B
blueswir1 已提交
901 902 903 904
            else
                ret = mmu_probe(env, addr, mmulev);
            DPRINTF_MMU("mmu_probe: 0x%08x (lev %d) -> 0x%08" PRIx64 "\n",
                        addr, mmulev, ret);
B
blueswir1 已提交
905 906
        }
        break;
907
    case 4: /* read MMU regs */
B
blueswir1 已提交
908
        {
B
blueswir1 已提交
909
            int reg = (addr >> 8) & 0x1f;
910

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

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

B
blueswir1 已提交
1161
            mmulev = (addr >> 8) & 15;
1162
            DPRINTF_MMU("mmu flush level %d\n", mmulev);
B
blueswir1 已提交
1163 1164
            switch (mmulev) {
            case 0: // flush page
B
blueswir1 已提交
1165
                tlb_flush_page(env, addr & 0xfffff000);
B
blueswir1 已提交
1166 1167 1168 1169 1170 1171 1172 1173 1174 1175
                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 已提交
1176
#ifdef DEBUG_MMU
B
blueswir1 已提交
1177
            dump_mmu(env);
B
bellard 已提交
1178
#endif
B
blueswir1 已提交
1179
        }
1180
        break;
1181
    case 4: /* write MMU regs */
B
blueswir1 已提交
1182
        {
B
blueswir1 已提交
1183
            int reg = (addr >> 8) & 0x1f;
B
blueswir1 已提交
1184
            uint32_t oldreg;
1185

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

1289 1290 1291 1292
            for (i = 0; i < 32; i += 4, src += 4, dst += 4) {
                temp = ldl_kernel(src);
                stl_kernel(dst, temp);
            }
B
blueswir1 已提交
1293
        }
1294
        break;
B
bellard 已提交
1295
    case 0x1f: /* Block fill, stda access */
B
blueswir1 已提交
1296
        {
B
blueswir1 已提交
1297 1298
            // addr = dst
            // fill 32 bytes with val
1299
            unsigned int i;
B
blueswir1 已提交
1300
            uint32_t dst = addr & 7;
1301 1302 1303

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

1369 1370 1371 1372
#endif /* CONFIG_USER_ONLY */
#else /* TARGET_SPARC64 */

#ifdef CONFIG_USER_ONLY
B
blueswir1 已提交
1373
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
1374 1375
{
    uint64_t ret = 0;
B
blueswir1 已提交
1376 1377 1378
#if defined(DEBUG_ASI)
    target_ulong last_addr = addr;
#endif
1379 1380 1381 1382

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

1383 1384 1385
    helper_check_align(addr, size - 1);
    ABI32_MASK(addr);

1386 1387 1388 1389 1390 1391 1392 1393
    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 已提交
1394
                ret = ldub_raw(addr);
1395 1396
                break;
            case 2:
1397
                ret = lduw_raw(addr);
1398 1399
                break;
            case 4:
1400
                ret = ldl_raw(addr);
1401 1402 1403
                break;
            default:
            case 8:
1404
                ret = ldq_raw(addr);
1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427
                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 已提交
1428
            break;
1429 1430
        case 4:
            ret = bswap32(ret);
B
blueswir1 已提交
1431
            break;
1432 1433
        case 8:
            ret = bswap64(ret);
B
blueswir1 已提交
1434
            break;
1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446
        default:
            break;
        }
    default:
        break;
    }

    /* Convert to signed number */
    if (sign) {
        switch(size) {
        case 1:
            ret = (int8_t) ret;
B
blueswir1 已提交
1447
            break;
1448 1449
        case 2:
            ret = (int16_t) ret;
B
blueswir1 已提交
1450
            break;
1451 1452
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
1453
            break;
1454 1455 1456 1457
        default:
            break;
        }
    }
B
blueswir1 已提交
1458 1459 1460 1461
#ifdef DEBUG_ASI
    dump_asi("read ", last_addr, asi, size, ret);
#endif
    return ret;
1462 1463
}

B
blueswir1 已提交
1464
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
1465
{
B
blueswir1 已提交
1466 1467 1468
#ifdef DEBUG_ASI
    dump_asi("write", addr, asi, size, val);
#endif
1469 1470 1471
    if (asi < 0x80)
        raise_exception(TT_PRIV_ACT);

1472 1473 1474
    helper_check_align(addr, size - 1);
    ABI32_MASK(addr);

1475 1476 1477 1478 1479 1480
    /* Convert to little endian */
    switch (asi) {
    case 0x88: // Primary LE
    case 0x89: // Secondary LE
        switch(size) {
        case 2:
B
blueswir1 已提交
1481
            addr = bswap16(addr);
B
blueswir1 已提交
1482
            break;
1483
        case 4:
B
blueswir1 已提交
1484
            addr = bswap32(addr);
B
blueswir1 已提交
1485
            break;
1486
        case 8:
B
blueswir1 已提交
1487
            addr = bswap64(addr);
B
blueswir1 已提交
1488
            break;
1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501
        default:
            break;
        }
    default:
        break;
    }

    switch(asi) {
    case 0x80: // Primary
    case 0x88: // Primary LE
        {
            switch(size) {
            case 1:
B
blueswir1 已提交
1502
                stb_raw(addr, val);
1503 1504
                break;
            case 2:
1505
                stw_raw(addr, val);
1506 1507
                break;
            case 4:
1508
                stl_raw(addr, val);
1509 1510 1511
                break;
            case 8:
            default:
1512
                stq_raw(addr, val);
1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526
                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 已提交
1527
        do_unassigned_access(addr, 1, 0, 1);
1528 1529 1530 1531 1532
        return;
    }
}

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

B
blueswir1 已提交
1534
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
B
bellard 已提交
1535
{
B
bellard 已提交
1536
    uint64_t ret = 0;
B
blueswir1 已提交
1537 1538 1539
#if defined(DEBUG_ASI)
    target_ulong last_addr = addr;
#endif
B
bellard 已提交
1540

B
blueswir1 已提交
1541
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
B
blueswir1 已提交
1542
        || (asi >= 0x30 && asi < 0x80 && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
1543
        raise_exception(TT_PRIV_ACT);
B
bellard 已提交
1544

1545
    helper_check_align(addr, size - 1);
B
bellard 已提交
1546
    switch (asi) {
1547 1548 1549 1550 1551 1552 1553
    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 已提交
1554 1555 1556
            if (env->hpstate & HS_PRIV) {
                switch(size) {
                case 1:
B
blueswir1 已提交
1557
                    ret = ldub_hypv(addr);
B
blueswir1 已提交
1558 1559
                    break;
                case 2:
1560
                    ret = lduw_hypv(addr);
B
blueswir1 已提交
1561 1562
                    break;
                case 4:
1563
                    ret = ldl_hypv(addr);
B
blueswir1 已提交
1564 1565 1566
                    break;
                default:
                case 8:
1567
                    ret = ldq_hypv(addr);
B
blueswir1 已提交
1568 1569 1570 1571 1572
                    break;
                }
            } else {
                switch(size) {
                case 1:
B
blueswir1 已提交
1573
                    ret = ldub_kernel(addr);
B
blueswir1 已提交
1574 1575
                    break;
                case 2:
1576
                    ret = lduw_kernel(addr);
B
blueswir1 已提交
1577 1578
                    break;
                case 4:
1579
                    ret = ldl_kernel(addr);
B
blueswir1 已提交
1580 1581 1582
                    break;
                default:
                case 8:
1583
                    ret = ldq_kernel(addr);
B
blueswir1 已提交
1584 1585
                    break;
                }
1586 1587 1588 1589
            }
        } else {
            switch(size) {
            case 1:
B
blueswir1 已提交
1590
                ret = ldub_user(addr);
1591 1592
                break;
            case 2:
1593
                ret = lduw_user(addr);
1594 1595
                break;
            case 4:
1596
                ret = ldl_user(addr);
1597 1598 1599
                break;
            default:
            case 8:
1600
                ret = ldq_user(addr);
1601 1602 1603 1604
                break;
            }
        }
        break;
B
bellard 已提交
1605 1606
    case 0x14: // Bypass
    case 0x15: // Bypass, non-cacheable
1607 1608
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
B
blueswir1 已提交
1609
        {
B
bellard 已提交
1610 1611
            switch(size) {
            case 1:
B
blueswir1 已提交
1612
                ret = ldub_phys(addr);
B
bellard 已提交
1613 1614
                break;
            case 2:
1615
                ret = lduw_phys(addr);
B
bellard 已提交
1616 1617
                break;
            case 4:
1618
                ret = ldl_phys(addr);
B
bellard 已提交
1619 1620 1621
                break;
            default:
            case 8:
1622
                ret = ldq_phys(addr);
B
bellard 已提交
1623 1624
                break;
            }
B
blueswir1 已提交
1625 1626
            break;
        }
B
bellard 已提交
1627 1628 1629 1630 1631 1632 1633
    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
1634
    case 0x81: // Secondary
B
bellard 已提交
1635 1636 1637
    case 0x83: // Secondary no-fault
    case 0x89: // Secondary LE
    case 0x8b: // Secondary no-fault LE
B
blueswir1 已提交
1638 1639
        // XXX
        break;
B
bellard 已提交
1640
    case 0x45: // LSU
B
blueswir1 已提交
1641 1642
        ret = env->lsu;
        break;
B
bellard 已提交
1643
    case 0x50: // I-MMU regs
B
blueswir1 已提交
1644
        {
B
blueswir1 已提交
1645
            int reg = (addr >> 3) & 0xf;
B
bellard 已提交
1646

B
blueswir1 已提交
1647 1648 1649
            ret = env->immuregs[reg];
            break;
        }
B
bellard 已提交
1650 1651 1652
    case 0x51: // I-MMU 8k TSB pointer
    case 0x52: // I-MMU 64k TSB pointer
    case 0x55: // I-MMU data access
B
blueswir1 已提交
1653 1654
        // XXX
        break;
B
bellard 已提交
1655
    case 0x56: // I-MMU tag read
B
blueswir1 已提交
1656 1657 1658 1659 1660 1661
        {
            unsigned int i;

            for (i = 0; i < 64; i++) {
                // Valid, ctx match, vaddr match
                if ((env->itlb_tte[i] & 0x8000000000000000ULL) != 0 &&
B
blueswir1 已提交
1662
                    env->itlb_tag[i] == addr) {
B
blueswir1 已提交
1663 1664 1665 1666 1667 1668
                    ret = env->itlb_tag[i];
                    break;
                }
            }
            break;
        }
B
bellard 已提交
1669
    case 0x58: // D-MMU regs
B
blueswir1 已提交
1670
        {
B
blueswir1 已提交
1671
            int reg = (addr >> 3) & 0xf;
B
bellard 已提交
1672

B
blueswir1 已提交
1673 1674 1675
            ret = env->dmmuregs[reg];
            break;
        }
B
bellard 已提交
1676
    case 0x5e: // D-MMU tag read
B
blueswir1 已提交
1677 1678 1679 1680 1681 1682
        {
            unsigned int i;

            for (i = 0; i < 64; i++) {
                // Valid, ctx match, vaddr match
                if ((env->dtlb_tte[i] & 0x8000000000000000ULL) != 0 &&
B
blueswir1 已提交
1683
                    env->dtlb_tag[i] == addr) {
B
blueswir1 已提交
1684 1685 1686 1687 1688 1689
                    ret = env->dtlb_tag[i];
                    break;
                }
            }
            break;
        }
B
bellard 已提交
1690 1691 1692 1693
    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 已提交
1694 1695 1696
    case 0x48: // Interrupt dispatch, RO
    case 0x49: // Interrupt data receive
    case 0x7f: // Incoming interrupt vector, RO
B
blueswir1 已提交
1697 1698
        // XXX
        break;
B
bellard 已提交
1699 1700 1701 1702
    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 已提交
1703
    case 0x77: // Interrupt vector, WO
B
bellard 已提交
1704
    default:
B
blueswir1 已提交
1705
        do_unassigned_access(addr, 0, 0, 1);
B
blueswir1 已提交
1706 1707
        ret = 0;
        break;
B
bellard 已提交
1708
    }
1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723

    /* 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 已提交
1724
            break;
1725 1726
        case 4:
            ret = bswap32(ret);
B
blueswir1 已提交
1727
            break;
1728 1729
        case 8:
            ret = bswap64(ret);
B
blueswir1 已提交
1730
            break;
1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742
        default:
            break;
        }
    default:
        break;
    }

    /* Convert to signed number */
    if (sign) {
        switch(size) {
        case 1:
            ret = (int8_t) ret;
B
blueswir1 已提交
1743
            break;
1744 1745
        case 2:
            ret = (int16_t) ret;
B
blueswir1 已提交
1746
            break;
1747 1748
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
1749
            break;
1750 1751 1752 1753
        default:
            break;
        }
    }
B
blueswir1 已提交
1754 1755 1756 1757
#ifdef DEBUG_ASI
    dump_asi("read ", last_addr, asi, size, ret);
#endif
    return ret;
B
bellard 已提交
1758 1759
}

B
blueswir1 已提交
1760
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
B
bellard 已提交
1761
{
B
blueswir1 已提交
1762 1763 1764
#ifdef DEBUG_ASI
    dump_asi("write", addr, asi, size, val);
#endif
B
blueswir1 已提交
1765
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
B
blueswir1 已提交
1766
        || (asi >= 0x30 && asi < 0x80 && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
1767
        raise_exception(TT_PRIV_ACT);
B
bellard 已提交
1768

1769
    helper_check_align(addr, size - 1);
1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780
    /* 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 已提交
1781
            addr = bswap16(addr);
B
blueswir1 已提交
1782
            break;
1783
        case 4:
B
blueswir1 已提交
1784
            addr = bswap32(addr);
B
blueswir1 已提交
1785
            break;
1786
        case 8:
B
blueswir1 已提交
1787
            addr = bswap64(addr);
B
blueswir1 已提交
1788
            break;
1789 1790 1791 1792 1793 1794 1795
        default:
            break;
        }
    default:
        break;
    }

B
bellard 已提交
1796
    switch(asi) {
1797 1798 1799 1800 1801
    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 已提交
1802 1803 1804
            if (env->hpstate & HS_PRIV) {
                switch(size) {
                case 1:
B
blueswir1 已提交
1805
                    stb_hypv(addr, val);
B
blueswir1 已提交
1806 1807
                    break;
                case 2:
1808
                    stw_hypv(addr, val);
B
blueswir1 已提交
1809 1810
                    break;
                case 4:
1811
                    stl_hypv(addr, val);
B
blueswir1 已提交
1812 1813 1814
                    break;
                case 8:
                default:
1815
                    stq_hypv(addr, val);
B
blueswir1 已提交
1816 1817 1818 1819 1820
                    break;
                }
            } else {
                switch(size) {
                case 1:
B
blueswir1 已提交
1821
                    stb_kernel(addr, val);
B
blueswir1 已提交
1822 1823
                    break;
                case 2:
1824
                    stw_kernel(addr, val);
B
blueswir1 已提交
1825 1826
                    break;
                case 4:
1827
                    stl_kernel(addr, val);
B
blueswir1 已提交
1828 1829 1830
                    break;
                case 8:
                default:
1831
                    stq_kernel(addr, val);
B
blueswir1 已提交
1832 1833
                    break;
                }
1834 1835 1836 1837
            }
        } else {
            switch(size) {
            case 1:
B
blueswir1 已提交
1838
                stb_user(addr, val);
1839 1840
                break;
            case 2:
1841
                stw_user(addr, val);
1842 1843
                break;
            case 4:
1844
                stl_user(addr, val);
1845 1846 1847
                break;
            case 8:
            default:
1848
                stq_user(addr, val);
1849 1850 1851 1852
                break;
            }
        }
        break;
B
bellard 已提交
1853 1854
    case 0x14: // Bypass
    case 0x15: // Bypass, non-cacheable
1855 1856
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
B
blueswir1 已提交
1857
        {
B
bellard 已提交
1858 1859
            switch(size) {
            case 1:
B
blueswir1 已提交
1860
                stb_phys(addr, val);
B
bellard 已提交
1861 1862
                break;
            case 2:
1863
                stw_phys(addr, val);
B
bellard 已提交
1864 1865
                break;
            case 4:
1866
                stl_phys(addr, val);
B
bellard 已提交
1867 1868 1869
                break;
            case 8:
            default:
1870
                stq_phys(addr, val);
B
bellard 已提交
1871 1872
                break;
            }
B
blueswir1 已提交
1873 1874
        }
        return;
B
bellard 已提交
1875 1876 1877 1878 1879 1880 1881
    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 已提交
1882
    case 0x81: // Secondary
B
bellard 已提交
1883
    case 0x89: // Secondary LE
B
blueswir1 已提交
1884 1885
        // XXX
        return;
B
bellard 已提交
1886
    case 0x45: // LSU
B
blueswir1 已提交
1887 1888 1889 1890
        {
            uint64_t oldreg;

            oldreg = env->lsu;
B
blueswir1 已提交
1891
            env->lsu = val & (DMMU_E | IMMU_E);
B
blueswir1 已提交
1892 1893 1894
            // Mappings generated during D/I MMU disabled mode are
            // invalid in normal mode
            if (oldreg != env->lsu) {
B
blueswir1 已提交
1895 1896
                DPRINTF_MMU("LSU change: 0x%" PRIx64 " -> 0x%" PRIx64 "\n",
                            oldreg, env->lsu);
B
bellard 已提交
1897
#ifdef DEBUG_MMU
B
blueswir1 已提交
1898
                dump_mmu(env);
B
bellard 已提交
1899
#endif
B
blueswir1 已提交
1900 1901 1902 1903
                tlb_flush(env, 1);
            }
            return;
        }
B
bellard 已提交
1904
    case 0x50: // I-MMU regs
B
blueswir1 已提交
1905
        {
B
blueswir1 已提交
1906
            int reg = (addr >> 3) & 0xf;
B
blueswir1 已提交
1907
            uint64_t oldreg;
1908

B
blueswir1 已提交
1909
            oldreg = env->immuregs[reg];
B
bellard 已提交
1910 1911 1912 1913 1914 1915 1916 1917 1918 1919
            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 已提交
1920 1921
                if ((val & 1) == 0)
                    val = 0; // Clear SFSR
B
bellard 已提交
1922 1923 1924 1925 1926 1927
                break;
            case 5: // TSB access
            case 6: // Tag access
            default:
                break;
            }
B
blueswir1 已提交
1928
            env->immuregs[reg] = val;
B
bellard 已提交
1929
            if (oldreg != env->immuregs[reg]) {
B
blueswir1 已提交
1930 1931
                DPRINTF_MMU("mmu change reg[%d]: 0x%08" PRIx64 " -> 0x%08"
                            PRIx64 "\n", reg, oldreg, env->immuregs[reg]);
B
bellard 已提交
1932
            }
1933
#ifdef DEBUG_MMU
B
blueswir1 已提交
1934
            dump_mmu(env);
B
bellard 已提交
1935
#endif
B
blueswir1 已提交
1936 1937
            return;
        }
B
bellard 已提交
1938
    case 0x54: // I-MMU data in
B
blueswir1 已提交
1939 1940 1941 1942 1943 1944 1945
        {
            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 已提交
1946
                    env->itlb_tte[i] = val;
B
blueswir1 已提交
1947 1948 1949 1950 1951 1952 1953
                    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 已提交
1954
                    env->itlb_tte[i] = val;
B
blueswir1 已提交
1955 1956 1957 1958 1959 1960
                    return;
                }
            }
            // error state?
            return;
        }
B
bellard 已提交
1961
    case 0x55: // I-MMU data access
B
blueswir1 已提交
1962
        {
B
blueswir1 已提交
1963
            unsigned int i = (addr >> 3) & 0x3f;
B
bellard 已提交
1964

B
blueswir1 已提交
1965
            env->itlb_tag[i] = env->immuregs[6];
B
blueswir1 已提交
1966
            env->itlb_tte[i] = val;
B
blueswir1 已提交
1967 1968
            return;
        }
B
bellard 已提交
1969
    case 0x57: // I-MMU demap
B
blueswir1 已提交
1970 1971
        // XXX
        return;
B
bellard 已提交
1972
    case 0x58: // D-MMU regs
B
blueswir1 已提交
1973
        {
B
blueswir1 已提交
1974
            int reg = (addr >> 3) & 0xf;
B
blueswir1 已提交
1975
            uint64_t oldreg;
1976

B
blueswir1 已提交
1977
            oldreg = env->dmmuregs[reg];
B
bellard 已提交
1978 1979 1980 1981 1982
            switch(reg) {
            case 0: // RO
            case 4:
                return;
            case 3: // SFSR
B
blueswir1 已提交
1983 1984
                if ((val & 1) == 0) {
                    val = 0; // Clear SFSR, Fault address
B
blueswir1 已提交
1985 1986
                    env->dmmuregs[4] = 0;
                }
B
blueswir1 已提交
1987
                env->dmmuregs[reg] = val;
B
bellard 已提交
1988 1989 1990 1991 1992 1993 1994 1995 1996 1997
                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 已提交
1998
            env->dmmuregs[reg] = val;
B
bellard 已提交
1999
            if (oldreg != env->dmmuregs[reg]) {
B
blueswir1 已提交
2000 2001
                DPRINTF_MMU("mmu change reg[%d]: 0x%08" PRIx64 " -> 0x%08"
                            PRIx64 "\n", reg, oldreg, env->dmmuregs[reg]);
B
bellard 已提交
2002
            }
2003
#ifdef DEBUG_MMU
B
blueswir1 已提交
2004
            dump_mmu(env);
B
bellard 已提交
2005
#endif
B
blueswir1 已提交
2006 2007
            return;
        }
B
bellard 已提交
2008
    case 0x5c: // D-MMU data in
B
blueswir1 已提交
2009 2010 2011 2012 2013 2014 2015
        {
            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 已提交
2016
                    env->dtlb_tte[i] = val;
B
blueswir1 已提交
2017 2018 2019 2020 2021 2022 2023
                    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 已提交
2024
                    env->dtlb_tte[i] = val;
B
blueswir1 已提交
2025 2026 2027 2028 2029 2030
                    return;
                }
            }
            // error state?
            return;
        }
B
bellard 已提交
2031
    case 0x5d: // D-MMU data access
B
blueswir1 已提交
2032
        {
B
blueswir1 已提交
2033
            unsigned int i = (addr >> 3) & 0x3f;
B
bellard 已提交
2034

B
blueswir1 已提交
2035
            env->dtlb_tag[i] = env->dmmuregs[6];
B
blueswir1 已提交
2036
            env->dtlb_tte[i] = val;
B
blueswir1 已提交
2037 2038
            return;
        }
B
bellard 已提交
2039
    case 0x5f: // D-MMU demap
B
bellard 已提交
2040
    case 0x49: // Interrupt data receive
B
blueswir1 已提交
2041 2042
        // XXX
        return;
B
bellard 已提交
2043 2044 2045 2046 2047 2048 2049
    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 已提交
2050 2051 2052 2053 2054 2055
    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 已提交
2056
    default:
B
blueswir1 已提交
2057
        do_unassigned_access(addr, 1, 0, 1);
B
blueswir1 已提交
2058
        return;
B
bellard 已提交
2059 2060
    }
}
2061
#endif /* CONFIG_USER_ONLY */
2062

B
blueswir1 已提交
2063
void helper_ldf_asi(target_ulong addr, int asi, int size, int rd)
2064 2065
{
    unsigned int i;
B
blueswir1 已提交
2066
    target_ulong val;
2067

2068
    helper_check_align(addr, 3);
2069 2070 2071 2072 2073
    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 已提交
2074 2075 2076 2077
        if (rd & 7) {
            raise_exception(TT_ILL_INSN);
            return;
        }
2078
        helper_check_align(addr, 0x3f);
B
blueswir1 已提交
2079
        for (i = 0; i < 16; i++) {
B
blueswir1 已提交
2080 2081
            *(uint32_t *)&env->fpr[rd++] = helper_ld_asi(addr, asi & 0x8f, 4,
                                                         0);
B
blueswir1 已提交
2082
            addr += 4;
2083 2084 2085 2086 2087 2088 2089
        }

        return;
    default:
        break;
    }

B
blueswir1 已提交
2090
    val = helper_ld_asi(addr, asi, size, 0);
2091 2092 2093
    switch(size) {
    default:
    case 4:
B
blueswir1 已提交
2094
        *((uint32_t *)&FT0) = val;
2095 2096
        break;
    case 8:
B
blueswir1 已提交
2097
        *((int64_t *)&DT0) = val;
2098
        break;
B
blueswir1 已提交
2099 2100 2101
    case 16:
        // XXX
        break;
2102 2103 2104
    }
}

B
blueswir1 已提交
2105
void helper_stf_asi(target_ulong addr, int asi, int size, int rd)
2106 2107
{
    unsigned int i;
B
blueswir1 已提交
2108
    target_ulong val = 0;
2109

2110
    helper_check_align(addr, 3);
2111 2112 2113 2114 2115
    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 已提交
2116 2117 2118 2119
        if (rd & 7) {
            raise_exception(TT_ILL_INSN);
            return;
        }
2120
        helper_check_align(addr, 0x3f);
B
blueswir1 已提交
2121
        for (i = 0; i < 16; i++) {
B
blueswir1 已提交
2122 2123 2124
            val = *(uint32_t *)&env->fpr[rd++];
            helper_st_asi(addr, val, asi & 0x8f, 4);
            addr += 4;
2125 2126 2127 2128 2129 2130 2131 2132 2133 2134
        }

        return;
    default:
        break;
    }

    switch(size) {
    default:
    case 4:
B
blueswir1 已提交
2135
        val = *((uint32_t *)&FT0);
2136 2137
        break;
    case 8:
B
blueswir1 已提交
2138
        val = *((int64_t *)&DT0);
2139
        break;
B
blueswir1 已提交
2140 2141 2142
    case 16:
        // XXX
        break;
2143
    }
B
blueswir1 已提交
2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157
    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;
2158 2159
}

B
blueswir1 已提交
2160 2161 2162 2163 2164 2165 2166 2167 2168 2169
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;
}
2170
#endif /* TARGET_SPARC64 */
B
bellard 已提交
2171 2172

#ifndef TARGET_SPARC64
B
blueswir1 已提交
2173
void helper_rett(void)
2174
{
2175 2176
    unsigned int cwp;

2177 2178 2179
    if (env->psret == 1)
        raise_exception(TT_ILL_INSN);

2180
    env->psret = 1;
2181
    cwp = cpu_cwp_inc(env, env->cwp + 1) ;
2182 2183 2184 2185 2186 2187
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_UNF);
    }
    set_cwp(cwp);
    env->psrs = env->psrps;
}
B
bellard 已提交
2188
#endif
2189

B
blueswir1 已提交
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 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233
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 已提交
2234 2235 2236 2237 2238
uint64_t helper_pack64(target_ulong high, target_ulong low)
{
    return ((uint64_t)high << 32) | (uint64_t)(low & 0xffffffff);
}

B
blueswir1 已提交
2239 2240
void helper_stdf(target_ulong addr, int mem_idx)
{
2241
    helper_check_align(addr, 7);
B
blueswir1 已提交
2242 2243 2244
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
2245
        stfq_user(addr, DT0);
B
blueswir1 已提交
2246 2247
        break;
    case 1:
2248
        stfq_kernel(addr, DT0);
B
blueswir1 已提交
2249 2250 2251
        break;
#ifdef TARGET_SPARC64
    case 2:
2252
        stfq_hypv(addr, DT0);
B
blueswir1 已提交
2253 2254 2255 2256 2257 2258
        break;
#endif
    default:
        break;
    }
#else
2259 2260
    ABI32_MASK(addr);
    stfq_raw(addr, DT0);
B
blueswir1 已提交
2261 2262 2263 2264 2265
#endif
}

void helper_lddf(target_ulong addr, int mem_idx)
{
2266
    helper_check_align(addr, 7);
B
blueswir1 已提交
2267 2268 2269
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
2270
        DT0 = ldfq_user(addr);
B
blueswir1 已提交
2271 2272
        break;
    case 1:
2273
        DT0 = ldfq_kernel(addr);
B
blueswir1 已提交
2274 2275 2276
        break;
#ifdef TARGET_SPARC64
    case 2:
2277
        DT0 = ldfq_hypv(addr);
B
blueswir1 已提交
2278 2279 2280 2281 2282 2283
        break;
#endif
    default:
        break;
    }
#else
2284 2285
    ABI32_MASK(addr);
    DT0 = ldfq_raw(addr);
B
blueswir1 已提交
2286 2287 2288
#endif
}

B
blueswir1 已提交
2289
void helper_ldqf(target_ulong addr, int mem_idx)
B
blueswir1 已提交
2290 2291 2292 2293
{
    // XXX add 128 bit load
    CPU_QuadU u;

2294
    helper_check_align(addr, 7);
B
blueswir1 已提交
2295 2296 2297
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
2298 2299
        u.ll.upper = ldq_user(addr);
        u.ll.lower = ldq_user(addr + 8);
B
blueswir1 已提交
2300 2301 2302
        QT0 = u.q;
        break;
    case 1:
2303 2304
        u.ll.upper = ldq_kernel(addr);
        u.ll.lower = ldq_kernel(addr + 8);
B
blueswir1 已提交
2305 2306 2307 2308
        QT0 = u.q;
        break;
#ifdef TARGET_SPARC64
    case 2:
2309 2310
        u.ll.upper = ldq_hypv(addr);
        u.ll.lower = ldq_hypv(addr + 8);
B
blueswir1 已提交
2311 2312 2313 2314 2315 2316 2317
        QT0 = u.q;
        break;
#endif
    default:
        break;
    }
#else
2318 2319 2320
    ABI32_MASK(addr);
    u.ll.upper = ldq_raw(addr);
    u.ll.lower = ldq_raw((addr + 8) & 0xffffffffULL);
B
blueswir1 已提交
2321
    QT0 = u.q;
B
blueswir1 已提交
2322
#endif
B
blueswir1 已提交
2323 2324
}

B
blueswir1 已提交
2325
void helper_stqf(target_ulong addr, int mem_idx)
B
blueswir1 已提交
2326 2327 2328 2329
{
    // XXX add 128 bit store
    CPU_QuadU u;

2330
    helper_check_align(addr, 7);
B
blueswir1 已提交
2331 2332 2333 2334
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
        u.q = QT0;
2335 2336
        stq_user(addr, u.ll.upper);
        stq_user(addr + 8, u.ll.lower);
B
blueswir1 已提交
2337 2338 2339
        break;
    case 1:
        u.q = QT0;
2340 2341
        stq_kernel(addr, u.ll.upper);
        stq_kernel(addr + 8, u.ll.lower);
B
blueswir1 已提交
2342 2343 2344 2345
        break;
#ifdef TARGET_SPARC64
    case 2:
        u.q = QT0;
2346 2347
        stq_hypv(addr, u.ll.upper);
        stq_hypv(addr + 8, u.ll.lower);
B
blueswir1 已提交
2348 2349 2350 2351 2352 2353
        break;
#endif
    default:
        break;
    }
#else
B
blueswir1 已提交
2354
    u.q = QT0;
2355 2356 2357
    ABI32_MASK(addr);
    stq_raw(addr, u.ll.upper);
    stq_raw((addr + 8) & 0xffffffffULL, u.ll.lower);
B
blueswir1 已提交
2358
#endif
B
blueswir1 已提交
2359
}
B
blueswir1 已提交
2360

B
bellard 已提交
2361
void helper_ldfsr(void)
2362
{
B
bellard 已提交
2363
    int rnd_mode;
B
blueswir1 已提交
2364 2365

    PUT_FSR32(env, *((uint32_t *) &FT0));
2366 2367
    switch (env->fsr & FSR_RD_MASK) {
    case FSR_RD_NEAREST:
B
bellard 已提交
2368
        rnd_mode = float_round_nearest_even;
B
blueswir1 已提交
2369
        break;
B
bellard 已提交
2370
    default:
2371
    case FSR_RD_ZERO:
B
bellard 已提交
2372
        rnd_mode = float_round_to_zero;
B
blueswir1 已提交
2373
        break;
2374
    case FSR_RD_POS:
B
bellard 已提交
2375
        rnd_mode = float_round_up;
B
blueswir1 已提交
2376
        break;
2377
    case FSR_RD_NEG:
B
bellard 已提交
2378
        rnd_mode = float_round_down;
B
blueswir1 已提交
2379
        break;
2380
    }
B
bellard 已提交
2381
    set_float_rounding_mode(rnd_mode, &env->fp_status);
2382
}
B
bellard 已提交
2383

B
blueswir1 已提交
2384 2385 2386 2387 2388 2389
void helper_stfsr(void)
{
    *((uint32_t *) &FT0) = GET_FSR32(env);
}

void helper_debug(void)
B
bellard 已提交
2390 2391 2392 2393
{
    env->exception_index = EXCP_DEBUG;
    cpu_loop_exit();
}
2394

B
bellard 已提交
2395
#ifndef TARGET_SPARC64
2396 2397 2398 2399 2400 2401
/* XXX: use another pointer for %iN registers to avoid slow wrapping
   handling ? */
void helper_save(void)
{
    uint32_t cwp;

2402
    cwp = cpu_cwp_dec(env, env->cwp - 1);
2403 2404 2405 2406 2407 2408 2409 2410 2411 2412
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_OVF);
    }
    set_cwp(cwp);
}

void helper_restore(void)
{
    uint32_t cwp;

2413
    cwp = cpu_cwp_inc(env, env->cwp + 1);
2414 2415 2416 2417 2418 2419
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_UNF);
    }
    set_cwp(cwp);
}

B
blueswir1 已提交
2420
void helper_wrpsr(target_ulong new_psr)
2421
{
2422
    if ((new_psr & PSR_CWP) >= env->nwindows)
2423 2424
        raise_exception(TT_ILL_INSN);
    else
B
blueswir1 已提交
2425
        PUT_PSR(env, new_psr);
2426 2427
}

B
blueswir1 已提交
2428
target_ulong helper_rdpsr(void)
2429
{
B
blueswir1 已提交
2430
    return GET_PSR(env);
2431
}
B
bellard 已提交
2432 2433

#else
2434 2435 2436 2437 2438 2439
/* XXX: use another pointer for %iN registers to avoid slow wrapping
   handling ? */
void helper_save(void)
{
    uint32_t cwp;

2440
    cwp = cpu_cwp_dec(env, env->cwp - 1);
2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460
    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;

2461
    cwp = cpu_cwp_inc(env, env->cwp + 1);
2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474
    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)
{
2475
    if (env->cansave != env->nwindows - 2) {
2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493
        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++;
2494
    if (env->cleanwin < env->nwindows - 1)
2495 2496 2497 2498 2499 2500 2501
        env->cleanwin++;
    if (env->otherwin == 0)
        env->cansave--;
    else
        env->otherwin--;
}

B
blueswir1 已提交
2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522
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 已提交
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 2550 2551 2552 2553 2554
// 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 已提交
2555
target_ulong helper_popc(target_ulong val)
B
bellard 已提交
2556
{
B
blueswir1 已提交
2557
    return ctpop64(val);
B
bellard 已提交
2558
}
B
bellard 已提交
2559 2560 2561 2562 2563 2564

static inline uint64_t *get_gregset(uint64_t pstate)
{
    switch (pstate) {
    default:
    case 0:
B
blueswir1 已提交
2565
        return env->bgregs;
B
bellard 已提交
2566
    case PS_AG:
B
blueswir1 已提交
2567
        return env->agregs;
B
bellard 已提交
2568
    case PS_MG:
B
blueswir1 已提交
2569
        return env->mgregs;
B
bellard 已提交
2570
    case PS_IG:
B
blueswir1 已提交
2571
        return env->igregs;
B
bellard 已提交
2572 2573 2574
    }
}

2575
void change_pstate(uint64_t new_pstate)
B
bellard 已提交
2576
{
2577
    uint64_t pstate_regs, new_pstate_regs;
B
bellard 已提交
2578 2579 2580 2581 2582
    uint64_t *src, *dst;

    pstate_regs = env->pstate & 0xc01;
    new_pstate_regs = new_pstate & 0xc01;
    if (new_pstate_regs != pstate_regs) {
B
blueswir1 已提交
2583 2584 2585 2586 2587
        // 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 已提交
2588 2589 2590 2591
    }
    env->pstate = new_pstate;
}

B
blueswir1 已提交
2592
void helper_wrpstate(target_ulong new_state)
2593
{
B
blueswir1 已提交
2594
    change_pstate(new_state & 0xf3f);
2595 2596
}

B
blueswir1 已提交
2597
void helper_done(void)
B
bellard 已提交
2598 2599
{
    env->tl--;
2600 2601 2602 2603 2604 2605 2606
    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 已提交
2607 2608
}

B
blueswir1 已提交
2609
void helper_retry(void)
B
bellard 已提交
2610 2611
{
    env->tl--;
2612 2613 2614 2615 2616 2617 2618
    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 已提交
2619
}
B
bellard 已提交
2620
#endif
2621

2622
void cpu_set_cwp(CPUState *env1, int new_cwp)
2623 2624
{
    /* put the modified wrap registers at their proper location */
2625 2626
    if (env1->cwp == env1->nwindows - 1)
        memcpy32(env1->regbase, env1->regbase + env1->nwindows * 16);
2627
    env1->cwp = new_cwp;
2628
    /* put the wrap registers at their temporary location */
2629 2630
    if (new_cwp == env1->nwindows - 1)
        memcpy32(env1->regbase + env1->nwindows * 16, env1->regbase);
2631
    env1->regwptr = env1->regbase + (new_cwp * 16);
2632 2633
}

2634
void set_cwp(int new_cwp)
2635
{
2636
    cpu_set_cwp(env, new_cwp);
2637 2638
}

2639
void helper_flush(target_ulong addr)
2640
{
2641 2642
    addr &= ~7;
    tb_invalidate_page_range(addr, addr + 8);
2643 2644
}

2645
#if !defined(CONFIG_USER_ONLY)
2646

2647 2648 2649
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
                                void *retaddr);

2650
#define MMUSUFFIX _mmu
2651
#define ALIGNED_ONLY
2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664

#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"

2665 2666 2667 2668 2669 2670 2671 2672 2673 2674 2675 2676 2677 2678 2679 2680 2681 2682
/* XXX: make it generic ? */
static void cpu_restore_state2(void *retaddr)
{
    TranslationBlock *tb;
    unsigned long pc;

    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 *)(long)env->cond);
        }
    }
}

2683 2684 2685
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
                                void *retaddr)
{
B
blueswir1 已提交
2686
#ifdef DEBUG_UNALIGNED
2687 2688
    printf("Unaligned access to 0x" TARGET_FMT_lx " from 0x" TARGET_FMT_lx
           "\n", addr, env->pc);
B
blueswir1 已提交
2689
#endif
2690
    cpu_restore_state2(retaddr);
B
blueswir1 已提交
2691
    raise_exception(TT_UNALIGNED);
2692
}
2693 2694 2695 2696 2697

/* 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 */
2698
void tlb_fill(target_ulong addr, int is_write, int mmu_idx, void *retaddr)
2699 2700 2701 2702 2703 2704 2705 2706 2707
{
    int ret;
    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;

2708
    ret = cpu_sparc_handle_mmu_fault(env, addr, is_write, mmu_idx, 1);
2709
    if (ret) {
2710
        cpu_restore_state2(retaddr);
2711 2712 2713 2714 2715 2716
        cpu_loop_exit();
    }
    env = saved_env;
}

#endif
2717 2718

#ifndef TARGET_SPARC64
2719
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
2720 2721 2722 2723 2724 2725 2726 2727
                          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;
2728 2729
#ifdef DEBUG_UNASSIGNED
    if (is_asi)
B
blueswir1 已提交
2730 2731
        printf("Unassigned mem %s access to " TARGET_FMT_plx
               " asi 0x%02x from " TARGET_FMT_lx "\n",
2732 2733 2734 2735 2736 2737 2738
               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
2739
    if (env->mmuregs[3]) /* Fault status register */
B
blueswir1 已提交
2740
        env->mmuregs[3] = 1; /* overflow (not read before another fault) */
2741 2742 2743 2744 2745 2746 2747 2748 2749 2750 2751
    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)) {
2752 2753 2754 2755
        if (is_exec)
            raise_exception(TT_CODE_ACCESS);
        else
            raise_exception(TT_DATA_ACCESS);
2756 2757 2758 2759
    }
    env = saved_env;
}
#else
2760
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
2761 2762 2763 2764 2765 2766 2767 2768 2769
                          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;
B
blueswir1 已提交
2770 2771
    printf("Unassigned mem access to " TARGET_FMT_plx " from " TARGET_FMT_lx
           "\n", addr, env->pc);
2772 2773
    env = saved_env;
#endif
2774 2775 2776 2777
    if (is_exec)
        raise_exception(TT_CODE_ACCESS);
    else
        raise_exception(TT_DATA_ACCESS);
2778 2779
}
#endif
2780