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

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

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

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

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

B
blueswir1 已提交
35 36 37
#ifdef TARGET_SPARC64
#ifndef TARGET_ABI32
#define AM_CHECK(env1) ((env1)->pstate & PS_AM)
38
#else
B
blueswir1 已提交
39 40
#define AM_CHECK(env1) (1)
#endif
41 42
#endif

B
blueswir1 已提交
43 44 45 46 47 48 49 50
static inline void address_mask(CPUState *env1, target_ulong *addr)
{
#ifdef TARGET_SPARC64
    if (AM_CHECK(env1))
        *addr &= 0xffffffffULL;
#endif
}

B
bellard 已提交
51 52 53 54
void raise_exception(int tt)
{
    env->exception_index = tt;
    cpu_loop_exit();
55
}
B
bellard 已提交
56

B
blueswir1 已提交
57
void helper_trap(target_ulong nb_trap)
58
{
B
blueswir1 已提交
59 60 61 62 63 64 65 66 67 68 69 70
    env->exception_index = TT_TRAP + (nb_trap & 0x7f);
    cpu_loop_exit();
}

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

B
blueswir1 已提交
71 72 73 74 75
static inline void set_cwp(int new_cwp)
{
    cpu_set_cwp(env, new_cwp);
}

B
blueswir1 已提交
76 77
void helper_check_align(target_ulong addr, uint32_t align)
{
78 79 80 81 82
    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 已提交
83
        raise_exception(TT_UNALIGNED);
84
    }
B
blueswir1 已提交
85 86
}

87 88 89
#define F_HELPER(name, p) void helper_f##name##p(void)

#define F_BINOP(name)                                           \
B
blueswir1 已提交
90
    float32 helper_f ## name ## s (float32 src1, float32 src2)  \
91
    {                                                           \
B
blueswir1 已提交
92
        return float32_ ## name (src1, src2, &env->fp_status);  \
93 94 95 96
    }                                                           \
    F_HELPER(name, d)                                           \
    {                                                           \
        DT0 = float64_ ## name (DT0, DT1, &env->fp_status);     \
B
blueswir1 已提交
97 98 99 100
    }                                                           \
    F_HELPER(name, q)                                           \
    {                                                           \
        QT0 = float128_ ## name (QT0, QT1, &env->fp_status);    \
101 102 103 104 105 106 107 108
    }

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

109
void helper_fsmuld(float32 src1, float32 src2)
B
blueswir1 已提交
110
{
111 112
    DT0 = float64_mul(float32_to_float64(src1, &env->fp_status),
                      float32_to_float64(src2, &env->fp_status),
113 114
                      &env->fp_status);
}
B
blueswir1 已提交
115

B
blueswir1 已提交
116 117 118 119 120 121 122
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 已提交
123
float32 helper_fnegs(float32 src)
124
{
B
blueswir1 已提交
125
    return float32_chs(src);
126 127
}

128 129
#ifdef TARGET_SPARC64
F_HELPER(neg, d)
130
{
131
    DT0 = float64_chs(DT1);
132
}
B
blueswir1 已提交
133 134 135 136 137 138

F_HELPER(neg, q)
{
    QT0 = float128_chs(QT1);
}
#endif
139 140

/* Integer to float conversion.  */
B
blueswir1 已提交
141
float32 helper_fitos(int32_t src)
B
bellard 已提交
142
{
B
blueswir1 已提交
143
    return int32_to_float32(src, &env->fp_status);
B
bellard 已提交
144 145
}

146
void helper_fitod(int32_t src)
B
bellard 已提交
147
{
148
    DT0 = int32_to_float64(src, &env->fp_status);
B
bellard 已提交
149
}
150

151
void helper_fitoq(int32_t src)
B
blueswir1 已提交
152
{
153
    QT0 = int32_to_float128(src, &env->fp_status);
B
blueswir1 已提交
154 155
}

B
blueswir1 已提交
156
#ifdef TARGET_SPARC64
157
float32 helper_fxtos(void)
B
blueswir1 已提交
158
{
159
    return int64_to_float32(*((int64_t *)&DT1), &env->fp_status);
B
blueswir1 已提交
160 161
}

162
F_HELPER(xto, d)
B
blueswir1 已提交
163 164 165
{
    DT0 = int64_to_float64(*((int64_t *)&DT1), &env->fp_status);
}
B
blueswir1 已提交
166

B
blueswir1 已提交
167 168 169 170 171
F_HELPER(xto, q)
{
    QT0 = int64_to_float128(*((int64_t *)&DT1), &env->fp_status);
}
#endif
172 173 174
#undef F_HELPER

/* floating point conversion */
175
float32 helper_fdtos(void)
176
{
177
    return float64_to_float32(DT1, &env->fp_status);
178 179
}

180
void helper_fstod(float32 src)
181
{
182
    DT0 = float32_to_float64(src, &env->fp_status);
183
}
184

185
float32 helper_fqtos(void)
B
blueswir1 已提交
186
{
187
    return float128_to_float32(QT1, &env->fp_status);
B
blueswir1 已提交
188 189
}

190
void helper_fstoq(float32 src)
B
blueswir1 已提交
191
{
192
    QT0 = float32_to_float128(src, &env->fp_status);
B
blueswir1 已提交
193 194 195 196 197 198 199 200 201 202 203 204
}

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

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

205
/* Float to integer conversion.  */
B
blueswir1 已提交
206
int32_t helper_fstoi(float32 src)
207
{
B
blueswir1 已提交
208
    return float32_to_int32_round_to_zero(src, &env->fp_status);
209 210
}

211
int32_t helper_fdtoi(void)
212
{
213
    return float64_to_int32_round_to_zero(DT1, &env->fp_status);
214 215
}

216
int32_t helper_fqtoi(void)
B
blueswir1 已提交
217
{
218
    return float128_to_int32_round_to_zero(QT1, &env->fp_status);
B
blueswir1 已提交
219 220
}

221
#ifdef TARGET_SPARC64
222
void helper_fstox(float32 src)
223
{
224
    *((int64_t *)&DT0) = float32_to_int64_round_to_zero(src, &env->fp_status);
225 226 227 228 229 230 231
}

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

B
blueswir1 已提交
232 233 234 235 236
void helper_fqtox(void)
{
    *((int64_t *)&DT0) = float128_to_int64_round_to_zero(QT1, &env->fp_status);
}

237 238 239 240 241
void helper_faligndata(void)
{
    uint64_t tmp;

    tmp = (*((uint64_t *)&DT0)) << ((env->gsr & 7) * 8);
B
blueswir1 已提交
242 243 244 245
    /* on many architectures a shift of 64 does nothing */
    if ((env->gsr & 7) != 0) {
        tmp |= (*((uint64_t *)&DT1)) >> (64 - (env->gsr & 7) * 8);
    }
246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489
    *((uint64_t *)&DT0) = tmp;
}

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

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

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

void helper_fpmerge(void)
{
    vis64 s, d;

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

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

    DT0 = d.d;
}

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

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

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

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

    DT0 = d.d;
}

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

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

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

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

    DT0 = d.d;
}

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

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

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

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

    DT0 = d.d;
}

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

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

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

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

    DT0 = d.d;
}

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

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

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

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

    DT0 = d.d;
}

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

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

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

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

    DT0 = d.d;
}

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

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

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

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

    DT0 = d.d;
}

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

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

    DT0 = d.d;
}

#define VIS_HELPER(name, F)                             \
    void name##16(void)                                 \
    {                                                   \
        vis64 s, d;                                     \
                                                        \
        s.d = DT0;                                      \
        d.d = DT1;                                      \
                                                        \
        d.VIS_W64(0) = F(d.VIS_W64(0), s.VIS_W64(0));   \
        d.VIS_W64(1) = F(d.VIS_W64(1), s.VIS_W64(1));   \
        d.VIS_W64(2) = F(d.VIS_W64(2), s.VIS_W64(2));   \
        d.VIS_W64(3) = F(d.VIS_W64(3), s.VIS_W64(3));   \
                                                        \
        DT0 = d.d;                                      \
    }                                                   \
                                                        \
B
blueswir1 已提交
490
    uint32_t name##16s(uint32_t src1, uint32_t src2)    \
491 492 493
    {                                                   \
        vis32 s, d;                                     \
                                                        \
B
blueswir1 已提交
494 495
        s.l = src1;                                     \
        d.l = src2;                                     \
496 497 498 499
                                                        \
        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 已提交
500
        return d.l;                                     \
501 502 503 504 505 506 507 508 509 510 511 512 513 514 515
    }                                                   \
                                                        \
    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 已提交
516
    uint32_t name##32s(uint32_t src1, uint32_t src2)    \
517 518 519
    {                                                   \
        vis32 s, d;                                     \
                                                        \
B
blueswir1 已提交
520 521
        s.l = src1;                                     \
        d.l = src2;                                     \
522 523 524
                                                        \
        d.l = F(d.l, s.l);                              \
                                                        \
B
blueswir1 已提交
525
        return d.l;                                     \
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
    }

#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 已提交
607
float32 helper_fabss(float32 src)
608
{
B
blueswir1 已提交
609
    return float32_abs(src);
610 611
}

B
bellard 已提交
612
#ifdef TARGET_SPARC64
613
void helper_fabsd(void)
B
bellard 已提交
614 615 616
{
    DT0 = float64_abs(DT1);
}
B
blueswir1 已提交
617 618 619 620 621 622

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

B
blueswir1 已提交
624
float32 helper_fsqrts(float32 src)
625
{
B
blueswir1 已提交
626
    return float32_sqrt(src, &env->fp_status);
627 628
}

629
void helper_fsqrtd(void)
630
{
B
bellard 已提交
631
    DT0 = float64_sqrt(DT1, &env->fp_status);
632 633
}

B
blueswir1 已提交
634 635 636 637 638
void helper_fsqrtq(void)
{
    QT0 = float128_sqrt(QT1, &env->fp_status);
}

639
#define GEN_FCMP(name, size, reg1, reg2, FS, TRAP)                      \
640
    void glue(helper_, name) (void)                                     \
