helper.c 12 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/*
 *  sparc helpers
 * 
 *  Copyright (c) 2003 Fabrice Bellard
 *
 * 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
 */
#include "exec.h"

bellard's avatar
bellard committed
22 23
//#define DEBUG_PCALL
//#define DEBUG_MMU
24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40

/* Sparc MMU emulation */

/* thread support */

spinlock_t global_cpu_lock = SPIN_LOCK_UNLOCKED;

void cpu_lock(void)
{
    spin_lock(&global_cpu_lock);
}

void cpu_unlock(void)
{
    spin_unlock(&global_cpu_lock);
}

bellard's avatar
bellard committed
41 42 43 44 45 46
#if defined(CONFIG_USER_ONLY) 

int cpu_sparc_handle_mmu_fault(CPUState *env, target_ulong address, int rw,
                               int is_user, int is_softmmu)
{
    env->mmuregs[4] = address;
bellard's avatar
bellard committed
47 48 49 50
    if (rw & 2)
        env->exception_index = TT_TFAULT;
    else
        env->exception_index = TT_DFAULT;
bellard's avatar
bellard committed
51 52 53 54
    return 1;
}

#else
55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75

#define MMUSUFFIX _mmu
#define GETPC() (__builtin_return_address(0))

#define SHIFT 0
#include "softmmu_template.h"

#define SHIFT 1
#include "softmmu_template.h"

#define SHIFT 2
#include "softmmu_template.h"

#define SHIFT 3
#include "softmmu_template.h"


/* try to fill the TLB and return an exception if error. If retaddr is
   NULL, it means that the function was called in C code (i.e. not
   from generated code or from helper.c) */
/* XXX: fix it to restore all registers */
bellard's avatar
bellard committed
76
void tlb_fill(target_ulong addr, int is_write, int is_user, void *retaddr)
77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99
{
    TranslationBlock *tb;
    int ret;
    unsigned long pc;
    CPUState *saved_env;

    /* XXX: hack to restore env in all cases, even if not called from
       generated code */
    saved_env = env;
    env = cpu_single_env;

    ret = cpu_sparc_handle_mmu_fault(env, addr, is_write, is_user, 1);
    if (ret) {
        if (retaddr) {
            /* now we have a real cpu fault */
            pc = (unsigned long)retaddr;
            tb = tb_find_pc(pc);
            if (tb) {
                /* the PC is inside the translated code. It means that we have
                   a virtual CPU fault */
                cpu_restore_state(tb, env, pc, NULL);
            }
        }
bellard's avatar
bellard committed
100
        cpu_loop_exit();
101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121
    }
    env = saved_env;
}

static const int access_table[8][8] = {
    { 0, 0, 0, 0, 2, 0, 3, 3 },
    { 0, 0, 0, 0, 2, 0, 0, 0 },
    { 2, 2, 0, 0, 0, 2, 3, 3 },
    { 2, 2, 0, 0, 0, 2, 0, 0 },
    { 2, 0, 2, 0, 2, 2, 3, 3 },
    { 2, 0, 2, 0, 2, 0, 2, 0 },
    { 2, 2, 2, 0, 2, 2, 3, 3 },
    { 2, 2, 2, 0, 2, 2, 2, 0 }
};

/* 1 = write OK */
static const int rw_table[2][8] = {
    { 0, 1, 0, 1, 0, 1, 0, 1 },
    { 0, 1, 0, 1, 0, 0, 0, 0 }
};

122 123
int get_physical_address (CPUState *env, target_phys_addr_t *physical, int *prot,
			  int *access_index, target_ulong address, int rw,
bellard's avatar
bellard committed
124
			  int is_user)
