/* * CRIS mmu emulation. * * Copyright (c) 2007 AXIS Communications AB * Written by Edgar E. Iglesias. * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License as published by the Free Software Foundation; either * version 2 of the License, or (at your option) any later version. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public * License along with this library; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ #ifndef CONFIG_USER_ONLY #include <stdio.h> #include <string.h> #include <stdlib.h> #include "config.h" #include "cpu.h" #include "mmu.h" #include "exec-all.h" static int cris_mmu_enabled(uint32_t rw_gc_cfg) { return (rw_gc_cfg & 12) != 0; } static int cris_mmu_segmented_addr(int seg, uint32_t rw_mm_cfg) { return (1 << seg) & rw_mm_cfg; } static uint32_t cris_mmu_translate_seg(CPUState *env, int seg) { uint32_t base; int i; if (seg < 8) base = env->sregs[SFR_RW_MM_KBASE_LO]; else base = env->sregs[SFR_RW_MM_KBASE_HI]; i = seg & 7; base >>= i * 4; base &= 15; base <<= 28; return base; } /* Used by the tlb decoder. */ #define EXTRACT_FIELD(src, start, end) \ (((src) >> start) & ((1 << (end - start + 1)) - 1)) static int cris_mmu_translate_page(struct cris_mmu_result_t *res, CPUState *env, uint32_t vaddr, int rw, int usermode) { unsigned int vpage; unsigned int idx; uint32_t lo, hi; uint32_t vpn, pfn = 0, pid, fg, fv, fk, fw, fx; int i, match = 0; vpage = vaddr >> 13; idx = vpage & 31; vpage >>= 4; /* We know the index which to check on each set. Scan both I and D. */ for (i = 0; i < 4; i++) { lo = env->tlbsets[0][i][idx].lo; hi = env->tlbsets[0][i][idx].hi; vpn = EXTRACT_FIELD(hi, 13, 31); pid = EXTRACT_FIELD(hi, 0, 7); if (vpn == vpage && pid == env->pregs[SR_PID]) { match = 1; break; } } if (match) { pfn = EXTRACT_FIELD(lo, 13, 31); fg = EXTRACT_FIELD(lo, 4, 4); fv = EXTRACT_FIELD(lo, 3, 3); fk = EXTRACT_FIELD(lo, 2, 2); fw = EXTRACT_FIELD(lo, 1, 1); fx = EXTRACT_FIELD(lo, 0, 0); } printf ("%s match=%d vaddr=%x vpage=%x vpn=%x pfn=%x pid=%x %x\n", __func__, match, vaddr, vpage, vpn, pfn, pid, env->pregs[SR_PID]); res->pfn = pfn; return !match; } int cris_mmu_translate(struct cris_mmu_result_t *res, CPUState *env, uint32_t vaddr, int rw, int mmu_idx) { uint32_t phy = vaddr; int seg; int miss = 0; int is_user = mmu_idx == MMU_USER_IDX; if (!cris_mmu_enabled(env->sregs[SFR_RW_GC_CFG])) { res->phy = vaddr; return 0; } seg = vaddr >> 28; if (cris_mmu_segmented_addr(seg, env->sregs[SFR_RW_MM_CFG])) { uint32_t base; miss = 0; base = cris_mmu_translate_seg(env, seg); phy = base | (0x0fffffff & vaddr); res->phy = phy; } else { miss = cris_mmu_translate_page(res, env, vaddr, rw, is_user); if (!miss) { phy &= 8191; phy |= (res->pfn << 13); res->phy = phy; } } // printf ("miss=%d v=%x -> p=%x\n", miss, vaddr, phy); return miss; } #endif