]> git.proxmox.com Git - qemu.git/blame - target-cris/mmu.c
Really really revert commit r4343
[qemu.git] / target-cris / mmu.c
CommitLineData
94cff60a
TS
1/*
2 * CRIS mmu emulation.
3 *
4 * Copyright (c) 2007 AXIS Communications AB
5 * Written by Edgar E. Iglesias.
6 *
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.
11 *
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.
16 *
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with this library; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 */
21
22#ifndef CONFIG_USER_ONLY
23
24#include <stdio.h>
25#include <string.h>
26#include <stdlib.h>
27
28#include "config.h"
29#include "cpu.h"
30#include "mmu.h"
31#include "exec-all.h"
32
786c02f1 33#define D(x)
94cff60a
TS
34
35static int cris_mmu_enabled(uint32_t rw_gc_cfg)
36{
37 return (rw_gc_cfg & 12) != 0;
38}
39
40static int cris_mmu_segmented_addr(int seg, uint32_t rw_mm_cfg)
41{
42 return (1 << seg) & rw_mm_cfg;
43}
44
45static uint32_t cris_mmu_translate_seg(CPUState *env, int seg)
46{
47 uint32_t base;
48 int i;
49
50 if (seg < 8)
51 base = env->sregs[SFR_RW_MM_KBASE_LO];
52 else
53 base = env->sregs[SFR_RW_MM_KBASE_HI];
54
55 i = seg & 7;
56 base >>= i * 4;
57 base &= 15;
58
59 base <<= 28;
60 return base;
61}
62/* Used by the tlb decoder. */
63#define EXTRACT_FIELD(src, start, end) \
786c02f1
EI
64 (((src) >> start) & ((1 << (end - start + 1)) - 1))
65
66static inline void set_field(uint32_t *dst, unsigned int val,
67 unsigned int offset, unsigned int width)
68{
69 uint32_t mask;
70
71 mask = (1 << width) - 1;
72 mask <<= offset;
73 val <<= offset;
74
75 val &= mask;
786c02f1
EI
76 *dst &= ~(mask);
77 *dst |= val;
78}
94cff60a 79
b41f7df0
EI
80static void dump_tlb(CPUState *env, int mmu)
81{
82 int set;
83 int idx;
84 uint32_t hi, lo, tlb_vpn, tlb_pfn;
85
86 for (set = 0; set < 4; set++) {
87 for (idx = 0; idx < 16; idx++) {
88 lo = env->tlbsets[mmu][set][idx].lo;
89 hi = env->tlbsets[mmu][set][idx].hi;
90 tlb_vpn = EXTRACT_FIELD(hi, 13, 31);
91 tlb_pfn = EXTRACT_FIELD(lo, 13, 31);
92
93 printf ("TLB: [%d][%d] hi=%x lo=%x v=%x p=%x\n",
94 set, idx, hi, lo, tlb_vpn, tlb_pfn);
95 }
96 }
97}
98
99/* rw 0 = read, 1 = write, 2 = exec. */
94cff60a
TS
100static int cris_mmu_translate_page(struct cris_mmu_result_t *res,
101 CPUState *env, uint32_t vaddr,
102 int rw, int usermode)
103{
104 unsigned int vpage;
105 unsigned int idx;
106 uint32_t lo, hi;
786c02f1
EI
107 uint32_t tlb_vpn, tlb_pfn = 0;
108 int tlb_pid, tlb_g, tlb_v, tlb_k, tlb_w, tlb_x;
109 int cfg_v, cfg_k, cfg_w, cfg_x;
b41f7df0 110 int set, match = 0;
786c02f1
EI
111 uint32_t r_cause;
112 uint32_t r_cfg;
113 int rwcause;
b41f7df0
EI
114 int mmu = 1; /* Data mmu is default. */
115 int vect_base;
786c02f1
EI
116
117 r_cause = env->sregs[SFR_R_MM_CAUSE];
118 r_cfg = env->sregs[SFR_RW_MM_CFG];
b41f7df0
EI
119
120 switch (rw) {
121 case 2: rwcause = CRIS_MMU_ERR_EXEC; mmu = 0; break;
122 case 1: rwcause = CRIS_MMU_ERR_WRITE; break;
123 default:
124 case 0: rwcause = CRIS_MMU_ERR_READ; break;
125 }
126
127 /* I exception vectors 4 - 7, D 8 - 11. */
128 vect_base = (mmu + 1) * 4;
94cff60a
TS
129
130 vpage = vaddr >> 13;
94cff60a
TS
131
132 /* We know the index which to check on each set.
133 Scan both I and D. */
786c02f1 134#if 0
b41f7df0
EI
135 for (set = 0; set < 4; set++) {
136 for (idx = 0; idx < 16; idx++) {
137 lo = env->tlbsets[mmu][set][idx].lo;
138 hi = env->tlbsets[mmu][set][idx].hi;
786c02f1
EI
139 tlb_vpn = EXTRACT_FIELD(hi, 13, 31);
140 tlb_pfn = EXTRACT_FIELD(lo, 13, 31);
141
142 printf ("TLB: [%d][%d] hi=%x lo=%x v=%x p=%x\n",
b41f7df0 143 set, idx, hi, lo, tlb_vpn, tlb_pfn);
786c02f1
EI
144 }
145 }
146#endif
b41f7df0
EI
147
148 idx = vpage & 15;
149 for (set = 0; set < 4; set++)
94cff60a 150 {
b41f7df0
EI
151 lo = env->tlbsets[mmu][set][idx].lo;
152 hi = env->tlbsets[mmu][set][idx].hi;
94cff60a 153
786c02f1
EI
154 tlb_vpn = EXTRACT_FIELD(hi, 13, 31);
155 tlb_pfn = EXTRACT_FIELD(lo, 13, 31);
94cff60a 156
b41f7df0
EI
157 D(printf("TLB[%d][%d] v=%x vpage=%x -> pfn=%x lo=%x hi=%x\n",
158 i, idx, tlb_vpn, vpage, tlb_pfn, lo, hi));
786c02f1 159 if (tlb_vpn == vpage) {
94cff60a
TS
160 match = 1;
161 break;
162 }
163 }
164
b41f7df0 165 res->bf_vec = vect_base;
94cff60a 166 if (match) {
786c02f1
EI
167 cfg_w = EXTRACT_FIELD(r_cfg, 19, 19);
168 cfg_k = EXTRACT_FIELD(r_cfg, 18, 18);
169 cfg_x = EXTRACT_FIELD(r_cfg, 17, 17);
170 cfg_v = EXTRACT_FIELD(r_cfg, 16, 16);
171
172 tlb_pid = EXTRACT_FIELD(hi, 0, 7);
173 tlb_pfn = EXTRACT_FIELD(lo, 13, 31);
174 tlb_g = EXTRACT_FIELD(lo, 4, 4);
175 tlb_v = EXTRACT_FIELD(lo, 3, 3);
176 tlb_k = EXTRACT_FIELD(lo, 2, 2);
177 tlb_w = EXTRACT_FIELD(lo, 1, 1);
178 tlb_x = EXTRACT_FIELD(lo, 0, 0);
179
180 /*
181 set_exception_vector(0x04, i_mmu_refill);
182 set_exception_vector(0x05, i_mmu_invalid);
183 set_exception_vector(0x06, i_mmu_access);
184 set_exception_vector(0x07, i_mmu_execute);
185 set_exception_vector(0x08, d_mmu_refill);
186 set_exception_vector(0x09, d_mmu_invalid);
187 set_exception_vector(0x0a, d_mmu_access);
188 set_exception_vector(0x0b, d_mmu_write);
189 */
b41f7df0
EI
190 if (!tlb_g
191 && tlb_pid != (env->pregs[PR_PID] & 0xff)) {
192 D(printf ("tlb: wrong pid %x %x pc=%x\n",
193 tlb_pid, env->pregs[PR_PID], env->pc));
786c02f1 194 match = 0;
b41f7df0
EI
195 res->bf_vec = vect_base;
196 } else if (rw == 1 && cfg_w && !tlb_w) {
197 D(printf ("tlb: write protected %x lo=%x\n",
198 vaddr, lo));
786c02f1 199 match = 0;
b41f7df0
EI
200 res->bf_vec = vect_base + 3;
201 } else if (cfg_v && !tlb_v) {
202 D(printf ("tlb: invalid %x\n", vaddr));
203 set_field(&r_cause, rwcause, 8, 9);
786c02f1 204 match = 0;
b41f7df0 205 res->bf_vec = vect_base + 1;
786c02f1 206 }
786c02f1 207
b41f7df0
EI
208 res->prot = 0;
209 if (match) {
210 res->prot |= PAGE_READ;
211 if (tlb_w)
212 res->prot |= PAGE_WRITE;
213 if (tlb_x)
214 res->prot |= PAGE_EXEC;
215 }
216 else
217 D(dump_tlb(env, mmu));
218
219 env->sregs[SFR_RW_MM_TLB_HI] = hi;
220 env->sregs[SFR_RW_MM_TLB_LO] = lo;
786c02f1
EI
221 }
222
223 if (!match) {
b41f7df0
EI
224 /* miss. */
225 idx = vpage & 15;
226 set = 0;
227
228 /* Update RW_MM_TLB_SEL. */
229 env->sregs[SFR_RW_MM_TLB_SEL] = 0;
230 set_field(&env->sregs[SFR_RW_MM_TLB_SEL], idx, 0, 4);
231 set_field(&env->sregs[SFR_RW_MM_TLB_SEL], set, 4, 5);
232
233 /* Update RW_MM_CAUSE. */
234 set_field(&r_cause, rwcause, 8, 2);
786c02f1
EI
235 set_field(&r_cause, vpage, 13, 19);
236 set_field(&r_cause, env->pregs[PR_PID], 0, 8);
237 env->sregs[SFR_R_MM_CAUSE] = r_cause;
b41f7df0 238 D(printf("refill vaddr=%x pc=%x\n", vaddr, env->pc));
94cff60a 239 }
b41f7df0
EI
240
241
242 D(printf ("%s rw=%d mtch=%d pc=%x va=%x vpn=%x tlbvpn=%x pfn=%x pid=%x"
243 " %x cause=%x sel=%x sp=%x %x %x\n",
244 __func__, rw, match, env->pc,
786c02f1
EI
245 vaddr, vpage,
246 tlb_vpn, tlb_pfn, tlb_pid,
247 env->pregs[PR_PID],
248 r_cause,
249 env->sregs[SFR_RW_MM_TLB_SEL],
b41f7df0 250 env->regs[R_SP], env->pregs[PR_USP], env->ksp));
786c02f1
EI
251
252 res->pfn = tlb_pfn;
94cff60a
TS
253 return !match;
254}
255
786c02f1
EI
256/* Give us the vaddr corresponding to the latest TLB update. */
257target_ulong cris_mmu_tlb_latest_update(CPUState *env, uint32_t new_lo)
258{
259 uint32_t sel = env->sregs[SFR_RW_MM_TLB_SEL];
260 uint32_t vaddr;
261 uint32_t hi;
262 int set;
263 int idx;
264
265 idx = EXTRACT_FIELD(sel, 0, 4);
266 set = EXTRACT_FIELD(sel, 4, 5);
267
268 hi = env->tlbsets[1][set][idx].hi;
269 vaddr = EXTRACT_FIELD(hi, 13, 31);
270 return vaddr << TARGET_PAGE_BITS;
271}
272
94cff60a
TS
273int cris_mmu_translate(struct cris_mmu_result_t *res,
274 CPUState *env, uint32_t vaddr,
6ebbf390 275 int rw, int mmu_idx)
94cff60a
TS
276{
277 uint32_t phy = vaddr;
278 int seg;
279 int miss = 0;
786c02f1 280 int is_user = mmu_idx == MMU_USER_IDX;
b41f7df0
EI
281 uint32_t old_srs;
282
283 old_srs= env->pregs[PR_SRS];
284
285 /* rw == 2 means exec, map the access to the insn mmu. */
286 env->pregs[PR_SRS] = rw == 2 ? 1 : 2;
94cff60a
TS
287
288 if (!cris_mmu_enabled(env->sregs[SFR_RW_GC_CFG])) {
289 res->phy = vaddr;
b41f7df0
EI
290 res->prot = PAGE_BITS;
291 goto done;
94cff60a
TS
292 }
293
294 seg = vaddr >> 28;
295 if (cris_mmu_segmented_addr(seg, env->sregs[SFR_RW_MM_CFG]))
296 {
297 uint32_t base;
298
299 miss = 0;
300 base = cris_mmu_translate_seg(env, seg);
301 phy = base | (0x0fffffff & vaddr);
302 res->phy = phy;
b41f7df0 303 res->prot = PAGE_BITS;
94cff60a
TS
304 }
305 else
306 {
307 miss = cris_mmu_translate_page(res, env, vaddr, rw, is_user);
b41f7df0
EI
308 phy = (res->pfn << 13);
309 res->phy = phy;
94cff60a 310 }
b41f7df0
EI
311 done:
312 env->pregs[PR_SRS] = old_srs;
94cff60a
TS
313 return miss;
314}
315#endif