B
bellard 已提交
641
    {                                                                   \
B
blueswir1 已提交
642 643
        target_ulong new_fsr;                                           \
                                                                        \
B
bellard 已提交
644 645 646
        env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                     \
        switch (glue(size, _compare) (reg1, reg2, &env->fp_status)) {   \
        case float_relation_unordered:                                  \
B
blueswir1 已提交
647
            new_fsr = (FSR_FCC1 | FSR_FCC0) << FS;                      \
648
            if ((env->fsr & FSR_NVM) || TRAP) {                         \
B
blueswir1 已提交
649
                env->fsr |= new_fsr;                                    \
650 651
                env->fsr |= FSR_NVC;                                    \
                env->fsr |= FSR_FTT_IEEE_EXCP;                          \
B
bellard 已提交
652 653 654 655 656 657
                raise_exception(TT_FP_EXCP);                            \
            } else {                                                    \
                env->fsr |= FSR_NVA;                                    \
            }                                                           \
            break;                                                      \
        case float_relation_less:                                       \
B
blueswir1 已提交
658
            new_fsr = FSR_FCC0 << FS;                                   \
B
bellard 已提交
659 660
            break;                                                      \
        case float_relation_greater:                                    \
B
blueswir1 已提交
661
            new_fsr = FSR_FCC1 << FS;                                   \
B
bellard 已提交
662 663
            break;                                                      \
        default:                                                        \
B
blueswir1 已提交
664
            new_fsr = 0;                                                \
B
bellard 已提交
665 666
            break;                                                      \
        }                                                               \
B
blueswir1 已提交
667
        env->fsr |= new_fsr;                                            \
668
    }
B
blueswir1 已提交
669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698
#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;                                            \
    }
699

B
blueswir1 已提交
700
GEN_FCMPS(fcmps, float32, 0, 0);
701 702
GEN_FCMP(fcmpd, float64, DT0, DT1, 0, 0);

B
blueswir1 已提交
703
GEN_FCMPS(fcmpes, float32, 0, 1);
704
GEN_FCMP(fcmped, float64, DT0, DT1, 0, 1);
B
bellard 已提交
705

B
blueswir1 已提交
706 707 708
GEN_FCMP(fcmpq, float128, QT0, QT1, 0, 0);
GEN_FCMP(fcmpeq, float128, QT0, QT1, 0, 1);

B
bellard 已提交
709
#ifdef TARGET_SPARC64
B
blueswir1 已提交
710
GEN_FCMPS(fcmps_fcc1, float32, 22, 0);
711
GEN_FCMP(fcmpd_fcc1, float64, DT0, DT1, 22, 0);
B
blueswir1 已提交
712
GEN_FCMP(fcmpq_fcc1, float128, QT0, QT1, 22, 0);
713

B
blueswir1 已提交
714
GEN_FCMPS(fcmps_fcc2, float32, 24, 0);
715
GEN_FCMP(fcmpd_fcc2, float64, DT0, DT1, 24, 0);
B
blueswir1 已提交
716
GEN_FCMP(fcmpq_fcc2, float128, QT0, QT1, 24, 0);
717

B
blueswir1 已提交
718
GEN_FCMPS(fcmps_fcc3, float32, 26, 0);
719
GEN_FCMP(fcmpd_fcc3, float64, DT0, DT1, 26, 0);
B
blueswir1 已提交
720
GEN_FCMP(fcmpq_fcc3, float128, QT0, QT1, 26, 0);
721

B
blueswir1 已提交
722
GEN_FCMPS(fcmpes_fcc1, float32, 22, 1);
723
GEN_FCMP(fcmped_fcc1, float64, DT0, DT1, 22, 1);
B
blueswir1 已提交
724
GEN_FCMP(fcmpeq_fcc1, float128, QT0, QT1, 22, 1);
B
bellard 已提交
725

B
blueswir1 已提交
726
GEN_FCMPS(fcmpes_fcc2, float32, 24, 1);
727
GEN_FCMP(fcmped_fcc2, float64, DT0, DT1, 24, 1);
B
blueswir1 已提交
728
GEN_FCMP(fcmpeq_fcc2, float128, QT0, QT1, 24, 1);
B
bellard 已提交
729

B
blueswir1 已提交
730
GEN_FCMPS(fcmpes_fcc3, float32, 26, 1);
731
GEN_FCMP(fcmped_fcc3, float64, DT0, DT1, 26, 1);
B
blueswir1 已提交
732 733
GEN_FCMP(fcmpeq_fcc3, float128, QT0, QT1, 26, 1);
#endif
B
blueswir1 已提交
734
#undef GEN_FCMPS
B
bellard 已提交
735

B
blueswir1 已提交
736 737
#if !defined(TARGET_SPARC64) && !defined(CONFIG_USER_ONLY) && \
    defined(DEBUG_MXCC)
738 739 740
static void dump_mxcc(CPUState *env)
{
    printf("mxccdata: %016llx %016llx %016llx %016llx\n",
B
blueswir1 已提交
741 742
           env->mxccdata[0], env->mxccdata[1],
           env->mxccdata[2], env->mxccdata[3]);
743 744
    printf("mxccregs: %016llx %016llx %016llx %016llx\n"
           "          %016llx %016llx %016llx %016llx\n",
B
blueswir1 已提交
745 746 747 748
           env->mxccregs[0], env->mxccregs[1],
           env->mxccregs[2], env->mxccregs[3],
           env->mxccregs[4], env->mxccregs[5],
           env->mxccregs[6], env->mxccregs[7]);
749 750 751
}
#endif

B
blueswir1 已提交
752 753 754 755
#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)
756 757 758 759
{
    switch (size)
    {
    case 1:
B
blueswir1 已提交
760 761
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %02" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xff);
762 763
        break;
    case 2:
B
blueswir1 已提交
764 765
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %04" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xffff);
766 767
        break;
    case 4:
B
blueswir1 已提交
768 769
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %08" PRIx64 "\n", txt,
                    addr, asi, r1 & 0xffffffff);
770 771
        break;
    case 8:
B
blueswir1 已提交
772 773
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %016" PRIx64 "\n", txt,
                    addr, asi, r1);
774 775 776 777 778
        break;
    }
}
#endif

B
blueswir1 已提交
779 780 781
#ifndef TARGET_SPARC64
#ifndef CONFIG_USER_ONLY
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
782
{
B
blueswir1 已提交
783
    uint64_t ret = 0;
784
#if defined(DEBUG_MXCC) || defined(DEBUG_ASI)
B
blueswir1 已提交
785
    uint32_t last_addr = addr;
786
#endif
B
bellard 已提交
787

788
    helper_check_align(addr, size - 1);
B
bellard 已提交
789
    switch (asi) {
790
    case 2: /* SuperSparc MXCC registers */
B
blueswir1 已提交
791
        switch (addr) {
792
        case 0x01c00a00: /* MXCC control register */
B
blueswir1 已提交
793 794 795
            if (size == 8)
                ret = env->mxccregs[3];
            else
B
blueswir1 已提交
796 797
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
798 799 800 801 802
            break;
        case 0x01c00a04: /* MXCC control register */
            if (size == 4)
                ret = env->mxccregs[3];
            else
B
blueswir1 已提交
803 804
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
805
            break;
806 807
        case 0x01c00c00: /* Module reset register */
            if (size == 8) {
B
blueswir1 已提交
808
                ret = env->mxccregs[5];
809 810
                // should we do something here?
            } else
B
blueswir1 已提交
811 812
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
813
            break;
814
        case 0x01c00f00: /* MBus port address register */
B
blueswir1 已提交
815 816 817
            if (size == 8)
                ret = env->mxccregs[7];
            else
B
blueswir1 已提交
818 819
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
820 821
            break;
        default:
B
blueswir1 已提交
822 823
            DPRINTF_MXCC("%08x: unimplemented address, size: %d\n", addr,
                         size);
824 825
            break;
        }
B
blueswir1 已提交
826 827
        DPRINTF_MXCC("asi = %d, size = %d, sign = %d, "
                     "addr = %08x -> ret = %08x,"
B
blueswir1 已提交
828
                     "addr = %08x\n", asi, size, sign, last_addr, ret, addr);
829 830 831
#ifdef DEBUG_MXCC
        dump_mxcc(env);
#endif
832
        break;
833
    case 3: /* MMU probe */
B
blueswir1 已提交
834 835 836
        {
            int mmulev;

B
blueswir1 已提交
837
            mmulev = (addr >> 8) & 15;
B
blueswir1 已提交
838 839
            if (mmulev > 4)
                ret = 0;
B
blueswir1 已提交
840 841 842 843
            else
                ret = mmu_probe(env, addr, mmulev);
            DPRINTF_MMU("mmu_probe: 0x%08x (lev %d) -> 0x%08" PRIx64 "\n",
                        addr, mmulev, ret);
B
blueswir1 已提交
844 845
        }
        break;
846
    case 4: /* read MMU regs */
B
blueswir1 已提交
847
        {
B
blueswir1 已提交
848
            int reg = (addr >> 8) & 0x1f;
849

B
blueswir1 已提交
850 851
            ret = env->mmuregs[reg];
            if (reg == 3) /* Fault status cleared on read */
B
blueswir1 已提交
852 853 854 855 856
                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 已提交
857
            DPRINTF_MMU("mmu_read: reg[%d] = 0x%08" PRIx64 "\n", reg, ret);
B
blueswir1 已提交
858 859
        }
        break;
B
blueswir1 已提交
860 861 862 863
    case 5: // Turbosparc ITLB Diagnostic
    case 6: // Turbosparc DTLB Diagnostic
    case 7: // Turbosparc IOTLB Diagnostic
        break;
864 865 866
    case 9: /* Supervisor code access */
        switch(size) {
        case 1:
B
blueswir1 已提交
867
            ret = ldub_code(addr);
868 869
            break;
        case 2:
870
            ret = lduw_code(addr);
871 872 873
            break;
        default:
        case 4:
874
            ret = ldl_code(addr);
875 876
            break;
        case 8:
877
            ret = ldq_code(addr);
878 879 880
            break;
        }
        break;
881 882 883
    case 0xa: /* User data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
884
            ret = ldub_user(addr);
885 886
            break;
        case 2:
887
            ret = lduw_user(addr);
888 889 890
            break;
        default:
        case 4:
891
            ret = ldl_user(addr);
892 893
            break;
        case 8:
894
            ret = ldq_user(addr);
895 896 897 898 899 900
            break;
        }
        break;
    case 0xb: /* Supervisor data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
901
            ret = ldub_kernel(addr);
902 903
            break;
        case 2:
904
            ret = lduw_kernel(addr);
905 906 907
            break;
        default:
        case 4:
908
            ret = ldl_kernel(addr);
909 910
            break;
        case 8:
911
            ret = ldq_kernel(addr);
912 913 914
            break;
        }
        break;
915 916 917 918 919 920
    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 已提交
921 922
        switch(size) {
        case 1:
B
blueswir1 已提交
923
            ret = ldub_phys(addr);
B
bellard 已提交
924 925
            break;
        case 2:
926
            ret = lduw_phys(addr);
B
bellard 已提交
927 928 929
            break;
        default:
        case 4:
930
            ret = ldl_phys(addr);
B
bellard 已提交
931
            break;
B
bellard 已提交
932
        case 8:
933
            ret = ldq_phys(addr);
B
blueswir1 已提交
934
            break;
B
bellard 已提交
935
        }
B
blueswir1 已提交
936
        break;
937
    case 0x21 ... 0x2f: /* MMU passthrough, 0x100000000 to 0xfffffffff */
938 939
        switch(size) {
        case 1:
B
blueswir1 已提交
940
            ret = ldub_phys((target_phys_addr_t)addr
941 942 943
                            | ((target_phys_addr_t)(asi & 0xf) << 32));
            break;
        case 2:
944
            ret = lduw_phys((target_phys_addr_t)addr
945 946 947 948
                            | ((target_phys_addr_t)(asi & 0xf) << 32));
            break;
        default:
        case 4:
949
            ret = ldl_phys((target_phys_addr_t)addr
950 951 952
                           | ((target_phys_addr_t)(asi & 0xf) << 32));
            break;
        case 8:
953
            ret = ldq_phys((target_phys_addr_t)addr
954
                           | ((target_phys_addr_t)(asi & 0xf) << 32));
B
blueswir1 已提交
955
            break;
956
        }
B
blueswir1 已提交
957
        break;
B
blueswir1 已提交
958 959 960
    case 0x30: // Turbosparc secondary cache diagnostic
    case 0x31: // Turbosparc RAM snoop
    case 0x32: // Turbosparc page table descriptor diagnostic
B
blueswir1 已提交
961 962 963
    case 0x39: /* data cache diagnostic register */
        ret = 0;
        break;
B
blueswir1 已提交
964
    case 8: /* User code access, XXX */
965
    default:
B
blueswir1 已提交
966
        do_unassigned_access(addr, 0, 0, asi);
B
blueswir1 已提交
967 968
        ret = 0;
        break;
969
    }
970 971 972
    if (sign) {
        switch(size) {
        case 1:
B
blueswir1 已提交
973
            ret = (int8_t) ret;
B
blueswir1 已提交
974
            break;
975
        case 2:
B
blueswir1 已提交
976 977 978 979
            ret = (int16_t) ret;
            break;
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
980
            break;
981 982 983 984
        default:
            break;
        }
    }
985
#ifdef DEBUG_ASI
B
blueswir1 已提交
986
    dump_asi("read ", last_addr, asi, size, ret);
987
#endif
B
blueswir1 已提交
988
    return ret;
989 990
}

