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

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

13
#ifdef DEBUG_MMU
14 15
#define DPRINTF_MMU(fmt, ...)                                   \
    do { printf("MMU: " fmt , ## __VA_ARGS__); } while (0)
16
#else
17
#define DPRINTF_MMU(fmt, ...) do {} while (0)
18 19 20
#endif

#ifdef DEBUG_MXCC
21 22
#define DPRINTF_MXCC(fmt, ...)                                  \
    do { printf("MXCC: " fmt , ## __VA_ARGS__); } while (0)
23
#else
24
#define DPRINTF_MXCC(fmt, ...) do {} while (0)
25 26
#endif

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

32 33 34 35 36 37 38
#ifdef DEBUG_PSTATE
#define DPRINTF_PSTATE(fmt, ...)                                   \
    do { printf("PSTATE: " fmt , ## __VA_ARGS__); } while (0)
#else
#define DPRINTF_PSTATE(fmt, ...) do {} while (0)
#endif

B
blueswir1 已提交
39 40 41
#ifdef TARGET_SPARC64
#ifndef TARGET_ABI32
#define AM_CHECK(env1) ((env1)->pstate & PS_AM)
42
#else
B
blueswir1 已提交
43 44
#define AM_CHECK(env1) (1)
#endif
45 46
#endif

47 48 49 50 51
#define DT0 (env->dt0)
#define DT1 (env->dt1)
#define QT0 (env->qt0)
#define QT1 (env->qt1)

P
Paul Brook 已提交
52 53 54 55 56
#if defined(CONFIG_USER_ONLY) && defined(TARGET_SPARC64)
static void do_unassigned_access(target_ulong addr, int is_write, int is_exec,
                          int is_asi, int size);
#endif

57
#if defined(TARGET_SPARC64) && !defined(CONFIG_USER_ONLY)
58 59 60 61 62 63
// Calculates TSB pointer value for fault page size 8k or 64k
static uint64_t ultrasparc_tsb_pointer(uint64_t tsb_register,
                                       uint64_t tag_access_register,
                                       int page_size)
{
    uint64_t tsb_base = tsb_register & ~0x1fffULL;
64 65
    int tsb_split = (tsb_register & 0x1000ULL) ? 1 : 0;
    int tsb_size  = tsb_register & 0xf;
66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104

    // discard lower 13 bits which hold tag access context
    uint64_t tag_access_va = tag_access_register & ~0x1fffULL;

    // now reorder bits
    uint64_t tsb_base_mask = ~0x1fffULL;
    uint64_t va = tag_access_va;

    // move va bits to correct position
    if (page_size == 8*1024) {
        va >>= 9;
    } else if (page_size == 64*1024) {
        va >>= 12;
    }

    if (tsb_size) {
        tsb_base_mask <<= tsb_size;
    }

    // calculate tsb_base mask and adjust va if split is in use
    if (tsb_split) {
        if (page_size == 8*1024) {
            va &= ~(1ULL << (13 + tsb_size));
        } else if (page_size == 64*1024) {
            va |= (1ULL << (13 + tsb_size));
        }
        tsb_base_mask <<= 1;
    }

    return ((tsb_base & tsb_base_mask) | (va & ~tsb_base_mask)) & ~0xfULL;
}

// Calculates tag target register value by reordering bits
// in tag access register
static uint64_t ultrasparc_tag_target(uint64_t tag_access_register)
{
    return ((tag_access_register & 0x1fff) << 48) | (tag_access_register >> 22);
}

105 106 107
static void replace_tlb_entry(SparcTLBEntry *tlb,
                              uint64_t tlb_tag, uint64_t tlb_tte,
                              CPUState *env1)
108 109 110 111
{
    target_ulong mask, size, va, offset;

    // flush page range if translation is valid
112
    if (TTE_IS_VALID(tlb->tte)) {
113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129

        mask = 0xffffffffffffe000ULL;
        mask <<= 3 * ((tlb->tte >> 61) & 3);
        size = ~mask + 1;

        va = tlb->tag & mask;

        for (offset = 0; offset < size; offset += TARGET_PAGE_SIZE) {
            tlb_flush_page(env1, va + offset);
        }
    }

    tlb->tag = tlb_tag;
    tlb->tte = tlb_tte;
}

static void demap_tlb(SparcTLBEntry *tlb, target_ulong demap_addr,
130
                      const char* strmmu, CPUState *env1)
131 132 133
{
    unsigned int i;
    target_ulong mask;
134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152
    uint64_t context;

    int is_demap_context = (demap_addr >> 6) & 1;

    // demap context
    switch ((demap_addr >> 4) & 3) {
    case 0: // primary
        context = env1->dmmu.mmu_primary_context;
        break;
    case 1: // secondary
        context = env1->dmmu.mmu_secondary_context;
        break;
    case 2: // nucleus
        context = 0;
        break;
    case 3: // reserved
    default:
        return;
    }
153 154

    for (i = 0; i < 64; i++) {
155
        if (TTE_IS_VALID(tlb[i].tte)) {
156

157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178
            if (is_demap_context) {
                // will remove non-global entries matching context value
                if (TTE_IS_GLOBAL(tlb[i].tte) ||
                    !tlb_compare_context(&tlb[i], context)) {
                    continue;
                }
            } else {
                // demap page
                // will remove any entry matching VA
                mask = 0xffffffffffffe000ULL;
                mask <<= 3 * ((tlb[i].tte >> 61) & 3);

                if (!compare_masked(demap_addr, tlb[i].tag, mask)) {
                    continue;
                }

                // entry should be global or matching context value
                if (!TTE_IS_GLOBAL(tlb[i].tte) &&
                    !tlb_compare_context(&tlb[i], context)) {
                    continue;
                }
            }
179

180
            replace_tlb_entry(&tlb[i], 0, 0, env1);
181
#ifdef DEBUG_MMU
182 183
            DPRINTF_MMU("%s demap invalidated entry [%02u]\n", strmmu, i);
            dump_mmu(env1);
184 185 186 187 188
#endif
        }
    }
}

189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238
static void replace_tlb_1bit_lru(SparcTLBEntry *tlb,
                                 uint64_t tlb_tag, uint64_t tlb_tte,
                                 const char* strmmu, CPUState *env1)
{
    unsigned int i, replace_used;

    // Try replacing invalid entry
    for (i = 0; i < 64; i++) {
        if (!TTE_IS_VALID(tlb[i].tte)) {
            replace_tlb_entry(&tlb[i], tlb_tag, tlb_tte, env1);
#ifdef DEBUG_MMU
            DPRINTF_MMU("%s lru replaced invalid entry [%i]\n", strmmu, i);
            dump_mmu(env1);
#endif
            return;
        }
    }

    // All entries are valid, try replacing unlocked entry

    for (replace_used = 0; replace_used < 2; ++replace_used) {

        // Used entries are not replaced on first pass

        for (i = 0; i < 64; i++) {
            if (!TTE_IS_LOCKED(tlb[i].tte) && !TTE_IS_USED(tlb[i].tte)) {

                replace_tlb_entry(&tlb[i], tlb_tag, tlb_tte, env1);
#ifdef DEBUG_MMU
                DPRINTF_MMU("%s lru replaced unlocked %s entry [%i]\n",
                            strmmu, (replace_used?"used":"unused"), i);
                dump_mmu(env1);
#endif
                return;
            }
        }

        // Now reset used bit and search for unused entries again

        for (i = 0; i < 64; i++) {
            TTE_SET_UNUSED(tlb[i].tte);
        }
    }

#ifdef DEBUG_MMU
    DPRINTF_MMU("%s lru replacement failed: no entries available\n", strmmu);
#endif
    // error state?
}

239 240
#endif

241
static inline target_ulong address_mask(CPUState *env1, target_ulong addr)
B
blueswir1 已提交
242 243 244
{
#ifdef TARGET_SPARC64
    if (AM_CHECK(env1))
245
        addr &= 0xffffffffULL;
B
blueswir1 已提交
246
#endif
247
    return addr;
B
blueswir1 已提交
248 249
}

B
blueswir1 已提交
250
static void raise_exception(int tt)
B
bellard 已提交
251 252 253
{
    env->exception_index = tt;
    cpu_loop_exit();
254
}
B
bellard 已提交
255

P
pbrook 已提交
256 257 258 259 260
void HELPER(raise_exception)(int tt)
{
    raise_exception(tt);
}

B
blueswir1 已提交
261 262
void helper_check_align(target_ulong addr, uint32_t align)
{
263 264 265 266 267
    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 已提交
268
        raise_exception(TT_UNALIGNED);
269
    }
B
blueswir1 已提交
270 271
}

272 273 274
#define F_HELPER(name, p) void helper_f##name##p(void)

#define F_BINOP(name)                                           \
B
blueswir1 已提交
275
    float32 helper_f ## name ## s (float32 src1, float32 src2)  \
276
    {                                                           \
B
blueswir1 已提交
277
        return float32_ ## name (src1, src2, &env->fp_status);  \
278 279 280 281
    }                                                           \
    F_HELPER(name, d)                                           \
    {                                                           \
        DT0 = float64_ ## name (DT0, DT1, &env->fp_status);     \
B
blueswir1 已提交
282 283 284 285
    }                                                           \
    F_HELPER(name, q)                                           \
    {                                                           \
        QT0 = float128_ ## name (QT0, QT1, &env->fp_status);    \
286 287 288 289 290 291 292 293
    }

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

294
void helper_fsmuld(float32 src1, float32 src2)
B
blueswir1 已提交
295
{
296 297
    DT0 = float64_mul(float32_to_float64(src1, &env->fp_status),
                      float32_to_float64(src2, &env->fp_status),
298 299
                      &env->fp_status);
}
B
blueswir1 已提交
300

B
blueswir1 已提交
301 302 303 304 305 306 307
void helper_fdmulq(void)
{
    QT0 = float128_mul(float64_to_float128(DT0, &env->fp_status),
                       float64_to_float128(DT1, &env->fp_status),
                       &env->fp_status);
}

B
blueswir1 已提交
308
float32 helper_fnegs(float32 src)
309
{
B
blueswir1 已提交
310
    return float32_chs(src);
311 312
}

313 314
#ifdef TARGET_SPARC64
F_HELPER(neg, d)
315
{
316
    DT0 = float64_chs(DT1);
317
}
B
blueswir1 已提交
318 319 320 321 322 323

F_HELPER(neg, q)
{
    QT0 = float128_chs(QT1);
}
#endif
324 325

/* Integer to float conversion.  */
B
blueswir1 已提交
326
float32 helper_fitos(int32_t src)
B
bellard 已提交
327
{
B
blueswir1 已提交
328
    return int32_to_float32(src, &env->fp_status);
B
bellard 已提交
329 330
}

331
void helper_fitod(int32_t src)
B
bellard 已提交
332
{
333
    DT0 = int32_to_float64(src, &env->fp_status);
B
bellard 已提交
334
}
335

336
void helper_fitoq(int32_t src)
B
blueswir1 已提交
337
{
338
    QT0 = int32_to_float128(src, &env->fp_status);
B
blueswir1 已提交
339 340
}

B
blueswir1 已提交
341
#ifdef TARGET_SPARC64
342
float32 helper_fxtos(void)
B
blueswir1 已提交
343
{
344
    return int64_to_float32(*((int64_t *)&DT1), &env->fp_status);
B
blueswir1 已提交
345 346
}

347
F_HELPER(xto, d)
B
blueswir1 已提交
348 349 350
{
    DT0 = int64_to_float64(*((int64_t *)&DT1), &env->fp_status);
}
B
blueswir1 已提交
351

B
blueswir1 已提交
352 353 354 355 356
F_HELPER(xto, q)
{
    QT0 = int64_to_float128(*((int64_t *)&DT1), &env->fp_status);
}
#endif
357 358 359
#undef F_HELPER

/* floating point conversion */
360
float32 helper_fdtos(void)
361
{
362
    return float64_to_float32(DT1, &env->fp_status);
363 364
}

365
void helper_fstod(float32 src)
366
{
367
    DT0 = float32_to_float64(src, &env->fp_status);
368
}
369

370
float32 helper_fqtos(void)
B
blueswir1 已提交
371
{
372
    return float128_to_float32(QT1, &env->fp_status);
B
blueswir1 已提交
373 374
}

375
void helper_fstoq(float32 src)
B
blueswir1 已提交
376
{
377
    QT0 = float32_to_float128(src, &env->fp_status);
B
blueswir1 已提交
378 379 380 381 382 383 384 385 386 387 388 389
}

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

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

390
/* Float to integer conversion.  */
B
blueswir1 已提交
391
int32_t helper_fstoi(float32 src)
392
{
B
blueswir1 已提交
393
    return float32_to_int32_round_to_zero(src, &env->fp_status);
394 395
}

396
int32_t helper_fdtoi(void)
397
{
398
    return float64_to_int32_round_to_zero(DT1, &env->fp_status);
399 400
}

401
int32_t helper_fqtoi(void)
B
blueswir1 已提交
402
{
403
    return float128_to_int32_round_to_zero(QT1, &env->fp_status);
B
blueswir1 已提交
404 405
}

406
#ifdef TARGET_SPARC64
407
void helper_fstox(float32 src)
408
{
409
    *((int64_t *)&DT0) = float32_to_int64_round_to_zero(src, &env->fp_status);
410 411 412 413 414 415 416
}

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

B
blueswir1 已提交
417 418 419 420 421
void helper_fqtox(void)
{
    *((int64_t *)&DT0) = float128_to_int64_round_to_zero(QT1, &env->fp_status);
}

422 423 424 425 426
void helper_faligndata(void)
{
    uint64_t tmp;

    tmp = (*((uint64_t *)&DT0)) << ((env->gsr & 7) * 8);
B
blueswir1 已提交
427 428 429 430
    /* on many architectures a shift of 64 does nothing */
    if ((env->gsr & 7) != 0) {
        tmp |= (*((uint64_t *)&DT1)) >> (64 - (env->gsr & 7) * 8);
    }
431 432 433
    *((uint64_t *)&DT0) = tmp;
}

434
#ifdef HOST_WORDS_BIGENDIAN
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
#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;
651 652 653 654
    d.VIS_W64(0) = s.VIS_B32(0) << 4;
    d.VIS_W64(1) = s.VIS_B32(1) << 4;
    d.VIS_W64(2) = s.VIS_B32(2) << 4;
    d.VIS_W64(3) = s.VIS_B32(3) << 4;
655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674

    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;                                      \
    }                                                   \
                                                        \
B
blueswir1 已提交
675
    uint32_t name##16s(uint32_t src1, uint32_t src2)    \
676 677 678
    {                                                   \
        vis32 s, d;                                     \
                                                        \
B
blueswir1 已提交
679 680
        s.l = src1;                                     \
        d.l = src2;                                     \
681 682 683 684
                                                        \
        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));   \
                                                        \
B
blueswir1 已提交
685
        return d.l;                                     \
686 687 688 689 690 691 692 693 694 695 696 697 698 699 700
    }                                                   \
                                                        \
    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;                                      \
    }                                                   \
                                                        \
B
blueswir1 已提交
701
    uint32_t name##32s(uint32_t src1, uint32_t src2)    \
702 703 704
    {                                                   \
        vis32 s, d;                                     \
                                                        \
B
blueswir1 已提交
705 706
        s.l = src1;                                     \
        d.l = src2;                                     \
707 708 709
                                                        \
        d.l = F(d.l, s.l);                              \
                                                        \
B
blueswir1 已提交
710
        return d.l;                                     \
711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791
    }

#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);
}

B
blueswir1 已提交
792
float32 helper_fabss(float32 src)
793
{
B
blueswir1 已提交
794
    return float32_abs(src);
795 796
}

B
bellard 已提交
797
#ifdef TARGET_SPARC64
798
void helper_fabsd(void)
B
bellard 已提交
799 800 801
{
    DT0 = float64_abs(DT1);
}
B
blueswir1 已提交
802 803 804 805 806 807

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

B
blueswir1 已提交
809
float32 helper_fsqrts(float32 src)
810
{
B
blueswir1 已提交
811
    return float32_sqrt(src, &env->fp_status);
812 813
}

814
void helper_fsqrtd(void)
815
{
B
bellard 已提交
816
    DT0 = float64_sqrt(DT1, &env->fp_status);
817 818
}

B
blueswir1 已提交
819 820 821 822 823
void helper_fsqrtq(void)
{
    QT0 = float128_sqrt(QT1, &env->fp_status);
}

824
#define GEN_FCMP(name, size, reg1, reg2, FS, TRAP)                      \
825
    void glue(helper_, name) (void)                                     \
