Statistics
| Branch: | Revision:

root / target-sparc / op_helper.c @ a74cdab4

History | View | Annotate | Download (122.8 kB)

1 e8af50a3 bellard
#include "exec.h"
2 eed152bb blueswir1
#include "host-utils.h"
3 1a2fb1c0 blueswir1
#include "helper.h"
4 b04d9890 Fabien Chouteau
#include "sysemu.h"
5 e8af50a3 bellard
6 e80cfcfc bellard
//#define DEBUG_MMU
7 952a328f blueswir1
//#define DEBUG_MXCC
8 94554550 blueswir1
//#define DEBUG_UNALIGNED
9 6c36d3fa blueswir1
//#define DEBUG_UNASSIGNED
10 8543e2cf blueswir1
//#define DEBUG_ASI
11 d81fd722 blueswir1
//#define DEBUG_PCALL
12 7e8695ed Igor V. Kovalenko
//#define DEBUG_PSTATE
13 b04d9890 Fabien Chouteau
//#define DEBUG_CACHE_CONTROL
14 e80cfcfc bellard
15 952a328f blueswir1
#ifdef DEBUG_MMU
16 001faf32 Blue Swirl
#define DPRINTF_MMU(fmt, ...)                                   \
17 001faf32 Blue Swirl
    do { printf("MMU: " fmt , ## __VA_ARGS__); } while (0)
18 952a328f blueswir1
#else
19 001faf32 Blue Swirl
#define DPRINTF_MMU(fmt, ...) do {} while (0)
20 952a328f blueswir1
#endif
21 952a328f blueswir1
22 952a328f blueswir1
#ifdef DEBUG_MXCC
23 001faf32 Blue Swirl
#define DPRINTF_MXCC(fmt, ...)                                  \
24 001faf32 Blue Swirl
    do { printf("MXCC: " fmt , ## __VA_ARGS__); } while (0)
25 952a328f blueswir1
#else
26 001faf32 Blue Swirl
#define DPRINTF_MXCC(fmt, ...) do {} while (0)
27 952a328f blueswir1
#endif
28 952a328f blueswir1
29 8543e2cf blueswir1
#ifdef DEBUG_ASI
30 001faf32 Blue Swirl
#define DPRINTF_ASI(fmt, ...)                                   \
31 001faf32 Blue Swirl
    do { printf("ASI: " fmt , ## __VA_ARGS__); } while (0)
32 8543e2cf blueswir1
#endif
33 8543e2cf blueswir1
34 7e8695ed Igor V. Kovalenko
#ifdef DEBUG_PSTATE
35 7e8695ed Igor V. Kovalenko
#define DPRINTF_PSTATE(fmt, ...)                                   \
36 7e8695ed Igor V. Kovalenko
    do { printf("PSTATE: " fmt , ## __VA_ARGS__); } while (0)
37 7e8695ed Igor V. Kovalenko
#else
38 7e8695ed Igor V. Kovalenko
#define DPRINTF_PSTATE(fmt, ...) do {} while (0)
39 7e8695ed Igor V. Kovalenko
#endif
40 7e8695ed Igor V. Kovalenko
41 b04d9890 Fabien Chouteau
#ifdef DEBUG_CACHE_CONTROL
42 b04d9890 Fabien Chouteau
#define DPRINTF_CACHE_CONTROL(fmt, ...)                                   \
43 b04d9890 Fabien Chouteau
    do { printf("CACHE_CONTROL: " fmt , ## __VA_ARGS__); } while (0)
44 b04d9890 Fabien Chouteau
#else
45 b04d9890 Fabien Chouteau
#define DPRINTF_CACHE_CONTROL(fmt, ...) do {} while (0)
46 b04d9890 Fabien Chouteau
#endif
47 b04d9890 Fabien Chouteau
48 2cade6a3 blueswir1
#ifdef TARGET_SPARC64
49 2cade6a3 blueswir1
#ifndef TARGET_ABI32
50 2cade6a3 blueswir1
#define AM_CHECK(env1) ((env1)->pstate & PS_AM)
51 c2bc0e38 blueswir1
#else
52 2cade6a3 blueswir1
#define AM_CHECK(env1) (1)
53 2cade6a3 blueswir1
#endif
54 c2bc0e38 blueswir1
#endif
55 c2bc0e38 blueswir1
56 21ffd181 Blue Swirl
#define DT0 (env->dt0)
57 21ffd181 Blue Swirl
#define DT1 (env->dt1)
58 21ffd181 Blue Swirl
#define QT0 (env->qt0)
59 21ffd181 Blue Swirl
#define QT1 (env->qt1)
60 21ffd181 Blue Swirl
61 b04d9890 Fabien Chouteau
/* Leon3 cache control */
62 b04d9890 Fabien Chouteau
63 b04d9890 Fabien Chouteau
/* Cache control: emulate the behavior of cache control registers but without
64 b04d9890 Fabien Chouteau
   any effect on the emulated */
65 b04d9890 Fabien Chouteau
66 b04d9890 Fabien Chouteau
#define CACHE_STATE_MASK 0x3
67 b04d9890 Fabien Chouteau
#define CACHE_DISABLED   0x0
68 b04d9890 Fabien Chouteau
#define CACHE_FROZEN     0x1
69 b04d9890 Fabien Chouteau
#define CACHE_ENABLED    0x3
70 b04d9890 Fabien Chouteau
71 b04d9890 Fabien Chouteau
/* Cache Control register fields */
72 b04d9890 Fabien Chouteau
73 b04d9890 Fabien Chouteau
#define CACHE_CTRL_IF (1 <<  4)  /* Instruction Cache Freeze on Interrupt */
74 b04d9890 Fabien Chouteau
#define CACHE_CTRL_DF (1 <<  5)  /* Data Cache Freeze on Interrupt */
75 b04d9890 Fabien Chouteau
#define CACHE_CTRL_DP (1 << 14)  /* Data cache flush pending */
76 b04d9890 Fabien Chouteau
#define CACHE_CTRL_IP (1 << 15)  /* Instruction cache flush pending */
77 b04d9890 Fabien Chouteau
#define CACHE_CTRL_IB (1 << 16)  /* Instruction burst fetch */
78 b04d9890 Fabien Chouteau
#define CACHE_CTRL_FI (1 << 21)  /* Flush Instruction cache (Write only) */
79 b04d9890 Fabien Chouteau
#define CACHE_CTRL_FD (1 << 22)  /* Flush Data cache (Write only) */
80 b04d9890 Fabien Chouteau
#define CACHE_CTRL_DS (1 << 23)  /* Data cache snoop enable */
81 b04d9890 Fabien Chouteau
82 3c7b48b7 Paul Brook
#if defined(CONFIG_USER_ONLY) && defined(TARGET_SPARC64)
83 3c7b48b7 Paul Brook
static void do_unassigned_access(target_ulong addr, int is_write, int is_exec,
84 3c7b48b7 Paul Brook
                          int is_asi, int size);
85 3c7b48b7 Paul Brook
#endif
86 3c7b48b7 Paul Brook
87 9c22a623 Blue Swirl
#if defined(TARGET_SPARC64) && !defined(CONFIG_USER_ONLY)
88 697a77e6 Igor Kovalenko
// Calculates TSB pointer value for fault page size 8k or 64k
89 697a77e6 Igor Kovalenko
static uint64_t ultrasparc_tsb_pointer(uint64_t tsb_register,
90 697a77e6 Igor Kovalenko
                                       uint64_t tag_access_register,
91 697a77e6 Igor Kovalenko
                                       int page_size)
92 697a77e6 Igor Kovalenko
{
93 697a77e6 Igor Kovalenko
    uint64_t tsb_base = tsb_register & ~0x1fffULL;
94 6e8e7d4c Igor Kovalenko
    int tsb_split = (tsb_register & 0x1000ULL) ? 1 : 0;
95 6e8e7d4c Igor Kovalenko
    int tsb_size  = tsb_register & 0xf;
96 697a77e6 Igor Kovalenko
97 697a77e6 Igor Kovalenko
    // discard lower 13 bits which hold tag access context
98 697a77e6 Igor Kovalenko
    uint64_t tag_access_va = tag_access_register & ~0x1fffULL;
99 697a77e6 Igor Kovalenko
100 697a77e6 Igor Kovalenko
    // now reorder bits
101 697a77e6 Igor Kovalenko
    uint64_t tsb_base_mask = ~0x1fffULL;
102 697a77e6 Igor Kovalenko
    uint64_t va = tag_access_va;
103 697a77e6 Igor Kovalenko
104 697a77e6 Igor Kovalenko
    // move va bits to correct position
105 697a77e6 Igor Kovalenko
    if (page_size == 8*1024) {
106 697a77e6 Igor Kovalenko
        va >>= 9;
107 697a77e6 Igor Kovalenko
    } else if (page_size == 64*1024) {
108 697a77e6 Igor Kovalenko
        va >>= 12;
109 697a77e6 Igor Kovalenko
    }
110 697a77e6 Igor Kovalenko
111 697a77e6 Igor Kovalenko
    if (tsb_size) {
112 697a77e6 Igor Kovalenko
        tsb_base_mask <<= tsb_size;
113 697a77e6 Igor Kovalenko
    }
114 697a77e6 Igor Kovalenko
115 697a77e6 Igor Kovalenko
    // calculate tsb_base mask and adjust va if split is in use
116 697a77e6 Igor Kovalenko
    if (tsb_split) {
117 697a77e6 Igor Kovalenko
        if (page_size == 8*1024) {
118 697a77e6 Igor Kovalenko
            va &= ~(1ULL << (13 + tsb_size));
119 697a77e6 Igor Kovalenko
        } else if (page_size == 64*1024) {
120 697a77e6 Igor Kovalenko
            va |= (1ULL << (13 + tsb_size));
121 697a77e6 Igor Kovalenko
        }
122 697a77e6 Igor Kovalenko
        tsb_base_mask <<= 1;
123 697a77e6 Igor Kovalenko
    }
124 697a77e6 Igor Kovalenko
125 697a77e6 Igor Kovalenko
    return ((tsb_base & tsb_base_mask) | (va & ~tsb_base_mask)) & ~0xfULL;
126 697a77e6 Igor Kovalenko
}
127 697a77e6 Igor Kovalenko
128 697a77e6 Igor Kovalenko
// Calculates tag target register value by reordering bits
129 697a77e6 Igor Kovalenko
// in tag access register
130 697a77e6 Igor Kovalenko
static uint64_t ultrasparc_tag_target(uint64_t tag_access_register)
131 697a77e6 Igor Kovalenko
{
132 697a77e6 Igor Kovalenko
    return ((tag_access_register & 0x1fff) << 48) | (tag_access_register >> 22);
133 697a77e6 Igor Kovalenko
}
134 697a77e6 Igor Kovalenko
135 f707726e Igor Kovalenko
static void replace_tlb_entry(SparcTLBEntry *tlb,
136 f707726e Igor Kovalenko
                              uint64_t tlb_tag, uint64_t tlb_tte,
137 f707726e Igor Kovalenko
                              CPUState *env1)
138 6e8e7d4c Igor Kovalenko
{
139 6e8e7d4c Igor Kovalenko
    target_ulong mask, size, va, offset;
140 6e8e7d4c Igor Kovalenko
141 6e8e7d4c Igor Kovalenko
    // flush page range if translation is valid
142 f707726e Igor Kovalenko
    if (TTE_IS_VALID(tlb->tte)) {
143 6e8e7d4c Igor Kovalenko
144 6e8e7d4c Igor Kovalenko
        mask = 0xffffffffffffe000ULL;
145 6e8e7d4c Igor Kovalenko
        mask <<= 3 * ((tlb->tte >> 61) & 3);
146 6e8e7d4c Igor Kovalenko
        size = ~mask + 1;
147 6e8e7d4c Igor Kovalenko
148 6e8e7d4c Igor Kovalenko
        va = tlb->tag & mask;
149 6e8e7d4c Igor Kovalenko
150 6e8e7d4c Igor Kovalenko
        for (offset = 0; offset < size; offset += TARGET_PAGE_SIZE) {
151 6e8e7d4c Igor Kovalenko
            tlb_flush_page(env1, va + offset);
152 6e8e7d4c Igor Kovalenko
        }
153 6e8e7d4c Igor Kovalenko
    }
154 6e8e7d4c Igor Kovalenko
155 6e8e7d4c Igor Kovalenko
    tlb->tag = tlb_tag;
156 6e8e7d4c Igor Kovalenko
    tlb->tte = tlb_tte;
157 6e8e7d4c Igor Kovalenko
}
158 6e8e7d4c Igor Kovalenko
159 6e8e7d4c Igor Kovalenko
static void demap_tlb(SparcTLBEntry *tlb, target_ulong demap_addr,
160 f707726e Igor Kovalenko
                      const char* strmmu, CPUState *env1)
161 6e8e7d4c Igor Kovalenko
{
162 6e8e7d4c Igor Kovalenko
    unsigned int i;
163 6e8e7d4c Igor Kovalenko
    target_ulong mask;
164 299b520c Igor V. Kovalenko
    uint64_t context;
165 299b520c Igor V. Kovalenko
166 299b520c Igor V. Kovalenko
    int is_demap_context = (demap_addr >> 6) & 1;
167 299b520c Igor V. Kovalenko
168 299b520c Igor V. Kovalenko
    // demap context
169 299b520c Igor V. Kovalenko
    switch ((demap_addr >> 4) & 3) {
170 299b520c Igor V. Kovalenko
    case 0: // primary
171 299b520c Igor V. Kovalenko
        context = env1->dmmu.mmu_primary_context;
172 299b520c Igor V. Kovalenko
        break;
173 299b520c Igor V. Kovalenko
    case 1: // secondary
174 299b520c Igor V. Kovalenko
        context = env1->dmmu.mmu_secondary_context;
175 299b520c Igor V. Kovalenko
        break;
176 299b520c Igor V. Kovalenko
    case 2: // nucleus
177 299b520c Igor V. Kovalenko
        context = 0;
178 299b520c Igor V. Kovalenko
        break;
179 299b520c Igor V. Kovalenko
    case 3: // reserved
180 299b520c Igor V. Kovalenko
    default:
181 299b520c Igor V. Kovalenko
        return;
182 299b520c Igor V. Kovalenko
    }
183 6e8e7d4c Igor Kovalenko
184 6e8e7d4c Igor Kovalenko
    for (i = 0; i < 64; i++) {
185 f707726e Igor Kovalenko
        if (TTE_IS_VALID(tlb[i].tte)) {
186 6e8e7d4c Igor Kovalenko
187 299b520c Igor V. Kovalenko
            if (is_demap_context) {
188 299b520c Igor V. Kovalenko
                // will remove non-global entries matching context value
189 299b520c Igor V. Kovalenko
                if (TTE_IS_GLOBAL(tlb[i].tte) ||
190 299b520c Igor V. Kovalenko
                    !tlb_compare_context(&tlb[i], context)) {
191 299b520c Igor V. Kovalenko
                    continue;
192 299b520c Igor V. Kovalenko
                }
193 299b520c Igor V. Kovalenko
            } else {
194 299b520c Igor V. Kovalenko
                // demap page
195 299b520c Igor V. Kovalenko
                // will remove any entry matching VA
196 299b520c Igor V. Kovalenko
                mask = 0xffffffffffffe000ULL;
197 299b520c Igor V. Kovalenko
                mask <<= 3 * ((tlb[i].tte >> 61) & 3);
198 299b520c Igor V. Kovalenko
199 299b520c Igor V. Kovalenko
                if (!compare_masked(demap_addr, tlb[i].tag, mask)) {
200 299b520c Igor V. Kovalenko
                    continue;
201 299b520c Igor V. Kovalenko
                }
202 299b520c Igor V. Kovalenko
203 299b520c Igor V. Kovalenko
                // entry should be global or matching context value
204 299b520c Igor V. Kovalenko
                if (!TTE_IS_GLOBAL(tlb[i].tte) &&
205 299b520c Igor V. Kovalenko
                    !tlb_compare_context(&tlb[i], context)) {
206 299b520c Igor V. Kovalenko
                    continue;
207 299b520c Igor V. Kovalenko
                }
208 299b520c Igor V. Kovalenko
            }
209 6e8e7d4c Igor Kovalenko
210 299b520c Igor V. Kovalenko
            replace_tlb_entry(&tlb[i], 0, 0, env1);
211 6e8e7d4c Igor Kovalenko
#ifdef DEBUG_MMU
212 299b520c Igor V. Kovalenko
            DPRINTF_MMU("%s demap invalidated entry [%02u]\n", strmmu, i);
213 d41160a3 Blue Swirl
            dump_mmu(stdout, fprintf, env1);
214 6e8e7d4c Igor Kovalenko
#endif
215 6e8e7d4c Igor Kovalenko
        }
216 6e8e7d4c Igor Kovalenko
    }
217 6e8e7d4c Igor Kovalenko
}
218 6e8e7d4c Igor Kovalenko
219 f707726e Igor Kovalenko
static void replace_tlb_1bit_lru(SparcTLBEntry *tlb,
220 f707726e Igor Kovalenko
                                 uint64_t tlb_tag, uint64_t tlb_tte,
221 f707726e Igor Kovalenko
                                 const char* strmmu, CPUState *env1)
222 f707726e Igor Kovalenko
{
223 f707726e Igor Kovalenko
    unsigned int i, replace_used;
224 f707726e Igor Kovalenko
225 f707726e Igor Kovalenko
    // Try replacing invalid entry
226 f707726e Igor Kovalenko
    for (i = 0; i < 64; i++) {
227 f707726e Igor Kovalenko
        if (!TTE_IS_VALID(tlb[i].tte)) {
228 f707726e Igor Kovalenko
            replace_tlb_entry(&tlb[i], tlb_tag, tlb_tte, env1);
229 f707726e Igor Kovalenko
#ifdef DEBUG_MMU
230 f707726e Igor Kovalenko
            DPRINTF_MMU("%s lru replaced invalid entry [%i]\n", strmmu, i);
231 d41160a3 Blue Swirl
            dump_mmu(stdout, fprintf, env1);
232 f707726e Igor Kovalenko
#endif
233 f707726e Igor Kovalenko
            return;
234 f707726e Igor Kovalenko
        }
235 f707726e Igor Kovalenko
    }
236 f707726e Igor Kovalenko
237 f707726e Igor Kovalenko
    // All entries are valid, try replacing unlocked entry
238 f707726e Igor Kovalenko
239 f707726e Igor Kovalenko
    for (replace_used = 0; replace_used < 2; ++replace_used) {
240 f707726e Igor Kovalenko
241 f707726e Igor Kovalenko
        // Used entries are not replaced on first pass
242 f707726e Igor Kovalenko
243 f707726e Igor Kovalenko
        for (i = 0; i < 64; i++) {
244 f707726e Igor Kovalenko
            if (!TTE_IS_LOCKED(tlb[i].tte) && !TTE_IS_USED(tlb[i].tte)) {
245 f707726e Igor Kovalenko
246 f707726e Igor Kovalenko
                replace_tlb_entry(&tlb[i], tlb_tag, tlb_tte, env1);
247 f707726e Igor Kovalenko
#ifdef DEBUG_MMU
248 f707726e Igor Kovalenko
                DPRINTF_MMU("%s lru replaced unlocked %s entry [%i]\n",
249 f707726e Igor Kovalenko
                            strmmu, (replace_used?"used":"unused"), i);
250 d41160a3 Blue Swirl
                dump_mmu(stdout, fprintf, env1);
251 f707726e Igor Kovalenko
#endif
252 f707726e Igor Kovalenko
                return;
253 f707726e Igor Kovalenko
            }
254 f707726e Igor Kovalenko
        }
255 f707726e Igor Kovalenko
256 f707726e Igor Kovalenko
        // Now reset used bit and search for unused entries again
257 f707726e Igor Kovalenko
258 f707726e Igor Kovalenko
        for (i = 0; i < 64; i++) {
259 f707726e Igor Kovalenko
            TTE_SET_UNUSED(tlb[i].tte);
260 f707726e Igor Kovalenko
        }
261 f707726e Igor Kovalenko
    }
262 f707726e Igor Kovalenko
263 f707726e Igor Kovalenko
#ifdef DEBUG_MMU
264 f707726e Igor Kovalenko
    DPRINTF_MMU("%s lru replacement failed: no entries available\n", strmmu);
265 f707726e Igor Kovalenko
#endif
266 f707726e Igor Kovalenko
    // error state?
267 f707726e Igor Kovalenko
}
268 f707726e Igor Kovalenko
269 697a77e6 Igor Kovalenko
#endif
270 697a77e6 Igor Kovalenko
271 41db525e Richard Henderson
static inline target_ulong address_mask(CPUState *env1, target_ulong addr)
272 2cade6a3 blueswir1
{
273 2cade6a3 blueswir1
#ifdef TARGET_SPARC64
274 2cade6a3 blueswir1
    if (AM_CHECK(env1))
275 41db525e Richard Henderson
        addr &= 0xffffffffULL;
276 2cade6a3 blueswir1
#endif
277 41db525e Richard Henderson
    return addr;
278 2cade6a3 blueswir1
}
279 2cade6a3 blueswir1
280 1295001c Igor V. Kovalenko
/* returns true if access using this ASI is to have address translated by MMU
281 1295001c Igor V. Kovalenko
   otherwise access is to raw physical address */
282 1295001c Igor V. Kovalenko
static inline int is_translating_asi(int asi)
283 1295001c Igor V. Kovalenko
{
284 1295001c Igor V. Kovalenko
#ifdef TARGET_SPARC64
285 1295001c Igor V. Kovalenko
    /* Ultrasparc IIi translating asi
286 1295001c Igor V. Kovalenko
       - note this list is defined by cpu implementation
287 1295001c Igor V. Kovalenko
     */
288 1295001c Igor V. Kovalenko
    switch (asi) {
289 1295001c Igor V. Kovalenko
    case 0x04 ... 0x11:
290 1295001c Igor V. Kovalenko
    case 0x18 ... 0x19:
291 1295001c Igor V. Kovalenko
    case 0x24 ... 0x2C:
292 1295001c Igor V. Kovalenko
    case 0x70 ... 0x73:
293 1295001c Igor V. Kovalenko
    case 0x78 ... 0x79:
294 1295001c Igor V. Kovalenko
    case 0x80 ... 0xFF:
295 1295001c Igor V. Kovalenko
        return 1;
296 1295001c Igor V. Kovalenko
297 1295001c Igor V. Kovalenko
    default:
298 1295001c Igor V. Kovalenko
        return 0;
299 1295001c Igor V. Kovalenko
    }
300 1295001c Igor V. Kovalenko
#else
301 1295001c Igor V. Kovalenko
    /* TODO: check sparc32 bits */
302 1295001c Igor V. Kovalenko
    return 0;
303 1295001c Igor V. Kovalenko
#endif
304 1295001c Igor V. Kovalenko
}
305 1295001c Igor V. Kovalenko
306 1295001c Igor V. Kovalenko
static inline target_ulong asi_address_mask(CPUState *env1,
307 1295001c Igor V. Kovalenko
                                            int asi, target_ulong addr)
308 1295001c Igor V. Kovalenko
{
309 1295001c Igor V. Kovalenko
    if (is_translating_asi(asi)) {
310 1295001c Igor V. Kovalenko
        return address_mask(env, addr);
311 1295001c Igor V. Kovalenko
    } else {
312 1295001c Igor V. Kovalenko
        return addr;
313 1295001c Igor V. Kovalenko
    }
314 1295001c Igor V. Kovalenko
}
315 1295001c Igor V. Kovalenko
316 f4a5a5ba blueswir1
static void raise_exception(int tt)
317 9d893301 bellard
{
318 9d893301 bellard
    env->exception_index = tt;
319 9d893301 bellard
    cpu_loop_exit();
320 3b46e624 ths
}
321 9d893301 bellard
322 a7812ae4 pbrook
void HELPER(raise_exception)(int tt)
323 a7812ae4 pbrook
{
324 a7812ae4 pbrook
    raise_exception(tt);
325 a7812ae4 pbrook
}
326 a7812ae4 pbrook
327 b04d9890 Fabien Chouteau
void helper_shutdown(void)
328 b04d9890 Fabien Chouteau
{
329 b04d9890 Fabien Chouteau
#if !defined(CONFIG_USER_ONLY)
330 b04d9890 Fabien Chouteau
    qemu_system_shutdown_request();
331 b04d9890 Fabien Chouteau
#endif
332 b04d9890 Fabien Chouteau
}
333 b04d9890 Fabien Chouteau
334 2b29924f blueswir1
void helper_check_align(target_ulong addr, uint32_t align)
335 2b29924f blueswir1
{
336 c2bc0e38 blueswir1
    if (addr & align) {
337 c2bc0e38 blueswir1
#ifdef DEBUG_UNALIGNED
338 c2bc0e38 blueswir1
    printf("Unaligned access to 0x" TARGET_FMT_lx " from 0x" TARGET_FMT_lx
339 c2bc0e38 blueswir1
           "\n", addr, env->pc);
340 c2bc0e38 blueswir1
#endif
341 2b29924f blueswir1
        raise_exception(TT_UNALIGNED);
342 c2bc0e38 blueswir1
    }
343 2b29924f blueswir1
}
344 2b29924f blueswir1
345 44e7757c blueswir1
#define F_HELPER(name, p) void helper_f##name##p(void)
346 44e7757c blueswir1
347 44e7757c blueswir1
#define F_BINOP(name)                                           \
348 714547bb blueswir1
    float32 helper_f ## name ## s (float32 src1, float32 src2)  \
349 44e7757c blueswir1
    {                                                           \
350 714547bb blueswir1
        return float32_ ## name (src1, src2, &env->fp_status);  \
351 44e7757c blueswir1
    }                                                           \
352 44e7757c blueswir1
    F_HELPER(name, d)                                           \
353 44e7757c blueswir1
    {                                                           \
354 44e7757c blueswir1
        DT0 = float64_ ## name (DT0, DT1, &env->fp_status);     \
355 4e14008f blueswir1
    }                                                           \
356 4e14008f blueswir1
    F_HELPER(name, q)                                           \
357 4e14008f blueswir1
    {                                                           \
358 4e14008f blueswir1
        QT0 = float128_ ## name (QT0, QT1, &env->fp_status);    \
359 44e7757c blueswir1
    }
360 44e7757c blueswir1
361 44e7757c blueswir1
F_BINOP(add);
362 44e7757c blueswir1
F_BINOP(sub);
363 44e7757c blueswir1
F_BINOP(mul);
364 44e7757c blueswir1
F_BINOP(div);
365 44e7757c blueswir1
#undef F_BINOP
366 44e7757c blueswir1
367 d84763bc blueswir1
void helper_fsmuld(float32 src1, float32 src2)
368 1a2fb1c0 blueswir1
{
369 d84763bc blueswir1
    DT0 = float64_mul(float32_to_float64(src1, &env->fp_status),
370 d84763bc blueswir1
                      float32_to_float64(src2, &env->fp_status),
371 44e7757c blueswir1
                      &env->fp_status);
372 44e7757c blueswir1
}
373 1a2fb1c0 blueswir1
374 4e14008f blueswir1
void helper_fdmulq(void)
375 4e14008f blueswir1
{
376 4e14008f blueswir1
    QT0 = float128_mul(float64_to_float128(DT0, &env->fp_status),
377 4e14008f blueswir1
                       float64_to_float128(DT1, &env->fp_status),
378 4e14008f blueswir1
                       &env->fp_status);
379 4e14008f blueswir1
}
380 4e14008f blueswir1
381 714547bb blueswir1
float32 helper_fnegs(float32 src)
382 44e7757c blueswir1
{
383 714547bb blueswir1
    return float32_chs(src);
384 417454b0 blueswir1
}
385 417454b0 blueswir1
386 44e7757c blueswir1
#ifdef TARGET_SPARC64
387 44e7757c blueswir1
F_HELPER(neg, d)
388 7e8c2b6c blueswir1
{
389 44e7757c blueswir1
    DT0 = float64_chs(DT1);
390 7e8c2b6c blueswir1
}
391 4e14008f blueswir1
392 4e14008f blueswir1
F_HELPER(neg, q)
393 4e14008f blueswir1
{
394 4e14008f blueswir1
    QT0 = float128_chs(QT1);
395 4e14008f blueswir1
}
396 4e14008f blueswir1
#endif
397 44e7757c blueswir1
398 44e7757c blueswir1
/* Integer to float conversion.  */
399 714547bb blueswir1
float32 helper_fitos(int32_t src)
400 a0c4cb4a bellard
{
401 714547bb blueswir1
    return int32_to_float32(src, &env->fp_status);
402 a0c4cb4a bellard
}
403 a0c4cb4a bellard
404 d84763bc blueswir1
void helper_fitod(int32_t src)
405 a0c4cb4a bellard
{
406 d84763bc blueswir1
    DT0 = int32_to_float64(src, &env->fp_status);
407 a0c4cb4a bellard
}
408 9c2b428e blueswir1
409 c5d04e99 blueswir1
void helper_fitoq(int32_t src)
410 4e14008f blueswir1
{
411 c5d04e99 blueswir1
    QT0 = int32_to_float128(src, &env->fp_status);
412 4e14008f blueswir1
}
413 4e14008f blueswir1
414 1e64e78d blueswir1
#ifdef TARGET_SPARC64
415 d84763bc blueswir1
float32 helper_fxtos(void)
416 1e64e78d blueswir1
{
417 d84763bc blueswir1
    return int64_to_float32(*((int64_t *)&DT1), &env->fp_status);
418 1e64e78d blueswir1
}
419 1e64e78d blueswir1
420 44e7757c blueswir1
F_HELPER(xto, d)
421 1e64e78d blueswir1
{
422 1e64e78d blueswir1
    DT0 = int64_to_float64(*((int64_t *)&DT1), &env->fp_status);
423 1e64e78d blueswir1
}
424 64a88d5d blueswir1
425 4e14008f blueswir1
F_HELPER(xto, q)
426 4e14008f blueswir1
{
427 4e14008f blueswir1
    QT0 = int64_to_float128(*((int64_t *)&DT1), &env->fp_status);
428 4e14008f blueswir1
}
429 4e14008f blueswir1
#endif
430 44e7757c blueswir1
#undef F_HELPER
431 44e7757c blueswir1
432 44e7757c blueswir1
/* floating point conversion */
433 d84763bc blueswir1
float32 helper_fdtos(void)
434 44e7757c blueswir1
{
435 d84763bc blueswir1
    return float64_to_float32(DT1, &env->fp_status);
436 44e7757c blueswir1
}
437 44e7757c blueswir1
438 d84763bc blueswir1
void helper_fstod(float32 src)
439 44e7757c blueswir1
{
440 d84763bc blueswir1
    DT0 = float32_to_float64(src, &env->fp_status);
441 44e7757c blueswir1
}
442 9c2b428e blueswir1
443 c5d04e99 blueswir1
float32 helper_fqtos(void)
444 4e14008f blueswir1
{
445 c5d04e99 blueswir1
    return float128_to_float32(QT1, &env->fp_status);
446 4e14008f blueswir1
}
447 4e14008f blueswir1
448 c5d04e99 blueswir1
void helper_fstoq(float32 src)
449 4e14008f blueswir1
{
450 c5d04e99 blueswir1
    QT0 = float32_to_float128(src, &env->fp_status);
451 4e14008f blueswir1
}
452 4e14008f blueswir1
453 4e14008f blueswir1
void helper_fqtod(void)
454 4e14008f blueswir1
{
455 4e14008f blueswir1
    DT0 = float128_to_float64(QT1, &env->fp_status);
456 4e14008f blueswir1
}
457 4e14008f blueswir1
458 4e14008f blueswir1
void helper_fdtoq(void)
459 4e14008f blueswir1
{
460 4e14008f blueswir1
    QT0 = float64_to_float128(DT1, &env->fp_status);
461 4e14008f blueswir1
}
462 4e14008f blueswir1
463 44e7757c blueswir1
/* Float to integer conversion.  */
464 714547bb blueswir1
int32_t helper_fstoi(float32 src)
465 44e7757c blueswir1
{
466 714547bb blueswir1
    return float32_to_int32_round_to_zero(src, &env->fp_status);
467 44e7757c blueswir1
}
468 44e7757c blueswir1
469 d84763bc blueswir1
int32_t helper_fdtoi(void)
470 44e7757c blueswir1
{
471 d84763bc blueswir1
    return float64_to_int32_round_to_zero(DT1, &env->fp_status);
472 44e7757c blueswir1
}
473 44e7757c blueswir1
474 c5d04e99 blueswir1
int32_t helper_fqtoi(void)
475 4e14008f blueswir1
{
476 c5d04e99 blueswir1
    return float128_to_int32_round_to_zero(QT1, &env->fp_status);
477 4e14008f blueswir1
}
478 4e14008f blueswir1
479 44e7757c blueswir1
#ifdef TARGET_SPARC64
480 d84763bc blueswir1
void helper_fstox(float32 src)
481 44e7757c blueswir1
{
482 d84763bc blueswir1
    *((int64_t *)&DT0) = float32_to_int64_round_to_zero(src, &env->fp_status);
483 44e7757c blueswir1
}
484 44e7757c blueswir1
485 44e7757c blueswir1
void helper_fdtox(void)
486 44e7757c blueswir1
{
487 44e7757c blueswir1
    *((int64_t *)&DT0) = float64_to_int64_round_to_zero(DT1, &env->fp_status);
488 44e7757c blueswir1
}
489 44e7757c blueswir1
490 4e14008f blueswir1
void helper_fqtox(void)
491 4e14008f blueswir1
{
492 4e14008f blueswir1
    *((int64_t *)&DT0) = float128_to_int64_round_to_zero(QT1, &env->fp_status);
493 4e14008f blueswir1
}
494 4e14008f blueswir1
495 44e7757c blueswir1
void helper_faligndata(void)
496 44e7757c blueswir1
{
497 44e7757c blueswir1
    uint64_t tmp;
498 44e7757c blueswir1
499 44e7757c blueswir1
    tmp = (*((uint64_t *)&DT0)) << ((env->gsr & 7) * 8);
500 06057e6f blueswir1
    /* on many architectures a shift of 64 does nothing */
501 06057e6f blueswir1
    if ((env->gsr & 7) != 0) {
502 06057e6f blueswir1
        tmp |= (*((uint64_t *)&DT1)) >> (64 - (env->gsr & 7) * 8);
503 06057e6f blueswir1
    }
504 44e7757c blueswir1
    *((uint64_t *)&DT0) = tmp;
505 44e7757c blueswir1
}
506 44e7757c blueswir1
507 e2542fe2 Juan Quintela
#ifdef HOST_WORDS_BIGENDIAN
508 44e7757c blueswir1
#define VIS_B64(n) b[7 - (n)]
509 44e7757c blueswir1
#define VIS_W64(n) w[3 - (n)]
510 44e7757c blueswir1
#define VIS_SW64(n) sw[3 - (n)]
511 44e7757c blueswir1
#define VIS_L64(n) l[1 - (n)]
512 44e7757c blueswir1
#define VIS_B32(n) b[3 - (n)]
513 44e7757c blueswir1
#define VIS_W32(n) w[1 - (n)]
514 44e7757c blueswir1
#else
515 44e7757c blueswir1
#define VIS_B64(n) b[n]
516 44e7757c blueswir1
#define VIS_W64(n) w[n]
517 44e7757c blueswir1
#define VIS_SW64(n) sw[n]
518 44e7757c blueswir1
#define VIS_L64(n) l[n]
519 44e7757c blueswir1
#define VIS_B32(n) b[n]
520 44e7757c blueswir1
#define VIS_W32(n) w[n]
521 44e7757c blueswir1
#endif
522 44e7757c blueswir1
523 44e7757c blueswir1
typedef union {
524 44e7757c blueswir1
    uint8_t b[8];
525 44e7757c blueswir1
    uint16_t w[4];
526 44e7757c blueswir1
    int16_t sw[4];
527 44e7757c blueswir1
    uint32_t l[2];
528 44e7757c blueswir1
    float64 d;
529 44e7757c blueswir1
} vis64;
530 44e7757c blueswir1
531 44e7757c blueswir1
typedef union {
532 44e7757c blueswir1
    uint8_t b[4];
533 44e7757c blueswir1
    uint16_t w[2];
534 44e7757c blueswir1
    uint32_t l;
535 44e7757c blueswir1
    float32 f;
536 44e7757c blueswir1
} vis32;
537 44e7757c blueswir1
538 44e7757c blueswir1
void helper_fpmerge(void)
539 44e7757c blueswir1
{
540 44e7757c blueswir1
    vis64 s, d;
541 44e7757c blueswir1
542 44e7757c blueswir1
    s.d = DT0;
543 44e7757c blueswir1
    d.d = DT1;
544 44e7757c blueswir1
545 44e7757c blueswir1
    // Reverse calculation order to handle overlap
546 44e7757c blueswir1
    d.VIS_B64(7) = s.VIS_B64(3);
547 44e7757c blueswir1
    d.VIS_B64(6) = d.VIS_B64(3);
548 44e7757c blueswir1
    d.VIS_B64(5) = s.VIS_B64(2);
549 44e7757c blueswir1
    d.VIS_B64(4) = d.VIS_B64(2);
550 44e7757c blueswir1
    d.VIS_B64(3) = s.VIS_B64(1);
551 44e7757c blueswir1
    d.VIS_B64(2) = d.VIS_B64(1);
552 44e7757c blueswir1
    d.VIS_B64(1) = s.VIS_B64(0);
553 44e7757c blueswir1
    //d.VIS_B64(0) = d.VIS_B64(0);
554 44e7757c blueswir1
555 44e7757c blueswir1
    DT0 = d.d;
556 44e7757c blueswir1
}
557 44e7757c blueswir1
558 44e7757c blueswir1
void helper_fmul8x16(void)
559 44e7757c blueswir1
{
560 44e7757c blueswir1
    vis64 s, d;
561 44e7757c blueswir1
    uint32_t tmp;
562 44e7757c blueswir1
563 44e7757c blueswir1
    s.d = DT0;
564 44e7757c blueswir1
    d.d = DT1;
565 44e7757c blueswir1
566 44e7757c blueswir1
#define PMUL(r)                                                 \
567 44e7757c blueswir1
    tmp = (int32_t)d.VIS_SW64(r) * (int32_t)s.VIS_B64(r);       \
568 44e7757c blueswir1
    if ((tmp & 0xff) > 0x7f)                                    \
569 44e7757c blueswir1
        tmp += 0x100;                                           \
570 44e7757c blueswir1
    d.VIS_W64(r) = tmp >> 8;
571 44e7757c blueswir1
572 44e7757c blueswir1
    PMUL(0);
573 44e7757c blueswir1
    PMUL(1);
574 44e7757c blueswir1
    PMUL(2);
575 44e7757c blueswir1
    PMUL(3);
576 44e7757c blueswir1
#undef PMUL
577 44e7757c blueswir1
578 44e7757c blueswir1
    DT0 = d.d;
579 44e7757c blueswir1
}
580 44e7757c blueswir1
581 44e7757c blueswir1
void helper_fmul8x16al(void)
582 44e7757c blueswir1
{
583 44e7757c blueswir1
    vis64 s, d;
584 44e7757c blueswir1
    uint32_t tmp;
585 44e7757c blueswir1
586 44e7757c blueswir1
    s.d = DT0;
587 44e7757c blueswir1
    d.d = DT1;
588 44e7757c blueswir1
589 44e7757c blueswir1
#define PMUL(r)                                                 \
590 44e7757c blueswir1
    tmp = (int32_t)d.VIS_SW64(1) * (int32_t)s.VIS_B64(r);       \
591 44e7757c blueswir1
    if ((tmp & 0xff) > 0x7f)                                    \
592 44e7757c blueswir1
        tmp += 0x100;                                           \
593 44e7757c blueswir1
    d.VIS_W64(r) = tmp >> 8;
594 44e7757c blueswir1
595 44e7757c blueswir1
    PMUL(0);
596 44e7757c blueswir1
    PMUL(1);
597 44e7757c blueswir1
    PMUL(2);
598 44e7757c blueswir1
    PMUL(3);
599 44e7757c blueswir1
#undef PMUL
600 44e7757c blueswir1
601 44e7757c blueswir1
    DT0 = d.d;
602 44e7757c blueswir1
}
603 44e7757c blueswir1
604 44e7757c blueswir1
void helper_fmul8x16au(void)
605 44e7757c blueswir1
{
606 44e7757c blueswir1
    vis64 s, d;
607 44e7757c blueswir1
    uint32_t tmp;
608 44e7757c blueswir1
609 44e7757c blueswir1
    s.d = DT0;
610 44e7757c blueswir1
    d.d = DT1;
611 44e7757c blueswir1
612 44e7757c blueswir1
#define PMUL(r)                                                 \
613 44e7757c blueswir1
    tmp = (int32_t)d.VIS_SW64(0) * (int32_t)s.VIS_B64(r);       \
614 44e7757c blueswir1
    if ((tmp & 0xff) > 0x7f)                                    \
615 44e7757c blueswir1
        tmp += 0x100;                                           \
616 44e7757c blueswir1
    d.VIS_W64(r) = tmp >> 8;
617 44e7757c blueswir1
618 44e7757c blueswir1
    PMUL(0);
619 44e7757c blueswir1
    PMUL(1);
620 44e7757c blueswir1
    PMUL(2);
621 44e7757c blueswir1
    PMUL(3);
622 44e7757c blueswir1
#undef PMUL
623 44e7757c blueswir1
624 44e7757c blueswir1
    DT0 = d.d;
625 44e7757c blueswir1
}
626 44e7757c blueswir1
627 44e7757c blueswir1
void helper_fmul8sux16(void)
628 44e7757c blueswir1
{
629 44e7757c blueswir1
    vis64 s, d;
630 44e7757c blueswir1
    uint32_t tmp;
631 44e7757c blueswir1
632 44e7757c blueswir1
    s.d = DT0;
633 44e7757c blueswir1
    d.d = DT1;
634 44e7757c blueswir1
635 44e7757c blueswir1
#define PMUL(r)                                                         \
636 44e7757c blueswir1
    tmp = (int32_t)d.VIS_SW64(r) * ((int32_t)s.VIS_SW64(r) >> 8);       \
637 44e7757c blueswir1
    if ((tmp & 0xff) > 0x7f)                                            \
638 44e7757c blueswir1
        tmp += 0x100;                                                   \
639 44e7757c blueswir1
    d.VIS_W64(r) = tmp >> 8;
640 44e7757c blueswir1
641 44e7757c blueswir1
    PMUL(0);
642 44e7757c blueswir1
    PMUL(1);
643 44e7757c blueswir1
    PMUL(2);
644 44e7757c blueswir1
    PMUL(3);
645 44e7757c blueswir1
#undef PMUL
646 44e7757c blueswir1
647 44e7757c blueswir1
    DT0 = d.d;
648 44e7757c blueswir1
}
649 44e7757c blueswir1
650 44e7757c blueswir1
void helper_fmul8ulx16(void)
651 44e7757c blueswir1
{
652 44e7757c blueswir1
    vis64 s, d;
653 44e7757c blueswir1
    uint32_t tmp;
654 44e7757c blueswir1
655 44e7757c blueswir1
    s.d = DT0;
656 44e7757c blueswir1
    d.d = DT1;
657 44e7757c blueswir1
658 44e7757c blueswir1
#define PMUL(r)                                                         \
659 44e7757c blueswir1
    tmp = (int32_t)d.VIS_SW64(r) * ((uint32_t)s.VIS_B64(r * 2));        \
660 44e7757c blueswir1
    if ((tmp & 0xff) > 0x7f)                                            \
661 44e7757c blueswir1
        tmp += 0x100;                                                   \
662 44e7757c blueswir1
    d.VIS_W64(r) = tmp >> 8;
663 44e7757c blueswir1
664 44e7757c blueswir1
    PMUL(0);
665 44e7757c blueswir1
    PMUL(1);
666 44e7757c blueswir1
    PMUL(2);
667 44e7757c blueswir1
    PMUL(3);
668 44e7757c blueswir1
#undef PMUL
669 44e7757c blueswir1
670 44e7757c blueswir1
    DT0 = d.d;
671 44e7757c blueswir1
}
672 44e7757c blueswir1
673 44e7757c blueswir1
void helper_fmuld8sux16(void)
674 44e7757c blueswir1
{
675 44e7757c blueswir1
    vis64 s, d;
676 44e7757c blueswir1
    uint32_t tmp;
677 44e7757c blueswir1
678 44e7757c blueswir1
    s.d = DT0;
679 44e7757c blueswir1
    d.d = DT1;
680 44e7757c blueswir1
681 44e7757c blueswir1
#define PMUL(r)                                                         \
682 44e7757c blueswir1
    tmp = (int32_t)d.VIS_SW64(r) * ((int32_t)s.VIS_SW64(r) >> 8);       \
683 44e7757c blueswir1
    if ((tmp & 0xff) > 0x7f)                                            \
684 44e7757c blueswir1
        tmp += 0x100;                                                   \
685 44e7757c blueswir1
    d.VIS_L64(r) = tmp;
686 44e7757c blueswir1
687 44e7757c blueswir1
    // Reverse calculation order to handle overlap
688 44e7757c blueswir1
    PMUL(1);
689 44e7757c blueswir1
    PMUL(0);
690 44e7757c blueswir1
#undef PMUL
691 44e7757c blueswir1
692 44e7757c blueswir1
    DT0 = d.d;
693 44e7757c blueswir1
}
694 44e7757c blueswir1
695 44e7757c blueswir1
void helper_fmuld8ulx16(void)
696 44e7757c blueswir1
{
697 44e7757c blueswir1
    vis64 s, d;
698 44e7757c blueswir1
    uint32_t tmp;
699 44e7757c blueswir1
700 44e7757c blueswir1
    s.d = DT0;
701 44e7757c blueswir1
    d.d = DT1;
702 44e7757c blueswir1
703 44e7757c blueswir1
#define PMUL(r)                                                         \
704 44e7757c blueswir1
    tmp = (int32_t)d.VIS_SW64(r) * ((uint32_t)s.VIS_B64(r * 2));        \
705 44e7757c blueswir1
    if ((tmp & 0xff) > 0x7f)                                            \
706 44e7757c blueswir1
        tmp += 0x100;                                                   \
707 44e7757c blueswir1
    d.VIS_L64(r) = tmp;
708 44e7757c blueswir1
709 44e7757c blueswir1
    // Reverse calculation order to handle overlap
710 44e7757c blueswir1
    PMUL(1);
711 44e7757c blueswir1
    PMUL(0);
712 44e7757c blueswir1
#undef PMUL
713 44e7757c blueswir1
714 44e7757c blueswir1
    DT0 = d.d;
715 44e7757c blueswir1
}
716 44e7757c blueswir1
717 44e7757c blueswir1
void helper_fexpand(void)
718 44e7757c blueswir1
{
719 44e7757c blueswir1
    vis32 s;
720 44e7757c blueswir1
    vis64 d;
721 44e7757c blueswir1
722 44e7757c blueswir1
    s.l = (uint32_t)(*(uint64_t *)&DT0 & 0xffffffff);
723 44e7757c blueswir1
    d.d = DT1;
724 c55bda30 blueswir1
    d.VIS_W64(0) = s.VIS_B32(0) << 4;
725 c55bda30 blueswir1
    d.VIS_W64(1) = s.VIS_B32(1) << 4;
726 c55bda30 blueswir1
    d.VIS_W64(2) = s.VIS_B32(2) << 4;
727 c55bda30 blueswir1
    d.VIS_W64(3) = s.VIS_B32(3) << 4;
728 44e7757c blueswir1
729 44e7757c blueswir1
    DT0 = d.d;
730 44e7757c blueswir1
}
731 44e7757c blueswir1
732 44e7757c blueswir1
#define VIS_HELPER(name, F)                             \
733 44e7757c blueswir1
    void name##16(void)                                 \
734 44e7757c blueswir1
    {                                                   \
735 44e7757c blueswir1
        vis64 s, d;                                     \
736 44e7757c blueswir1
                                                        \
737 44e7757c blueswir1
        s.d = DT0;                                      \
738 44e7757c blueswir1
        d.d = DT1;                                      \
739 44e7757c blueswir1
                                                        \
740 44e7757c blueswir1
        d.VIS_W64(0) = F(d.VIS_W64(0), s.VIS_W64(0));   \
741 44e7757c blueswir1
        d.VIS_W64(1) = F(d.VIS_W64(1), s.VIS_W64(1));   \
742 44e7757c blueswir1
        d.VIS_W64(2) = F(d.VIS_W64(2), s.VIS_W64(2));   \
743 44e7757c blueswir1
        d.VIS_W64(3) = F(d.VIS_W64(3), s.VIS_W64(3));   \
744 44e7757c blueswir1
                                                        \
745 44e7757c blueswir1
        DT0 = d.d;                                      \
746 44e7757c blueswir1
    }                                                   \
747 44e7757c blueswir1
                                                        \
748 1d01299d blueswir1
    uint32_t name##16s(uint32_t src1, uint32_t src2)    \
749 44e7757c blueswir1
    {                                                   \
750 44e7757c blueswir1
        vis32 s, d;                                     \
751 44e7757c blueswir1
                                                        \
752 1d01299d blueswir1
        s.l = src1;                                     \
753 1d01299d blueswir1
        d.l = src2;                                     \
754 44e7757c blueswir1
                                                        \
755 44e7757c blueswir1
        d.VIS_W32(0) = F(d.VIS_W32(0), s.VIS_W32(0));   \
756 44e7757c blueswir1
        d.VIS_W32(1) = F(d.VIS_W32(1), s.VIS_W32(1));   \
757 44e7757c blueswir1
                                                        \
758 1d01299d blueswir1
        return d.l;                                     \
759 44e7757c blueswir1
    }                                                   \
760 44e7757c blueswir1
                                                        \
761 44e7757c blueswir1
    void name##32(void)                                 \
762 44e7757c blueswir1
    {                                                   \
763 44e7757c blueswir1
        vis64 s, d;                                     \
764 44e7757c blueswir1
                                                        \
765 44e7757c blueswir1
        s.d = DT0;                                      \
766 44e7757c blueswir1
        d.d = DT1;                                      \
767 44e7757c blueswir1
                                                        \
768 44e7757c blueswir1
        d.VIS_L64(0) = F(d.VIS_L64(0), s.VIS_L64(0));   \
769 44e7757c blueswir1
        d.VIS_L64(1) = F(d.VIS_L64(1), s.VIS_L64(1));   \
770 44e7757c blueswir1
                                                        \
771 44e7757c blueswir1
        DT0 = d.d;                                      \
772 44e7757c blueswir1
    }                                                   \
773 44e7757c blueswir1
                                                        \
774 1d01299d blueswir1
    uint32_t name##32s(uint32_t src1, uint32_t src2)    \
775 44e7757c blueswir1
    {                                                   \
776 44e7757c blueswir1
        vis32 s, d;                                     \
777 44e7757c blueswir1
                                                        \
778 1d01299d blueswir1
        s.l = src1;                                     \
779 1d01299d blueswir1
        d.l = src2;                                     \
780 44e7757c blueswir1
                                                        \
781 44e7757c blueswir1
        d.l = F(d.l, s.l);                              \
782 44e7757c blueswir1
                                                        \
783 1d01299d blueswir1
        return d.l;                                     \
784 44e7757c blueswir1
    }
785 44e7757c blueswir1
786 44e7757c blueswir1
#define FADD(a, b) ((a) + (b))
787 44e7757c blueswir1
#define FSUB(a, b) ((a) - (b))
788 44e7757c blueswir1
VIS_HELPER(helper_fpadd, FADD)
789 44e7757c blueswir1
VIS_HELPER(helper_fpsub, FSUB)
790 44e7757c blueswir1
791 44e7757c blueswir1
#define VIS_CMPHELPER(name, F)                                        \
792 44e7757c blueswir1
    void name##16(void)                                           \
793 44e7757c blueswir1
    {                                                             \
794 44e7757c blueswir1
        vis64 s, d;                                               \
795 44e7757c blueswir1
                                                                  \
796 44e7757c blueswir1
        s.d = DT0;                                                \
797 44e7757c blueswir1
        d.d = DT1;                                                \
798 44e7757c blueswir1
                                                                  \
799 44e7757c blueswir1
        d.VIS_W64(0) = F(d.VIS_W64(0), s.VIS_W64(0))? 1: 0;       \
800 44e7757c blueswir1
        d.VIS_W64(0) |= F(d.VIS_W64(1), s.VIS_W64(1))? 2: 0;      \
801 44e7757c blueswir1
        d.VIS_W64(0) |= F(d.VIS_W64(2), s.VIS_W64(2))? 4: 0;      \
802 44e7757c blueswir1
        d.VIS_W64(0) |= F(d.VIS_W64(3), s.VIS_W64(3))? 8: 0;      \
803 44e7757c blueswir1
                                                                  \
804 44e7757c blueswir1
        DT0 = d.d;                                                \
805 44e7757c blueswir1
    }                                                             \
806 44e7757c blueswir1
                                                                  \
807 44e7757c blueswir1
    void name##32(void)                                           \
808 44e7757c blueswir1
    {                                                             \
809 44e7757c blueswir1
        vis64 s, d;                                               \
810 44e7757c blueswir1
                                                                  \
811 44e7757c blueswir1
        s.d = DT0;                                                \
812 44e7757c blueswir1
        d.d = DT1;                                                \
813 44e7757c blueswir1
                                                                  \
814 44e7757c blueswir1
        d.VIS_L64(0) = F(d.VIS_L64(0), s.VIS_L64(0))? 1: 0;       \
815 44e7757c blueswir1
        d.VIS_L64(0) |= F(d.VIS_L64(1), s.VIS_L64(1))? 2: 0;      \
816 44e7757c blueswir1
                                                                  \
817 44e7757c blueswir1
        DT0 = d.d;                                                \
818 44e7757c blueswir1
    }
819 44e7757c blueswir1
820 44e7757c blueswir1
#define FCMPGT(a, b) ((a) > (b))
821 44e7757c blueswir1
#define FCMPEQ(a, b) ((a) == (b))
822 44e7757c blueswir1
#define FCMPLE(a, b) ((a) <= (b))
823 44e7757c blueswir1
#define FCMPNE(a, b) ((a) != (b))
824 44e7757c blueswir1
825 44e7757c blueswir1
VIS_CMPHELPER(helper_fcmpgt, FCMPGT)
826 44e7757c blueswir1
VIS_CMPHELPER(helper_fcmpeq, FCMPEQ)
827 44e7757c blueswir1
VIS_CMPHELPER(helper_fcmple, FCMPLE)
828 44e7757c blueswir1
VIS_CMPHELPER(helper_fcmpne, FCMPNE)
829 44e7757c blueswir1
#endif
830 44e7757c blueswir1
831 44e7757c blueswir1
void helper_check_ieee_exceptions(void)
832 44e7757c blueswir1
{
833 44e7757c blueswir1
    target_ulong status;
834 44e7757c blueswir1
835 44e7757c blueswir1
    status = get_float_exception_flags(&env->fp_status);
836 44e7757c blueswir1
    if (status) {
837 44e7757c blueswir1
        /* Copy IEEE 754 flags into FSR */
838 44e7757c blueswir1
        if (status & float_flag_invalid)
839 44e7757c blueswir1
            env->fsr |= FSR_NVC;
840 44e7757c blueswir1
        if (status & float_flag_overflow)
841 44e7757c blueswir1
            env->fsr |= FSR_OFC;
842 44e7757c blueswir1
        if (status & float_flag_underflow)
843 44e7757c blueswir1
            env->fsr |= FSR_UFC;
844 44e7757c blueswir1
        if (status & float_flag_divbyzero)
845 44e7757c blueswir1
            env->fsr |= FSR_DZC;
846 44e7757c blueswir1
        if (status & float_flag_inexact)
847 44e7757c blueswir1
            env->fsr |= FSR_NXC;
848 44e7757c blueswir1
849 44e7757c blueswir1
        if ((env->fsr & FSR_CEXC_MASK) & ((env->fsr & FSR_TEM_MASK) >> 23)) {
850 44e7757c blueswir1
            /* Unmasked exception, generate a trap */
851 44e7757c blueswir1
            env->fsr |= FSR_FTT_IEEE_EXCP;
852 44e7757c blueswir1
            raise_exception(TT_FP_EXCP);
853 44e7757c blueswir1
        } else {
854 44e7757c blueswir1
            /* Accumulate exceptions */
855 44e7757c blueswir1
            env->fsr |= (env->fsr & FSR_CEXC_MASK) << 5;
856 44e7757c blueswir1
        }
857 44e7757c blueswir1
    }
858 44e7757c blueswir1
}
859 44e7757c blueswir1
860 44e7757c blueswir1
void helper_clear_float_exceptions(void)
861 44e7757c blueswir1
{
862 44e7757c blueswir1
    set_float_exception_flags(0, &env->fp_status);
863 44e7757c blueswir1
}
864 44e7757c blueswir1
865 714547bb blueswir1
float32 helper_fabss(float32 src)
866 e8af50a3 bellard
{
867 714547bb blueswir1
    return float32_abs(src);
868 e8af50a3 bellard
}
869 e8af50a3 bellard
870 3475187d bellard
#ifdef TARGET_SPARC64
871 7e8c2b6c blueswir1
void helper_fabsd(void)
872 3475187d bellard
{
873 3475187d bellard
    DT0 = float64_abs(DT1);
874 3475187d bellard
}
875 4e14008f blueswir1
876 4e14008f blueswir1
void helper_fabsq(void)
877 4e14008f blueswir1
{
878 4e14008f blueswir1
    QT0 = float128_abs(QT1);
879 4e14008f blueswir1
}
880 4e14008f blueswir1
#endif
881 3475187d bellard
882 714547bb blueswir1
float32 helper_fsqrts(float32 src)
883 e8af50a3 bellard
{
884 714547bb blueswir1
    return float32_sqrt(src, &env->fp_status);
885 e8af50a3 bellard
}
886 e8af50a3 bellard
887 7e8c2b6c blueswir1
void helper_fsqrtd(void)
888 e8af50a3 bellard
{
889 7a0e1f41 bellard
    DT0 = float64_sqrt(DT1, &env->fp_status);
890 e8af50a3 bellard
}
891 e8af50a3 bellard
892 4e14008f blueswir1
void helper_fsqrtq(void)
893 4e14008f blueswir1
{
894 4e14008f blueswir1
    QT0 = float128_sqrt(QT1, &env->fp_status);
895 4e14008f blueswir1
}
896 4e14008f blueswir1
897 1b5f56b1 Blue Swirl
#define GEN_FCMP(name, size, reg1, reg2, FS, E)                         \
898 7e8c2b6c blueswir1
    void glue(helper_, name) (void)                                     \
899 65ce8c2f bellard
    {                                                                   \
900 1b5f56b1 Blue Swirl
        env->fsr &= FSR_FTT_NMASK;                                      \
901 1b5f56b1 Blue Swirl
        if (E && (glue(size, _is_any_nan)(reg1) ||                      \
902 1b5f56b1 Blue Swirl
                     glue(size, _is_any_nan)(reg2)) &&                  \
903 1b5f56b1 Blue Swirl
            (env->fsr & FSR_NVM)) {                                     \
904 1b5f56b1 Blue Swirl
            env->fsr |= FSR_NVC;                                        \
905 1b5f56b1 Blue Swirl
            env->fsr |= FSR_FTT_IEEE_EXCP;                              \
906 1b5f56b1 Blue Swirl
            raise_exception(TT_FP_EXCP);                                \
907 1b5f56b1 Blue Swirl
        }                                                               \
908 65ce8c2f bellard
        switch (glue(size, _compare) (reg1, reg2, &env->fp_status)) {   \
909 65ce8c2f bellard
        case float_relation_unordered:                                  \
910 1b5f56b1 Blue Swirl
            if ((env->fsr & FSR_NVM)) {                                 \
911 417454b0 blueswir1
                env->fsr |= FSR_NVC;                                    \
912 417454b0 blueswir1
                env->fsr |= FSR_FTT_IEEE_EXCP;                          \
913 65ce8c2f bellard
                raise_exception(TT_FP_EXCP);                            \
914 65ce8c2f bellard
            } else {                                                    \
915 1b5f56b1 Blue Swirl
                env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);             \
916 1b5f56b1 Blue Swirl
                env->fsr |= (FSR_FCC1 | FSR_FCC0) << FS;                \
917 65ce8c2f bellard
                env->fsr |= FSR_NVA;                                    \
918 65ce8c2f bellard
            }                                                           \
919 65ce8c2f bellard
            break;                                                      \
920 65ce8c2f bellard
        case float_relation_less:                                       \
921 1b5f56b1 Blue Swirl
            env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                 \
922 1b5f56b1 Blue Swirl
            env->fsr |= FSR_FCC0 << FS;                                 \
923 65ce8c2f bellard
            break;                                                      \
924 65ce8c2f bellard
        case float_relation_greater:                                    \
925 1b5f56b1 Blue Swirl
            env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                 \
926 1b5f56b1 Blue Swirl
            env->fsr |= FSR_FCC1 << FS;                                 \
927 65ce8c2f bellard
            break;                                                      \
928 65ce8c2f bellard
        default:                                                        \
929 1b5f56b1 Blue Swirl
            env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                 \
930 65ce8c2f bellard
            break;                                                      \
931 65ce8c2f bellard
        }                                                               \
932 e8af50a3 bellard
    }
933 1b5f56b1 Blue Swirl
#define GEN_FCMPS(name, size, FS, E)                                    \
934 714547bb blueswir1
    void glue(helper_, name)(float32 src1, float32 src2)                \
935 714547bb blueswir1
    {                                                                   \
936 1b5f56b1 Blue Swirl
        env->fsr &= FSR_FTT_NMASK;                                      \
937 1b5f56b1 Blue Swirl
        if (E && (glue(size, _is_any_nan)(src1) ||                      \
938 1b5f56b1 Blue Swirl
                     glue(size, _is_any_nan)(src2)) &&                  \
939 1b5f56b1 Blue Swirl
            (env->fsr & FSR_NVM)) {                                     \
940 1b5f56b1 Blue Swirl
            env->fsr |= FSR_NVC;                                        \
941 1b5f56b1 Blue Swirl
            env->fsr |= FSR_FTT_IEEE_EXCP;                              \
942 1b5f56b1 Blue Swirl
            raise_exception(TT_FP_EXCP);                                \
943 1b5f56b1 Blue Swirl
        }                                                               \
944 714547bb blueswir1
        switch (glue(size, _compare) (src1, src2, &env->fp_status)) {   \
945 714547bb blueswir1
        case float_relation_unordered:                                  \
946 1b5f56b1 Blue Swirl
            if ((env->fsr & FSR_NVM)) {                                 \
947 714547bb blueswir1
                env->fsr |= FSR_NVC;                                    \
948 714547bb blueswir1
                env->fsr |= FSR_FTT_IEEE_EXCP;                          \
949 714547bb blueswir1
                raise_exception(TT_FP_EXCP);                            \
950 714547bb blueswir1
            } else {                                                    \
951 1b5f56b1 Blue Swirl
                env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);             \
952 1b5f56b1 Blue Swirl
                env->fsr |= (FSR_FCC1 | FSR_FCC0) << FS;                \
953 714547bb blueswir1
                env->fsr |= FSR_NVA;                                    \
954 714547bb blueswir1
            }                                                           \
955 714547bb blueswir1
            break;                                                      \
956 714547bb blueswir1
        case float_relation_less:                                       \
957 1b5f56b1 Blue Swirl
            env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                 \
958 1b5f56b1 Blue Swirl
            env->fsr |= FSR_FCC0 << FS;                                 \
959 714547bb blueswir1
            break;                                                      \
960 714547bb blueswir1
        case float_relation_greater:                                    \
961 1b5f56b1 Blue Swirl
            env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                 \
962 1b5f56b1 Blue Swirl
            env->fsr |= FSR_FCC1 << FS;                                 \
963 714547bb blueswir1
            break;                                                      \
964 714547bb blueswir1
        default:                                                        \
965 1b5f56b1 Blue Swirl
            env->fsr &= ~((FSR_FCC1 | FSR_FCC0) << FS);                 \
966 714547bb blueswir1
            break;                                                      \
967 714547bb blueswir1
        }                                                               \
968 714547bb blueswir1
    }
969 e8af50a3 bellard
970 714547bb blueswir1
GEN_FCMPS(fcmps, float32, 0, 0);
971 417454b0 blueswir1
GEN_FCMP(fcmpd, float64, DT0, DT1, 0, 0);
972 417454b0 blueswir1
973 714547bb blueswir1
GEN_FCMPS(fcmpes, float32, 0, 1);
974 417454b0 blueswir1
GEN_FCMP(fcmped, float64, DT0, DT1, 0, 1);
975 3475187d bellard
976 4e14008f blueswir1
GEN_FCMP(fcmpq, float128, QT0, QT1, 0, 0);
977 4e14008f blueswir1
GEN_FCMP(fcmpeq, float128, QT0, QT1, 0, 1);
978 4e14008f blueswir1
979 8393617c Blue Swirl
static uint32_t compute_all_flags(void)
980 8393617c Blue Swirl
{
981 8393617c Blue Swirl
    return env->psr & PSR_ICC;
982 8393617c Blue Swirl
}
983 8393617c Blue Swirl
984 8393617c Blue Swirl
static uint32_t compute_C_flags(void)
985 8393617c Blue Swirl
{
986 8393617c Blue Swirl
    return env->psr & PSR_CARRY;
987 8393617c Blue Swirl
}
988 8393617c Blue Swirl
989 5a4bb580 Richard Henderson
static inline uint32_t get_NZ_icc(int32_t dst)
990 bdf9f35d Blue Swirl
{
991 bdf9f35d Blue Swirl
    uint32_t ret = 0;
992 bdf9f35d Blue Swirl
993 5a4bb580 Richard Henderson
    if (dst == 0) {
994 5a4bb580 Richard Henderson
        ret = PSR_ZERO;
995 5a4bb580 Richard Henderson
    } else if (dst < 0) {
996 5a4bb580 Richard Henderson
        ret = PSR_NEG;
997 5a4bb580 Richard Henderson
    }
998 bdf9f35d Blue Swirl
    return ret;
999 bdf9f35d Blue Swirl
}
1000 bdf9f35d Blue Swirl
1001 8393617c Blue Swirl
#ifdef TARGET_SPARC64
1002 8393617c Blue Swirl
static uint32_t compute_all_flags_xcc(void)
1003 8393617c Blue Swirl
{
1004 8393617c Blue Swirl
    return env->xcc & PSR_ICC;
1005 8393617c Blue Swirl
}
1006 8393617c Blue Swirl
1007 8393617c Blue Swirl
static uint32_t compute_C_flags_xcc(void)
1008 8393617c Blue Swirl
{
1009 8393617c Blue Swirl
    return env->xcc & PSR_CARRY;
1010 8393617c Blue Swirl
}
1011 8393617c Blue Swirl
1012 5a4bb580 Richard Henderson
static inline uint32_t get_NZ_xcc(target_long dst)
1013 bdf9f35d Blue Swirl
{
1014 bdf9f35d Blue Swirl
    uint32_t ret = 0;
1015 bdf9f35d Blue Swirl
1016 5a4bb580 Richard Henderson
    if (!dst) {
1017 5a4bb580 Richard Henderson
        ret = PSR_ZERO;
1018 5a4bb580 Richard Henderson
    } else if (dst < 0) {
1019 5a4bb580 Richard Henderson
        ret = PSR_NEG;
1020 5a4bb580 Richard Henderson
    }
1021 bdf9f35d Blue Swirl
    return ret;
1022 bdf9f35d Blue Swirl
}
1023 bdf9f35d Blue Swirl
#endif
1024 bdf9f35d Blue Swirl
1025 6c78ea32 Blue Swirl
static inline uint32_t get_V_div_icc(target_ulong src2)
1026 6c78ea32 Blue Swirl
{
1027 6c78ea32 Blue Swirl
    uint32_t ret = 0;
1028 6c78ea32 Blue Swirl
1029 5a4bb580 Richard Henderson
    if (src2 != 0) {
1030 5a4bb580 Richard Henderson
        ret = PSR_OVF;
1031 5a4bb580 Richard Henderson
    }
1032 6c78ea32 Blue Swirl
    return ret;
1033 6c78ea32 Blue Swirl
}
1034 6c78ea32 Blue Swirl
1035 6c78ea32 Blue Swirl
static uint32_t compute_all_div(void)
1036 6c78ea32 Blue Swirl
{
1037 6c78ea32 Blue Swirl
    uint32_t ret;
1038 6c78ea32 Blue Swirl
1039 6c78ea32 Blue Swirl
    ret = get_NZ_icc(CC_DST);
1040 6c78ea32 Blue Swirl
    ret |= get_V_div_icc(CC_SRC2);
1041 6c78ea32 Blue Swirl
    return ret;
1042 6c78ea32 Blue Swirl
}
1043 6c78ea32 Blue Swirl
1044 6c78ea32 Blue Swirl
static uint32_t compute_C_div(void)
1045 6c78ea32 Blue Swirl
{
1046 6c78ea32 Blue Swirl
    return 0;
1047 6c78ea32 Blue Swirl
}
1048 6c78ea32 Blue Swirl
1049 5a4bb580 Richard Henderson
static inline uint32_t get_C_add_icc(uint32_t dst, uint32_t src1)
1050 bdf9f35d Blue Swirl
{
1051 bdf9f35d Blue Swirl
    uint32_t ret = 0;
1052 bdf9f35d Blue Swirl
1053 5a4bb580 Richard Henderson
    if (dst < src1) {
1054 5a4bb580 Richard Henderson
        ret = PSR_CARRY;
1055 5a4bb580 Richard Henderson
    }
1056 bdf9f35d Blue Swirl
    return ret;
1057 bdf9f35d Blue Swirl
}
1058 bdf9f35d Blue Swirl
1059 5a4bb580 Richard Henderson
static inline uint32_t get_C_addx_icc(uint32_t dst, uint32_t src1,
1060 5a4bb580 Richard Henderson
                                      uint32_t src2)
1061 bdf9f35d Blue Swirl
{
1062 bdf9f35d Blue Swirl
    uint32_t ret = 0;
1063 bdf9f35d Blue Swirl
1064 5a4bb580 Richard Henderson
    if (((src1 & src2) | (~dst & (src1 | src2))) & (1U << 31)) {
1065 5a4bb580 Richard Henderson
        ret = PSR_CARRY;
1066 5a4bb580 Richard Henderson
    }
1067 5a4bb580 Richard Henderson
    return ret;
1068 5a4bb580 Richard Henderson
}
1069 5a4bb580 Richard Henderson
1070 5a4bb580 Richard Henderson
static inline uint32_t get_V_add_icc(uint32_t dst, uint32_t src1,
1071 5a4bb580 Richard Henderson
                                     uint32_t src2)
1072 5a4bb580 Richard Henderson
{
1073 5a4bb580 Richard Henderson
    uint32_t ret = 0;
1074 5a4bb580 Richard Henderson
1075 5a4bb580 Richard Henderson
    if (((src1 ^ src2 ^ -1) & (src1 ^ dst)) & (1U << 31)) {
1076 5a4bb580 Richard Henderson
        ret = PSR_OVF;
1077 5a4bb580 Richard Henderson
    }
1078 bdf9f35d Blue Swirl
    return ret;
1079 bdf9f35d Blue Swirl
}
1080 bdf9f35d Blue Swirl
1081 bdf9f35d Blue Swirl
#ifdef TARGET_SPARC64
1082 bdf9f35d Blue Swirl
static inline uint32_t get_C_add_xcc(target_ulong dst, target_ulong src1)
1083 bdf9f35d Blue Swirl
{
1084 bdf9f35d Blue Swirl
    uint32_t ret = 0;
1085 bdf9f35d Blue Swirl
1086 5a4bb580 Richard Henderson
    if (dst < src1) {
1087 5a4bb580 Richard Henderson
        ret = PSR_CARRY;
1088 5a4bb580 Richard Henderson
    }
1089 5a4bb580 Richard Henderson
    return ret;
1090 5a4bb580 Richard Henderson
}
1091 5a4bb580 Richard Henderson
1092 5a4bb580 Richard Henderson
static inline uint32_t get_C_addx_xcc(target_ulong dst, target_ulong src1,
1093 5a4bb580 Richard Henderson
                                      target_ulong src2)
1094 5a4bb580 Richard Henderson
{
1095 5a4bb580 Richard Henderson
    uint32_t ret = 0;
1096 5a4bb580 Richard Henderson
1097 5a4bb580 Richard Henderson
    if (((src1 & src2) | (~dst & (src1 | src2))) & (1ULL << 63)) {
1098 5a4bb580 Richard Henderson
        ret = PSR_CARRY;
1099 5a4bb580 Richard Henderson
    }
1100 bdf9f35d Blue Swirl
    return ret;
1101 bdf9f35d Blue Swirl
}
1102 bdf9f35d Blue Swirl
1103 bdf9f35d Blue Swirl
static inline uint32_t get_V_add_xcc(target_ulong dst, target_ulong src1,
1104 bdf9f35d Blue Swirl
                                         target_ulong src2)
1105 bdf9f35d Blue Swirl
{
1106 bdf9f35d Blue Swirl
    uint32_t ret = 0;
1107 bdf9f35d Blue Swirl
1108 5a4bb580 Richard Henderson
    if (((src1 ^ src2 ^ -1) & (src1 ^ dst)) & (1ULL << 63)) {
1109 5a4bb580 Richard Henderson
        ret = PSR_OVF;
1110 5a4bb580 Richard Henderson
    }
1111 bdf9f35d Blue Swirl
    return ret;
1112 bdf9f35d Blue Swirl
}
1113 bdf9f35d Blue Swirl
1114 bdf9f35d Blue Swirl
static uint32_t compute_all_add_xcc(void)
1115 bdf9f35d Blue Swirl
{
1116 bdf9f35d Blue Swirl
    uint32_t ret;
1117 bdf9f35d Blue Swirl
1118 bdf9f35d Blue Swirl
    ret = get_NZ_xcc(CC_DST);
1119 bdf9f35d Blue Swirl
    ret |= get_C_add_xcc(CC_DST, CC_SRC);
1120 bdf9f35d Blue Swirl
    ret |= get_V_add_xcc(CC_DST, CC_SRC, CC_SRC2);
1121 bdf9f35d Blue Swirl
    return ret;
1122 bdf9f35d Blue Swirl
}
1123 bdf9f35d Blue Swirl
1124 bdf9f35d Blue Swirl
static uint32_t compute_C_add_xcc(void)
1125 bdf9f35d Blue Swirl
{
1126 bdf9f35d Blue Swirl
    return get_C_add_xcc(CC_DST, CC_SRC);
1127 bdf9f35d Blue Swirl
}
1128 8393617c Blue Swirl
#endif
1129 8393617c Blue Swirl
1130 3e6ba503 Artyom Tarasenko
static uint32_t compute_all_add(void)
1131 789c91ef Blue Swirl
{
1132 789c91ef Blue Swirl
    uint32_t ret;
1133 789c91ef Blue Swirl
1134 789c91ef Blue Swirl
    ret = get_NZ_icc(CC_DST);
1135 5a4bb580 Richard Henderson
    ret |= get_C_add_icc(CC_DST, CC_SRC);
1136 789c91ef Blue Swirl
    ret |= get_V_add_icc(CC_DST, CC_SRC, CC_SRC2);
1137 789c91ef Blue Swirl
    return ret;
1138 789c91ef Blue Swirl
}
1139 789c91ef Blue Swirl
1140 3e6ba503 Artyom Tarasenko
static uint32_t compute_C_add(void)
1141 789c91ef Blue Swirl
{
1142 5a4bb580 Richard Henderson
    return get_C_add_icc(CC_DST, CC_SRC);
1143 789c91ef Blue Swirl
}
1144 789c91ef Blue Swirl
1145 789c91ef Blue Swirl
#ifdef TARGET_SPARC64
1146 789c91ef Blue Swirl
static uint32_t compute_all_addx_xcc(void)
1147 789c91ef Blue Swirl
{
1148 789c91ef Blue Swirl
    uint32_t ret;
1149 789c91ef Blue Swirl
1150 789c91ef Blue Swirl
    ret = get_NZ_xcc(CC_DST);
1151 5a4bb580 Richard Henderson
    ret |= get_C_addx_xcc(CC_DST, CC_SRC, CC_SRC2);
1152 789c91ef Blue Swirl
    ret |= get_V_add_xcc(CC_DST, CC_SRC, CC_SRC2);
1153 789c91ef Blue Swirl
    return ret;
1154 789c91ef Blue Swirl
}
1155 789c91ef Blue Swirl
1156 789c91ef Blue Swirl
static uint32_t compute_C_addx_xcc(void)
1157 789c91ef Blue Swirl
{
1158 789c91ef Blue Swirl
    uint32_t ret;
1159 789c91ef Blue Swirl
1160 5a4bb580 Richard Henderson
    ret = get_C_addx_xcc(CC_DST, CC_SRC, CC_SRC2);
1161 789c91ef Blue Swirl
    return ret;
1162 789c91ef Blue Swirl
}
1163 789c91ef Blue Swirl
#endif
1164 789c91ef Blue Swirl
1165 5a4bb580 Richard Henderson
static uint32_t compute_all_addx(void)
1166 5a4bb580 Richard Henderson
{
1167 5a4bb580 Richard Henderson
    uint32_t ret;
1168 5a4bb580 Richard Henderson
1169 5a4bb580 Richard Henderson
    ret = get_NZ_icc(CC_DST);
1170 5a4bb580 Richard Henderson
    ret |= get_C_addx_icc(CC_DST, CC_SRC, CC_SRC2);
1171 5a4bb580 Richard Henderson
    ret |= get_V_add_icc(CC_DST, CC_SRC, CC_SRC2);
1172 5a4bb580 Richard Henderson
    return ret;
1173 5a4bb580 Richard Henderson
}
1174 5a4bb580 Richard Henderson
1175 5a4bb580 Richard Henderson
static uint32_t compute_C_addx(void)
1176 5a4bb580 Richard Henderson
{
1177 5a4bb580 Richard Henderson
    uint32_t ret;
1178 5a4bb580 Richard Henderson
1179 5a4bb580 Richard Henderson
    ret = get_C_addx_icc(CC_DST, CC_SRC, CC_SRC2);
1180 5a4bb580 Richard Henderson
    return ret;
1181 5a4bb580 Richard Henderson
}
1182 5a4bb580 Richard Henderson
1183 3b2d1e92 Blue Swirl
static inline uint32_t get_V_tag_icc(target_ulong src1, target_ulong src2)
1184 3b2d1e92 Blue Swirl
{
1185 3b2d1e92 Blue Swirl
    uint32_t ret = 0;
1186 3b2d1e92 Blue Swirl
1187 5a4bb580 Richard Henderson
    if ((src1 | src2) & 0x3) {
1188 5a4bb580 Richard Henderson
        ret = PSR_OVF;
1189 5a4bb580 Richard Henderson
    }
1190 3b2d1e92 Blue Swirl
    return ret;
1191 3b2d1e92 Blue Swirl
}
1192 3b2d1e92 Blue Swirl
1193 3b2d1e92 Blue Swirl
static uint32_t compute_all_tadd(void)
1194 3b2d1e92 Blue Swirl
{
1195 3b2d1e92 Blue Swirl
    uint32_t ret;
1196 3b2d1e92 Blue Swirl
1197 3b2d1e92 Blue Swirl
    ret = get_NZ_icc(CC_DST);
1198 5a4bb580 Richard Henderson
    ret |= get_C_add_icc(CC_DST, CC_SRC);
1199 3b2d1e92 Blue Swirl
    ret |= get_V_add_icc(CC_DST, CC_SRC, CC_SRC2);
1200 3b2d1e92 Blue Swirl
    ret |= get_V_tag_icc(CC_SRC, CC_SRC2);
1201 3b2d1e92 Blue Swirl
    return ret;
1202 3b2d1e92 Blue Swirl
}
1203 3b2d1e92 Blue Swirl
1204 3b2d1e92 Blue Swirl
static uint32_t compute_all_taddtv(void)
1205 3b2d1e92 Blue Swirl
{
1206 3b2d1e92 Blue Swirl
    uint32_t ret;
1207 3b2d1e92 Blue Swirl
1208 3b2d1e92 Blue Swirl
    ret = get_NZ_icc(CC_DST);
1209 5a4bb580 Richard Henderson
    ret |= get_C_add_icc(CC_DST, CC_SRC);
1210 3b2d1e92 Blue Swirl
    return ret;
1211 3b2d1e92 Blue Swirl
}
1212 3b2d1e92 Blue Swirl
1213 5a4bb580 Richard Henderson
static inline uint32_t get_C_sub_icc(uint32_t src1, uint32_t src2)
1214 3b2d1e92 Blue Swirl
{
1215 5a4bb580 Richard Henderson
    uint32_t ret = 0;
1216 5a4bb580 Richard Henderson
1217 5a4bb580 Richard Henderson
    if (src1 < src2) {
1218 5a4bb580 Richard Henderson
        ret = PSR_CARRY;
1219 5a4bb580 Richard Henderson
    }
1220 5a4bb580 Richard Henderson
    return ret;
1221 3b2d1e92 Blue Swirl
}
1222 3b2d1e92 Blue Swirl
1223 5a4bb580 Richard Henderson
static inline uint32_t get_C_subx_icc(uint32_t dst, uint32_t src1,
1224 5a4bb580 Richard Henderson
                                      uint32_t src2)
1225 d4b0d468 Blue Swirl
{
1226 d4b0d468 Blue Swirl
    uint32_t ret = 0;
1227 d4b0d468 Blue Swirl
1228 5a4bb580 Richard Henderson
    if (((~src1 & src2) | (dst & (~src1 | src2))) & (1U << 31)) {
1229 5a4bb580 Richard Henderson
        ret = PSR_CARRY;
1230 5a4bb580 Richard Henderson
    }
1231 d4b0d468 Blue Swirl
    return ret;
1232 d4b0d468 Blue Swirl
}
1233 d4b0d468 Blue Swirl
1234 5a4bb580 Richard Henderson
static inline uint32_t get_V_sub_icc(uint32_t dst, uint32_t src1,
1235 5a4bb580 Richard Henderson
                                     uint32_t src2)
1236 d4b0d468 Blue Swirl
{
1237 d4b0d468 Blue Swirl
    uint32_t ret = 0;
1238 d4b0d468 Blue Swirl
1239 5a4bb580 Richard Henderson
    if (((src1 ^ src2) & (src1 ^ dst)) & (1U << 31)) {
1240 5a4bb580 Richard Henderson
        ret = PSR_OVF;
1241 5a4bb580 Richard Henderson
    }
1242 d4b0d468 Blue Swirl
    return ret;
1243 d4b0d468 Blue Swirl
}
1244 d4b0d468 Blue Swirl
1245 d4b0d468 Blue Swirl
1246 d4b0d468 Blue Swirl
#ifdef TARGET_SPARC64
1247 d4b0d468 Blue Swirl
static inline uint32_t get_C_sub_xcc(target_ulong src1, target_ulong src2)
1248 d4b0d468 Blue Swirl
{
1249 d4b0d468 Blue Swirl
    uint32_t ret = 0;
1250 d4b0d468 Blue Swirl
1251 5a4bb580 Richard Henderson
    if (src1 < src2) {
1252 5a4bb580 Richard Henderson
        ret = PSR_CARRY;
1253 5a4bb580 Richard Henderson
    }
1254 5a4bb580 Richard Henderson
    return ret;
1255 5a4bb580 Richard Henderson
}
1256 5a4bb580 Richard Henderson
1257 5a4bb580 Richard Henderson
static inline uint32_t get_C_subx_xcc(target_ulong dst, target_ulong src1,
1258 5a4bb580 Richard Henderson
                                      target_ulong src2)
1259 5a4bb580 Richard Henderson
{
1260 5a4bb580 Richard Henderson
    uint32_t ret = 0;
1261 5a4bb580 Richard Henderson
1262 5a4bb580 Richard Henderson
    if (((~src1 & src2) | (dst & (~src1 | src2))) & (1ULL << 63)) {
1263 5a4bb580 Richard Henderson
        ret = PSR_CARRY;
1264 5a4bb580 Richard Henderson
    }
1265 d4b0d468 Blue Swirl
    return ret;
1266 d4b0d468 Blue Swirl
}
1267 d4b0d468 Blue Swirl
1268 d4b0d468 Blue Swirl
static inline uint32_t get_V_sub_xcc(target_ulong dst, target_ulong src1,
1269 d4b0d468 Blue Swirl
                                     target_ulong src2)
1270 d4b0d468 Blue Swirl
{
1271 d4b0d468 Blue Swirl
    uint32_t ret = 0;
1272 d4b0d468 Blue Swirl
1273 5a4bb580 Richard Henderson
    if (((src1 ^ src2) & (src1 ^ dst)) & (1ULL << 63)) {
1274 5a4bb580 Richard Henderson
        ret = PSR_OVF;
1275 5a4bb580 Richard Henderson
    }
1276 d4b0d468 Blue Swirl
    return ret;
1277 d4b0d468 Blue Swirl
}
1278 d4b0d468 Blue Swirl
1279 d4b0d468 Blue Swirl
static uint32_t compute_all_sub_xcc(void)
1280 d4b0d468 Blue Swirl
{
1281 d4b0d468 Blue Swirl
    uint32_t ret;
1282 d4b0d468 Blue Swirl
1283 d4b0d468 Blue Swirl
    ret = get_NZ_xcc(CC_DST);
1284 d4b0d468 Blue Swirl
    ret |= get_C_sub_xcc(CC_SRC, CC_SRC2);
1285 d4b0d468 Blue Swirl
    ret |= get_V_sub_xcc(CC_DST, CC_SRC, CC_SRC2);
1286 d4b0d468 Blue Swirl
    return ret;
1287 d4b0d468 Blue Swirl
}
1288 d4b0d468 Blue Swirl
1289 d4b0d468 Blue Swirl
static uint32_t compute_C_sub_xcc(void)
1290 d4b0d468 Blue Swirl
{
1291 d4b0d468 Blue Swirl
    return get_C_sub_xcc(CC_SRC, CC_SRC2);
1292 d4b0d468 Blue Swirl
}
1293 d4b0d468 Blue Swirl
#endif
1294 d4b0d468 Blue Swirl
1295 3e6ba503 Artyom Tarasenko
static uint32_t compute_all_sub(void)
1296 2ca1d92b Blue Swirl
{
1297 2ca1d92b Blue Swirl
    uint32_t ret;
1298 2ca1d92b Blue Swirl
1299 2ca1d92b Blue Swirl
    ret = get_NZ_icc(CC_DST);
1300 5a4bb580 Richard Henderson
    ret |= get_C_sub_icc(CC_SRC, CC_SRC2);
1301 2ca1d92b Blue Swirl
    ret |= get_V_sub_icc(CC_DST, CC_SRC, CC_SRC2);
1302 2ca1d92b Blue Swirl
    return ret;
1303 2ca1d92b Blue Swirl
}
1304 2ca1d92b Blue Swirl
1305 3e6ba503 Artyom Tarasenko
static uint32_t compute_C_sub(void)
1306 2ca1d92b Blue Swirl
{
1307 5a4bb580 Richard Henderson
    return get_C_sub_icc(CC_SRC, CC_SRC2);
1308 2ca1d92b Blue Swirl
}
1309 2ca1d92b Blue Swirl
1310 2ca1d92b Blue Swirl
#ifdef TARGET_SPARC64
1311 2ca1d92b Blue Swirl
static uint32_t compute_all_subx_xcc(void)
1312 2ca1d92b Blue Swirl
{
1313 2ca1d92b Blue Swirl
    uint32_t ret;
1314 2ca1d92b Blue Swirl
1315 2ca1d92b Blue Swirl
    ret = get_NZ_xcc(CC_DST);
1316 5a4bb580 Richard Henderson
    ret |= get_C_subx_xcc(CC_DST, CC_SRC, CC_SRC2);
1317 2ca1d92b Blue Swirl
    ret |= get_V_sub_xcc(CC_DST, CC_SRC, CC_SRC2);
1318 2ca1d92b Blue Swirl
    return ret;
1319 2ca1d92b Blue Swirl
}
1320 2ca1d92b Blue Swirl
1321 2ca1d92b Blue Swirl
static uint32_t compute_C_subx_xcc(void)
1322 2ca1d92b Blue Swirl
{
1323 2ca1d92b Blue Swirl
    uint32_t ret;
1324 2ca1d92b Blue Swirl
1325 5a4bb580 Richard Henderson
    ret = get_C_subx_xcc(CC_DST, CC_SRC, CC_SRC2);
1326 2ca1d92b Blue Swirl
    return ret;
1327 2ca1d92b Blue Swirl
}
1328 2ca1d92b Blue Swirl
#endif
1329 2ca1d92b Blue Swirl
1330 5a4bb580 Richard Henderson
static uint32_t compute_all_subx(void)
1331 3b2d1e92 Blue Swirl
{
1332 3b2d1e92 Blue Swirl
    uint32_t ret;
1333 3b2d1e92 Blue Swirl
1334 3b2d1e92 Blue Swirl
    ret = get_NZ_icc(CC_DST);
1335 5a4bb580 Richard Henderson
    ret |= get_C_subx_icc(CC_DST, CC_SRC, CC_SRC2);
1336 3b2d1e92 Blue Swirl
    ret |= get_V_sub_icc(CC_DST, CC_SRC, CC_SRC2);
1337 3b2d1e92 Blue Swirl
    return ret;
1338 3b2d1e92 Blue Swirl
}
1339 3b2d1e92 Blue Swirl
1340 5a4bb580 Richard Henderson
static uint32_t compute_C_subx(void)
1341 3b2d1e92 Blue Swirl
{
1342 5a4bb580 Richard Henderson
    uint32_t ret;
1343 5a4bb580 Richard Henderson
1344 5a4bb580 Richard Henderson
    ret = get_C_subx_icc(CC_DST, CC_SRC, CC_SRC2);
1345 5a4bb580 Richard Henderson
    return ret;
1346 3b2d1e92 Blue Swirl
}
1347 3b2d1e92 Blue Swirl
1348 5a4bb580 Richard Henderson
static uint32_t compute_all_tsub(void)
1349 3b2d1e92 Blue Swirl
{
1350 3b2d1e92 Blue Swirl
    uint32_t ret;
1351 3b2d1e92 Blue Swirl
1352 3b2d1e92 Blue Swirl
    ret = get_NZ_icc(CC_DST);
1353 5a4bb580 Richard Henderson
    ret |= get_C_sub_icc(CC_SRC, CC_SRC2);
1354 5a4bb580 Richard Henderson
    ret |= get_V_sub_icc(CC_DST, CC_SRC, CC_SRC2);
1355 5a4bb580 Richard Henderson
    ret |= get_V_tag_icc(CC_SRC, CC_SRC2);
1356 3b2d1e92 Blue Swirl
    return ret;
1357 3b2d1e92 Blue Swirl
}
1358 3b2d1e92 Blue Swirl
1359 5a4bb580 Richard Henderson
static uint32_t compute_all_tsubtv(void)
1360 3b2d1e92 Blue Swirl
{
1361 5a4bb580 Richard Henderson
    uint32_t ret;
1362 5a4bb580 Richard Henderson
1363 5a4bb580 Richard Henderson
    ret = get_NZ_icc(CC_DST);
1364 5a4bb580 Richard Henderson
    ret |= get_C_sub_icc(CC_SRC, CC_SRC2);
1365 5a4bb580 Richard Henderson
    return ret;
1366 3b2d1e92 Blue Swirl
}
1367 3b2d1e92 Blue Swirl
1368 38482a77 Blue Swirl
static uint32_t compute_all_logic(void)
1369 38482a77 Blue Swirl
{
1370 38482a77 Blue Swirl
    return get_NZ_icc(CC_DST);
1371 38482a77 Blue Swirl
}
1372 38482a77 Blue Swirl
1373 38482a77 Blue Swirl
static uint32_t compute_C_logic(void)
1374 38482a77 Blue Swirl
{
1375 38482a77 Blue Swirl
    return 0;
1376 38482a77 Blue Swirl
}
1377 38482a77 Blue Swirl
1378 38482a77 Blue Swirl
#ifdef TARGET_SPARC64
1379 38482a77 Blue Swirl
static uint32_t compute_all_logic_xcc(void)
1380 38482a77 Blue Swirl
{
1381 38482a77 Blue Swirl
    return get_NZ_xcc(CC_DST);
1382 38482a77 Blue Swirl
}
1383 38482a77 Blue Swirl
#endif
1384 38482a77 Blue Swirl
1385 8393617c Blue Swirl
typedef struct CCTable {
1386 8393617c Blue Swirl
    uint32_t (*compute_all)(void); /* return all the flags */
1387 8393617c Blue Swirl
    uint32_t (*compute_c)(void);  /* return the C flag */
1388 8393617c Blue Swirl
} CCTable;
1389 8393617c Blue Swirl
1390 8393617c Blue Swirl
static const CCTable icc_table[CC_OP_NB] = {
1391 8393617c Blue Swirl
    /* CC_OP_DYNAMIC should never happen */
1392 8393617c Blue Swirl
    [CC_OP_FLAGS] = { compute_all_flags, compute_C_flags },
1393 6c78ea32 Blue Swirl
    [CC_OP_DIV] = { compute_all_div, compute_C_div },
1394 bdf9f35d Blue Swirl
    [CC_OP_ADD] = { compute_all_add, compute_C_add },
1395 5a4bb580 Richard Henderson
    [CC_OP_ADDX] = { compute_all_addx, compute_C_addx },
1396 5a4bb580 Richard Henderson
    [CC_OP_TADD] = { compute_all_tadd, compute_C_add },
1397 5a4bb580 Richard Henderson
    [CC_OP_TADDTV] = { compute_all_taddtv, compute_C_add },
1398 d4b0d468 Blue Swirl
    [CC_OP_SUB] = { compute_all_sub, compute_C_sub },
1399 5a4bb580 Richard Henderson
    [CC_OP_SUBX] = { compute_all_subx, compute_C_subx },
1400 5a4bb580 Richard Henderson
    [CC_OP_TSUB] = { compute_all_tsub, compute_C_sub },
1401 5a4bb580 Richard Henderson
    [CC_OP_TSUBTV] = { compute_all_tsubtv, compute_C_sub },
1402 38482a77 Blue Swirl
    [CC_OP_LOGIC] = { compute_all_logic, compute_C_logic },
1403 8393617c Blue Swirl
};
1404 8393617c Blue Swirl
1405 8393617c Blue Swirl
#ifdef TARGET_SPARC64
1406 8393617c Blue Swirl
static const CCTable xcc_table[CC_OP_NB] = {
1407 8393617c Blue Swirl
    /* CC_OP_DYNAMIC should never happen */
1408 8393617c Blue Swirl
    [CC_OP_FLAGS] = { compute_all_flags_xcc, compute_C_flags_xcc },
1409 6c78ea32 Blue Swirl
    [CC_OP_DIV] = { compute_all_logic_xcc, compute_C_logic },
1410 bdf9f35d Blue Swirl
    [CC_OP_ADD] = { compute_all_add_xcc, compute_C_add_xcc },
1411 789c91ef Blue Swirl
    [CC_OP_ADDX] = { compute_all_addx_xcc, compute_C_addx_xcc },
1412 3b2d1e92 Blue Swirl
    [CC_OP_TADD] = { compute_all_add_xcc, compute_C_add_xcc },
1413 3b2d1e92 Blue Swirl
    [CC_OP_TADDTV] = { compute_all_add_xcc, compute_C_add_xcc },
1414 d4b0d468 Blue Swirl
    [CC_OP_SUB] = { compute_all_sub_xcc, compute_C_sub_xcc },
1415 2ca1d92b Blue Swirl
    [CC_OP_SUBX] = { compute_all_subx_xcc, compute_C_subx_xcc },
1416 3b2d1e92 Blue Swirl
    [CC_OP_TSUB] = { compute_all_sub_xcc, compute_C_sub_xcc },
1417 3b2d1e92 Blue Swirl
    [CC_OP_TSUBTV] = { compute_all_sub_xcc, compute_C_sub_xcc },
1418 38482a77 Blue Swirl
    [CC_OP_LOGIC] = { compute_all_logic_xcc, compute_C_logic },
1419 8393617c Blue Swirl
};
1420 8393617c Blue Swirl
#endif
1421 8393617c Blue Swirl
1422 8393617c Blue Swirl
void helper_compute_psr(void)
1423 8393617c Blue Swirl
{
1424 8393617c Blue Swirl
    uint32_t new_psr;
1425 8393617c Blue Swirl
1426 8393617c Blue Swirl
    new_psr = icc_table[CC_OP].compute_all();
1427 8393617c Blue Swirl
    env->psr = new_psr;
1428 8393617c Blue Swirl
#ifdef TARGET_SPARC64
1429 8393617c Blue Swirl
    new_psr = xcc_table[CC_OP].compute_all();
1430 8393617c Blue Swirl
    env->xcc = new_psr;
1431 8393617c Blue Swirl
#endif
1432 8393617c Blue Swirl
    CC_OP = CC_OP_FLAGS;
1433 8393617c Blue Swirl
}
1434 8393617c Blue Swirl
1435 70c48285 Richard Henderson
uint32_t helper_compute_C_icc(void)
1436 8393617c Blue Swirl
{
1437 8393617c Blue Swirl
    uint32_t ret;
1438 8393617c Blue Swirl
1439 8393617c Blue Swirl
    ret = icc_table[CC_OP].compute_c() >> PSR_CARRY_SHIFT;
1440 8393617c Blue Swirl
    return ret;
1441 8393617c Blue Swirl
}
1442 8393617c Blue Swirl
1443 5a834bb4 Blue Swirl
static inline void memcpy32(target_ulong *dst, const target_ulong *src)
1444 5a834bb4 Blue Swirl
{
1445 5a834bb4 Blue Swirl
    dst[0] = src[0];
1446 5a834bb4 Blue Swirl
    dst[1] = src[1];
1447 5a834bb4 Blue Swirl
    dst[2] = src[2];
1448 5a834bb4 Blue Swirl
    dst[3] = src[3];
1449 5a834bb4 Blue Swirl
    dst[4] = src[4];
1450 5a834bb4 Blue Swirl
    dst[5] = src[5];
1451 5a834bb4 Blue Swirl
    dst[6] = src[6];
1452 5a834bb4 Blue Swirl
    dst[7] = src[7];
1453 5a834bb4 Blue Swirl
}
1454 5a834bb4 Blue Swirl
1455 5a834bb4 Blue Swirl
static void set_cwp(int new_cwp)
1456 5a834bb4 Blue Swirl
{
1457 5a834bb4 Blue Swirl
    /* put the modified wrap registers at their proper location */
1458 5a834bb4 Blue Swirl
    if (env->cwp == env->nwindows - 1) {
1459 5a834bb4 Blue Swirl
        memcpy32(env->regbase, env->regbase + env->nwindows * 16);
1460 5a834bb4 Blue Swirl
    }
1461 5a834bb4 Blue Swirl
    env->cwp = new_cwp;
1462 5a834bb4 Blue Swirl
1463 5a834bb4 Blue Swirl
    /* put the wrap registers at their temporary location */
1464 5a834bb4 Blue Swirl
    if (new_cwp == env->nwindows - 1) {
1465 5a834bb4 Blue Swirl
        memcpy32(env->regbase + env->nwindows * 16, env->regbase);
1466 5a834bb4 Blue Swirl
    }
1467 5a834bb4 Blue Swirl
    env->regwptr = env->regbase + (new_cwp * 16);
1468 5a834bb4 Blue Swirl
}
1469 5a834bb4 Blue Swirl
1470 5a834bb4 Blue Swirl
void cpu_set_cwp(CPUState *env1, int new_cwp)
1471 5a834bb4 Blue Swirl
{
1472 5a834bb4 Blue Swirl
    CPUState *saved_env;
1473 5a834bb4 Blue Swirl
1474 5a834bb4 Blue Swirl
    saved_env = env;
1475 5a834bb4 Blue Swirl
    env = env1;
1476 5a834bb4 Blue Swirl
    set_cwp(new_cwp);
1477 5a834bb4 Blue Swirl
    env = saved_env;
1478 5a834bb4 Blue Swirl
}
1479 5a834bb4 Blue Swirl
1480 5a834bb4 Blue Swirl
static target_ulong get_psr(void)
1481 5a834bb4 Blue Swirl
{
1482 5a834bb4 Blue Swirl
    helper_compute_psr();
1483 5a834bb4 Blue Swirl
1484 5a834bb4 Blue Swirl
#if !defined (TARGET_SPARC64)
1485 5a834bb4 Blue Swirl
    return env->version | (env->psr & PSR_ICC) |
1486 5a834bb4 Blue Swirl
        (env->psref? PSR_EF : 0) |
1487 5a834bb4 Blue Swirl
        (env->psrpil << 8) |
1488 5a834bb4 Blue Swirl
        (env->psrs? PSR_S : 0) |
1489 5a834bb4 Blue Swirl
        (env->psrps? PSR_PS : 0) |
1490 5a834bb4 Blue Swirl
        (env->psret? PSR_ET : 0) | env->cwp;
1491 5a834bb4 Blue Swirl
#else
1492 2aae2b8e Igor V. Kovalenko
    return env->psr & PSR_ICC;
1493 5a834bb4 Blue Swirl
#endif
1494 5a834bb4 Blue Swirl
}
1495 5a834bb4 Blue Swirl
1496 5a834bb4 Blue Swirl
target_ulong cpu_get_psr(CPUState *env1)
1497 5a834bb4 Blue Swirl
{
1498 5a834bb4 Blue Swirl
    CPUState *saved_env;
1499 5a834bb4 Blue Swirl
    target_ulong ret;
1500 5a834bb4 Blue Swirl
1501 5a834bb4 Blue Swirl
    saved_env = env;
1502 5a834bb4 Blue Swirl
    env = env1;
1503 5a834bb4 Blue Swirl
    ret = get_psr();
1504 5a834bb4 Blue Swirl
    env = saved_env;
1505 5a834bb4 Blue Swirl
    return ret;
1506 5a834bb4 Blue Swirl
}
1507 5a834bb4 Blue Swirl
1508 5a834bb4 Blue Swirl
static void put_psr(target_ulong val)
1509 5a834bb4 Blue Swirl
{
1510 5a834bb4 Blue Swirl
    env->psr = val & PSR_ICC;
1511 2aae2b8e Igor V. Kovalenko
#if !defined (TARGET_SPARC64)
1512 5a834bb4 Blue Swirl
    env->psref = (val & PSR_EF)? 1 : 0;
1513 5a834bb4 Blue Swirl
    env->psrpil = (val & PSR_PIL) >> 8;
1514 2aae2b8e Igor V. Kovalenko
#endif
1515 5a834bb4 Blue Swirl
#if ((!defined (TARGET_SPARC64)) && !defined(CONFIG_USER_ONLY))
1516 5a834bb4 Blue Swirl
    cpu_check_irqs(env);
1517 5a834bb4 Blue Swirl
#endif
1518 2aae2b8e Igor V. Kovalenko
#if !defined (TARGET_SPARC64)
1519 5a834bb4 Blue Swirl
    env->psrs = (val & PSR_S)? 1 : 0;
1520 5a834bb4 Blue Swirl
    env->psrps = (val & PSR_PS)? 1 : 0;
1521 5a834bb4 Blue Swirl
    env->psret = (val & PSR_ET)? 1 : 0;
1522 5a834bb4 Blue Swirl
    set_cwp(val & PSR_CWP);
1523 2aae2b8e Igor V. Kovalenko
#endif
1524 5a834bb4 Blue Swirl
    env->cc_op = CC_OP_FLAGS;
1525 5a834bb4 Blue Swirl
}
1526 5a834bb4 Blue Swirl
1527 5a834bb4 Blue Swirl
void cpu_put_psr(CPUState *env1, target_ulong val)
1528 5a834bb4 Blue Swirl
{
1529 5a834bb4 Blue Swirl
    CPUState *saved_env;
1530 5a834bb4 Blue Swirl
1531 5a834bb4 Blue Swirl
    saved_env = env;
1532 5a834bb4 Blue Swirl
    env = env1;
1533 5a834bb4 Blue Swirl
    put_psr(val);
1534 5a834bb4 Blue Swirl
    env = saved_env;
1535 5a834bb4 Blue Swirl
}
1536 5a834bb4 Blue Swirl
1537 5a834bb4 Blue Swirl
static int cwp_inc(int cwp)
1538 5a834bb4 Blue Swirl
{
1539 5a834bb4 Blue Swirl
    if (unlikely(cwp >= env->nwindows)) {
1540 5a834bb4 Blue Swirl
        cwp -= env->nwindows;
1541 5a834bb4 Blue Swirl
    }
1542 5a834bb4 Blue Swirl
    return cwp;
1543 5a834bb4 Blue Swirl
}
1544 5a834bb4 Blue Swirl
1545 5a834bb4 Blue Swirl
int cpu_cwp_inc(CPUState *env1, int cwp)
1546 5a834bb4 Blue Swirl
{
1547 5a834bb4 Blue Swirl
    CPUState *saved_env;
1548 5a834bb4 Blue Swirl
    target_ulong ret;
1549 5a834bb4 Blue Swirl
1550 5a834bb4 Blue Swirl
    saved_env = env;
1551 5a834bb4 Blue Swirl
    env = env1;
1552 5a834bb4 Blue Swirl
    ret = cwp_inc(cwp);
1553 5a834bb4 Blue Swirl
    env = saved_env;
1554 5a834bb4 Blue Swirl
    return ret;
1555 5a834bb4 Blue Swirl
}
1556 5a834bb4 Blue Swirl
1557 5a834bb4 Blue Swirl
static int cwp_dec(int cwp)
1558 5a834bb4 Blue Swirl
{
1559 5a834bb4 Blue Swirl
    if (unlikely(cwp < 0)) {
1560 5a834bb4 Blue Swirl
        cwp += env->nwindows;
1561 5a834bb4 Blue Swirl
    }
1562 5a834bb4 Blue Swirl
    return cwp;
1563 5a834bb4 Blue Swirl
}
1564 5a834bb4 Blue Swirl
1565 5a834bb4 Blue Swirl
int cpu_cwp_dec(CPUState *env1, int cwp)
1566 5a834bb4 Blue Swirl
{
1567 5a834bb4 Blue Swirl
    CPUState *saved_env;
1568 5a834bb4 Blue Swirl
    target_ulong ret;
1569 5a834bb4 Blue Swirl
1570 5a834bb4 Blue Swirl
    saved_env = env;
1571 5a834bb4 Blue Swirl
    env = env1;
1572 5a834bb4 Blue Swirl
    ret = cwp_dec(cwp);
1573 5a834bb4 Blue Swirl
    env = saved_env;
1574 5a834bb4 Blue Swirl
    return ret;
1575 5a834bb4 Blue Swirl
}
1576 5a834bb4 Blue Swirl
1577 3475187d bellard
#ifdef TARGET_SPARC64
1578 714547bb blueswir1
GEN_FCMPS(fcmps_fcc1, float32, 22, 0);
1579 417454b0 blueswir1
GEN_FCMP(fcmpd_fcc1, float64, DT0, DT1, 22, 0);
1580 64a88d5d blueswir1
GEN_FCMP(fcmpq_fcc1, float128, QT0, QT1, 22, 0);
1581 417454b0 blueswir1
1582 714547bb blueswir1
GEN_FCMPS(fcmps_fcc2, float32, 24, 0);
1583 417454b0 blueswir1
GEN_FCMP(fcmpd_fcc2, float64, DT0, DT1, 24, 0);
1584 64a88d5d blueswir1
GEN_FCMP(fcmpq_fcc2, float128, QT0, QT1, 24, 0);
1585 417454b0 blueswir1
1586 714547bb blueswir1
GEN_FCMPS(fcmps_fcc3, float32, 26, 0);
1587 417454b0 blueswir1
GEN_FCMP(fcmpd_fcc3, float64, DT0, DT1, 26, 0);
1588 64a88d5d blueswir1
GEN_FCMP(fcmpq_fcc3, float128, QT0, QT1, 26, 0);
1589 417454b0 blueswir1
1590 714547bb blueswir1
GEN_FCMPS(fcmpes_fcc1, float32, 22, 1);
1591 417454b0 blueswir1
GEN_FCMP(fcmped_fcc1, float64, DT0, DT1, 22, 1);
1592 64a88d5d blueswir1
GEN_FCMP(fcmpeq_fcc1, float128, QT0, QT1, 22, 1);
1593 3475187d bellard
1594 714547bb blueswir1
GEN_FCMPS(fcmpes_fcc2, float32, 24, 1);
1595 417454b0 blueswir1
GEN_FCMP(fcmped_fcc2, float64, DT0, DT1, 24, 1);
1596 64a88d5d blueswir1
GEN_FCMP(fcmpeq_fcc2, float128, QT0, QT1, 24, 1);
1597 3475187d bellard
1598 714547bb blueswir1
GEN_FCMPS(fcmpes_fcc3, float32, 26, 1);
1599 417454b0 blueswir1
GEN_FCMP(fcmped_fcc3, float64, DT0, DT1, 26, 1);
1600 4e14008f blueswir1
GEN_FCMP(fcmpeq_fcc3, float128, QT0, QT1, 26, 1);
1601 4e14008f blueswir1
#endif
1602 714547bb blueswir1
#undef GEN_FCMPS
1603 3475187d bellard
1604 77f193da blueswir1
#if !defined(TARGET_SPARC64) && !defined(CONFIG_USER_ONLY) && \
1605 77f193da blueswir1
    defined(DEBUG_MXCC)
1606 952a328f blueswir1
static void dump_mxcc(CPUState *env)
1607 952a328f blueswir1
{
1608 0bf9e31a Blue Swirl
    printf("mxccdata: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64
1609 0bf9e31a Blue Swirl
           "\n",
1610 77f193da blueswir1
           env->mxccdata[0], env->mxccdata[1],
1611 77f193da blueswir1
           env->mxccdata[2], env->mxccdata[3]);
1612 0bf9e31a Blue Swirl
    printf("mxccregs: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64
1613 0bf9e31a Blue Swirl
           "\n"
1614 0bf9e31a Blue Swirl
           "          %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64
1615 0bf9e31a Blue Swirl
           "\n",
1616 77f193da blueswir1
           env->mxccregs[0], env->mxccregs[1],
1617 77f193da blueswir1
           env->mxccregs[2], env->mxccregs[3],
1618 77f193da blueswir1
           env->mxccregs[4], env->mxccregs[5],
1619 77f193da blueswir1
           env->mxccregs[6], env->mxccregs[7]);
1620 952a328f blueswir1
}
1621 952a328f blueswir1
#endif
1622 952a328f blueswir1
1623 1a2fb1c0 blueswir1
#if (defined(TARGET_SPARC64) || !defined(CONFIG_USER_ONLY)) \
1624 1a2fb1c0 blueswir1
    && defined(DEBUG_ASI)
1625 1a2fb1c0 blueswir1
static void dump_asi(const char *txt, target_ulong addr, int asi, int size,
1626 1a2fb1c0 blueswir1
                     uint64_t r1)
1627 8543e2cf blueswir1
{
1628 8543e2cf blueswir1
    switch (size)
1629 8543e2cf blueswir1
    {
1630 8543e2cf blueswir1
    case 1:
1631 1a2fb1c0 blueswir1
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %02" PRIx64 "\n", txt,
1632 1a2fb1c0 blueswir1
                    addr, asi, r1 & 0xff);
1633 8543e2cf blueswir1
        break;
1634 8543e2cf blueswir1
    case 2:
1635 1a2fb1c0 blueswir1
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %04" PRIx64 "\n", txt,
1636 1a2fb1c0 blueswir1
                    addr, asi, r1 & 0xffff);
1637 8543e2cf blueswir1
        break;
1638 8543e2cf blueswir1
    case 4:
1639 1a2fb1c0 blueswir1
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %08" PRIx64 "\n", txt,
1640 1a2fb1c0 blueswir1
                    addr, asi, r1 & 0xffffffff);
1641 8543e2cf blueswir1
        break;
1642 8543e2cf blueswir1
    case 8:
1643 1a2fb1c0 blueswir1
        DPRINTF_ASI("%s "TARGET_FMT_lx " asi 0x%02x = %016" PRIx64 "\n", txt,
1644 1a2fb1c0 blueswir1
                    addr, asi, r1);
1645 8543e2cf blueswir1
        break;
1646 8543e2cf blueswir1
    }
1647 8543e2cf blueswir1
}
1648 8543e2cf blueswir1
#endif
1649 8543e2cf blueswir1
1650 1a2fb1c0 blueswir1
#ifndef TARGET_SPARC64
1651 1a2fb1c0 blueswir1
#ifndef CONFIG_USER_ONLY
1652 b04d9890 Fabien Chouteau
1653 b04d9890 Fabien Chouteau
1654 b04d9890 Fabien Chouteau
/* Leon3 cache control */
1655 b04d9890 Fabien Chouteau
1656 60f356e8 Fabien Chouteau
static void leon3_cache_control_int(void)
1657 b04d9890 Fabien Chouteau
{
1658 b04d9890 Fabien Chouteau
    uint32_t state = 0;
1659 b04d9890 Fabien Chouteau
1660 b04d9890 Fabien Chouteau
    if (env->cache_control & CACHE_CTRL_IF) {
1661 b04d9890 Fabien Chouteau
        /* Instruction cache state */
1662 b04d9890 Fabien Chouteau
        state = env->cache_control & CACHE_STATE_MASK;
1663 b04d9890 Fabien Chouteau
        if (state == CACHE_ENABLED) {
1664 b04d9890 Fabien Chouteau
            state = CACHE_FROZEN;
1665 b04d9890 Fabien Chouteau
            DPRINTF_CACHE_CONTROL("Instruction cache: freeze\n");
1666 b04d9890 Fabien Chouteau
        }
1667 b04d9890 Fabien Chouteau
1668 b04d9890 Fabien Chouteau
        env->cache_control &= ~CACHE_STATE_MASK;
1669 b04d9890 Fabien Chouteau
        env->cache_control |= state;
1670 b04d9890 Fabien Chouteau
    }
1671 b04d9890 Fabien Chouteau
1672 b04d9890 Fabien Chouteau
    if (env->cache_control & CACHE_CTRL_DF) {
1673 b04d9890 Fabien Chouteau
        /* Data cache state */
1674 b04d9890 Fabien Chouteau
        state = (env->cache_control >> 2) & CACHE_STATE_MASK;
1675 b04d9890 Fabien Chouteau
        if (state == CACHE_ENABLED) {
1676 b04d9890 Fabien Chouteau
            state = CACHE_FROZEN;
1677 b04d9890 Fabien Chouteau
            DPRINTF_CACHE_CONTROL("Data cache: freeze\n");
1678 b04d9890 Fabien Chouteau
        }
1679 b04d9890 Fabien Chouteau
1680 b04d9890 Fabien Chouteau
        env->cache_control &= ~(CACHE_STATE_MASK << 2);
1681 b04d9890 Fabien Chouteau
        env->cache_control |= (state << 2);
1682 b04d9890 Fabien Chouteau
    }
1683 b04d9890 Fabien Chouteau
}
1684 b04d9890 Fabien Chouteau
1685 b04d9890 Fabien Chouteau
static void leon3_cache_control_st(target_ulong addr, uint64_t val, int size)
1686 b04d9890 Fabien Chouteau
{
1687 b04d9890 Fabien Chouteau
    DPRINTF_CACHE_CONTROL("st addr:%08x, val:%" PRIx64 ", size:%d\n",
1688 b04d9890 Fabien Chouteau
                          addr, val, size);
1689 b04d9890 Fabien Chouteau
1690 b04d9890 Fabien Chouteau
    if (size != 4) {
1691 b04d9890 Fabien Chouteau
        DPRINTF_CACHE_CONTROL("32bits only\n");
1692 b04d9890 Fabien Chouteau
        return;
1693 b04d9890 Fabien Chouteau
    }
1694 b04d9890 Fabien Chouteau
1695 b04d9890 Fabien Chouteau
    switch (addr) {
1696 b04d9890 Fabien Chouteau
    case 0x00:              /* Cache control */
1697 b04d9890 Fabien Chouteau
1698 b04d9890 Fabien Chouteau
        /* These values must always be read as zeros */
1699 b04d9890 Fabien Chouteau
        val &= ~CACHE_CTRL_FD;
1700 b04d9890 Fabien Chouteau
        val &= ~CACHE_CTRL_FI;
1701 b04d9890 Fabien Chouteau
        val &= ~CACHE_CTRL_IB;
1702 b04d9890 Fabien Chouteau
        val &= ~CACHE_CTRL_IP;
1703 b04d9890 Fabien Chouteau
        val &= ~CACHE_CTRL_DP;
1704 b04d9890 Fabien Chouteau
1705 b04d9890 Fabien Chouteau
        env->cache_control = val;
1706 b04d9890 Fabien Chouteau
        break;
1707 b04d9890 Fabien Chouteau
    case 0x04:              /* Instruction cache configuration */
1708 b04d9890 Fabien Chouteau
    case 0x08:              /* Data cache configuration */
1709 b04d9890 Fabien Chouteau
        /* Read Only */
1710 b04d9890 Fabien Chouteau
        break;
1711 b04d9890 Fabien Chouteau
    default:
1712 b04d9890 Fabien Chouteau
        DPRINTF_CACHE_CONTROL("write unknown register %08x\n", addr);
1713 b04d9890 Fabien Chouteau
        break;
1714 b04d9890 Fabien Chouteau
    };
1715 b04d9890 Fabien Chouteau
}
1716 b04d9890 Fabien Chouteau
1717 b04d9890 Fabien Chouteau
static uint64_t leon3_cache_control_ld(target_ulong addr, int size)
1718 b04d9890 Fabien Chouteau
{
1719 b04d9890 Fabien Chouteau
    uint64_t ret = 0;
1720 b04d9890 Fabien Chouteau
1721 b04d9890 Fabien Chouteau
    if (size != 4) {
1722 b04d9890 Fabien Chouteau
        DPRINTF_CACHE_CONTROL("32bits only\n");
1723 b04d9890 Fabien Chouteau
        return 0;
1724 b04d9890 Fabien Chouteau
    }
1725 b04d9890 Fabien Chouteau
1726 b04d9890 Fabien Chouteau
    switch (addr) {
1727 b04d9890 Fabien Chouteau
    case 0x00:              /* Cache control */
1728 b04d9890 Fabien Chouteau
        ret = env->cache_control;
1729 b04d9890 Fabien Chouteau
        break;
1730 b04d9890 Fabien Chouteau
1731 b04d9890 Fabien Chouteau
        /* Configuration registers are read and only always keep those
1732 b04d9890 Fabien Chouteau
           predefined values */
1733 b04d9890 Fabien Chouteau
1734 b04d9890 Fabien Chouteau
    case 0x04:              /* Instruction cache configuration */
1735 b04d9890 Fabien Chouteau
        ret = 0x10220000;
1736 b04d9890 Fabien Chouteau
        break;
1737 b04d9890 Fabien Chouteau
    case 0x08:              /* Data cache configuration */
1738 b04d9890 Fabien Chouteau
        ret = 0x18220000;
1739 b04d9890 Fabien Chouteau
        break;
1740 b04d9890 Fabien Chouteau
    default:
1741 b04d9890 Fabien Chouteau
        DPRINTF_CACHE_CONTROL("read unknown register %08x\n", addr);
1742 b04d9890 Fabien Chouteau
        break;
1743 b04d9890 Fabien Chouteau
    };
1744 60f356e8 Fabien Chouteau
    DPRINTF_CACHE_CONTROL("ld addr:%08x, ret:0x%" PRIx64 ", size:%d\n",
1745 b04d9890 Fabien Chouteau
                          addr, ret, size);
1746 b04d9890 Fabien Chouteau
    return ret;
1747 b04d9890 Fabien Chouteau
}
1748 b04d9890 Fabien Chouteau
1749 60f356e8 Fabien Chouteau
void leon3_irq_manager(void *irq_manager, int intno)
1750 60f356e8 Fabien Chouteau
{
1751 60f356e8 Fabien Chouteau
    leon3_irq_ack(irq_manager, intno);
1752 60f356e8 Fabien Chouteau
    leon3_cache_control_int();
1753 60f356e8 Fabien Chouteau
}
1754 60f356e8 Fabien Chouteau
1755 1a2fb1c0 blueswir1
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
1756 e8af50a3 bellard
{
1757 1a2fb1c0 blueswir1
    uint64_t ret = 0;
1758 8543e2cf blueswir1
#if defined(DEBUG_MXCC) || defined(DEBUG_ASI)
1759 1a2fb1c0 blueswir1
    uint32_t last_addr = addr;
1760 952a328f blueswir1
#endif
1761 e80cfcfc bellard
1762 c2bc0e38 blueswir1
    helper_check_align(addr, size - 1);
1763 e80cfcfc bellard
    switch (asi) {
1764 b04d9890 Fabien Chouteau
    case 2: /* SuperSparc MXCC registers and Leon3 cache control */
1765 1a2fb1c0 blueswir1
        switch (addr) {
1766 b04d9890 Fabien Chouteau
        case 0x00:          /* Leon3 Cache Control */
1767 b04d9890 Fabien Chouteau
        case 0x08:          /* Leon3 Instruction Cache config */
1768 b04d9890 Fabien Chouteau
        case 0x0C:          /* Leon3 Date Cache config */
1769 60f356e8 Fabien Chouteau
            if (env->def->features & CPU_FEATURE_CACHE_CTRL) {
1770 60f356e8 Fabien Chouteau
                ret = leon3_cache_control_ld(addr, size);
1771 60f356e8 Fabien Chouteau
            }
1772 b04d9890 Fabien Chouteau
            break;
1773 952a328f blueswir1
        case 0x01c00a00: /* MXCC control register */
1774 1a2fb1c0 blueswir1
            if (size == 8)
1775 1a2fb1c0 blueswir1
                ret = env->mxccregs[3];
1776 1a2fb1c0 blueswir1
            else
1777 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
1778 77f193da blueswir1
                             size);
1779 952a328f blueswir1
            break;
1780 952a328f blueswir1
        case 0x01c00a04: /* MXCC control register */
1781 952a328f blueswir1
            if (size == 4)
1782 952a328f blueswir1
                ret = env->mxccregs[3];
1783 952a328f blueswir1
            else
1784 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
1785 77f193da blueswir1
                             size);
1786 952a328f blueswir1
            break;
1787 295db113 blueswir1
        case 0x01c00c00: /* Module reset register */
1788 295db113 blueswir1
            if (size == 8) {
1789 1a2fb1c0 blueswir1
                ret = env->mxccregs[5];
1790 295db113 blueswir1
                // should we do something here?
1791 295db113 blueswir1
            } else
1792 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
1793 77f193da blueswir1
                             size);
1794 295db113 blueswir1
            break;
1795 952a328f blueswir1
        case 0x01c00f00: /* MBus port address register */
1796 1a2fb1c0 blueswir1
            if (size == 8)
1797 1a2fb1c0 blueswir1
                ret = env->mxccregs[7];
1798 1a2fb1c0 blueswir1
            else
1799 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
1800 77f193da blueswir1
                             size);
1801 952a328f blueswir1
            break;
1802 952a328f blueswir1
        default:
1803 77f193da blueswir1
            DPRINTF_MXCC("%08x: unimplemented address, size: %d\n", addr,
1804 77f193da blueswir1
                         size);
1805 952a328f blueswir1
            break;
1806 952a328f blueswir1
        }
1807 77f193da blueswir1
        DPRINTF_MXCC("asi = %d, size = %d, sign = %d, "
1808 9827e450 blueswir1
                     "addr = %08x -> ret = %" PRIx64 ","
1809 1a2fb1c0 blueswir1
                     "addr = %08x\n", asi, size, sign, last_addr, ret, addr);
1810 952a328f blueswir1
#ifdef DEBUG_MXCC
1811 952a328f blueswir1
        dump_mxcc(env);
1812 952a328f blueswir1
#endif
1813 6c36d3fa blueswir1
        break;
1814 e8af50a3 bellard
    case 3: /* MMU probe */
1815 0f8a249a blueswir1
        {
1816 0f8a249a blueswir1
            int mmulev;
1817 0f8a249a blueswir1
1818 1a2fb1c0 blueswir1
            mmulev = (addr >> 8) & 15;
1819 0f8a249a blueswir1
            if (mmulev > 4)
1820 0f8a249a blueswir1
                ret = 0;
1821 1a2fb1c0 blueswir1
            else
1822 1a2fb1c0 blueswir1
                ret = mmu_probe(env, addr, mmulev);
1823 1a2fb1c0 blueswir1
            DPRINTF_MMU("mmu_probe: 0x%08x (lev %d) -> 0x%08" PRIx64 "\n",
1824 1a2fb1c0 blueswir1
                        addr, mmulev, ret);
1825 0f8a249a blueswir1
        }
1826 0f8a249a blueswir1
        break;
1827 e8af50a3 bellard
    case 4: /* read MMU regs */
1828 0f8a249a blueswir1
        {
1829 1a2fb1c0 blueswir1
            int reg = (addr >> 8) & 0x1f;
1830 3b46e624 ths
1831 0f8a249a blueswir1
            ret = env->mmuregs[reg];
1832 0f8a249a blueswir1
            if (reg == 3) /* Fault status cleared on read */
1833 3dd9a152 blueswir1
                env->mmuregs[3] = 0;
1834 3dd9a152 blueswir1
            else if (reg == 0x13) /* Fault status read */
1835 3dd9a152 blueswir1
                ret = env->mmuregs[3];
1836 3dd9a152 blueswir1
            else if (reg == 0x14) /* Fault address read */
1837 3dd9a152 blueswir1
                ret = env->mmuregs[4];
1838 1a2fb1c0 blueswir1
            DPRINTF_MMU("mmu_read: reg[%d] = 0x%08" PRIx64 "\n", reg, ret);
1839 0f8a249a blueswir1
        }
1840 0f8a249a blueswir1
        break;
1841 045380be blueswir1
    case 5: // Turbosparc ITLB Diagnostic
1842 045380be blueswir1
    case 6: // Turbosparc DTLB Diagnostic
1843 045380be blueswir1
    case 7: // Turbosparc IOTLB Diagnostic
1844 045380be blueswir1
        break;
1845 6c36d3fa blueswir1
    case 9: /* Supervisor code access */
1846 6c36d3fa blueswir1
        switch(size) {
1847 6c36d3fa blueswir1
        case 1:
1848 1a2fb1c0 blueswir1
            ret = ldub_code(addr);
1849 6c36d3fa blueswir1
            break;
1850 6c36d3fa blueswir1
        case 2:
1851 a4e7dd52 blueswir1
            ret = lduw_code(addr);
1852 6c36d3fa blueswir1
            break;
1853 6c36d3fa blueswir1
        default:
1854 6c36d3fa blueswir1
        case 4:
1855 a4e7dd52 blueswir1
            ret = ldl_code(addr);
1856 6c36d3fa blueswir1
            break;
1857 6c36d3fa blueswir1
        case 8:
1858 a4e7dd52 blueswir1
            ret = ldq_code(addr);
1859 6c36d3fa blueswir1
            break;
1860 6c36d3fa blueswir1
        }
1861 6c36d3fa blueswir1
        break;
1862 81ad8ba2 blueswir1
    case 0xa: /* User data access */
1863 81ad8ba2 blueswir1
        switch(size) {
1864 81ad8ba2 blueswir1
        case 1:
1865 1a2fb1c0 blueswir1
            ret = ldub_user(addr);
1866 81ad8ba2 blueswir1
            break;
1867 81ad8ba2 blueswir1
        case 2:
1868 a4e7dd52 blueswir1
            ret = lduw_user(addr);
1869 81ad8ba2 blueswir1
            break;
1870 81ad8ba2 blueswir1
        default:
1871 81ad8ba2 blueswir1
        case 4:
1872 a4e7dd52 blueswir1
            ret = ldl_user(addr);
1873 81ad8ba2 blueswir1
            break;
1874 81ad8ba2 blueswir1
        case 8:
1875 a4e7dd52 blueswir1
            ret = ldq_user(addr);
1876 81ad8ba2 blueswir1
            break;
1877 81ad8ba2 blueswir1
        }
1878 81ad8ba2 blueswir1
        break;
1879 81ad8ba2 blueswir1
    case 0xb: /* Supervisor data access */
1880 81ad8ba2 blueswir1
        switch(size) {
1881 81ad8ba2 blueswir1
        case 1:
1882 1a2fb1c0 blueswir1
            ret = ldub_kernel(addr);
1883 81ad8ba2 blueswir1
            break;
1884 81ad8ba2 blueswir1
        case 2:
1885 a4e7dd52 blueswir1
            ret = lduw_kernel(addr);
1886 81ad8ba2 blueswir1
            break;
1887 81ad8ba2 blueswir1
        default:
1888 81ad8ba2 blueswir1
        case 4:
1889 a4e7dd52 blueswir1
            ret = ldl_kernel(addr);
1890 81ad8ba2 blueswir1
            break;
1891 81ad8ba2 blueswir1
        case 8:
1892 a4e7dd52 blueswir1
            ret = ldq_kernel(addr);
1893 81ad8ba2 blueswir1
            break;
1894 81ad8ba2 blueswir1
        }
1895 81ad8ba2 blueswir1
        break;
1896 6c36d3fa blueswir1
    case 0xc: /* I-cache tag */
1897 6c36d3fa blueswir1
    case 0xd: /* I-cache data */
1898 6c36d3fa blueswir1
    case 0xe: /* D-cache tag */
1899 6c36d3fa blueswir1
    case 0xf: /* D-cache data */
1900 6c36d3fa blueswir1
        break;
1901 6c36d3fa blueswir1
    case 0x20: /* MMU passthrough */
1902 02aab46a bellard
        switch(size) {
1903 02aab46a bellard
        case 1:
1904 1a2fb1c0 blueswir1
            ret = ldub_phys(addr);
1905 02aab46a bellard
            break;
1906 02aab46a bellard
        case 2:
1907 a4e7dd52 blueswir1
            ret = lduw_phys(addr);
1908 02aab46a bellard
            break;
1909 02aab46a bellard
        default:
1910 02aab46a bellard
        case 4:
1911 a4e7dd52 blueswir1
            ret = ldl_phys(addr);
1912 02aab46a bellard
            break;
1913 9e61bde5 bellard
        case 8:
1914 a4e7dd52 blueswir1
            ret = ldq_phys(addr);
1915 0f8a249a blueswir1
            break;
1916 02aab46a bellard
        }
1917 0f8a249a blueswir1
        break;
1918 7d85892b blueswir1
    case 0x21 ... 0x2f: /* MMU passthrough, 0x100000000 to 0xfffffffff */
1919 5dcb6b91 blueswir1
        switch(size) {
1920 5dcb6b91 blueswir1
        case 1:
1921 c227f099 Anthony Liguori
            ret = ldub_phys((target_phys_addr_t)addr
1922 c227f099 Anthony Liguori
                            | ((target_phys_addr_t)(asi & 0xf) << 32));
1923 5dcb6b91 blueswir1
            break;
1924 5dcb6b91 blueswir1
        case 2:
1925 c227f099 Anthony Liguori
            ret = lduw_phys((target_phys_addr_t)addr
1926 c227f099 Anthony Liguori
                            | ((target_phys_addr_t)(asi & 0xf) << 32));
1927 5dcb6b91 blueswir1
            break;
1928 5dcb6b91 blueswir1
        default:
1929 5dcb6b91 blueswir1
        case 4:
1930 c227f099 Anthony Liguori
            ret = ldl_phys((target_phys_addr_t)addr
1931 c227f099 Anthony Liguori
                           | ((target_phys_addr_t)(asi & 0xf) << 32));
1932 5dcb6b91 blueswir1
            break;
1933 5dcb6b91 blueswir1
        case 8:
1934 c227f099 Anthony Liguori
            ret = ldq_phys((target_phys_addr_t)addr
1935 c227f099 Anthony Liguori
                           | ((target_phys_addr_t)(asi & 0xf) << 32));
1936 0f8a249a blueswir1
            break;
1937 5dcb6b91 blueswir1
        }
1938 0f8a249a blueswir1
        break;
1939 045380be blueswir1
    case 0x30: // Turbosparc secondary cache diagnostic
1940 045380be blueswir1
    case 0x31: // Turbosparc RAM snoop
1941 045380be blueswir1
    case 0x32: // Turbosparc page table descriptor diagnostic
1942 666c87aa blueswir1
    case 0x39: /* data cache diagnostic register */
1943 da7ed379 Artyom Tarasenko
    case 0x4c: /* SuperSPARC MMU Breakpoint Action register */
1944 666c87aa blueswir1
        ret = 0;
1945 666c87aa blueswir1
        break;
1946 4017190e blueswir1
    case 0x38: /* SuperSPARC MMU Breakpoint Control Registers */
1947 4017190e blueswir1
        {
1948 4017190e blueswir1
            int reg = (addr >> 8) & 3;
1949 4017190e blueswir1
1950 4017190e blueswir1
            switch(reg) {
1951 4017190e blueswir1
            case 0: /* Breakpoint Value (Addr) */
1952 4017190e blueswir1
                ret = env->mmubpregs[reg];
1953 4017190e blueswir1
                break;
1954 4017190e blueswir1
            case 1: /* Breakpoint Mask */
1955 4017190e blueswir1
                ret = env->mmubpregs[reg];
1956 4017190e blueswir1
                break;
1957 4017190e blueswir1
            case 2: /* Breakpoint Control */
1958 4017190e blueswir1
                ret = env->mmubpregs[reg];
1959 4017190e blueswir1
                break;
1960 4017190e blueswir1
            case 3: /* Breakpoint Status */
1961 4017190e blueswir1
                ret = env->mmubpregs[reg];
1962 4017190e blueswir1
                env->mmubpregs[reg] = 0ULL;
1963 4017190e blueswir1
                break;
1964 4017190e blueswir1
            }
1965 0bf9e31a Blue Swirl
            DPRINTF_MMU("read breakpoint reg[%d] 0x%016" PRIx64 "\n", reg,
1966 0bf9e31a Blue Swirl
                        ret);
1967 4017190e blueswir1
        }
1968 4017190e blueswir1
        break;
1969 045380be blueswir1
    case 8: /* User code access, XXX */
1970 e8af50a3 bellard
    default:
1971 e18231a3 blueswir1
        do_unassigned_access(addr, 0, 0, asi, size);
1972 0f8a249a blueswir1
        ret = 0;
1973 0f8a249a blueswir1
        break;
1974 e8af50a3 bellard
    }
1975 81ad8ba2 blueswir1
    if (sign) {
1976 81ad8ba2 blueswir1
        switch(size) {
1977 81ad8ba2 blueswir1
        case 1:
1978 1a2fb1c0 blueswir1
            ret = (int8_t) ret;
1979 e32664fb blueswir1
            break;
1980 81ad8ba2 blueswir1
        case 2:
1981 1a2fb1c0 blueswir1
            ret = (int16_t) ret;
1982 1a2fb1c0 blueswir1
            break;
1983 1a2fb1c0 blueswir1
        case 4:
1984 1a2fb1c0 blueswir1
            ret = (int32_t) ret;
1985 e32664fb blueswir1
            break;
1986 81ad8ba2 blueswir1
        default:
1987 81ad8ba2 blueswir1
            break;
1988 81ad8ba2 blueswir1
        }
1989 81ad8ba2 blueswir1
    }
1990 8543e2cf blueswir1
#ifdef DEBUG_ASI
1991 1a2fb1c0 blueswir1
    dump_asi("read ", last_addr, asi, size, ret);
1992 8543e2cf blueswir1
#endif
1993 1a2fb1c0 blueswir1
    return ret;
1994 e8af50a3 bellard
}
1995 e8af50a3 bellard
1996 1a2fb1c0 blueswir1
void helper_st_asi(target_ulong addr, uint64_t val, int asi, int size)
1997 e8af50a3 bellard
{
1998 c2bc0e38 blueswir1
    helper_check_align(addr, size - 1);
1999 e8af50a3 bellard
    switch(asi) {
2000 b04d9890 Fabien Chouteau
    case 2: /* SuperSparc MXCC registers and Leon3 cache control */
2001 1a2fb1c0 blueswir1
        switch (addr) {
2002 b04d9890 Fabien Chouteau
        case 0x00:          /* Leon3 Cache Control */
2003 b04d9890 Fabien Chouteau
        case 0x08:          /* Leon3 Instruction Cache config */
2004 b04d9890 Fabien Chouteau
        case 0x0C:          /* Leon3 Date Cache config */
2005 60f356e8 Fabien Chouteau
            if (env->def->features & CPU_FEATURE_CACHE_CTRL) {
2006 60f356e8 Fabien Chouteau
                leon3_cache_control_st(addr, val, size);
2007 60f356e8 Fabien Chouteau
            }
2008 b04d9890 Fabien Chouteau
            break;
2009 b04d9890 Fabien Chouteau
2010 952a328f blueswir1
        case 0x01c00000: /* MXCC stream data register 0 */
2011 952a328f blueswir1
            if (size == 8)
2012 1a2fb1c0 blueswir1
                env->mxccdata[0] = val;
2013 952a328f blueswir1
            else
2014 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2015 77f193da blueswir1
                             size);
2016 952a328f blueswir1
            break;
2017 952a328f blueswir1
        case 0x01c00008: /* MXCC stream data register 1 */
2018 952a328f blueswir1
            if (size == 8)
2019 1a2fb1c0 blueswir1
                env->mxccdata[1] = val;
2020 952a328f blueswir1
            else
2021 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2022 77f193da blueswir1
                             size);
2023 952a328f blueswir1
            break;
2024 952a328f blueswir1
        case 0x01c00010: /* MXCC stream data register 2 */
2025 952a328f blueswir1
            if (size == 8)
2026 1a2fb1c0 blueswir1
                env->mxccdata[2] = val;
2027 952a328f blueswir1
            else
2028 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2029 77f193da blueswir1
                             size);
2030 952a328f blueswir1
            break;
2031 952a328f blueswir1
        case 0x01c00018: /* MXCC stream data register 3 */
2032 952a328f blueswir1
            if (size == 8)
2033 1a2fb1c0 blueswir1
                env->mxccdata[3] = val;
2034 952a328f blueswir1
            else
2035 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2036 77f193da blueswir1
                             size);