B
blueswir1 已提交
991
void helper_st_asi(target_ulong addr, uint64_t val, int asi, int size)
992
{
993
    helper_check_align(addr, size - 1);
994
    switch(asi) {
995
    case 2: /* SuperSparc MXCC registers */
B
blueswir1 已提交
996
        switch (addr) {
997 998
        case 0x01c00000: /* MXCC stream data register 0 */
            if (size == 8)
B
blueswir1 已提交
999
                env->mxccdata[0] = val;
1000
            else
B
blueswir1 已提交
1001 1002
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1003 1004 1005
            break;
        case 0x01c00008: /* MXCC stream data register 1 */
            if (size == 8)
B
blueswir1 已提交
1006
                env->mxccdata[1] = val;
1007
            else
B
blueswir1 已提交
1008 1009
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1010 1011 1012
            break;
        case 0x01c00010: /* MXCC stream data register 2 */
            if (size == 8)
B
blueswir1 已提交
1013
                env->mxccdata[2] = val;
1014
            else
B
blueswir1 已提交
1015 1016
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1017 1018 1019
            break;
        case 0x01c00018: /* MXCC stream data register 3 */
            if (size == 8)
B
blueswir1 已提交
1020
                env->mxccdata[3] = val;
1021
            else
B
blueswir1 已提交
1022 1023
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1024 1025 1026
            break;
        case 0x01c00100: /* MXCC stream source */
            if (size == 8)
B
blueswir1 已提交
1027
                env->mxccregs[0] = val;
1028
            else
B
blueswir1 已提交
1029 1030 1031 1032 1033 1034 1035 1036 1037 1038
                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);
1039 1040 1041
            break;
        case 0x01c00200: /* MXCC stream destination */
            if (size == 8)
B
blueswir1 已提交
1042
                env->mxccregs[1] = val;
1043
            else
B
blueswir1 已提交
1044 1045 1046 1047 1048 1049 1050 1051 1052 1053
                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]);
1054 1055 1056
            break;
        case 0x01c00a00: /* MXCC control register */
            if (size == 8)
B
blueswir1 已提交
1057
                env->mxccregs[3] = val;
1058
            else
B
blueswir1 已提交
1059 1060
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1061 1062 1063
            break;
        case 0x01c00a04: /* MXCC control register */
            if (size == 4)
1064
                env->mxccregs[3] = (env->mxccregs[3] & 0xffffffff00000000ULL)
B
blueswir1 已提交
1065
                    | val;
1066
            else
B
blueswir1 已提交
1067 1068
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1069 1070
            break;
        case 0x01c00e00: /* MXCC error register  */
1071
            // writing a 1 bit clears the error
1072
            if (size == 8)
B
blueswir1 已提交
1073
                env->mxccregs[6] &= ~val;
1074
            else
B
blueswir1 已提交
1075 1076
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1077 1078 1079
            break;
        case 0x01c00f00: /* MBus port address register */
            if (size == 8)
B
blueswir1 已提交
1080
                env->mxccregs[7] = val;
1081
            else
B
blueswir1 已提交
1082 1083
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
                             size);
1084 1085
            break;
        default:
B
blueswir1 已提交
1086 1087
            DPRINTF_MXCC("%08x: unimplemented address, size: %d\n", addr,
                         size);
1088 1089
            break;
        }
B
blueswir1 已提交
1090 1091
        DPRINTF_MXCC("asi = %d, size = %d, addr = %08x, val = %08x\n", asi,
                     size, addr, val);
1092 1093 1094
#ifdef DEBUG_MXCC
        dump_mxcc(env);
#endif
1095
        break;
1096
    case 3: /* MMU flush */