125
{
bellard's avatar
bellard committed
126 127
    int access_perms = 0;
    target_phys_addr_t pde_ptr;
128 129
    uint32_t pde;
    target_ulong virt_addr;
bellard's avatar
bellard committed
130 131
    int error_code = 0, is_dirty;
    unsigned long page_offset;
132 133 134

    virt_addr = address & TARGET_PAGE_MASK;
    if ((env->mmuregs[0] & MMU_E) == 0) { /* MMU disabled */
bellard's avatar
bellard committed
135 136 137
	*physical = address;
        *prot = PAGE_READ | PAGE_WRITE;
        return 0;
138 139
    }

bellard's avatar
bellard committed
140 141
    *access_index = ((rw & 1) << 2) | (rw & 2) | (is_user? 0 : 1);

142 143
    /* SPARC reference MMU table walk: Context table->L1->L2->PTE */
    /* Context base + context number */
bellard's avatar
bellard committed
144
    pde_ptr = (env->mmuregs[1] << 4) + (env->mmuregs[2] << 4);
bellard's avatar
bellard committed
145
    pde = ldl_phys(pde_ptr);
146 147 148

    /* Ctx pde */
    switch (pde & PTE_ENTRYTYPE_MASK) {
bellard's avatar
bellard committed
149
    default:
150
    case 0: /* Invalid */
bellard's avatar
bellard committed
151
	return 1 << 2;
bellard's avatar
bellard committed
152
    case 2: /* L0 PTE, maybe should not happen? */
153
    case 3: /* Reserved */
bellard's avatar
bellard committed
154
        return 4 << 2;
bellard's avatar
bellard committed
155 156
    case 1: /* L0 PDE */
	pde_ptr = ((address >> 22) & ~3) + ((pde & ~3) << 4);
bellard's avatar
bellard committed
157
        pde = ldl_phys(pde_ptr);
158 159

	switch (pde & PTE_ENTRYTYPE_MASK) {
bellard's avatar
bellard committed
160
	default:
161
	case 0: /* Invalid */
bellard's avatar
bellard committed
162
	    return (1 << 8) | (1 << 2);
163
	case 3: /* Reserved */
bellard's avatar
bellard committed
164
	    return (1 << 8) | (4 << 2);
bellard's avatar
bellard committed
165 166
	case 1: /* L1 PDE */
	    pde_ptr = ((address & 0xfc0000) >> 16) + ((pde & ~3) << 4);
bellard's avatar
bellard committed
167
            pde = ldl_phys(pde_ptr);
168 169

	    switch (pde & PTE_ENTRYTYPE_MASK) {
bellard's avatar
bellard committed
170
	    default:
171
	    case 0: /* Invalid */
bellard's avatar
bellard committed
172
		return (2 << 8) | (1 << 2);
173
	    case 3: /* Reserved */
bellard's avatar
bellard committed
174
		return (2 << 8) | (4 << 2);
bellard's avatar
bellard committed
175 176
	    case 1: /* L2 PDE */
		pde_ptr = ((address & 0x3f000) >> 10) + ((pde & ~3) << 4);
bellard's avatar
bellard committed
177
                pde = ldl_phys(pde_ptr);
178 179

		switch (pde & PTE_ENTRYTYPE_MASK) {
bellard's avatar
bellard committed
180
		default:
181
		case 0: /* Invalid */
bellard's avatar
bellard committed
182
		    return (3 << 8) | (1 << 2);
183 184
		case 1: /* PDE, should not happen */
		case 3: /* Reserved */
bellard's avatar
bellard committed
185
		    return (3 << 8) | (4 << 2);
186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202
		case 2: /* L3 PTE */
		    virt_addr = address & TARGET_PAGE_MASK;
		    page_offset = (address & TARGET_PAGE_MASK) & (TARGET_PAGE_SIZE - 1);
		}
		break;
	    case 2: /* L2 PTE */
		virt_addr = address & ~0x3ffff;
		page_offset = address & 0x3ffff;
	    }
	    break;
	case 2: /* L1 PTE */
	    virt_addr = address & ~0xffffff;
	    page_offset = address & 0xffffff;
	}
    }

    /* update page modified and dirty bits */
bellard's avatar
bellard committed
203
    is_dirty = (rw & 1) && !(pde & PG_MODIFIED_MASK);
204 205 206 207
    if (!(pde & PG_ACCESSED_MASK) || is_dirty) {
	pde |= PG_ACCESSED_MASK;
	if (is_dirty)
	    pde |= PG_MODIFIED_MASK;
bellard's avatar
bellard committed
208
        stl_phys_notdirty(pde_ptr, pde);
209 210 211
    }
    /* check access */
    access_perms = (pde & PTE_ACCESS_MASK) >> PTE_ACCESS_SHIFT;
bellard's avatar
bellard committed
212
    error_code = access_table[*access_index][access_perms];
213
    if (error_code)
bellard's avatar
bellard committed
214
	return error_code;
215 216

    /* the page can be put in the TLB */
bellard's avatar
bellard committed
217
    *prot = PAGE_READ;
218 219 220 221
    if (pde & PG_MODIFIED_MASK) {
        /* only set write access if already dirty... otherwise wait
           for dirty access */
	if (rw_table[is_user][access_perms])
bellard's avatar
bellard committed
222
	        *prot |= PAGE_WRITE;
223 224 225 226
    }

    /* Even if large ptes, we map only one 4KB page in the cache to
       avoid filling it too fast */
bellard's avatar
bellard committed
227 228 229 230 231
    *physical = ((pde & PTE_ADDR_MASK) << 4) + page_offset;
    return 0;
}