B
bellard 已提交
826
    {                                                                   \
B
blueswir1 已提交
827 828
        target_ulong new_fsr;                                           \
                                                                        \
B
bellard 已提交
829 830 831
        env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                     \
        switch (glue(size, _compare) (reg1, reg2, &env->fp_status)) {   \
        case float_relation_unordered:                                  \
B
blueswir1 已提交
832
            new_fsr = (FSR_FCC1 | FSR_FCC0) << FS;                      \
833
            if ((env->fsr & FSR_NVM) || TRAP) {                         \
B
blueswir1 已提交
834
                env->fsr |= new_fsr;                                    \
835 836
                env->fsr |= FSR_NVC;                                    \
                env->fsr |= FSR_FTT_IEEE_EXCP;                          \
B
bellard 已提交
837 838 839 840 841 842
                raise_exception(TT_FP_EXCP);                            \
            } else {                                                    \
                env->fsr |= FSR_NVA;                                    \
            }                                                           \
            break;                                                      \
        case float_relation_less:                                       \
B
blueswir1 已提交
843
            new_fsr = FSR_FCC0 << FS;                                   \
B
bellard 已提交
844 845
            break;                                                      \
        case float_relation_greater:                                    \
B
blueswir1 已提交
846
            new_fsr = FSR_FCC1 << FS;                                   \
B
bellard 已提交
847 848
            break;                                                      \
        default:                                                        \
B
blueswir1 已提交
849
            new_fsr = 0;                                                \
B
bellard 已提交
850 851
            break;                                                      \
        }                                                               \
B
blueswir1 已提交
852
        env->fsr |= new_fsr;                                            \
853
    }
B
blueswir1 已提交
854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883
#define GEN_FCMPS(name, size, FS, TRAP)                                 \
    void glue(helper_, name)(float32 src1, float32 src2)                \
    {                                                                   \
        target_ulong new_fsr;                                           \
                                                                        \
        env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                     \
        switch (glue(size, _compare) (src1, src2, &env->fp_status)) {   \
        case float_relation_unordered:                                  \
            new_fsr = (FSR_FCC1 | FSR_FCC0) << FS;                      \
            if ((env->fsr & FSR_NVM) || TRAP) {                         \
                env->fsr |= new_fsr;                                    \
                env->fsr |= FSR_NVC;                                    \
                env->fsr |= FSR_FTT_IEEE_EXCP;                          \
                raise_exception(TT_FP_EXCP);                            \
            } else {                                                    \
                env->fsr |= FSR_NVA;                                    \
            }                                                           \
            break;                                                      \
        case float_relation_less:                                       \
            new_fsr = FSR_FCC0 << FS;                                   \
            break;                                                      \
        case float_relation_greater:                                    \
            new_fsr = FSR_FCC1 << FS;                                   \
            break;                                                      \
        default:                                                        \
            new_fsr = 0;                                                \
            break;                                                      \
        }                                                               \
        env->fsr |= new_fsr;                                            \
    }
884

B
blueswir1 已提交
885
GEN_FCMPS(fcmps, float32, 0, 0);
886 887
GEN_FCMP(fcmpd, float64, DT0, DT1, 0, 0);

B
blueswir1 已提交
888
GEN_FCMPS(fcmpes, float32, 0, 1);
889
GEN_FCMP(fcmped, float64, DT0, DT1, 0, 1);
B
bellard 已提交
890

B
blueswir1 已提交
891 892 893
GEN_FCMP(fcmpq, float128, QT0, QT1, 0, 0);
GEN_FCMP(fcmpeq, float128, QT0, QT1, 0, 1);

894 895 896 897 898 899 900 901 902 903
static uint32_t compute_all_flags(void)
{
    return env->psr & PSR_ICC;
}

static uint32_t compute_C_flags(void)
{
    return env->psr & PSR_CARRY;
}

904
static inline uint32_t get_NZ_icc(int32_t dst)
B
Blue Swirl 已提交
905 906 907
{
    uint32_t ret = 0;

908 909 910 911 912
    if (dst == 0) {
        ret = PSR_ZERO;
    } else if (dst < 0) {
        ret = PSR_NEG;
    }
B
Blue Swirl 已提交
913 914 915
    return ret;
}

916 917 918 919 920 921 922 923 924 925 926
#ifdef TARGET_SPARC64
static uint32_t compute_all_flags_xcc(void)
{
    return env->xcc & PSR_ICC;
}

static uint32_t compute_C_flags_xcc(void)
{
    return env->xcc & PSR_CARRY;
}

927
static inline uint32_t get_NZ_xcc(target_long dst)
B
Blue Swirl 已提交
928 929 930
{
    uint32_t ret = 0;

931 932 933 934 935
    if (!dst) {
        ret = PSR_ZERO;
    } else if (dst < 0) {
        ret = PSR_NEG;
    }
B
Blue Swirl 已提交
936 937 938 939
    return ret;
}
#endif

B
Blue Swirl 已提交
940 941 942 943
static inline uint32_t get_V_div_icc(target_ulong src2)
{
    uint32_t ret = 0;

944 945 946
    if (src2 != 0) {
        ret = PSR_OVF;
    }
B
Blue Swirl 已提交
947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963
    return ret;
}

static uint32_t compute_all_div(void)
{
    uint32_t ret;

    ret = get_NZ_icc(CC_DST);
    ret |= get_V_div_icc(CC_SRC2);
    return ret;
}

static uint32_t compute_C_div(void)
{
    return 0;
}

964
static inline uint32_t get_C_add_icc(uint32_t dst, uint32_t src1)
B
Blue Swirl 已提交
965 966 967
{
    uint32_t ret = 0;

968 969 970
    if (dst < src1) {
        ret = PSR_CARRY;
    }
B
Blue Swirl 已提交
971 972 973
    return ret;
}

974 975
static inline uint32_t get_C_addx_icc(uint32_t dst, uint32_t src1,
                                      uint32_t src2)
B
Blue Swirl 已提交
976 977 978
{
    uint32_t ret = 0;

979 980 981 982 983 984 985 986 987 988 989 990 991 992
    if (((src1 & src2) | (~dst & (src1 | src2))) & (1U << 31)) {
        ret = PSR_CARRY;
    }
    return ret;
}

static inline uint32_t get_V_add_icc(uint32_t dst, uint32_t src1,
                                     uint32_t src2)
{
    uint32_t ret = 0;

    if (((src1 ^ src2 ^ -1) & (src1 ^ dst)) & (1U << 31)) {
        ret = PSR_OVF;
    }
B
Blue Swirl 已提交
993 994 995 996 997 998 999 1000
    return ret;
}

#ifdef TARGET_SPARC64
static inline uint32_t get_C_add_xcc(target_ulong dst, target_ulong src1)
{
    uint32_t ret = 0;

1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014
    if (dst < src1) {
        ret = PSR_CARRY;
    }
    return ret;
}

static inline uint32_t get_C_addx_xcc(target_ulong dst, target_ulong src1,
                                      target_ulong src2)
{
    uint32_t ret = 0;

    if (((src1 & src2) | (~dst & (src1 | src2))) & (1ULL << 63)) {
        ret = PSR_CARRY;
    }
B
Blue Swirl 已提交
1015 1016 1017 1018 1019 1020 1021 1022
    return ret;
}

static inline uint32_t get_V_add_xcc(target_ulong dst, target_ulong src1,
                                         target_ulong src2)
{
    uint32_t ret = 0;

1023 1024 1025
    if (((src1 ^ src2 ^ -1) & (src1 ^ dst)) & (1ULL << 63)) {
        ret = PSR_OVF;
    }
B
Blue Swirl 已提交
1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042
    return ret;
}

static uint32_t compute_all_add_xcc(void)
{
    uint32_t ret;

    ret = get_NZ_xcc(CC_DST);
    ret |= get_C_add_xcc(CC_DST, CC_SRC);
    ret |= get_V_add_xcc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
}

static uint32_t compute_C_add_xcc(void)
{
    return get_C_add_xcc(CC_DST, CC_SRC);
}
1043 1044
#endif

1045
static uint32_t compute_all_add(void)
B
Blue Swirl 已提交
1046 1047 1048 1049
{
    uint32_t ret;

    ret = get_NZ_icc(CC_DST);
1050
    ret |= get_C_add_icc(CC_DST, CC_SRC);
B
Blue Swirl 已提交
1051 1052 1053 1054
    ret |= get_V_add_icc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
}

1055
static uint32_t compute_C_add(void)
B
Blue Swirl 已提交
1056
{
1057
    return get_C_add_icc(CC_DST, CC_SRC);
B
Blue Swirl 已提交
1058 1059 1060 1061 1062 1063 1064 1065
}

#ifdef TARGET_SPARC64
static uint32_t compute_all_addx_xcc(void)
{
    uint32_t ret;

    ret = get_NZ_xcc(CC_DST);
1066
    ret |= get_C_addx_xcc(CC_DST, CC_SRC, CC_SRC2);
B
Blue Swirl 已提交
1067 1068 1069 1070 1071 1072 1073 1074
    ret |= get_V_add_xcc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
}

static uint32_t compute_C_addx_xcc(void)
{
    uint32_t ret;

1075
    ret = get_C_addx_xcc(CC_DST, CC_SRC, CC_SRC2);
B
Blue Swirl 已提交
1076 1077 1078 1079
    return ret;
}
#endif

1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097
static uint32_t compute_all_addx(void)
{
    uint32_t ret;

    ret = get_NZ_icc(CC_DST);
    ret |= get_C_addx_icc(CC_DST, CC_SRC, CC_SRC2);
    ret |= get_V_add_icc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
}

static uint32_t compute_C_addx(void)
{
    uint32_t ret;

    ret = get_C_addx_icc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
}

B
Blue Swirl 已提交
1098 1099 1100 1101
static inline uint32_t get_V_tag_icc(target_ulong src1, target_ulong src2)
{
    uint32_t ret = 0;

1102 1103 1104
    if ((src1 | src2) & 0x3) {
        ret = PSR_OVF;
    }
B
Blue Swirl 已提交
1105 1106 1107 1108 1109 1110 1111 1112
    return ret;
}

static uint32_t compute_all_tadd(void)
{
    uint32_t ret;

    ret = get_NZ_icc(CC_DST);
1113
    ret |= get_C_add_icc(CC_DST, CC_SRC);
B
Blue Swirl 已提交
1114 1115 1116 1117 1118 1119 1120 1121 1122 1123
    ret |= get_V_add_icc(CC_DST, CC_SRC, CC_SRC2);
    ret |= get_V_tag_icc(CC_SRC, CC_SRC2);
    return ret;
}

static uint32_t compute_all_taddtv(void)
{
    uint32_t ret;

    ret = get_NZ_icc(CC_DST);
1124
    ret |= get_C_add_icc(CC_DST, CC_SRC);
B
Blue Swirl 已提交
1125 1126 1127
    return ret;
}

1128
static inline uint32_t get_C_sub_icc(uint32_t src1, uint32_t src2)
B
Blue Swirl 已提交
1129
{
1130 1131 1132 1133 1134 1135
    uint32_t ret = 0;

    if (src1 < src2) {
        ret = PSR_CARRY;
    }
    return ret;
B
Blue Swirl 已提交
1136 1137
}

1138 1139
static inline uint32_t get_C_subx_icc(uint32_t dst, uint32_t src1,
                                      uint32_t src2)
B
Blue Swirl 已提交
1140 1141 1142
{
    uint32_t ret = 0;

1143 1144 1145
    if (((~src1 & src2) | (dst & (~src1 | src2))) & (1U << 31)) {
        ret = PSR_CARRY;
    }
B
Blue Swirl 已提交
1146 1147 1148
    return ret;
}

1149 1150
static inline uint32_t get_V_sub_icc(uint32_t dst, uint32_t src1,
                                     uint32_t src2)
B
Blue Swirl 已提交
1151 1152 1153
{
    uint32_t ret = 0;

1154 1155 1156
    if (((src1 ^ src2) & (src1 ^ dst)) & (1U << 31)) {
        ret = PSR_OVF;
    }
B
Blue Swirl 已提交
1157 1158 1159 1160 1161 1162 1163 1164 1165
    return ret;
}


#ifdef TARGET_SPARC64
static inline uint32_t get_C_sub_xcc(target_ulong src1, target_ulong src2)
{
    uint32_t ret = 0;

1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
    if (src1 < src2) {
        ret = PSR_CARRY;
    }
    return ret;
}

static inline uint32_t get_C_subx_xcc(target_ulong dst, target_ulong src1,
                                      target_ulong src2)
{
    uint32_t ret = 0;

    if (((~src1 & src2) | (dst & (~src1 | src2))) & (1ULL << 63)) {
        ret = PSR_CARRY;
    }
B
Blue Swirl 已提交
1180 1181 1182 1183 1184 1185 1186 1187
    return ret;
}

static inline uint32_t get_V_sub_xcc(target_ulong dst, target_ulong src1,
                                     target_ulong src2)
{
    uint32_t ret = 0;

1188 1189 1190
    if (((src1 ^ src2) & (src1 ^ dst)) & (1ULL << 63)) {
        ret = PSR_OVF;
    }
B
Blue Swirl 已提交
1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209
    return ret;
}

static uint32_t compute_all_sub_xcc(void)
{
    uint32_t ret;

    ret = get_NZ_xcc(CC_DST);
    ret |= get_C_sub_xcc(CC_SRC, CC_SRC2);
    ret |= get_V_sub_xcc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
}

static uint32_t compute_C_sub_xcc(void)
{
    return get_C_sub_xcc(CC_SRC, CC_SRC2);
}
#endif

1210
static uint32_t compute_all_sub(void)
B
Blue Swirl 已提交
1211 1212 1213 1214
{
    uint32_t ret;

    ret = get_NZ_icc(CC_DST);
1215
    ret |= get_C_sub_icc(CC_SRC, CC_SRC2);
B
Blue Swirl 已提交
1216 1217 1218 1219
    ret |= get_V_sub_icc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
}

1220
static uint32_t compute_C_sub(void)
B
Blue Swirl 已提交
1221
{
1222
    return get_C_sub_icc(CC_SRC, CC_SRC2);
B
Blue Swirl 已提交
1223 1224 1225 1226 1227 1228 1229 1230
}

#ifdef TARGET_SPARC64
static uint32_t compute_all_subx_xcc(void)
{
    uint32_t ret;

    ret = get_NZ_xcc(CC_DST);
1231
    ret |= get_C_subx_xcc(CC_DST, CC_SRC, CC_SRC2);
B
Blue Swirl 已提交
1232 1233 1234 1235 1236 1237 1238 1239
    ret |= get_V_sub_xcc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
}

static uint32_t compute_C_subx_xcc(void)
{
    uint32_t ret;

1240
    ret = get_C_subx_xcc(CC_DST, CC_SRC, CC_SRC2);
B
Blue Swirl 已提交
1241 1242 1243 1244
    return ret;
}
#endif

1245
static uint32_t compute_all_subx(void)
B
Blue Swirl 已提交
1246 1247 1248 1249
{
    uint32_t ret;

    ret = get_NZ_icc(CC_DST);
1250
    ret |= get_C_subx_icc(CC_DST, CC_SRC, CC_SRC2);
B
Blue Swirl 已提交
1251 1252 1253 1254
    ret |= get_V_sub_icc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
}

1255
static uint32_t compute_C_subx(void)
B
Blue Swirl 已提交
1256
{
1257 1258 1259 1260
    uint32_t ret;

    ret = get_C_subx_icc(CC_DST, CC_SRC, CC_SRC2);
    return ret;
B
Blue Swirl 已提交
1261 1262
}

1263
static uint32_t compute_all_tsub(void)
B
Blue Swirl 已提交
1264 1265 1266 1267
{
    uint32_t ret;

    ret = get_NZ_icc(CC_DST);
1268 1269 1270
    ret |= get_C_sub_icc(CC_SRC, CC_SRC2);
    ret |= get_V_sub_icc(CC_DST, CC_SRC, CC_SRC2);
    ret |= get_V_tag_icc(CC_SRC, CC_SRC2);
B
Blue Swirl 已提交
1271 1272 1273
    return ret;
}

1274
static uint32_t compute_all_tsubtv(void)
B
Blue Swirl 已提交
1275
{
1276 1277 1278 1279 1280
    uint32_t ret;

    ret = get_NZ_icc(CC_DST);
    ret |= get_C_sub_icc(CC_SRC, CC_SRC2);
    return ret;
B
Blue Swirl 已提交
1281 1282
}

1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299
static uint32_t compute_all_logic(void)
{
    return get_NZ_icc(CC_DST);
}

static uint32_t compute_C_logic(void)
{
    return 0;
}

#ifdef TARGET_SPARC64
static uint32_t compute_all_logic_xcc(void)
{
    return get_NZ_xcc(CC_DST);
}
#endif

1300 1301 1302 1303 1304 1305 1306 1307
typedef struct CCTable {
    uint32_t (*compute_all)(void); /* return all the flags */
    uint32_t (*compute_c)(void);  /* return the C flag */
} CCTable;

static const CCTable icc_table[CC_OP_NB] = {
    /* CC_OP_DYNAMIC should never happen */
    [CC_OP_FLAGS] = { compute_all_flags, compute_C_flags },
B
Blue Swirl 已提交
1308
    [CC_OP_DIV] = { compute_all_div, compute_C_div },
B
Blue Swirl 已提交
1309
    [CC_OP_ADD] = { compute_all_add, compute_C_add },
1310 1311 1312
    [CC_OP_ADDX] = { compute_all_addx, compute_C_addx },
    [CC_OP_TADD] = { compute_all_tadd, compute_C_add },
    [CC_OP_TADDTV] = { compute_all_taddtv, compute_C_add },
B
Blue Swirl 已提交
1313
    [CC_OP_SUB] = { compute_all_sub, compute_C_sub },
1314 1315 1316
    [CC_OP_SUBX] = { compute_all_subx, compute_C_subx },
    [CC_OP_TSUB] = { compute_all_tsub, compute_C_sub },
    [CC_OP_TSUBTV] = { compute_all_tsubtv, compute_C_sub },
1317
    [CC_OP_LOGIC] = { compute_all_logic, compute_C_logic },
1318 1319 1320 1321 1322 1323
};

