1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include "cpu.h"
22#include "exec/helper-proto.h"
23#include "sysemu/kvm.h"
24#include "kvm_ppc.h"
25#include "mmu-hash32.h"
26
27
28
29
30#ifdef DEBUG_MMU
31# define LOG_MMU_STATE(cpu) log_cpu_state((cpu), 0)
32#else
33# define LOG_MMU_STATE(cpu) do { } while (0)
34#endif
35
36#ifdef DEBUG_BATS
37# define LOG_BATS(...) qemu_log(__VA_ARGS__)
38#else
39# define LOG_BATS(...) do { } while (0)
40#endif
41
42struct mmu_ctx_hash32 {
43 hwaddr raddr;
44 int prot;
45 int key;
46};
47
48static int ppc_hash32_pp_prot(int key, int pp, int nx)
49{
50 int prot;
51
52 if (key == 0) {
53 switch (pp) {
54 case 0x0:
55 case 0x1:
56 case 0x2:
57 prot = PAGE_READ | PAGE_WRITE;
58 break;
59
60 case 0x3:
61 prot = PAGE_READ;
62 break;
63
64 default:
65 abort();
66 }
67 } else {
68 switch (pp) {
69 case 0x0:
70 prot = 0;
71 break;
72
73 case 0x1:
74 case 0x3:
75 prot = PAGE_READ;
76 break;
77
78 case 0x2:
79 prot = PAGE_READ | PAGE_WRITE;
80 break;
81
82 default:
83 abort();
84 }
85 }
86 if (nx == 0) {
87 prot |= PAGE_EXEC;
88 }
89
90 return prot;
91}
92
93static int ppc_hash32_pte_prot(CPUPPCState *env,
94 target_ulong sr, ppc_hash_pte32_t pte)
95{
96 unsigned pp, key;
97
98 key = !!(msr_pr ? (sr & SR32_KP) : (sr & SR32_KS));
99 pp = pte.pte1 & HPTE32_R_PP;
100
101 return ppc_hash32_pp_prot(key, pp, !!(sr & SR32_NX));
102}
103
104static target_ulong hash32_bat_size(CPUPPCState *env,
105 target_ulong batu, target_ulong batl)
106{
107 if ((msr_pr && !(batu & BATU32_VP))
108 || (!msr_pr && !(batu & BATU32_VS))) {
109 return 0;
110 }
111
112 return BATU32_BEPI & ~((batu & BATU32_BL) << 15);
113}
114
115static int hash32_bat_prot(CPUPPCState *env,
116 target_ulong batu, target_ulong batl)
117{
118 int pp, prot;
119
120 prot = 0;
121 pp = batl & BATL32_PP;
122 if (pp != 0) {
123 prot = PAGE_READ | PAGE_EXEC;
124 if (pp == 0x2) {
125 prot |= PAGE_WRITE;
126 }
127 }
128 return prot;
129}
130
131static target_ulong hash32_bat_601_size(CPUPPCState *env,
132 target_ulong batu, target_ulong batl)
133{
134 if (!(batl & BATL32_601_V)) {
135 return 0;
136 }
137
138 return BATU32_BEPI & ~((batl & BATL32_601_BL) << 17);
139}
140
141static int hash32_bat_601_prot(CPUPPCState *env,
142 target_ulong batu, target_ulong batl)
143{
144 int key, pp;
145
146 pp = batu & BATU32_601_PP;
147 if (msr_pr == 0) {
148 key = !!(batu & BATU32_601_KS);
149 } else {
150 key = !!(batu & BATU32_601_KP);
151 }
152 return ppc_hash32_pp_prot(key, pp, 0);
153}
154
155static hwaddr ppc_hash32_bat_lookup(CPUPPCState *env, target_ulong ea, int rwx,
156 int *prot)
157{
158 target_ulong *BATlt, *BATut;
159 int i;
160
161 LOG_BATS("%s: %cBAT v " TARGET_FMT_lx "\n", __func__,
162 rwx == 2 ? 'I' : 'D', ea);
163 if (rwx == 2) {
164 BATlt = env->IBAT[1];
165 BATut = env->IBAT[0];
166 } else {
167 BATlt = env->DBAT[1];
168 BATut = env->DBAT[0];
169 }
170 for (i = 0; i < env->nb_BATs; i++) {
171 target_ulong batu = BATut[i];
172 target_ulong batl = BATlt[i];
173 target_ulong mask;
174
175 if (unlikely(env->mmu_model == POWERPC_MMU_601)) {
176 mask = hash32_bat_601_size(env, batu, batl);
177 } else {
178 mask = hash32_bat_size(env, batu, batl);
179 }
180 LOG_BATS("%s: %cBAT%d v " TARGET_FMT_lx " BATu " TARGET_FMT_lx
181 " BATl " TARGET_FMT_lx "\n", __func__,
182 type == ACCESS_CODE ? 'I' : 'D', i, ea, batu, batl);
183
184 if (mask && ((ea & mask) == (batu & BATU32_BEPI))) {
185 hwaddr raddr = (batl & mask) | (ea & ~mask);
186
187 if (unlikely(env->mmu_model == POWERPC_MMU_601)) {
188 *prot = hash32_bat_601_prot(env, batu, batl);
189 } else {
190 *prot = hash32_bat_prot(env, batu, batl);
191 }
192
193 return raddr & TARGET_PAGE_MASK;
194 }
195 }
196
197
198#if defined(DEBUG_BATS)
199 if (qemu_log_enabled()) {
200 LOG_BATS("no BAT match for " TARGET_FMT_lx ":\n", ea);
201 for (i = 0; i < 4; i++) {
202 BATu = &BATut[i];
203 BATl = &BATlt[i];
204 BEPIu = *BATu & BATU32_BEPIU;
205 BEPIl = *BATu & BATU32_BEPIL;
206 bl = (*BATu & 0x00001FFC) << 15;
207 LOG_BATS("%s: %cBAT%d v " TARGET_FMT_lx " BATu " TARGET_FMT_lx
208 " BATl " TARGET_FMT_lx "\n\t" TARGET_FMT_lx " "
209 TARGET_FMT_lx " " TARGET_FMT_lx "\n",
210 __func__, type == ACCESS_CODE ? 'I' : 'D', i, ea,
211 *BATu, *BATl, BEPIu, BEPIl, bl);
212 }
213 }
214#endif
215
216 return -1;
217}
218
219static int ppc_hash32_direct_store(CPUPPCState *env, target_ulong sr,
220 target_ulong eaddr, int rwx,
221 hwaddr *raddr, int *prot)
222{
223 CPUState *cs = CPU(ppc_env_get_cpu(env));
224 int key = !!(msr_pr ? (sr & SR32_KP) : (sr & SR32_KS));
225
226 qemu_log_mask(CPU_LOG_MMU, "direct store...\n");
227
228 if ((sr & 0x1FF00000) >> 20 == 0x07f) {
229
230
231
232
233 *raddr = ((sr & 0xF) << 28) | (eaddr & 0x0FFFFFFF);
234 *prot = PAGE_READ | PAGE_WRITE | PAGE_EXEC;
235 return 0;
236 }
237
238 if (rwx == 2) {
239
240 cs->exception_index = POWERPC_EXCP_ISI;
241 env->error_code = 0x10000000;
242 return 1;
243 }
244
245 switch (env->access_type) {
246 case ACCESS_INT:
247
248 break;
249 case ACCESS_FLOAT:
250
251 cs->exception_index = POWERPC_EXCP_ALIGN;
252 env->error_code = POWERPC_EXCP_ALIGN_FP;
253 env->spr[SPR_DAR] = eaddr;
254 return 1;
255 case ACCESS_RES:
256
257 env->error_code = 0;
258 env->spr[SPR_DAR] = eaddr;
259 if (rwx == 1) {
260 env->spr[SPR_DSISR] = 0x06000000;
261 } else {
262 env->spr[SPR_DSISR] = 0x04000000;
263 }
264 return 1;
265 case ACCESS_CACHE:
266
267
268
269
270 *raddr = eaddr;
271 return 0;
272 case ACCESS_EXT:
273
274 cs->exception_index = POWERPC_EXCP_DSI;
275 env->error_code = 0;
276 env->spr[SPR_DAR] = eaddr;
277 if (rwx == 1) {
278 env->spr[SPR_DSISR] = 0x06100000;
279 } else {
280 env->spr[SPR_DSISR] = 0x04100000;
281 }
282 return 1;
283 default:
284 qemu_log("ERROR: instruction should not need "
285 "address translation\n");
286 abort();
287 }
288 if ((rwx == 1 || key != 1) && (rwx == 0 || key != 0)) {
289 *raddr = eaddr;
290 return 0;
291 } else {
292 cs->exception_index = POWERPC_EXCP_DSI;
293 env->error_code = 0;
294 env->spr[SPR_DAR] = eaddr;
295 if (rwx == 1) {
296 env->spr[SPR_DSISR] = 0x0a000000;
297 } else {
298 env->spr[SPR_DSISR] = 0x08000000;
299 }
300 return 1;
301 }
302}
303
304hwaddr get_pteg_offset32(CPUPPCState *env, hwaddr hash)
305{
306 return (hash * HASH_PTEG_SIZE_32) & env->htab_mask;
307}
308
309static hwaddr ppc_hash32_pteg_search(CPUPPCState *env, hwaddr pteg_off,
310 bool secondary, target_ulong ptem,
311 ppc_hash_pte32_t *pte)
312{
313 hwaddr pte_offset = pteg_off;
314 target_ulong pte0, pte1;
315 int i;
316
317 for (i = 0; i < HPTES_PER_GROUP; i++) {
318 pte0 = ppc_hash32_load_hpte0(env, pte_offset);
319 pte1 = ppc_hash32_load_hpte1(env, pte_offset);
320
321 if ((pte0 & HPTE32_V_VALID)
322 && (secondary == !!(pte0 & HPTE32_V_SECONDARY))
323 && HPTE32_V_COMPARE(pte0, ptem)) {
324 pte->pte0 = pte0;
325 pte->pte1 = pte1;
326 return pte_offset;
327 }
328
329 pte_offset += HASH_PTE_SIZE_32;
330 }
331
332 return -1;
333}
334
335static hwaddr ppc_hash32_htab_lookup(CPUPPCState *env,
336 target_ulong sr, target_ulong eaddr,
337 ppc_hash_pte32_t *pte)
338{
339 hwaddr pteg_off, pte_offset;
340 hwaddr hash;
341 uint32_t vsid, pgidx, ptem;
342
343 vsid = sr & SR32_VSID;
344 pgidx = (eaddr & ~SEGMENT_MASK_256M) >> TARGET_PAGE_BITS;
345 hash = vsid ^ pgidx;
346 ptem = (vsid << 7) | (pgidx >> 10);
347
348
349 qemu_log_mask(CPU_LOG_MMU, "htab_base " TARGET_FMT_plx
350 " htab_mask " TARGET_FMT_plx
351 " hash " TARGET_FMT_plx "\n",
352 env->htab_base, env->htab_mask, hash);
353
354
355 qemu_log_mask(CPU_LOG_MMU, "0 htab=" TARGET_FMT_plx "/" TARGET_FMT_plx
356 " vsid=%" PRIx32 " ptem=%" PRIx32
357 " hash=" TARGET_FMT_plx "\n",
358 env->htab_base, env->htab_mask, vsid, ptem, hash);
359 pteg_off = get_pteg_offset32(env, hash);
360 pte_offset = ppc_hash32_pteg_search(env, pteg_off, 0, ptem, pte);
361 if (pte_offset == -1) {
362
363 qemu_log_mask(CPU_LOG_MMU, "1 htab=" TARGET_FMT_plx "/" TARGET_FMT_plx
364 " vsid=%" PRIx32 " api=%" PRIx32
365 " hash=" TARGET_FMT_plx "\n", env->htab_base,
366 env->htab_mask, vsid, ptem, ~hash);
367 pteg_off = get_pteg_offset32(env, ~hash);
368 pte_offset = ppc_hash32_pteg_search(env, pteg_off, 1, ptem, pte);
369 }
370
371 return pte_offset;
372}
373
374static hwaddr ppc_hash32_pte_raddr(target_ulong sr, ppc_hash_pte32_t pte,
375 target_ulong eaddr)
376{
377 hwaddr rpn = pte.pte1 & HPTE32_R_RPN;
378 hwaddr mask = ~TARGET_PAGE_MASK;
379
380 return (rpn & ~mask) | (eaddr & mask);
381}
382
383int ppc_hash32_handle_mmu_fault(PowerPCCPU *cpu, target_ulong eaddr, int rwx,
384 int mmu_idx)
385{
386 CPUState *cs = CPU(cpu);
387 CPUPPCState *env = &cpu->env;
388 target_ulong sr;
389 hwaddr pte_offset;
390 ppc_hash_pte32_t pte;
391 int prot;
392 uint32_t new_pte1;
393 const int need_prot[] = {PAGE_READ, PAGE_WRITE, PAGE_EXEC};
394 hwaddr raddr;
395
396 assert((rwx == 0) || (rwx == 1) || (rwx == 2));
397
398
399 if (((rwx == 2) && (msr_ir == 0)) || ((rwx != 2) && (msr_dr == 0))) {
400
401 raddr = eaddr;
402 tlb_set_page(cs, eaddr & TARGET_PAGE_MASK, raddr & TARGET_PAGE_MASK,
403 PAGE_READ | PAGE_WRITE | PAGE_EXEC, mmu_idx,
404 TARGET_PAGE_SIZE);
405 return 0;
406 }
407
408
409 if (env->nb_BATs != 0) {
410 raddr = ppc_hash32_bat_lookup(env, eaddr, rwx, &prot);
411 if (raddr != -1) {
412 if (need_prot[rwx] & ~prot) {
413 if (rwx == 2) {
414 cs->exception_index = POWERPC_EXCP_ISI;
415 env->error_code = 0x08000000;
416 } else {
417 cs->exception_index = POWERPC_EXCP_DSI;
418 env->error_code = 0;
419 env->spr[SPR_DAR] = eaddr;
420 if (rwx == 1) {
421 env->spr[SPR_DSISR] = 0x0a000000;
422 } else {
423 env->spr[SPR_DSISR] = 0x08000000;
424 }
425 }
426 return 1;
427 }
428
429 tlb_set_page(cs, eaddr & TARGET_PAGE_MASK,
430 raddr & TARGET_PAGE_MASK, prot, mmu_idx,
431 TARGET_PAGE_SIZE);
432 return 0;
433 }
434 }
435
436
437 sr = env->sr[eaddr >> 28];
438
439
440 if (sr & SR32_T) {
441 if (ppc_hash32_direct_store(env, sr, eaddr, rwx,
442 &raddr, &prot) == 0) {
443 tlb_set_page(cs, eaddr & TARGET_PAGE_MASK,
444 raddr & TARGET_PAGE_MASK, prot, mmu_idx,
445 TARGET_PAGE_SIZE);
446 return 0;
447 } else {
448 return 1;
449 }
450 }
451
452
453 if ((rwx == 2) && (sr & SR32_NX)) {
454 cs->exception_index = POWERPC_EXCP_ISI;
455 env->error_code = 0x10000000;
456 return 1;
457 }
458
459
460 pte_offset = ppc_hash32_htab_lookup(env, sr, eaddr, &pte);
461 if (pte_offset == -1) {
462 if (rwx == 2) {
463 cs->exception_index = POWERPC_EXCP_ISI;
464 env->error_code = 0x40000000;
465 } else {
466 cs->exception_index = POWERPC_EXCP_DSI;
467 env->error_code = 0;
468 env->spr[SPR_DAR] = eaddr;
469 if (rwx == 1) {
470 env->spr[SPR_DSISR] = 0x42000000;
471 } else {
472 env->spr[SPR_DSISR] = 0x40000000;
473 }
474 }
475
476 return 1;
477 }
478 qemu_log_mask(CPU_LOG_MMU,
479 "found PTE at offset %08" HWADDR_PRIx "\n", pte_offset);
480
481
482
483 prot = ppc_hash32_pte_prot(env, sr, pte);
484
485 if (need_prot[rwx] & ~prot) {
486
487 qemu_log_mask(CPU_LOG_MMU, "PTE access rejected\n");
488 if (rwx == 2) {
489 cs->exception_index = POWERPC_EXCP_ISI;
490 env->error_code = 0x08000000;
491 } else {
492 cs->exception_index = POWERPC_EXCP_DSI;
493 env->error_code = 0;
494 env->spr[SPR_DAR] = eaddr;
495 if (rwx == 1) {
496 env->spr[SPR_DSISR] = 0x0a000000;
497 } else {
498 env->spr[SPR_DSISR] = 0x08000000;
499 }
500 }
501 return 1;
502 }
503
504 qemu_log_mask(CPU_LOG_MMU, "PTE access granted !\n");
505
506
507
508 new_pte1 = pte.pte1 | HPTE32_R_R;
509 if (rwx == 1) {
510 new_pte1 |= HPTE32_R_C;
511 } else {
512
513
514 prot &= ~PAGE_WRITE;
515 }
516
517 if (new_pte1 != pte.pte1) {
518 ppc_hash32_store_hpte1(env, pte_offset, new_pte1);
519 }
520
521
522
523 raddr = ppc_hash32_pte_raddr(sr, pte, eaddr);
524
525 tlb_set_page(cs, eaddr & TARGET_PAGE_MASK, raddr & TARGET_PAGE_MASK,
526 prot, mmu_idx, TARGET_PAGE_SIZE);
527
528 return 0;
529}
530
531hwaddr ppc_hash32_get_phys_page_debug(CPUPPCState *env, target_ulong eaddr)
532{
533 target_ulong sr;
534 hwaddr pte_offset;
535 ppc_hash_pte32_t pte;
536 int prot;
537
538 if (msr_dr == 0) {
539
540 return eaddr;
541 }
542
543 if (env->nb_BATs != 0) {
544 hwaddr raddr = ppc_hash32_bat_lookup(env, eaddr, 0, &prot);
545 if (raddr != -1) {
546 return raddr;
547 }
548 }
549
550 sr = env->sr[eaddr >> 28];
551
552 if (sr & SR32_T) {
553
554 return -1;
555 }
556
557 pte_offset = ppc_hash32_htab_lookup(env, sr, eaddr, &pte);
558 if (pte_offset == -1) {
559 return -1;
560 }
561
562 return ppc_hash32_pte_raddr(sr, pte, eaddr) & TARGET_PAGE_MASK;
563}
564