/* Perform address translation */
232
int cpu_sparc_handle_mmu_fault (CPUState *env, target_ulong address, int rw,
bellard's avatar
bellard committed
233 234
                              int is_user, int is_softmmu)
{
235 236
    target_ulong virt_addr;
    target_phys_addr_t paddr;
bellard's avatar
bellard committed
237 238
    unsigned long vaddr;
    int error_code = 0, prot, ret = 0, access_index;
239

bellard's avatar
bellard committed
240 241 242 243 244 245 246
    error_code = get_physical_address(env, &paddr, &prot, &access_index, address, rw, is_user);
    if (error_code == 0) {
	virt_addr = address & TARGET_PAGE_MASK;
	vaddr = virt_addr + ((address & TARGET_PAGE_MASK) & (TARGET_PAGE_SIZE - 1));
	ret = tlb_set_page(env, vaddr, paddr, prot, is_user, is_softmmu);
	return ret;
    }
247 248 249

    if (env->mmuregs[3]) /* Fault status register */
	env->mmuregs[3] = 1; /* overflow (not read before another fault) */
bellard's avatar
bellard committed
250
    env->mmuregs[3] |= (access_index << 5) | error_code | 2;
251 252
    env->mmuregs[4] = address; /* Fault address register */

bellard's avatar
bellard committed
253
    if ((env->mmuregs[0] & MMU_NF) || env->psret == 0)  {
bellard's avatar
bellard committed
254
#if 0
bellard's avatar
bellard committed
255
        // No fault
bellard's avatar
bellard committed
256 257 258 259 260 261 262 263 264 265 266 267 268 269 270
	vaddr = address & TARGET_PAGE_MASK;
        paddr = 0xfffff000;
        prot = PAGE_READ | PAGE_WRITE;
        ret = tlb_set_page(env, vaddr, paddr, prot, is_user, is_softmmu);
	return ret;
#else
        cpu_abort(env, "MMU no fault case no handled");
        return 0;
#endif
    } else {
        if (rw & 2)
            env->exception_index = TT_TFAULT;
        else
            env->exception_index = TT_DFAULT;
        return 1;
bellard's avatar
bellard committed
271
    }
272
}
bellard's avatar
bellard committed
273
#endif
274

275
void memcpy32(target_ulong *dst, const target_ulong *src)
276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298
{
    dst[0] = src[0];
    dst[1] = src[1];
    dst[2] = src[2];
    dst[3] = src[3];
    dst[4] = src[4];
    dst[5] = src[5];
    dst[6] = src[6];
    dst[7] = src[7];
}