#ifdef TARGET_SPARC64
static const CCTable xcc_table[CC_OP_NB] = {
    /* CC_OP_DYNAMIC should never happen */
    [CC_OP_FLAGS] = { compute_all_flags_xcc, compute_C_flags_xcc },
B
Blue Swirl 已提交
1324
    [CC_OP_DIV] = { compute_all_logic_xcc, compute_C_logic },
B
Blue Swirl 已提交
1325
    [CC_OP_ADD] = { compute_all_add_xcc, compute_C_add_xcc },
B
Blue Swirl 已提交
1326
    [CC_OP_ADDX] = { compute_all_addx_xcc, compute_C_addx_xcc },
B
Blue Swirl 已提交
1327 1328
    [CC_OP_TADD] = { compute_all_add_xcc, compute_C_add_xcc },
    [CC_OP_TADDTV] = { compute_all_add_xcc, compute_C_add_xcc },
B
Blue Swirl 已提交
1329
    [CC_OP_SUB] = { compute_all_sub_xcc, compute_C_sub_xcc },
B
Blue Swirl 已提交
1330
    [CC_OP_SUBX] = { compute_all_subx_xcc, compute_C_subx_xcc },
B
Blue Swirl 已提交
1331 1332
    [CC_OP_TSUB] = { compute_all_sub_xcc, compute_C_sub_xcc },
    [CC_OP_TSUBTV] = { compute_all_sub_xcc, compute_C_sub_xcc },
1333
    [CC_OP_LOGIC] = { compute_all_logic_xcc, compute_C_logic },
1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349
};
#endif

void helper_compute_psr(void)
{
    uint32_t new_psr;

    new_psr = icc_table[CC_OP].compute_all();
    env->psr = new_psr;
#ifdef TARGET_SPARC64
    new_psr = xcc_table[CC_OP].compute_all();
    env->xcc = new_psr;
#endif
    CC_OP = CC_OP_FLAGS;
}

1350
uint32_t helper_compute_C_icc(void)
1351 1352 1353 1354 1355 1356 1357
{
    uint32_t ret;

    ret = icc_table[CC_OP].compute_c() >> PSR_CARRY_SHIFT;
    return ret;
}

1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493
static inline void memcpy32(target_ulong *dst, const target_ulong *src)
{
    dst[0] = src[0];
    dst[1] = src[1];
    dst[2] = src[2];
    dst[3] = src[3];
    dst[4] = src[4];
    dst[5] = src[5];
    dst[6] = src[6];
    dst[7] = src[7];
}

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

    /* put the wrap registers at their temporary location */
    if (new_cwp == env->nwindows - 1) {
        memcpy32(env->regbase + env->nwindows * 16, env->regbase);
    }
    env->regwptr = env->regbase + (new_cwp * 16);
}

void cpu_set_cwp(CPUState *env1, int new_cwp)
{
    CPUState *saved_env;

    saved_env = env;
    env = env1;
    set_cwp(new_cwp);
    env = saved_env;
}

static target_ulong get_psr(void)
{
    helper_compute_psr();

#if !defined (TARGET_SPARC64)
    return env->version | (env->psr & PSR_ICC) |
        (env->psref? PSR_EF : 0) |
        (env->psrpil << 8) |
        (env->psrs? PSR_S : 0) |
        (env->psrps? PSR_PS : 0) |
        (env->psret? PSR_ET : 0) | env->cwp;
#else
    return env->version | (env->psr & PSR_ICC) |
        (env->psref? PSR_EF : 0) |
        (env->psrpil << 8) |
        (env->psrs? PSR_S : 0) |
        (env->psrps? PSR_PS : 0) | env->cwp;
#endif
}

target_ulong cpu_get_psr(CPUState *env1)
{
    CPUState *saved_env;
    target_ulong ret;

    saved_env = env;
    env = env1;
    ret = get_psr();
    env = saved_env;
    return ret;
}

static void put_psr(target_ulong val)
{
    env->psr = val & PSR_ICC;
    env->psref = (val & PSR_EF)? 1 : 0;
    env->psrpil = (val & PSR_PIL) >> 8;
#if ((!defined (TARGET_SPARC64)) && !defined(CONFIG_USER_ONLY))
    cpu_check_irqs(env);
#endif
    env->psrs = (val & PSR_S)? 1 : 0;
    env->psrps = (val & PSR_PS)? 1 : 0;
#if !defined (TARGET_SPARC64)
    env->psret = (val & PSR_ET)? 1 : 0;
#endif
    set_cwp(val & PSR_CWP);
    env->cc_op = CC_OP_FLAGS;
}

void cpu_put_psr(CPUState *env1, target_ulong val)
{
    CPUState *saved_env;

    saved_env = env;
    env = env1;
    put_psr(val);
    env = saved_env;
}

static int cwp_inc(int cwp)
{
    if (unlikely(cwp >= env->nwindows)) {
        cwp -= env->nwindows;
    }
    return cwp;
}

int cpu_cwp_inc(CPUState *env1, int cwp)
{
    CPUState *saved_env;
    target_ulong ret;

    saved_env = env;
    env = env1;
    ret = cwp_inc(cwp);
    env = saved_env;
    return ret;
}

static int cwp_dec(int cwp)
{
    if (unlikely(cwp < 0)) {
        cwp += env->nwindows;
    }
    return cwp;
}

int cpu_cwp_dec(CPUState *env1, int cwp)
{
    CPUState *saved_env;
    target_ulong ret;

    saved_env = env;
    env = env1;
    ret = cwp_dec(cwp);
    env = saved_env;
    return ret;
}

B
bellard 已提交
1494
#ifdef TARGET_SPARC64
B
blueswir1 已提交
1495
GEN_FCMPS(fcmps_fcc1, float32, 22, 0);
1496
GEN_FCMP(fcmpd_fcc1, float64, DT0, DT1, 22, 0);
B
blueswir1 已提交
1497
GEN_FCMP(fcmpq_fcc1, float128, QT0, QT1, 22, 0);
1498

B
blueswir1 已提交
1499
GEN_FCMPS(fcmps_fcc2, float32, 24, 0);
1500
GEN_FCMP(fcmpd_fcc2, float64, DT0, DT1, 24, 0);
B
blueswir1 已提交
1501
GEN_FCMP(fcmpq_fcc2, float128, QT0, QT1, 24, 0);
1502

B
blueswir1 已提交
1503
GEN_FCMPS(fcmps_fcc3, float32, 26, 0);
1504
GEN_FCMP(fcmpd_fcc3, float64, DT0, DT1, 26, 0);
B
blueswir1 已提交
1505
GEN_FCMP(fcmpq_fcc3, float128, QT0, QT1, 26, 0);
1506

B
blueswir1 已提交
1507
GEN_FCMPS(fcmpes_fcc1, float32, 22, 1);
1508
GEN_FCMP(fcmped_fcc1, float64, DT0, DT1, 22, 1);
B
blueswir1 已提交
1509
GEN_FCMP(fcmpeq_fcc1, float128, QT0, QT1, 22, 1);
B
bellard 已提交
1510

B
blueswir1 已提交
1511
GEN_FCMPS(fcmpes_fcc2, float32, 24, 1);
1512
GEN_FCMP(fcmped_fcc2, float64, DT0, DT1, 24, 1);
B
blueswir1 已提交
1513
GEN_FCMP(fcmpeq_fcc2, float128, QT0, QT1, 24, 1);
B
bellard 已提交
1514

B
blueswir1 已提交
1515
GEN_FCMPS(fcmpes_fcc3, float32, 26, 1);
1516
GEN_FCMP(fcmped_fcc3, float64, DT0, DT1, 26, 1);
B
blueswir1 已提交
1517 1518
GEN_FCMP(fcmpeq_fcc3, float128, QT0, QT1, 26, 1);
#endif
B
blueswir1 已提交
1519
#undef GEN_FCMPS
B
bellard 已提交
1520

B
blueswir1 已提交
1521 1522
#if !defined(TARGET_SPARC64) && !defined(CONFIG_USER_ONLY) && \
    defined(DEBUG_MXCC)
1523 1524
static void dump_mxcc(CPUState *env)
{
1525 1526
    printf("mxccdata: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64
           "\n",
B
blueswir1 已提交
1527 1528
           env->mxccdata[0], env->mxccdata[1],
           env->mxccdata[2], env->mxccdata[3]);
1529 1530 1531 1532
    printf("mxccregs: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64
           "\n"
           "          %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64
           "\n",
B
blueswir1 已提交
1533 1534 1535 1536
           env->mxccregs[0], env->mxccregs[1],
           env->mxccregs[2], env->mxccregs[3],
           env->mxccregs[4], env->mxccregs[5],
           env->mxccregs[6], env->mxccregs[7]);
1537 1538 1539
}
#endif

B
blueswir1 已提交
1540 1541 1542 1543
#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)
1544 1545 1546 1547
{
    switch (size)
    {
    case 1:
B
blueswir1 已提交
1548 1549
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %02" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xff);
1550 1551
        break;
    case 2:
B
blueswir1 已提交
1552 1553
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %04" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xffff);
1554 1555
        break;
    case 4:
B
blueswir1 已提交
1556 1557
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %08" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xffffffff);
1558 1559
        break;
    case 8:
B
blueswir1 已提交
1560 1561
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %016" PRIx64 "\n", txt,
                    addr, asi, r1);
1562 1563 1564 1565 1566
        break;
    }
}
#endif

B
blueswir1 已提交
1567 1568 1569
#ifndef TARGET_SPARC64
#ifndef CONFIG_USER_ONLY
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
1570
{
B
blueswir1 已提交
1571
    uint64_t ret = 0;
1572
#if defined(DEBUG_MXCC) || defined(DEBUG_ASI)
B
blueswir1 已提交
1573
    uint32_t last_addr = addr;
1574
#endif
B
bellard 已提交
1575

1576
    helper_check_align(addr, size - 1);
B
bellard 已提交
1577
    switch (asi) {
1578
    case 2: /* SuperSparc MXCC registers */
B
blueswir1 已提交
1579
        switch (addr) {
1580
        case 0x01c00a00: /* MXCC control register */
B
blueswir1 已提交
1581 1582 1583
            if (size == 8)
                ret = env->mxccregs[3];
            else
B
blueswir1 已提交
1584 1585
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1586 1587 1588 1589 1590
            break;
        case 0x01c00a04: /* MXCC control register */
            if (size == 4)
                ret = env->mxccregs[3];
            else
B
blueswir1 已提交
1591 1592
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1593
            break;
1594 1595
        case 0x01c00c00: /* Module reset register */
            if (size == 8) {
B
blueswir1 已提交
1596
                ret = env->mxccregs[5];
1597 1598
                // should we do something here?
            } else
B
blueswir1 已提交
1599 1600
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1601
            break;
1602
        case 0x01c00f00: /* MBus port address register */
B
blueswir1 已提交
1603 1604 1605
            if (size == 8)
                ret = env->mxccregs[7];
            else
B
blueswir1 已提交
1606 1607
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1608 1609
            break;
        default:
B
blueswir1 已提交
1610 1611
            DPRINTF_MXCC("%08x: unimplemented address, size: %d\n", addr,
                         size);
1612 1613
            break;
        }
B
blueswir1 已提交
1614
        DPRINTF_MXCC("asi = %d, size = %d, sign = %d, "
1615
                     "addr = %08x -> ret = %" PRIx64 ","
B
blueswir1 已提交
1616
                     "addr = %08x\n", asi, size, sign, last_addr, ret, addr);
1617 1618 1619
#ifdef DEBUG_MXCC
        dump_mxcc(env);
#endif
1620
        break;
1621
    case 3: /* MMU probe */
B
blueswir1 已提交
1622 1623 1624
        {
            int mmulev;

B
blueswir1 已提交
1625
            mmulev = (addr >> 8) & 15;
B
blueswir1 已提交
1626 1627
            if (mmulev > 4)
                ret = 0;
B
blueswir1 已提交
1628 1629 1630 1631
            else
                ret = mmu_probe(env, addr, mmulev);
            DPRINTF_MMU("mmu_probe: 0x%08x (lev %d) -> 0x%08" PRIx64 "\n",
                        addr, mmulev, ret);
B
blueswir1 已提交
1632 1633
        }
        break;
1634
    case 4: /* read MMU regs */
B
blueswir1 已提交
1635
        {
B
blueswir1 已提交
1636
            int reg = (addr >> 8) & 0x1f;
1637

B
blueswir1 已提交
1638 1639
            ret = env->mmuregs[reg];
            if (reg == 3) /* Fault status cleared on read */
B
blueswir1 已提交
1640 1641 1642 1643 1644
                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 已提交
1645
            DPRINTF_MMU("mmu_read: reg[%d] = 0x%08" PRIx64 "\n", reg, ret);
B
blueswir1 已提交
1646 1647
        }
        break;
B
blueswir1 已提交
1648 1649 1650 1651
    case 5: // Turbosparc ITLB Diagnostic
    case 6: // Turbosparc DTLB Diagnostic
    case 7: // Turbosparc IOTLB Diagnostic
        break;
1652 1653 1654
    case 9: /* Supervisor code access */
        switch(size) {
        case 1:
B
blueswir1 已提交
1655
            ret = ldub_code(addr);
1656 1657
            break;
        case 2:
1658
            ret = lduw_code(addr);
1659 1660 1661
            break;
        default:
        case 4:
1662
            ret = ldl_code(addr);
1663 1664
            break;
        case 8:
1665
            ret = ldq_code(addr);
1666 1667 1668
            break;
        }
        break;
1669 1670 1671
    case 0xa: /* User data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
1672
            ret = ldub_user(addr);
1673 1674
            break;
        case 2:
1675
            ret = lduw_user(addr);
1676 1677 1678
            break;
        default:
        case 4:
1679
            ret = ldl_user(addr);
1680 1681
            break;
        case 8:
1682
            ret = ldq_user(addr);
1683 1684 1685 1686 1687 1688
            break;
        }
        break;
    case 0xb: /* Supervisor data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
1689
            ret = ldub_kernel(addr);
1690 1691
            break;
        case 2:
1692
            ret = lduw_kernel(addr);
1693 1694 1695
            break;
        default:
        case 4:
1696
            ret = ldl_kernel(addr);
1697 1698
            break;
        case 8:
1699
            ret = ldq_kernel(addr);
1700 1701 1702
            break;
        }
        break;
1703 1704 1705 1706 1707 1708
    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 已提交
1709 1710
        switch(size) {
        case 1:
B
blueswir1 已提交
1711
            ret = ldub_phys(addr);
B
bellard 已提交
1712 1713
            break;
        case 2:
1714
            ret = lduw_phys(addr);
B
bellard 已提交
1715 1716 1717
            break;
        default:
        case 4:
1718
            ret = ldl_phys(addr);
B
bellard 已提交
1719
            break;
B
bellard 已提交
1720
        case 8:
1721
            ret = ldq_phys(addr);
B
blueswir1 已提交
1722
            break;
B
bellard 已提交
1723
        }
B
blueswir1 已提交
1724
        break;
1725
    case 0x21 ... 0x2f: /* MMU passthrough, 0x100000000 to 0xfffffffff */
1726 1727
        switch(size) {
        case 1:
A
Anthony Liguori 已提交
1728 1729
            ret = ldub_phys((target_phys_addr_t)addr
                            | ((target_phys_addr_t)(asi & 0xf) << 32));
1730 1731
            break;
        case 2:
A
Anthony Liguori 已提交
1732 1733
            ret = lduw_phys((target_phys_addr_t)addr
                            | ((target_phys_addr_t)(asi & 0xf) << 32));
1734 1735 1736
            break;
        default:
        case 4:
A
Anthony Liguori 已提交
1737 1738
            ret = ldl_phys((target_phys_addr_t)addr
                           | ((target_phys_addr_t)(asi & 0xf) << 32));
1739 1740
            break;
        case 8:
A
Anthony Liguori 已提交
1741 1742
            ret = ldq_phys((target_phys_addr_t)addr
                           | ((target_phys_addr_t)(asi & 0xf) << 32));
B
blueswir1 已提交
1743
            break;
1744
        }
B
blueswir1 已提交
1745
        break;
B
blueswir1 已提交
1746 1747 1748
    case 0x30: // Turbosparc secondary cache diagnostic
    case 0x31: // Turbosparc RAM snoop
    case 0x32: // Turbosparc page table descriptor diagnostic
B
blueswir1 已提交
1749 1750 1751
    case 0x39: /* data cache diagnostic register */
        ret = 0;
        break;
1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770
    case 0x38: /* SuperSPARC MMU Breakpoint Control Registers */
        {
            int reg = (addr >> 8) & 3;

            switch(reg) {
            case 0: /* Breakpoint Value (Addr) */
                ret = env->mmubpregs[reg];
                break;
            case 1: /* Breakpoint Mask */
                ret = env->mmubpregs[reg];
                break;
            case 2: /* Breakpoint Control */
                ret = env->mmubpregs[reg];
                break;
            case 3: /* Breakpoint Status */
                ret = env->mmubpregs[reg];
                env->mmubpregs[reg] = 0ULL;
                break;
            }
1771 1772
            DPRINTF_MMU("read breakpoint reg[%d] 0x%016" PRIx64 "\n", reg,
                        ret);
1773 1774
        }
        break;
B
blueswir1 已提交
1775
    case 8: /* User code access, XXX */
1776
    default:
1777
        do_unassigned_access(addr, 0, 0, asi, size);
B
blueswir1 已提交
1778 1779
        ret = 0;
        break;
1780
    }
1781 1782 1783
    if (sign) {
        switch(size) {
        case 1:
B
blueswir1 已提交
1784
            ret = (int8_t) ret;
B
blueswir1 已提交
1785
            break;
1786
        case 2:
B
blueswir1 已提交
1787 1788 1789 1790
            ret = (int16_t) ret;
            break;
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
1791
            break;
1792 1793 1794 1795
        default:
            break;
        }
    }
1796
#ifdef DEBUG_ASI
B
blueswir1 已提交
1797
    dump_asi("read ", last_addr, asi, size, ret);
1798
#endif
B
blueswir1 已提交
1799
    return ret;
1800 1801
}