B
blueswir1 已提交
1097 1098
        {
            int mmulev;
B
bellard 已提交
1099

B
blueswir1 已提交
1100
            mmulev = (addr >> 8) & 15;
1101
            DPRINTF_MMU("mmu flush level %d\n", mmulev);
B
blueswir1 已提交
1102 1103
            switch (mmulev) {
            case 0: // flush page
B
blueswir1 已提交
1104
                tlb_flush_page(env, addr & 0xfffff000);
B
blueswir1 已提交
1105 1106 1107 1108 1109 1110 1111 1112 1113 1114
                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 已提交
1115
#ifdef DEBUG_MMU
B
blueswir1 已提交
1116
            dump_mmu(env);
B
bellard 已提交
1117
#endif
B
blueswir1 已提交
1118
        }
1119
        break;
1120
    case 4: /* write MMU regs */
B
blueswir1 已提交
1121
        {
B
blueswir1 已提交
1122
            int reg = (addr >> 8) & 0x1f;
B
blueswir1 已提交
1123
            uint32_t oldreg;
1124

B
blueswir1 已提交
1125
            oldreg = env->mmuregs[reg];
B
bellard 已提交
1126
            switch(reg) {
1127
            case 0: // Control Register
B
blueswir1 已提交
1128
                env->mmuregs[reg] = (env->mmuregs[reg] & 0xff000000) |
B
blueswir1 已提交
1129
                                    (val & 0x00ffffff);
B
blueswir1 已提交
1130 1131
                // Mappings generated during no-fault mode or MMU
                // disabled mode are invalid in normal mode
1132 1133
                if ((oldreg & (MMU_E | MMU_NF | env->def->mmu_bm)) !=
                    (env->mmuregs[reg] & (MMU_E | MMU_NF | env->def->mmu_bm)))
B
bellard 已提交
1134 1135
                    tlb_flush(env, 1);
                break;
1136
            case 1: // Context Table Pointer Register
1137
                env->mmuregs[reg] = val & env->def->mmu_ctpr_mask;
1138 1139
                break;
            case 2: // Context Register
1140
                env->mmuregs[reg] = val & env->def->mmu_cxr_mask;
B
bellard 已提交
1141 1142 1143 1144 1145 1146
                if (oldreg != env->mmuregs[reg]) {
                    /* we flush when the MMU context changes because
                       QEMU has no MMU context support */
                    tlb_flush(env, 1);
                }
                break;
1147 1148 1149 1150
            case 3: // Synchronous Fault Status Register with Clear
            case 4: // Synchronous Fault Address Register
                break;
            case 0x10: // TLB Replacement Control Register
1151
                env->mmuregs[reg] = val & env->def->mmu_trcr_mask;
B
bellard 已提交
1152
                break;
1153
            case 0x13: // Synchronous Fault Status Register with Read and Clear
1154
                env->mmuregs[3] = val & env->def->mmu_sfsr_mask;
B
blueswir1 已提交
1155
                break;
1156
            case 0x14: // Synchronous Fault Address Register
B
blueswir1 已提交
1157
                env->mmuregs[4] = val;
B
blueswir1 已提交
1158
                break;
B
bellard 已提交
1159
            default:
B
blueswir1 已提交
1160
                env->mmuregs[reg] = val;
B
bellard 已提交
1161 1162 1163
                break;
            }
            if (oldreg != env->mmuregs[reg]) {
B
blueswir1 已提交
1164 1165
                DPRINTF_MMU("mmu change reg[%d]: 0x%08x -> 0x%08x\n",
                            reg, oldreg, env->mmuregs[reg]);
B
bellard 已提交
1166
            }
1167
#ifdef DEBUG_MMU
B
blueswir1 已提交
1168
            dump_mmu(env);
B
bellard 已提交
1169
#endif
B
blueswir1 已提交
1170
        }
1171
        break;
B
blueswir1 已提交
1172 1173 1174 1175
    case 5: // Turbosparc ITLB Diagnostic
    case 6: // Turbosparc DTLB Diagnostic
    case 7: // Turbosparc IOTLB Diagnostic
        break;
1176 1177 1178
    case 0xa: /* User data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
1179
            stb_user(addr, val);
1180 1181
            break;
        case 2:
1182
            stw_user(addr, val);
1183 1184 1185
            break;
        default:
        case 4:
1186
            stl_user(addr, val);
1187 1188
            break;
        case 8:
1189
            stq_user(addr, val);
1190 1191 1192 1193 1194 1195
            break;
        }
        break;
    case 0xb: /* Supervisor data access */
        switch(size) {
        case 1:
B
blueswir1 已提交
1196
            stb_kernel(addr, val);
1197 1198
            break;
        case 2:
1199
            stw_kernel(addr, val);
1200 1201 1202
            break;
        default:
        case 4:
1203
            stl_kernel(addr, val);
1204 1205
            break;
        case 8:
1206
            stq_kernel(addr, val);
1207 1208 1209
            break;
        }
        break;
1210 1211 1212 1213 1214 1215 1216 1217 1218 1219
    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 已提交
1220
    case 0x17: /* Block copy, sta access */
B
blueswir1 已提交
1221
        {
B
blueswir1 已提交
1222 1223
            // val = src
            // addr = dst
B
blueswir1 已提交
1224
            // copy 32 bytes
1225
            unsigned int i;
B
blueswir1 已提交
1226
            uint32_t src = val & ~3, dst = addr & ~3, temp;
1227

1228 1229 1230 1231
            for (i = 0; i < 32; i += 4, src += 4, dst += 4) {
                temp = ldl_kernel(src);
                stl_kernel(dst, temp);
            }
B
blueswir1 已提交
1232
        }
1233
        break;
B
bellard 已提交
1234
    case 0x1f: /* Block fill, stda access */
B
blueswir1 已提交
1235
        {
B
blueswir1 已提交
1236 1237
            // addr = dst
            // fill 32 bytes with val
1238
            unsigned int i;
B
blueswir1 已提交
1239
            uint32_t dst = addr & 7;
1240 1241 1242

            for (i = 0; i < 32; i += 8, dst += 8)
                stq_kernel(dst, val);
B
blueswir1 已提交
1243
        }
1244
        break;
1245
    case 0x20: /* MMU passthrough */
B
blueswir1 已提交
1246
        {
B
bellard 已提交
1247 1248
            switch(size) {
            case 1:
B
blueswir1 已提交
1249
                stb_phys(addr, val);
B
bellard 已提交
1250 1251
                break;
            case 2:
1252
                stw_phys(addr, val);
B
bellard 已提交
1253 1254 1255
                break;
            case 4:
            default:
1256
                stl_phys(addr, val);
B
bellard 已提交
1257
                break;
B
bellard 已提交
1258
            case 8:
1259
                stq_phys(addr, val);
B
bellard 已提交
1260
                break;
B
bellard 已提交
1261
            }
B
blueswir1 已提交
1262
        }
1263
        break;
B
blueswir1 已提交
1264
    case 0x21 ... 0x2f: /* MMU passthrough, 0x100000000 to 0xfffffffff */
B
blueswir1 已提交
1265
        {
1266 1267
            switch(size) {
            case 1:
B
blueswir1 已提交
1268 1269
                stb_phys((target_phys_addr_t)addr
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
1270 1271
                break;
            case 2:
1272
                stw_phys((target_phys_addr_t)addr
B
blueswir1 已提交
1273
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
1274 1275 1276
                break;
            case 4:
            default:
1277
                stl_phys((target_phys_addr_t)addr
B
blueswir1 已提交
1278
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
1279 1280
                break;
            case 8:
1281
                stq_phys((target_phys_addr_t)addr
B
blueswir1 已提交
1282
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
1283 1284
                break;
            }
B
blueswir1 已提交
1285
        }
1286
        break;
B
blueswir1 已提交
1287 1288 1289
    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 已提交
1290 1291
    case 0x32: // store buffer control or Turbosparc page table
               // descriptor diagnostic
1292 1293
    case 0x36: /* I-cache flash clear */
    case 0x37: /* D-cache flash clear */
B
blueswir1 已提交
1294 1295
    case 0x38: /* breakpoint diagnostics */
    case 0x4c: /* breakpoint action */
1296
        break;
B
blueswir1 已提交
1297
    case 8: /* User code access, XXX */
1298
    case 9: /* Supervisor code access, XXX */
1299
    default:
B
blueswir1 已提交
1300
        do_unassigned_access(addr, 1, 0, asi);
1301
        break;
1302
    }
1303
#ifdef DEBUG_ASI
B
blueswir1 已提交
1304
    dump_asi("write", addr, asi, size, val);
1305
#endif
1306 1307
}

1308 1309 1310 1311
#endif /* CONFIG_USER_ONLY */
#else /* TARGET_SPARC64 */

#ifdef CONFIG_USER_ONLY
B
blueswir1 已提交
1312
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
1313 1314
{
    uint64_t ret = 0;
B
blueswir1 已提交
1315 1316 1317
#if defined(DEBUG_ASI)
    target_ulong last_addr = addr;
#endif
1318 1319 1320 1321

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

1322
    helper_check_align(addr, size - 1);
B
blueswir1 已提交
1323
    address_mask(env, &addr);
1324

1325 1326 1327
    switch (asi) {
    case 0x82: // Primary no-fault
    case 0x8a: // Primary no-fault LE
B
blueswir1 已提交
1328 1329 1330 1331 1332 1333 1334 1335 1336
        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
1337 1338 1339
        {
            switch(size) {
            case 1:
B
blueswir1 已提交
1340
                ret = ldub_raw(addr);
1341 1342
                break;
            case 2:
1343
                ret = lduw_raw(addr);
1344 1345
                break;
            case 4:
1346
                ret = ldl_raw(addr);
1347 1348 1349
                break;
            default:
            case 8:
1350
                ret = ldq_raw(addr);
1351 1352 1353 1354 1355 1356
                break;
            }
        }
        break;
    case 0x83: // Secondary no-fault
    case 0x8b: // Secondary no-fault LE
B
blueswir1 已提交
1357 1358 1359 1360 1361 1362 1363 1364 1365
        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
1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380
        // 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 已提交
1381
            break;
1382 1383
        case 4:
            ret = bswap32(ret);
B
blueswir1 已提交
1384
            break;
1385 1386
        case 8:
            ret = bswap64(ret);
B
blueswir1 已提交
1387
            break;
1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399
        default:
            break;
        }
    default:
        break;
    }

    /* Convert to signed number */
    if (sign) {
        switch(size) {
        case 1:
            ret = (int8_t) ret;
B
blueswir1 已提交
1400
            break;
1401 1402
        case 2:
            ret = (int16_t) ret;
B
blueswir1 已提交
1403
            break;
1404 1405
        case 4:
            ret = (int32_t) ret;
B
blueswir1 已提交
1406
            break;
1407 1408 1409 1410
        default:
            break;
        }
    }
B
blueswir1 已提交
1411 1412 1413 1414
#ifdef DEBUG_ASI
    dump_asi("read ", last_addr, asi, size, ret);
#endif
    return ret;
1415 1416
}

B
blueswir1 已提交
1417
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
1418
{
B
blueswir1 已提交
1419 1420 1421
#ifdef DEBUG_ASI
    dump_asi("write", addr, asi, size, val);
#endif
1422 1423 1424
    if (asi < 0x80)
        raise_exception(TT_PRIV_ACT);

1425
    helper_check_align(addr, size - 1);
B
blueswir1 已提交
1426
    address_mask(env, &addr);
1427

1428 1429 1430 1431 1432 1433
    /* Convert to little endian */
    switch (asi) {
    case 0x88: // Primary LE
    case 0x89: // Secondary LE
        switch(size) {
        case 2:
B
blueswir1 已提交
1434
            addr = bswap16(addr);
B
blueswir1 已提交
1435
            break;
1436
        case 4:
B
blueswir1 已提交
1437
            addr = bswap32(addr);
B
blueswir1 已提交
1438
            break;
1439
        case 8:
B
blueswir1 已提交
1440
            addr = bswap64(addr);
B
blueswir1 已提交
1441
            break;
1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454
        default:
            break;
        }
    default:
        break;
    }

    switch(asi) {
    case 0x80: // Primary
    case 0x88: // Primary LE
        {
            switch(size) {
            case 1:
B
blueswir1 已提交
1455
                stb_raw(addr, val);
1456 1457
                break;
            case 2:
1458
                stw_raw(addr, val);
1459 1460
                break;
            case 4:
1461
                stl_raw(addr, val);
1462 1463 1464
                break;
            case 8:
            default:
1465
                stq_raw(addr, val);
1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479
                break;
            }
        }
        break;
    case 0x81: // Secondary
    case 0x89: // Secondary LE
        // XXX
        return;

    case 0x82: // Primary no-fault, RO
    case 0x83: // Secondary no-fault, RO
    case 0x8a: // Primary no-fault LE, RO
    case 0x8b: // Secondary no-fault LE, RO
    default:
B
blueswir1 已提交
1480
        do_unassigned_access(addr, 1, 0, 1);
1481 1482 1483 1484 1485
        return;
    }
}

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

B
blueswir1 已提交
1487
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
B
bellard 已提交
1488
{
B
bellard 已提交
1489
    uint64_t ret = 0;
B
blueswir1 已提交
1490 1491 1492
#if defined(DEBUG_ASI)
    target_ulong last_addr = addr;
#endif
B
bellard 已提交
1493

B
blueswir1 已提交
1494
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
1495 1496
        || ((env->def->features & CPU_FEATURE_HYPV)
            && asi >= 0x30 && asi < 0x80
1497
            && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
1498
        raise_exception(TT_PRIV_ACT);
B
bellard 已提交
1499

1500
    helper_check_align(addr, size - 1);
B
bellard 已提交
1501
    switch (asi) {
B
blueswir1 已提交
1502 1503 1504 1505 1506 1507 1508 1509 1510
    case 0x82: // Primary no-fault
    case 0x8a: // Primary no-fault LE
        if (cpu_get_phys_page_debug(env, addr) == -1ULL) {
#ifdef DEBUG_ASI
            dump_asi("read ", last_addr, asi, size, ret);
#endif
            return 0;
        }
        // Fall through
1511 1512 1513 1514 1515
    case 0x10: // As if user primary
    case 0x18: // As if user primary LE
    case 0x80: // Primary
    case 0x88: // Primary LE
        if ((asi & 0x80) && (env->pstate & PS_PRIV)) {
1516 1517
            if ((env->def->features & CPU_FEATURE_HYPV)
                && env->hpstate & HS_PRIV) {
B
blueswir1 已提交
1518 1519
                switch(size) {
                case 1:
B
blueswir1 已提交
1520
                    ret = ldub_hypv(addr);
B
blueswir1 已提交
1521 1522
                    break;
                case 2:
1523
                    ret = lduw_hypv(addr);
B
blueswir1 已提交
1524 1525
                    break;
                case 4:
1526
                    ret = ldl_hypv(addr);
B
blueswir1 已提交
1527 1528 1529
                    break;
                default:
                case 8:
1530
                    ret = ldq_hypv(addr);
B
blueswir1 已提交
1531 1532 1533 1534 1535
                    break;
                }
            } else {
                switch(size) {
                case 1:
B
blueswir1 已提交
1536
                    ret = ldub_kernel(addr);
B
blueswir1 已提交
1537 1538
                    break;
                case 2:
1539
                    ret = lduw_kernel(addr);
B
blueswir1 已提交
1540 1541
                    break;
                case 4:
1542
                    ret = ldl_kernel(addr);
B
blueswir1 已提交
1543 1544 1545
                    break;
                default:
                case 8:
1546
                    ret = ldq_kernel(addr);
B
blueswir1 已提交
1547 1548
                    break;
                }
1549 1550 1551 1552
            }
        } else {
            switch(size) {
            case 1:
B
blueswir1 已提交
1553
                ret = ldub_user(addr);
1554 1555
                break;
            case 2:
1556
                ret = lduw_user(addr);
1557 1558
                break;
            case 4:
1559
                ret = ldl_user(addr);
1560 1561 1562
                break;
            default:
            case 8:
1563
                ret = ldq_user(addr);
1564 1565 1566 1567
                break;
            }
        }
        break;
B
bellard 已提交
1568 1569
    case 0x14: // Bypass
    case 0x15: // Bypass, non-cacheable
1570 1571
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
B
blueswir1 已提交
1572
        {
B
bellard 已提交
1573 1574
            switch(size) {
            case 1:
B
blueswir1 已提交
1575
                ret = ldub_phys(addr);
B
bellard 已提交
1576 1577
                break;
            case 2:
1578
                ret = lduw_phys(addr);
B
bellard 已提交
1579 1580
                break;
            case 4:
1581
                ret = ldl_phys(addr);
B
bellard 已提交
1582 1583 1584
                break;
            default:
            case 8:
1585
                ret = ldq_phys(addr);
B
bellard 已提交
1586 1587
                break;
            }
B
blueswir1 已提交
1588 1589
            break;
        }
B
blueswir1 已提交
1590 1591 1592 1593 1594
    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
blueswir1 已提交
1595 1596 1597 1598 1599 1600 1601 1602 1603
    case 0x83: // Secondary no-fault
    case 0x8b: // Secondary no-fault LE
        if (cpu_get_phys_page_debug(env, addr) == -1ULL) {
#ifdef DEBUG_ASI
            dump_asi("read ", last_addr, asi, size, ret);
#endif
            return 0;
        }
        // Fall through
B
bellard 已提交
1604 1605 1606 1607 1608
    case 0x04: // Nucleus
    case 0x0c: // Nucleus Little Endian (LE)
    case 0x11: // As if user secondary
    case 0x19: // As if user secondary LE
    case 0x4a: // UPA config
1609
    case 0x81: // Secondary
B
bellard 已提交
1610
    case 0x89: // Secondary LE
B
blueswir1 已提交
1611 1612
        // XXX
        break;
B
bellard 已提交
1613
    case 0x45: // LSU
B
blueswir1 已提交
1614 1615
        ret = env->lsu;
        break;
B
bellard 已提交
1616
    case 0x50: // I-MMU regs
B
blueswir1 已提交
1617
        {
B
blueswir1 已提交
1618
            int reg = (addr >> 3) & 0xf;
B
bellard 已提交
1619

B
blueswir1 已提交
1620 1621 1622
            ret = env->immuregs[reg];
            break;
        }
B
bellard 已提交
1623 1624
    case 0x51: // I-MMU 8k TSB pointer
    case 0x52: // I-MMU 64k TSB pointer
B
blueswir1 已提交
1625 1626
        // XXX
        break;
1627 1628 1629 1630 1631 1632 1633
    case 0x55: // I-MMU data access
        {
            int reg = (addr >> 3) & 0x3f;

            ret = env->itlb_tte[reg];
            break;
        }
B
bellard 已提交
1634
    case 0x56: // I-MMU tag read
B
blueswir1 已提交
1635
        {
B
blueswir1 已提交
1636
            int reg = (addr >> 3) & 0x3f;
B
blueswir1 已提交
1637

B
blueswir1 已提交
1638
            ret = env->itlb_tag[reg];
B
blueswir1 已提交
1639 1640
            break;
        }
B
bellard 已提交
1641
    case 0x58: // D-MMU regs
B
blueswir1 已提交
1642
        {
B
blueswir1 已提交
1643
            int reg = (addr >> 3) & 0xf;
B
bellard 已提交
1644

B
blueswir1 已提交
1645 1646 1647
            ret = env->dmmuregs[reg];
            break;
        }
1648 1649 1650 1651 1652 1653 1654
    case 0x5d: // D-MMU data access
        {
            int reg = (addr >> 3) & 0x3f;

            ret = env->dtlb_tte[reg];
            break;
        }
B
bellard 已提交
1655
    case 0x5e: // D-MMU tag read
B
blueswir1 已提交
1656
        {
B
blueswir1 已提交
1657
            int reg = (addr >> 3) & 0x3f;
B
blueswir1 已提交
1658

B
blueswir1 已提交
1659
            ret = env->dtlb_tag[reg];
B
blueswir1 已提交
1660 1661
            break;
        }
1662 1663
    case 0x46: // D-cache data
    case 0x47: // D-cache tag access
1664 1665 1666
    case 0x4b: // E-cache error enable
    case 0x4c: // E-cache asynchronous fault status
    case 0x4d: // E-cache asynchronous fault address
1667 1668 1669 1670 1671 1672 1673 1674
    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 已提交
1675 1676 1677
    case 0x59: // D-MMU 8k TSB pointer
    case 0x5a: // D-MMU 64k TSB pointer
    case 0x5b: // D-MMU data pointer
B
bellard 已提交
1678 1679 1680
    case 0x48: // Interrupt dispatch, RO
    case 0x49: // Interrupt data receive
    case 0x7f: // Incoming interrupt vector, RO
B
blueswir1 已提交
1681 1682
        // XXX
        break;
B
bellard 已提交
1683 1684 1685 1686
    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 已提交
1687
    case 0x77: // Interrupt vector, WO
B
bellard 已提交
1688
    default:
B
blueswir1 已提交
1689
        do_unassigned_access(addr, 0, 0, 1);
B
blueswir1 已提交
1690 1691
        ret = 0;
        break;
B
bellard 已提交
1692
    }
1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707

    /* 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 已提交
1708
            break;
1709 1710
        case 4:
            ret = bswap32(ret);
B
blueswir1 已提交
1711
            break;
1712 1713
        case 8:
            ret = bswap64(ret);
B
blueswir1 已提交
1714
            break;
1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726
        default:
            break;
        }
    default:
        break;
    }

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

B
blueswir1 已提交
1744
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
B
bellard 已提交
1745
{
B
blueswir1 已提交
1746 1747 1748
#ifdef DEBUG_ASI
    dump_asi("write", addr, asi, size, val);
#endif
B
blueswir1 已提交
1749
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
1750 1751
        || ((env->def->features & CPU_FEATURE_HYPV)
            && asi >= 0x30 && asi < 0x80
1752
            && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
1753
        raise_exception(TT_PRIV_ACT);
B
bellard 已提交
1754

1755
    helper_check_align(addr, size - 1);
1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766
    /* Convert to little endian */
    switch (asi) {
    case 0x0c: // Nucleus Little Endian (LE)
    case 0x18: // As if user primary LE
    case 0x19: // As if user secondary LE
    case 0x1c: // Bypass LE
    case 0x1d: // Bypass, non-cacheable LE
    case 0x88: // Primary LE
    case 0x89: // Secondary LE
        switch(size) {
        case 2:
B
blueswir1 已提交
1767
            addr = bswap16(addr);
B
blueswir1 已提交
1768
            break;
1769
        case 4:
B
blueswir1 已提交
1770
            addr = bswap32(addr);
B
blueswir1 已提交
1771
            break;
1772
        case 8:
B
blueswir1 已提交
1773
            addr = bswap64(addr);
B
blueswir1 已提交
1774
            break;
1775 1776 1777 1778 1779 1780 1781
        default:
            break;
        }
    default:
        break;
    }

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

            oldreg = env->lsu;
B
blueswir1 已提交
1881
            env->lsu = val & (DMMU_E | IMMU_E);
B
blueswir1 已提交
1882 1883 1884
            // Mappings generated during D/I MMU disabled mode are
            // invalid in normal mode
            if (oldreg != env->lsu) {
B
blueswir1 已提交
1885 1886
                DPRINTF_MMU("LSU change: 0x%" PRIx64 " -> 0x%" PRIx64 "\n",
                            oldreg, env->lsu);
B
bellard 已提交
1887
#ifdef DEBUG_MMU
B
blueswir1 已提交
1888
                dump_mmu(env);
B
bellard 已提交
1889
#endif
B
blueswir1 已提交
1890 1891 1892 1893
                tlb_flush(env, 1);
            }
            return;
        }
B
bellard 已提交
1894
    case 0x50: // I-MMU regs
B
blueswir1 已提交
1895
        {
B
blueswir1 已提交
1896
            int reg = (addr >> 3) & 0xf;
B
blueswir1 已提交
1897
            uint64_t oldreg;
1898

B
blueswir1 已提交
1899
            oldreg = env->immuregs[reg];
B
bellard 已提交
1900 1901 1902 1903 1904 1905 1906 1907 1908 1909
            switch(reg) {
            case 0: // RO
            case 4:
                return;
            case 1: // Not in I-MMU
            case 2:
            case 7:
            case 8:
                return;
            case 3: // SFSR
B
blueswir1 已提交
1910 1911
                if ((val & 1) == 0)
                    val = 0; // Clear SFSR
B
bellard 已提交
1912 1913 1914 1915 1916 1917
                break;
            case 5: // TSB access
            case 6: // Tag access
            default:
                break;
            }
B
blueswir1 已提交
1918
            env->immuregs[reg] = val;
B
bellard 已提交
1919
            if (oldreg != env->immuregs[reg]) {
B
blueswir1 已提交
1920 1921
                DPRINTF_MMU("mmu change reg[%d]: 0x%08" PRIx64 " -> 0x%08"
                            PRIx64 "\n", reg, oldreg, env->immuregs[reg]);
B
bellard 已提交
1922
            }
1923
#ifdef DEBUG_MMU
B
blueswir1 已提交
1924
            dump_mmu(env);
B
bellard 已提交
1925
#endif
B
blueswir1 已提交
1926 1927
            return;
        }
B
bellard 已提交
1928
    case 0x54: // I-MMU data in
B
blueswir1 已提交
1929 1930 1931 1932 1933 1934 1935
        {
            unsigned int i;

            // Try finding an invalid entry
            for (i = 0; i < 64; i++) {
                if ((env->itlb_tte[i] & 0x8000000000000000ULL) == 0) {
                    env->itlb_tag[i] = env->immuregs[6];
B
blueswir1 已提交
1936
                    env->itlb_tte[i] = val;
B
blueswir1 已提交
1937 1938 1939 1940 1941 1942 1943
                    return;
                }
            }
            // Try finding an unlocked entry
            for (i = 0; i < 64; i++) {
                if ((env->itlb_tte[i] & 0x40) == 0) {
                    env->itlb_tag[i] = env->immuregs[6];
B
blueswir1 已提交
1944
                    env->itlb_tte[i] = val;
B
blueswir1 已提交
1945 1946 1947 1948 1949 1950
                    return;
                }
            }
            // error state?
            return;
        }
B
bellard 已提交
1951
    case 0x55: // I-MMU data access
B
blueswir1 已提交
1952
        {
B
blueswir1 已提交
1953
            unsigned int i = (addr >> 3) & 0x3f;
B
bellard 已提交
1954

B
blueswir1 已提交
1955
            env->itlb_tag[i] = env->immuregs[6];
B
blueswir1 已提交
1956
            env->itlb_tte[i] = val;
B
blueswir1 已提交
1957 1958
            return;
        }
B
bellard 已提交
1959
    case 0x57: // I-MMU demap
B
blueswir1 已提交
1960 1961
        // XXX
        return;
B
bellard 已提交
1962
    case 0x58: // D-MMU regs
B
blueswir1 已提交
1963
        {
B
blueswir1 已提交
1964
            int reg = (addr >> 3) & 0xf;
B
blueswir1 已提交
1965
            uint64_t oldreg;
1966

B
blueswir1 已提交
1967
            oldreg = env->dmmuregs[reg];
B
bellard 已提交
1968 1969 1970 1971 1972
            switch(reg) {
            case 0: // RO
            case 4:
                return;
            case 3: // SFSR
B
blueswir1 已提交
1973 1974
                if ((val & 1) == 0) {
                    val = 0; // Clear SFSR, Fault address
B
blueswir1 已提交
1975 1976
                    env->dmmuregs[4] = 0;
                }
B
blueswir1 已提交
1977
                env->dmmuregs[reg] = val;
B
bellard 已提交
1978 1979 1980 1981 1982 1983 1984 1985 1986 1987
                break;
            case 1: // Primary context
            case 2: // Secondary context
            case 5: // TSB access
            case 6: // Tag access
            case 7: // Virtual Watchpoint
            case 8: // Physical Watchpoint
            default:
                break;
            }
B
blueswir1 已提交
1988
            env->dmmuregs[reg] = val;
B
bellard 已提交
1989
            if (oldreg != env->dmmuregs[reg]) {
B
blueswir1 已提交
1990 1991
                DPRINTF_MMU("mmu change reg[%d]: 0x%08" PRIx64 " -> 0x%08"
                            PRIx64 "\n", reg, oldreg, env->dmmuregs[reg]);
B
bellard 已提交
1992
            }
1993
#ifdef DEBUG_MMU
B
blueswir1 已提交
1994
            dump_mmu(env);
B
bellard 已提交
1995
#endif
B
blueswir1 已提交
1996 1997
            return;
        }
B
bellard 已提交
1998
    case 0x5c: // D-MMU data in
B
blueswir1 已提交
1999 2000 2001 2002 2003 2004 2005
        {
            unsigned int i;

            // Try finding an invalid entry
            for (i = 0; i < 64; i++) {
                if ((env->dtlb_tte[i] & 0x8000000000000000ULL) == 0) {
                    env->dtlb_tag[i] = env->dmmuregs[6];
B
blueswir1 已提交
2006
                    env->dtlb_tte[i] = val;
B
blueswir1 已提交
2007 2008 2009 2010 2011 2012 2013
                    return;
                }
            }
            // Try finding an unlocked entry
            for (i = 0; i < 64; i++) {
                if ((env->dtlb_tte[i] & 0x40) == 0) {
                    env->dtlb_tag[i] = env->dmmuregs[6];
B
blueswir1 已提交
2014
                    env->dtlb_tte[i] = val;
B
blueswir1 已提交
2015 2016 2017 2018 2019 2020
                    return;
                }
            }
            // error state?
            return;
        }
B
bellard 已提交
2021
    case 0x5d: // D-MMU data access
B
blueswir1 已提交
2022
        {
B
blueswir1 已提交
2023
            unsigned int i = (addr >> 3) & 0x3f;
B
bellard 已提交
2024

B
blueswir1 已提交
2025
            env->dtlb_tag[i] = env->dmmuregs[6];
B
blueswir1 已提交
2026
            env->dtlb_tte[i] = val;
B
blueswir1 已提交
2027 2028
            return;
        }
B
bellard 已提交
2029
    case 0x5f: // D-MMU demap
B
bellard 已提交
2030
    case 0x49: // Interrupt data receive
B
blueswir1 已提交
2031 2032
        // XXX
        return;
2033 2034
    case 0x46: // D-cache data
    case 0x47: // D-cache tag access
2035 2036 2037
    case 0x4b: // E-cache error enable
    case 0x4c: // E-cache asynchronous fault status
    case 0x4d: // E-cache asynchronous fault address
2038 2039 2040 2041 2042 2043 2044 2045
    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 已提交
2046 2047 2048 2049 2050 2051 2052
    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 已提交
2053 2054 2055 2056 2057 2058
    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 已提交
2059
    default:
B
blueswir1 已提交
2060
        do_unassigned_access(addr, 1, 0, 1);
B
blueswir1 已提交
2061
        return;
B
bellard 已提交
2062 2063
    }
}
2064
#endif /* CONFIG_USER_ONLY */
2065

B
blueswir1 已提交
2066 2067 2068
void helper_ldda_asi(target_ulong addr, int asi, int rd)
{
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
2069 2070
        || ((env->def->features & CPU_FEATURE_HYPV)
            && asi >= 0x30 && asi < 0x80
2071
            && !(env->hpstate & HS_PRIV)))
B
blueswir1 已提交
2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112
        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 已提交
2113
void helper_ldf_asi(target_ulong addr, int asi, int size, int rd)
2114 2115
{
    unsigned int i;
B
blueswir1 已提交
2116
    target_ulong val;
2117

2118
    helper_check_align(addr, 3);
2119 2120 2121 2122 2123
    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 已提交
2124 2125 2126 2127
        if (rd & 7) {
            raise_exception(TT_ILL_INSN);
            return;
        }
2128
        helper_check_align(addr, 0x3f);
B
blueswir1 已提交
2129
        for (i = 0; i < 16; i++) {
B
blueswir1 已提交
2130 2131
            *(uint32_t *)&env->fpr[rd++] = helper_ld_asi(addr, asi & 0x8f, 4,
                                                         0);
B
blueswir1 已提交
2132
            addr += 4;
2133 2134 2135 2136 2137 2138 2139
        }

        return;
    default:
        break;
    }

B
blueswir1 已提交
2140
    val = helper_ld_asi(addr, asi, size, 0);
2141 2142 2143
    switch(size) {
    default:
    case 4:
B
blueswir1 已提交
2144
        *((uint32_t *)&env->fpr[rd]) = val;
2145 2146
        break;
    case 8:
B
blueswir1 已提交
2147
        *((int64_t *)&DT0) = val;
2148
        break;
B
blueswir1 已提交
2149 2150 2151
    case 16:
        // XXX
        break;
2152 2153 2154
    }
}