void set_cwp(int new_cwp)
{
    /* put the modified wrap registers at their proper location */
    if (env->cwp == (NWINDOWS - 1))
        memcpy32(env->regbase, env->regbase + NWINDOWS * 16);
    env->cwp = new_cwp;
    /* put the wrap registers at their temporary location */
    if (new_cwp == (NWINDOWS - 1))
        memcpy32(env->regbase + NWINDOWS * 16, env->regbase);
    env->regwptr = env->regbase + (new_cwp * 16);
}

bellard's avatar
bellard committed
299 300 301 302 303 304 305 306 307
void cpu_set_cwp(CPUState *env1, int new_cwp)
{
    CPUState *saved_env;
    saved_env = env;
    env = env1;
    set_cwp(new_cwp);
    env = saved_env;
}

bellard's avatar
bellard committed
308
void do_interrupt(int intno)
309 310 311 312 313 314
{
    int cwp;

#ifdef DEBUG_PCALL
    if (loglevel & CPU_LOG_INT) {
	static int count;
bellard's avatar
bellard committed
315 316
	fprintf(logfile, "%6d: v=%02x pc=%08x npc=%08x SP=%08x\n",
                count, intno,
bellard's avatar
bellard committed
317 318
                env->pc,
                env->npc, env->regwptr[6]);
bellard's avatar
bellard committed
319
#if 1
bellard's avatar
bellard committed
320
	cpu_dump_state(env, logfile, fprintf, 0);
321 322 323
	{
	    int i;
	    uint8_t *ptr;
bellard's avatar
bellard committed
324

325
	    fprintf(logfile, "       code=");
bellard's avatar
bellard committed
326
	    ptr = (uint8_t *)env->pc;
327 328 329 330 331 332 333 334
	    for(i = 0; i < 16; i++) {
		fprintf(logfile, " %02x", ldub(ptr + i));
	    }
	    fprintf(logfile, "\n");
	}
#endif
	count++;
    }
bellard's avatar
bellard committed
335 336 337
#endif
#if !defined(CONFIG_USER_ONLY) 
    if (env->psret == 0) {
bellard's avatar
bellard committed
338
        cpu_abort(cpu_single_env, "Trap 0x%02x while interrupts disabled, Error state", env->exception_index);
bellard's avatar
bellard committed
339 340
	return;
    }
341 342 343 344
#endif
    env->psret = 0;
    cwp = (env->cwp - 1) & (NWINDOWS - 1); 
    set_cwp(cwp);
bellard's avatar
bellard committed
345 346
    env->regwptr[9] = env->pc;
    env->regwptr[10] = env->npc;
347 348 349 350 351 352 353 354
    env->psrps = env->psrs;
    env->psrs = 1;
    env->tbr = (env->tbr & TBR_BASE_MASK) | (intno << 4);
    env->pc = env->tbr;
    env->npc = env->pc + 4;
    env->exception_index = 0;
}