B
blueswir1 已提交
1802
void helper_st_asi(target_ulong addr, uint64_t val, int asi, int size)
1803
{
1804
    helper_check_align(addr, size - 1);
1805
    switch(asi) {
1806
    case 2: /* SuperSparc MXCC registers */
B
blueswir1 已提交
1807
        switch (addr) {
1808 1809
        case 0x01c00000: /* MXCC stream data register 0 */
            if (size == 8)
B
blueswir1 已提交
1810
                env->mxccdata[0] = val;
1811
            else
B
blueswir1 已提交
1812 1813
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1814 1815 1816
            break;
        case 0x01c00008: /* MXCC stream data register 1 */
            if (size == 8)
B
blueswir1 已提交
1817
                env->mxccdata[1] = val;
1818
            else
B
blueswir1 已提交
1819 1820
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1821 1822 1823
            break;
        case 0x01c00010: /* MXCC stream data register 2 */
            if (size == 8)
B
blueswir1 已提交
1824
                env->mxccdata[2] = val;
1825
            else
B
blueswir1 已提交
1826 1827
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1828 1829 1830
            break;
        case 0x01c00018: /* MXCC stream data register 3 */
            if (size == 8)
B
blueswir1 已提交
1831
                env->mxccdata[3] = val;
1832
            else
B
blueswir1 已提交
1833 1834
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1835 1836 1837
            break;
        case 0x01c00100: /* MXCC stream source */
            if (size == 8)
B
blueswir1 已提交
1838
                env->mxccregs[0] = val;
1839
            else
B
blueswir1 已提交
1840 1841 1842 1843 1844 1845 1846 1847 1848 1849
                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);
1850 1851 1852
            break;
        case 0x01c00200: /* MXCC stream destination */
            if (size == 8)
B
blueswir1 已提交
1853
                env->mxccregs[1] = val;
1854
            else
B
blueswir1 已提交
1855 1856 1857 1858 1859 1860 1861 1862 1863 1864
                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]);
1865 1866 1867
            break;
        case 0x01c00a00: /* MXCC control register */
            if (size == 8)
B
blueswir1 已提交
1868
                env->mxccregs[3] = val;
1869
            else
B
blueswir1 已提交
1870 1871
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1872 1873 1874
            break;
        case 0x01c00a04: /* MXCC control register */
            if (size == 4)
1875
                env->mxccregs[3] = (env->mxccregs[3] & 0xffffffff00000000ULL)
B
blueswir1 已提交
1876
                    | val;
1877
            else
B
blueswir1 已提交
1878 1879
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1880 1881
            break;
        case 0x01c00e00: /* MXCC error register  */
1882
            // writing a 1 bit clears the error
1883
            if (size == 8)
B
blueswir1 已提交
1884
                env->mxccregs[6] &= ~val;
1885
            else
B
blueswir1 已提交
1886 1887
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1888 1889 1890
            break;
        case 0x01c00f00: /* MBus port address register */
            if (size == 8)
B
blueswir1 已提交
1891
                env->mxccregs[7] = val;
1892
            else
B
blueswir1 已提交
1893 1894
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1895 1896
            break;
        default:
B
blueswir1 已提交
1897 1898
            DPRINTF_MXCC("%08x: unimplemented address, size: %d\n", addr,
                         size);
1899 1900
            break;
        }
1901 1902
        DPRINTF_MXCC("asi = %d, size = %d, addr = %08x, val = %" PRIx64 "\n",
                     asi, size, addr, val);
1903 1904 1905
#ifdef DEBUG_MXCC
        dump_mxcc(env);
#endif
1906
        break;
1907
    case 3: /* MMU flush */