2037 952a328f blueswir1
            break;
2038 952a328f blueswir1
        case 0x01c00100: /* MXCC stream source */
2039 952a328f blueswir1
            if (size == 8)
2040 1a2fb1c0 blueswir1
                env->mxccregs[0] = val;
2041 952a328f blueswir1
            else
2042 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2043 77f193da blueswir1
                             size);
2044 77f193da blueswir1
            env->mxccdata[0] = ldq_phys((env->mxccregs[0] & 0xffffffffULL) +
2045 77f193da blueswir1
                                        0);
2046 77f193da blueswir1
            env->mxccdata[1] = ldq_phys((env->mxccregs[0] & 0xffffffffULL) +
2047 77f193da blueswir1
                                        8);
2048 77f193da blueswir1
            env->mxccdata[2] = ldq_phys((env->mxccregs[0] & 0xffffffffULL) +
2049 77f193da blueswir1
                                        16);
2050 77f193da blueswir1
            env->mxccdata[3] = ldq_phys((env->mxccregs[0] & 0xffffffffULL) +
2051 77f193da blueswir1
                                        24);
2052 952a328f blueswir1
            break;
2053 952a328f blueswir1
        case 0x01c00200: /* MXCC stream destination */
2054 952a328f blueswir1
            if (size == 8)