355
target_ulong mmu_probe(target_ulong address, int mmulev)
bellard's avatar
bellard committed
356 357 358 359 360 361
{
    target_phys_addr_t pde_ptr;
    uint32_t pde;

    /* Context base + context number */
    pde_ptr = (env->mmuregs[1] << 4) + (env->mmuregs[2] << 4);
bellard's avatar
bellard committed
362 363
    pde = ldl_phys(pde_ptr);

bellard's avatar
bellard committed
364 365 366 367 368 369 370 371 372 373
    switch (pde & PTE_ENTRYTYPE_MASK) {
    default:
    case 0: /* Invalid */
    case 2: /* PTE, maybe should not happen? */
    case 3: /* Reserved */
	return 0;
    case 1: /* L1 PDE */
	if (mmulev == 3)
	    return pde;
	pde_ptr = ((address >> 22) & ~3) + ((pde & ~3) << 4);
bellard's avatar
bellard committed
374
        pde = ldl_phys(pde_ptr);
bellard's avatar
bellard committed
375 376 377 378 379 380 381 382 383 384 385 386

	switch (pde & PTE_ENTRYTYPE_MASK) {
	default:
	case 0: /* Invalid */
	case 3: /* Reserved */
	    return 0;
	case 2: /* L1 PTE */
	    return pde;
	case 1: /* L2 PDE */
	    if (mmulev == 2)
		return pde;
	    pde_ptr = ((address & 0xfc0000) >> 16) + ((pde & ~3) << 4);
bellard's avatar
bellard committed
387
            pde = ldl_phys(pde_ptr);
bellard's avatar
bellard committed
388 389 390 391 392 393 394 395 396 397 398 399

	    switch (pde & PTE_ENTRYTYPE_MASK) {
	    default:
	    case 0: /* Invalid */
	    case 3: /* Reserved */
		return 0;
	    case 2: /* L2 PTE */
		return pde;
	    case 1: /* L3 PDE */
		if (mmulev == 1)
		    return pde;
		pde_ptr = ((address & 0x3f000) >> 10) + ((pde & ~3) << 4);
bellard's avatar
bellard committed
400
                pde = ldl_phys(pde_ptr);
bellard's avatar
bellard committed
401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416

		switch (pde & PTE_ENTRYTYPE_MASK) {
		default:
		case 0: /* Invalid */
		case 1: /* PDE, should not happen */
		case 3: /* Reserved */
		    return 0;
		case 2: /* L3 PTE */
		    return pde;
		}
	    }
	}
    }
    return 0;
}

bellard's avatar
bellard committed
417
#ifdef DEBUG_MMU
bellard's avatar
bellard committed
418 419
void dump_mmu(void)
{
420 421 422
     target_ulong va, va1, va2;
     unsigned int n, m, o;
     target_phys_addr_t pde_ptr, pa;
bellard's avatar
bellard committed
423 424 425 426
    uint32_t pde;

    printf("MMU dump:\n");
    pde_ptr = (env->mmuregs[1] << 4) + (env->mmuregs[2] << 4);
bellard's avatar
bellard committed
427
    pde = ldl_phys(pde_ptr);
428
    printf("Root ptr: " TARGET_FMT_lx ", ctx: %d\n", env->mmuregs[1] << 4, env->mmuregs[2]);
bellard's avatar
bellard committed
429 430 431 432
    for (n = 0, va = 0; n < 256; n++, va += 16 * 1024 * 1024) {
	pde_ptr = mmu_probe(va, 2);
	if (pde_ptr) {
	    pa = cpu_get_phys_page_debug(env, va);
433
 	    printf("VA: " TARGET_FMT_lx ", PA: " TARGET_FMT_lx " PDE: " TARGET_FMT_lx "\n", va, pa, pde_ptr);
bellard's avatar
bellard committed
434 435 436 437
	    for (m = 0, va1 = va; m < 64; m++, va1 += 256 * 1024) {
		pde_ptr = mmu_probe(va1, 1);
		if (pde_ptr) {
		    pa = cpu_get_phys_page_debug(env, va1);
438
 		    printf(" VA: " TARGET_FMT_lx ", PA: " TARGET_FMT_lx " PDE: " TARGET_FMT_lx "\n", va1, pa, pde_ptr);
bellard's avatar
bellard committed
439 440 441 442
		    for (o = 0, va2 = va1; o < 64; o++, va2 += 4 * 1024) {
			pde_ptr = mmu_probe(va2, 0);
			if (pde_ptr) {
			    pa = cpu_get_phys_page_debug(env, va2);
443
 			    printf("  VA: " TARGET_FMT_lx ", PA: " TARGET_FMT_lx " PTE: " TARGET_FMT_lx "\n", va2, pa, pde_ptr);
bellard's avatar
bellard committed
444 445 446 447 448 449 450 451
			}
		    }
		}
	    }
	}
    }
    printf("MMU dump ends\n");
}
bellard's avatar
bellard committed
452
#endif