B
blueswir1 已提交
1908 1909
        {
            int mmulev;
B
bellard 已提交
1910

B
blueswir1 已提交
1911
            mmulev = (addr >> 8) & 15;
1912
            DPRINTF_MMU("mmu flush level %d\n", mmulev);
B
blueswir1 已提交
1913 1914
            switch (mmulev) {
            case 0: // flush page
B
blueswir1 已提交
1915
                tlb_flush_page(env, addr & 0xfffff000);
B
blueswir1 已提交
1916 1917 1918 1919 1920 1921 1922 1923 1924 1925
                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 已提交
1926
#ifdef DEBUG_MMU
B
blueswir1 已提交
1927
            dump_mmu(env);
B
bellard 已提交
1928
#endif
B
blueswir1 已提交
1929
        }
1930
        break;
1931
    case 4: /* write MMU regs */
B
blueswir1 已提交
1932
        {
B
blueswir1 已提交
1933
            int reg = (addr >> 8) & 0x1f;
B
blueswir1 已提交
1934
            uint32_t oldreg;
1935

B
blueswir1 已提交
1936
            oldreg = env->mmuregs[reg];
B
bellard 已提交
1937
            switch(reg) {
1938
            case 0: // Control Register
B
blueswir1 已提交
1939
                env->mmuregs[reg] = (env->mmuregs[reg] & 0xff000000) |
B
blueswir1 已提交
1940
                                    (val & 0x00ffffff);
B
blueswir1 已提交
1941 1942
                // Mappings generated during no-fault mode or MMU
                // disabled mode are invalid in normal mode
1943 1944
                if ((oldreg & (MMU_E | MMU_NF | env->def->mmu_bm)) !=
                    (env->mmuregs[reg] & (MMU_E | MMU_NF | env->def->mmu_bm)))
B
bellard 已提交
1945 1946
                    tlb_flush(env, 1);
                break;
1947
            case 1: // Context Table Pointer Register
1948
                env->mmuregs[reg] = val & env->def->mmu_ctpr_mask;
1949 1950
                break;
            case 2: // Context Register
1951
                env->mmuregs[reg] = val & env->def->mmu_cxr_mask;
B
bellard 已提交
1952 1953 1954 1955 1956 1957
                if (oldreg != env->mmuregs[reg]) {
                    /* we flush when the MMU context changes because
                       QEMU has no MMU context support */
                    tlb_flush(env, 1);
                }
                break;
1958 1959 1960 1961
            case 3: // Synchronous Fault Status Register with Clear
            case 4: // Synchronous Fault Address Register
                break;
            case 0x10: // TLB Replacement Control Register
1962
                env->mmuregs[reg] = val & env->def->mmu_trcr_mask;
B
bellard 已提交
1963
                break;
1964
            case 0x13: // Synchronous Fault Status Register with Read and Clear
1965
                env->mmuregs[3] = val & env->def->mmu_sfsr_mask;
B
blueswir1 已提交
1966
                break;
1967
            case 0x14: // Synchronous Fault Address Register
B
blueswir1 已提交
1968
                env->mmuregs[4] = val;
B
blueswir1 已提交
1969
                break;
B
bellard 已提交
1970
            default:
B
blueswir1 已提交
1971
                env->mmuregs[reg] = val;
B
bellard 已提交
1972 1973 1974
                break;
            }
            if (oldreg != env->mmuregs[reg]) {
B
blueswir1 已提交
1975 1976
                DPRINTF_MMU("mmu change reg[%d]: 0x%08x -> 0x%08x\n",
                            reg, oldreg, env->mmuregs[reg]);
B
bellard 已提交
1977
            }
1978
#ifdef DEBUG_MMU
B
blueswir1 已提交
1979
            dump_mmu(env);
B
bellard 已提交
1980
#endif
B
blueswir1 已提交
1981
        }
1982
        break;
B
blueswir1 已提交
1983 1984 1985 1986
    case 5: // Turbosparc ITLB Diagnostic
    case 6: // Turbosparc DTLB Diagnostic
    case 7: // Turbosparc IOTLB Diagnostic
        break;
1987 1988 1989
    case 0xa: /* User data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
1990
            stb_user(addr, val);
1991 1992
            break;
        case 2:
1993
            stw_user(addr, val);
1994 1995 1996
            break;
        default:
        case 4:
1997
            stl_user(addr, val);
1998 1999
            break;
        case 8:
2000
            stq_user(addr, val);
2001 2002 2003 2004 2005 2006
            break;
        }
        break;
    case 0xb: /* Supervisor data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
2007
            stb_kernel(addr, val);
2008 2009
            break;
        case 2:
2010
            stw_kernel(addr, val);
2011 2012 2013
            break;
        default:
        case 4:
2014
            stl_kernel(addr, val);
2015 2016
            break;
        case 8:
2017
            stq_kernel(addr, val);
2018 2019 2020
            break;
        }
        break;
2021 2022 2023 2024 2025 2026 2027 2028 2029 2030
    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 已提交
2031
    case 0x17: /* Block copy, sta access */
B
blueswir1 已提交
2032
        {
B
blueswir1 已提交
2033 2034
            // val = src
            // addr = dst
B
blueswir1 已提交
2035
            // copy 32 bytes
2036
            unsigned int i;
B
blueswir1 已提交
2037
            uint32_t src = val & ~3, dst = addr & ~3, temp;
2038

2039 2040 2041 2042
            for (i = 0; i < 32; i += 4, src += 4, dst += 4) {
                temp = ldl_kernel(src);
                stl_kernel(dst, temp);
            }
B
blueswir1 已提交
2043
        }
2044
        break;
B
bellard 已提交
2045
    case 0x1f: /* Block fill, stda access */
B
blueswir1 已提交
2046
        {
B
blueswir1 已提交
2047 2048
            // addr = dst
            // fill 32 bytes with val
2049
            unsigned int i;
B
blueswir1 已提交
2050
            uint32_t dst = addr & 7;
2051 2052 2053

            for (i = 0; i < 32; i += 8, dst += 8)
                stq_kernel(dst, val);
B
blueswir1 已提交
2054
        }
2055
        break;
2056
    case 0x20: /* MMU passthrough */
B
blueswir1 已提交
2057
        {
B
bellard 已提交
2058 2059
            switch(size) {
            case 1:
B
blueswir1 已提交
2060
                stb_phys(addr, val);
B
bellard 已提交
2061 2062
                break;
            case 2:
2063
                stw_phys(addr, val);
B
bellard 已提交
2064 2065 2066
                break;
            case 4:
            default:
2067
                stl_phys(addr, val);
B
bellard 已提交
2068
                break;
B
bellard 已提交
2069
            case 8:
2070
                stq_phys(addr, val);
B
bellard 已提交
2071
                break;
B
bellard 已提交
2072
            }
B
blueswir1 已提交
2073
        }
2074
        break;
B
blueswir1 已提交
2075
    case 0x21 ... 0x2f: /* MMU passthrough, 0x100000000 to 0xfffffffff */
B
blueswir1 已提交
2076
        {
2077 2078
            switch(size) {
            case 1:
A
Anthony Liguori 已提交
2079 2080
                stb_phys((target_phys_addr_t)addr
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
2081 2082
                break;
            case 2:
A
Anthony Liguori 已提交
2083 2084
                stw_phys((target_phys_addr_t)addr
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
2085 2086 2087
                break;
            case 4:
            default:
A
Anthony Liguori 已提交
2088 2089
                stl_phys((target_phys_addr_t)addr
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
2090 2091
                break;
            case 8:
A
Anthony Liguori 已提交
2092 2093
                stq_phys((target_phys_addr_t)addr
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
2094 2095
                break;
            }
B
blueswir1 已提交
2096
        }
2097
        break;
B
blueswir1 已提交
2098 2099 2100
    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 已提交
2101 2102
    case 0x32: // store buffer control or Turbosparc page table
               // descriptor diagnostic
2103 2104
    case 0x36: /* I-cache flash clear */
    case 0x37: /* D-cache flash clear */
B
blueswir1 已提交
2105
    case 0x4c: /* breakpoint action */
2106
        break;
2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124
    case 0x38: /* SuperSPARC MMU Breakpoint Control Registers*/
        {
            int reg = (addr >> 8) & 3;

            switch(reg) {
            case 0: /* Breakpoint Value (Addr) */
                env->mmubpregs[reg] = (val & 0xfffffffffULL);
                break;
            case 1: /* Breakpoint Mask */
                env->mmubpregs[reg] = (val & 0xfffffffffULL);
                break;
            case 2: /* Breakpoint Control */
                env->mmubpregs[reg] = (val & 0x7fULL);
                break;
            case 3: /* Breakpoint Status */
                env->mmubpregs[reg] = (val & 0xfULL);
                break;
            }
2125
            DPRINTF_MMU("write breakpoint reg[%d] 0x%016x\n", reg,
2126 2127 2128
                        env->mmuregs[reg]);
        }
        break;
B
blueswir1 已提交
2129
    case 8: /* User code access, XXX */
2130
    case 9: /* Supervisor code access, XXX */
2131
    default:
2132
        do_unassigned_access(addr, 1, 0, asi, size);
2133
        break;
2134
    }
2135
#ifdef DEBUG_ASI
B
blueswir1 已提交
2136
    dump_asi("write", addr, asi, size, val);
2137
#endif
2138 2139
}

2140 2141 2142 2143
#endif /* CONFIG_USER_ONLY */
#else /* TARGET_SPARC64 */

#ifdef CONFIG_USER_ONLY
B
blueswir1 已提交
2144
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
2145 2146
{
    uint64_t ret = 0;
B
blueswir1 已提交
2147 2148 2149
#if defined(DEBUG_ASI)
    target_ulong last_addr = addr;
#endif
2150 2151 2152 2153

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

2154
    helper_check_align(addr, size - 1);
2155
    addr = address_mask(env, addr);
2156

2157 2158 2159
    switch (asi) {
    case 0x82: // Primary no-fault
    case 0x8a: // Primary no-fault LE
B
blueswir1 已提交
2160 2161 2162 2163 2164 2165 2166 2167 2168
        if (page_check_range(addr, size, PAGE_READ) == -1) {
#ifdef DEBUG_ASI
            dump_asi("read ", last_addr, asi, size, ret);
#endif
            return 0;
        }
        // Fall through
    case 0x80: // Primary
    case 0x88: // Primary LE
2169 2170 2171
        {
            switch(size) {
            case 1:
B
blueswir1 已提交
2172
                ret = ldub_raw(addr);
2173 2174
                break;
            case 2:
2175
                ret = lduw_raw(addr);
2176 2177
                break;
            case 4:
2178
                ret = ldl_raw(addr);
2179 2180 2181
                break;
            default:
            case 8:
2182
                ret = ldq_raw(addr);
2183 2184 2185 2186 2187 2188
                break;
            }
        }
        break;
    case 0x83: // Secondary no-fault
    case 0x8b: // Secondary no-fault LE
B
blueswir1 已提交
2189 2190 2191 2192 2193 2194 2195 2196 2197
        if (page_check_range(addr, size, PAGE_READ) == -1) {
#ifdef DEBUG_ASI
            dump_asi("read ", last_addr, asi, size, ret);
#endif
            return 0;
        }
        // Fall through
    case 0x81: // Secondary
    case 0x89: // Secondary LE
2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212
        // 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 已提交
2213
            break;
2214 2215
        case 4:
            ret = bswap32(ret);
B
blueswir1 已提交
2216
            break;
2217 2218
        case 8:
            ret = bswap64(ret);
B
blueswir1 已提交
2219
            break;
2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231
        default:
            break;
        }
    default:
        break;
    }

    /* Convert to signed number */
    if (sign) {
        switch(size) {
        case 1:
            ret = (int8_t) ret;
B
blueswir1 已提交
2232
            break;
2233 2234
        case 2:
            ret = (int16_t) ret;
B
blueswir1 已提交
2235
            break;
2236 2237
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
2238
            break;
2239 2240 2241 2242
        default:
            break;
        }
    }
B
blueswir1 已提交
2243 2244 2245 2246
#ifdef DEBUG_ASI
    dump_asi("read ", last_addr, asi, size, ret);
#endif
    return ret;
2247 2248
}

B
blueswir1 已提交
2249
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
2250
{
B
blueswir1 已提交
2251 2252 2253
#ifdef DEBUG_ASI
    dump_asi("write", addr, asi, size, val);
#endif
2254 2255 2256
    if (asi < 0x80)
        raise_exception(TT_PRIV_ACT);

2257
    helper_check_align(addr, size - 1);
2258
    addr = address_mask(env, addr);
2259

2260 2261 2262 2263 2264 2265
    /* Convert to little endian */
    switch (asi) {
    case 0x88: // Primary LE
    case 0x89: // Secondary LE
        switch(size) {
        case 2:
2266
            val = bswap16(val);
B
blueswir1 已提交
2267
            break;
2268
        case 4:
2269
            val = bswap32(val);
B
blueswir1 已提交
2270
            break;
2271
        case 8:
2272
            val = bswap64(val);
B
blueswir1 已提交
2273
            break;
2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286
        default:
            break;
        }
    default:
        break;
    }

    switch(asi) {
    case 0x80: // Primary
    case 0x88: // Primary LE
        {
            switch(size) {
            case 1:
B
blueswir1 已提交
2287
                stb_raw(addr, val);
2288 2289
                break;
            case 2:
2290
                stw_raw(addr, val);
2291 2292
                break;
            case 4:
2293
                stl_raw(addr, val);
2294 2295 2296
                break;
            case 8:
            default:
2297
                stq_raw(addr, val);
2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311
                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:
2312
        do_unassigned_access(addr, 1, 0, 1, size);
2313 2314 2315 2316 2317
        return;
    }
}

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

B
blueswir1 已提交
2319
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
B
bellard 已提交
2320
{
B
bellard 已提交
2321
    uint64_t ret = 0;
B
blueswir1 已提交
2322 2323 2324
#if defined(DEBUG_ASI)
    target_ulong last_addr = addr;
#endif
B
bellard 已提交
2325

I
Igor V. Kovalenko 已提交
2326 2327
    asi &= 0xff;

B
blueswir1 已提交
2328
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
2329 2330
        || ((env->def->features & CPU_FEATURE_HYPV)
            && asi >= 0x30 && asi < 0x80
2331
            && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
2332
        raise_exception(TT_PRIV_ACT);
B
bellard 已提交
2333

2334
    helper_check_align(addr, size - 1);
B
bellard 已提交
2335
    switch (asi) {
B
blueswir1 已提交
2336 2337
    case 0x82: // Primary no-fault
    case 0x8a: // Primary no-fault LE
2338 2339 2340 2341 2342 2343 2344 2345
    case 0x83: // Secondary no-fault
    case 0x8b: // Secondary no-fault LE
        {
            /* secondary space access has lowest asi bit equal to 1 */
            int access_mmu_idx = ( asi & 1 ) ? MMU_KERNEL_IDX
                                             : MMU_KERNEL_SECONDARY_IDX;

            if (cpu_get_phys_page_nofault(env, addr, access_mmu_idx) == -1ULL) {
B
blueswir1 已提交
2346
#ifdef DEBUG_ASI
2347
                dump_asi("read ", last_addr, asi, size, ret);
B
blueswir1 已提交
2348
#endif
2349 2350
                return 0;
            }
B
blueswir1 已提交
2351 2352
        }
        // Fall through
2353
    case 0x10: // As if user primary
2354
    case 0x11: // As if user secondary
2355
    case 0x18: // As if user primary LE
2356
    case 0x19: // As if user secondary LE
2357
    case 0x80: // Primary
2358
    case 0x81: // Secondary
2359
    case 0x88: // Primary LE
2360
    case 0x89: // Secondary LE
B
blueswir1 已提交
2361 2362
    case 0xe2: // UA2007 Primary block init
    case 0xe3: // UA2007 Secondary block init
2363
        if ((asi & 0x80) && (env->pstate & PS_PRIV)) {
2364 2365
            if ((env->def->features & CPU_FEATURE_HYPV)
                && env->hpstate & HS_PRIV) {
B
blueswir1 已提交
2366 2367
                switch(size) {
                case 1:
B
blueswir1 已提交
2368
                    ret = ldub_hypv(addr);
B
blueswir1 已提交
2369 2370
                    break;
                case 2:
2371
                    ret = lduw_hypv(addr);
B
blueswir1 已提交
2372 2373
                    break;
                case 4:
2374
                    ret = ldl_hypv(addr);
B
blueswir1 已提交
2375 2376 2377
                    break;
                default:
                case 8:
2378
                    ret = ldq_hypv(addr);
B
blueswir1 已提交
2379 2380 2381
                    break;
                }
            } else {
2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419
                /* secondary space access has lowest asi bit equal to 1 */
                if (asi & 1) {
                    switch(size) {
                    case 1:
                        ret = ldub_kernel_secondary(addr);
                        break;
                    case 2:
                        ret = lduw_kernel_secondary(addr);
                        break;
                    case 4:
                        ret = ldl_kernel_secondary(addr);
                        break;
                    default:
                    case 8:
                        ret = ldq_kernel_secondary(addr);
                        break;
                    }
                } else {
                    switch(size) {
                    case 1:
                        ret = ldub_kernel(addr);
                        break;
                    case 2:
                        ret = lduw_kernel(addr);
                        break;
                    case 4:
                        ret = ldl_kernel(addr);
                        break;
                    default:
                    case 8:
                        ret = ldq_kernel(addr);
                        break;
                    }
                }
            }
        } else {
            /* secondary space access has lowest asi bit equal to 1 */
            if (asi & 1) {
B
blueswir1 已提交
2420 2421
                switch(size) {
                case 1:
2422
                    ret = ldub_user_secondary(addr);
B
blueswir1 已提交
2423 2424
                    break;
                case 2:
2425
                    ret = lduw_user_secondary(addr);
B
blueswir1 已提交
2426 2427
                    break;
                case 4:
2428
                    ret = ldl_user_secondary(addr);
B
blueswir1 已提交
2429 2430 2431
                    break;
                default:
                case 8:
2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448
                    ret = ldq_user_secondary(addr);
                    break;
                }
            } else {
                switch(size) {
                case 1:
                    ret = ldub_user(addr);
                    break;
                case 2:
                    ret = lduw_user(addr);
                    break;
                case 4:
                    ret = ldl_user(addr);
                    break;
                default:
                case 8:
                    ret = ldq_user(addr);
B
blueswir1 已提交
2449 2450
                    break;
                }
2451 2452 2453
            }
        }
        break;
B
bellard 已提交
2454 2455
    case 0x14: // Bypass
    case 0x15: // Bypass, non-cacheable
2456 2457
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
B
blueswir1 已提交
2458
        {
B
bellard 已提交
2459 2460
            switch(size) {
            case 1:
B
blueswir1 已提交
2461
                ret = ldub_phys(addr);
B
bellard 已提交
2462 2463
                break;
            case 2:
2464
                ret = lduw_phys(addr);
B
bellard 已提交
2465 2466
                break;
            case 4:
2467
                ret = ldl_phys(addr);
B
bellard 已提交
2468 2469 2470
                break;
            default:
            case 8:
2471
                ret = ldq_phys(addr);
B
bellard 已提交
2472 2473
                break;
            }
B
blueswir1 已提交
2474 2475
            break;
        }
B
blueswir1 已提交
2476 2477 2478 2479 2480
    case 0x24: // Nucleus quad LDD 128 bit atomic
    case 0x2c: // Nucleus quad LDD 128 bit atomic LE
        //  Only ldda allowed
        raise_exception(TT_ILL_INSN);
        return 0;
B
bellard 已提交
2481 2482
    case 0x04: // Nucleus
    case 0x0c: // Nucleus Little Endian (LE)
2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500
    {
        switch(size) {
        case 1:
            ret = ldub_nucleus(addr);
            break;
        case 2:
            ret = lduw_nucleus(addr);
            break;
        case 4:
            ret = ldl_nucleus(addr);
            break;
        default:
        case 8:
            ret = ldq_nucleus(addr);
            break;
        }
        break;
    }
B
bellard 已提交
2501
    case 0x4a: // UPA config
B
blueswir1 已提交
2502 2503
        // XXX
        break;
B
bellard 已提交
2504
    case 0x45: // LSU
B
blueswir1 已提交
2505 2506
        ret = env->lsu;
        break;
B
bellard 已提交
2507
    case 0x50: // I-MMU regs
B
blueswir1 已提交
2508
        {
B
blueswir1 已提交
2509
            int reg = (addr >> 3) & 0xf;
B
bellard 已提交
2510

2511 2512
            if (reg == 0) {
                // I-TSB Tag Target register
2513
                ret = ultrasparc_tag_target(env->immu.tag_access);
2514 2515 2516 2517
            } else {
                ret = env->immuregs[reg];
            }

B
blueswir1 已提交
2518 2519
            break;
        }
B
bellard 已提交
2520
    case 0x51: // I-MMU 8k TSB pointer
2521 2522 2523
        {
            // env->immuregs[5] holds I-MMU TSB register value
            // env->immuregs[6] holds I-MMU Tag Access register value
2524
            ret = ultrasparc_tsb_pointer(env->immu.tsb, env->immu.tag_access,
2525 2526 2527
                                         8*1024);
            break;
        }
B
bellard 已提交
2528
    case 0x52: // I-MMU 64k TSB pointer
2529 2530 2531
        {
            // env->immuregs[5] holds I-MMU TSB register value
            // env->immuregs[6] holds I-MMU Tag Access register value
2532
            ret = ultrasparc_tsb_pointer(env->immu.tsb, env->immu.tag_access,
2533 2534 2535
                                         64*1024);
            break;
        }
2536 2537 2538 2539
    case 0x55: // I-MMU data access
        {
            int reg = (addr >> 3) & 0x3f;

2540
            ret = env->itlb[reg].tte;
2541 2542
            break;
        }
B
bellard 已提交
2543
    case 0x56: // I-MMU tag read
B
blueswir1 已提交
2544
        {
B
blueswir1 已提交
2545
            int reg = (addr >> 3) & 0x3f;
B
blueswir1 已提交
2546

2547
            ret = env->itlb[reg].tag;
B
blueswir1 已提交
2548 2549
            break;
        }
B
bellard 已提交
2550
    case 0x58: // D-MMU regs
B
blueswir1 已提交
2551
        {
B
blueswir1 已提交
2552
            int reg = (addr >> 3) & 0xf;
B
bellard 已提交
2553

2554 2555
            if (reg == 0) {
                // D-TSB Tag Target register
2556
                ret = ultrasparc_tag_target(env->dmmu.tag_access);
2557 2558 2559 2560 2561 2562 2563 2564 2565
            } else {
                ret = env->dmmuregs[reg];
            }
            break;
        }
    case 0x59: // D-MMU 8k TSB pointer
        {
            // env->dmmuregs[5] holds D-MMU TSB register value
            // env->dmmuregs[6] holds D-MMU Tag Access register value
2566
            ret = ultrasparc_tsb_pointer(env->dmmu.tsb, env->dmmu.tag_access,
2567 2568 2569 2570 2571 2572 2573
                                         8*1024);
            break;
        }
    case 0x5a: // D-MMU 64k TSB pointer
        {
            // env->dmmuregs[5] holds D-MMU TSB register value
            // env->dmmuregs[6] holds D-MMU Tag Access register value
2574
            ret = ultrasparc_tsb_pointer(env->dmmu.tsb, env->dmmu.tag_access,
2575
                                         64*1024);
B
blueswir1 已提交
2576 2577
            break;
        }
2578 2579 2580 2581
    case 0x5d: // D-MMU data access
        {
            int reg = (addr >> 3) & 0x3f;

2582
            ret = env->dtlb[reg].tte;
2583 2584
            break;
        }
B
bellard 已提交
2585
    case 0x5e: // D-MMU tag read
B
blueswir1 已提交
2586
        {
B
blueswir1 已提交
2587
            int reg = (addr >> 3) & 0x3f;
B
blueswir1 已提交
2588

2589
            ret = env->dtlb[reg].tag;
B
blueswir1 已提交
2590 2591
            break;
        }
2592 2593
    case 0x46: // D-cache data
    case 0x47: // D-cache tag access
2594 2595 2596
    case 0x4b: // E-cache error enable
    case 0x4c: // E-cache asynchronous fault status
    case 0x4d: // E-cache asynchronous fault address
2597 2598 2599 2600 2601 2602 2603 2604
    case 0x4e: // E-cache tag data
    case 0x66: // I-cache instruction access
    case 0x67: // I-cache tag access
    case 0x6e: // I-cache predecode
    case 0x6f: // I-cache LRU etc.
    case 0x76: // E-cache tag
    case 0x7e: // E-cache tag
        break;
B
bellard 已提交
2605
    case 0x5b: // D-MMU data pointer
B
bellard 已提交
2606 2607 2608
    case 0x48: // Interrupt dispatch, RO
    case 0x49: // Interrupt data receive
    case 0x7f: // Incoming interrupt vector, RO
B
blueswir1 已提交
2609 2610
        // XXX
        break;
B
bellard 已提交
2611 2612 2613 2614
    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 已提交
2615
    case 0x77: // Interrupt vector, WO
B
bellard 已提交
2616
    default:
2617
        do_unassigned_access(addr, 0, 0, 1, size);
B
blueswir1 已提交
2618 2619
        ret = 0;
        break;
B
bellard 已提交
2620
    }
2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635

    /* 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 已提交
2636
            break;
2637 2638
        case 4:
            ret = bswap32(ret);
B
blueswir1 已提交
2639
            break;
2640 2641
        case 8:
            ret = bswap64(ret);
B
blueswir1 已提交
2642
            break;
2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654
        default:
            break;
        }
    default:
        break;
    }

    /* Convert to signed number */
    if (sign) {
        switch(size) {
        case 1:
            ret = (int8_t) ret;
B
blueswir1 已提交
2655
            break;
2656 2657
        case 2:
            ret = (int16_t) ret;
B
blueswir1 已提交
2658
            break;
2659 2660
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
2661
            break;
2662 2663 2664 2665
        default:
            break;
        }
    }
B
blueswir1 已提交
2666 2667 2668 2669
#ifdef DEBUG_ASI
    dump_asi("read ", last_addr, asi, size, ret);
#endif
    return ret;
B
bellard 已提交
2670 2671
}

B
blueswir1 已提交
2672
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
B
bellard 已提交
2673
{
B
blueswir1 已提交
2674 2675 2676
#ifdef DEBUG_ASI
    dump_asi("write", addr, asi, size, val);
#endif
I
Igor V. Kovalenko 已提交
2677 2678 2679

    asi &= 0xff;

B
blueswir1 已提交
2680
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
2681 2682
        || ((env->def->features & CPU_FEATURE_HYPV)
            && asi >= 0x30 && asi < 0x80
2683
            && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
2684
        raise_exception(TT_PRIV_ACT);
B
bellard 已提交
2685

2686
    helper_check_align(addr, size - 1);
2687 2688 2689 2690 2691 2692 2693 2694 2695 2696 2697
    /* 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:
2698
            val = bswap16(val);
B
blueswir1 已提交
2699
            break;
2700
        case 4:
2701
            val = bswap32(val);
B
blueswir1 已提交
2702
            break;
2703
        case 8:
2704
            val = bswap64(val);
B
blueswir1 已提交
2705
            break;
2706 2707 2708 2709 2710 2711 2712
        default:
            break;
        }
    default:
        break;
    }

B
bellard 已提交
2713
    switch(asi) {
2714
    case 0x10: // As if user primary
2715
    case 0x11: // As if user secondary
2716
    case 0x18: // As if user primary LE
2717
    case 0x19: // As if user secondary LE
2718
    case 0x80: // Primary
2719
    case 0x81: // Secondary
2720
    case 0x88: // Primary LE
2721
    case 0x89: // Secondary LE
B
blueswir1 已提交
2722 2723
    case 0xe2: // UA2007 Primary block init
    case 0xe3: // UA2007 Secondary block init
2724
        if ((asi & 0x80) && (env->pstate & PS_PRIV)) {
2725 2726
            if ((env->def->features & CPU_FEATURE_HYPV)
                && env->hpstate & HS_PRIV) {
B
blueswir1 已提交
2727 2728
                switch(size) {
                case 1:
B
blueswir1 已提交
2729
                    stb_hypv(addr, val);
B
blueswir1 已提交
2730 2731
                    break;
                case 2:
2732
                    stw_hypv(addr, val);
B
blueswir1 已提交
2733 2734
                    break;
                case 4:
2735
                    stl_hypv(addr, val);
B
blueswir1 已提交
2736 2737 2738
                    break;
                case 8:
                default:
2739
                    stq_hypv(addr, val);
B
blueswir1 已提交
2740 2741 2742
                    break;
                }
            } else {
2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780
                /* secondary space access has lowest asi bit equal to 1 */
                if (asi & 1) {
                    switch(size) {
                    case 1:
                        stb_kernel_secondary(addr, val);
                        break;
                    case 2:
                        stw_kernel_secondary(addr, val);
                        break;
                    case 4:
                        stl_kernel_secondary(addr, val);
                        break;
                    case 8:
                    default:
                        stq_kernel_secondary(addr, val);
                        break;
                    }
                } else {
                    switch(size) {
                    case 1:
                        stb_kernel(addr, val);
                        break;
                    case 2:
                        stw_kernel(addr, val);
                        break;
                    case 4:
                        stl_kernel(addr, val);
                        break;
                    case 8:
                    default:
                        stq_kernel(addr, val);
                        break;
                    }
                }
            }
        } else {
            /* secondary space access has lowest asi bit equal to 1 */
            if (asi & 1) {
B
blueswir1 已提交
2781 2782
                switch(size) {
                case 1:
2783
                    stb_user_secondary(addr, val);
B
blueswir1 已提交
2784 2785
                    break;
                case 2:
2786
                    stw_user_secondary(addr, val);
B
blueswir1 已提交
2787 2788
                    break;
                case 4:
2789
                    stl_user_secondary(addr, val);
B
blueswir1 已提交
2790 2791 2792
                    break;
                case 8:
                default:
2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809
                    stq_user_secondary(addr, val);
                    break;
                }
            } else {
                switch(size) {
                case 1:
                    stb_user(addr, val);
                    break;
                case 2:
                    stw_user(addr, val);
                    break;
                case 4:
                    stl_user(addr, val);
                    break;
                case 8:
                default:
                    stq_user(addr, val);
B
blueswir1 已提交
2810 2811
                    break;
                }
2812 2813 2814
            }
        }
        break;
B
bellard 已提交
2815 2816
    case 0x14: // Bypass
    case 0x15: // Bypass, non-cacheable
2817 2818
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
B
blueswir1 已提交
2819
        {
B
bellard 已提交
2820 2821
            switch(size) {
            case 1:
B
blueswir1 已提交
2822
                stb_phys(addr, val);
B
bellard 已提交
2823 2824
                break;
            case 2:
2825
                stw_phys(addr, val);
B
bellard 已提交
2826 2827
                break;
            case 4:
2828
                stl_phys(addr, val);
B
bellard 已提交
2829 2830 2831
                break;
            case 8:
            default:
2832
                stq_phys(addr, val);
B
bellard 已提交
2833 2834
                break;
            }
B
blueswir1 已提交
2835 2836
        }
        return;
B
blueswir1 已提交
2837 2838 2839 2840 2841
    case 0x24: // Nucleus quad LDD 128 bit atomic
    case 0x2c: // Nucleus quad LDD 128 bit atomic LE
        //  Only ldda allowed
        raise_exception(TT_ILL_INSN);
        return;
B
bellard 已提交
2842 2843
    case 0x04: // Nucleus
    case 0x0c: // Nucleus Little Endian (LE)
2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862
    {
        switch(size) {
        case 1:
            stb_nucleus(addr, val);
            break;
        case 2:
            stw_nucleus(addr, val);
            break;
        case 4:
            stl_nucleus(addr, val);
            break;
        default:
        case 8:
            stq_nucleus(addr, val);
            break;
        }
        break;
    }

B
bellard 已提交
2863
    case 0x4a: // UPA config
B
blueswir1 已提交
2864 2865
        // XXX
        return;
B
bellard 已提交
2866
    case 0x45: // LSU
B
blueswir1 已提交
2867 2868 2869 2870
        {
            uint64_t oldreg;

            oldreg = env->lsu;
B
blueswir1 已提交
2871
            env->lsu = val & (DMMU_E | IMMU_E);
B
blueswir1 已提交
2872 2873 2874
            // Mappings generated during D/I MMU disabled mode are
            // invalid in normal mode
            if (oldreg != env->lsu) {
B
blueswir1 已提交
2875 2876
                DPRINTF_MMU("LSU change: 0x%" PRIx64 " -> 0x%" PRIx64 "\n",
                            oldreg, env->lsu);
B
bellard 已提交
2877
#ifdef DEBUG_MMU
B
blueswir1 已提交
2878
                dump_mmu(env);
B
bellard 已提交
2879
#endif
B
blueswir1 已提交
2880 2881 2882 2883
                tlb_flush(env, 1);
            }
            return;
        }
B
bellard 已提交
2884
    case 0x50: // I-MMU regs
B
blueswir1 已提交
2885
        {
B
blueswir1 已提交
2886
            int reg = (addr >> 3) & 0xf;
B
blueswir1 已提交
2887
            uint64_t oldreg;
2888

B
blueswir1 已提交
2889
            oldreg = env->immuregs[reg];
B
bellard 已提交
2890 2891 2892 2893 2894 2895 2896
            switch(reg) {
            case 0: // RO
                return;
            case 1: // Not in I-MMU
            case 2:
                return;
            case 3: // SFSR
B
blueswir1 已提交
2897 2898
                if ((val & 1) == 0)
                    val = 0; // Clear SFSR
2899
                env->immu.sfsr = val;
B
bellard 已提交
2900
                break;
2901 2902
            case 4: // RO
                return;
B
bellard 已提交
2903
            case 5: // TSB access
2904 2905 2906 2907
                DPRINTF_MMU("immu TSB write: 0x%016" PRIx64 " -> 0x%016"
                            PRIx64 "\n", env->immu.tsb, val);
                env->immu.tsb = val;
                break;
B
bellard 已提交
2908
            case 6: // Tag access
2909 2910 2911 2912 2913
                env->immu.tag_access = val;
                break;
            case 7:
            case 8:
                return;
B
bellard 已提交
2914 2915 2916
            default:
                break;
            }
2917

B
bellard 已提交
2918
            if (oldreg != env->immuregs[reg]) {
2919
                DPRINTF_MMU("immu change reg[%d]: 0x%016" PRIx64 " -> 0x%016"
B
blueswir1 已提交
2920
                            PRIx64 "\n", reg, oldreg, env->immuregs[reg]);
B
bellard 已提交
2921
            }
2922
#ifdef DEBUG_MMU
B
blueswir1 已提交
2923
            dump_mmu(env);
B
bellard 已提交
2924
#endif
B
blueswir1 已提交
2925 2926
            return;
        }
B
bellard 已提交
2927
    case 0x54: // I-MMU data in
2928 2929
        replace_tlb_1bit_lru(env->itlb, env->immu.tag_access, val, "immu", env);
        return;
B
bellard 已提交
2930
    case 0x55: // I-MMU data access
B
blueswir1 已提交
2931
        {
2932 2933
            // TODO: auto demap

B
blueswir1 已提交
2934
            unsigned int i = (addr >> 3) & 0x3f;
B
bellard 已提交
2935

2936
            replace_tlb_entry(&env->itlb[i], env->immu.tag_access, val, env);
2937 2938

#ifdef DEBUG_MMU
2939
            DPRINTF_MMU("immu data access replaced entry [%i]\n", i);
2940 2941
            dump_mmu(env);
#endif
B
blueswir1 已提交
2942 2943
            return;
        }
B
bellard 已提交
2944
    case 0x57: // I-MMU demap
2945
        demap_tlb(env->itlb, addr, "immu", env);
B
blueswir1 已提交
2946
        return;
B
bellard 已提交
2947
    case 0x58: // D-MMU regs
B
blueswir1 已提交
2948
        {
B
blueswir1 已提交
2949
            int reg = (addr >> 3) & 0xf;
B
blueswir1 已提交
2950
            uint64_t oldreg;
2951

B
blueswir1 已提交
2952
            oldreg = env->dmmuregs[reg];
B
bellard 已提交
2953 2954 2955 2956 2957
            switch(reg) {
            case 0: // RO
            case 4:
                return;
            case 3: // SFSR
B
blueswir1 已提交
2958 2959
                if ((val & 1) == 0) {
                    val = 0; // Clear SFSR, Fault address
2960
                    env->dmmu.sfar = 0;
B
blueswir1 已提交
2961
                }
2962
                env->dmmu.sfsr = val;
B
bellard 已提交
2963 2964
                break;
            case 1: // Primary context
2965 2966
                env->dmmu.mmu_primary_context = val;
                break;
B
bellard 已提交
2967
            case 2: // Secondary context
2968 2969
                env->dmmu.mmu_secondary_context = val;
                break;
B
bellard 已提交
2970
            case 5: // TSB access
2971 2972 2973 2974
                DPRINTF_MMU("dmmu TSB write: 0x%016" PRIx64 " -> 0x%016"
                            PRIx64 "\n", env->dmmu.tsb, val);
                env->dmmu.tsb = val;
                break;
B
bellard 已提交
2975
            case 6: // Tag access
2976 2977
                env->dmmu.tag_access = val;
                break;
B
bellard 已提交
2978 2979 2980
            case 7: // Virtual Watchpoint
            case 8: // Physical Watchpoint
            default:
2981
                env->dmmuregs[reg] = val;
B
bellard 已提交
2982 2983
                break;
            }
2984

B
bellard 已提交
2985
            if (oldreg != env->dmmuregs[reg]) {
2986
                DPRINTF_MMU("dmmu change reg[%d]: 0x%016" PRIx64 " -> 0x%016"
B
blueswir1 已提交
2987
                            PRIx64 "\n", reg, oldreg, env->dmmuregs[reg]);
B
bellard 已提交
2988
            }
2989
#ifdef DEBUG_MMU
B
blueswir1 已提交
2990
            dump_mmu(env);
B
bellard 已提交
2991
#endif
B
blueswir1 已提交
2992 2993
            return;
        }
B
bellard 已提交
2994
    case 0x5c: // D-MMU data in
2995 2996
        replace_tlb_1bit_lru(env->dtlb, env->dmmu.tag_access, val, "dmmu", env);
        return;
B
bellard 已提交
2997
    case 0x5d: // D-MMU data access
B
blueswir1 已提交
2998
        {
B
blueswir1 已提交
2999
            unsigned int i = (addr >> 3) & 0x3f;
B
bellard 已提交
3000

3001 3002
            replace_tlb_entry(&env->dtlb[i], env->dmmu.tag_access, val, env);

3003
#ifdef DEBUG_MMU
3004
            DPRINTF_MMU("dmmu data access replaced entry [%i]\n", i);
3005 3006
            dump_mmu(env);
#endif
B
blueswir1 已提交
3007 3008
            return;
        }
B
bellard 已提交
3009
    case 0x5f: // D-MMU demap
3010
        demap_tlb(env->dtlb, addr, "dmmu", env);
3011
        return;
B
bellard 已提交
3012
    case 0x49: // Interrupt data receive
B
blueswir1 已提交
3013 3014
        // XXX
        return;
3015 3016
    case 0x46: // D-cache data
    case 0x47: // D-cache tag access
3017 3018 3019
    case 0x4b: // E-cache error enable
    case 0x4c: // E-cache asynchronous fault status
    case 0x4d: // E-cache asynchronous fault address
3020 3021 3022 3023 3024 3025 3026 3027
    case 0x4e: // E-cache tag data
    case 0x66: // I-cache instruction access
    case 0x67: // I-cache tag access
    case 0x6e: // I-cache predecode
    case 0x6f: // I-cache LRU etc.
    case 0x76: // E-cache tag
    case 0x7e: // E-cache tag
        return;
B
bellard 已提交
3028 3029 3030 3031 3032 3033 3034
    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 已提交
3035 3036 3037 3038 3039 3040
    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 已提交
3041
    default:
3042
        do_unassigned_access(addr, 1, 0, 1, size);
B
blueswir1 已提交
3043
        return;
B
bellard 已提交
3044 3045
    }
}
3046
#endif /* CONFIG_USER_ONLY */
3047

B
blueswir1 已提交
3048 3049 3050
void helper_ldda_asi(target_ulong addr, int asi, int rd)
{
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
3051 3052
        || ((env->def->features & CPU_FEATURE_HYPV)
            && asi >= 0x30 && asi < 0x80
3053
            && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094
        raise_exception(TT_PRIV_ACT);

    switch (asi) {
    case 0x24: // Nucleus quad LDD 128 bit atomic
    case 0x2c: // Nucleus quad LDD 128 bit atomic LE
        helper_check_align(addr, 0xf);
        if (rd == 0) {
            env->gregs[1] = ldq_kernel(addr + 8);
            if (asi == 0x2c)
                bswap64s(&env->gregs[1]);
        } else if (rd < 8) {
            env->gregs[rd] = ldq_kernel(addr);
            env->gregs[rd + 1] = ldq_kernel(addr + 8);
            if (asi == 0x2c) {
                bswap64s(&env->gregs[rd]);
                bswap64s(&env->gregs[rd + 1]);
            }
        } else {
            env->regwptr[rd] = ldq_kernel(addr);
            env->regwptr[rd + 1] = ldq_kernel(addr + 8);
            if (asi == 0x2c) {
                bswap64s(&env->regwptr[rd]);
                bswap64s(&env->regwptr[rd + 1]);
            }
        }
        break;
    default:
        helper_check_align(addr, 0x3);
        if (rd == 0)
            env->gregs[1] = helper_ld_asi(addr + 4, asi, 4, 0);
        else if (rd < 8) {
            env->gregs[rd] = helper_ld_asi(addr, asi, 4, 0);
            env->gregs[rd + 1] = helper_ld_asi(addr + 4, asi, 4, 0);
        } else {
            env->regwptr[rd] = helper_ld_asi(addr, asi, 4, 0);
            env->regwptr[rd + 1] = helper_ld_asi(addr + 4, asi, 4, 0);
        }
        break;
    }
}

B
blueswir1 已提交
3095
void helper_ldf_asi(target_ulong addr, int asi, int size, int rd)
3096 3097
{
    unsigned int i;
B
blueswir1 已提交
3098
    target_ulong val;
3099

3100
    helper_check_align(addr, 3);
3101 3102 3103 3104 3105
    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 已提交
3106 3107 3108 3109
        if (rd & 7) {
            raise_exception(TT_ILL_INSN);
            return;
        }
3110
        helper_check_align(addr, 0x3f);
B
blueswir1 已提交
3111
        for (i = 0; i < 16; i++) {
B
blueswir1 已提交
3112 3113
            *(uint32_t *)&env->fpr[rd++] = helper_ld_asi(addr, asi & 0x8f, 4,
                                                         0);
B
blueswir1 已提交
3114
            addr += 4;
3115 3116 3117 3118 3119 3120 3121
        }

        return;
    default:
        break;
    }

B
blueswir1 已提交
3122
    val = helper_ld_asi(addr, asi, size, 0);
3123 3124 3125
    switch(size) {
    default:
    case 4:
B
blueswir1 已提交
3126
        *((uint32_t *)&env->fpr[rd]) = val;
3127 3128
        break;
    case 8:
B
blueswir1 已提交
3129
        *((int64_t *)&DT0) = val;
3130
        break;
B
blueswir1 已提交
3131 3132 3133
    case 16:
        // XXX
        break;
3134 3135 3136
    }
}

B
blueswir1 已提交
3137
void helper_stf_asi(target_ulong addr, int asi, int size, int rd)
3138 3139
{
    unsigned int i;
B
blueswir1 已提交
3140
    target_ulong val = 0;
3141

3142
    helper_check_align(addr, 3);
3143
    switch (asi) {
B
blueswir1 已提交
3144 3145
    case 0xe0: // UA2007 Block commit store primary (cache flush)
    case 0xe1: // UA2007 Block commit store secondary (cache flush)
3146 3147 3148 3149
    case 0xf0: // Block store primary
    case 0xf1: // Block store secondary
    case 0xf8: // Block store primary LE
    case 0xf9: // Block store secondary LE
B
blueswir1 已提交
3150 3151 3152 3153
        if (rd & 7) {
            raise_exception(TT_ILL_INSN);
            return;
        }
3154
        helper_check_align(addr, 0x3f);
B
blueswir1 已提交
3155
        for (i = 0; i < 16; i++) {
B
blueswir1 已提交
3156 3157 3158
            val = *(uint32_t *)&env->fpr[rd++];
            helper_st_asi(addr, val, asi & 0x8f, 4);
            addr += 4;
3159 3160 3161 3162 3163 3164 3165 3166 3167 3168
        }

        return;
    default:
        break;
    }

    switch(size) {
    default:
    case 4:
B
blueswir1 已提交
3169
        val = *((uint32_t *)&env->fpr[rd]);
3170 3171
        break;
    case 8:
B
blueswir1 已提交
3172
        val = *((int64_t *)&DT0);
3173
        break;
B
blueswir1 已提交
3174 3175 3176
    case 16:
        // XXX
        break;
3177
    }
B
blueswir1 已提交
3178 3179 3180 3181 3182 3183 3184 3185
    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;

3186
    val2 &= 0xffffffffUL;
B
blueswir1 已提交
3187 3188
    ret = helper_ld_asi(addr, asi, 4, 0);
    ret &= 0xffffffffUL;
3189 3190
    if (val2 == ret)
        helper_st_asi(addr, val1 & 0xffffffffUL, asi, 4);
B
blueswir1 已提交
3191
    return ret;
3192 3193
}

B
blueswir1 已提交
3194 3195 3196 3197 3198 3199
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);
3200 3201
    if (val2 == ret)
        helper_st_asi(addr, val1, asi, 8);
B
blueswir1 已提交
3202 3203
    return ret;
}
3204
#endif /* TARGET_SPARC64 */
B
bellard 已提交
3205 3206

#ifndef TARGET_SPARC64
B
blueswir1 已提交
3207
void helper_rett(void)
3208
{
3209 3210
    unsigned int cwp;

3211 3212 3213
    if (env->psret == 1)
        raise_exception(TT_ILL_INSN);

3214
    env->psret = 1;
3215
    cwp = cwp_inc(env->cwp + 1) ;
3216 3217 3218 3219 3220 3221
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_UNF);
    }
    set_cwp(cwp);
    env->psrs = env->psrps;
}
B
bellard 已提交
3222
#endif
3223