2055 1a2fb1c0 blueswir1
                env->mxccregs[1] = val;
2056 952a328f blueswir1
            else
2057 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2058 77f193da blueswir1
                             size);
2059 77f193da blueswir1
            stq_phys((env->mxccregs[1] & 0xffffffffULL) +  0,
2060 77f193da blueswir1
                     env->mxccdata[0]);
2061 77f193da blueswir1
            stq_phys((env->mxccregs[1] & 0xffffffffULL) +  8,
2062 77f193da blueswir1
                     env->mxccdata[1]);
2063 77f193da blueswir1
            stq_phys((env->mxccregs[1] & 0xffffffffULL) + 16,
2064 77f193da blueswir1
                     env->mxccdata[2]);
2065 77f193da blueswir1
            stq_phys((env->mxccregs[1] & 0xffffffffULL) + 24,
2066 77f193da blueswir1
                     env->mxccdata[3]);
2067 952a328f blueswir1
            break;
2068 952a328f blueswir1
        case 0x01c00a00: /* MXCC control register */
2069 952a328f blueswir1
            if (size == 8)
2070 1a2fb1c0 blueswir1
                env->mxccregs[3] = val;
2071 952a328f blueswir1
            else
2072 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2073 77f193da blueswir1
                             size);
2074 952a328f blueswir1
            break;
