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