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