2075 952a328f blueswir1
        case 0x01c00a04: /* MXCC control register */
2076 952a328f blueswir1
            if (size == 4)
2077 9f4576f0 blueswir1
                env->mxccregs[3] = (env->mxccregs[3] & 0xffffffff00000000ULL)
2078 77f193da blueswir1
                    | val;
2079 952a328f blueswir1
            else
2080 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2081 77f193da blueswir1
                             size);
2082 952a328f blueswir1
            break;
2083 952a328f blueswir1
        case 0x01c00e00: /* MXCC error register  */
2084 bbf7d96b blueswir1
            // writing a 1 bit clears the error
2085 952a328f blueswir1
            if (size == 8)
2086 1a2fb1c0 blueswir1
                env->mxccregs[6] &= ~val;
2087 952a328f blueswir1
            else
2088 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2089 77f193da blueswir1
                             size);
2090 952a328f blueswir1
            break;
2091 952a328f blueswir1
        case 0x01c00f00: /* MBus port address register */
2092 952a328f blueswir1
            if (size == 8)
2093 1a2fb1c0 blueswir1
                env->mxccregs[7] = val;
2094 952a328f blueswir1
            else
2095 77f193da blueswir1
                DPRINTF_MXCC("%08x: unimplemented access size: %d\n", addr,
2096 77f193da blueswir1
                             size);
2097 952a328f blueswir1
            break;
2098 952a328f blueswir1
        default:
2099 77f193da blueswir1
            DPRINTF_MXCC("%08x: unimplemented address, size: %d\n", addr,
2100 77f193da blueswir1
                         size);
2101 952a328f blueswir1
            break;
2102 952a328f blueswir1
        }
2103 9827e450 blueswir1
        DPRINTF_MXCC("asi = %d, size = %d, addr = %08x, val = %" PRIx64 "\n",
2104 9827e450 blueswir1
                     asi, size, addr, val);
2105 952a328f blueswir1
#ifdef DEBUG_MXCC
2106 952a328f blueswir1
        dump_mxcc(env);
2107 952a328f blueswir1
#endif
2108 6c36d3fa blueswir1
        break;
2109 e8af50a3 bellard
    case 3: /* MMU flush */
2110 0f8a249a blueswir1
        {
2111 0f8a249a blueswir1
            int mmulev;
2112 e80cfcfc bellard
2113 1a2fb1c0 blueswir1
            mmulev = (addr >> 8) & 15;
2114 952a328f blueswir1
            DPRINTF_MMU("mmu flush level %d\n", mmulev);
2115 0f8a249a blueswir1
            switch (mmulev) {
2116 0f8a249a blueswir1
            case 0: // flush page
2117 1a2fb1c0 blueswir1
                tlb_flush_page(env, addr & 0xfffff000);
2118 0f8a249a blueswir1
                break;
2119 0f8a249a blueswir1
            case 1: // flush segment (256k)
2120 0f8a249a blueswir1
            case 2: // flush region (16M)
2121 0f8a249a blueswir1
            case 3: // flush context (4G)
2122 0f8a249a blueswir1
            case 4: // flush entire
2123 0f8a249a blueswir1
                tlb_flush(env, 1);
2124 0f8a249a blueswir1
                break;
2125 0f8a249a blueswir1
            default:
2126 0f8a249a blueswir1
                break;
2127 0f8a249a blueswir1
            }
2128 55754d9e bellard
#ifdef DEBUG_MMU
2129 d41160a3 Blue Swirl
            dump_mmu(stdout, fprintf, env);
2130 55754d9e bellard
#endif
2131 0f8a249a blueswir1
        }
2132 8543e2cf blueswir1
        break;
2133 e8af50a3 bellard
    case 4: /* write MMU regs */
2134 0f8a249a blueswir1
        {
2135 1a2fb1c0 blueswir1
            int reg = (addr >> 8) & 0x1f;
2136 0f8a249a blueswir1
            uint32_t oldreg;
2137 3b46e624 ths
2138 0f8a249a blueswir1
            oldreg = env->mmuregs[reg];
2139 55754d9e bellard
            switch(reg) {
2140 3deaeab7 blueswir1
            case 0: // Control Register
2141 3dd9a152 blueswir1
                env->mmuregs[reg] = (env->mmuregs[reg] & 0xff000000) |
2142 1a2fb1c0 blueswir1
                                    (val & 0x00ffffff);
2143 0f8a249a blueswir1
                // Mappings generated during no-fault mode or MMU
2144 0f8a249a blueswir1
                // disabled mode are invalid in normal mode
2145 5578ceab blueswir1
                if ((oldreg & (MMU_E | MMU_NF | env->def->mmu_bm)) !=
2146 5578ceab blueswir1
                    (env->mmuregs[reg] & (MMU_E | MMU_NF | env->def->mmu_bm)))
2147 55754d9e bellard
                    tlb_flush(env, 1);
2148 55754d9e bellard
                break;
2149 3deaeab7 blueswir1
            case 1: // Context Table Pointer Register
2150 5578ceab blueswir1
                env->mmuregs[reg] = val & env->def->mmu_ctpr_mask;
2151 3deaeab7 blueswir1
                break;
2152 3deaeab7 blueswir1
            case 2: // Context Register
2153 5578ceab blueswir1
                env->mmuregs[reg] = val & env->def->mmu_cxr_mask;
2154 55754d9e bellard
                if (oldreg != env->mmuregs[reg]) {
2155 55754d9e bellard
                    /* we flush when the MMU context changes because
2156 55754d9e bellard
                       QEMU has no MMU context support */
2157 55754d9e bellard
                    tlb_flush(env, 1);
2158 55754d9e bellard
                }
2159 55754d9e bellard
                break;
2160 3deaeab7 blueswir1
            case 3: // Synchronous Fault Status Register with Clear
2161 3deaeab7 blueswir1
            case 4: // Synchronous Fault Address Register
2162 3deaeab7 blueswir1
                break;
2163 3deaeab7 blueswir1
            case 0x10: // TLB Replacement Control Register
2164 5578ceab blueswir1
                env->mmuregs[reg] = val & env->def->mmu_trcr_mask;
2165 55754d9e bellard
                break;
2166 3deaeab7 blueswir1
            case 0x13: // Synchronous Fault Status Register with Read and Clear
2167 5578ceab blueswir1
                env->mmuregs[3] = val & env->def->mmu_sfsr_mask;
2168 3dd9a152 blueswir1
                break;
2169 3deaeab7 blueswir1
            case 0x14: // Synchronous Fault Address Register
2170 1a2fb1c0 blueswir1
                env->mmuregs[4] = val;
2171 3dd9a152 blueswir1
                break;
2172 55754d9e bellard
            default:
2173 1a2fb1c0 blueswir1
                env->mmuregs[reg] = val;
2174 55754d9e bellard
                break;
2175 55754d9e bellard
            }
2176 55754d9e bellard
            if (oldreg != env->mmuregs[reg]) {
2177 77f193da blueswir1
                DPRINTF_MMU("mmu change reg[%d]: 0x%08x -> 0x%08x\n",
2178 77f193da blueswir1
                            reg, oldreg, env->mmuregs[reg]);
2179 55754d9e bellard
            }
2180 952a328f blueswir1
#ifdef DEBUG_MMU
2181 d41160a3 Blue Swirl
            dump_mmu(stdout, fprintf, env);
2182 55754d9e bellard
#endif
2183 0f8a249a blueswir1
        }
2184 8543e2cf blueswir1
        break;
2185 045380be blueswir1
    case 5: // Turbosparc ITLB Diagnostic
2186 045380be blueswir1
    case 6: // Turbosparc DTLB Diagnostic
2187 045380be blueswir1
    case 7: // Turbosparc IOTLB Diagnostic
2188 045380be blueswir1
        break;
2189 81ad8ba2 blueswir1
    case 0xa: /* User data access */
2190 81ad8ba2 blueswir1
        switch(size) {
2191 81ad8ba2 blueswir1
        case 1:
2192 1a2fb1c0 blueswir1
            stb_user(addr, val);
2193 81ad8ba2 blueswir1
            break;
2194 81ad8ba2 blueswir1
        case 2:
2195 a4e7dd52 blueswir1
            stw_user(addr, val);
2196 81ad8ba2 blueswir1
            break;
2197 81ad8ba2 blueswir1
        default:
2198 81ad8ba2 blueswir1
        case 4:
2199 a4e7dd52 blueswir1
            stl_user(addr, val);
2200 81ad8ba2 blueswir1
            break;
2201 81ad8ba2 blueswir1
        case 8:
2202 a4e7dd52 blueswir1
            stq_user(addr, val);
2203 81ad8ba2 blueswir1
            break;
2204 81ad8ba2 blueswir1
        }
2205 81ad8ba2 blueswir1
        break;
2206 81ad8ba2 blueswir1
    case 0xb: /* Supervisor data access */
2207 81ad8ba2 blueswir1
        switch(size) {
2208 81ad8ba2 blueswir1
        case 1:
2209 1a2fb1c0 blueswir1
            stb_kernel(addr, val);
2210 81ad8ba2 blueswir1
            break;
2211 81ad8ba2 blueswir1
        case 2:
2212 a4e7dd52 blueswir1
            stw_kernel(addr, val);
2213 81ad8ba2 blueswir1
            break;
2214 81ad8ba2 blueswir1
        default:
2215 81ad8ba2 blueswir1
        case 4:
2216 a4e7dd52 blueswir1
            stl_kernel(addr, val);
2217 81ad8ba2 blueswir1
            break;
2218 81ad8ba2 blueswir1
        case 8:
2219 a4e7dd52 blueswir1
            stq_kernel(addr, val);
2220 81ad8ba2 blueswir1
            break;
2221 81ad8ba2 blueswir1
        }
2222 81ad8ba2 blueswir1
        break;
2223 6c36d3fa blueswir1
    case 0xc: /* I-cache tag */
2224 6c36d3fa blueswir1
    case 0xd: /* I-cache data */
2225 6c36d3fa blueswir1
    case 0xe: /* D-cache tag */
2226 6c36d3fa blueswir1
    case 0xf: /* D-cache data */
2227 6c36d3fa blueswir1
    case 0x10: /* I/D-cache flush page */
2228 6c36d3fa blueswir1
    case 0x11: /* I/D-cache flush segment */
2229 6c36d3fa blueswir1
    case 0x12: /* I/D-cache flush region */
2230 6c36d3fa blueswir1
    case 0x13: /* I/D-cache flush context */
2231 6c36d3fa blueswir1
    case 0x14: /* I/D-cache flush user */
2232 6c36d3fa blueswir1
        break;
2233 e80cfcfc bellard
    case 0x17: /* Block copy, sta access */
2234 0f8a249a blueswir1
        {
2235 1a2fb1c0 blueswir1
            // val = src
2236 1a2fb1c0 blueswir1
            // addr = dst
2237 0f8a249a blueswir1
            // copy 32 bytes
2238 6c36d3fa blueswir1
            unsigned int i;
2239 1a2fb1c0 blueswir1
            uint32_t src = val & ~3, dst = addr & ~3, temp;
2240 3b46e624 ths
2241 6c36d3fa blueswir1
            for (i = 0; i < 32; i += 4, src += 4, dst += 4) {
2242 6c36d3fa blueswir1
                temp = ldl_kernel(src);
2243 6c36d3fa blueswir1
                stl_kernel(dst, temp);
2244 6c36d3fa blueswir1
            }
2245 0f8a249a blueswir1
        }
2246 8543e2cf blueswir1
        break;
2247 e80cfcfc bellard
    case 0x1f: /* Block fill, stda access */
2248 0f8a249a blueswir1
        {
2249 1a2fb1c0 blueswir1
            // addr = dst
2250 1a2fb1c0 blueswir1
            // fill 32 bytes with val
2251 6c36d3fa blueswir1
            unsigned int i;
2252 1a2fb1c0 blueswir1
            uint32_t dst = addr & 7;
2253 6c36d3fa blueswir1
2254 6c36d3fa blueswir1
            for (i = 0; i < 32; i += 8, dst += 8)
2255 6c36d3fa blueswir1
                stq_kernel(dst, val);
2256 0f8a249a blueswir1
        }
2257 8543e2cf blueswir1
        break;
2258 6c36d3fa blueswir1
    case 0x20: /* MMU passthrough */
2259 0f8a249a blueswir1
        {
2260 02aab46a bellard
            switch(size) {
2261 02aab46a bellard
            case 1:
2262 1a2fb1c0 blueswir1
                stb_phys(addr, val);
2263 02aab46a bellard
                break;
2264 02aab46a bellard
            case 2:
2265 a4e7dd52 blueswir1
                stw_phys(addr, val);
2266 02aab46a bellard
                break;
2267 02aab46a bellard
            case 4:
2268 02aab46a bellard
            default:
2269 a4e7dd52 blueswir1
                stl_phys(addr, val);
2270 02aab46a bellard
                break;
2271 9e61bde5 bellard
            case 8:
2272 a4e7dd52 blueswir1
                stq_phys(addr, val);
2273 9e61bde5 bellard
                break;
2274 02aab46a bellard
            }
2275 0f8a249a blueswir1
        }
