/* *  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