ahci/qtest: Execute IDENTIFY prior to data commands
[qemu/ar7.git] / target-ppc / mmu-hash32.c
blobdfee358d6a7cb5fa7868554fcdf9a0c721e0a276
1 /*
2 * PowerPC MMU, TLB and BAT emulation helpers for QEMU.
4 * Copyright (c) 2003-2007 Jocelyn Mayer
5 * Copyright (c) 2013 David Gibson, IBM Corporation
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 "cpu.h"
22 #include "exec/helper-proto.h"
23 #include "sysemu/kvm.h"
24 #include "kvm_ppc.h"
25 #include "mmu-hash32.h"
27 //#define DEBUG_MMU
28 //#define DEBUG_BAT
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
36 #ifdef DEBUG_BATS
37 # define LOG_BATS(...) qemu_log(__VA_ARGS__)
38 #else
39 # define LOG_BATS(...) do { } while (0)
40 #endif
42 struct mmu_ctx_hash32 {
43 hwaddr raddr; /* Real address */
44 int prot; /* Protection bits */
45 int key; /* Access key */
48 static int ppc_hash32_pp_prot(int key, int pp, int nx)
50 int prot;
52 if (key == 0) {
53 switch (pp) {
54 case 0x0:
55 case 0x1:
56 case 0x2:
57 prot = PAGE_READ | PAGE_WRITE;
58 break;
60 case 0x3:
61 prot = PAGE_READ;
62 break;
64 default:
65 abort();
67 } else {
68 switch (pp) {
69 case 0x0:
70 prot = 0;
71 break;
73 case 0x1:
74 case 0x3:
75 prot = PAGE_READ;
76 break;
78 case 0x2:
79 prot = PAGE_READ | PAGE_WRITE;
80 break;
82 default:
83 abort();
86 if (nx == 0) {
87 prot |= PAGE_EXEC;
90 return prot;
93 static int ppc_hash32_pte_prot(CPUPPCState *env,
94 target_ulong sr, ppc_hash_pte32_t pte)
96 unsigned pp, key;
98 key = !!(msr_pr ? (sr & SR32_KP) : (sr & SR32_KS));
99 pp = pte.pte1 & HPTE32_R_PP;
101 return ppc_hash32_pp_prot(key, pp, !!(sr & SR32_NX));
104 static target_ulong hash32_bat_size(CPUPPCState *env,
105 target_ulong batu, target_ulong batl)
107 if ((msr_pr && !(batu & BATU32_VP))
108 || (!msr_pr && !(batu & BATU32_VS))) {
109 return 0;
112 return BATU32_BEPI & ~((batu & BATU32_BL) << 15);
115 static int hash32_bat_prot(CPUPPCState *env,
116 target_ulong batu, target_ulong batl)
118 int pp, prot;
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;
128 return prot;
131 static target_ulong hash32_bat_601_size(CPUPPCState *env,
132 target_ulong batu, target_ulong batl)
134 if (!(batl & BATL32_601_V)) {
135 return 0;
138 return BATU32_BEPI & ~((batl & BATL32_601_BL) << 17);
141 static int hash32_bat_601_prot(CPUPPCState *env,
142 target_ulong batu, target_ulong batl)
144 int key, pp;
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);
152 return ppc_hash32_pp_prot(key, pp, 0);
155 static hwaddr ppc_hash32_bat_lookup(CPUPPCState *env, target_ulong ea, int rwx,
156 int *prot)
158 target_ulong *BATlt, *BATut;
159 int i;
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];
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;
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);
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);
184 if (mask && ((ea & mask) == (batu & BATU32_BEPI))) {
185 hwaddr raddr = (batl & mask) | (ea & ~mask);
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);
193 return raddr & TARGET_PAGE_MASK;
197 /* No hit */
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);
214 #endif
216 return -1;
219 static int ppc_hash32_direct_store(CPUPPCState *env, target_ulong sr,
220 target_ulong eaddr, int rwx,
221 hwaddr *raddr, int *prot)
223 CPUState *cs = CPU(ppc_env_get_cpu(env));
224 int key = !!(msr_pr ? (sr & SR32_KP) : (sr & SR32_KS));
226 qemu_log_mask(CPU_LOG_MMU, "direct store...\n");
228 if ((sr & 0x1FF00000) >> 20 == 0x07f) {
229 /* Memory-forced I/O controller interface access */
230 /* If T=1 and BUID=x'07F', the 601 performs a memory access
231 * to SR[28-31] LA[4-31], bypassing all protection mechanisms.
233 *raddr = ((sr & 0xF) << 28) | (eaddr & 0x0FFFFFFF);
234 *prot = PAGE_READ | PAGE_WRITE | PAGE_EXEC;
235 return 0;
238 if (rwx == 2) {
239 /* No code fetch is allowed in direct-store areas */
240 cs->exception_index = POWERPC_EXCP_ISI;
241 env->error_code = 0x10000000;
242 return 1;
245 switch (env->access_type) {
246 case ACCESS_INT:
247 /* Integer load/store : only access allowed */
248 break;
249 case ACCESS_FLOAT:
250 /* Floating point load/store */
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 /* lwarx, ldarx or srwcx. */
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;
264 return 1;
265 case ACCESS_CACHE:
266 /* dcba, dcbt, dcbtst, dcbf, dcbi, dcbst, dcbz, or icbi */
267 /* Should make the instruction do no-op.
268 * As it already do no-op, it's quite easy :-)
270 *raddr = eaddr;
271 return 0;
272 case ACCESS_EXT:
273 /* eciwx or ecowx */
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;
282 return 1;
283 default:
284 qemu_log("ERROR: instruction should not need "
285 "address translation\n");
286 abort();
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;
300 return 1;
304 hwaddr get_pteg_offset32(CPUPPCState *env, hwaddr hash)
306 return (hash * HASH_PTEG_SIZE_32) & env->htab_mask;
309 static hwaddr ppc_hash32_pteg_search(CPUPPCState *env, hwaddr pteg_off,
310 bool secondary, target_ulong ptem,
311 ppc_hash_pte32_t *pte)
313 hwaddr pte_offset = pteg_off;
314 target_ulong pte0, pte1;
315 int i;
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);
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;
329 pte_offset += HASH_PTE_SIZE_32;
332 return -1;
335 static hwaddr ppc_hash32_htab_lookup(CPUPPCState *env,
336 target_ulong sr, target_ulong eaddr,
337 ppc_hash_pte32_t *pte)
339 hwaddr pteg_off, pte_offset;
340 hwaddr hash;
341 uint32_t vsid, pgidx, ptem;
343 vsid = sr & SR32_VSID;
344 pgidx = (eaddr & ~SEGMENT_MASK_256M) >> TARGET_PAGE_BITS;
345 hash = vsid ^ pgidx;
346 ptem = (vsid << 7) | (pgidx >> 10);
348 /* Page address translation */
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);
354 /* Primary PTEG lookup */
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 /* Secondary PTEG lookup */
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);
371 return pte_offset;
374 static hwaddr ppc_hash32_pte_raddr(target_ulong sr, ppc_hash_pte32_t pte,
375 target_ulong eaddr)
377 hwaddr rpn = pte.pte1 & HPTE32_R_RPN;
378 hwaddr mask = ~TARGET_PAGE_MASK;
380 return (rpn & ~mask) | (eaddr & mask);
383 int ppc_hash32_handle_mmu_fault(PowerPCCPU *cpu, target_ulong eaddr, int rwx,
384 int mmu_idx)
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;
396 assert((rwx == 0) || (rwx == 1) || (rwx == 2));
398 /* 1. Handle real mode accesses */
399 if (((rwx == 2) && (msr_ir == 0)) || ((rwx != 2) && (msr_dr == 0))) {
400 /* Translation is off */
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;
408 /* 2. Check Block Address Translation entries (BATs) */
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;
426 return 1;
429 tlb_set_page(cs, eaddr & TARGET_PAGE_MASK,
430 raddr & TARGET_PAGE_MASK, prot, mmu_idx,
431 TARGET_PAGE_SIZE);
432 return 0;
436 /* 3. Look up the Segment Register */
437 sr = env->sr[eaddr >> 28];
439 /* 4. Handle direct store segments */
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;
452 /* 5. Check for segment level no-execute violation */
453 if ((rwx == 2) && (sr & SR32_NX)) {
454 cs->exception_index = POWERPC_EXCP_ISI;
455 env->error_code = 0x10000000;
456 return 1;
459 /* 6. Locate the PTE in the hash table */
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;
476 return 1;
478 qemu_log_mask(CPU_LOG_MMU,
479 "found PTE at offset %08" HWADDR_PRIx "\n", pte_offset);
481 /* 7. Check access permissions */
483 prot = ppc_hash32_pte_prot(env, sr, pte);
485 if (need_prot[rwx] & ~prot) {
486 /* Access right violation */
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;
501 return 1;
504 qemu_log_mask(CPU_LOG_MMU, "PTE access granted !\n");
506 /* 8. Update PTE referenced and changed bits if necessary */
508 new_pte1 = pte.pte1 | HPTE32_R_R; /* set referenced bit */
509 if (rwx == 1) {
510 new_pte1 |= HPTE32_R_C; /* set changed (dirty) bit */
511 } else {
512 /* Treat the page as read-only for now, so that a later write
513 * will pass through this function again to set the C bit */
514 prot &= ~PAGE_WRITE;
517 if (new_pte1 != pte.pte1) {
518 ppc_hash32_store_hpte1(env, pte_offset, new_pte1);
521 /* 9. Determine the real address from the PTE */
523 raddr = ppc_hash32_pte_raddr(sr, pte, eaddr);
525 tlb_set_page(cs, eaddr & TARGET_PAGE_MASK, raddr & TARGET_PAGE_MASK,
526 prot, mmu_idx, TARGET_PAGE_SIZE);
528 return 0;
531 hwaddr ppc_hash32_get_phys_page_debug(CPUPPCState *env, target_ulong eaddr)
533 target_ulong sr;
534 hwaddr pte_offset;
535 ppc_hash_pte32_t pte;
536 int prot;
538 if (msr_dr == 0) {
539 /* Translation is off */
540 return eaddr;
543 if (env->nb_BATs != 0) {
544 hwaddr raddr = ppc_hash32_bat_lookup(env, eaddr, 0, &prot);
545 if (raddr != -1) {
546 return raddr;
550 sr = env->sr[eaddr >> 28];
552 if (sr & SR32_T) {
553 /* FIXME: Add suitable debug support for Direct Store segments */
554 return -1;
557 pte_offset = ppc_hash32_htab_lookup(env, sr, eaddr, &pte);
558 if (pte_offset == -1) {
559 return -1;
562 return ppc_hash32_pte_raddr(sr, pte, eaddr) & TARGET_PAGE_MASK;