B
blueswir1 已提交
2155
void helper_stf_asi(target_ulong addr, int asi, int size, int rd)
2156 2157
{
    unsigned int i;
B
blueswir1 已提交
2158
    target_ulong val = 0;
2159

2160
    helper_check_align(addr, 3);
2161 2162 2163 2164 2165
    switch (asi) {
    case 0xf0: // Block store primary
    case 0xf1: // Block store secondary
    case 0xf8: // Block store primary LE
    case 0xf9: // Block store secondary LE
B
blueswir1 已提交
2166 2167 2168 2169
        if (rd & 7) {
            raise_exception(TT_ILL_INSN);
            return;
        }
2170
        helper_check_align(addr, 0x3f);
B
blueswir1 已提交
2171
        for (i = 0; i < 16; i++) {
B
blueswir1 已提交
2172 2173 2174
            val = *(uint32_t *)&env->fpr[rd++];
            helper_st_asi(addr, val, asi & 0x8f, 4);
            addr += 4;
2175 2176 2177 2178 2179 2180 2181 2182 2183 2184
        }

        return;
    default:
        break;
    }

    switch(size) {
    default:
    case 4:
B
blueswir1 已提交
2185
        val = *((uint32_t *)&env->fpr[rd]);
2186 2187
        break;
    case 8:
B
blueswir1 已提交
2188
        val = *((int64_t *)&DT0);
2189
        break;
B
blueswir1 已提交
2190 2191 2192
    case 16:
        // XXX
        break;
2193
    }
B
blueswir1 已提交
2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207
    helper_st_asi(addr, val, asi, size);
}

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

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

