root / target-s390x / helper.c @ 66a0a2cb
History | View | Annotate | Download (17.4 kB)
1 | 10ec5117 | Alexander Graf | /*
|
---|---|---|---|
2 | 10ec5117 | Alexander Graf | * S/390 helpers
|
3 | 10ec5117 | Alexander Graf | *
|
4 | 10ec5117 | Alexander Graf | * Copyright (c) 2009 Ulrich Hecht
|
5 | d5a43964 | Alexander Graf | * Copyright (c) 2011 Alexander Graf
|
6 | 10ec5117 | Alexander Graf | *
|
7 | 10ec5117 | Alexander Graf | * This library is free software; you can redistribute it and/or
|
8 | 10ec5117 | Alexander Graf | * modify it under the terms of the GNU Lesser General Public
|
9 | 10ec5117 | Alexander Graf | * License as published by the Free Software Foundation; either
|
10 | 10ec5117 | Alexander Graf | * version 2 of the License, or (at your option) any later version.
|
11 | 10ec5117 | Alexander Graf | *
|
12 | 10ec5117 | Alexander Graf | * This library is distributed in the hope that it will be useful,
|
13 | 10ec5117 | Alexander Graf | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
14 | 10ec5117 | Alexander Graf | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
15 | 10ec5117 | Alexander Graf | * Lesser General Public License for more details.
|
16 | 10ec5117 | Alexander Graf | *
|
17 | 10ec5117 | Alexander Graf | * You should have received a copy of the GNU Lesser General Public
|
18 | 70539e18 | Blue Swirl | * License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
19 | 10ec5117 | Alexander Graf | */
|
20 | 10ec5117 | Alexander Graf | |
21 | 10ec5117 | Alexander Graf | #include <stdio.h> |
22 | 10ec5117 | Alexander Graf | #include <stdlib.h> |
23 | 10ec5117 | Alexander Graf | #include <string.h> |
24 | 10ec5117 | Alexander Graf | |
25 | 10ec5117 | Alexander Graf | #include "cpu.h" |
26 | 10ec5117 | Alexander Graf | #include "gdbstub.h" |
27 | 10ec5117 | Alexander Graf | #include "qemu-common.h" |
28 | d5a43964 | Alexander Graf | #include "qemu-timer.h" |
29 | ef81522b | Alexander Graf | #ifndef CONFIG_USER_ONLY
|
30 | ef81522b | Alexander Graf | #include "sysemu.h" |
31 | ef81522b | Alexander Graf | #endif
|
32 | 10ec5117 | Alexander Graf | |
33 | d5a43964 | Alexander Graf | //#define DEBUG_S390
|
34 | d5a43964 | Alexander Graf | //#define DEBUG_S390_PTE
|
35 | d5a43964 | Alexander Graf | //#define DEBUG_S390_STDOUT
|
36 | d5a43964 | Alexander Graf | |
37 | d5a43964 | Alexander Graf | #ifdef DEBUG_S390
|
38 | d5a43964 | Alexander Graf | #ifdef DEBUG_S390_STDOUT
|
39 | d5a43964 | Alexander Graf | #define DPRINTF(fmt, ...) \
|
40 | d5a43964 | Alexander Graf | do { fprintf(stderr, fmt, ## __VA_ARGS__); \ |
41 | d5a43964 | Alexander Graf | qemu_log(fmt, ##__VA_ARGS__); } while (0) |
42 | d5a43964 | Alexander Graf | #else
|
43 | d5a43964 | Alexander Graf | #define DPRINTF(fmt, ...) \
|
44 | d5a43964 | Alexander Graf | do { qemu_log(fmt, ## __VA_ARGS__); } while (0) |
45 | d5a43964 | Alexander Graf | #endif
|
46 | d5a43964 | Alexander Graf | #else
|
47 | d5a43964 | Alexander Graf | #define DPRINTF(fmt, ...) \
|
48 | d5a43964 | Alexander Graf | do { } while (0) |
49 | d5a43964 | Alexander Graf | #endif
|
50 | d5a43964 | Alexander Graf | |
51 | d5a43964 | Alexander Graf | #ifdef DEBUG_S390_PTE
|
52 | d5a43964 | Alexander Graf | #define PTE_DPRINTF DPRINTF
|
53 | d5a43964 | Alexander Graf | #else
|
54 | d5a43964 | Alexander Graf | #define PTE_DPRINTF(fmt, ...) \
|
55 | d5a43964 | Alexander Graf | do { } while (0) |
56 | d5a43964 | Alexander Graf | #endif
|
57 | d5a43964 | Alexander Graf | |
58 | d5a43964 | Alexander Graf | #ifndef CONFIG_USER_ONLY
|
59 | d5a43964 | Alexander Graf | static void s390x_tod_timer(void *opaque) |
60 | d5a43964 | Alexander Graf | { |
61 | d5a43964 | Alexander Graf | CPUState *env = opaque; |
62 | d5a43964 | Alexander Graf | |
63 | d5a43964 | Alexander Graf | env->pending_int |= INTERRUPT_TOD; |
64 | d5a43964 | Alexander Graf | cpu_interrupt(env, CPU_INTERRUPT_HARD); |
65 | d5a43964 | Alexander Graf | } |
66 | d5a43964 | Alexander Graf | |
67 | d5a43964 | Alexander Graf | static void s390x_cpu_timer(void *opaque) |
68 | d5a43964 | Alexander Graf | { |
69 | d5a43964 | Alexander Graf | CPUState *env = opaque; |
70 | d5a43964 | Alexander Graf | |
71 | d5a43964 | Alexander Graf | env->pending_int |= INTERRUPT_CPUTIMER; |
72 | d5a43964 | Alexander Graf | cpu_interrupt(env, CPU_INTERRUPT_HARD); |
73 | d5a43964 | Alexander Graf | } |
74 | d5a43964 | Alexander Graf | #endif
|
75 | 10c339a0 | Alexander Graf | |
76 | 10ec5117 | Alexander Graf | CPUS390XState *cpu_s390x_init(const char *cpu_model) |
77 | 10ec5117 | Alexander Graf | { |
78 | 10ec5117 | Alexander Graf | CPUS390XState *env; |
79 | d5a43964 | Alexander Graf | #if !defined (CONFIG_USER_ONLY)
|
80 | d5a43964 | Alexander Graf | struct tm tm;
|
81 | d5a43964 | Alexander Graf | #endif
|
82 | 10ec5117 | Alexander Graf | static int inited = 0; |
83 | d5a43964 | Alexander Graf | static int cpu_num = 0; |
84 | 10ec5117 | Alexander Graf | |
85 | 7267c094 | Anthony Liguori | env = g_malloc0(sizeof(CPUS390XState));
|
86 | 10ec5117 | Alexander Graf | cpu_exec_init(env); |
87 | d5ab9713 | Jan Kiszka | if (tcg_enabled() && !inited) {
|
88 | 10ec5117 | Alexander Graf | inited = 1;
|
89 | d5a43964 | Alexander Graf | s390x_translate_init(); |
90 | 10ec5117 | Alexander Graf | } |
91 | 10ec5117 | Alexander Graf | |
92 | d5a43964 | Alexander Graf | #if !defined(CONFIG_USER_ONLY)
|
93 | d5a43964 | Alexander Graf | qemu_get_timedate(&tm, 0);
|
94 | d5a43964 | Alexander Graf | env->tod_offset = TOD_UNIX_EPOCH + |
95 | d5a43964 | Alexander Graf | (time2tod(mktimegm(&tm)) * 1000000000ULL);
|
96 | d5a43964 | Alexander Graf | env->tod_basetime = 0;
|
97 | d5a43964 | Alexander Graf | env->tod_timer = qemu_new_timer_ns(vm_clock, s390x_tod_timer, env); |
98 | d5a43964 | Alexander Graf | env->cpu_timer = qemu_new_timer_ns(vm_clock, s390x_cpu_timer, env); |
99 | d5a43964 | Alexander Graf | #endif
|
100 | 10ec5117 | Alexander Graf | env->cpu_model_str = cpu_model; |
101 | d5a43964 | Alexander Graf | env->cpu_num = cpu_num++; |
102 | d5a43964 | Alexander Graf | env->ext_index = -1;
|
103 | 10ec5117 | Alexander Graf | cpu_reset(env); |
104 | 10ec5117 | Alexander Graf | qemu_init_vcpu(env); |
105 | 10ec5117 | Alexander Graf | return env;
|
106 | 10ec5117 | Alexander Graf | } |
107 | 10ec5117 | Alexander Graf | |
108 | d5a43964 | Alexander Graf | #if defined(CONFIG_USER_ONLY)
|
109 | d5a43964 | Alexander Graf | |
110 | d5a43964 | Alexander Graf | void do_interrupt (CPUState *env)
|
111 | d5a43964 | Alexander Graf | { |
112 | d5a43964 | Alexander Graf | env->exception_index = -1;
|
113 | d5a43964 | Alexander Graf | } |
114 | d5a43964 | Alexander Graf | |
115 | d5a43964 | Alexander Graf | int cpu_s390x_handle_mmu_fault (CPUState *env, target_ulong address, int rw, |
116 | 97b348e7 | Blue Swirl | int mmu_idx)
|
117 | d5a43964 | Alexander Graf | { |
118 | 97b348e7 | Blue Swirl | /* fprintf(stderr,"%s: address 0x%lx rw %d mmu_idx %d\n",
|
119 | 97b348e7 | Blue Swirl | __FUNCTION__, address, rw, mmu_idx); */
|
120 | d5a43964 | Alexander Graf | env->exception_index = EXCP_ADDR; |
121 | d5a43964 | Alexander Graf | env->__excp_addr = address; /* FIXME: find out how this works on a real machine */
|
122 | d5a43964 | Alexander Graf | return 1; |
123 | d5a43964 | Alexander Graf | } |
124 | d5a43964 | Alexander Graf | |
125 | d5a43964 | Alexander Graf | #endif /* CONFIG_USER_ONLY */ |
126 | d5a43964 | Alexander Graf | |
127 | 10ec5117 | Alexander Graf | void cpu_reset(CPUS390XState *env)
|
128 | 10ec5117 | Alexander Graf | { |
129 | 10ec5117 | Alexander Graf | if (qemu_loglevel_mask(CPU_LOG_RESET)) {
|
130 | 10ec5117 | Alexander Graf | qemu_log("CPU Reset (CPU %d)\n", env->cpu_index);
|
131 | 10ec5117 | Alexander Graf | log_cpu_state(env, 0);
|
132 | 10ec5117 | Alexander Graf | } |
133 | 10ec5117 | Alexander Graf | |
134 | 10ec5117 | Alexander Graf | memset(env, 0, offsetof(CPUS390XState, breakpoints));
|
135 | 10ec5117 | Alexander Graf | /* FIXME: reset vector? */
|
136 | 10ec5117 | Alexander Graf | tlb_flush(env, 1);
|
137 | ef81522b | Alexander Graf | s390_add_running_cpu(env); |
138 | 10ec5117 | Alexander Graf | } |
139 | 10c339a0 | Alexander Graf | |
140 | d5a43964 | Alexander Graf | #ifndef CONFIG_USER_ONLY
|
141 | d5a43964 | Alexander Graf | |
142 | d5a43964 | Alexander Graf | /* Ensure to exit the TB after this call! */
|
143 | d5a43964 | Alexander Graf | static void trigger_pgm_exception(CPUState *env, uint32_t code, uint32_t ilc) |
144 | d5a43964 | Alexander Graf | { |
145 | d5a43964 | Alexander Graf | env->exception_index = EXCP_PGM; |
146 | d5a43964 | Alexander Graf | env->int_pgm_code = code; |
147 | d5a43964 | Alexander Graf | env->int_pgm_ilc = ilc; |
148 | d5a43964 | Alexander Graf | } |
149 | d5a43964 | Alexander Graf | |
150 | d5a43964 | Alexander Graf | static int trans_bits(CPUState *env, uint64_t mode) |
151 | d5a43964 | Alexander Graf | { |
152 | d5a43964 | Alexander Graf | int bits = 0; |
153 | d5a43964 | Alexander Graf | |
154 | d5a43964 | Alexander Graf | switch (mode) {
|
155 | d5a43964 | Alexander Graf | case PSW_ASC_PRIMARY:
|
156 | d5a43964 | Alexander Graf | bits = 1;
|
157 | d5a43964 | Alexander Graf | break;
|
158 | d5a43964 | Alexander Graf | case PSW_ASC_SECONDARY:
|
159 | d5a43964 | Alexander Graf | bits = 2;
|
160 | d5a43964 | Alexander Graf | break;
|
161 | d5a43964 | Alexander Graf | case PSW_ASC_HOME:
|
162 | d5a43964 | Alexander Graf | bits = 3;
|
163 | d5a43964 | Alexander Graf | break;
|
164 | d5a43964 | Alexander Graf | default:
|
165 | d5a43964 | Alexander Graf | cpu_abort(env, "unknown asc mode\n");
|
166 | d5a43964 | Alexander Graf | break;
|
167 | d5a43964 | Alexander Graf | } |
168 | d5a43964 | Alexander Graf | |
169 | d5a43964 | Alexander Graf | return bits;
|
170 | d5a43964 | Alexander Graf | } |
171 | d5a43964 | Alexander Graf | |
172 | d5a43964 | Alexander Graf | static void trigger_prot_fault(CPUState *env, target_ulong vaddr, uint64_t mode) |
173 | d5a43964 | Alexander Graf | { |
174 | d5a43964 | Alexander Graf | int ilc = ILC_LATER_INC_2;
|
175 | d5a43964 | Alexander Graf | int bits = trans_bits(env, mode) | 4; |
176 | d5a43964 | Alexander Graf | |
177 | d5a43964 | Alexander Graf | DPRINTF("%s: vaddr=%016" PRIx64 " bits=%d\n", __FUNCTION__, vaddr, bits); |
178 | d5a43964 | Alexander Graf | |
179 | d5a43964 | Alexander Graf | stq_phys(env->psa + offsetof(LowCore, trans_exc_code), vaddr | bits); |
180 | d5a43964 | Alexander Graf | trigger_pgm_exception(env, PGM_PROTECTION, ilc); |
181 | d5a43964 | Alexander Graf | } |
182 | d5a43964 | Alexander Graf | |
183 | d5a43964 | Alexander Graf | static void trigger_page_fault(CPUState *env, target_ulong vaddr, uint32_t type, |
184 | d5a43964 | Alexander Graf | uint64_t asc, int rw)
|
185 | d5a43964 | Alexander Graf | { |
186 | d5a43964 | Alexander Graf | int ilc = ILC_LATER;
|
187 | d5a43964 | Alexander Graf | int bits = trans_bits(env, asc);
|
188 | d5a43964 | Alexander Graf | |
189 | d5a43964 | Alexander Graf | if (rw == 2) { |
190 | d5a43964 | Alexander Graf | /* code has is undefined ilc */
|
191 | d5a43964 | Alexander Graf | ilc = 2;
|
192 | d5a43964 | Alexander Graf | } |
193 | d5a43964 | Alexander Graf | |
194 | d5a43964 | Alexander Graf | DPRINTF("%s: vaddr=%016" PRIx64 " bits=%d\n", __FUNCTION__, vaddr, bits); |
195 | d5a43964 | Alexander Graf | |
196 | d5a43964 | Alexander Graf | stq_phys(env->psa + offsetof(LowCore, trans_exc_code), vaddr | bits); |
197 | d5a43964 | Alexander Graf | trigger_pgm_exception(env, type, ilc); |
198 | d5a43964 | Alexander Graf | } |
199 | d5a43964 | Alexander Graf | |
200 | d5a43964 | Alexander Graf | static int mmu_translate_asce(CPUState *env, target_ulong vaddr, uint64_t asc, |
201 | d5a43964 | Alexander Graf | uint64_t asce, int level, target_ulong *raddr,
|
202 | d5a43964 | Alexander Graf | int *flags, int rw) |
203 | c92114b1 | Alexander Graf | { |
204 | d5a43964 | Alexander Graf | uint64_t offs = 0;
|
205 | d5a43964 | Alexander Graf | uint64_t origin; |
206 | d5a43964 | Alexander Graf | uint64_t new_asce; |
207 | d5a43964 | Alexander Graf | |
208 | d5a43964 | Alexander Graf | PTE_DPRINTF("%s: 0x%" PRIx64 "\n", __FUNCTION__, asce); |
209 | d5a43964 | Alexander Graf | |
210 | d5a43964 | Alexander Graf | if (((level != _ASCE_TYPE_SEGMENT) && (asce & _REGION_ENTRY_INV)) ||
|
211 | d5a43964 | Alexander Graf | ((level == _ASCE_TYPE_SEGMENT) && (asce & _SEGMENT_ENTRY_INV))) { |
212 | d5a43964 | Alexander Graf | /* XXX different regions have different faults */
|
213 | d5a43964 | Alexander Graf | DPRINTF("%s: invalid region\n", __FUNCTION__);
|
214 | d5a43964 | Alexander Graf | trigger_page_fault(env, vaddr, PGM_SEGMENT_TRANS, asc, rw); |
215 | d5a43964 | Alexander Graf | return -1; |
216 | d5a43964 | Alexander Graf | } |
217 | d5a43964 | Alexander Graf | |
218 | d5a43964 | Alexander Graf | if ((level <= _ASCE_TYPE_MASK) && ((asce & _ASCE_TYPE_MASK) != level)) {
|
219 | d5a43964 | Alexander Graf | trigger_page_fault(env, vaddr, PGM_TRANS_SPEC, asc, rw); |
220 | d5a43964 | Alexander Graf | return -1; |
221 | d5a43964 | Alexander Graf | } |
222 | d5a43964 | Alexander Graf | |
223 | d5a43964 | Alexander Graf | if (asce & _ASCE_REAL_SPACE) {
|
224 | d5a43964 | Alexander Graf | /* direct mapping */
|
225 | d5a43964 | Alexander Graf | |
226 | d5a43964 | Alexander Graf | *raddr = vaddr; |
227 | d5a43964 | Alexander Graf | return 0; |
228 | d5a43964 | Alexander Graf | } |
229 | d5a43964 | Alexander Graf | |
230 | d5a43964 | Alexander Graf | origin = asce & _ASCE_ORIGIN; |
231 | d5a43964 | Alexander Graf | |
232 | d5a43964 | Alexander Graf | switch (level) {
|
233 | d5a43964 | Alexander Graf | case _ASCE_TYPE_REGION1 + 4: |
234 | d5a43964 | Alexander Graf | offs = (vaddr >> 50) & 0x3ff8; |
235 | d5a43964 | Alexander Graf | break;
|
236 | d5a43964 | Alexander Graf | case _ASCE_TYPE_REGION1:
|
237 | d5a43964 | Alexander Graf | offs = (vaddr >> 39) & 0x3ff8; |
238 | d5a43964 | Alexander Graf | break;
|
239 | d5a43964 | Alexander Graf | case _ASCE_TYPE_REGION2:
|
240 | d5a43964 | Alexander Graf | offs = (vaddr >> 28) & 0x3ff8; |
241 | d5a43964 | Alexander Graf | break;
|
242 | d5a43964 | Alexander Graf | case _ASCE_TYPE_REGION3:
|
243 | d5a43964 | Alexander Graf | offs = (vaddr >> 17) & 0x3ff8; |
244 | d5a43964 | Alexander Graf | break;
|
245 | d5a43964 | Alexander Graf | case _ASCE_TYPE_SEGMENT:
|
246 | d5a43964 | Alexander Graf | offs = (vaddr >> 9) & 0x07f8; |
247 | d5a43964 | Alexander Graf | origin = asce & _SEGMENT_ENTRY_ORIGIN; |
248 | d5a43964 | Alexander Graf | break;
|
249 | d5a43964 | Alexander Graf | } |
250 | d5a43964 | Alexander Graf | |
251 | d5a43964 | Alexander Graf | /* XXX region protection flags */
|
252 | d5a43964 | Alexander Graf | /* *flags &= ~PAGE_WRITE */
|
253 | d5a43964 | Alexander Graf | |
254 | d5a43964 | Alexander Graf | new_asce = ldq_phys(origin + offs); |
255 | d5a43964 | Alexander Graf | PTE_DPRINTF("%s: 0x%" PRIx64 " + 0x%" PRIx64 " => 0x%016" PRIx64 "\n", |
256 | d5a43964 | Alexander Graf | __FUNCTION__, origin, offs, new_asce); |
257 | d5a43964 | Alexander Graf | |
258 | d5a43964 | Alexander Graf | if (level != _ASCE_TYPE_SEGMENT) {
|
259 | d5a43964 | Alexander Graf | /* yet another region */
|
260 | d5a43964 | Alexander Graf | return mmu_translate_asce(env, vaddr, asc, new_asce, level - 4, raddr, |
261 | d5a43964 | Alexander Graf | flags, rw); |
262 | d5a43964 | Alexander Graf | } |
263 | d5a43964 | Alexander Graf | |
264 | d5a43964 | Alexander Graf | /* PTE */
|
265 | d5a43964 | Alexander Graf | if (new_asce & _PAGE_INVALID) {
|
266 | d5a43964 | Alexander Graf | DPRINTF("%s: PTE=0x%" PRIx64 " invalid\n", __FUNCTION__, new_asce); |
267 | d5a43964 | Alexander Graf | trigger_page_fault(env, vaddr, PGM_PAGE_TRANS, asc, rw); |
268 | d5a43964 | Alexander Graf | return -1; |
269 | d5a43964 | Alexander Graf | } |
270 | d5a43964 | Alexander Graf | |
271 | d5a43964 | Alexander Graf | if (new_asce & _PAGE_RO) {
|
272 | d5a43964 | Alexander Graf | *flags &= ~PAGE_WRITE; |
273 | d5a43964 | Alexander Graf | } |
274 | d5a43964 | Alexander Graf | |
275 | d5a43964 | Alexander Graf | *raddr = new_asce & _ASCE_ORIGIN; |
276 | d5a43964 | Alexander Graf | |
277 | d5a43964 | Alexander Graf | PTE_DPRINTF("%s: PTE=0x%" PRIx64 "\n", __FUNCTION__, new_asce); |
278 | d5a43964 | Alexander Graf | |
279 | c92114b1 | Alexander Graf | return 0; |
280 | c92114b1 | Alexander Graf | } |
281 | c92114b1 | Alexander Graf | |
282 | d5a43964 | Alexander Graf | static int mmu_translate_asc(CPUState *env, target_ulong vaddr, uint64_t asc, |
283 | d5a43964 | Alexander Graf | target_ulong *raddr, int *flags, int rw) |
284 | d5a43964 | Alexander Graf | { |
285 | d5a43964 | Alexander Graf | uint64_t asce = 0;
|
286 | d5a43964 | Alexander Graf | int level, new_level;
|
287 | d5a43964 | Alexander Graf | int r;
|
288 | 10c339a0 | Alexander Graf | |
289 | d5a43964 | Alexander Graf | switch (asc) {
|
290 | d5a43964 | Alexander Graf | case PSW_ASC_PRIMARY:
|
291 | d5a43964 | Alexander Graf | PTE_DPRINTF("%s: asc=primary\n", __FUNCTION__);
|
292 | d5a43964 | Alexander Graf | asce = env->cregs[1];
|
293 | d5a43964 | Alexander Graf | break;
|
294 | d5a43964 | Alexander Graf | case PSW_ASC_SECONDARY:
|
295 | d5a43964 | Alexander Graf | PTE_DPRINTF("%s: asc=secondary\n", __FUNCTION__);
|
296 | d5a43964 | Alexander Graf | asce = env->cregs[7];
|
297 | d5a43964 | Alexander Graf | break;
|
298 | d5a43964 | Alexander Graf | case PSW_ASC_HOME:
|
299 | d5a43964 | Alexander Graf | PTE_DPRINTF("%s: asc=home\n", __FUNCTION__);
|
300 | d5a43964 | Alexander Graf | asce = env->cregs[13];
|
301 | d5a43964 | Alexander Graf | break;
|
302 | d5a43964 | Alexander Graf | } |
303 | d5a43964 | Alexander Graf | |
304 | d5a43964 | Alexander Graf | switch (asce & _ASCE_TYPE_MASK) {
|
305 | d5a43964 | Alexander Graf | case _ASCE_TYPE_REGION1:
|
306 | d5a43964 | Alexander Graf | break;
|
307 | d5a43964 | Alexander Graf | case _ASCE_TYPE_REGION2:
|
308 | d5a43964 | Alexander Graf | if (vaddr & 0xffe0000000000000ULL) { |
309 | d5a43964 | Alexander Graf | DPRINTF("%s: vaddr doesn't fit 0x%16" PRIx64
|
310 | d5a43964 | Alexander Graf | " 0xffe0000000000000ULL\n", __FUNCTION__,
|
311 | d5a43964 | Alexander Graf | vaddr); |
312 | d5a43964 | Alexander Graf | trigger_page_fault(env, vaddr, PGM_TRANS_SPEC, asc, rw); |
313 | d5a43964 | Alexander Graf | return -1; |
314 | d5a43964 | Alexander Graf | } |
315 | d5a43964 | Alexander Graf | break;
|
316 | d5a43964 | Alexander Graf | case _ASCE_TYPE_REGION3:
|
317 | d5a43964 | Alexander Graf | if (vaddr & 0xfffffc0000000000ULL) { |
318 | d5a43964 | Alexander Graf | DPRINTF("%s: vaddr doesn't fit 0x%16" PRIx64
|
319 | d5a43964 | Alexander Graf | " 0xfffffc0000000000ULL\n", __FUNCTION__,
|
320 | d5a43964 | Alexander Graf | vaddr); |
321 | d5a43964 | Alexander Graf | trigger_page_fault(env, vaddr, PGM_TRANS_SPEC, asc, rw); |
322 | d5a43964 | Alexander Graf | return -1; |
323 | d5a43964 | Alexander Graf | } |
324 | d5a43964 | Alexander Graf | break;
|
325 | d5a43964 | Alexander Graf | case _ASCE_TYPE_SEGMENT:
|
326 | d5a43964 | Alexander Graf | if (vaddr & 0xffffffff80000000ULL) { |
327 | d5a43964 | Alexander Graf | DPRINTF("%s: vaddr doesn't fit 0x%16" PRIx64
|
328 | d5a43964 | Alexander Graf | " 0xffffffff80000000ULL\n", __FUNCTION__,
|
329 | d5a43964 | Alexander Graf | vaddr); |
330 | d5a43964 | Alexander Graf | trigger_page_fault(env, vaddr, PGM_TRANS_SPEC, asc, rw); |
331 | d5a43964 | Alexander Graf | return -1; |
332 | d5a43964 | Alexander Graf | } |
333 | d5a43964 | Alexander Graf | break;
|
334 | d5a43964 | Alexander Graf | } |
335 | d5a43964 | Alexander Graf | |
336 | d5a43964 | Alexander Graf | /* fake level above current */
|
337 | d5a43964 | Alexander Graf | level = asce & _ASCE_TYPE_MASK; |
338 | d5a43964 | Alexander Graf | new_level = level + 4;
|
339 | d5a43964 | Alexander Graf | asce = (asce & ~_ASCE_TYPE_MASK) | (new_level & _ASCE_TYPE_MASK); |
340 | d5a43964 | Alexander Graf | |
341 | d5a43964 | Alexander Graf | r = mmu_translate_asce(env, vaddr, asc, asce, new_level, raddr, flags, rw); |
342 | d5a43964 | Alexander Graf | |
343 | d5a43964 | Alexander Graf | if ((rw == 1) && !(*flags & PAGE_WRITE)) { |
344 | d5a43964 | Alexander Graf | trigger_prot_fault(env, vaddr, asc); |
345 | d5a43964 | Alexander Graf | return -1; |
346 | d5a43964 | Alexander Graf | } |
347 | d5a43964 | Alexander Graf | |
348 | d5a43964 | Alexander Graf | return r;
|
349 | d5a43964 | Alexander Graf | } |
350 | d5a43964 | Alexander Graf | |
351 | d5a43964 | Alexander Graf | int mmu_translate(CPUState *env, target_ulong vaddr, int rw, uint64_t asc, |
352 | d5a43964 | Alexander Graf | target_ulong *raddr, int *flags)
|
353 | d5a43964 | Alexander Graf | { |
354 | d5a43964 | Alexander Graf | int r = -1; |
355 | b9959138 | Alexander Graf | uint8_t *sk; |
356 | d5a43964 | Alexander Graf | |
357 | d5a43964 | Alexander Graf | *flags = PAGE_READ | PAGE_WRITE | PAGE_EXEC; |
358 | d5a43964 | Alexander Graf | vaddr &= TARGET_PAGE_MASK; |
359 | d5a43964 | Alexander Graf | |
360 | d5a43964 | Alexander Graf | if (!(env->psw.mask & PSW_MASK_DAT)) {
|
361 | d5a43964 | Alexander Graf | *raddr = vaddr; |
362 | d5a43964 | Alexander Graf | r = 0;
|
363 | d5a43964 | Alexander Graf | goto out;
|
364 | d5a43964 | Alexander Graf | } |
365 | d5a43964 | Alexander Graf | |
366 | d5a43964 | Alexander Graf | switch (asc) {
|
367 | d5a43964 | Alexander Graf | case PSW_ASC_PRIMARY:
|
368 | d5a43964 | Alexander Graf | case PSW_ASC_HOME:
|
369 | d5a43964 | Alexander Graf | r = mmu_translate_asc(env, vaddr, asc, raddr, flags, rw); |
370 | d5a43964 | Alexander Graf | break;
|
371 | d5a43964 | Alexander Graf | case PSW_ASC_SECONDARY:
|
372 | d5a43964 | Alexander Graf | /*
|
373 | d5a43964 | Alexander Graf | * Instruction: Primary
|
374 | d5a43964 | Alexander Graf | * Data: Secondary
|
375 | d5a43964 | Alexander Graf | */
|
376 | d5a43964 | Alexander Graf | if (rw == 2) { |
377 | d5a43964 | Alexander Graf | r = mmu_translate_asc(env, vaddr, PSW_ASC_PRIMARY, raddr, flags, |
378 | d5a43964 | Alexander Graf | rw); |
379 | d5a43964 | Alexander Graf | *flags &= ~(PAGE_READ | PAGE_WRITE); |
380 | d5a43964 | Alexander Graf | } else {
|
381 | d5a43964 | Alexander Graf | r = mmu_translate_asc(env, vaddr, PSW_ASC_SECONDARY, raddr, flags, |
382 | d5a43964 | Alexander Graf | rw); |
383 | d5a43964 | Alexander Graf | *flags &= ~(PAGE_EXEC); |
384 | d5a43964 | Alexander Graf | } |
385 | d5a43964 | Alexander Graf | break;
|
386 | d5a43964 | Alexander Graf | case PSW_ASC_ACCREG:
|
387 | d5a43964 | Alexander Graf | default:
|
388 | d5a43964 | Alexander Graf | hw_error("guest switched to unknown asc mode\n");
|
389 | d5a43964 | Alexander Graf | break;
|
390 | d5a43964 | Alexander Graf | } |
391 | d5a43964 | Alexander Graf | |
392 | d5a43964 | Alexander Graf | out:
|
393 | d5a43964 | Alexander Graf | /* Convert real address -> absolute address */
|
394 | d5a43964 | Alexander Graf | if (*raddr < 0x2000) { |
395 | d5a43964 | Alexander Graf | *raddr = *raddr + env->psa; |
396 | d5a43964 | Alexander Graf | } |
397 | d5a43964 | Alexander Graf | |
398 | b9959138 | Alexander Graf | if (*raddr <= ram_size) {
|
399 | b9959138 | Alexander Graf | sk = &env->storage_keys[*raddr / TARGET_PAGE_SIZE]; |
400 | b9959138 | Alexander Graf | if (*flags & PAGE_READ) {
|
401 | b9959138 | Alexander Graf | *sk |= SK_R; |
402 | b9959138 | Alexander Graf | } |
403 | b9959138 | Alexander Graf | |
404 | b9959138 | Alexander Graf | if (*flags & PAGE_WRITE) {
|
405 | b9959138 | Alexander Graf | *sk |= SK_C; |
406 | b9959138 | Alexander Graf | } |
407 | b9959138 | Alexander Graf | } |
408 | b9959138 | Alexander Graf | |
409 | d5a43964 | Alexander Graf | return r;
|
410 | d5a43964 | Alexander Graf | } |
411 | d5a43964 | Alexander Graf | |
412 | d5a43964 | Alexander Graf | int cpu_s390x_handle_mmu_fault (CPUState *env, target_ulong _vaddr, int rw, |
413 | 97b348e7 | Blue Swirl | int mmu_idx)
|
414 | 10c339a0 | Alexander Graf | { |
415 | d5a43964 | Alexander Graf | uint64_t asc = env->psw.mask & PSW_MASK_ASC; |
416 | d5a43964 | Alexander Graf | target_ulong vaddr, raddr; |
417 | 10c339a0 | Alexander Graf | int prot;
|
418 | 10c339a0 | Alexander Graf | |
419 | 97b348e7 | Blue Swirl | DPRINTF("%s: address 0x%" PRIx64 " rw %d mmu_idx %d\n", |
420 | 97b348e7 | Blue Swirl | __FUNCTION__, _vaddr, rw, mmu_idx); |
421 | d5a43964 | Alexander Graf | |
422 | d5a43964 | Alexander Graf | _vaddr &= TARGET_PAGE_MASK; |
423 | d5a43964 | Alexander Graf | vaddr = _vaddr; |
424 | d5a43964 | Alexander Graf | |
425 | d5a43964 | Alexander Graf | /* 31-Bit mode */
|
426 | d5a43964 | Alexander Graf | if (!(env->psw.mask & PSW_MASK_64)) {
|
427 | d5a43964 | Alexander Graf | vaddr &= 0x7fffffff;
|
428 | d5a43964 | Alexander Graf | } |
429 | d5a43964 | Alexander Graf | |
430 | d5a43964 | Alexander Graf | if (mmu_translate(env, vaddr, rw, asc, &raddr, &prot)) {
|
431 | d5a43964 | Alexander Graf | /* Translation ended in exception */
|
432 | d5a43964 | Alexander Graf | return 1; |
433 | d5a43964 | Alexander Graf | } |
434 | 10c339a0 | Alexander Graf | |
435 | d5a43964 | Alexander Graf | /* check out of RAM access */
|
436 | d5a43964 | Alexander Graf | if (raddr > (ram_size + virtio_size)) {
|
437 | d5a43964 | Alexander Graf | DPRINTF("%s: aaddr %" PRIx64 " > ram_size %" PRIx64 "\n", __FUNCTION__, |
438 | d5a43964 | Alexander Graf | (uint64_t)aaddr, (uint64_t)ram_size); |
439 | d5a43964 | Alexander Graf | trigger_pgm_exception(env, PGM_ADDRESSING, ILC_LATER); |
440 | d5a43964 | Alexander Graf | return 1; |
441 | d5a43964 | Alexander Graf | } |
442 | 10c339a0 | Alexander Graf | |
443 | d5a43964 | Alexander Graf | DPRINTF("%s: set tlb %" PRIx64 " -> %" PRIx64 " (%x)\n", __FUNCTION__, |
444 | d5a43964 | Alexander Graf | (uint64_t)vaddr, (uint64_t)raddr, prot); |
445 | d5a43964 | Alexander Graf | |
446 | d5a43964 | Alexander Graf | tlb_set_page(env, _vaddr, raddr, prot, |
447 | d4c430a8 | Paul Brook | mmu_idx, TARGET_PAGE_SIZE); |
448 | d5a43964 | Alexander Graf | |
449 | d4c430a8 | Paul Brook | return 0; |
450 | 10c339a0 | Alexander Graf | } |
451 | d5a43964 | Alexander Graf | |
452 | d5a43964 | Alexander Graf | target_phys_addr_t cpu_get_phys_page_debug(CPUState *env, target_ulong vaddr) |
453 | d5a43964 | Alexander Graf | { |
454 | d5a43964 | Alexander Graf | target_ulong raddr; |
455 | d5a43964 | Alexander Graf | int prot = PAGE_READ | PAGE_WRITE | PAGE_EXEC;
|
456 | d5a43964 | Alexander Graf | int old_exc = env->exception_index;
|
457 | d5a43964 | Alexander Graf | uint64_t asc = env->psw.mask & PSW_MASK_ASC; |
458 | d5a43964 | Alexander Graf | |
459 | d5a43964 | Alexander Graf | /* 31-Bit mode */
|
460 | d5a43964 | Alexander Graf | if (!(env->psw.mask & PSW_MASK_64)) {
|
461 | d5a43964 | Alexander Graf | vaddr &= 0x7fffffff;
|
462 | d5a43964 | Alexander Graf | } |
463 | d5a43964 | Alexander Graf | |
464 | d5a43964 | Alexander Graf | mmu_translate(env, vaddr, 2, asc, &raddr, &prot);
|
465 | d5a43964 | Alexander Graf | env->exception_index = old_exc; |
466 | d5a43964 | Alexander Graf | |
467 | d5a43964 | Alexander Graf | return raddr;
|
468 | d5a43964 | Alexander Graf | } |
469 | d5a43964 | Alexander Graf | |
470 | d5a43964 | Alexander Graf | void load_psw(CPUState *env, uint64_t mask, uint64_t addr)
|
471 | d5a43964 | Alexander Graf | { |
472 | d5a43964 | Alexander Graf | if (mask & PSW_MASK_WAIT) {
|
473 | d5a43964 | Alexander Graf | if (!(mask & (PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK))) {
|
474 | ef81522b | Alexander Graf | if (s390_del_running_cpu(env) == 0) { |
475 | ef81522b | Alexander Graf | #ifndef CONFIG_USER_ONLY
|
476 | ef81522b | Alexander Graf | qemu_system_shutdown_request(); |
477 | ef81522b | Alexander Graf | #endif
|
478 | ef81522b | Alexander Graf | } |
479 | d5a43964 | Alexander Graf | } |
480 | ef81522b | Alexander Graf | env->halted = 1;
|
481 | ef81522b | Alexander Graf | env->exception_index = EXCP_HLT; |
482 | d5a43964 | Alexander Graf | } |
483 | d5a43964 | Alexander Graf | |
484 | d5a43964 | Alexander Graf | env->psw.addr = addr; |
485 | d5a43964 | Alexander Graf | env->psw.mask = mask; |
486 | d5a43964 | Alexander Graf | env->cc_op = (mask >> 13) & 3; |
487 | d5a43964 | Alexander Graf | } |
488 | d5a43964 | Alexander Graf | |
489 | d5a43964 | Alexander Graf | static uint64_t get_psw_mask(CPUState *env)
|
490 | d5a43964 | Alexander Graf | { |
491 | d5a43964 | Alexander Graf | uint64_t r = env->psw.mask; |
492 | d5a43964 | Alexander Graf | |
493 | d5a43964 | Alexander Graf | env->cc_op = calc_cc(env, env->cc_op, env->cc_src, env->cc_dst, env->cc_vr); |
494 | d5a43964 | Alexander Graf | |
495 | d5a43964 | Alexander Graf | r &= ~(3ULL << 13); |
496 | d5a43964 | Alexander Graf | assert(!(env->cc_op & ~3));
|
497 | d5a43964 | Alexander Graf | r |= env->cc_op << 13;
|
498 | d5a43964 | Alexander Graf | |
499 | d5a43964 | Alexander Graf | return r;
|
500 | d5a43964 | Alexander Graf | } |
501 | d5a43964 | Alexander Graf | |
502 | d5a43964 | Alexander Graf | static void do_svc_interrupt(CPUState *env) |
503 | d5a43964 | Alexander Graf | { |
504 | d5a43964 | Alexander Graf | uint64_t mask, addr; |
505 | d5a43964 | Alexander Graf | LowCore *lowcore; |
506 | d5a43964 | Alexander Graf | target_phys_addr_t len = TARGET_PAGE_SIZE; |
507 | d5a43964 | Alexander Graf | |
508 | d5a43964 | Alexander Graf | lowcore = cpu_physical_memory_map(env->psa, &len, 1);
|
509 | d5a43964 | Alexander Graf | |
510 | d5a43964 | Alexander Graf | lowcore->svc_code = cpu_to_be16(env->int_svc_code); |
511 | d5a43964 | Alexander Graf | lowcore->svc_ilc = cpu_to_be16(env->int_svc_ilc); |
512 | d5a43964 | Alexander Graf | lowcore->svc_old_psw.mask = cpu_to_be64(get_psw_mask(env)); |
513 | d5a43964 | Alexander Graf | lowcore->svc_old_psw.addr = cpu_to_be64(env->psw.addr + (env->int_svc_ilc)); |
514 | d5a43964 | Alexander Graf | mask = be64_to_cpu(lowcore->svc_new_psw.mask); |
515 | d5a43964 | Alexander Graf | addr = be64_to_cpu(lowcore->svc_new_psw.addr); |
516 | d5a43964 | Alexander Graf | |
517 | d5a43964 | Alexander Graf | cpu_physical_memory_unmap(lowcore, len, 1, len);
|
518 | d5a43964 | Alexander Graf | |
519 | d5a43964 | Alexander Graf | load_psw(env, mask, addr); |
520 | d5a43964 | Alexander Graf | } |
521 | d5a43964 | Alexander Graf | |
522 | d5a43964 | Alexander Graf | static void do_program_interrupt(CPUState *env) |
523 | d5a43964 | Alexander Graf | { |
524 | d5a43964 | Alexander Graf | uint64_t mask, addr; |
525 | d5a43964 | Alexander Graf | LowCore *lowcore; |
526 | d5a43964 | Alexander Graf | target_phys_addr_t len = TARGET_PAGE_SIZE; |
527 | d5a43964 | Alexander Graf | int ilc = env->int_pgm_ilc;
|
528 | d5a43964 | Alexander Graf | |
529 | d5a43964 | Alexander Graf | switch (ilc) {
|
530 | d5a43964 | Alexander Graf | case ILC_LATER:
|
531 | d5a43964 | Alexander Graf | ilc = get_ilc(ldub_code(env->psw.addr)); |
532 | d5a43964 | Alexander Graf | break;
|
533 | d5a43964 | Alexander Graf | case ILC_LATER_INC:
|
534 | d5a43964 | Alexander Graf | ilc = get_ilc(ldub_code(env->psw.addr)); |
535 | d5a43964 | Alexander Graf | env->psw.addr += ilc * 2;
|
536 | d5a43964 | Alexander Graf | break;
|
537 | d5a43964 | Alexander Graf | case ILC_LATER_INC_2:
|
538 | d5a43964 | Alexander Graf | ilc = get_ilc(ldub_code(env->psw.addr)) * 2;
|
539 | d5a43964 | Alexander Graf | env->psw.addr += ilc; |
540 | d5a43964 | Alexander Graf | break;
|
541 | d5a43964 | Alexander Graf | } |
542 | d5a43964 | Alexander Graf | |
543 | d5a43964 | Alexander Graf | qemu_log("%s: code=0x%x ilc=%d\n", __FUNCTION__, env->int_pgm_code, ilc);
|
544 | d5a43964 | Alexander Graf | |
545 | d5a43964 | Alexander Graf | lowcore = cpu_physical_memory_map(env->psa, &len, 1);
|
546 | d5a43964 | Alexander Graf | |
547 | d5a43964 | Alexander Graf | lowcore->pgm_ilc = cpu_to_be16(ilc); |
548 | d5a43964 | Alexander Graf | lowcore->pgm_code = cpu_to_be16(env->int_pgm_code); |
549 | d5a43964 | Alexander Graf | lowcore->program_old_psw.mask = cpu_to_be64(get_psw_mask(env)); |
550 | d5a43964 | Alexander Graf | lowcore->program_old_psw.addr = cpu_to_be64(env->psw.addr); |
551 | d5a43964 | Alexander Graf | mask = be64_to_cpu(lowcore->program_new_psw.mask); |
552 | d5a43964 | Alexander Graf | addr = be64_to_cpu(lowcore->program_new_psw.addr); |
553 | d5a43964 | Alexander Graf | |
554 | d5a43964 | Alexander Graf | cpu_physical_memory_unmap(lowcore, len, 1, len);
|
555 | d5a43964 | Alexander Graf | |
556 | d5a43964 | Alexander Graf | DPRINTF("%s: %x %x %" PRIx64 " %" PRIx64 "\n", __FUNCTION__, |
557 | d5a43964 | Alexander Graf | env->int_pgm_code, ilc, env->psw.mask, |
558 | d5a43964 | Alexander Graf | env->psw.addr); |
559 | d5a43964 | Alexander Graf | |
560 | d5a43964 | Alexander Graf | load_psw(env, mask, addr); |
561 | d5a43964 | Alexander Graf | } |
562 | d5a43964 | Alexander Graf | |
563 | d5a43964 | Alexander Graf | #define VIRTIO_SUBCODE_64 0x0D00 |
564 | d5a43964 | Alexander Graf | |
565 | d5a43964 | Alexander Graf | static void do_ext_interrupt(CPUState *env) |
566 | d5a43964 | Alexander Graf | { |
567 | d5a43964 | Alexander Graf | uint64_t mask, addr; |
568 | d5a43964 | Alexander Graf | LowCore *lowcore; |
569 | d5a43964 | Alexander Graf | target_phys_addr_t len = TARGET_PAGE_SIZE; |
570 | d5a43964 | Alexander Graf | ExtQueue *q; |
571 | d5a43964 | Alexander Graf | |
572 | d5a43964 | Alexander Graf | if (!(env->psw.mask & PSW_MASK_EXT)) {
|
573 | d5a43964 | Alexander Graf | cpu_abort(env, "Ext int w/o ext mask\n");
|
574 | d5a43964 | Alexander Graf | } |
575 | d5a43964 | Alexander Graf | |
576 | d5a43964 | Alexander Graf | if (env->ext_index < 0 || env->ext_index > MAX_EXT_QUEUE) { |
577 | d5a43964 | Alexander Graf | cpu_abort(env, "Ext queue overrun: %d\n", env->ext_index);
|
578 | d5a43964 | Alexander Graf | } |
579 | d5a43964 | Alexander Graf | |
580 | d5a43964 | Alexander Graf | q = &env->ext_queue[env->ext_index]; |
581 | d5a43964 | Alexander Graf | lowcore = cpu_physical_memory_map(env->psa, &len, 1);
|
582 | d5a43964 | Alexander Graf | |
583 | d5a43964 | Alexander Graf | lowcore->ext_int_code = cpu_to_be16(q->code); |
584 | d5a43964 | Alexander Graf | lowcore->ext_params = cpu_to_be32(q->param); |
585 | d5a43964 | Alexander Graf | lowcore->ext_params2 = cpu_to_be64(q->param64); |
586 | d5a43964 | Alexander Graf | lowcore->external_old_psw.mask = cpu_to_be64(get_psw_mask(env)); |
587 | d5a43964 | Alexander Graf | lowcore->external_old_psw.addr = cpu_to_be64(env->psw.addr); |
588 | d5a43964 | Alexander Graf | lowcore->cpu_addr = cpu_to_be16(env->cpu_num | VIRTIO_SUBCODE_64); |
589 | d5a43964 | Alexander Graf | mask = be64_to_cpu(lowcore->external_new_psw.mask); |
590 | d5a43964 | Alexander Graf | addr = be64_to_cpu(lowcore->external_new_psw.addr); |
591 | d5a43964 | Alexander Graf | |
592 | d5a43964 | Alexander Graf | cpu_physical_memory_unmap(lowcore, len, 1, len);
|
593 | d5a43964 | Alexander Graf | |
594 | d5a43964 | Alexander Graf | env->ext_index--; |
595 | d5a43964 | Alexander Graf | if (env->ext_index == -1) { |
596 | d5a43964 | Alexander Graf | env->pending_int &= ~INTERRUPT_EXT; |
597 | d5a43964 | Alexander Graf | } |
598 | d5a43964 | Alexander Graf | |
599 | d5a43964 | Alexander Graf | DPRINTF("%s: %" PRIx64 " %" PRIx64 "\n", __FUNCTION__, |
600 | d5a43964 | Alexander Graf | env->psw.mask, env->psw.addr); |
601 | d5a43964 | Alexander Graf | |
602 | d5a43964 | Alexander Graf | load_psw(env, mask, addr); |
603 | d5a43964 | Alexander Graf | } |
604 | 3110e292 | Alexander Graf | |
605 | 3110e292 | Alexander Graf | void do_interrupt (CPUState *env)
|
606 | 3110e292 | Alexander Graf | { |
607 | d5a43964 | Alexander Graf | qemu_log("%s: %d at pc=%" PRIx64 "\n", __FUNCTION__, env->exception_index, |
608 | d5a43964 | Alexander Graf | env->psw.addr); |
609 | d5a43964 | Alexander Graf | |
610 | ef81522b | Alexander Graf | s390_add_running_cpu(env); |
611 | d5a43964 | Alexander Graf | /* handle external interrupts */
|
612 | d5a43964 | Alexander Graf | if ((env->psw.mask & PSW_MASK_EXT) &&
|
613 | d5a43964 | Alexander Graf | env->exception_index == -1) {
|
614 | d5a43964 | Alexander Graf | if (env->pending_int & INTERRUPT_EXT) {
|
615 | d5a43964 | Alexander Graf | /* code is already in env */
|
616 | d5a43964 | Alexander Graf | env->exception_index = EXCP_EXT; |
617 | d5a43964 | Alexander Graf | } else if (env->pending_int & INTERRUPT_TOD) { |
618 | d5a43964 | Alexander Graf | cpu_inject_ext(env, 0x1004, 0, 0); |
619 | d5a43964 | Alexander Graf | env->exception_index = EXCP_EXT; |
620 | d5a43964 | Alexander Graf | env->pending_int &= ~INTERRUPT_EXT; |
621 | d5a43964 | Alexander Graf | env->pending_int &= ~INTERRUPT_TOD; |
622 | d5a43964 | Alexander Graf | } else if (env->pending_int & INTERRUPT_CPUTIMER) { |
623 | d5a43964 | Alexander Graf | cpu_inject_ext(env, 0x1005, 0, 0); |
624 | d5a43964 | Alexander Graf | env->exception_index = EXCP_EXT; |
625 | d5a43964 | Alexander Graf | env->pending_int &= ~INTERRUPT_EXT; |
626 | d5a43964 | Alexander Graf | env->pending_int &= ~INTERRUPT_TOD; |
627 | d5a43964 | Alexander Graf | } |
628 | d5a43964 | Alexander Graf | } |
629 | d5a43964 | Alexander Graf | |
630 | d5a43964 | Alexander Graf | switch (env->exception_index) {
|
631 | d5a43964 | Alexander Graf | case EXCP_PGM:
|
632 | d5a43964 | Alexander Graf | do_program_interrupt(env); |
633 | d5a43964 | Alexander Graf | break;
|
634 | d5a43964 | Alexander Graf | case EXCP_SVC:
|
635 | d5a43964 | Alexander Graf | do_svc_interrupt(env); |
636 | d5a43964 | Alexander Graf | break;
|
637 | d5a43964 | Alexander Graf | case EXCP_EXT:
|
638 | d5a43964 | Alexander Graf | do_ext_interrupt(env); |
639 | d5a43964 | Alexander Graf | break;
|
640 | d5a43964 | Alexander Graf | } |
641 | d5a43964 | Alexander Graf | env->exception_index = -1;
|
642 | d5a43964 | Alexander Graf | |
643 | d5a43964 | Alexander Graf | if (!env->pending_int) {
|
644 | d5a43964 | Alexander Graf | env->interrupt_request &= ~CPU_INTERRUPT_HARD; |
645 | d5a43964 | Alexander Graf | } |
646 | 3110e292 | Alexander Graf | } |
647 | d5a43964 | Alexander Graf | |
648 | d5a43964 | Alexander Graf | #endif /* CONFIG_USER_ONLY */ |