B
blueswir1 已提交
3224 3225 3226 3227 3228
target_ulong helper_udiv(target_ulong a, target_ulong b)
{
    uint64_t x0;
    uint32_t x1;

3229
    x0 = (a & 0xffffffff) | ((int64_t) (env->y) << 32);
B
blueswir1 已提交
3230 3231 3232 3233 3234 3235 3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250
    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;

3251
    x0 = (a & 0xffffffff) | ((int64_t) (env->y) << 32);
B
blueswir1 已提交
3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265 3266 3267
    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 已提交
3268 3269
void helper_stdf(target_ulong addr, int mem_idx)
{
3270
    helper_check_align(addr, 7);
B
blueswir1 已提交
3271 3272 3273
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
3274
        stfq_user(addr, DT0);
B
blueswir1 已提交
3275 3276
        break;
    case 1:
3277
        stfq_kernel(addr, DT0);
B
blueswir1 已提交
3278 3279 3280
        break;
#ifdef TARGET_SPARC64
    case 2:
3281
        stfq_hypv(addr, DT0);
B
blueswir1 已提交
3282 3283 3284 3285 3286 3287
        break;
#endif
    default:
        break;
    }
#else
3288
    stfq_raw(address_mask(env, addr), DT0);
B
blueswir1 已提交
3289 3290 3291 3292 3293
#endif
}