B
blueswir1 已提交
2210 2211 2212 2213 2214 2215 2216 2217 2218 2219
target_ulong helper_casx_asi(target_ulong addr, target_ulong val1,
                             target_ulong val2, uint32_t asi)
{
    target_ulong ret;

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

#ifndef TARGET_SPARC64
B
blueswir1 已提交
2223
void helper_rett(void)
2224
{
2225 2226
    unsigned int cwp;

2227 2228 2229
    if (env->psret == 1)
        raise_exception(TT_ILL_INSN);

2230
    env->psret = 1;
2231
    cwp = cpu_cwp_inc(env, env->cwp + 1) ;
2232 2233 2234 2235 2236 2237
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_UNF);
    }
    set_cwp(cwp);
    env->psrs = env->psrps;
}
B
bellard 已提交
2238
#endif
2239

B
blueswir1 已提交
2240 2241 2242 2243 2244
target_ulong helper_udiv(target_ulong a, target_ulong b)
{
    uint64_t x0;
    uint32_t x1;

2245
    x0 = (a & 0xffffffff) | ((int64_t) (env->y) << 32);
B
blueswir1 已提交
2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266
    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;

2267
    x0 = (a & 0xffffffff) | ((int64_t) (env->y) << 32);
B
blueswir1 已提交
2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283
    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 已提交
2284 2285
void helper_stdf(target_ulong addr, int mem_idx)
{
2286
    helper_check_align(addr, 7);
B
blueswir1 已提交
2287 2288 2289
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
2290
        stfq_user(addr, DT0);
B
blueswir1 已提交
2291 2292
        break;
    case 1:
2293
        stfq_kernel(addr, DT0);
B
blueswir1 已提交
2294 2295 2296
        break;
#ifdef TARGET_SPARC64
    case 2:
2297
        stfq_hypv(addr, DT0);
B
blueswir1 已提交
2298 2299 2300 2301 2302 2303
        break;
#endif
    default:
        break;
    }
#else
B
blueswir1 已提交
2304
    address_mask(env, &addr);
2305
    stfq_raw(addr, DT0);
B
blueswir1 已提交
2306 2307 2308 2309 2310
#endif
}

