virtio-blk: multiqueue batch notify
[qemu/kevin.git] / target-openrisc / sys_helper.c
bloba719e452bee4876250916ca636c2ddef153ac698
1 /*
2 * OpenRISC system instructions helper routines
4 * Copyright (c) 2011-2012 Jia Liu <proljc@gmail.com>
5 * Zhizhou Zhang <etouzh@gmail.com>
7 * This library is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2 of the License, or (at your option) any later version.
12 * This library is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
21 #include "qemu/osdep.h"
22 #include "cpu.h"
23 #include "exec/exec-all.h"
24 #include "exec/helper-proto.h"
26 #define TO_SPR(group, number) (((group) << 11) + (number))
28 void HELPER(mtspr)(CPUOpenRISCState *env,
29 target_ulong ra, target_ulong rb, target_ulong offset)
31 #ifndef CONFIG_USER_ONLY
32 int spr = (ra | offset);
33 int idx;
35 OpenRISCCPU *cpu = openrisc_env_get_cpu(env);
36 CPUState *cs = CPU(cpu);
38 switch (spr) {
39 case TO_SPR(0, 0): /* VR */
40 env->vr = rb;
41 break;
43 case TO_SPR(0, 16): /* NPC */
44 env->npc = rb;
45 break;
47 case TO_SPR(0, 17): /* SR */
48 if ((env->sr & (SR_IME | SR_DME | SR_SM)) ^
49 (rb & (SR_IME | SR_DME | SR_SM))) {
50 tlb_flush(cs, 1);
52 env->sr = rb;
53 env->sr |= SR_FO; /* FO is const equal to 1 */
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;
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;
69 break;
71 case TO_SPR(0, 18): /* PPC */
72 env->ppc = rb;
73 break;
75 case TO_SPR(0, 32): /* EPCR */
76 env->epcr = rb;
77 break;
79 case TO_SPR(0, 48): /* EEAR */
80 env->eear = rb;
81 break;
83 case TO_SPR(0, 64): /* ESR */
84 env->esr = rb;
85 break;
86 case TO_SPR(1, 512) ... TO_SPR(1, 512+DTLB_SIZE-1): /* DTLBW0MR 0-127 */
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);
91 env->tlb->dtlb[0][idx].mr = rb;
92 break;
94 case TO_SPR(1, 640) ... TO_SPR(1, 640+DTLB_SIZE-1): /* DTLBW0TR 0-127 */
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): /* DTLBW1MR 0-127 */
99 case TO_SPR(1, 896) ... TO_SPR(1, 1023): /* DTLBW1TR 0-127 */
100 case TO_SPR(1, 1024) ... TO_SPR(1, 1151): /* DTLBW2MR 0-127 */
101 case TO_SPR(1, 1152) ... TO_SPR(1, 1279): /* DTLBW2TR 0-127 */
102 case TO_SPR(1, 1280) ... TO_SPR(1, 1407): /* DTLBW3MR 0-127 */
103 case TO_SPR(1, 1408) ... TO_SPR(1, 1535): /* DTLBW3TR 0-127 */
104 break;
105 case TO_SPR(2, 512) ... TO_SPR(2, 512+ITLB_SIZE-1): /* ITLBW0MR 0-127 */
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);
110 env->tlb->itlb[0][idx].mr = rb;
111 break;
113 case TO_SPR(2, 640) ... TO_SPR(2, 640+ITLB_SIZE-1): /* ITLBW0TR 0-127 */
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): /* ITLBW1MR 0-127 */
118 case TO_SPR(2, 896) ... TO_SPR(2, 1023): /* ITLBW1TR 0-127 */
119 case TO_SPR(2, 1024) ... TO_SPR(2, 1151): /* ITLBW2MR 0-127 */
120 case TO_SPR(2, 1152) ... TO_SPR(2, 1279): /* ITLBW2TR 0-127 */
121 case TO_SPR(2, 1280) ... TO_SPR(2, 1407): /* ITLBW3MR 0-127 */
122 case TO_SPR(2, 1408) ... TO_SPR(2, 1535): /* ITLBW3TR 0-127 */
123 break;
124 case TO_SPR(9, 0): /* PICMR */
125 env->picmr |= rb;
126 break;
127 case TO_SPR(9, 2): /* PICSR */
128 env->picsr &= ~rb;
129 break;
130 case TO_SPR(10, 0): /* TTMR */
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;
147 int ip = env->ttmr & TTMR_IP;
149 if (rb & TTMR_IP) { /* Keep IP bit. */
150 env->ttmr = (rb & ~TTMR_IP) | ip;
151 } else { /* Clear IP bit. */
152 env->ttmr = rb & ~TTMR_IP;
153 cs->interrupt_request &= ~CPU_INTERRUPT_TIMER;
156 cpu_openrisc_timer_update(cpu);
158 break;
160 case TO_SPR(10, 1): /* TTCR */
161 env->ttcr = rb;
162 if (env->ttmr & TIMER_NONE) {
163 return;
165 cpu_openrisc_timer_update(cpu);
166 break;
167 default:
169 break;
171 #endif
174 target_ulong HELPER(mfspr)(CPUOpenRISCState *env,
175 target_ulong rd, target_ulong ra, uint32_t offset)
177 #ifndef CONFIG_USER_ONLY
178 int spr = (ra | offset);
179 int idx;
181 OpenRISCCPU *cpu = openrisc_env_get_cpu(env);
183 switch (spr) {
184 case TO_SPR(0, 0): /* VR */
185 return env->vr & SPR_VR;
187 case TO_SPR(0, 1): /* UPR */
188 return env->upr; /* TT, DM, IM, UP present */
190 case TO_SPR(0, 2): /* CPUCFGR */
191 return env->cpucfgr;
193 case TO_SPR(0, 3): /* DMMUCFGR */
194 return env->dmmucfgr; /* 1Way, 64 entries */
196 case TO_SPR(0, 4): /* IMMUCFGR */
197 return env->immucfgr;
199 case TO_SPR(0, 16): /* NPC */
200 return env->npc;
202 case TO_SPR(0, 17): /* SR */
203 return env->sr;
205 case TO_SPR(0, 18): /* PPC */
206 return env->ppc;
208 case TO_SPR(0, 32): /* EPCR */
209 return env->epcr;
211 case TO_SPR(0, 48): /* EEAR */
212 return env->eear;
214 case TO_SPR(0, 64): /* ESR */
215 return env->esr;
217 case TO_SPR(1, 512) ... TO_SPR(1, 512+DTLB_SIZE-1): /* DTLBW0MR 0-127 */
218 idx = spr - TO_SPR(1, 512);
219 return env->tlb->dtlb[0][idx].mr;
221 case TO_SPR(1, 640) ... TO_SPR(1, 640+DTLB_SIZE-1): /* DTLBW0TR 0-127 */
222 idx = spr - TO_SPR(1, 640);
223 return env->tlb->dtlb[0][idx].tr;
225 case TO_SPR(1, 768) ... TO_SPR(1, 895): /* DTLBW1MR 0-127 */
226 case TO_SPR(1, 896) ... TO_SPR(1, 1023): /* DTLBW1TR 0-127 */
227 case TO_SPR(1, 1024) ... TO_SPR(1, 1151): /* DTLBW2MR 0-127 */
228 case TO_SPR(1, 1152) ... TO_SPR(1, 1279): /* DTLBW2TR 0-127 */
229 case TO_SPR(1, 1280) ... TO_SPR(1, 1407): /* DTLBW3MR 0-127 */
230 case TO_SPR(1, 1408) ... TO_SPR(1, 1535): /* DTLBW3TR 0-127 */
231 break;
233 case TO_SPR(2, 512) ... TO_SPR(2, 512+ITLB_SIZE-1): /* ITLBW0MR 0-127 */
234 idx = spr - TO_SPR(2, 512);
235 return env->tlb->itlb[0][idx].mr;
237 case TO_SPR(2, 640) ... TO_SPR(2, 640+ITLB_SIZE-1): /* ITLBW0TR 0-127 */
238 idx = spr - TO_SPR(2, 640);
239 return env->tlb->itlb[0][idx].tr;
241 case TO_SPR(2, 768) ... TO_SPR(2, 895): /* ITLBW1MR 0-127 */
242 case TO_SPR(2, 896) ... TO_SPR(2, 1023): /* ITLBW1TR 0-127 */
243 case TO_SPR(2, 1024) ... TO_SPR(2, 1151): /* ITLBW2MR 0-127 */
244 case TO_SPR(2, 1152) ... TO_SPR(2, 1279): /* ITLBW2TR 0-127 */
245 case TO_SPR(2, 1280) ... TO_SPR(2, 1407): /* ITLBW3MR 0-127 */
246 case TO_SPR(2, 1408) ... TO_SPR(2, 1535): /* ITLBW3TR 0-127 */
247 break;
249 case TO_SPR(9, 0): /* PICMR */
250 return env->picmr;
252 case TO_SPR(9, 2): /* PICSR */
253 return env->picsr;
255 case TO_SPR(10, 0): /* TTMR */
256 return env->ttmr;
258 case TO_SPR(10, 1): /* TTCR */
259 cpu_openrisc_count_update(cpu);
260 return env->ttcr;
262 default:
263 break;
265 #endif
267 /*If we later need to add tracepoints (or debug printfs) for the return
268 value, it may be useful to structure the code like this:
270 target_ulong ret = 0;
272 switch() {
273 case x:
274 ret = y;
275 break;
276 case z:
277 ret = 42;
278 break;
282 later something like trace_spr_read(ret);
284 return ret;*/
286 /* for rd is passed in, if rd unchanged, just keep it back. */
287 return rd;