2276 8543e2cf blueswir1
        break;
2277 045380be blueswir1
    case 0x21 ... 0x2f: /* MMU passthrough, 0x100000000 to 0xfffffffff */
2278 0f8a249a blueswir1
        {
2279 5dcb6b91 blueswir1
            switch(size) {
2280 5dcb6b91 blueswir1
            case 1:
2281 c227f099 Anthony Liguori
                stb_phys((target_phys_addr_t)addr
2282 c227f099 Anthony Liguori
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
2283 5dcb6b91 blueswir1
                break;
2284 5dcb6b91 blueswir1
            case 2:
2285 c227f099 Anthony Liguori
                stw_phys((target_phys_addr_t)addr
2286 c227f099 Anthony Liguori
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
2287 5dcb6b91 blueswir1
                break;
2288 5dcb6b91 blueswir1
            case 4:
2289 5dcb6b91 blueswir1
            default:
2290 c227f099 Anthony Liguori
                stl_phys((target_phys_addr_t)addr
2291 c227f099 Anthony Liguori
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
2292 5dcb6b91 blueswir1
                break;
2293 5dcb6b91 blueswir1
            case 8:
2294 c227f099 Anthony Liguori
                stq_phys((target_phys_addr_t)addr
2295 c227f099 Anthony Liguori
                         | ((target_phys_addr_t)(asi & 0xf) << 32), val);
2296 5dcb6b91 blueswir1
                break;
2297 5dcb6b91 blueswir1
            }
2298 0f8a249a blueswir1
        }
2299 8543e2cf blueswir1
        break;
2300 045380be blueswir1
    case 0x30: // store buffer tags or Turbosparc secondary cache diagnostic
2301 045380be blueswir1
    case 0x31: // store buffer data, Ross RT620 I-cache flush or
2302 045380be blueswir1
               // Turbosparc snoop RAM
2303 77f193da blueswir1
    case 0x32: // store buffer control or Turbosparc page table
2304 77f193da blueswir1
               // descriptor diagnostic
2305 6c36d3fa blueswir1
    case 0x36: /* I-cache flash clear */
2306 6c36d3fa blueswir1
    case 0x37: /* D-cache flash clear */
2307 666c87aa blueswir1
    case 0x4c: /* breakpoint action */
2308 6c36d3fa blueswir1
        break;
2309 4017190e blueswir1
    case 0x38: /* SuperSPARC MMU Breakpoint Control Registers*/
2310 4017190e blueswir1
        {
2311 4017190e blueswir1
            int reg = (addr >> 8) & 3;
2312 4017190e blueswir1
2313 4017190e blueswir1
            switch(reg) {
2314 4017190e blueswir1
            case 0: /* Breakpoint Value (Addr) */
2315 4017190e blueswir1
                env->mmubpregs[reg] = (val & 0xfffffffffULL);
2316 4017190e blueswir1
                break;
2317 4017190e blueswir1
            case 1: /* Breakpoint Mask */
2318 4017190e blueswir1
                env->mmubpregs[reg] = (val & 0xfffffffffULL);
2319 4017190e blueswir1
                break;
2320 4017190e blueswir1
            case 2: /* Breakpoint Control */
2321 4017190e blueswir1
                env->mmubpregs[reg] = (val & 0x7fULL);
2322 4017190e blueswir1
                break;
2323 4017190e blueswir1
            case 3: /* Breakpoint Status */
2324 4017190e blueswir1
                env->mmubpregs[reg] = (val & 0xfULL);
2325 4017190e blueswir1
                break;
2326 4017190e blueswir1
            }
2327 0bf9e31a Blue Swirl
            DPRINTF_MMU("write breakpoint reg[%d] 0x%016x\n", reg,
2328 4017190e blueswir1
                        env->mmuregs[reg]);
2329 4017190e blueswir1
        }
2330 4017190e blueswir1
        break;
2331 045380be blueswir1
    case 8: /* User code access, XXX */
2332 6c36d3fa blueswir1
    case 9: /* Supervisor code access, XXX */
2333 e8af50a3 bellard
    default:
2334 e18231a3 blueswir1
        do_unassigned_access(addr, 1, 0, asi, size);
2335 8543e2cf blueswir1
        break;
2336 e8af50a3 bellard
    }
2337 8543e2cf blueswir1
#ifdef DEBUG_ASI
2338 1a2fb1c0 blueswir1
    dump_asi("write", addr, asi, size, val);
2339 8543e2cf blueswir1
#endif
2340 e8af50a3 bellard
}
2341 e8af50a3 bellard
2342 81ad8ba2 blueswir1
#endif /* CONFIG_USER_ONLY */
2343 81ad8ba2 blueswir1
#else /* TARGET_SPARC64 */
2344 81ad8ba2 blueswir1
2345 81ad8ba2 blueswir1
#ifdef CONFIG_USER_ONLY
2346 1a2fb1c0 blueswir1
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
2347 81ad8ba2 blueswir1
{
2348 81ad8ba2 blueswir1
    uint64_t ret = 0;
2349 1a2fb1c0 blueswir1
#if defined(DEBUG_ASI)
2350 1a2fb1c0 blueswir1
    target_ulong last_addr = addr;
2351 1a2fb1c0 blueswir1
#endif
2352 81ad8ba2 blueswir1
2353 81ad8ba2 blueswir1
    if (asi < 0x80)
2354 81ad8ba2 blueswir1
        raise_exception(TT_PRIV_ACT);
2355 81ad8ba2 blueswir1
2356 c2bc0e38 blueswir1
    helper_check_align(addr, size - 1);
2357 1295001c Igor V. Kovalenko
    addr = asi_address_mask(env, asi, addr);
2358 c2bc0e38 blueswir1
2359 81ad8ba2 blueswir1
    switch (asi) {
2360 81ad8ba2 blueswir1
    case 0x82: // Primary no-fault
2361 81ad8ba2 blueswir1
    case 0x8a: // Primary no-fault LE
2362 e83ce550 blueswir1
        if (page_check_range(addr, size, PAGE_READ) == -1) {
2363 e83ce550 blueswir1
#ifdef DEBUG_ASI
2364 e83ce550 blueswir1
            dump_asi("read ", last_addr, asi, size, ret);
2365 e83ce550 blueswir1
#endif
2366 e83ce550 blueswir1
            return 0;
2367 e83ce550 blueswir1
        }
2368 e83ce550 blueswir1
        // Fall through
2369 e83ce550 blueswir1
    case 0x80: // Primary
2370 e83ce550 blueswir1
    case 0x88: // Primary LE
2371 81ad8ba2 blueswir1
        {
2372 81ad8ba2 blueswir1
            switch(size) {
2373 81ad8ba2 blueswir1
            case 1:
2374 1a2fb1c0 blueswir1
                ret = ldub_raw(addr);
2375 81ad8ba2 blueswir1
                break;
2376 81ad8ba2 blueswir1
            case 2:
2377 a4e7dd52 blueswir1
                ret = lduw_raw(addr);
2378 81ad8ba2 blueswir1
                break;
2379 81ad8ba2 blueswir1
            case 4:
2380 a4e7dd52 blueswir1
                ret = ldl_raw(addr);
2381 81ad8ba2 blueswir1
                break;
2382 81ad8ba2 blueswir1
            default:
2383 81ad8ba2 blueswir1
            case 8:
2384 a4e7dd52 blueswir1
                ret = ldq_raw(addr);
2385 81ad8ba2 blueswir1
                break;
2386 81ad8ba2 blueswir1
            }
2387 81ad8ba2 blueswir1
        }
2388 81ad8ba2 blueswir1
        break;
2389 81ad8ba2 blueswir1
    case 0x83: // Secondary no-fault
2390 81ad8ba2 blueswir1
    case 0x8b: // Secondary no-fault LE
2391 e83ce550 blueswir1
        if (page_check_range(addr, size, PAGE_READ) == -1) {
2392 e83ce550 blueswir1
#ifdef DEBUG_ASI
2393 e83ce550 blueswir1
            dump_asi("read ", last_addr, asi, size, ret);
2394 e83ce550 blueswir1
#endif
2395 e83ce550 blueswir1
            return 0;
2396 e83ce550 blueswir1
        }
2397 e83ce550 blueswir1
        // Fall through
2398 e83ce550 blueswir1
    case 0x81: // Secondary
2399 e83ce550 blueswir1
    case 0x89: // Secondary LE
2400 81ad8ba2 blueswir1
        // XXX
2401 81ad8ba2 blueswir1
        break;
2402 81ad8ba2 blueswir1
    default:
2403 81ad8ba2 blueswir1
        break;
2404 81ad8ba2 blueswir1
    }
2405 81ad8ba2 blueswir1
2406 81ad8ba2 blueswir1
    /* Convert from little endian */
2407 81ad8ba2 blueswir1
    switch (asi) {
2408 81ad8ba2 blueswir1
    case 0x88: // Primary LE
2409 81ad8ba2 blueswir1
    case 0x89: // Secondary LE
2410 81ad8ba2 blueswir1
    case 0x8a: // Primary no-fault LE
2411 81ad8ba2 blueswir1
    case 0x8b: // Secondary no-fault LE
2412 81ad8ba2 blueswir1
        switch(size) {
2413 81ad8ba2 blueswir1
        case 2:
2414 81ad8ba2 blueswir1
            ret = bswap16(ret);
2415 e32664fb blueswir1
            break;
2416 81ad8ba2 blueswir1
        case 4:
2417 81ad8ba2 blueswir1
            ret = bswap32(ret);
2418 e32664fb blueswir1
            break;
2419 81ad8ba2 blueswir1
        case 8:
2420 81ad8ba2 blueswir1
            ret = bswap64(ret);
2421 e32664fb blueswir1
            break;
2422 81ad8ba2 blueswir1
        default:
2423 81ad8ba2 blueswir1
            break;
2424 81ad8ba2 blueswir1
        }
2425 81ad8ba2 blueswir1
    default:
2426 81ad8ba2 blueswir1
        break;
2427 81ad8ba2 blueswir1
    }
2428 81ad8ba2 blueswir1
2429 81ad8ba2 blueswir1
    /* Convert to signed number */
2430 81ad8ba2 blueswir1
    if (sign) {
2431 81ad8ba2 blueswir1
        switch(size) {
2432 81ad8ba2 blueswir1
        case 1:
2433 81ad8ba2 blueswir1
            ret = (int8_t) ret;
2434 e32664fb blueswir1
            break;
2435 81ad8ba2 blueswir1
        case 2:
2436 81ad8ba2 blueswir1
            ret = (int16_t) ret;
2437 e32664fb blueswir1
            break;
2438 81ad8ba2 blueswir1
        case 4:
2439 81ad8ba2 blueswir1
            ret = (int32_t) ret;
2440 e32664fb blueswir1
            break;
2441 81ad8ba2 blueswir1
        default:
2442 81ad8ba2 blueswir1
            break;
2443 81ad8ba2 blueswir1
        }
2444 81ad8ba2 blueswir1
    }
2445 1a2fb1c0 blueswir1
#ifdef DEBUG_ASI
2446 1a2fb1c0 blueswir1
    dump_asi("read ", last_addr, asi, size, ret);
2447 1a2fb1c0 blueswir1
#endif
2448 1a2fb1c0 blueswir1
    return ret;
2449 81ad8ba2 blueswir1
}
2450 81ad8ba2 blueswir1
2451 1a2fb1c0 blueswir1
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
2452 81ad8ba2 blueswir1
{
2453 1a2fb1c0 blueswir1
#ifdef DEBUG_ASI
2454 1a2fb1c0 blueswir1
    dump_asi("write", addr, asi, size, val);
2455 1a2fb1c0 blueswir1
#endif
2456 81ad8ba2 blueswir1
    if (asi < 0x80)
2457 81ad8ba2 blueswir1
        raise_exception(TT_PRIV_ACT);
2458 81ad8ba2 blueswir1
2459 c2bc0e38 blueswir1
    helper_check_align(addr, size - 1);
2460 1295001c Igor V. Kovalenko
    addr = asi_address_mask(env, asi, addr);
2461 c2bc0e38 blueswir1
2462 81ad8ba2 blueswir1
    /* Convert to little endian */
2463 81ad8ba2 blueswir1
    switch (asi) {
2464 81ad8ba2 blueswir1
    case 0x88: // Primary LE
2465 81ad8ba2 blueswir1
    case 0x89: // Secondary LE
2466 81ad8ba2 blueswir1
        switch(size) {
2467 81ad8ba2 blueswir1
        case 2:
2468 5b0f0bec Igor Kovalenko
            val = bswap16(val);
2469 e32664fb blueswir1
            break;
2470 81ad8ba2 blueswir1
        case 4:
2471 5b0f0bec Igor Kovalenko
            val = bswap32(val);
2472 e32664fb blueswir1
            break;
2473 81ad8ba2 blueswir1
        case 8:
2474 5b0f0bec Igor Kovalenko
            val = bswap64(val);
2475 e32664fb blueswir1
            break;
2476 81ad8ba2 blueswir1
        default:
2477 81ad8ba2 blueswir1
            break;
2478 81ad8ba2 blueswir1
        }
2479 81ad8ba2 blueswir1
    default:
2480 81ad8ba2 blueswir1
        break;
2481 81ad8ba2 blueswir1
    }
2482 81ad8ba2 blueswir1
2483 81ad8ba2 blueswir1
    switch(asi) {
2484 81ad8ba2 blueswir1
    case 0x80: // Primary
2485 81ad8ba2 blueswir1
    case 0x88: // Primary LE
2486 81ad8ba2 blueswir1
        {
2487 81ad8ba2 blueswir1
            switch(size) {
2488 81ad8ba2 blueswir1
            case 1:
2489 1a2fb1c0 blueswir1
                stb_raw(addr, val);
2490 81ad8ba2 blueswir1
                break;
2491 81ad8ba2 blueswir1
            case 2:
2492 a4e7dd52 blueswir1
                stw_raw(addr, val);
2493 81ad8ba2 blueswir1
                break;
2494 81ad8ba2 blueswir1
            case 4:
2495 a4e7dd52 blueswir1
                stl_raw(addr, val);
2496 81ad8ba2 blueswir1
                break;
2497 81ad8ba2 blueswir1
            case 8:
2498 81ad8ba2 blueswir1
            default:
2499 a4e7dd52 blueswir1
                stq_raw(addr, val);
2500 81ad8ba2 blueswir1
                break;
2501 81ad8ba2 blueswir1
            }
2502 81ad8ba2 blueswir1
        }
2503 81ad8ba2 blueswir1
        break;
2504 81ad8ba2 blueswir1
    case 0x81: // Secondary
2505 81ad8ba2 blueswir1
    case 0x89: // Secondary LE
2506 81ad8ba2 blueswir1
        // XXX
2507 81ad8ba2 blueswir1
        return;
2508 81ad8ba2 blueswir1
2509 81ad8ba2 blueswir1
    case 0x82: // Primary no-fault, RO
2510 81ad8ba2 blueswir1
    case 0x83: // Secondary no-fault, RO
2511 81ad8ba2 blueswir1
    case 0x8a: // Primary no-fault LE, RO
2512 81ad8ba2 blueswir1
    case 0x8b: // Secondary no-fault LE, RO
2513 81ad8ba2 blueswir1
    default:
2514 e18231a3 blueswir1
        do_unassigned_access(addr, 1, 0, 1, size);
2515 81ad8ba2 blueswir1
        return;
2516 81ad8ba2 blueswir1
    }
2517 81ad8ba2 blueswir1
}
2518 81ad8ba2 blueswir1
2519 81ad8ba2 blueswir1
#else /* CONFIG_USER_ONLY */
2520 3475187d bellard
2521 1a2fb1c0 blueswir1
uint64_t helper_ld_asi(target_ulong addr, int asi, int size, int sign)
2522 3475187d bellard
{
2523 83469015 bellard
    uint64_t ret = 0;
2524 1a2fb1c0 blueswir1
#if defined(DEBUG_ASI)
2525 1a2fb1c0 blueswir1
    target_ulong last_addr = addr;
2526 1a2fb1c0 blueswir1
#endif
2527 3475187d bellard
2528 01b5d4e5 Igor V. Kovalenko
    asi &= 0xff;
2529 01b5d4e5 Igor V. Kovalenko
2530 6f27aba6 blueswir1
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
2531 2aae2b8e Igor V. Kovalenko
        || (cpu_has_hypervisor(env)
2532 5578ceab blueswir1
            && asi >= 0x30 && asi < 0x80
2533 fb79ceb9 blueswir1
            && !(env->hpstate & HS_PRIV)))
2534 0f8a249a blueswir1
        raise_exception(TT_PRIV_ACT);
2535 3475187d bellard
2536 c2bc0e38 blueswir1
    helper_check_align(addr, size - 1);
2537 1295001c Igor V. Kovalenko
    addr = asi_address_mask(env, asi, addr);
2538 1295001c Igor V. Kovalenko
2539 3475187d bellard
    switch (asi) {
2540 e83ce550 blueswir1
    case 0x82: // Primary no-fault
2541 e83ce550 blueswir1
    case 0x8a: // Primary no-fault LE
2542 2065061e Igor V. Kovalenko
    case 0x83: // Secondary no-fault
2543 2065061e Igor V. Kovalenko
    case 0x8b: // Secondary no-fault LE
2544 2065061e Igor V. Kovalenko
        {
2545 2065061e Igor V. Kovalenko
            /* secondary space access has lowest asi bit equal to 1 */
2546 2065061e Igor V. Kovalenko
            int access_mmu_idx = ( asi & 1 ) ? MMU_KERNEL_IDX
2547 2065061e Igor V. Kovalenko
                                             : MMU_KERNEL_SECONDARY_IDX;
2548 2065061e Igor V. Kovalenko
2549 2065061e Igor V. Kovalenko
            if (cpu_get_phys_page_nofault(env, addr, access_mmu_idx) == -1ULL) {
2550 e83ce550 blueswir1
#ifdef DEBUG_ASI
2551 2065061e Igor V. Kovalenko
                dump_asi("read ", last_addr, asi, size, ret);
2552 e83ce550 blueswir1
#endif
2553 2065061e Igor V. Kovalenko
                return 0;
2554 2065061e Igor V. Kovalenko
            }
2555 e83ce550 blueswir1
        }
2556 e83ce550 blueswir1
        // Fall through
2557 81ad8ba2 blueswir1
    case 0x10: // As if user primary
2558 2065061e Igor V. Kovalenko
    case 0x11: // As if user secondary
2559 81ad8ba2 blueswir1
    case 0x18: // As if user primary LE
2560 2065061e Igor V. Kovalenko
    case 0x19: // As if user secondary LE
2561 81ad8ba2 blueswir1
    case 0x80: // Primary
2562 2065061e Igor V. Kovalenko
    case 0x81: // Secondary
2563 81ad8ba2 blueswir1
    case 0x88: // Primary LE
2564 2065061e Igor V. Kovalenko
    case 0x89: // Secondary LE
2565 c99657d3 blueswir1
    case 0xe2: // UA2007 Primary block init
2566 c99657d3 blueswir1
    case 0xe3: // UA2007 Secondary block init
2567 81ad8ba2 blueswir1
        if ((asi & 0x80) && (env->pstate & PS_PRIV)) {
2568 2aae2b8e Igor V. Kovalenko
            if (cpu_hypervisor_mode(env)) {
2569 6f27aba6 blueswir1
                switch(size) {
2570 6f27aba6 blueswir1
                case 1:
2571 1a2fb1c0 blueswir1
                    ret = ldub_hypv(addr);
2572 6f27aba6 blueswir1
                    break;
2573 6f27aba6 blueswir1
                case 2:
2574 a4e7dd52 blueswir1
                    ret = lduw_hypv(addr);
2575 6f27aba6 blueswir1
                    break;
2576 6f27aba6 blueswir1
                case 4:
2577 a4e7dd52 blueswir1
                    ret = ldl_hypv(addr);
2578 6f27aba6 blueswir1
                    break;
2579 6f27aba6 blueswir1
                default:
2580 6f27aba6 blueswir1
                case 8:
2581 a4e7dd52 blueswir1
                    ret = ldq_hypv(addr);
2582 6f27aba6 blueswir1
                    break;
2583 6f27aba6 blueswir1
                }
2584 6f27aba6 blueswir1
            } else {
2585 2065061e Igor V. Kovalenko
                /* secondary space access has lowest asi bit equal to 1 */
2586 2065061e Igor V. Kovalenko
                if (asi & 1) {
2587 2065061e Igor V. Kovalenko
                    switch(size) {
2588 2065061e Igor V. Kovalenko
                    case 1:
2589 2065061e Igor V. Kovalenko
                        ret = ldub_kernel_secondary(addr);
2590 2065061e Igor V. Kovalenko
                        break;
2591 2065061e Igor V. Kovalenko
                    case 2:
2592 2065061e Igor V. Kovalenko
                        ret = lduw_kernel_secondary(addr);
2593 2065061e Igor V. Kovalenko
                        break;
2594 2065061e Igor V. Kovalenko
                    case 4:
2595 2065061e Igor V. Kovalenko
                        ret = ldl_kernel_secondary(addr);
2596 2065061e Igor V. Kovalenko
                        break;
2597 2065061e Igor V. Kovalenko
                    default:
2598 2065061e Igor V. Kovalenko
                    case 8:
2599 2065061e Igor V. Kovalenko
                        ret = ldq_kernel_secondary(addr);
2600 2065061e Igor V. Kovalenko
                        break;
2601 2065061e Igor V. Kovalenko
                    }
2602 2065061e Igor V. Kovalenko
                } else {
2603 2065061e Igor V. Kovalenko
                    switch(size) {
2604 2065061e Igor V. Kovalenko
                    case 1:
2605 2065061e Igor V. Kovalenko
                        ret = ldub_kernel(addr);
2606 2065061e Igor V. Kovalenko
                        break;
2607 2065061e Igor V. Kovalenko
                    case 2:
2608 2065061e Igor V. Kovalenko
                        ret = lduw_kernel(addr);
2609 2065061e Igor V. Kovalenko
                        break;
2610 2065061e Igor V. Kovalenko
                    case 4:
2611 2065061e Igor V. Kovalenko
                        ret = ldl_kernel(addr);
2612 2065061e Igor V. Kovalenko
                        break;
2613 2065061e Igor V. Kovalenko
                    default:
2614 2065061e Igor V. Kovalenko
                    case 8:
2615 2065061e Igor V. Kovalenko
                        ret = ldq_kernel(addr);
2616 2065061e Igor V. Kovalenko
                        break;
2617 2065061e Igor V. Kovalenko
                    }
2618 2065061e Igor V. Kovalenko
                }
2619 2065061e Igor V. Kovalenko
            }
2620 2065061e Igor V. Kovalenko
        } else {
2621 2065061e Igor V. Kovalenko
            /* secondary space access has lowest asi bit equal to 1 */
2622 2065061e Igor V. Kovalenko
            if (asi & 1) {
2623 6f27aba6 blueswir1
                switch(size) {
2624 6f27aba6 blueswir1
                case 1:
2625 2065061e Igor V. Kovalenko
                    ret = ldub_user_secondary(addr);
2626 6f27aba6 blueswir1
                    break;
2627 6f27aba6 blueswir1
                case 2:
2628 2065061e Igor V. Kovalenko
                    ret = lduw_user_secondary(addr);
2629 6f27aba6 blueswir1
                    break;
2630 6f27aba6 blueswir1
                case 4:
2631 2065061e Igor V. Kovalenko
                    ret = ldl_user_secondary(addr);
2632 6f27aba6 blueswir1
                    break;
2633 6f27aba6 blueswir1
                default:
2634 6f27aba6 blueswir1
                case 8:
2635 2065061e Igor V. Kovalenko
                    ret = ldq_user_secondary(addr);
2636 2065061e Igor V. Kovalenko
                    break;
2637 2065061e Igor V. Kovalenko
                }
2638 2065061e Igor V. Kovalenko
            } else {
2639 2065061e Igor V. Kovalenko
                switch(size) {
2640 2065061e Igor V. Kovalenko
                case 1:
2641 2065061e Igor V. Kovalenko
                    ret = ldub_user(addr);
2642 2065061e Igor V. Kovalenko
                    break;
2643 2065061e Igor V. Kovalenko
                case 2:
2644 2065061e Igor V. Kovalenko
                    ret = lduw_user(addr);
2645 2065061e Igor V. Kovalenko
                    break;
2646 2065061e Igor V. Kovalenko
                case 4:
2647 2065061e Igor V. Kovalenko
                    ret = ldl_user(addr);
2648 2065061e Igor V. Kovalenko
                    break;
2649 2065061e Igor V. Kovalenko
                default:
2650 2065061e Igor V. Kovalenko
                case 8:
2651 2065061e Igor V. Kovalenko
                    ret = ldq_user(addr);
2652 6f27aba6 blueswir1
                    break;
2653 6f27aba6 blueswir1
                }
2654 81ad8ba2 blueswir1
            }
2655 81ad8ba2 blueswir1
        }
2656 81ad8ba2 blueswir1
        break;
2657 3475187d bellard
    case 0x14: // Bypass
2658 3475187d bellard
    case 0x15: // Bypass, non-cacheable
2659 81ad8ba2 blueswir1
    case 0x1c: // Bypass LE
2660 81ad8ba2 blueswir1
    case 0x1d: // Bypass, non-cacheable LE
2661 0f8a249a blueswir1
        {
2662 02aab46a bellard
            switch(size) {
2663 02aab46a bellard
            case 1:
2664 1a2fb1c0 blueswir1
                ret = ldub_phys(addr);
2665 02aab46a bellard
                break;
2666 02aab46a bellard
            case 2:
2667 a4e7dd52 blueswir1
                ret = lduw_phys(addr);
2668 02aab46a bellard
                break;
2669 02aab46a bellard
            case 4:
2670 a4e7dd52 blueswir1
                ret = ldl_phys(addr);
2671 02aab46a bellard
                break;
2672 02aab46a bellard
            default:
2673 02aab46a bellard
            case 8:
2674 a4e7dd52 blueswir1
                ret = ldq_phys(addr);
2675 02aab46a bellard
                break;
2676 02aab46a bellard
            }
2677 0f8a249a blueswir1
            break;
2678 0f8a249a blueswir1
        }
2679 db166940 blueswir1
    case 0x24: // Nucleus quad LDD 128 bit atomic
2680 db166940 blueswir1
    case 0x2c: // Nucleus quad LDD 128 bit atomic LE
2681 db166940 blueswir1
        //  Only ldda allowed
2682 db166940 blueswir1
        raise_exception(TT_ILL_INSN);
2683 db166940 blueswir1
        return 0;
2684 83469015 bellard
    case 0x04: // Nucleus
2685 83469015 bellard
    case 0x0c: // Nucleus Little Endian (LE)
2686 2065061e Igor V. Kovalenko
    {
2687 2065061e Igor V. Kovalenko
        switch(size) {
2688 2065061e Igor V. Kovalenko
        case 1:
2689 2065061e Igor V. Kovalenko
            ret = ldub_nucleus(addr);
2690 2065061e Igor V. Kovalenko
            break;
2691 2065061e Igor V. Kovalenko
        case 2:
2692 2065061e Igor V. Kovalenko
            ret = lduw_nucleus(addr);
2693 2065061e Igor V. Kovalenko
            break;
2694 2065061e Igor V. Kovalenko
        case 4:
2695 2065061e Igor V. Kovalenko
            ret = ldl_nucleus(addr);
2696 2065061e Igor V. Kovalenko
            break;
2697 2065061e Igor V. Kovalenko
        default:
2698 2065061e Igor V. Kovalenko
        case 8:
2699 2065061e Igor V. Kovalenko
            ret = ldq_nucleus(addr);
2700 2065061e Igor V. Kovalenko
            break;
2701 2065061e Igor V. Kovalenko
        }
2702 2065061e Igor V. Kovalenko
        break;
2703 2065061e Igor V. Kovalenko
    }
2704 83469015 bellard
    case 0x4a: // UPA config
2705 0f8a249a blueswir1
        // XXX
2706 0f8a249a blueswir1
        break;
2707 3475187d bellard
    case 0x45: // LSU
2708 0f8a249a blueswir1
        ret = env->lsu;
2709 0f8a249a blueswir1
        break;
2710 3475187d bellard
    case 0x50: // I-MMU regs
2711 0f8a249a blueswir1
        {
2712 1a2fb1c0 blueswir1
            int reg = (addr >> 3) & 0xf;
2713 3475187d bellard
2714 697a77e6 Igor Kovalenko
            if (reg == 0) {
2715 697a77e6 Igor Kovalenko
                // I-TSB Tag Target register
2716 6e8e7d4c Igor Kovalenko
                ret = ultrasparc_tag_target(env->immu.tag_access);
2717 697a77e6 Igor Kovalenko
            } else {
2718 697a77e6 Igor Kovalenko
                ret = env->immuregs[reg];
2719 697a77e6 Igor Kovalenko
            }
2720 697a77e6 Igor Kovalenko
2721 0f8a249a blueswir1
            break;
2722 0f8a249a blueswir1
        }
2723 3475187d bellard
    case 0x51: // I-MMU 8k TSB pointer
2724 697a77e6 Igor Kovalenko
        {
2725 697a77e6 Igor Kovalenko
            // env->immuregs[5] holds I-MMU TSB register value
2726 697a77e6 Igor Kovalenko
            // env->immuregs[6] holds I-MMU Tag Access register value
2727 6e8e7d4c Igor Kovalenko
            ret = ultrasparc_tsb_pointer(env->immu.tsb, env->immu.tag_access,
2728 697a77e6 Igor Kovalenko
                                         8*1024);
2729 697a77e6 Igor Kovalenko
            break;
2730 697a77e6 Igor Kovalenko
        }
2731 3475187d bellard
    case 0x52: // I-MMU 64k TSB pointer
2732 697a77e6 Igor Kovalenko
        {
2733 697a77e6 Igor Kovalenko
            // env->immuregs[5] holds I-MMU TSB register value
2734 697a77e6 Igor Kovalenko
            // env->immuregs[6] holds I-MMU Tag Access register value
2735 6e8e7d4c Igor Kovalenko
            ret = ultrasparc_tsb_pointer(env->immu.tsb, env->immu.tag_access,
2736 697a77e6 Igor Kovalenko
                                         64*1024);
2737 697a77e6 Igor Kovalenko
            break;
2738 697a77e6 Igor Kovalenko
        }
2739 a5a52cf2 blueswir1
    case 0x55: // I-MMU data access
2740 a5a52cf2 blueswir1
        {
2741 a5a52cf2 blueswir1
            int reg = (addr >> 3) & 0x3f;
2742 a5a52cf2 blueswir1
2743 6e8e7d4c Igor Kovalenko
            ret = env->itlb[reg].tte;
2744 a5a52cf2 blueswir1
            break;
2745 a5a52cf2 blueswir1
        }
2746 83469015 bellard
    case 0x56: // I-MMU tag read
2747 0f8a249a blueswir1
        {
2748 43e9e742 blueswir1
            int reg = (addr >> 3) & 0x3f;
2749 0f8a249a blueswir1
2750 6e8e7d4c Igor Kovalenko
            ret = env->itlb[reg].tag;
2751 0f8a249a blueswir1
            break;
2752 0f8a249a blueswir1
        }
2753 3475187d bellard
    case 0x58: // D-MMU regs
2754 0f8a249a blueswir1
        {
2755 1a2fb1c0 blueswir1
            int reg = (addr >> 3) & 0xf;
2756 3475187d bellard
2757 697a77e6 Igor Kovalenko
            if (reg == 0) {
2758 697a77e6 Igor Kovalenko
                // D-TSB Tag Target register
2759 6e8e7d4c Igor Kovalenko
                ret = ultrasparc_tag_target(env->dmmu.tag_access);
2760 697a77e6 Igor Kovalenko
            } else {
2761 697a77e6 Igor Kovalenko
                ret = env->dmmuregs[reg];
2762 697a77e6 Igor Kovalenko
            }
2763 697a77e6 Igor Kovalenko
            break;
2764 697a77e6 Igor Kovalenko
        }
2765 697a77e6 Igor Kovalenko
    case 0x59: // D-MMU 8k TSB pointer
2766 697a77e6 Igor Kovalenko
        {
2767 697a77e6 Igor Kovalenko
            // env->dmmuregs[5] holds D-MMU TSB register value
2768 697a77e6 Igor Kovalenko
            // env->dmmuregs[6] holds D-MMU Tag Access register value
2769 6e8e7d4c Igor Kovalenko
            ret = ultrasparc_tsb_pointer(env->dmmu.tsb, env->dmmu.tag_access,
2770 697a77e6 Igor Kovalenko
                                         8*1024);
2771 697a77e6 Igor Kovalenko
            break;
2772 697a77e6 Igor Kovalenko
        }
2773 697a77e6 Igor Kovalenko
    case 0x5a: // D-MMU 64k TSB pointer
2774 697a77e6 Igor Kovalenko
        {
2775 697a77e6 Igor Kovalenko
            // env->dmmuregs[5] holds D-MMU TSB register value
2776 697a77e6 Igor Kovalenko
            // env->dmmuregs[6] holds D-MMU Tag Access register value
2777 6e8e7d4c Igor Kovalenko
            ret = ultrasparc_tsb_pointer(env->dmmu.tsb, env->dmmu.tag_access,
2778 697a77e6 Igor Kovalenko
                                         64*1024);
2779 0f8a249a blueswir1
            break;
2780 0f8a249a blueswir1
        }
2781 a5a52cf2 blueswir1
    case 0x5d: // D-MMU data access
2782 a5a52cf2 blueswir1
        {
2783 a5a52cf2 blueswir1
            int reg = (addr >> 3) & 0x3f;
2784 a5a52cf2 blueswir1
2785 6e8e7d4c Igor Kovalenko
            ret = env->dtlb[reg].tte;
2786 a5a52cf2 blueswir1
            break;
2787 a5a52cf2 blueswir1
        }
2788 83469015 bellard
    case 0x5e: // D-MMU tag read
2789 0f8a249a blueswir1
        {
2790 43e9e742 blueswir1
            int reg = (addr >> 3) & 0x3f;
2791 0f8a249a blueswir1
2792 6e8e7d4c Igor Kovalenko
            ret = env->dtlb[reg].tag;
2793 0f8a249a blueswir1
            break;
2794 0f8a249a blueswir1
        }
2795 f7350b47 blueswir1
    case 0x46: // D-cache data
2796 f7350b47 blueswir1
    case 0x47: // D-cache tag access
2797 a5a52cf2 blueswir1
    case 0x4b: // E-cache error enable
2798 a5a52cf2 blueswir1
    case 0x4c: // E-cache asynchronous fault status
2799 a5a52cf2 blueswir1
    case 0x4d: // E-cache asynchronous fault address
2800 f7350b47 blueswir1
    case 0x4e: // E-cache tag data
2801 f7350b47 blueswir1
    case 0x66: // I-cache instruction access
2802 f7350b47 blueswir1
    case 0x67: // I-cache tag access
2803 f7350b47 blueswir1
    case 0x6e: // I-cache predecode
2804 f7350b47 blueswir1
    case 0x6f: // I-cache LRU etc.
2805 f7350b47 blueswir1
    case 0x76: // E-cache tag
2806 f7350b47 blueswir1
    case 0x7e: // E-cache tag
2807 f7350b47 blueswir1
        break;
2808 3475187d bellard
    case 0x5b: // D-MMU data pointer
2809 83469015 bellard
    case 0x48: // Interrupt dispatch, RO
2810 83469015 bellard
    case 0x49: // Interrupt data receive
2811 83469015 bellard
    case 0x7f: // Incoming interrupt vector, RO
2812 0f8a249a blueswir1
        // XXX
2813 0f8a249a blueswir1
        break;
2814 3475187d bellard
    case 0x54: // I-MMU data in, WO
2815 3475187d bellard
    case 0x57: // I-MMU demap, WO
2816 3475187d bellard
    case 0x5c: // D-MMU data in, WO
2817 3475187d bellard
    case 0x5f: // D-MMU demap, WO
2818 83469015 bellard
    case 0x77: // Interrupt vector, WO
2819 3475187d bellard
    default:
2820 e18231a3 blueswir1
        do_unassigned_access(addr, 0, 0, 1, size);
2821 0f8a249a blueswir1
        ret = 0;
2822 0f8a249a blueswir1
        break;
2823 3475187d bellard
    }
2824 81ad8ba2 blueswir1
2825 81ad8ba2 blueswir1
    /* Convert from little endian */
2826 81ad8ba2 blueswir1
    switch (asi) {
2827 81ad8ba2 blueswir1
    case 0x0c: // Nucleus Little Endian (LE)
2828 81ad8ba2 blueswir1
    case 0x18: // As if user primary LE
2829 81ad8ba2 blueswir1
    case 0x19: // As if user secondary LE
2830 81ad8ba2 blueswir1
    case 0x1c: // Bypass LE
2831 81ad8ba2 blueswir1
    case 0x1d: // Bypass, non-cacheable LE
2832 81ad8ba2 blueswir1
    case 0x88: // Primary LE
2833 81ad8ba2 blueswir1
    case 0x89: // Secondary LE
2834 81ad8ba2 blueswir1
    case 0x8a: // Primary no-fault LE
2835 81ad8ba2 blueswir1
    case 0x8b: // Secondary no-fault LE
2836 81ad8ba2 blueswir1
        switch(size) {
2837 81ad8ba2 blueswir1
        case 2:
2838 81ad8ba2 blueswir1
            ret = bswap16(ret);
2839 e32664fb blueswir1
            break;
2840 81ad8ba2 blueswir1
        case 4:
2841 81ad8ba2 blueswir1
            ret = bswap32(ret);
2842 e32664fb blueswir1
            break;
2843 81ad8ba2 blueswir1
        case 8:
2844 81ad8ba2 blueswir1
            ret = bswap64(ret);
2845 e32664fb blueswir1
            break;
2846 81ad8ba2 blueswir1
        default:
2847 81ad8ba2 blueswir1
            break;
2848 81ad8ba2 blueswir1
        }
2849 81ad8ba2 blueswir1
    default:
2850 81ad8ba2 blueswir1
        break;
2851 81ad8ba2 blueswir1
    }
2852 81ad8ba2 blueswir1
2853 81ad8ba2 blueswir1
    /* Convert to signed number */
2854 81ad8ba2 blueswir1
    if (sign) {
2855 81ad8ba2 blueswir1
        switch(size) {
2856 81ad8ba2 blueswir1
        case 1:
2857 81ad8ba2 blueswir1
            ret = (int8_t) ret;
2858 e32664fb blueswir1
            break;
2859 81ad8ba2 blueswir1
        case 2:
2860 81ad8ba2 blueswir1
            ret = (int16_t) ret;
2861 e32664fb blueswir1
            break;
2862 81ad8ba2 blueswir1
        case 4:
2863 81ad8ba2 blueswir1
            ret = (int32_t) ret;
2864 e32664fb blueswir1
            break;
2865 81ad8ba2 blueswir1
        default:
2866 81ad8ba2 blueswir1
            break;
2867 81ad8ba2 blueswir1
        }
2868 81ad8ba2 blueswir1
    }
2869 1a2fb1c0 blueswir1
#ifdef DEBUG_ASI
2870 1a2fb1c0 blueswir1
    dump_asi("read ", last_addr, asi, size, ret);
2871 1a2fb1c0 blueswir1
#endif
2872 1a2fb1c0 blueswir1
    return ret;
2873 3475187d bellard
}
2874 3475187d bellard
2875 1a2fb1c0 blueswir1
void helper_st_asi(target_ulong addr, target_ulong val, int asi, int size)
2876 3475187d bellard
{
2877 1a2fb1c0 blueswir1
#ifdef DEBUG_ASI
2878 1a2fb1c0 blueswir1
    dump_asi("write", addr, asi, size, val);
2879 1a2fb1c0 blueswir1
#endif
2880 01b5d4e5 Igor V. Kovalenko
2881 01b5d4e5 Igor V. Kovalenko
    asi &= 0xff;
2882 01b5d4e5 Igor V. Kovalenko
2883 6f27aba6 blueswir1
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
2884 2aae2b8e Igor V. Kovalenko
        || (cpu_has_hypervisor(env)
2885 5578ceab blueswir1
            && asi >= 0x30 && asi < 0x80
2886 fb79ceb9 blueswir1
            && !(env->hpstate & HS_PRIV)))