void helper_lddf(target_ulong addr, int mem_idx)
{
2311
    helper_check_align(addr, 7);
B
blueswir1 已提交
2312 2313 2314
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
2315
        DT0 = ldfq_user(addr);
B
blueswir1 已提交
2316 2317
        break;
    case 1:
2318
        DT0 = ldfq_kernel(addr);
B
blueswir1 已提交
2319 2320 2321
        break;
#ifdef TARGET_SPARC64
    case 2:
2322
        DT0 = ldfq_hypv(addr);
B
blueswir1 已提交
2323 2324 2325 2326 2327 2328
        break;
#endif
    default:
        break;
    }
#else
B
blueswir1 已提交
2329
    address_mask(env, &addr);
2330
    DT0 = ldfq_raw(addr);
B
blueswir1 已提交
2331 2332 2333
#endif
}

B
blueswir1 已提交
2334
void helper_ldqf(target_ulong addr, int mem_idx)
B
blueswir1 已提交
2335 2336 2337 2338
{
    // XXX add 128 bit load
    CPU_QuadU u;

2339
    helper_check_align(addr, 7);
B
blueswir1 已提交
2340 2341 2342
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
2343 2344
        u.ll.upper = ldq_user(addr);
        u.ll.lower = ldq_user(addr + 8);
B
blueswir1 已提交
2345 2346 2347
        QT0 = u.q;
        break;
    case 1:
2348 2349
        u.ll.upper = ldq_kernel(addr);
        u.ll.lower = ldq_kernel(addr + 8);
B
blueswir1 已提交
2350 2351 2352 2353
        QT0 = u.q;
        break;
#ifdef TARGET_SPARC64
    case 2:
2354 2355
        u.ll.upper = ldq_hypv(addr);
        u.ll.lower = ldq_hypv(addr + 8);
B
blueswir1 已提交
2356 2357 2358 2359 2360 2361 2362
        QT0 = u.q;
        break;
#endif
    default:
        break;
    }
#else
B
blueswir1 已提交
2363
    address_mask(env, &addr);
2364 2365
    u.ll.upper = ldq_raw(addr);
    u.ll.lower = ldq_raw((addr + 8) & 0xffffffffULL);
B
blueswir1 已提交
2366
    QT0 = u.q;
B
blueswir1 已提交
2367
#endif
B
blueswir1 已提交
2368 2369
}

B
blueswir1 已提交
2370
void helper_stqf(target_ulong addr, int mem_idx)
B
blueswir1 已提交
2371 2372 2373 2374
{
    // XXX add 128 bit store
    CPU_QuadU u;

2375
    helper_check_align(addr, 7);
B
blueswir1 已提交
2376 2377 2378 2379
#if !defined(CONFIG_USER_ONLY)
    switch (mem_idx) {
    case 0:
        u.q = QT0;
2380 2381
        stq_user(addr, u.ll.upper);
        stq_user(addr + 8, u.ll.lower);
B
blueswir1 已提交
2382 2383 2384
        break;
    case 1:
        u.q = QT0;
2385 2386
        stq_kernel(addr, u.ll.upper);
        stq_kernel(addr + 8, u.ll.lower);
B
blueswir1 已提交
2387 2388 2389 2390
        break;
#ifdef TARGET_SPARC64
    case 2:
        u.q = QT0;
2391 2392
        stq_hypv(addr, u.ll.upper);
        stq_hypv(addr + 8, u.ll.lower);
B
blueswir1 已提交
2393 2394 2395 2396 2397 2398
        break;
#endif
    default:
        break;
    }
#else
B
blueswir1 已提交
2399
    u.q = QT0;
B
blueswir1 已提交
2400
    address_mask(env, &addr);
2401 2402
    stq_raw(addr, u.ll.upper);
    stq_raw((addr + 8) & 0xffffffffULL, u.ll.lower);
B
blueswir1 已提交
2403
#endif
B
blueswir1 已提交
2404
}
B
blueswir1 已提交
2405

2406
static inline void set_fsr(void)
2407
{
B
bellard 已提交
2408
    int rnd_mode;
B
blueswir1 已提交
2409

2410 2411
    switch (env->fsr & FSR_RD_MASK) {
    case FSR_RD_NEAREST:
B
bellard 已提交
2412
        rnd_mode = float_round_nearest_even;
B
blueswir1 已提交
2413
        break;
B
bellard 已提交
2414
    default:
2415
    case FSR_RD_ZERO:
B
bellard 已提交
2416
        rnd_mode = float_round_to_zero;
B
blueswir1 已提交
2417
        break;
2418
    case FSR_RD_POS:
B
bellard 已提交
2419
        rnd_mode = float_round_up;
B
blueswir1 已提交
2420
        break;
2421
    case FSR_RD_NEG:
B
bellard 已提交
2422
        rnd_mode = float_round_down;
B
blueswir1 已提交
2423
        break;
2424
    }
B
bellard 已提交
2425
    set_float_rounding_mode(rnd_mode, &env->fp_status);
2426
}
B
bellard 已提交
2427

2428
void helper_ldfsr(uint32_t new_fsr)
B
blueswir1 已提交
2429
{
2430 2431
    env->fsr = (new_fsr & FSR_LDFSR_MASK) | (env->fsr & FSR_LDFSR_OLDMASK);
    set_fsr();
B
blueswir1 已提交
2432 2433
}

2434 2435 2436 2437 2438 2439 2440 2441
#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 已提交
2442
void helper_debug(void)
B
bellard 已提交
2443 2444 2445 2446
{
    env->exception_index = EXCP_DEBUG;
    cpu_loop_exit();
}
2447

B
bellard 已提交
2448
#ifndef TARGET_SPARC64
2449 2450 2451 2452 2453 2454
/* XXX: use another pointer for %iN registers to avoid slow wrapping
   handling ? */
void helper_save(void)
{
    uint32_t cwp;

2455
    cwp = cpu_cwp_dec(env, env->cwp - 1);
2456 2457 2458 2459 2460 2461 2462 2463 2464 2465
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_OVF);
    }
    set_cwp(cwp);
}

void helper_restore(void)
{
    uint32_t cwp;

2466
    cwp = cpu_cwp_inc(env, env->cwp + 1);
2467 2468 2469 2470 2471 2472
    if (env->wim & (1 << cwp)) {
        raise_exception(TT_WIN_UNF);
    }
    set_cwp(cwp);
}

B
blueswir1 已提交
2473
void helper_wrpsr(target_ulong new_psr)
2474
{
2475
    if ((new_psr & PSR_CWP) >= env->nwindows)
2476 2477
        raise_exception(TT_ILL_INSN);
    else
B
blueswir1 已提交
2478
        PUT_PSR(env, new_psr);
2479 2480
}

B
blueswir1 已提交
2481
target_ulong helper_rdpsr(void)
2482
{
B
blueswir1 已提交
2483
    return GET_PSR(env);
2484
}
B
bellard 已提交
2485 2486

#else
2487 2488 2489 2490 2491 2492
/* XXX: use another pointer for %iN registers to avoid slow wrapping
   handling ? */