void helper_lddf(target_ulong addr, int mem_idx)
{
3294
    helper_check_align(addr, 7);
B
blueswir1 已提交
3295 3296 3297
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
3298
        DT0 = ldfq_user(addr);
B
blueswir1 已提交
3299 3300
        break;
    case 1:
3301
        DT0 = ldfq_kernel(addr);
B
blueswir1 已提交
3302 3303 3304
        break;
#ifdef TARGET_SPARC64
    case 2:
3305
        DT0 = ldfq_hypv(addr);
B
blueswir1 已提交
3306 3307 3308 3309 3310 3311
        break;
#endif
    default:
        break;
    }
#else
3312
    DT0 = ldfq_raw(address_mask(env, addr));
B
blueswir1 已提交
3313 3314 3315
#endif
}

B
blueswir1 已提交
3316
void helper_ldqf(target_ulong addr, int mem_idx)
B
blueswir1 已提交
3317 3318 3319 3320
{
    // XXX add 128 bit load
    CPU_QuadU u;

3321
    helper_check_align(addr, 7);
B
blueswir1 已提交
3322 3323 3324
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
3325 3326
        u.ll.upper = ldq_user(addr);
        u.ll.lower = ldq_user(addr + 8);
B
blueswir1 已提交
3327 3328 3329
        QT0 = u.q;
        break;
    case 1:
3330 3331
        u.ll.upper = ldq_kernel(addr);
        u.ll.lower = ldq_kernel(addr + 8);
B
blueswir1 已提交
3332 3333 3334 3335
        QT0 = u.q;
        break;
#ifdef TARGET_SPARC64
    case 2:
3336 3337
        u.ll.upper = ldq_hypv(addr);
        u.ll.lower = ldq_hypv(addr + 8);
B
blueswir1 已提交
3338 3339 3340 3341 3342 3343 3344
        QT0 = u.q;
        break;
#endif
    default:
        break;
    }
#else
3345 3346
    u.ll.upper = ldq_raw(address_mask(env, addr));
    u.ll.lower = ldq_raw(address_mask(env, addr + 8));
B
blueswir1 已提交
3347
    QT0 = u.q;
B
blueswir1 已提交
3348
#endif
B
blueswir1 已提交
3349 3350
}

B
blueswir1 已提交
3351
void helper_stqf(target_ulong addr, int mem_idx)
B
blueswir1 已提交
3352 3353 3354 3355
{
    // XXX add 128 bit store
    CPU_QuadU u;

3356
    helper_check_align(addr, 7);
B
blueswir1 已提交
3357 3358 3359 3360
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
        u.q = QT0;
3361 3362
        stq_user(addr, u.ll.upper);
        stq_user(addr + 8, u.ll.lower);
B
blueswir1 已提交
3363 3364 3365
        break;
    case 1:
        u.q = QT0;
3366 3367
        stq_kernel(addr, u.ll.upper);
        stq_kernel(addr + 8, u.ll.lower);
B
blueswir1 已提交
3368 3369 3370 3371
        break;
#ifdef TARGET_SPARC64
    case 2:
        u.q = QT0;
3372 3373
        stq_hypv(addr, u.ll.upper);
        stq_hypv(addr + 8, u.ll.lower);
B
blueswir1 已提交
3374 3375 3376 3377 3378 3379
        break;
#endif
    default:
        break;
    }
#else
B
blueswir1 已提交
3380
    u.q = QT0;
3381 3382
    stq_raw(address_mask(env, addr), u.ll.upper);
    stq_raw(address_mask(env, addr + 8), u.ll.lower);
B
blueswir1 已提交
3383
#endif
B
blueswir1 已提交
3384
}
B
blueswir1 已提交
3385

3386
static inline void set_fsr(void)
3387
{
B
bellard 已提交
3388
    int rnd_mode;
B
blueswir1 已提交
3389

3390 3391
    switch (env->fsr & FSR_RD_MASK) {
    case FSR_RD_NEAREST:
B
bellard 已提交
3392
        rnd_mode = float_round_nearest_even;
B
blueswir1 已提交
3393
        break;
B
bellard 已提交
3394
    default:
3395
    case FSR_RD_ZERO:
B
bellard 已提交
3396
        rnd_mode = float_round_to_zero;
B
blueswir1 已提交
3397
        break;
3398
    case FSR_RD_POS:
B
bellard 已提交
3399
        rnd_mode = float_round_up;
B
blueswir1 已提交
3400
        break;
3401
    case FSR_RD_NEG:
B
bellard 已提交
3402
        rnd_mode = float_round_down;
B
blueswir1 已提交
3403
        break;
3404
    }
B
bellard 已提交
3405
    set_float_rounding_mode(rnd_mode, &env->fp_status);
3406
}
B
bellard 已提交
3407

3408
void helper_ldfsr(uint32_t new_fsr)
B
blueswir1 已提交
3409
{
3410 3411
    env->fsr = (new_fsr & FSR_LDFSR_MASK) | (env->fsr & FSR_LDFSR_OLDMASK);
    set_fsr();
B
blueswir1 已提交
3412 3413
}

3414 3415 3416 3417 3418 3419 3420 3421
#ifdef TARGET_SPARC64
void helper_ldxfsr(uint64_t new_fsr)
{
    env->fsr = (new_fsr & FSR_LDXFSR_MASK) | (env->fsr & FSR_LDXFSR_OLDMASK);
    set_fsr();
}
#endif

B
blueswir1 已提交
3422
void helper_debug(void)
B
bellard 已提交
3423 3424 3425 3426
{
    env->exception_index = EXCP_DEBUG;
    cpu_loop_exit();
}
3427

B
bellard 已提交
3428
#ifndef TARGET_SPARC64
3429 3430 3431 3432 3433 3434
/* XXX: use another pointer for %iN registers to avoid slow wrapping
   handling ? */
void helper_save(void)
{
    uint32_t cwp;

3435
    cwp = cwp_dec(env->cwp - 1);
3436 3437 3438 3439 3440 3441 3442 3443 3444 3445
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_OVF);
    }
    set_cwp(cwp);
}

void helper_restore(void)
{
    uint32_t cwp;

3446
    cwp = cwp_inc(env->cwp + 1);
3447 3448 3449 3450 3451 3452
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_UNF);
    }
    set_cwp(cwp);
}

B
blueswir1 已提交
3453
void helper_wrpsr(target_ulong new_psr)
3454
{
3455
    if ((new_psr & PSR_CWP) >= env->nwindows) {
3456
        raise_exception(TT_ILL_INSN);
3457 3458 3459
    } else {
        cpu_put_psr(env, new_psr);
    }
3460 3461
}

B
blueswir1 已提交
3462
target_ulong helper_rdpsr(void)
3463
{
3464
    return get_psr();
3465
}
B
bellard 已提交
3466 3467

#else
3468 3469 3470 3471 3472 3473
/* XXX: use another pointer for %iN registers to avoid slow wrapping
   handling ? */