2887 0f8a249a blueswir1
        raise_exception(TT_PRIV_ACT);
2888 3475187d bellard
2889 c2bc0e38 blueswir1
    helper_check_align(addr, size - 1);
2890 1295001c Igor V. Kovalenko
    addr = asi_address_mask(env, asi, addr);
2891 1295001c Igor V. Kovalenko
2892 81ad8ba2 blueswir1
    /* Convert to little endian */
2893 81ad8ba2 blueswir1
    switch (asi) {
2894 81ad8ba2 blueswir1
    case 0x0c: // Nucleus Little Endian (LE)
2895 81ad8ba2 blueswir1
    case 0x18: // As if user primary LE
2896 81ad8ba2 blueswir1
    case 0x19: // As if user secondary LE
2897 81ad8ba2 blueswir1
    case 0x1c: // Bypass LE
2898 81ad8ba2 blueswir1
    case 0x1d: // Bypass, non-cacheable LE
2899 81ad8ba2 blueswir1
    case 0x88: // Primary LE
2900 81ad8ba2 blueswir1
    case 0x89: // Secondary LE
2901 81ad8ba2 blueswir1
        switch(size) {
2902 81ad8ba2 blueswir1
        case 2:
2903 5b0f0bec Igor Kovalenko
            val = bswap16(val);
2904 e32664fb blueswir1
            break;
2905 81ad8ba2 blueswir1
        case 4:
2906 5b0f0bec Igor Kovalenko
            val = bswap32(val);
2907 e32664fb blueswir1
            break;
2908 81ad8ba2 blueswir1
        case 8:
2909 5b0f0bec Igor Kovalenko
            val = bswap64(val);
2910 e32664fb blueswir1
            break;
2911 81ad8ba2 blueswir1
        default:
2912 81ad8ba2 blueswir1
            break;
2913 81ad8ba2 blueswir1
        }
2914 81ad8ba2 blueswir1
    default:
2915 81ad8ba2 blueswir1
        break;
2916 81ad8ba2 blueswir1
    }
2917 81ad8ba2 blueswir1
2918 3475187d bellard
    switch(asi) {
2919 81ad8ba2 blueswir1
    case 0x10: // As if user primary
2920 2065061e Igor V. Kovalenko
    case 0x11: // As if user secondary
2921 81ad8ba2 blueswir1
    case 0x18: // As if user primary LE
2922 2065061e Igor V. Kovalenko
    case 0x19: // As if user secondary LE
2923 81ad8ba2 blueswir1
    case 0x80: // Primary
2924 2065061e Igor V. Kovalenko
    case 0x81: // Secondary
2925 81ad8ba2 blueswir1
    case 0x88: // Primary LE
2926 2065061e Igor V. Kovalenko
    case 0x89: // Secondary LE
2927 c99657d3 blueswir1
    case 0xe2: // UA2007 Primary block init
2928 c99657d3 blueswir1
    case 0xe3: // UA2007 Secondary block init
2929 81ad8ba2 blueswir1
        if ((asi & 0x80) && (env->pstate & PS_PRIV)) {
2930 2aae2b8e Igor V. Kovalenko
            if (cpu_hypervisor_mode(env)) {
2931 6f27aba6 blueswir1
                switch(size) {
2932 6f27aba6 blueswir1
                case 1:
2933 1a2fb1c0 blueswir1
                    stb_hypv(addr, val);
2934 6f27aba6 blueswir1
                    break;
2935 6f27aba6 blueswir1
                case 2:
2936 a4e7dd52 blueswir1
                    stw_hypv(addr, val);
2937 6f27aba6 blueswir1
                    break;
2938 6f27aba6 blueswir1
                case 4:
2939 a4e7dd52 blueswir1
                    stl_hypv(addr, val);
2940 6f27aba6 blueswir1
                    break;
2941 6f27aba6 blueswir1
                case 8:
2942 6f27aba6 blueswir1
                default:
2943 a4e7dd52 blueswir1
                    stq_hypv(addr, val);
2944 6f27aba6 blueswir1
                    break;
2945 6f27aba6 blueswir1
                }
2946 6f27aba6 blueswir1
            } else {
2947 2065061e Igor V. Kovalenko
                /* secondary space access has lowest asi bit equal to 1 */
2948 2065061e Igor V. Kovalenko
                if (asi & 1) {
2949 2065061e Igor V. Kovalenko
                    switch(size) {
2950 2065061e Igor V. Kovalenko
                    case 1:
2951 2065061e Igor V. Kovalenko
                        stb_kernel_secondary(addr, val);
2952 2065061e Igor V. Kovalenko
                        break;
2953 2065061e Igor V. Kovalenko
                    case 2:
2954 2065061e Igor V. Kovalenko
                        stw_kernel_secondary(addr, val);
2955 2065061e Igor V. Kovalenko
                        break;
2956 2065061e Igor V. Kovalenko
                    case 4:
2957 2065061e Igor V. Kovalenko
                        stl_kernel_secondary(addr, val);
2958 2065061e Igor V. Kovalenko
                        break;
2959 2065061e Igor V. Kovalenko
                    case 8:
2960 2065061e Igor V. Kovalenko
                    default:
2961 2065061e Igor V. Kovalenko
                        stq_kernel_secondary(addr, val);
2962 2065061e Igor V. Kovalenko
                        break;
2963 2065061e Igor V. Kovalenko
                    }
2964 2065061e Igor V. Kovalenko
                } else {
2965 2065061e Igor V. Kovalenko
                    switch(size) {
2966 2065061e Igor V. Kovalenko
                    case 1:
2967 2065061e Igor V. Kovalenko
                        stb_kernel(addr, val);
2968 2065061e Igor V. Kovalenko
                        break;
2969 2065061e Igor V. Kovalenko
                    case 2:
2970 2065061e Igor V. Kovalenko
                        stw_kernel(addr, val);
2971 2065061e Igor V. Kovalenko
                        break;
2972 2065061e Igor V. Kovalenko
                    case 4:
2973 2065061e Igor V. Kovalenko
                        stl_kernel(addr, val);
2974 2065061e Igor V. Kovalenko
                        break;
2975 2065061e Igor V. Kovalenko
                    case 8:
2976 2065061e Igor V. Kovalenko
                    default:
2977 2065061e Igor V. Kovalenko
                        stq_kernel(addr, val);
2978 2065061e Igor V. Kovalenko
                        break;
2979 2065061e Igor V. Kovalenko
                    }
2980 2065061e Igor V. Kovalenko
                }
2981 2065061e Igor V. Kovalenko
            }
2982 2065061e Igor V. Kovalenko
        } else {
2983 2065061e Igor V. Kovalenko
            /* secondary space access has lowest asi bit equal to 1 */
2984 2065061e Igor V. Kovalenko
            if (asi & 1) {
2985 6f27aba6 blueswir1
                switch(size) {
2986 6f27aba6 blueswir1
                case 1:
2987 2065061e Igor V. Kovalenko
                    stb_user_secondary(addr, val);
2988 6f27aba6 blueswir1
                    break;
2989 6f27aba6 blueswir1
                case 2:
2990 2065061e Igor V. Kovalenko
                    stw_user_secondary(addr, val);
2991 6f27aba6 blueswir1
                    break;
2992 6f27aba6 blueswir1
                case 4:
2993 2065061e Igor V. Kovalenko
                    stl_user_secondary(addr, val);
2994 6f27aba6 blueswir1
                    break;
2995 6f27aba6 blueswir1
                case 8:
2996 6f27aba6 blueswir1
                default:
2997 2065061e Igor V. Kovalenko
                    stq_user_secondary(addr, val);
2998 2065061e Igor V. Kovalenko
                    break;
2999 2065061e Igor V. Kovalenko
                }
3000 2065061e Igor V. Kovalenko
            } else {
3001 2065061e Igor V. Kovalenko
                switch(size) {
3002 2065061e Igor V. Kovalenko
                case 1:
3003 2065061e Igor V. Kovalenko
                    stb_user(addr, val);
3004 2065061e Igor V. Kovalenko
                    break;
3005 2065061e Igor V. Kovalenko
                case 2:
3006 2065061e Igor V. Kovalenko
                    stw_user(addr, val);
3007 2065061e Igor V. Kovalenko
                    break;
3008 2065061e Igor V. Kovalenko
                case 4:
3009 2065061e Igor V. Kovalenko
                    stl_user(addr, val);
3010 2065061e Igor V. Kovalenko
                    break;
3011 2065061e Igor V. Kovalenko
                case 8:
3012 2065061e Igor V. Kovalenko
                default:
3013 2065061e Igor V. Kovalenko
                    stq_user(addr, val);
3014 6f27aba6 blueswir1
                    break;
3015 6f27aba6 blueswir1
                }
3016 81ad8ba2 blueswir1
            }
3017 81ad8ba2 blueswir1
        }
3018 81ad8ba2 blueswir1
        break;
3019 3475187d bellard
    case 0x14: // Bypass
3020 3475187d bellard
    case 0x15: // Bypass, non-cacheable
3021 81ad8ba2 blueswir1
    case 0x1c: // Bypass LE
3022 81ad8ba2 blueswir1
    case 0x1d: // Bypass, non-cacheable LE
3023 0f8a249a blueswir1
        {
3024 02aab46a bellard
            switch(size) {
3025 02aab46a bellard
            case 1:
3026 1a2fb1c0 blueswir1
                stb_phys(addr, val);
3027 02aab46a bellard
                break;
3028 02aab46a bellard
            case 2:
3029 a4e7dd52 blueswir1
                stw_phys(addr, val);
3030 02aab46a bellard
                break;
3031 02aab46a bellard
            case 4:
3032 a4e7dd52 blueswir1
                stl_phys(addr, val);
3033 02aab46a bellard
                break;
3034 02aab46a bellard
            case 8:
3035 02aab46a bellard
            default:
3036 a4e7dd52 blueswir1
                stq_phys(addr, val);
3037 02aab46a bellard
                break;
3038 02aab46a bellard
            }
3039 0f8a249a blueswir1
        }
3040 0f8a249a blueswir1
        return;
3041 db166940 blueswir1
    case 0x24: // Nucleus quad LDD 128 bit atomic
3042 db166940 blueswir1
    case 0x2c: // Nucleus quad LDD 128 bit atomic LE
3043 db166940 blueswir1
        //  Only ldda allowed
3044 db166940 blueswir1
        raise_exception(TT_ILL_INSN);
3045 db166940 blueswir1
        return;
3046 83469015 bellard
    case 0x04: // Nucleus
3047 83469015 bellard
    case 0x0c: // Nucleus Little Endian (LE)
3048 2065061e Igor V. Kovalenko
    {
3049 2065061e Igor V. Kovalenko
        switch(size) {
3050 2065061e Igor V. Kovalenko
        case 1:
3051 2065061e Igor V. Kovalenko
            stb_nucleus(addr, val);
3052 2065061e Igor V. Kovalenko
            break;
3053 2065061e Igor V. Kovalenko
        case 2:
3054 2065061e Igor V. Kovalenko
            stw_nucleus(addr, val);
3055 2065061e Igor V. Kovalenko
            break;
3056 2065061e Igor V. Kovalenko
        case 4:
3057 2065061e Igor V. Kovalenko
            stl_nucleus(addr, val);
3058 2065061e Igor V. Kovalenko
            break;
3059 2065061e Igor V. Kovalenko
        default:
3060 2065061e Igor V. Kovalenko
        case 8:
3061 2065061e Igor V. Kovalenko
            stq_nucleus(addr, val);
3062 2065061e Igor V. Kovalenko
            break;
3063 2065061e Igor V. Kovalenko
        }
3064 2065061e Igor V. Kovalenko
        break;
3065 2065061e Igor V. Kovalenko
    }
3066 2065061e Igor V. Kovalenko
3067 83469015 bellard
    case 0x4a: // UPA config
3068 0f8a249a blueswir1
        // XXX
3069 0f8a249a blueswir1
        return;
3070 3475187d bellard
    case 0x45: // LSU
3071 0f8a249a blueswir1
        {
3072 0f8a249a blueswir1
            uint64_t oldreg;
3073 0f8a249a blueswir1
3074 0f8a249a blueswir1
            oldreg = env->lsu;
3075 1a2fb1c0 blueswir1
            env->lsu = val & (DMMU_E | IMMU_E);
3076 0f8a249a blueswir1
            // Mappings generated during D/I MMU disabled mode are
3077 0f8a249a blueswir1
            // invalid in normal mode
3078 0f8a249a blueswir1
            if (oldreg != env->lsu) {
3079 77f193da blueswir1
                DPRINTF_MMU("LSU change: 0x%" PRIx64 " -> 0x%" PRIx64 "\n",
3080 77f193da blueswir1
                            oldreg, env->lsu);
3081 83469015 bellard
#ifdef DEBUG_MMU
3082 d41160a3 Blue Swirl
                dump_mmu(stdout, fprintf, env1);
3083 83469015 bellard
#endif
3084 0f8a249a blueswir1
                tlb_flush(env, 1);
3085 0f8a249a blueswir1
            }
3086 0f8a249a blueswir1
            return;
3087 0f8a249a blueswir1
        }
3088 3475187d bellard
    case 0x50: // I-MMU regs
3089 0f8a249a blueswir1
        {
3090 1a2fb1c0 blueswir1
            int reg = (addr >> 3) & 0xf;
3091 0f8a249a blueswir1
            uint64_t oldreg;
3092 3b46e624 ths
3093 0f8a249a blueswir1
            oldreg = env->immuregs[reg];
3094 3475187d bellard
            switch(reg) {
3095 3475187d bellard
            case 0: // RO
3096 3475187d bellard
                return;
3097 3475187d bellard
            case 1: // Not in I-MMU
3098 3475187d bellard
            case 2:
3099 3475187d bellard
                return;
3100 3475187d bellard
            case 3: // SFSR
3101 1a2fb1c0 blueswir1
                if ((val & 1) == 0)
3102 1a2fb1c0 blueswir1
                    val = 0; // Clear SFSR
3103 6e8e7d4c Igor Kovalenko
                env->immu.sfsr = val;
3104 3475187d bellard
                break;
3105 6e8e7d4c Igor Kovalenko
            case 4: // RO
3106 6e8e7d4c Igor Kovalenko
                return;
3107 3475187d bellard
            case 5: // TSB access
3108 6e8e7d4c Igor Kovalenko
                DPRINTF_MMU("immu TSB write: 0x%016" PRIx64 " -> 0x%016"
3109 6e8e7d4c Igor Kovalenko
                            PRIx64 "\n", env->immu.tsb, val);
3110 6e8e7d4c Igor Kovalenko
                env->immu.tsb = val;
3111 6e8e7d4c Igor Kovalenko
                break;
3112 3475187d bellard
            case 6: // Tag access
3113 6e8e7d4c Igor Kovalenko
                env->immu.tag_access = val;
3114 6e8e7d4c Igor Kovalenko
                break;
3115 6e8e7d4c Igor Kovalenko
            case 7:
3116 6e8e7d4c Igor Kovalenko
            case 8:
3117 6e8e7d4c Igor Kovalenko
                return;
3118 3475187d bellard
            default:
3119 3475187d bellard
                break;
3120 3475187d bellard
            }
3121 6e8e7d4c Igor Kovalenko
3122 3475187d bellard
            if (oldreg != env->immuregs[reg]) {
3123 6e8e7d4c Igor Kovalenko
                DPRINTF_MMU("immu change reg[%d]: 0x%016" PRIx64 " -> 0x%016"
3124 77f193da blueswir1
                            PRIx64 "\n", reg, oldreg, env->immuregs[reg]);
3125 3475187d bellard
            }
3126 952a328f blueswir1
#ifdef DEBUG_MMU
3127 d41160a3 Blue Swirl
            dump_mmu(stdout, fprintf, env);
3128 3475187d bellard
#endif
3129 0f8a249a blueswir1
            return;
3130 0f8a249a blueswir1
        }
3131 3475187d bellard
    case 0x54: // I-MMU data in
3132 f707726e Igor Kovalenko
        replace_tlb_1bit_lru(env->itlb, env->immu.tag_access, val, "immu", env);
3133 f707726e Igor Kovalenko
        return;
3134 3475187d bellard
    case 0x55: // I-MMU data access
3135 0f8a249a blueswir1
        {
3136 cc6747f4 blueswir1
            // TODO: auto demap
3137 cc6747f4 blueswir1
3138 1a2fb1c0 blueswir1
            unsigned int i = (addr >> 3) & 0x3f;
3139 3475187d bellard
3140 f707726e Igor Kovalenko
            replace_tlb_entry(&env->itlb[i], env->immu.tag_access, val, env);
3141 6e8e7d4c Igor Kovalenko
3142 6e8e7d4c Igor Kovalenko
#ifdef DEBUG_MMU
3143 f707726e Igor Kovalenko
            DPRINTF_MMU("immu data access replaced entry [%i]\n", i);
3144 d41160a3 Blue Swirl
            dump_mmu(stdout, fprintf, env);
3145 6e8e7d4c Igor Kovalenko
#endif
3146 0f8a249a blueswir1
            return;
3147 0f8a249a blueswir1
        }
3148 3475187d bellard
    case 0x57: // I-MMU demap
3149 170f4c55 Igor V. Kovalenko
        demap_tlb(env->itlb, addr, "immu", env);
3150 0f8a249a blueswir1
        return;
3151 3475187d bellard
    case 0x58: // D-MMU regs
3152 0f8a249a blueswir1
        {
3153 1a2fb1c0 blueswir1
            int reg = (addr >> 3) & 0xf;
3154 0f8a249a blueswir1
            uint64_t oldreg;
3155 3b46e624 ths
3156 0f8a249a blueswir1
            oldreg = env->dmmuregs[reg];
3157 3475187d bellard
            switch(reg) {
3158 3475187d bellard
            case 0: // RO
3159 3475187d bellard
            case 4:
3160 3475187d bellard
                return;
3161 3475187d bellard
            case 3: // SFSR
3162 1a2fb1c0 blueswir1
                if ((val & 1) == 0) {
3163 1a2fb1c0 blueswir1
                    val = 0; // Clear SFSR, Fault address
3164 6e8e7d4c Igor Kovalenko
                    env->dmmu.sfar = 0;
3165 0f8a249a blueswir1
                }
3166 6e8e7d4c Igor Kovalenko
                env->dmmu.sfsr = val;
3167 3475187d bellard
                break;
3168 3475187d bellard
            case 1: // Primary context
3169 6e8e7d4c Igor Kovalenko
                env->dmmu.mmu_primary_context = val;
3170 664a65b0 Igor V. Kovalenko
                /* can be optimized to only flush MMU_USER_IDX
3171 664a65b0 Igor V. Kovalenko
                   and MMU_KERNEL_IDX entries */
3172 664a65b0 Igor V. Kovalenko
                tlb_flush(env, 1);
3173 6e8e7d4c Igor Kovalenko
                break;
3174 3475187d bellard
            case 2: // Secondary context
3175 6e8e7d4c Igor Kovalenko
                env->dmmu.mmu_secondary_context = val;
3176 664a65b0 Igor V. Kovalenko
                /* can be optimized to only flush MMU_USER_SECONDARY_IDX
3177 664a65b0 Igor V. Kovalenko
                   and MMU_KERNEL_SECONDARY_IDX entries */
3178 664a65b0 Igor V. Kovalenko
                tlb_flush(env, 1);
3179 6e8e7d4c Igor Kovalenko
                break;
3180 3475187d bellard
            case 5: // TSB access
3181 6e8e7d4c Igor Kovalenko
                DPRINTF_MMU("dmmu TSB write: 0x%016" PRIx64 " -> 0x%016"
3182 6e8e7d4c Igor Kovalenko
                            PRIx64 "\n", env->dmmu.tsb, val);
3183 6e8e7d4c Igor Kovalenko
                env->dmmu.tsb = val;
3184 6e8e7d4c Igor Kovalenko
                break;
3185 3475187d bellard
            case 6: // Tag access
3186 6e8e7d4c Igor Kovalenko
                env->dmmu.tag_access = val;
3187 6e8e7d4c Igor Kovalenko
                break;
3188 3475187d bellard
            case 7: // Virtual Watchpoint
3189 3475187d bellard
            case 8: // Physical Watchpoint
3190 3475187d bellard
            default:
3191 6e8e7d4c Igor Kovalenko
                env->dmmuregs[reg] = val;
3192 3475187d bellard
                break;
3193 3475187d bellard
            }
3194 6e8e7d4c Igor Kovalenko
3195 3475187d bellard
            if (oldreg != env->dmmuregs[reg]) {
3196 6e8e7d4c Igor Kovalenko
                DPRINTF_MMU("dmmu change reg[%d]: 0x%016" PRIx64 " -> 0x%016"
3197 77f193da blueswir1
                            PRIx64 "\n", reg, oldreg, env->dmmuregs[reg]);
3198 3475187d bellard
            }
3199 952a328f blueswir1
#ifdef DEBUG_MMU
3200 d41160a3 Blue Swirl
            dump_mmu(stdout, fprintf, env);
3201 3475187d bellard
#endif
3202 0f8a249a blueswir1
            return;
3203 0f8a249a blueswir1
        }
3204 3475187d bellard
    case 0x5c: // D-MMU data in
3205 f707726e Igor Kovalenko
        replace_tlb_1bit_lru(env->dtlb, env->dmmu.tag_access, val, "dmmu", env);
3206 f707726e Igor Kovalenko
        return;
3207 3475187d bellard
    case 0x5d: // D-MMU data access
3208 0f8a249a blueswir1
        {
3209 1a2fb1c0 blueswir1
            unsigned int i = (addr >> 3) & 0x3f;
3210 3475187d bellard
3211 f707726e Igor Kovalenko
            replace_tlb_entry(&env->dtlb[i], env->dmmu.tag_access, val, env);
3212 f707726e Igor Kovalenko
3213 6e8e7d4c Igor Kovalenko
#ifdef DEBUG_MMU
3214 f707726e Igor Kovalenko
            DPRINTF_MMU("dmmu data access replaced entry [%i]\n", i);
3215 d41160a3 Blue Swirl
            dump_mmu(stdout, fprintf, env);
3216 6e8e7d4c Igor Kovalenko
#endif
3217 0f8a249a blueswir1
            return;
3218 0f8a249a blueswir1
        }
3219 3475187d bellard
    case 0x5f: // D-MMU demap
3220 170f4c55 Igor V. Kovalenko
        demap_tlb(env->dtlb, addr, "dmmu", env);
3221 cc6747f4 blueswir1
        return;
3222 83469015 bellard
    case 0x49: // Interrupt data receive
3223 0f8a249a blueswir1
        // XXX
3224 0f8a249a blueswir1
        return;
3225 f7350b47 blueswir1
    case 0x46: // D-cache data
3226 f7350b47 blueswir1
    case 0x47: // D-cache tag access
3227 a5a52cf2 blueswir1
    case 0x4b: // E-cache error enable
3228 a5a52cf2 blueswir1
    case 0x4c: // E-cache asynchronous fault status
3229 a5a52cf2 blueswir1
    case 0x4d: // E-cache asynchronous fault address
3230 f7350b47 blueswir1
    case 0x4e: // E-cache tag data
3231 f7350b47 blueswir1
    case 0x66: // I-cache instruction access
3232 f7350b47 blueswir1
    case 0x67: // I-cache tag access
3233 f7350b47 blueswir1
    case 0x6e: // I-cache predecode
3234 f7350b47 blueswir1
    case 0x6f: // I-cache LRU etc.
3235 f7350b47 blueswir1
    case 0x76: // E-cache tag
3236 f7350b47 blueswir1
    case 0x7e: // E-cache tag
3237 f7350b47 blueswir1
        return;
3238 3475187d bellard
    case 0x51: // I-MMU 8k TSB pointer, RO
3239 3475187d bellard
    case 0x52: // I-MMU 64k TSB pointer, RO
3240 3475187d bellard
    case 0x56: // I-MMU tag read, RO
3241 3475187d bellard
    case 0x59: // D-MMU 8k TSB pointer, RO
3242 3475187d bellard
    case 0x5a: // D-MMU 64k TSB pointer, RO
3243 3475187d bellard
    case 0x5b: // D-MMU data pointer, RO
3244 3475187d bellard
    case 0x5e: // D-MMU tag read, RO
3245 83469015 bellard
    case 0x48: // Interrupt dispatch, RO
3246 83469015 bellard
    case 0x7f: // Incoming interrupt vector, RO
3247 83469015 bellard
    case 0x82: // Primary no-fault, RO
3248 83469015 bellard
    case 0x83: // Secondary no-fault, RO
3249 83469015 bellard
    case 0x8a: // Primary no-fault LE, RO
3250 83469015 bellard
    case 0x8b: // Secondary no-fault LE, RO
3251 3475187d bellard
    default:
3252 e18231a3 blueswir1
        do_unassigned_access(addr, 1, 0, 1, size);
3253 0f8a249a blueswir1
        return;
3254 3475187d bellard
    }
3255 3475187d bellard
}
3256 81ad8ba2 blueswir1
#endif /* CONFIG_USER_ONLY */
3257 3391c818 blueswir1
3258 db166940 blueswir1
void helper_ldda_asi(target_ulong addr, int asi, int rd)
3259 db166940 blueswir1
{
3260 db166940 blueswir1
    if ((asi < 0x80 && (env->pstate & PS_PRIV) == 0)
3261 2aae2b8e Igor V. Kovalenko
        || (cpu_has_hypervisor(env)
3262 5578ceab blueswir1
            && asi >= 0x30 && asi < 0x80
3263 fb79ceb9 blueswir1
            && !(env->hpstate & HS_PRIV)))
3264 db166940 blueswir1
        raise_exception(TT_PRIV_ACT);
3265 db166940 blueswir1
3266 1295001c Igor V. Kovalenko
    addr = asi_address_mask(env, asi, addr);
3267 1295001c Igor V. Kovalenko
3268 db166940 blueswir1
    switch (asi) {
3269 03ae77d6 Blue Swirl
#if !defined(CONFIG_USER_ONLY)
3270 db166940 blueswir1
    case 0x24: // Nucleus quad LDD 128 bit atomic
3271 db166940 blueswir1
    case 0x2c: // Nucleus quad LDD 128 bit atomic LE
3272 db166940 blueswir1
        helper_check_align(addr, 0xf);
3273 db166940 blueswir1
        if (rd == 0) {
3274 54a3c0f0 Igor V. Kovalenko
            env->gregs[1] = ldq_nucleus(addr + 8);
3275 db166940 blueswir1
            if (asi == 0x2c)
3276 db166940 blueswir1
                bswap64s(&env->gregs[1]);
3277 db166940 blueswir1
        } else if (rd < 8) {
3278 54a3c0f0 Igor V. Kovalenko
            env->gregs[rd] = ldq_nucleus(addr);
3279 54a3c0f0 Igor V. Kovalenko
            env->gregs[rd + 1] = ldq_nucleus(addr + 8);
3280 db166940 blueswir1
            if (asi == 0x2c) {
3281 db166940 blueswir1
                bswap64s(&env->gregs[rd]);
3282 db166940 blueswir1
                bswap64s(&env->gregs[rd + 1]);
3283 db166940 blueswir1
            }
3284 db166940 blueswir1
        } else {
3285 54a3c0f0 Igor V. Kovalenko
            env->regwptr[rd] = ldq_nucleus(addr);
3286 54a3c0f0 Igor V. Kovalenko
            env->regwptr[rd + 1] = ldq_nucleus(addr + 8);
3287 db166940 blueswir1
            if (asi == 0x2c) {
3288 db166940 blueswir1
                bswap64s(&env->regwptr[rd]);
3289 db166940 blueswir1
                bswap64s(&env->regwptr[rd + 1]);
3290 db166940 blueswir1
            }
3291 db166940 blueswir1
        }
3292 db166940 blueswir1
        break;
3293 03ae77d6 Blue Swirl
#endif
3294 db166940 blueswir1
    default:
3295 db166940 blueswir1
        helper_check_align(addr, 0x3);
3296 db166940 blueswir1
        if (rd == 0)
3297 db166940 blueswir1
            env->gregs[1] = helper_ld_asi(addr + 4, asi, 4, 0);
3298 db166940 blueswir1
        else if (rd < 8) {
3299 db166940 blueswir1
            env->gregs[rd] = helper_ld_asi(addr, asi, 4, 0);
3300 db166940 blueswir1
            env->gregs[rd + 1] = helper_ld_asi(addr + 4, asi, 4, 0);
3301 db166940 blueswir1
        } else {
3302 db166940 blueswir1
            env->regwptr[rd] = helper_ld_asi(addr, asi, 4, 0);
3303 db166940 blueswir1
            env->regwptr[rd + 1] = helper_ld_asi(addr + 4, asi, 4, 0);
3304 db166940 blueswir1
        }
3305 db166940 blueswir1
        break;
3306 db166940 blueswir1
    }
3307 db166940 blueswir1
}
3308 db166940 blueswir1
3309 1a2fb1c0 blueswir1
void helper_ldf_asi(target_ulong addr, int asi, int size, int rd)
3310 3391c818 blueswir1
{
3311 3391c818 blueswir1
    unsigned int i;
3312 1a2fb1c0 blueswir1
    target_ulong val;
3313 3391c818 blueswir1
3314 c2bc0e38 blueswir1
    helper_check_align(addr, 3);
3315 1295001c Igor V. Kovalenko
    addr = asi_address_mask(env, asi, addr);
3316 1295001c Igor V. Kovalenko
3317 3391c818 blueswir1
    switch (asi) {
3318 3391c818 blueswir1
    case 0xf0: // Block load primary
3319 3391c818 blueswir1
    case 0xf1: // Block load secondary
3320 3391c818 blueswir1
    case 0xf8: // Block load primary LE
3321 3391c818 blueswir1
    case 0xf9: // Block load secondary LE
3322 51996525 blueswir1
        if (rd & 7) {
3323 51996525 blueswir1
            raise_exception(TT_ILL_INSN);
3324 51996525 blueswir1
            return;
3325 51996525 blueswir1
        }
3326 c2bc0e38 blueswir1
        helper_check_align(addr, 0x3f);
3327 51996525 blueswir1
        for (i = 0; i < 16; i++) {
3328 77f193da blueswir1
            *(uint32_t *)&env->fpr[rd++] = helper_ld_asi(addr, asi & 0x8f, 4,
3329 77f193da blueswir1
                                                         0);
3330 1a2fb1c0 blueswir1
            addr += 4;
3331 3391c818 blueswir1
        }
3332 3391c818 blueswir1
3333 3391c818 blueswir1
        return;
3334 0e2fa9ca Igor V. Kovalenko
    case 0x70: // Block load primary, user privilege
3335 0e2fa9ca Igor V. Kovalenko
    case 0x71: // Block load secondary, user privilege
3336 0e2fa9ca Igor V. Kovalenko
        if (rd & 7) {
3337 0e2fa9ca Igor V. Kovalenko
            raise_exception(TT_ILL_INSN);
3338 0e2fa9ca Igor V. Kovalenko
            return;
3339 0e2fa9ca Igor V. Kovalenko
        }
3340 0e2fa9ca Igor V. Kovalenko
        helper_check_align(addr, 0x3f);
3341 0e2fa9ca Igor V. Kovalenko
        for (i = 0; i < 16; i++) {
3342 0e2fa9ca Igor V. Kovalenko
            *(uint32_t *)&env->fpr[rd++] = helper_ld_asi(addr, asi & 0x1f, 4,
3343 0e2fa9ca Igor V. Kovalenko
                                                         0);
3344 0e2fa9ca Igor V. Kovalenko
            addr += 4;
3345 0e2fa9ca Igor V. Kovalenko
        }
3346 0e2fa9ca Igor V. Kovalenko
3347 0e2fa9ca Igor V. Kovalenko
        return;
3348 3391c818 blueswir1
    default:
3349 3391c818 blueswir1
        break;
3350 3391c818 blueswir1
    }
3351 3391c818 blueswir1
3352 1a2fb1c0 blueswir1
    val = helper_ld_asi(addr, asi, size, 0);
3353 3391c818 blueswir1
    switch(size) {
3354 3391c818 blueswir1
    default:
3355 3391c818 blueswir1
    case 4:
3356 714547bb blueswir1
        *((uint32_t *)&env->fpr[rd]) = val;
3357 3391c818 blueswir1
        break;
3358 3391c818 blueswir1
    case 8:
3359 1a2fb1c0 blueswir1
        *((int64_t *)&DT0) = val;
3360 3391c818 blueswir1
        break;
3361 1f587329 blueswir1
    case 16:
3362 1f587329 blueswir1
        // XXX
3363 1f587329 blueswir1
        break;
3364 3391c818 blueswir1
    }
3365 3391c818 blueswir1
}
3366 3391c818 blueswir1
3367 1a2fb1c0 blueswir1
void helper_stf_asi(target_ulong addr, int asi, int size, int rd)
3368 3391c818 blueswir1
{
3369 3391c818 blueswir1
    unsigned int i;
3370 1a2fb1c0 blueswir1
    target_ulong val = 0;
3371 3391c818 blueswir1
3372 c2bc0e38 blueswir1
    helper_check_align(addr, 3);
3373 1295001c Igor V. Kovalenko
    addr = asi_address_mask(env, asi, addr);
3374 1295001c Igor V. Kovalenko
3375 3391c818 blueswir1
    switch (asi) {
3376 c99657d3 blueswir1
    case 0xe0: // UA2007 Block commit store primary (cache flush)
3377 c99657d3 blueswir1
    case 0xe1: // UA2007 Block commit store secondary (cache flush)
3378 3391c818 blueswir1
    case 0xf0: // Block store primary
3379 3391c818 blueswir1
    case 0xf1: // Block store secondary
3380 3391c818 blueswir1
    case 0xf8: // Block store primary LE
3381 3391c818 blueswir1
    case 0xf9: // Block store secondary LE
3382 51996525 blueswir1
        if (rd & 7) {
3383 51996525 blueswir1
            raise_exception(TT_ILL_INSN);
3384 51996525 blueswir1
            return;
3385 51996525 blueswir1
        }
3386 c2bc0e38 blueswir1
        helper_check_align(addr, 0x3f);
3387 51996525 blueswir1
        for (i = 0; i < 16; i++) {
3388 1a2fb1c0 blueswir1
            val = *(uint32_t *)&env->fpr[rd++];
3389 1a2fb1c0 blueswir1
            helper_st_asi(addr, val, asi & 0x8f, 4);
3390 1a2fb1c0 blueswir1
            addr += 4;
3391 3391c818 blueswir1
        }
3392 3391c818 blueswir1
3393 3391c818 blueswir1
        return;
3394 0e2fa9ca Igor V. Kovalenko
    case 0x70: // Block store primary, user privilege
3395 0e2fa9ca Igor V. Kovalenko
    case 0x71: // Block store secondary, user privilege
3396 0e2fa9ca Igor V. Kovalenko
        if (rd & 7) {
3397 0e2fa9ca Igor V. Kovalenko
            raise_exception(TT_ILL_INSN);
3398 0e2fa9ca Igor V. Kovalenko
            return;
3399 0e2fa9ca Igor V. Kovalenko
        }
3400 0e2fa9ca Igor V. Kovalenko
        helper_check_align(addr, 0x3f);
3401 0e2fa9ca Igor V. Kovalenko
        for (i = 0; i < 16; i++) {
3402 0e2fa9ca Igor V. Kovalenko
            val = *(uint32_t *)&env->fpr[rd++];
3403 0e2fa9ca Igor V. Kovalenko
            helper_st_asi(addr, val, asi & 0x1f, 4);
3404 0e2fa9ca Igor V. Kovalenko
            addr += 4;
3405 0e2fa9ca Igor V. Kovalenko
        }
3406 0e2fa9ca Igor V. Kovalenko
3407 0e2fa9ca Igor V. Kovalenko
        return;
3408 3391c818 blueswir1
    default:
3409 3391c818 blueswir1
        break;
3410 3391c818 blueswir1
    }
3411 3391c818 blueswir1
3412 3391c818 blueswir1
    switch(size) {
3413 3391c818 blueswir1
    default:
3414 3391c818 blueswir1
    case 4:
3415 714547bb blueswir1
        val = *((uint32_t *)&env->fpr[rd]);
3416 3391c818 blueswir1
        break;
3417 3391c818 blueswir1
    case 8:
3418 1a2fb1c0 blueswir1
        val = *((int64_t *)&DT0);
3419 3391c818 blueswir1
        break;
3420 1f587329 blueswir1
    case 16:
3421 1f587329 blueswir1
        // XXX
3422 1f587329 blueswir1
        break;
3423 3391c818 blueswir1
    }
3424 1a2fb1c0 blueswir1
    helper_st_asi(addr, val, asi, size);
3425 1a2fb1c0 blueswir1
}
3426 1a2fb1c0 blueswir1
3427 1a2fb1c0 blueswir1
target_ulong helper_cas_asi(target_ulong addr, target_ulong val1,
3428 1a2fb1c0 blueswir1
                            target_ulong val2, uint32_t asi)