void helper_save(void)
{
    uint32_t cwp;

2493
    cwp = cpu_cwp_dec(env, env->cwp - 1);
2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513
    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;

2514
    cwp = cpu_cwp_inc(env, env->cwp + 1);
2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527
    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)
{
2528
    if (env->cansave != env->nwindows - 2) {
2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542 2543 2544 2545 2546
        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++;
2547
    if (env->cleanwin < env->nwindows - 1)
2548 2549 2550 2551 2552 2553 2554
        env->cleanwin++;
    if (env->otherwin == 0)
        env->cansave--;
    else
        env->otherwin--;
}

B
blueswir1 已提交
2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575
target_ulong helper_rdccr(void)
{
    return GET_CCR(env);
}

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

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

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

2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607
// 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 已提交
2608
target_ulong helper_popc(target_ulong val)
B
bellard 已提交
2609
{
B
blueswir1 已提交
2610
    return ctpop64(val);
B
bellard 已提交
2611
}
B
bellard 已提交
2612 2613 2614 2615 2616 2617

static inline uint64_t *get_gregset(uint64_t pstate)
{
    switch (pstate) {
    default:
    case 0:
B
blueswir1 已提交
2618
        return env->bgregs;
B
bellard 已提交
2619
    case PS_AG:
B
blueswir1 已提交
2620
        return env->agregs;
B
bellard 已提交
2621
    case PS_MG:
B
blueswir1 已提交
2622
        return env->mgregs;
B
bellard 已提交
2623
    case PS_IG:
B
blueswir1 已提交
2624
        return env->igregs;
B
bellard 已提交
2625 2626 2627
    }
}

B
blueswir1 已提交
2628
static inline void change_pstate(uint64_t new_pstate)
B
bellard 已提交
2629
{
2630
    uint64_t pstate_regs, new_pstate_regs;
B
bellard 已提交
2631 2632 2633 2634 2635
    uint64_t *src, *dst;

    pstate_regs = env->pstate & 0xc01;
    new_pstate_regs = new_pstate & 0xc01;
    if (new_pstate_regs != pstate_regs) {
B
blueswir1 已提交
2636 2637 2638 2639 2640
        // 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 已提交
2641 2642 2643 2644
    }
    env->pstate = new_pstate;
}

B
blueswir1 已提交
2645
void helper_wrpstate(target_ulong new_state)
2646
{
2647
    if (!(env->def->features & CPU_FEATURE_GL))
2648
        change_pstate(new_state & 0xf3f);
2649 2650
}

B
blueswir1 已提交
2651
void helper_done(void)
B
bellard 已提交
2652
{
2653 2654 2655 2656 2657 2658
    env->pc = env->tsptr->tpc;
    env->npc = env->tsptr->tnpc + 4;
    PUT_CCR(env, env->tsptr->tstate >> 32);
    env->asi = (env->tsptr->tstate >> 24) & 0xff;
    change_pstate((env->tsptr->tstate >> 8) & 0xf3f);
    PUT_CWP64(env, env->tsptr->tstate & 0xff);
B
blueswir1 已提交
2659
    env->tl--;
2660
    env->tsptr = &env->ts[env->tl & MAXTL_MASK];
B
bellard 已提交
2661 2662
}

B
blueswir1 已提交
2663
void helper_retry(void)
B
bellard 已提交
2664
{
2665 2666 2667 2668 2669 2670
    env->pc = env->tsptr->tpc;
    env->npc = env->tsptr->tnpc;
    PUT_CCR(env, env->tsptr->tstate >> 32);
    env->asi = (env->tsptr->tstate >> 24) & 0xff;
    change_pstate((env->tsptr->tstate >> 8) & 0xf3f);
    PUT_CWP64(env, env->tsptr->tstate & 0xff);
B
blueswir1 已提交
2671
    env->tl--;
2672
    env->tsptr = &env->ts[env->tl & MAXTL_MASK];
B
bellard 已提交
2673
}
B
bellard 已提交
2674
#endif
2675

B
blueswir1 已提交
2676
void helper_flush(target_ulong addr)
2677
{
B
blueswir1 已提交
2678 2679
    addr &= ~7;
    tb_invalidate_page_range(addr, addr + 8);
2680 2681
}

B
blueswir1 已提交
2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 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 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812
#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

void do_interrupt(CPUState *env)
{
    int intno = env->exception_index;

#ifdef DEBUG_PCALL
    if (loglevel & CPU_LOG_INT) {
        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";
        }

        fprintf(logfile, "%6d: %s (v=%04x) pc=%016" PRIx64 " npc=%016" PRIx64
                " SP=%016" PRIx64 "\n",
                count, name, intno,
                env->pc,
                env->npc, env->regwptr[6]);
        cpu_dump_state(env, logfile, fprintf, 0);
#if 0
        {
            int i;
            uint8_t *ptr;

            fprintf(logfile, "       code=");
            ptr = (uint8_t *)env->pc;
            for(i = 0; i < 16; i++) {
                fprintf(logfile, " %02x", ldub(ptr + i));
            }
            fprintf(logfile, "\n");
        }
#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++;
    }
    env->tsptr = &env->ts[env->tl & MAXTL_MASK];
    env->tsptr->tstate = ((uint64_t)GET_CCR(env) << 32) |
        ((env->asi & 0xff) << 24) | ((env->pstate & 0xf3f) << 8) |
        GET_CWP64(env);
    env->tsptr->tpc = env->pc;
    env->tsptr->tnpc = env->npc;
    env->tsptr->tt = intno;
    if (!(env->def->features & CPU_FEATURE_GL)) {
        switch (intno) {
        case TT_IVEC:
            change_pstate(PS_PEF | PS_PRIV | PS_IG);
            break;
        case TT_TFAULT:
        case TT_TMISS:
        case TT_DFAULT:
        case TT_DMISS:
        case TT_DPROT:
            change_pstate(PS_PEF | PS_PRIV | PS_MG);
            break;
        default:
            change_pstate(PS_PEF | PS_PRIV | PS_AG);
            break;
        }
    }
    if (intno == TT_CLRWIN)
        cpu_set_cwp(env, cpu_cwp_dec(env, env->cwp - 1));
    else if ((intno & 0x1c0) == TT_SPILL)
        cpu_set_cwp(env, cpu_cwp_dec(env, env->cwp - env->cansave - 2));
    else if ((intno & 0x1c0) == TT_FILL)
        cpu_set_cwp(env, cpu_cwp_inc(env, env->cwp + 1));
    env->tbr &= ~0x7fffULL;
    env->tbr |= ((env->tl > 1) ? 1 << 14 : 0) | (intno << 5);
    env->pc = env->tbr;
    env->npc = env->pc + 4;
    env->exception_index = 0;
2813
}
B
blueswir1 已提交
2814 2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848
#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
2849

B
blueswir1 已提交
2850
void do_interrupt(CPUState *env)
2851
{
B
blueswir1 已提交
2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907
    int cwp, intno = env->exception_index;

#ifdef DEBUG_PCALL
    if (loglevel & CPU_LOG_INT) {
        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";
        }

        fprintf(logfile, "%6d: %s (v=%02x) pc=%08x npc=%08x SP=%08x\n",
                count, name, intno,
                env->pc,
                env->npc, env->regwptr[6]);
        cpu_dump_state(env, logfile, fprintf, 0);
#if 0
        {
            int i;
            uint8_t *ptr;

            fprintf(logfile, "       code=");
            ptr = (uint8_t *)env->pc;
            for(i = 0; i < 16; i++) {
                fprintf(logfile, " %02x", ldub(ptr + i));
            }
            fprintf(logfile, "\n");
        }
#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;
    cwp = cpu_cwp_dec(env, env->cwp - 1);
    cpu_set_cwp(env, cwp);
    env->regwptr[9] = env->pc;
    env->regwptr[10] = env->npc;
    env->psrps = env->psrs;
    env->psrs = 1;
    env->tbr = (env->tbr & TBR_BASE_MASK) | (intno << 4);
    env->pc = env->tbr;
    env->npc = env->pc + 4;
    env->exception_index = 0;
2908
}
B
blueswir1 已提交
2909
#endif
2910

2911
#if !defined(CONFIG_USER_ONLY)
2912

2913 2914 2915
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
                                void *retaddr);

2916
#define MMUSUFFIX _mmu
2917
#define ALIGNED_ONLY
2918 2919 2920 2921 2922 2923 2924 2925 2926 2927 2928 2929 2930

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

2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944 2945 2946 2947 2948
/* 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);
        }
    }
}

2949 2950 2951
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
                                void *retaddr)
{
B
blueswir1 已提交
2952
#ifdef DEBUG_UNALIGNED
2953 2954
    printf("Unaligned access to 0x" TARGET_FMT_lx " from 0x" TARGET_FMT_lx
           "\n", addr, env->pc);
B
blueswir1 已提交
2955
#endif
2956
    cpu_restore_state2(retaddr);
B
blueswir1 已提交
2957
    raise_exception(TT_UNALIGNED);
2958
}
2959 2960 2961 2962 2963

/* 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 */
2964
void tlb_fill(target_ulong addr, int is_write, int mmu_idx, void *retaddr)
2965 2966 2967 2968 2969 2970 2971 2972 2973
{
    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;

2974
    ret = cpu_sparc_handle_mmu_fault(env, addr, is_write, mmu_idx, 1);
2975
    if (ret) {
2976
        cpu_restore_state2(retaddr);
2977 2978 2979 2980 2981 2982
        cpu_loop_exit();
    }
    env = saved_env;
}

#endif
2983 2984

#ifndef TARGET_SPARC64
2985
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
2986 2987 2988 2989 2990 2991 2992 2993
                          int is_asi)
{
    CPUState *saved_env;

    /* XXX: hack to restore env in all cases, even if not called from
       generated code */
    saved_env = env;
    env = cpu_single_env;
2994 2995
#ifdef DEBUG_UNASSIGNED
    if (is_asi)
B
blueswir1 已提交
2996 2997
        printf("Unassigned mem %s access to " TARGET_FMT_plx
               " asi 0x%02x from " TARGET_FMT_lx "\n",
2998 2999 3000 3001 3002 3003 3004
               is_exec ? "exec" : is_write ? "write" : "read", addr, is_asi,
               env->pc);
    else
        printf("Unassigned mem %s access to " TARGET_FMT_plx " from "
               TARGET_FMT_lx "\n",
               is_exec ? "exec" : is_write ? "write" : "read", addr, env->pc);
#endif
3005
    if (env->mmuregs[3]) /* Fault status register */
B
blueswir1 已提交
3006
        env->mmuregs[3] = 1; /* overflow (not read before another fault) */
3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017
    if (is_asi)
        env->mmuregs[3] |= 1 << 16;
    if (env->psrs)
        env->mmuregs[3] |= 1 << 5;
    if (is_exec)
        env->mmuregs[3] |= 1 << 6;
    if (is_write)
        env->mmuregs[3] |= 1 << 7;
    env->mmuregs[3] |= (5 << 2) | 2;
    env->mmuregs[4] = addr; /* Fault address register */
    if ((env->mmuregs[0] & MMU_E) && !(env->mmuregs[0] & MMU_NF)) {
3018 3019 3020 3021
        if (is_exec)
            raise_exception(TT_CODE_ACCESS);
        else
            raise_exception(TT_DATA_ACCESS);
3022 3023 3024 3025
    }
    env = saved_env;
}
#else
3026
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
3027 3028 3029 3030 3031 3032 3033 3034 3035
                          int is_asi)
{
#ifdef DEBUG_UNASSIGNED
    CPUState *saved_env;

    /* XXX: hack to restore env in all cases, even if not called from
       generated code */
    saved_env = env;
    env = cpu_single_env;
B
blueswir1 已提交
3036 3037
    printf("Unassigned mem access to " TARGET_FMT_plx " from " TARGET_FMT_lx
           "\n", addr, env->pc);
3038 3039
    env = saved_env;
#endif
3040 3041 3042 3043
    if (is_exec)
        raise_exception(TT_CODE_ACCESS);
    else
        raise_exception(TT_DATA_ACCESS);
3044 3045
}
#endif
3046