void helper_save(void)
{
    uint32_t cwp;

3474
    cwp = cwp_dec(env->cwp - 1);
3475 3476 3477 3478 3479 3480 3481 3482 3483 3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494
    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;

3495
    cwp = cwp_inc(env->cwp + 1);
3496 3497 3498 3499 3500 3501 3502 3503 3504 3505 3506 3507 3508
    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)
{
3509
    if (env->cansave != env->nwindows - 2) {
3510 3511 3512 3513 3514 3515 3516 3517 3518 3519 3520 3521 3522 3523 3524 3525 3526 3527
        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++;
3528
    if (env->cleanwin < env->nwindows - 1)
3529 3530 3531 3532 3533 3534 3535
        env->cleanwin++;
    if (env->otherwin == 0)
        env->cansave--;
    else
        env->otherwin--;
}

3536 3537 3538 3539 3540 3541 3542 3543 3544 3545 3546 3547 3548 3549 3550 3551 3552 3553 3554 3555 3556 3557 3558 3559 3560 3561 3562 3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585 3586 3587 3588 3589 3590 3591 3592 3593 3594 3595 3596 3597 3598 3599 3600 3601 3602 3603 3604 3605 3606 3607 3608 3609 3610
static target_ulong get_ccr(void)
{
    target_ulong psr;

    psr = get_psr();

    return ((env->xcc >> 20) << 4) | ((psr & PSR_ICC) >> 20);
}

target_ulong cpu_get_ccr(CPUState *env1)
{
    CPUState *saved_env;
    target_ulong ret;

    saved_env = env;
    env = env1;
    ret = get_ccr();
    env = saved_env;
    return ret;
}

static void put_ccr(target_ulong val)
{
    target_ulong tmp = val;

    env->xcc = (tmp >> 4) << 20;
    env->psr = (tmp & 0xf) << 20;
    CC_OP = CC_OP_FLAGS;
}

void cpu_put_ccr(CPUState *env1, target_ulong val)
{
    CPUState *saved_env;

    saved_env = env;
    env = env1;
    put_ccr(val);
    env = saved_env;
}

static target_ulong get_cwp64(void)
{
    return env->nwindows - 1 - env->cwp;
}

target_ulong cpu_get_cwp64(CPUState *env1)
{
    CPUState *saved_env;
    target_ulong ret;

    saved_env = env;
    env = env1;
    ret = get_cwp64();
    env = saved_env;
    return ret;
}

static void put_cwp64(int cwp)
{
    if (unlikely(cwp >= env->nwindows || cwp < 0)) {
        cwp %= env->nwindows;
    }
    set_cwp(env->nwindows - 1 - cwp);
}

void cpu_put_cwp64(CPUState *env1, int cwp)
{
    CPUState *saved_env;

    saved_env = env;
    env = env1;
    put_cwp64(cwp);
    env = saved_env;
}

B
blueswir1 已提交
3611 3612
target_ulong helper_rdccr(void)
{
3613
    return get_ccr();
B
blueswir1 已提交
3614 3615 3616 3617
}

void helper_wrccr(target_ulong new_ccr)
{
3618
    put_ccr(new_ccr);
B
blueswir1 已提交
3619 3620 3621 3622 3623 3624
}

// CWP handling is reversed in V9, but we still use the V8 register
// order.
target_ulong helper_rdcwp(void)
{
3625
    return get_cwp64();
B
blueswir1 已提交
3626 3627 3628 3629
}

void helper_wrcwp(target_ulong new_cwp)
{
3630
    put_cwp64(new_cwp);
B
blueswir1 已提交
3631
}
B
bellard 已提交
3632

3633 3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645 3646 3647 3648 3649 3650 3651 3652 3653 3654 3655 3656 3657 3658 3659 3660 3661 3662 3663
// 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 已提交
3664
target_ulong helper_popc(target_ulong val)
B
bellard 已提交
3665
{
B
blueswir1 已提交
3666
    return ctpop64(val);
B
bellard 已提交
3667
}
B
bellard 已提交
3668

3669
static inline uint64_t *get_gregset(uint32_t pstate)
B
bellard 已提交
3670 3671 3672
{
    switch (pstate) {
    default:
3673 3674 3675 3676 3677 3678
        DPRINTF_PSTATE("ERROR in get_gregset: active pstate bits=%x%s%s%s\n",
                pstate,
                (pstate & PS_IG) ? " IG" : "",
                (pstate & PS_MG) ? " MG" : "",
                (pstate & PS_AG) ? " AG" : "");
        /* pass through to normal set of global registers */
B
bellard 已提交
3679
    case 0:
B
blueswir1 已提交
3680
        return env->bgregs;
B
bellard 已提交
3681
    case PS_AG:
B
blueswir1 已提交
3682
        return env->agregs;
B
bellard 已提交
3683
    case PS_MG:
B
blueswir1 已提交
3684
        return env->mgregs;
B
bellard 已提交
3685
    case PS_IG:
B
blueswir1 已提交
3686
        return env->igregs;
B
bellard 已提交
3687 3688 3689
    }
}

3690
static inline void change_pstate(uint32_t new_pstate)
B
bellard 已提交
3691
{
3692
    uint32_t pstate_regs, new_pstate_regs;
B
bellard 已提交
3693 3694
    uint64_t *src, *dst;

3695 3696 3697 3698 3699
    if (env->def->features & CPU_FEATURE_GL) {
        // PS_AG is not implemented in this case
        new_pstate &= ~PS_AG;
    }

B
bellard 已提交
3700 3701
    pstate_regs = env->pstate & 0xc01;
    new_pstate_regs = new_pstate & 0xc01;
3702

B
bellard 已提交
3703
    if (new_pstate_regs != pstate_regs) {
3704 3705
        DPRINTF_PSTATE("change_pstate: switching regs old=%x new=%x\n",
                       pstate_regs, new_pstate_regs);
B
blueswir1 已提交
3706 3707 3708 3709 3710
        // 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 已提交
3711
    }
3712 3713 3714 3715
    else {
        DPRINTF_PSTATE("change_pstate: regs new=%x (unchanged)\n",
                       new_pstate_regs);
    }
B
bellard 已提交
3716 3717 3718
    env->pstate = new_pstate;
}

B
blueswir1 已提交
3719
void helper_wrpstate(target_ulong new_state)
3720
{
3721
    change_pstate(new_state & 0xf3f);
3722 3723 3724 3725 3726 3727

#if !defined(CONFIG_USER_ONLY)
    if (cpu_interrupts_enabled(env)) {
        cpu_check_irqs(env);
    }
#endif
3728 3729
}

3730 3731 3732 3733 3734 3735 3736 3737 3738 3739 3740 3741 3742 3743
void helper_wrpil(target_ulong new_pil)
{
#if !defined(CONFIG_USER_ONLY)
    DPRINTF_PSTATE("helper_wrpil old=%x new=%x\n",
                   env->psrpil, (uint32_t)new_pil);

    env->psrpil = new_pil;

    if (cpu_interrupts_enabled(env)) {
        cpu_check_irqs(env);
    }
#endif
}

B
blueswir1 已提交
3744
void helper_done(void)
B
bellard 已提交
3745
{
3746 3747
    trap_state* tsptr = cpu_tsptr(env);

3748
    env->pc = tsptr->tnpc;
3749
    env->npc = tsptr->tnpc + 4;
3750
    put_ccr(tsptr->tstate >> 32);
3751 3752
    env->asi = (tsptr->tstate >> 24) & 0xff;
    change_pstate((tsptr->tstate >> 8) & 0xf3f);
3753
    put_cwp64(tsptr->tstate & 0xff);
B
blueswir1 已提交
3754
    env->tl--;
3755 3756 3757 3758 3759 3760 3761 3762

    DPRINTF_PSTATE("... helper_done tl=%d\n", env->tl);

#if !defined(CONFIG_USER_ONLY)
    if (cpu_interrupts_enabled(env)) {
        cpu_check_irqs(env);
    }
#endif
B
bellard 已提交
3763 3764
}

B
blueswir1 已提交
3765
void helper_retry(void)
B
bellard 已提交
3766
{
3767 3768 3769 3770
    trap_state* tsptr = cpu_tsptr(env);

    env->pc = tsptr->tpc;
    env->npc = tsptr->tnpc;
3771
    put_ccr(tsptr->tstate >> 32);
3772 3773
    env->asi = (tsptr->tstate >> 24) & 0xff;
    change_pstate((tsptr->tstate >> 8) & 0xf3f);
3774
    put_cwp64(tsptr->tstate & 0xff);
B
blueswir1 已提交
3775
    env->tl--;
3776 3777 3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792 3793 3794 3795 3796

    DPRINTF_PSTATE("... helper_retry tl=%d\n", env->tl);

#if !defined(CONFIG_USER_ONLY)
    if (cpu_interrupts_enabled(env)) {
        cpu_check_irqs(env);
    }
#endif
}

static void do_modify_softint(const char* operation, uint32_t value)
{
    if (env->softint != value) {
        env->softint = value;
        DPRINTF_PSTATE(": %s new %08x\n", operation, env->softint);
#if !defined(CONFIG_USER_ONLY)
        if (cpu_interrupts_enabled(env)) {
            cpu_check_irqs(env);
        }
#endif
    }
B
bellard 已提交
3797
}
3798 3799 3800

void helper_set_softint(uint64_t value)
{
3801
    do_modify_softint("helper_set_softint", env->softint | (uint32_t)value);
3802 3803 3804 3805
}

void helper_clear_softint(uint64_t value)
{
3806
    do_modify_softint("helper_clear_softint", env->softint & (uint32_t)~value);
3807 3808 3809 3810
}

void helper_write_softint(uint64_t value)
{
3811
    do_modify_softint("helper_write_softint", (uint32_t)value);
3812
}
B
bellard 已提交
3813
#endif
3814

B
blueswir1 已提交
3815
void helper_flush(target_ulong addr)
3816
{
B
blueswir1 已提交
3817 3818
    addr &= ~7;
    tb_invalidate_page_range(addr, addr + 8);
3819 3820
}

B
blueswir1 已提交
3821 3822 3823 3824 3825 3826 3827 3828 3829 3830 3831 3832 3833 3834 3835 3836 3837 3838 3839 3840 3841 3842 3843 3844 3845 3846 3847 3848 3849 3850 3851 3852 3853 3854 3855 3856 3857
#ifdef TARGET_SPARC64
#ifdef DEBUG_PCALL
static const char * const excp_names[0x80] = {
    [TT_TFAULT] = "Instruction Access Fault",
    [TT_TMISS] = "Instruction Access MMU Miss",
    [TT_CODE_ACCESS] = "Instruction Access Error",
    [TT_ILL_INSN] = "Illegal Instruction",
    [TT_PRIV_INSN] = "Privileged Instruction",
    [TT_NFPU_INSN] = "FPU Disabled",
    [TT_FP_EXCP] = "FPU Exception",
    [TT_TOVF] = "Tag Overflow",
    [TT_CLRWIN] = "Clean Windows",
    [TT_DIV_ZERO] = "Division By Zero",
    [TT_DFAULT] = "Data Access Fault",
    [TT_DMISS] = "Data Access MMU Miss",
    [TT_DATA_ACCESS] = "Data Access Error",
    [TT_DPROT] = "Data Protection Error",
    [TT_UNALIGNED] = "Unaligned Memory Access",
    [TT_PRIV_ACT] = "Privileged Action",
    [TT_EXTINT | 0x1] = "External Interrupt 1",
    [TT_EXTINT | 0x2] = "External Interrupt 2",
    [TT_EXTINT | 0x3] = "External Interrupt 3",
    [TT_EXTINT | 0x4] = "External Interrupt 4",
    [TT_EXTINT | 0x5] = "External Interrupt 5",
    [TT_EXTINT | 0x6] = "External Interrupt 6",
    [TT_EXTINT | 0x7] = "External Interrupt 7",
    [TT_EXTINT | 0x8] = "External Interrupt 8",
    [TT_EXTINT | 0x9] = "External Interrupt 9",
    [TT_EXTINT | 0xa] = "External Interrupt 10",
    [TT_EXTINT | 0xb] = "External Interrupt 11",
    [TT_EXTINT | 0xc] = "External Interrupt 12",
    [TT_EXTINT | 0xd] = "External Interrupt 13",
    [TT_EXTINT | 0xe] = "External Interrupt 14",
    [TT_EXTINT | 0xf] = "External Interrupt 15",
};
#endif

3858 3859 3860 3861 3862
trap_state* cpu_tsptr(CPUState* env)
{
    return &env->ts[env->tl & MAXTL_MASK];
}

B
blueswir1 已提交
3863 3864 3865
void do_interrupt(CPUState *env)
{
    int intno = env->exception_index;
3866
    trap_state* tsptr;
B
blueswir1 已提交
3867 3868

#ifdef DEBUG_PCALL
3869
    if (qemu_loglevel_mask(CPU_LOG_INT)) {
B
blueswir1 已提交
3870 3871 3872 3873 3874 3875 3876 3877 3878 3879 3880 3881 3882 3883 3884 3885 3886
        static int count;
        const char *name;

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

3887
        qemu_log("%6d: %s (v=%04x) pc=%016" PRIx64 " npc=%016" PRIx64
B
blueswir1 已提交
3888 3889 3890 3891
                " SP=%016" PRIx64 "\n",
                count, name, intno,
                env->pc,
                env->npc, env->regwptr[6]);
3892
        log_cpu_state(env, 0);
B
blueswir1 已提交
3893 3894 3895 3896 3897
#if 0
        {
            int i;
            uint8_t *ptr;

3898
            qemu_log("       code=");
B
blueswir1 已提交
3899 3900
            ptr = (uint8_t *)env->pc;
            for(i = 0; i < 16; i++) {
3901
                qemu_log(" %02x", ldub(ptr + i));
B
blueswir1 已提交
3902
            }
3903
            qemu_log("\n");
B
blueswir1 已提交
3904 3905 3906 3907 3908 3909 3910 3911 3912 3913 3914 3915 3916 3917 3918 3919 3920 3921 3922
        }
#endif
        count++;
    }
#endif
#if !defined(CONFIG_USER_ONLY)
    if (env->tl >= env->maxtl) {
        cpu_abort(env, "Trap 0x%04x while trap level (%d) >= MAXTL (%d),"
                  " Error state", env->exception_index, env->tl, env->maxtl);
        return;
    }
#endif
    if (env->tl < env->maxtl - 1) {
        env->tl++;
    } else {
        env->pstate |= PS_RED;
        if (env->tl < env->maxtl)
            env->tl++;
    }
3923 3924
    tsptr = cpu_tsptr(env);

3925
    tsptr->tstate = (get_ccr() << 32) |
B
blueswir1 已提交
3926
        ((env->asi & 0xff) << 24) | ((env->pstate & 0xf3f) << 8) |
3927
        get_cwp64();
3928 3929 3930
    tsptr->tpc = env->pc;
    tsptr->tnpc = env->npc;
    tsptr->tt = intno;
3931 3932 3933 3934 3935 3936 3937

    switch (intno) {
    case TT_IVEC:
        change_pstate(PS_PEF | PS_PRIV | PS_IG);
        break;
    case TT_TFAULT:
    case TT_DFAULT:
3938 3939 3940
    case TT_TMISS ... TT_TMISS + 3:
    case TT_DMISS ... TT_DMISS + 3:
    case TT_DPROT ... TT_DPROT + 3:
3941 3942 3943 3944 3945
        change_pstate(PS_PEF | PS_PRIV | PS_MG);
        break;
    default:
        change_pstate(PS_PEF | PS_PRIV | PS_AG);
        break;
B
blueswir1 已提交
3946
    }
3947

3948 3949 3950 3951 3952 3953 3954
    if (intno == TT_CLRWIN) {
        set_cwp(cwp_dec(env->cwp - 1));
    } else if ((intno & 0x1c0) == TT_SPILL) {
        set_cwp(cwp_dec(env->cwp - env->cansave - 2));
    } else if ((intno & 0x1c0) == TT_FILL) {
        set_cwp(cwp_inc(env->cwp + 1));
    }
B
blueswir1 已提交
3955 3956 3957 3958
    env->tbr &= ~0x7fffULL;
    env->tbr |= ((env->tl > 1) ? 1 << 14 : 0) | (intno << 5);
    env->pc = env->tbr;
    env->npc = env->pc + 4;
3959
    env->exception_index = -1;
3960
}
B
blueswir1 已提交
3961 3962 3963 3964 3965 3966 3967 3968 3969 3970 3971 3972 3973 3974 3975 3976 3977 3978 3979 3980 3981 3982 3983 3984 3985 3986 3987 3988 3989 3990 3991 3992 3993 3994 3995
#else
#ifdef DEBUG_PCALL
static const char * const excp_names[0x80] = {
    [TT_TFAULT] = "Instruction Access Fault",
    [TT_ILL_INSN] = "Illegal Instruction",
    [TT_PRIV_INSN] = "Privileged Instruction",
    [TT_NFPU_INSN] = "FPU Disabled",
    [TT_WIN_OVF] = "Window Overflow",
    [TT_WIN_UNF] = "Window Underflow",
    [TT_UNALIGNED] = "Unaligned Memory Access",
    [TT_FP_EXCP] = "FPU Exception",
    [TT_DFAULT] = "Data Access Fault",
    [TT_TOVF] = "Tag Overflow",
    [TT_EXTINT | 0x1] = "External Interrupt 1",
    [TT_EXTINT | 0x2] = "External Interrupt 2",
    [TT_EXTINT | 0x3] = "External Interrupt 3",
    [TT_EXTINT | 0x4] = "External Interrupt 4",
    [TT_EXTINT | 0x5] = "External Interrupt 5",
    [TT_EXTINT | 0x6] = "External Interrupt 6",
    [TT_EXTINT | 0x7] = "External Interrupt 7",
    [TT_EXTINT | 0x8] = "External Interrupt 8",
    [TT_EXTINT | 0x9] = "External Interrupt 9",
    [TT_EXTINT | 0xa] = "External Interrupt 10",
    [TT_EXTINT | 0xb] = "External Interrupt 11",
    [TT_EXTINT | 0xc] = "External Interrupt 12",
    [TT_EXTINT | 0xd] = "External Interrupt 13",
    [TT_EXTINT | 0xe] = "External Interrupt 14",
    [TT_EXTINT | 0xf] = "External Interrupt 15",
    [TT_TOVF] = "Tag Overflow",
    [TT_CODE_ACCESS] = "Instruction Access Error",
    [TT_DATA_ACCESS] = "Data Access Error",
    [TT_DIV_ZERO] = "Division By Zero",
    [TT_NCP_INSN] = "Coprocessor Disabled",
};
#endif
3996

B
blueswir1 已提交
3997
void do_interrupt(CPUState *env)
3998
{
B
blueswir1 已提交
3999 4000 4001
    int cwp, intno = env->exception_index;

#ifdef DEBUG_PCALL
4002
    if (qemu_loglevel_mask(CPU_LOG_INT)) {
B
blueswir1 已提交
4003 4004 4005 4006 4007 4008 4009 4010 4011 4012 4013 4014 4015
        static int count;
        const char *name;

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

4016
        qemu_log("%6d: %s (v=%02x) pc=%08x npc=%08x SP=%08x\n",
B
blueswir1 已提交
4017 4018 4019
                count, name, intno,
                env->pc,
                env->npc, env->regwptr[6]);
4020
        log_cpu_state(env, 0);
B
blueswir1 已提交
4021 4022 4023 4024 4025
#if 0
        {
            int i;
            uint8_t *ptr;

4026
            qemu_log("       code=");
B
blueswir1 已提交
4027 4028
            ptr = (uint8_t *)env->pc;
            for(i = 0; i < 16; i++) {
4029
                qemu_log(" %02x", ldub(ptr + i));
B
blueswir1 已提交
4030
            }
4031
            qemu_log("\n");
B
blueswir1 已提交
4032 4033 4034 4035 4036 4037 4038 4039 4040 4041 4042 4043 4044
        }
#endif
        count++;
    }
#endif
#if !defined(CONFIG_USER_ONLY)
    if (env->psret == 0) {
        cpu_abort(env, "Trap 0x%02x while interrupts disabled, Error state",
                  env->exception_index);
        return;
    }
#endif
    env->psret = 0;
4045 4046
    cwp = cwp_dec(env->cwp - 1);
    set_cwp(cwp);
B
blueswir1 已提交
4047 4048 4049 4050 4051 4052 4053
    env->regwptr[9] = env->pc;
    env->regwptr[10] = env->npc;
    env->psrps = env->psrs;
    env->psrs = 1;
    env->tbr = (env->tbr & TBR_BASE_MASK) | (intno << 4);
    env->pc = env->tbr;
    env->npc = env->pc + 4;
4054
    env->exception_index = -1;
4055
}
B
blueswir1 已提交
4056
#endif
4057

4058
#if !defined(CONFIG_USER_ONLY)
4059

4060 4061 4062
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
                                void *retaddr);

4063
#define MMUSUFFIX _mmu
4064
#define ALIGNED_ONLY
4065 4066 4067 4068 4069 4070 4071 4072 4073 4074 4075 4076 4077

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

4078 4079 4080 4081 4082 4083 4084 4085 4086 4087 4088 4089 4090 4091 4092 4093 4094 4095
/* 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);
        }
    }
}

4096 4097 4098
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
                                void *retaddr)
{
B
blueswir1 已提交
4099
#ifdef DEBUG_UNALIGNED
4100 4101
    printf("Unaligned access to 0x" TARGET_FMT_lx " from 0x" TARGET_FMT_lx
           "\n", addr, env->pc);
B
blueswir1 已提交
4102
#endif
4103
    cpu_restore_state2(retaddr);
B
blueswir1 已提交
4104
    raise_exception(TT_UNALIGNED);
4105
}
4106 4107 4108 4109 4110

/* 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 */
4111
void tlb_fill(target_ulong addr, int is_write, int mmu_idx, void *retaddr)
4112 4113 4114 4115 4116 4117 4118 4119 4120
{
    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;

4121
    ret = cpu_sparc_handle_mmu_fault(env, addr, is_write, mmu_idx, 1);
4122
    if (ret) {
4123
        cpu_restore_state2(retaddr);
4124 4125 4126 4127 4128
        cpu_loop_exit();
    }
    env = saved_env;
}

P
Paul Brook 已提交
4129
#endif /* !CONFIG_USER_ONLY */
4130 4131

#ifndef TARGET_SPARC64
P
Paul Brook 已提交
4132
#if !defined(CONFIG_USER_ONLY)
A
Anthony Liguori 已提交
4133
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
4134
                          int is_asi, int size)
4135 4136
{
    CPUState *saved_env;
4137
    int fault_type;
4138 4139 4140 4141 4142

    /* XXX: hack to restore env in all cases, even if not called from
       generated code */
    saved_env = env;
    env = cpu_single_env;
4143 4144
#ifdef DEBUG_UNASSIGNED
    if (is_asi)
4145
        printf("Unassigned mem %s access of %d byte%s to " TARGET_FMT_plx
B
blueswir1 已提交
4146
               " asi 0x%02x from " TARGET_FMT_lx "\n",
4147 4148
               is_exec ? "exec" : is_write ? "write" : "read", size,
               size == 1 ? "" : "s", addr, is_asi, env->pc);
4149
    else
4150 4151 4152 4153
        printf("Unassigned mem %s access of %d byte%s to " TARGET_FMT_plx
               " from " TARGET_FMT_lx "\n",
               is_exec ? "exec" : is_write ? "write" : "read", size,
               size == 1 ? "" : "s", addr, env->pc);
4154
#endif
4155 4156 4157 4158 4159 4160 4161 4162 4163 4164 4165 4166 4167 4168 4169 4170 4171 4172 4173 4174 4175 4176 4177
    /* Don't overwrite translation and access faults */
    fault_type = (env->mmuregs[3] & 0x1c) >> 2;
    if ((fault_type > 4) || (fault_type == 0)) {
        env->mmuregs[3] = 0; /* Fault status register */
        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;
        /* SuperSPARC will never place instruction fault addresses in the FAR */
        if (!is_exec) {
            env->mmuregs[4] = addr; /* Fault address register */
        }
    }
    /* overflow (same type fault was not read before another fault) */
    if (fault_type == ((env->mmuregs[3] & 0x1c)) >> 2) {
        env->mmuregs[3] |= 1;
    }

4178
    if ((env->mmuregs[0] & MMU_E) && !(env->mmuregs[0] & MMU_NF)) {
4179 4180 4181 4182
        if (is_exec)
            raise_exception(TT_CODE_ACCESS);
        else
            raise_exception(TT_DATA_ACCESS);
4183
    }
4184 4185 4186 4187 4188 4189

    /* flush neverland mappings created during no-fault mode,
       so the sequential MMU faults report proper fault types */
    if (env->mmuregs[0] & MMU_NF) {
        tlb_flush(env, 1);
    }
4190 4191

    env = saved_env;
4192
}
P
Paul Brook 已提交
4193 4194 4195 4196 4197
#endif
#else
#if defined(CONFIG_USER_ONLY)
static void do_unassigned_access(target_ulong addr, int is_write, int is_exec,
                          int is_asi, int size)
4198
#else
A
Anthony Liguori 已提交
4199
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
4200
                          int is_asi, int size)
P
Paul Brook 已提交
4201
#endif
4202 4203 4204 4205 4206 4207 4208
{
    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;
4209 4210

#ifdef DEBUG_UNASSIGNED
B
blueswir1 已提交
4211 4212
    printf("Unassigned mem access to " TARGET_FMT_plx " from " TARGET_FMT_lx
           "\n", addr, env->pc);
4213
#endif
4214

4215 4216 4217 4218
    if (is_exec)
        raise_exception(TT_CODE_ACCESS);
    else
        raise_exception(TT_DATA_ACCESS);
4219 4220

    env = saved_env;
4221 4222
}
#endif
4223

P
Paul Brook 已提交
4224

B
blueswir1 已提交
4225 4226 4227 4228 4229 4230 4231 4232 4233 4234 4235 4236 4237 4238 4239 4240 4241 4242 4243 4244 4245 4246 4247 4248
#ifdef TARGET_SPARC64
void helper_tick_set_count(void *opaque, uint64_t count)
{
#if !defined(CONFIG_USER_ONLY)
    cpu_tick_set_count(opaque, count);
#endif
}

uint64_t helper_tick_get_count(void *opaque)
{
#if !defined(CONFIG_USER_ONLY)
    return cpu_tick_get_count(opaque);
#else
    return 0;
#endif
}

void helper_tick_set_limit(void *opaque, uint64_t limit)
{
#if !defined(CONFIG_USER_ONLY)
    cpu_tick_set_limit(opaque, limit);
#endif
}
#endif