1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include "qemu/osdep.h"
22#include "cpu.h"
23#include "exec/exec-all.h"
24#include "exec/helper-proto.h"
25#include "exception.h"
26#include "sysemu/sysemu.h"
27#ifndef CONFIG_USER_ONLY
28#include "hw/boards.h"
29#endif
30
31#define TO_SPR(group, number) (((group) << 11) + (number))
32
33void HELPER(mtspr)(CPUOpenRISCState *env, target_ulong spr, target_ulong rb)
34{
35#ifndef CONFIG_USER_ONLY
36 OpenRISCCPU *cpu = env_archcpu(env);
37 CPUState *cs = env_cpu(env);
38 target_ulong mr;
39 int idx;
40#endif
41
42 switch (spr) {
43#ifndef CONFIG_USER_ONLY
44 case TO_SPR(0, 11):
45 env->evbar = rb;
46 break;
47
48 case TO_SPR(0, 16):
49 cpu_restore_state(cs, GETPC(), true);
50
51
52 if (env->pc != rb) {
53 env->pc = rb;
54 env->dflag = 0;
55 cpu_loop_exit(cs);
56 }
57 break;
58
59 case TO_SPR(0, 17):
60 cpu_set_sr(env, rb);
61 break;
62
63 case TO_SPR(0, 32):
64 env->epcr = rb;
65 break;
66
67 case TO_SPR(0, 48):
68 env->eear = rb;
69 break;
70
71 case TO_SPR(0, 64):
72 env->esr = rb;
73 break;
74
75 case TO_SPR(0, 1024) ... TO_SPR(0, 1024 + (16 * 32)):
76 idx = (spr - 1024);
77 env->shadow_gpr[idx / 32][idx % 32] = rb;
78 break;
79
80 case TO_SPR(1, 512) ... TO_SPR(1, 512 + TLB_SIZE - 1):
81 idx = spr - TO_SPR(1, 512);
82 mr = env->tlb.dtlb[idx].mr;
83 if (mr & 1) {
84 tlb_flush_page(cs, mr & TARGET_PAGE_MASK);
85 }
86 if (rb & 1) {
87 tlb_flush_page(cs, rb & TARGET_PAGE_MASK);
88 }
89 env->tlb.dtlb[idx].mr = rb;
90 break;
91 case TO_SPR(1, 640) ... TO_SPR(1, 640 + TLB_SIZE - 1):
92 idx = spr - TO_SPR(1, 640);
93 env->tlb.dtlb[idx].tr = rb;
94 break;
95 case TO_SPR(1, 768) ... TO_SPR(1, 895):
96 case TO_SPR(1, 896) ... TO_SPR(1, 1023):
97 case TO_SPR(1, 1024) ... TO_SPR(1, 1151):
98 case TO_SPR(1, 1152) ... TO_SPR(1, 1279):
99 case TO_SPR(1, 1280) ... TO_SPR(1, 1407):
100 case TO_SPR(1, 1408) ... TO_SPR(1, 1535):
101 break;
102
103 case TO_SPR(2, 512) ... TO_SPR(2, 512 + TLB_SIZE - 1):
104 idx = spr - TO_SPR(2, 512);
105 mr = env->tlb.itlb[idx].mr;
106 if (mr & 1) {
107 tlb_flush_page(cs, mr & TARGET_PAGE_MASK);
108 }
109 if (rb & 1) {
110 tlb_flush_page(cs, rb & TARGET_PAGE_MASK);
111 }
112 env->tlb.itlb[idx].mr = rb;
113 break;
114 case TO_SPR(2, 640) ... TO_SPR(2, 640 + TLB_SIZE - 1):
115 idx = spr - TO_SPR(2, 640);
116 env->tlb.itlb[idx].tr = rb;
117 break;
118 case TO_SPR(2, 768) ... TO_SPR(2, 895):
119 case TO_SPR(2, 896) ... TO_SPR(2, 1023):
120 case TO_SPR(2, 1024) ... TO_SPR(2, 1151):
121 case TO_SPR(2, 1152) ... TO_SPR(2, 1279):
122 case TO_SPR(2, 1280) ... TO_SPR(2, 1407):
123 case TO_SPR(2, 1408) ... TO_SPR(2, 1535):
124 break;
125
126 case TO_SPR(5, 1):
127 env->mac = deposit64(env->mac, 0, 32, rb);
128 break;
129 case TO_SPR(5, 2):
130 env->mac = deposit64(env->mac, 32, 32, rb);
131 break;
132 case TO_SPR(8, 0):
133 env->pmr = rb;
134 if (env->pmr & PMR_DME || env->pmr & PMR_SME) {
135 cpu_restore_state(cs, GETPC(), true);
136 env->pc += 4;
137 cs->halted = 1;
138 raise_exception(cpu, EXCP_HALTED);
139 }
140 break;
141 case TO_SPR(9, 0):
142 env->picmr = rb;
143 break;
144 case TO_SPR(9, 2):
145 env->picsr &= ~rb;
146 break;
147 case TO_SPR(10, 0):
148 {
149 if ((env->ttmr & TTMR_M) ^ (rb & TTMR_M)) {
150 switch (rb & TTMR_M) {
151 case TIMER_NONE:
152 cpu_openrisc_count_stop(cpu);
153 break;
154 case TIMER_INTR:
155 case TIMER_SHOT:
156 case TIMER_CONT:
157 cpu_openrisc_count_start(cpu);
158 break;
159 default:
160 break;
161 }
162 }
163
164 int ip = env->ttmr & TTMR_IP;
165
166 if (rb & TTMR_IP) {
167 env->ttmr = (rb & ~TTMR_IP) | ip;
168 } else {
169 env->ttmr = rb & ~TTMR_IP;
170 cs->interrupt_request &= ~CPU_INTERRUPT_TIMER;
171 }
172
173 cpu_openrisc_timer_update(cpu);
174 }
175 break;
176
177 case TO_SPR(10, 1):
178 cpu_openrisc_count_set(cpu, rb);
179 if (env->ttmr & TIMER_NONE) {
180 return;
181 }
182 cpu_openrisc_timer_update(cpu);
183 break;
184#endif
185
186 case TO_SPR(0, 20):
187 cpu_set_fpcsr(env, rb);
188 break;
189 }
190}
191
192target_ulong HELPER(mfspr)(CPUOpenRISCState *env, target_ulong rd,
193 target_ulong spr)
194{
195#ifndef CONFIG_USER_ONLY
196 MachineState *ms = MACHINE(qdev_get_machine());
197 OpenRISCCPU *cpu = env_archcpu(env);
198 CPUState *cs = env_cpu(env);
199 int idx;
200#endif
201
202 switch (spr) {
203#ifndef CONFIG_USER_ONLY
204 case TO_SPR(0, 0):
205 return env->vr;
206
207 case TO_SPR(0, 1):
208 return env->upr;
209
210 case TO_SPR(0, 2):
211 return env->cpucfgr;
212
213 case TO_SPR(0, 3):
214 return env->dmmucfgr;
215
216 case TO_SPR(0, 4):
217 return env->immucfgr;
218
219 case TO_SPR(0, 9):
220 return env->vr2;
221
222 case TO_SPR(0, 10):
223 return env->avr;
224
225 case TO_SPR(0, 11):
226 return env->evbar;
227
228 case TO_SPR(0, 16):
229 cpu_restore_state(cs, GETPC(), false);
230 return env->pc;
231
232 case TO_SPR(0, 17):
233 return cpu_get_sr(env);
234
235 case TO_SPR(0, 18):
236 cpu_restore_state(cs, GETPC(), false);
237 return env->ppc;
238
239 case TO_SPR(0, 32):
240 return env->epcr;
241
242 case TO_SPR(0, 48):
243 return env->eear;
244
245 case TO_SPR(0, 64):
246 return env->esr;
247
248 case TO_SPR(0, 128):
249 return cpu->parent_obj.cpu_index;
250
251 case TO_SPR(0, 129):
252 return ms->smp.max_cpus;
253
254 case TO_SPR(0, 1024) ... TO_SPR(0, 1024 + (16 * 32)):
255 idx = (spr - 1024);
256 return env->shadow_gpr[idx / 32][idx % 32];
257
258 case TO_SPR(1, 512) ... TO_SPR(1, 512 + TLB_SIZE - 1):
259 idx = spr - TO_SPR(1, 512);
260 return env->tlb.dtlb[idx].mr;
261
262 case TO_SPR(1, 640) ... TO_SPR(1, 640 + TLB_SIZE - 1):
263 idx = spr - TO_SPR(1, 640);
264 return env->tlb.dtlb[idx].tr;
265
266 case TO_SPR(1, 768) ... TO_SPR(1, 895):
267 case TO_SPR(1, 896) ... TO_SPR(1, 1023):
268 case TO_SPR(1, 1024) ... TO_SPR(1, 1151):
269 case TO_SPR(1, 1152) ... TO_SPR(1, 1279):
270 case TO_SPR(1, 1280) ... TO_SPR(1, 1407):
271 case TO_SPR(1, 1408) ... TO_SPR(1, 1535):
272 break;
273
274 case TO_SPR(2, 512) ... TO_SPR(2, 512 + TLB_SIZE - 1):
275 idx = spr - TO_SPR(2, 512);
276 return env->tlb.itlb[idx].mr;
277
278 case TO_SPR(2, 640) ... TO_SPR(2, 640 + TLB_SIZE - 1):
279 idx = spr - TO_SPR(2, 640);
280 return env->tlb.itlb[idx].tr;
281
282 case TO_SPR(2, 768) ... TO_SPR(2, 895):
283 case TO_SPR(2, 896) ... TO_SPR(2, 1023):
284 case TO_SPR(2, 1024) ... TO_SPR(2, 1151):
285 case TO_SPR(2, 1152) ... TO_SPR(2, 1279):
286 case TO_SPR(2, 1280) ... TO_SPR(2, 1407):
287 case TO_SPR(2, 1408) ... TO_SPR(2, 1535):
288 break;
289
290 case TO_SPR(5, 1):
291 return (uint32_t)env->mac;
292 break;
293 case TO_SPR(5, 2):
294 return env->mac >> 32;
295 break;
296
297 case TO_SPR(8, 0):
298 return env->pmr;
299
300 case TO_SPR(9, 0):
301 return env->picmr;
302
303 case TO_SPR(9, 2):
304 return env->picsr;
305
306 case TO_SPR(10, 0):
307 return env->ttmr;
308
309 case TO_SPR(10, 1):
310 cpu_openrisc_count_update(cpu);
311 return cpu_openrisc_count_get(cpu);
312#endif
313
314 case TO_SPR(0, 20):
315 return env->fpcsr;
316 }
317
318
319 return rd;
320}
321