3429 1a2fb1c0 blueswir1
{
3430 1a2fb1c0 blueswir1
    target_ulong ret;
3431 1a2fb1c0 blueswir1
3432 1121f879 blueswir1
    val2 &= 0xffffffffUL;
3433 1a2fb1c0 blueswir1
    ret = helper_ld_asi(addr, asi, 4, 0);
3434 1a2fb1c0 blueswir1
    ret &= 0xffffffffUL;
3435 1121f879 blueswir1
    if (val2 == ret)
3436 1121f879 blueswir1
        helper_st_asi(addr, val1 & 0xffffffffUL, asi, 4);
3437 1a2fb1c0 blueswir1
    return ret;
3438 3391c818 blueswir1
}
3439 3391c818 blueswir1
3440 1a2fb1c0 blueswir1
target_ulong helper_casx_asi(target_ulong addr, target_ulong val1,
3441 1a2fb1c0 blueswir1
                             target_ulong val2, uint32_t asi)
3442 1a2fb1c0 blueswir1
{
3443 1a2fb1c0 blueswir1
    target_ulong ret;
3444 1a2fb1c0 blueswir1
3445 1a2fb1c0 blueswir1
    ret = helper_ld_asi(addr, asi, 8, 0);
3446 1121f879 blueswir1
    if (val2 == ret)
3447 1121f879 blueswir1
        helper_st_asi(addr, val1, asi, 8);
3448 1a2fb1c0 blueswir1
    return ret;
3449 1a2fb1c0 blueswir1
}
3450 81ad8ba2 blueswir1
#endif /* TARGET_SPARC64 */
3451 3475187d bellard
3452 3475187d bellard
#ifndef TARGET_SPARC64
3453 1a2fb1c0 blueswir1
void helper_rett(void)
3454 e8af50a3 bellard
{
3455 af7bf89b bellard
    unsigned int cwp;
3456 af7bf89b bellard
3457 d4218d99 blueswir1
    if (env->psret == 1)
3458 d4218d99 blueswir1
        raise_exception(TT_ILL_INSN);
3459 d4218d99 blueswir1
3460 e8af50a3 bellard
    env->psret = 1;
3461 5a834bb4 Blue Swirl
    cwp = cwp_inc(env->cwp + 1) ;
3462 e8af50a3 bellard
    if (env->wim & (1 << cwp)) {
3463 e8af50a3 bellard
        raise_exception(TT_WIN_UNF);
3464 e8af50a3 bellard
    }
3465 e8af50a3 bellard
    set_cwp(cwp);
3466 e8af50a3 bellard
    env->psrs = env->psrps;
3467 e8af50a3 bellard
}
3468 3475187d bellard
#endif
3469 e8af50a3 bellard
3470 0fcec41e Aurelien Jarno
static target_ulong helper_udiv_common(target_ulong a, target_ulong b, int cc)
3471 3b89f26c blueswir1
{
3472 0fcec41e Aurelien Jarno
    int overflow = 0;
3473 3b89f26c blueswir1
    uint64_t x0;
3474 3b89f26c blueswir1
    uint32_t x1;
3475 3b89f26c blueswir1
3476 7621a90d blueswir1
    x0 = (a & 0xffffffff) | ((int64_t) (env->y) << 32);
3477 09487205 Igor V. Kovalenko
    x1 = (b & 0xffffffff);
3478 3b89f26c blueswir1
3479 3b89f26c blueswir1
    if (x1 == 0) {
3480 3b89f26c blueswir1
        raise_exception(TT_DIV_ZERO);
3481 3b89f26c blueswir1
    }
3482 3b89f26c blueswir1
3483 3b89f26c blueswir1
    x0 = x0 / x1;
3484 3b89f26c blueswir1
    if (x0 > 0xffffffff) {
3485 0fcec41e Aurelien Jarno
        x0 = 0xffffffff;
3486 0fcec41e Aurelien Jarno
        overflow = 1;
3487 0fcec41e Aurelien Jarno
    }
3488 0fcec41e Aurelien Jarno
3489 0fcec41e Aurelien Jarno
    if (cc) {
3490 0fcec41e Aurelien Jarno
        env->cc_dst = x0;
3491 0fcec41e Aurelien Jarno
        env->cc_src2 = overflow;
3492 0fcec41e Aurelien Jarno
        env->cc_op = CC_OP_DIV;
3493 3b89f26c blueswir1
    }
3494 0fcec41e Aurelien Jarno
    return x0;
3495 3b89f26c blueswir1
}
3496 3b89f26c blueswir1
3497 0fcec41e Aurelien Jarno
target_ulong helper_udiv(target_ulong a, target_ulong b)
3498 0fcec41e Aurelien Jarno
{
3499 0fcec41e Aurelien Jarno
    return helper_udiv_common(a, b, 0);
3500 0fcec41e Aurelien Jarno
}
3501 0fcec41e Aurelien Jarno
3502 0fcec41e Aurelien Jarno
target_ulong helper_udiv_cc(target_ulong a, target_ulong b)
3503 0fcec41e Aurelien Jarno
{
3504 0fcec41e Aurelien Jarno
    return helper_udiv_common(a, b, 1);
3505 0fcec41e Aurelien Jarno
}
3506 0fcec41e Aurelien Jarno
3507 0fcec41e Aurelien Jarno
static target_ulong helper_sdiv_common(target_ulong a, target_ulong b, int cc)
3508 3b89f26c blueswir1
{
3509 0fcec41e Aurelien Jarno
    int overflow = 0;
3510 3b89f26c blueswir1
    int64_t x0;
3511 3b89f26c blueswir1
    int32_t x1;
3512 3b89f26c blueswir1
3513 7621a90d blueswir1
    x0 = (a & 0xffffffff) | ((int64_t) (env->y) << 32);
3514 09487205 Igor V. Kovalenko
    x1 = (b & 0xffffffff);
3515 3b89f26c blueswir1
3516 3b89f26c blueswir1
    if (x1 == 0) {
3517 3b89f26c blueswir1
        raise_exception(TT_DIV_ZERO);
3518 3b89f26c blueswir1
    }
3519 3b89f26c blueswir1
3520 3b89f26c blueswir1
    x0 = x0 / x1;
3521 3b89f26c blueswir1
    if ((int32_t) x0 != x0) {
3522 0fcec41e Aurelien Jarno
        x0 = x0 < 0 ? 0x80000000: 0x7fffffff;
3523 0fcec41e Aurelien Jarno
        overflow = 1;
3524 0fcec41e Aurelien Jarno
    }
3525 0fcec41e Aurelien Jarno
3526 0fcec41e Aurelien Jarno
    if (cc) {
3527 0fcec41e Aurelien Jarno
        env->cc_dst = x0;
3528 0fcec41e Aurelien Jarno
        env->cc_src2 = overflow;
3529 0fcec41e Aurelien Jarno
        env->cc_op = CC_OP_DIV;
3530 3b89f26c blueswir1
    }
3531 0fcec41e Aurelien Jarno
    return x0;
3532 0fcec41e Aurelien Jarno
}
3533 0fcec41e Aurelien Jarno
3534 0fcec41e Aurelien Jarno
target_ulong helper_sdiv(target_ulong a, target_ulong b)
3535 0fcec41e Aurelien Jarno
{
3536 0fcec41e Aurelien Jarno
    return helper_sdiv_common(a, b, 0);
3537 0fcec41e Aurelien Jarno
}
3538 0fcec41e Aurelien Jarno
3539 0fcec41e Aurelien Jarno
target_ulong helper_sdiv_cc(target_ulong a, target_ulong b)
3540 0fcec41e Aurelien Jarno
{
3541 0fcec41e Aurelien Jarno
    return helper_sdiv_common(a, b, 1);
3542 3b89f26c blueswir1
}
3543 3b89f26c blueswir1
3544 7fa76c0b blueswir1
void helper_stdf(target_ulong addr, int mem_idx)
3545 7fa76c0b blueswir1
{
3546 c2bc0e38 blueswir1
    helper_check_align(addr, 7);
3547 7fa76c0b blueswir1
#if !defined(CONFIG_USER_ONLY)
3548 7fa76c0b blueswir1
    switch (mem_idx) {
3549 b219094a Igor V. Kovalenko
    case MMU_USER_IDX:
3550 c2bc0e38 blueswir1
        stfq_user(addr, DT0);
3551 7fa76c0b blueswir1
        break;
3552 b219094a Igor V. Kovalenko
    case MMU_KERNEL_IDX:
3553 c2bc0e38 blueswir1
        stfq_kernel(addr, DT0);
3554 7fa76c0b blueswir1
        break;
3555 7fa76c0b blueswir1
#ifdef TARGET_SPARC64
3556 b219094a Igor V. Kovalenko
    case MMU_HYPV_IDX:
3557 c2bc0e38 blueswir1
        stfq_hypv(addr, DT0);
3558 7fa76c0b blueswir1
        break;
3559 7fa76c0b blueswir1
#endif
3560 7fa76c0b blueswir1
    default:
3561 b219094a Igor V. Kovalenko
        DPRINTF_MMU("helper_stdf: need to check MMU idx %d\n", mem_idx);
3562 7fa76c0b blueswir1
        break;
3563 7fa76c0b blueswir1
    }
3564 7fa76c0b blueswir1
#else
3565 41db525e Richard Henderson
    stfq_raw(address_mask(env, addr), DT0);
3566 7fa76c0b blueswir1
#endif
3567 7fa76c0b blueswir1
}
3568 7fa76c0b blueswir1
3569 7fa76c0b blueswir1
void helper_lddf(target_ulong addr, int mem_idx)
3570 7fa76c0b blueswir1
{
3571 c2bc0e38 blueswir1
    helper_check_align(addr, 7);
3572 7fa76c0b blueswir1
#if !defined(CONFIG_USER_ONLY)
3573 7fa76c0b blueswir1
    switch (mem_idx) {
3574 b219094a Igor V. Kovalenko
    case MMU_USER_IDX:
3575 c2bc0e38 blueswir1
        DT0 = ldfq_user(addr);
3576 7fa76c0b blueswir1
        break;
3577 b219094a Igor V. Kovalenko
    case MMU_KERNEL_IDX:
3578 c2bc0e38 blueswir1
        DT0 = ldfq_kernel(addr);
3579 7fa76c0b blueswir1
        break;
3580 7fa76c0b blueswir1
#ifdef TARGET_SPARC64
3581 b219094a Igor V. Kovalenko
    case MMU_HYPV_IDX:
3582 c2bc0e38 blueswir1
        DT0 = ldfq_hypv(addr);
3583 7fa76c0b blueswir1
        break;
3584 7fa76c0b blueswir1
#endif
3585 7fa76c0b blueswir1
    default:
3586 b219094a Igor V. Kovalenko
        DPRINTF_MMU("helper_lddf: need to check MMU idx %d\n", mem_idx);
3587 7fa76c0b blueswir1
        break;
3588 7fa76c0b blueswir1
    }
3589 7fa76c0b blueswir1
#else
3590 41db525e Richard Henderson
    DT0 = ldfq_raw(address_mask(env, addr));
3591 7fa76c0b blueswir1
#endif
3592 7fa76c0b blueswir1
}
3593 7fa76c0b blueswir1
3594 64a88d5d blueswir1
void helper_ldqf(target_ulong addr, int mem_idx)
3595 7fa76c0b blueswir1
{
3596 7fa76c0b blueswir1
    // XXX add 128 bit load
3597 7fa76c0b blueswir1
    CPU_QuadU u;
3598 7fa76c0b blueswir1
3599 c2bc0e38 blueswir1
    helper_check_align(addr, 7);
3600 64a88d5d blueswir1
#if !defined(CONFIG_USER_ONLY)
3601 64a88d5d blueswir1
    switch (mem_idx) {
3602 b219094a Igor V. Kovalenko
    case MMU_USER_IDX:
3603 c2bc0e38 blueswir1
        u.ll.upper = ldq_user(addr);
3604 c2bc0e38 blueswir1
        u.ll.lower = ldq_user(addr + 8);
3605 64a88d5d blueswir1
        QT0 = u.q;
3606 64a88d5d blueswir1
        break;
3607 b219094a Igor V. Kovalenko
    case MMU_KERNEL_IDX:
3608 c2bc0e38 blueswir1
        u.ll.upper = ldq_kernel(addr);
3609 c2bc0e38 blueswir1
        u.ll.lower = ldq_kernel(addr + 8);
3610 64a88d5d blueswir1
        QT0 = u.q;
3611 64a88d5d blueswir1
        break;
3612 64a88d5d blueswir1
#ifdef TARGET_SPARC64
3613 b219094a Igor V. Kovalenko
    case MMU_HYPV_IDX:
3614 c2bc0e38 blueswir1
        u.ll.upper = ldq_hypv(addr);
3615 c2bc0e38 blueswir1
        u.ll.lower = ldq_hypv(addr + 8);
3616 64a88d5d blueswir1
        QT0 = u.q;
3617 64a88d5d blueswir1
        break;
3618 64a88d5d blueswir1
#endif
3619 64a88d5d blueswir1
    default:
3620 b219094a Igor V. Kovalenko
        DPRINTF_MMU("helper_ldqf: need to check MMU idx %d\n", mem_idx);
3621 64a88d5d blueswir1
        break;
3622 64a88d5d blueswir1
    }
3623 64a88d5d blueswir1
#else
3624 41db525e Richard Henderson
    u.ll.upper = ldq_raw(address_mask(env, addr));
3625 41db525e Richard Henderson
    u.ll.lower = ldq_raw(address_mask(env, addr + 8));
3626 7fa76c0b blueswir1
    QT0 = u.q;
3627 64a88d5d blueswir1
#endif
3628 7fa76c0b blueswir1
}
3629 7fa76c0b blueswir1
3630 64a88d5d blueswir1
void helper_stqf(target_ulong addr, int mem_idx)
3631 7fa76c0b blueswir1
{
3632 7fa76c0b blueswir1
    // XXX add 128 bit store
3633 7fa76c0b blueswir1
    CPU_QuadU u;
3634 7fa76c0b blueswir1
3635 c2bc0e38 blueswir1
    helper_check_align(addr, 7);
3636 64a88d5d blueswir1
#if !defined(CONFIG_USER_ONLY)
3637 64a88d5d blueswir1
    switch (mem_idx) {
3638 b219094a Igor V. Kovalenko
    case MMU_USER_IDX:
3639 64a88d5d blueswir1
        u.q = QT0;
3640 c2bc0e38 blueswir1
        stq_user(addr, u.ll.upper);
3641 c2bc0e38 blueswir1
        stq_user(addr + 8, u.ll.lower);
3642 64a88d5d blueswir1
        break;
3643 b219094a Igor V. Kovalenko
    case MMU_KERNEL_IDX:
3644 64a88d5d blueswir1
        u.q = QT0;
3645 c2bc0e38 blueswir1
        stq_kernel(addr, u.ll.upper);
3646 c2bc0e38 blueswir1
        stq_kernel(addr + 8, u.ll.lower);
3647 64a88d5d blueswir1
        break;
3648 64a88d5d blueswir1
#ifdef TARGET_SPARC64
3649 b219094a Igor V. Kovalenko
    case MMU_HYPV_IDX:
3650 64a88d5d blueswir1
        u.q = QT0;
3651 c2bc0e38 blueswir1
        stq_hypv(addr, u.ll.upper);
3652 c2bc0e38 blueswir1
        stq_hypv(addr + 8, u.ll.lower);
3653 64a88d5d blueswir1
        break;
3654 64a88d5d blueswir1
#endif
3655 64a88d5d blueswir1
    default:
3656 b219094a Igor V. Kovalenko
        DPRINTF_MMU("helper_stqf: need to check MMU idx %d\n", mem_idx);
3657 64a88d5d blueswir1
        break;
3658 64a88d5d blueswir1
    }
3659 64a88d5d blueswir1
#else
3660 7fa76c0b blueswir1
    u.q = QT0;
3661 41db525e Richard Henderson
    stq_raw(address_mask(env, addr), u.ll.upper);
3662 41db525e Richard Henderson
    stq_raw(address_mask(env, addr + 8), u.ll.lower);
3663 7fa76c0b blueswir1
#endif
3664 64a88d5d blueswir1
}
3665 7fa76c0b blueswir1
3666 3a3b925d blueswir1
static inline void set_fsr(void)
3667 e8af50a3 bellard
{
3668 7a0e1f41 bellard
    int rnd_mode;
3669 bb5529bb blueswir1
3670 e8af50a3 bellard
    switch (env->fsr & FSR_RD_MASK) {
3671 e8af50a3 bellard
    case FSR_RD_NEAREST:
3672 7a0e1f41 bellard
        rnd_mode = float_round_nearest_even;
3673 0f8a249a blueswir1
        break;
3674 ed910241 bellard
    default:
3675 e8af50a3 bellard
    case FSR_RD_ZERO:
3676 7a0e1f41 bellard
        rnd_mode = float_round_to_zero;
3677 0f8a249a blueswir1
        break;
3678 e8af50a3 bellard
    case FSR_RD_POS:
3679 7a0e1f41 bellard
        rnd_mode = float_round_up;
3680 0f8a249a blueswir1
        break;
3681 e8af50a3 bellard
    case FSR_RD_NEG:
3682 7a0e1f41 bellard
        rnd_mode = float_round_down;
3683 0f8a249a blueswir1
        break;
3684 e8af50a3 bellard
    }
3685 7a0e1f41 bellard
    set_float_rounding_mode(rnd_mode, &env->fp_status);
3686 e8af50a3 bellard
}
3687 e80cfcfc bellard
3688 3a3b925d blueswir1
void helper_ldfsr(uint32_t new_fsr)
3689 bb5529bb blueswir1
{
3690 3a3b925d blueswir1
    env->fsr = (new_fsr & FSR_LDFSR_MASK) | (env->fsr & FSR_LDFSR_OLDMASK);
3691 3a3b925d blueswir1
    set_fsr();
3692 bb5529bb blueswir1
}
3693 bb5529bb blueswir1
3694 3a3b925d blueswir1
#ifdef TARGET_SPARC64
3695 3a3b925d blueswir1
void helper_ldxfsr(uint64_t new_fsr)
3696 3a3b925d blueswir1
{
3697 3a3b925d blueswir1
    env->fsr = (new_fsr & FSR_LDXFSR_MASK) | (env->fsr & FSR_LDXFSR_OLDMASK);
3698 3a3b925d blueswir1
    set_fsr();
3699 3a3b925d blueswir1
}
3700 3a3b925d blueswir1
#endif
3701 3a3b925d blueswir1
3702 bb5529bb blueswir1
void helper_debug(void)
3703 e80cfcfc bellard
{
3704 e80cfcfc bellard
    env->exception_index = EXCP_DEBUG;
3705 e80cfcfc bellard
    cpu_loop_exit();
3706 e80cfcfc bellard
}
3707 af7bf89b bellard
3708 3475187d bellard
#ifndef TARGET_SPARC64
3709 72a9747b blueswir1
/* XXX: use another pointer for %iN registers to avoid slow wrapping
3710 72a9747b blueswir1
   handling ? */
3711 72a9747b blueswir1
void helper_save(void)
3712 72a9747b blueswir1
{
3713 72a9747b blueswir1
    uint32_t cwp;
3714 72a9747b blueswir1
3715 5a834bb4 Blue Swirl
    cwp = cwp_dec(env->cwp - 1);
3716 72a9747b blueswir1
    if (env->wim & (1 << cwp)) {
3717 72a9747b blueswir1
        raise_exception(TT_WIN_OVF);
3718 72a9747b blueswir1
    }
3719 72a9747b blueswir1
    set_cwp(cwp);
3720 72a9747b blueswir1
}
3721 72a9747b blueswir1
3722 72a9747b blueswir1
void helper_restore(void)
3723 72a9747b blueswir1
{
3724 72a9747b blueswir1
    uint32_t cwp;
3725 72a9747b blueswir1
3726 5a834bb4 Blue Swirl
    cwp = cwp_inc(env->cwp + 1);
3727 72a9747b blueswir1
    if (env->wim & (1 << cwp)) {
3728 72a9747b blueswir1
        raise_exception(TT_WIN_UNF);
3729 72a9747b blueswir1
    }
3730 72a9747b blueswir1
    set_cwp(cwp);
3731 72a9747b blueswir1
}
3732 72a9747b blueswir1
3733 1a2fb1c0 blueswir1
void helper_wrpsr(target_ulong new_psr)
3734 af7bf89b bellard
{
3735 5a834bb4 Blue Swirl
    if ((new_psr & PSR_CWP) >= env->nwindows) {
3736 d4218d99 blueswir1
        raise_exception(TT_ILL_INSN);
3737 5a834bb4 Blue Swirl
    } else {
3738 5a834bb4 Blue Swirl
        cpu_put_psr(env, new_psr);
3739 5a834bb4 Blue Swirl
    }
3740 af7bf89b bellard
}
3741 af7bf89b bellard
3742 1a2fb1c0 blueswir1
target_ulong helper_rdpsr(void)
3743 af7bf89b bellard
{
3744 5a834bb4 Blue Swirl
    return get_psr();
3745 af7bf89b bellard
}
3746 3475187d bellard
3747 3475187d bellard
#else
3748 72a9747b blueswir1
/* XXX: use another pointer for %iN registers to avoid slow wrapping
3749 72a9747b blueswir1
   handling ? */
3750 72a9747b blueswir1
void helper_save(void)
3751 72a9747b blueswir1
{
3752 72a9747b blueswir1
    uint32_t cwp;
3753 72a9747b blueswir1
3754 5a834bb4 Blue Swirl
    cwp = cwp_dec(env->cwp - 1);
3755 72a9747b blueswir1
    if (env->cansave == 0) {
3756 72a9747b blueswir1
        raise_exception(TT_SPILL | (env->otherwin != 0 ?
3757 72a9747b blueswir1
                                    (TT_WOTHER | ((env->wstate & 0x38) >> 1)):
3758 72a9747b blueswir1
                                    ((env->wstate & 0x7) << 2)));
3759 72a9747b blueswir1
    } else {
3760 72a9747b blueswir1
        if (env->cleanwin - env->canrestore == 0) {
3761 72a9747b blueswir1
            // XXX Clean windows without trap
3762 72a9747b blueswir1
            raise_exception(TT_CLRWIN);
3763 72a9747b blueswir1
        } else {
3764 72a9747b blueswir1
            env->cansave--;
3765 72a9747b blueswir1
            env->canrestore++;
3766 72a9747b blueswir1
            set_cwp(cwp);
3767 72a9747b blueswir1
        }
3768 72a9747b blueswir1
    }
3769 72a9747b blueswir1
}
3770 72a9747b blueswir1
3771 72a9747b blueswir1
void helper_restore(void)
3772 72a9747b blueswir1
{
3773 72a9747b blueswir1
    uint32_t cwp;
3774 72a9747b blueswir1
3775 5a834bb4 Blue Swirl
    cwp = cwp_inc(env->cwp + 1);
3776 72a9747b blueswir1
    if (env->canrestore == 0) {
3777 72a9747b blueswir1
        raise_exception(TT_FILL | (env->otherwin != 0 ?
3778 72a9747b blueswir1
                                   (TT_WOTHER | ((env->wstate & 0x38) >> 1)):
3779 72a9747b blueswir1
                                   ((env->wstate & 0x7) << 2)));
3780 72a9747b blueswir1
    } else {
3781 72a9747b blueswir1
        env->cansave++;
3782 72a9747b blueswir1
        env->canrestore--;
3783 72a9747b blueswir1
        set_cwp(cwp);
3784 72a9747b blueswir1
    }
3785 72a9747b blueswir1
}
3786 72a9747b blueswir1
3787 72a9747b blueswir1
void helper_flushw(void)
3788 72a9747b blueswir1
{
3789 1a14026e blueswir1
    if (env->cansave != env->nwindows - 2) {
3790 72a9747b blueswir1
        raise_exception(TT_SPILL | (env->otherwin != 0 ?
3791 72a9747b blueswir1
                                    (TT_WOTHER | ((env->wstate & 0x38) >> 1)):
3792 72a9747b blueswir1
                                    ((env->wstate & 0x7) << 2)));
3793 72a9747b blueswir1
    }
3794 72a9747b blueswir1
}
3795 72a9747b blueswir1
3796 72a9747b blueswir1
void helper_saved(void)
3797 72a9747b blueswir1
{
3798 72a9747b blueswir1
    env->cansave++;
3799 72a9747b blueswir1
    if (env->otherwin == 0)
3800 72a9747b blueswir1
        env->canrestore--;
3801 72a9747b blueswir1
    else
3802 72a9747b blueswir1
        env->otherwin--;
3803 72a9747b blueswir1
}
3804 72a9747b blueswir1
3805 72a9747b blueswir1
void helper_restored(void)
3806 72a9747b blueswir1
{
3807 72a9747b blueswir1
    env->canrestore++;
3808 1a14026e blueswir1
    if (env->cleanwin < env->nwindows - 1)
3809 72a9747b blueswir1
        env->cleanwin++;
3810 72a9747b blueswir1
    if (env->otherwin == 0)
3811 72a9747b blueswir1
        env->cansave--;
3812 72a9747b blueswir1
    else
3813 72a9747b blueswir1
        env->otherwin--;
3814 72a9747b blueswir1
}
3815 72a9747b blueswir1
3816 5a834bb4 Blue Swirl
static target_ulong get_ccr(void)
3817 5a834bb4 Blue Swirl
{
3818 5a834bb4 Blue Swirl
    target_ulong psr;
3819 5a834bb4 Blue Swirl
3820 5a834bb4 Blue Swirl
    psr = get_psr();
3821 5a834bb4 Blue Swirl
3822 5a834bb4 Blue Swirl
    return ((env->xcc >> 20) << 4) | ((psr & PSR_ICC) >> 20);
3823 5a834bb4 Blue Swirl
}
3824 5a834bb4 Blue Swirl
3825 5a834bb4 Blue Swirl
target_ulong cpu_get_ccr(CPUState *env1)
3826 5a834bb4 Blue Swirl
{
3827 5a834bb4 Blue Swirl
    CPUState *saved_env;
3828 5a834bb4 Blue Swirl
    target_ulong ret;
3829 5a834bb4 Blue Swirl
3830 5a834bb4 Blue Swirl
    saved_env = env;
3831 5a834bb4 Blue Swirl
    env = env1;
3832 5a834bb4 Blue Swirl
    ret = get_ccr();
3833 5a834bb4 Blue Swirl
    env = saved_env;
3834 5a834bb4 Blue Swirl
    return ret;
3835 5a834bb4 Blue Swirl
}
3836 5a834bb4 Blue Swirl
3837 5a834bb4 Blue Swirl
static void put_ccr(target_ulong val)
3838 5a834bb4 Blue Swirl
{
3839 5a834bb4 Blue Swirl
    target_ulong tmp = val;
3840 5a834bb4 Blue Swirl
3841 5a834bb4 Blue Swirl
    env->xcc = (tmp >> 4) << 20;
3842 5a834bb4 Blue Swirl
    env->psr = (tmp & 0xf) << 20;
3843 5a834bb4 Blue Swirl
    CC_OP = CC_OP_FLAGS;
3844 5a834bb4 Blue Swirl
}
3845 5a834bb4 Blue Swirl
3846 5a834bb4 Blue Swirl
void cpu_put_ccr(CPUState *env1, target_ulong val)
3847 5a834bb4 Blue Swirl
{
3848 5a834bb4 Blue Swirl
    CPUState *saved_env;
3849 5a834bb4 Blue Swirl
3850 5a834bb4 Blue Swirl
    saved_env = env;
3851 5a834bb4 Blue Swirl
    env = env1;
3852 5a834bb4 Blue Swirl
    put_ccr(val);
3853 5a834bb4 Blue Swirl
    env = saved_env;
3854 5a834bb4 Blue Swirl
}
3855 5a834bb4 Blue Swirl
3856 5a834bb4 Blue Swirl
static target_ulong get_cwp64(void)
3857 5a834bb4 Blue Swirl
{
3858 5a834bb4 Blue Swirl
    return env->nwindows - 1 - env->cwp;
3859 5a834bb4 Blue Swirl
}
3860 5a834bb4 Blue Swirl
3861 5a834bb4 Blue Swirl
target_ulong cpu_get_cwp64(CPUState *env1)
3862 5a834bb4 Blue Swirl
{
3863 5a834bb4 Blue Swirl
    CPUState *saved_env;
3864 5a834bb4 Blue Swirl
    target_ulong ret;
3865 5a834bb4 Blue Swirl
3866 5a834bb4 Blue Swirl
    saved_env = env;
3867 5a834bb4 Blue Swirl
    env = env1;
3868 5a834bb4 Blue Swirl
    ret = get_cwp64();
3869 5a834bb4 Blue Swirl
    env = saved_env;
3870 5a834bb4 Blue Swirl
    return ret;
3871 5a834bb4 Blue Swirl
}
3872 5a834bb4 Blue Swirl
3873 5a834bb4 Blue Swirl
static void put_cwp64(int cwp)
3874 5a834bb4 Blue Swirl
{
3875 5a834bb4 Blue Swirl
    if (unlikely(cwp >= env->nwindows || cwp < 0)) {
3876 5a834bb4 Blue Swirl
        cwp %= env->nwindows;
3877 5a834bb4 Blue Swirl
    }
3878 5a834bb4 Blue Swirl
    set_cwp(env->nwindows - 1 - cwp);
3879 5a834bb4 Blue Swirl
}
3880 5a834bb4 Blue Swirl
3881 5a834bb4 Blue Swirl
void cpu_put_cwp64(CPUState *env1, int cwp)
3882 5a834bb4 Blue Swirl
{
3883 5a834bb4 Blue Swirl
    CPUState *saved_env;
3884 5a834bb4 Blue Swirl
3885 5a834bb4 Blue Swirl
    saved_env = env;
3886 5a834bb4 Blue Swirl
    env = env1;
3887 5a834bb4 Blue Swirl
    put_cwp64(cwp);
3888 5a834bb4 Blue Swirl
    env = saved_env;
3889 5a834bb4 Blue Swirl
}
3890 5a834bb4 Blue Swirl
3891 d35527d9 blueswir1
target_ulong helper_rdccr(void)
3892 d35527d9 blueswir1
{
3893 5a834bb4 Blue Swirl
    return get_ccr();
3894 d35527d9 blueswir1
}
3895 d35527d9 blueswir1
3896 d35527d9 blueswir1
void helper_wrccr(target_ulong new_ccr)
3897 d35527d9 blueswir1
{
3898 5a834bb4 Blue Swirl
    put_ccr(new_ccr);
3899 d35527d9 blueswir1
}
3900 d35527d9 blueswir1
3901 d35527d9 blueswir1
// CWP handling is reversed in V9, but we still use the V8 register
3902 d35527d9 blueswir1
// order.
3903 d35527d9 blueswir1
target_ulong helper_rdcwp(void)
3904 d35527d9 blueswir1
{
3905 5a834bb4 Blue Swirl
    return get_cwp64();
3906 d35527d9 blueswir1
}
3907 d35527d9 blueswir1
3908 d35527d9 blueswir1
void helper_wrcwp(target_ulong new_cwp)
3909 d35527d9 blueswir1
{
3910 5a834bb4 Blue Swirl
    put_cwp64(new_cwp);
3911 d35527d9 blueswir1
}
3912 3475187d bellard
3913 1f5063fb blueswir1
// This function uses non-native bit order
3914 1f5063fb blueswir1
#define GET_FIELD(X, FROM, TO)                                  \
3915 1f5063fb blueswir1
    ((X) >> (63 - (TO)) & ((1ULL << ((TO) - (FROM) + 1)) - 1))
3916 1f5063fb blueswir1
3917 1f5063fb blueswir1
// This function uses the order in the manuals, i.e. bit 0 is 2^0
3918 1f5063fb blueswir1
#define GET_FIELD_SP(X, FROM, TO)               \
3919 1f5063fb blueswir1
    GET_FIELD(X, 63 - (TO), 63 - (FROM))
3920 1f5063fb blueswir1
3921 1f5063fb blueswir1
target_ulong helper_array8(target_ulong pixel_addr, target_ulong cubesize)
3922 1f5063fb blueswir1
{
3923 1f5063fb blueswir1
    return (GET_FIELD_SP(pixel_addr, 60, 63) << (17 + 2 * cubesize)) |
3924 1f5063fb blueswir1
        (GET_FIELD_SP(pixel_addr, 39, 39 + cubesize - 1) << (17 + cubesize)) |
3925 1f5063fb blueswir1
        (GET_FIELD_SP(pixel_addr, 17 + cubesize - 1, 17) << 17) |
3926 1f5063fb blueswir1
        (GET_FIELD_SP(pixel_addr, 56, 59) << 13) |
3927 1f5063fb blueswir1
        (GET_FIELD_SP(pixel_addr, 35, 38) << 9) |
3928 1f5063fb blueswir1
        (GET_FIELD_SP(pixel_addr, 13, 16) << 5) |
3929 1f5063fb blueswir1
        (((pixel_addr >> 55) & 1) << 4) |
3930 1f5063fb blueswir1
        (GET_FIELD_SP(pixel_addr, 33, 34) << 2) |
3931 1f5063fb blueswir1
        GET_FIELD_SP(pixel_addr, 11, 12);
3932 1f5063fb blueswir1
}
3933 1f5063fb blueswir1
3934 1f5063fb blueswir1
target_ulong helper_alignaddr(target_ulong addr, target_ulong offset)
3935 1f5063fb blueswir1
{
3936 1f5063fb blueswir1
    uint64_t tmp;
3937 1f5063fb blueswir1
3938 1f5063fb blueswir1
    tmp = addr + offset;
3939 1f5063fb blueswir1
    env->gsr &= ~7ULL;
3940 1f5063fb blueswir1
    env->gsr |= tmp & 7ULL;
3941 1f5063fb blueswir1
    return tmp & ~7ULL;
3942 1f5063fb blueswir1
}
3943 1f5063fb blueswir1
3944 1a2fb1c0 blueswir1
target_ulong helper_popc(target_ulong val)
3945 3475187d bellard
{
3946 1a2fb1c0 blueswir1
    return ctpop64(val);
3947 3475187d bellard
}
3948 83469015 bellard
3949 d780a466 Igor V. Kovalenko
static inline uint64_t *get_gregset(uint32_t pstate)
3950 83469015 bellard
{
3951 83469015 bellard
    switch (pstate) {
3952 83469015 bellard
    default:
3953 7e8695ed Igor V. Kovalenko
        DPRINTF_PSTATE("ERROR in get_gregset: active pstate bits=%x%s%s%s\n",
3954 7e8695ed Igor V. Kovalenko
                pstate,
3955 7e8695ed Igor V. Kovalenko
                (pstate & PS_IG) ? " IG" : "",
3956 7e8695ed Igor V. Kovalenko
                (pstate & PS_MG) ? " MG" : "",
3957 7e8695ed Igor V. Kovalenko
                (pstate & PS_AG) ? " AG" : "");
3958 7e8695ed Igor V. Kovalenko
        /* pass through to normal set of global registers */
3959 83469015 bellard
    case 0:
3960 0f8a249a blueswir1
        return env->bgregs;
3961 83469015 bellard
    case PS_AG:
3962 0f8a249a blueswir1
        return env->agregs;
3963 83469015 bellard
    case PS_MG:
3964 0f8a249a blueswir1
        return env->mgregs;
3965 83469015 bellard
    case PS_IG:
3966 0f8a249a blueswir1
        return env->igregs;
3967 83469015 bellard
    }
3968 83469015 bellard
}
3969 83469015 bellard
3970 d780a466 Igor V. Kovalenko
static inline void change_pstate(uint32_t new_pstate)
3971 83469015 bellard
{
3972 d780a466 Igor V. Kovalenko
    uint32_t pstate_regs, new_pstate_regs;
3973 83469015 bellard
    uint64_t *src, *dst;
3974 83469015 bellard
3975 5210977a Igor Kovalenko
    if (env->def->features & CPU_FEATURE_GL) {
3976 5210977a Igor Kovalenko
        // PS_AG is not implemented in this case
3977 5210977a Igor Kovalenko
        new_pstate &= ~PS_AG;
3978 5210977a Igor Kovalenko
    }
3979 5210977a Igor Kovalenko
3980 83469015 bellard
    pstate_regs = env->pstate & 0xc01;
3981 83469015 bellard
    new_pstate_regs = new_pstate & 0xc01;
3982 5210977a Igor Kovalenko
3983 83469015 bellard
    if (new_pstate_regs != pstate_regs) {
3984 7e8695ed Igor V. Kovalenko
        DPRINTF_PSTATE("change_pstate: switching regs old=%x new=%x\n",
3985 7e8695ed Igor V. Kovalenko
                       pstate_regs, new_pstate_regs);
3986 0f8a249a blueswir1
        // Switch global register bank
3987 0f8a249a blueswir1
        src = get_gregset(new_pstate_regs);
3988 0f8a249a blueswir1
        dst = get_gregset(pstate_regs);
3989 0f8a249a blueswir1
        memcpy32(dst, env->gregs);
3990 0f8a249a blueswir1
        memcpy32(env->gregs, src);
3991 83469015 bellard
    }
3992 7e8695ed Igor V. Kovalenko
    else {
3993 7e8695ed Igor V. Kovalenko
        DPRINTF_PSTATE("change_pstate: regs new=%x (unchanged)\n",
3994 7e8695ed Igor V. Kovalenko
                       new_pstate_regs);
3995 7e8695ed Igor V. Kovalenko
    }
3996 83469015 bellard
    env->pstate = new_pstate;
3997 83469015 bellard
}
3998 83469015 bellard
3999 1a2fb1c0 blueswir1
void helper_wrpstate(target_ulong new_state)
4000 8f1f22f6 blueswir1
{
4001 5210977a Igor Kovalenko
    change_pstate(new_state & 0xf3f);
4002 4dc28134 Igor V. Kovalenko
4003 4dc28134 Igor V. Kovalenko
#if !defined(CONFIG_USER_ONLY)
4004 4dc28134 Igor V. Kovalenko
    if (cpu_interrupts_enabled(env)) {
4005 4dc28134 Igor V. Kovalenko
        cpu_check_irqs(env);
4006 4dc28134 Igor V. Kovalenko
    }
4007 4dc28134 Igor V. Kovalenko
#endif
4008 8f1f22f6 blueswir1
}
4009 8f1f22f6 blueswir1
4010 1fae7b70 Igor V. Kovalenko
void helper_wrpil(target_ulong new_pil)
4011 1fae7b70 Igor V. Kovalenko
{
4012 1fae7b70 Igor V. Kovalenko
#if !defined(CONFIG_USER_ONLY)
4013 1fae7b70 Igor V. Kovalenko
    DPRINTF_PSTATE("helper_wrpil old=%x new=%x\n",
4014 1fae7b70 Igor V. Kovalenko
                   env->psrpil, (uint32_t)new_pil);
4015 1fae7b70 Igor V. Kovalenko
4016 1fae7b70 Igor V. Kovalenko
    env->psrpil = new_pil;
4017 1fae7b70 Igor V. Kovalenko
4018 1fae7b70 Igor V. Kovalenko
    if (cpu_interrupts_enabled(env)) {
4019 1fae7b70 Igor V. Kovalenko
        cpu_check_irqs(env);
4020 1fae7b70 Igor V. Kovalenko
    }
4021 1fae7b70 Igor V. Kovalenko
#endif
4022 1fae7b70 Igor V. Kovalenko
}
4023 1fae7b70 Igor V. Kovalenko
4024 1a2fb1c0 blueswir1
void helper_done(void)
4025 83469015 bellard
{
4026 8194f35a Igor Kovalenko
    trap_state* tsptr = cpu_tsptr(env);
4027 8194f35a Igor Kovalenko
4028 3723cd09 Igor V. Kovalenko
    env->pc = tsptr->tnpc;
4029 8194f35a Igor Kovalenko
    env->npc = tsptr->tnpc + 4;
4030 5a834bb4 Blue Swirl
    put_ccr(tsptr->tstate >> 32);
4031 8194f35a Igor Kovalenko
    env->asi = (tsptr->tstate >> 24) & 0xff;
4032 8194f35a Igor Kovalenko
    change_pstate((tsptr->tstate >> 8) & 0xf3f);
4033 5a834bb4 Blue Swirl
    put_cwp64(tsptr->tstate & 0xff);
4034 e6bf7d70 blueswir1
    env->tl--;
4035 4dc28134 Igor V. Kovalenko
4036 4dc28134 Igor V. Kovalenko
    DPRINTF_PSTATE("... helper_done tl=%d\n", env->tl);
4037 4dc28134 Igor V. Kovalenko
4038 4dc28134 Igor V. Kovalenko
#if !defined(CONFIG_USER_ONLY)
4039 4dc28134 Igor V. Kovalenko
    if (cpu_interrupts_enabled(env)) {
4040 4dc28134 Igor V. Kovalenko
        cpu_check_irqs(env);
4041 4dc28134 Igor V. Kovalenko
    }
4042 4dc28134 Igor V. Kovalenko
#endif
4043 83469015 bellard
}
4044 83469015 bellard
4045 1a2fb1c0 blueswir1
void helper_retry(void)
4046 83469015 bellard
{
4047 8194f35a Igor Kovalenko
    trap_state* tsptr = cpu_tsptr(env);
4048 8194f35a Igor Kovalenko
4049 8194f35a Igor Kovalenko
    env->pc = tsptr->tpc;
4050 8194f35a Igor Kovalenko
    env->npc = tsptr->tnpc;
4051 5a834bb4 Blue Swirl
    put_ccr(tsptr->tstate >> 32);
4052 8194f35a Igor Kovalenko
    env->asi = (tsptr->tstate >> 24) & 0xff;
4053 8194f35a Igor Kovalenko
    change_pstate((tsptr->tstate >> 8) & 0xf3f);
4054 5a834bb4 Blue Swirl
    put_cwp64(tsptr->tstate & 0xff);
4055 e6bf7d70 blueswir1
    env->tl--;
4056 4dc28134 Igor V. Kovalenko
4057 4dc28134 Igor V. Kovalenko
    DPRINTF_PSTATE("... helper_retry tl=%d\n", env->tl);
4058 4dc28134 Igor V. Kovalenko
4059 4dc28134 Igor V. Kovalenko
#if !defined(CONFIG_USER_ONLY)
4060 4dc28134 Igor V. Kovalenko
    if (cpu_interrupts_enabled(env)) {
4061 4dc28134 Igor V. Kovalenko
        cpu_check_irqs(env);
4062 4dc28134 Igor V. Kovalenko
    }
4063 4dc28134 Igor V. Kovalenko
#endif
4064 4dc28134 Igor V. Kovalenko
}
4065 4dc28134 Igor V. Kovalenko
4066 4dc28134 Igor V. Kovalenko
static void do_modify_softint(const char* operation, uint32_t value)
4067 4dc28134 Igor V. Kovalenko
{
4068 4dc28134 Igor V. Kovalenko
    if (env->softint != value) {
4069 4dc28134 Igor V. Kovalenko
        env->softint = value;
4070 4dc28134 Igor V. Kovalenko
        DPRINTF_PSTATE(": %s new %08x\n", operation, env->softint);
4071 4dc28134 Igor V. Kovalenko
#if !defined(CONFIG_USER_ONLY)
4072 4dc28134 Igor V. Kovalenko
        if (cpu_interrupts_enabled(env)) {
4073 4dc28134 Igor V. Kovalenko
            cpu_check_irqs(env);
4074 4dc28134 Igor V. Kovalenko
        }
4075 4dc28134 Igor V. Kovalenko
#endif
4076 4dc28134 Igor V. Kovalenko
    }
4077 83469015 bellard
}
4078 9d926598 blueswir1
4079 9d926598 blueswir1
void helper_set_softint(uint64_t value)
4080 9d926598 blueswir1
{
4081 4dc28134 Igor V. Kovalenko
    do_modify_softint("helper_set_softint", env->softint | (uint32_t)value);
4082 9d926598 blueswir1
}
4083 9d926598 blueswir1
4084 9d926598 blueswir1
void helper_clear_softint(uint64_t value)
4085 9d926598 blueswir1
{
4086 4dc28134 Igor V. Kovalenko
    do_modify_softint("helper_clear_softint", env->softint & (uint32_t)~value);
4087 9d926598 blueswir1
}
4088 9d926598 blueswir1
4089 9d926598 blueswir1
void helper_write_softint(uint64_t value)
4090 9d926598 blueswir1
{
4091 4dc28134 Igor V. Kovalenko
    do_modify_softint("helper_write_softint", (uint32_t)value);
4092 9d926598 blueswir1
}
4093 3475187d bellard
#endif
4094 ee5bbe38 bellard
4095 91736d37 blueswir1
void helper_flush(target_ulong addr)
4096 ee5bbe38 bellard
{
4097 91736d37 blueswir1
    addr &= ~7;
4098 91736d37 blueswir1
    tb_invalidate_page_range(addr, addr + 8);
4099 ee5bbe38 bellard
}
4100 ee5bbe38 bellard
4101 91736d37 blueswir1
#ifdef TARGET_SPARC64
4102 91736d37 blueswir1
#ifdef DEBUG_PCALL
4103 91736d37 blueswir1
static const char * const excp_names[0x80] = {
4104 91736d37 blueswir1
    [TT_TFAULT] = "Instruction Access Fault",
4105 91736d37 blueswir1
    [TT_TMISS] = "Instruction Access MMU Miss",
4106 91736d37 blueswir1
    [TT_CODE_ACCESS] = "Instruction Access Error",
4107 91736d37 blueswir1
    [TT_ILL_INSN] = "Illegal Instruction",
4108 91736d37 blueswir1
    [TT_PRIV_INSN] = "Privileged Instruction",
4109 91736d37 blueswir1
    [TT_NFPU_INSN] = "FPU Disabled",
4110 91736d37 blueswir1
    [TT_FP_EXCP] = "FPU Exception",
4111 91736d37 blueswir1
    [TT_TOVF] = "Tag Overflow",
4112 91736d37 blueswir1
    [TT_CLRWIN] = "Clean Windows",
4113 91736d37 blueswir1
    [TT_DIV_ZERO] = "Division By Zero",
4114 91736d37 blueswir1
    [TT_DFAULT] = "Data Access Fault",
4115 91736d37 blueswir1
    [TT_DMISS] = "Data Access MMU Miss",
4116 91736d37 blueswir1
    [TT_DATA_ACCESS] = "Data Access Error",
4117 91736d37 blueswir1
    [TT_DPROT] = "Data Protection Error",
4118 91736d37 blueswir1
    [TT_UNALIGNED] = "Unaligned Memory Access",
4119 91736d37 blueswir1
    [TT_PRIV_ACT] = "Privileged Action",
4120 91736d37 blueswir1
    [TT_EXTINT | 0x1] = "External Interrupt 1",
4121 91736d37 blueswir1
    [TT_EXTINT | 0x2] = "External Interrupt 2",
4122 91736d37 blueswir1
    [TT_EXTINT | 0x3] = "External Interrupt 3",
4123 91736d37 blueswir1
    [TT_EXTINT | 0x4] = "External Interrupt 4",
4124 91736d37 blueswir1
    [TT_EXTINT | 0x5] = "External Interrupt 5",
4125 91736d37 blueswir1
    [TT_EXTINT | 0x6] = "External Interrupt 6",
4126 91736d37 blueswir1
    [TT_EXTINT | 0x7] = "External Interrupt 7",
4127 91736d37 blueswir1
    [TT_EXTINT | 0x8] = "External Interrupt 8",
4128 91736d37 blueswir1
    [TT_EXTINT | 0x9] = "External Interrupt 9",
4129 91736d37 blueswir1
    [TT_EXTINT | 0xa] = "External Interrupt 10",
4130 91736d37 blueswir1
    [TT_EXTINT | 0xb] = "External Interrupt 11",
4131 91736d37 blueswir1
    [TT_EXTINT | 0xc] = "External Interrupt 12",
4132 91736d37 blueswir1
    [TT_EXTINT | 0xd] = "External Interrupt 13",
4133 91736d37 blueswir1
    [TT_EXTINT | 0xe] = "External Interrupt 14",
4134 91736d37 blueswir1
    [TT_EXTINT | 0xf] = "External Interrupt 15",
4135 91736d37 blueswir1
};
4136 91736d37 blueswir1
#endif
4137 91736d37 blueswir1
4138 8194f35a Igor Kovalenko
trap_state* cpu_tsptr(CPUState* env)
4139 8194f35a Igor Kovalenko
{
4140 8194f35a Igor Kovalenko
    return &env->ts[env->tl & MAXTL_MASK];
4141 8194f35a Igor Kovalenko
}
4142 8194f35a Igor Kovalenko
4143 91736d37 blueswir1
void do_interrupt(CPUState *env)
4144 91736d37 blueswir1
{
4145 91736d37 blueswir1
    int intno = env->exception_index;
4146 8194f35a Igor Kovalenko
    trap_state* tsptr;
4147 91736d37 blueswir1
4148 91736d37 blueswir1
#ifdef DEBUG_PCALL
4149 8fec2b8c aliguori
    if (qemu_loglevel_mask(CPU_LOG_INT)) {
4150 91736d37 blueswir1
        static int count;
4151 91736d37 blueswir1
        const char *name;
4152 91736d37 blueswir1
4153 91736d37 blueswir1
        if (intno < 0 || intno >= 0x180)
4154 91736d37 blueswir1
            name = "Unknown";
4155 91736d37 blueswir1
        else if (intno >= 0x100)
4156 91736d37 blueswir1
            name = "Trap Instruction";
4157 91736d37 blueswir1
        else if (intno >= 0xc0)
4158 91736d37 blueswir1
            name = "Window Fill";
4159 91736d37 blueswir1
        else if (intno >= 0x80)
4160 91736d37 blueswir1
            name = "Window Spill";
4161 91736d37 blueswir1
        else {
4162 91736d37 blueswir1
            name = excp_names[intno];
4163 91736d37 blueswir1
            if (!name)
4164 91736d37 blueswir1
                name = "Unknown";
4165 91736d37 blueswir1
        }
4166 91736d37 blueswir1
4167 93fcfe39 aliguori
        qemu_log("%6d: %s (v=%04x) pc=%016" PRIx64 " npc=%016" PRIx64
4168 91736d37 blueswir1
                " SP=%016" PRIx64 "\n",
4169 91736d37 blueswir1
                count, name, intno,
4170 91736d37 blueswir1
                env->pc,
4171 91736d37 blueswir1
                env->npc, env->regwptr[6]);
4172 93fcfe39 aliguori
        log_cpu_state(env, 0);
4173 91736d37 blueswir1
#if 0
4174 91736d37 blueswir1
        {
4175 91736d37 blueswir1
            int i;
4176 91736d37 blueswir1
            uint8_t *ptr;
4177 91736d37 blueswir1

4178 93fcfe39 aliguori
            qemu_log("       code=");
4179 91736d37 blueswir1
            ptr = (uint8_t *)env->pc;
4180 91736d37 blueswir1
            for(i = 0; i < 16; i++) {
4181 93fcfe39 aliguori
                qemu_log(" %02x", ldub(ptr + i));
4182 91736d37 blueswir1
            }
4183 93fcfe39 aliguori
            qemu_log("\n");
4184 91736d37 blueswir1
        }
4185 91736d37 blueswir1
#endif
4186 91736d37 blueswir1
        count++;
4187 91736d37 blueswir1
    }
4188 91736d37 blueswir1
#endif
4189 91736d37 blueswir1
#if !defined(CONFIG_USER_ONLY)
4190 91736d37 blueswir1
    if (env->tl >= env->maxtl) {
4191 91736d37 blueswir1
        cpu_abort(env, "Trap 0x%04x while trap level (%d) >= MAXTL (%d),"
4192 91736d37 blueswir1
                  " Error state", env->exception_index, env->tl, env->maxtl);
4193 91736d37 blueswir1
        return;
4194 91736d37 blueswir1
    }
4195 91736d37 blueswir1
#endif
4196 91736d37 blueswir1
    if (env->tl < env->maxtl - 1) {
4197 91736d37 blueswir1
        env->tl++;
4198 91736d37 blueswir1
    } else {
4199 91736d37 blueswir1
        env->pstate |= PS_RED;
4200 91736d37 blueswir1
        if (env->tl < env->maxtl)
4201 91736d37 blueswir1
            env->tl++;
4202 91736d37 blueswir1
    }
4203 8194f35a Igor Kovalenko
    tsptr = cpu_tsptr(env);
4204 8194f35a Igor Kovalenko
4205 5a834bb4 Blue Swirl
    tsptr->tstate = (get_ccr() << 32) |
4206 91736d37 blueswir1
        ((env->asi & 0xff) << 24) | ((env->pstate & 0xf3f) << 8) |
4207 5a834bb4 Blue Swirl
        get_cwp64();
4208 8194f35a Igor Kovalenko
    tsptr->tpc = env->pc;
4209 8194f35a Igor Kovalenko
    tsptr->tnpc = env->npc;
4210 8194f35a Igor Kovalenko
    tsptr->tt = intno;
4211 5210977a Igor Kovalenko
4212 5210977a Igor Kovalenko
    switch (intno) {
4213 5210977a Igor Kovalenko
    case TT_IVEC:
4214 5210977a Igor Kovalenko
        change_pstate(PS_PEF | PS_PRIV | PS_IG);
4215 5210977a Igor Kovalenko
        break;
4216 5210977a Igor Kovalenko
    case TT_TFAULT:
4217 5210977a Igor Kovalenko
    case TT_DFAULT:
4218 87f6d3f6 Igor V. Kovalenko
    case TT_TMISS ... TT_TMISS + 3:
4219 87f6d3f6 Igor V. Kovalenko
    case TT_DMISS ... TT_DMISS + 3:
4220 87f6d3f6 Igor V. Kovalenko
    case TT_DPROT ... TT_DPROT + 3:
4221 5210977a Igor Kovalenko
        change_pstate(PS_PEF | PS_PRIV | PS_MG);
4222 5210977a Igor Kovalenko
        break;
4223 5210977a Igor Kovalenko
    default:
4224 5210977a Igor Kovalenko
        change_pstate(PS_PEF | PS_PRIV | PS_AG);
4225 5210977a Igor Kovalenko
        break;
4226 91736d37 blueswir1
    }
4227 5210977a Igor Kovalenko
4228 5a834bb4 Blue Swirl
    if (intno == TT_CLRWIN) {
4229 5a834bb4 Blue Swirl
        set_cwp(cwp_dec(env->cwp - 1));
4230 5a834bb4 Blue Swirl
    } else if ((intno & 0x1c0) == TT_SPILL) {
4231 5a834bb4 Blue Swirl
        set_cwp(cwp_dec(env->cwp - env->cansave - 2));
4232 5a834bb4 Blue Swirl
    } else if ((intno & 0x1c0) == TT_FILL) {
4233 5a834bb4 Blue Swirl
        set_cwp(cwp_inc(env->cwp + 1));
4234 5a834bb4 Blue Swirl
    }
4235 91736d37 blueswir1
    env->tbr &= ~0x7fffULL;
4236 91736d37 blueswir1
    env->tbr |= ((env->tl > 1) ? 1 << 14 : 0) | (intno << 5);
4237 91736d37 blueswir1
    env->pc = env->tbr;
4238 91736d37 blueswir1
    env->npc = env->pc + 4;
4239 821b19fe Igor V. Kovalenko
    env->exception_index = -1;
4240 ee5bbe38 bellard
}
4241 91736d37 blueswir1
#else
4242 91736d37 blueswir1
#ifdef DEBUG_PCALL
4243 91736d37 blueswir1
static const char * const excp_names[0x80] = {
4244 91736d37 blueswir1
    [TT_TFAULT] = "Instruction Access Fault",
4245 91736d37 blueswir1
    [TT_ILL_INSN] = "Illegal Instruction",
4246 91736d37 blueswir1
    [TT_PRIV_INSN] = "Privileged Instruction",
4247 91736d37 blueswir1
    [TT_NFPU_INSN] = "FPU Disabled",
4248 91736d37 blueswir1
    [TT_WIN_OVF] = "Window Overflow",
4249 91736d37 blueswir1
    [TT_WIN_UNF] = "Window Underflow",
4250 91736d37 blueswir1
    [TT_UNALIGNED] = "Unaligned Memory Access",
4251 91736d37 blueswir1
    [TT_FP_EXCP] = "FPU Exception",
4252 91736d37 blueswir1
    [TT_DFAULT] = "Data Access Fault",
4253 91736d37 blueswir1
    [TT_TOVF] = "Tag Overflow",
4254 91736d37 blueswir1
    [TT_EXTINT | 0x1] = "External Interrupt 1",
4255 91736d37 blueswir1
    [TT_EXTINT | 0x2] = "External Interrupt 2",
4256 91736d37 blueswir1
    [TT_EXTINT | 0x3] = "External Interrupt 3",
4257 91736d37 blueswir1
    [TT_EXTINT | 0x4] = "External Interrupt 4",
4258 91736d37 blueswir1
    [TT_EXTINT | 0x5] = "External Interrupt 5",
4259 91736d37 blueswir1
    [TT_EXTINT | 0x6] = "External Interrupt 6",
4260 91736d37 blueswir1
    [TT_EXTINT | 0x7] = "External Interrupt 7",
4261 91736d37 blueswir1
    [TT_EXTINT | 0x8] = "External Interrupt 8",
4262 91736d37 blueswir1
    [TT_EXTINT | 0x9] = "External Interrupt 9",
4263 91736d37 blueswir1
    [TT_EXTINT | 0xa] = "External Interrupt 10",
4264 91736d37 blueswir1
    [TT_EXTINT | 0xb] = "External Interrupt 11",
4265 91736d37 blueswir1
    [TT_EXTINT | 0xc] = "External Interrupt 12",
4266 91736d37 blueswir1
    [TT_EXTINT | 0xd] = "External Interrupt 13",
4267 91736d37 blueswir1
    [TT_EXTINT | 0xe] = "External Interrupt 14",
4268 91736d37 blueswir1
    [TT_EXTINT | 0xf] = "External Interrupt 15",
4269 91736d37 blueswir1
    [TT_TOVF] = "Tag Overflow",
4270 91736d37 blueswir1
    [TT_CODE_ACCESS] = "Instruction Access Error",
4271 91736d37 blueswir1
    [TT_DATA_ACCESS] = "Data Access Error",
4272 91736d37 blueswir1
    [TT_DIV_ZERO] = "Division By Zero",
4273 91736d37 blueswir1
    [TT_NCP_INSN] = "Coprocessor Disabled",
4274 91736d37 blueswir1
};
4275 91736d37 blueswir1
#endif
4276 ee5bbe38 bellard
4277 91736d37 blueswir1
void do_interrupt(CPUState *env)
4278 ee5bbe38 bellard
{
4279 91736d37 blueswir1
    int cwp, intno = env->exception_index;
4280 91736d37 blueswir1
4281 91736d37 blueswir1
#ifdef DEBUG_PCALL
4282 8fec2b8c aliguori
    if (qemu_loglevel_mask(CPU_LOG_INT)) {
4283 91736d37 blueswir1
        static int count;
4284 91736d37 blueswir1
        const char *name;
4285 91736d37 blueswir1
4286 91736d37 blueswir1
        if (intno < 0 || intno >= 0x100)
4287 91736d37 blueswir1
            name = "Unknown";
4288 91736d37 blueswir1
        else if (intno >= 0x80)
4289 91736d37 blueswir1
            name = "Trap Instruction";
4290 91736d37 blueswir1
        else {
4291 91736d37 blueswir1
            name = excp_names[intno];
4292 91736d37 blueswir1
            if (!name)
4293 91736d37 blueswir1
                name = "Unknown";
4294 91736d37 blueswir1
        }
4295 91736d37 blueswir1
4296 93fcfe39 aliguori
        qemu_log("%6d: %s (v=%02x) pc=%08x npc=%08x SP=%08x\n",
4297 91736d37 blueswir1
                count, name, intno,
4298 91736d37 blueswir1
                env->pc,
4299 91736d37 blueswir1
                env->npc, env->regwptr[6]);
4300 93fcfe39 aliguori
        log_cpu_state(env, 0);
4301 91736d37 blueswir1
#if 0
4302 91736d37 blueswir1
        {
4303 91736d37 blueswir1
            int i;
4304 91736d37 blueswir1
            uint8_t *ptr;
4305 91736d37 blueswir1

4306 93fcfe39 aliguori
            qemu_log("       code=");
4307 91736d37 blueswir1
            ptr = (uint8_t *)env->pc;
4308 91736d37 blueswir1
            for(i = 0; i < 16; i++) {
4309 93fcfe39 aliguori
                qemu_log(" %02x", ldub(ptr + i));
4310 91736d37 blueswir1
            }
4311 93fcfe39 aliguori
            qemu_log("\n");
4312 91736d37 blueswir1
        }
4313 91736d37 blueswir1
#endif
4314 91736d37 blueswir1
        count++;
4315 91736d37 blueswir1
    }
4316 91736d37 blueswir1
#endif
4317 91736d37 blueswir1
#if !defined(CONFIG_USER_ONLY)
4318 91736d37 blueswir1
    if (env->psret == 0) {
4319 91736d37 blueswir1
        cpu_abort(env, "Trap 0x%02x while interrupts disabled, Error state",
4320 91736d37 blueswir1
                  env->exception_index);
4321 91736d37 blueswir1
        return;
4322 91736d37 blueswir1
    }
4323 91736d37 blueswir1
#endif
4324 91736d37 blueswir1
    env->psret = 0;
4325 5a834bb4 Blue Swirl
    cwp = cwp_dec(env->cwp - 1);
4326 5a834bb4 Blue Swirl
    set_cwp(cwp);
4327 91736d37 blueswir1
    env->regwptr[9] = env->pc;
4328 91736d37 blueswir1
    env->regwptr[10] = env->npc;
4329 91736d37 blueswir1
    env->psrps = env->psrs;
4330 91736d37 blueswir1
    env->psrs = 1;
4331 91736d37 blueswir1
    env->tbr = (env->tbr & TBR_BASE_MASK) | (intno << 4);
4332 91736d37 blueswir1
    env->pc = env->tbr;
4333 91736d37 blueswir1
    env->npc = env->pc + 4;
4334 95372a39 Blue Swirl
    env->exception_index = -1;
4335 b04d9890 Fabien Chouteau
4336 b04d9890 Fabien Chouteau
#if !defined(CONFIG_USER_ONLY)
4337 b04d9890 Fabien Chouteau
    /* IRQ acknowledgment */
4338 b04d9890 Fabien Chouteau
    if ((intno & ~15) == TT_EXTINT && env->qemu_irq_ack != NULL) {
4339 b04d9890 Fabien Chouteau
        env->qemu_irq_ack(env->irq_manager, intno);
4340 b04d9890 Fabien Chouteau
    }
4341 b04d9890 Fabien Chouteau
#endif
4342 ee5bbe38 bellard
}
4343 91736d37 blueswir1
#endif
4344 ee5bbe38 bellard
4345 5fafdf24 ths
#if !defined(CONFIG_USER_ONLY)
4346 ee5bbe38 bellard
4347 d2889a3e blueswir1
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
4348 d2889a3e blueswir1
                                void *retaddr);
4349 d2889a3e blueswir1
4350 ee5bbe38 bellard
#define MMUSUFFIX _mmu
4351 d2889a3e blueswir1
#define ALIGNED_ONLY
4352 ee5bbe38 bellard
4353 ee5bbe38 bellard
#define SHIFT 0
4354 ee5bbe38 bellard
#include "softmmu_template.h"
4355 ee5bbe38 bellard
4356 ee5bbe38 bellard
#define SHIFT 1
4357 ee5bbe38 bellard
#include "softmmu_template.h"
4358 ee5bbe38 bellard
4359 ee5bbe38 bellard
#define SHIFT 2
4360 ee5bbe38 bellard
#include "softmmu_template.h"
4361 ee5bbe38 bellard
4362 ee5bbe38 bellard
#define SHIFT 3
4363 ee5bbe38 bellard
#include "softmmu_template.h"
4364 ee5bbe38 bellard
4365 c2bc0e38 blueswir1
/* XXX: make it generic ? */
4366 c2bc0e38 blueswir1
static void cpu_restore_state2(void *retaddr)
4367 c2bc0e38 blueswir1
{
4368 c2bc0e38 blueswir1
    TranslationBlock *tb;
4369 c2bc0e38 blueswir1
    unsigned long pc;
4370 c2bc0e38 blueswir1
4371 c2bc0e38 blueswir1
    if (retaddr) {
4372 c2bc0e38 blueswir1
        /* now we have a real cpu fault */
4373 c2bc0e38 blueswir1
        pc = (unsigned long)retaddr;
4374 c2bc0e38 blueswir1
        tb = tb_find_pc(pc);
4375 c2bc0e38 blueswir1
        if (tb) {
4376 c2bc0e38 blueswir1
            /* the PC is inside the translated code. It means that we have
4377 c2bc0e38 blueswir1
               a virtual CPU fault */
4378 618ba8e6 Stefan Weil
            cpu_restore_state(tb, env, pc);
4379 c2bc0e38 blueswir1
        }
4380 c2bc0e38 blueswir1
    }
4381 c2bc0e38 blueswir1
}
4382 c2bc0e38 blueswir1
4383 d2889a3e blueswir1
static void do_unaligned_access(target_ulong addr, int is_write, int is_user,
4384 d2889a3e blueswir1
                                void *retaddr)
4385 d2889a3e blueswir1
{
4386 94554550 blueswir1
#ifdef DEBUG_UNALIGNED
4387 c2bc0e38 blueswir1
    printf("Unaligned access to 0x" TARGET_FMT_lx " from 0x" TARGET_FMT_lx
4388 c2bc0e38 blueswir1
           "\n", addr, env->pc);
4389 94554550 blueswir1
#endif
4390 c2bc0e38 blueswir1
    cpu_restore_state2(retaddr);
4391 94554550 blueswir1
    raise_exception(TT_UNALIGNED);
4392 d2889a3e blueswir1
}
4393 ee5bbe38 bellard
4394 ee5bbe38 bellard
/* try to fill the TLB and return an exception if error. If retaddr is
4395 ee5bbe38 bellard
   NULL, it means that the function was called in C code (i.e. not
4396 ee5bbe38 bellard
   from generated code or from helper.c) */
4397 ee5bbe38 bellard
/* XXX: fix it to restore all registers */
4398 6ebbf390 j_mayer
void tlb_fill(target_ulong addr, int is_write, int mmu_idx, void *retaddr)
4399 ee5bbe38 bellard
{
4400 ee5bbe38 bellard
    int ret;
4401 ee5bbe38 bellard
    CPUState *saved_env;
4402 ee5bbe38 bellard
4403 ee5bbe38 bellard
    /* XXX: hack to restore env in all cases, even if not called from
4404 ee5bbe38 bellard
       generated code */
4405 ee5bbe38 bellard
    saved_env = env;
4406 ee5bbe38 bellard
    env = cpu_single_env;
4407 ee5bbe38 bellard
4408 6ebbf390 j_mayer
    ret = cpu_sparc_handle_mmu_fault(env, addr, is_write, mmu_idx, 1);
4409 ee5bbe38 bellard
    if (ret) {
4410 c2bc0e38 blueswir1
        cpu_restore_state2(retaddr);
4411 ee5bbe38 bellard
        cpu_loop_exit();
4412 ee5bbe38 bellard
    }
4413 ee5bbe38 bellard
    env = saved_env;
4414 ee5bbe38 bellard
}
4415 ee5bbe38 bellard
4416 3c7b48b7 Paul Brook
#endif /* !CONFIG_USER_ONLY */
4417 6c36d3fa blueswir1
4418 6c36d3fa blueswir1
#ifndef TARGET_SPARC64
4419 3c7b48b7 Paul Brook
#if !defined(CONFIG_USER_ONLY)
4420 c227f099 Anthony Liguori
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
4421 e18231a3 blueswir1
                          int is_asi, int size)
4422 6c36d3fa blueswir1
{
4423 6c36d3fa blueswir1
    CPUState *saved_env;
4424 576c2cdc Artyom Tarasenko
    int fault_type;
4425 6c36d3fa blueswir1
4426 6c36d3fa blueswir1
    /* XXX: hack to restore env in all cases, even if not called from
4427 6c36d3fa blueswir1
       generated code */
4428 6c36d3fa blueswir1
    saved_env = env;
4429 6c36d3fa blueswir1
    env = cpu_single_env;
4430 8543e2cf blueswir1
#ifdef DEBUG_UNASSIGNED
4431 8543e2cf blueswir1
    if (is_asi)
4432 e18231a3 blueswir1
        printf("Unassigned mem %s access of %d byte%s to " TARGET_FMT_plx
4433 77f193da blueswir1
               " asi 0x%02x from " TARGET_FMT_lx "\n",
4434 e18231a3 blueswir1
               is_exec ? "exec" : is_write ? "write" : "read", size,
4435 e18231a3 blueswir1
               size == 1 ? "" : "s", addr, is_asi, env->pc);
4436 8543e2cf blueswir1
    else
4437 e18231a3 blueswir1
        printf("Unassigned mem %s access of %d byte%s to " TARGET_FMT_plx
4438 e18231a3 blueswir1
               " from " TARGET_FMT_lx "\n",
4439 e18231a3 blueswir1
               is_exec ? "exec" : is_write ? "write" : "read", size,
4440 e18231a3 blueswir1
               size == 1 ? "" : "s", addr, env->pc);
4441 8543e2cf blueswir1
#endif
4442 576c2cdc Artyom Tarasenko
    /* Don't overwrite translation and access faults */
4443 576c2cdc Artyom Tarasenko
    fault_type = (env->mmuregs[3] & 0x1c) >> 2;
4444 576c2cdc Artyom Tarasenko
    if ((fault_type > 4) || (fault_type == 0)) {
4445 576c2cdc Artyom Tarasenko
        env->mmuregs[3] = 0; /* Fault status register */
4446 576c2cdc Artyom Tarasenko
        if (is_asi)
4447 576c2cdc Artyom Tarasenko
            env->mmuregs[3] |= 1 << 16;
4448 576c2cdc Artyom Tarasenko
        if (env->psrs)
4449 576c2cdc Artyom Tarasenko
            env->mmuregs[3] |= 1 << 5;
4450 576c2cdc Artyom Tarasenko
        if (is_exec)
4451 576c2cdc Artyom Tarasenko
            env->mmuregs[3] |= 1 << 6;
4452 576c2cdc Artyom Tarasenko
        if (is_write)
4453 576c2cdc Artyom Tarasenko
            env->mmuregs[3] |= 1 << 7;
4454 576c2cdc Artyom Tarasenko
        env->mmuregs[3] |= (5 << 2) | 2;
4455 576c2cdc Artyom Tarasenko
        /* SuperSPARC will never place instruction fault addresses in the FAR */
4456 576c2cdc Artyom Tarasenko
        if (!is_exec) {
4457 576c2cdc Artyom Tarasenko
            env->mmuregs[4] = addr; /* Fault address register */
4458 576c2cdc Artyom Tarasenko
        }
4459 576c2cdc Artyom Tarasenko
    }
4460 576c2cdc Artyom Tarasenko
    /* overflow (same type fault was not read before another fault) */
4461 576c2cdc Artyom Tarasenko
    if (fault_type == ((env->mmuregs[3] & 0x1c)) >> 2) {
4462 576c2cdc Artyom Tarasenko
        env->mmuregs[3] |= 1;
4463 576c2cdc Artyom Tarasenko
    }
4464 576c2cdc Artyom Tarasenko
4465 6c36d3fa blueswir1
    if ((env->mmuregs[0] & MMU_E) && !(env->mmuregs[0] & MMU_NF)) {
4466 1b2e93c1 blueswir1
        if (is_exec)
4467 1b2e93c1 blueswir1
            raise_exception(TT_CODE_ACCESS);
4468 1b2e93c1 blueswir1
        else
4469 1b2e93c1 blueswir1
            raise_exception(TT_DATA_ACCESS);
4470 6c36d3fa blueswir1
    }
4471 576c2cdc Artyom Tarasenko
4472 576c2cdc Artyom Tarasenko
    /* flush neverland mappings created during no-fault mode,
4473 576c2cdc Artyom Tarasenko
       so the sequential MMU faults report proper fault types */
4474 576c2cdc Artyom Tarasenko
    if (env->mmuregs[0] & MMU_NF) {
4475 576c2cdc Artyom Tarasenko
        tlb_flush(env, 1);
4476 576c2cdc Artyom Tarasenko
    }
4477 15e7c451 Artyom Tarasenko
4478 15e7c451 Artyom Tarasenko
    env = saved_env;
4479 6c36d3fa blueswir1
}
4480 3c7b48b7 Paul Brook
#endif
4481 3c7b48b7 Paul Brook
#else
4482 3c7b48b7 Paul Brook
#if defined(CONFIG_USER_ONLY)
4483 3c7b48b7 Paul Brook
static void do_unassigned_access(target_ulong addr, int is_write, int is_exec,
4484 3c7b48b7 Paul Brook
                          int is_asi, int size)
4485 6c36d3fa blueswir1
#else
4486 c227f099 Anthony Liguori
void do_unassigned_access(target_phys_addr_t addr, int is_write, int is_exec,
4487 e18231a3 blueswir1
                          int is_asi, int size)
4488 3c7b48b7 Paul Brook
#endif
4489 6c36d3fa blueswir1
{
4490 6c36d3fa blueswir1
    CPUState *saved_env;
4491 6c36d3fa blueswir1
4492 6c36d3fa blueswir1
    /* XXX: hack to restore env in all cases, even if not called from
4493 6c36d3fa blueswir1
       generated code */
4494 6c36d3fa blueswir1
    saved_env = env;
4495 6c36d3fa blueswir1
    env = cpu_single_env;
4496 dffbe217 Igor V. Kovalenko
4497 dffbe217 Igor V. Kovalenko
#ifdef DEBUG_UNASSIGNED
4498 77f193da blueswir1
    printf("Unassigned mem access to " TARGET_FMT_plx " from " TARGET_FMT_lx
4499 77f193da blueswir1
           "\n", addr, env->pc);
4500 6c36d3fa blueswir1
#endif
4501 dffbe217 Igor V. Kovalenko
4502 1b2e93c1 blueswir1
    if (is_exec)
4503 1b2e93c1 blueswir1
        raise_exception(TT_CODE_ACCESS);
4504 1b2e93c1 blueswir1
    else
4505 1b2e93c1 blueswir1
        raise_exception(TT_DATA_ACCESS);
4506 dffbe217 Igor V. Kovalenko
4507 dffbe217 Igor V. Kovalenko
    env = saved_env;
4508 6c36d3fa blueswir1
}
4509 6c36d3fa blueswir1
#endif
4510 20c9f095 blueswir1
4511 3c7b48b7 Paul Brook
4512 f4b1a842 blueswir1
#ifdef TARGET_SPARC64
4513 f4b1a842 blueswir1
void helper_tick_set_count(void *opaque, uint64_t count)
4514 f4b1a842 blueswir1
{
4515 f4b1a842 blueswir1
#if !defined(CONFIG_USER_ONLY)
4516 f4b1a842 blueswir1
    cpu_tick_set_count(opaque, count);
4517 f4b1a842 blueswir1
#endif
4518 f4b1a842 blueswir1
}
4519 f4b1a842 blueswir1
4520 f4b1a842 blueswir1
uint64_t helper_tick_get_count(void *opaque)
4521 f4b1a842 blueswir1
{
4522 f4b1a842 blueswir1
#if !defined(CONFIG_USER_ONLY)
4523 f4b1a842 blueswir1
    return cpu_tick_get_count(opaque);
4524 f4b1a842 blueswir1
#else
4525 f4b1a842 blueswir1
    return 0;
4526 f4b1a842 blueswir1
#endif
4527 f4b1a842 blueswir1
}
4528 f4b1a842 blueswir1
4529 f4b1a842 blueswir1
void helper_tick_set_limit(void *opaque, uint64_t limit)
4530 f4b1a842 blueswir1
{
4531 f4b1a842 blueswir1
#if !defined(CONFIG_USER_ONLY)
4532 f4b1a842 blueswir1
    cpu_tick_set_limit(opaque, limit);
4533 f4b1a842 blueswir1
#endif
4534 f4b1a842 blueswir1
}
4535 f4b1a842 blueswir1
#endif