Commit ab93bbe2aebebce9901e740b1000058f74c15e26
1 parent
0f0b7264
soft mmu support
git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@349 c046a42c-6fe2-441c-8c8c-71466251a162
Showing
4 changed files
with
579 additions
and
0 deletions
bswap.h
0 → 100644
| 1 | +#ifndef BSWAP_H | ||
| 2 | +#define BSWAP_H | ||
| 3 | + | ||
| 4 | +#include "config-host.h" | ||
| 5 | + | ||
| 6 | +#include <inttypes.h> | ||
| 7 | + | ||
| 8 | +#ifdef HAVE_BYTESWAP_H | ||
| 9 | +#include <byteswap.h> | ||
| 10 | +#else | ||
| 11 | + | ||
| 12 | +#define bswap_16(x) \ | ||
| 13 | +({ \ | ||
| 14 | + uint16_t __x = (x); \ | ||
| 15 | + ((uint16_t)( \ | ||
| 16 | + (((uint16_t)(__x) & (uint16_t)0x00ffU) << 8) | \ | ||
| 17 | + (((uint16_t)(__x) & (uint16_t)0xff00U) >> 8) )); \ | ||
| 18 | +}) | ||
| 19 | + | ||
| 20 | +#define bswap_32(x) \ | ||
| 21 | +({ \ | ||
| 22 | + uint32_t __x = (x); \ | ||
| 23 | + ((uint32_t)( \ | ||
| 24 | + (((uint32_t)(__x) & (uint32_t)0x000000ffUL) << 24) | \ | ||
| 25 | + (((uint32_t)(__x) & (uint32_t)0x0000ff00UL) << 8) | \ | ||
| 26 | + (((uint32_t)(__x) & (uint32_t)0x00ff0000UL) >> 8) | \ | ||
| 27 | + (((uint32_t)(__x) & (uint32_t)0xff000000UL) >> 24) )); \ | ||
| 28 | +}) | ||
| 29 | + | ||
| 30 | +#define bswap_64(x) \ | ||
| 31 | +({ \ | ||
| 32 | + uint64_t __x = (x); \ | ||
| 33 | + ((uint64_t)( \ | ||
| 34 | + (uint64_t)(((uint64_t)(__x) & (uint64_t)0x00000000000000ffULL) << 56) | \ | ||
| 35 | + (uint64_t)(((uint64_t)(__x) & (uint64_t)0x000000000000ff00ULL) << 40) | \ | ||
| 36 | + (uint64_t)(((uint64_t)(__x) & (uint64_t)0x0000000000ff0000ULL) << 24) | \ | ||
| 37 | + (uint64_t)(((uint64_t)(__x) & (uint64_t)0x00000000ff000000ULL) << 8) | \ | ||
| 38 | + (uint64_t)(((uint64_t)(__x) & (uint64_t)0x000000ff00000000ULL) >> 8) | \ | ||
| 39 | + (uint64_t)(((uint64_t)(__x) & (uint64_t)0x0000ff0000000000ULL) >> 24) | \ | ||
| 40 | + (uint64_t)(((uint64_t)(__x) & (uint64_t)0x00ff000000000000ULL) >> 40) | \ | ||
| 41 | + (uint64_t)(((uint64_t)(__x) & (uint64_t)0xff00000000000000ULL) >> 56) )); \ | ||
| 42 | +}) | ||
| 43 | + | ||
| 44 | +#endif /* !HAVE_BYTESWAP_H */ | ||
| 45 | + | ||
| 46 | +#if defined(__alpha__) || defined (__ia64__) | ||
| 47 | +#define HOST_LONG_BITS 64 | ||
| 48 | +#else | ||
| 49 | +#define HOST_LONG_BITS 32 | ||
| 50 | +#endif | ||
| 51 | + | ||
| 52 | +#define HOST_LONG_SIZE (HOST_LONG_BITS / 8) | ||
| 53 | + | ||
| 54 | +static inline uint16_t bswap16(uint16_t x) | ||
| 55 | +{ | ||
| 56 | + return bswap_16(x); | ||
| 57 | +} | ||
| 58 | + | ||
| 59 | +static inline uint32_t bswap32(uint32_t x) | ||
| 60 | +{ | ||
| 61 | + return bswap_32(x); | ||
| 62 | +} | ||
| 63 | + | ||
| 64 | +static inline uint64_t bswap64(uint64_t x) | ||
| 65 | +{ | ||
| 66 | + return bswap_64(x); | ||
| 67 | +} | ||
| 68 | + | ||
| 69 | +static inline void bswap16s(uint16_t *s) | ||
| 70 | +{ | ||
| 71 | + *s = bswap16(*s); | ||
| 72 | +} | ||
| 73 | + | ||
| 74 | +static inline void bswap32s(uint32_t *s) | ||
| 75 | +{ | ||
| 76 | + *s = bswap32(*s); | ||
| 77 | +} | ||
| 78 | + | ||
| 79 | +static inline void bswap64s(uint64_t *s) | ||
| 80 | +{ | ||
| 81 | + *s = bswap64(*s); | ||
| 82 | +} | ||
| 83 | + | ||
| 84 | +#endif /* BSWAP_H */ |
cpu-defs.h
0 → 100644
| 1 | +/* | ||
| 2 | + * common defines for all CPUs | ||
| 3 | + * | ||
| 4 | + * Copyright (c) 2003 Fabrice Bellard | ||
| 5 | + * | ||
| 6 | + * This library is free software; you can redistribute it and/or | ||
| 7 | + * modify it under the terms of the GNU Lesser General Public | ||
| 8 | + * License as published by the Free Software Foundation; either | ||
| 9 | + * version 2 of the License, or (at your option) any later version. | ||
| 10 | + * | ||
| 11 | + * This library is distributed in the hope that it will be useful, | ||
| 12 | + * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 13 | + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
| 14 | + * Lesser General Public License for more details. | ||
| 15 | + * | ||
| 16 | + * You should have received a copy of the GNU Lesser General Public | ||
| 17 | + * License along with this library; if not, write to the Free Software | ||
| 18 | + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 19 | + */ | ||
| 20 | +#ifndef CPU_DEFS_H | ||
| 21 | +#define CPU_DEFS_H | ||
| 22 | + | ||
| 23 | +#include "config.h" | ||
| 24 | +#include <setjmp.h> | ||
| 25 | + | ||
| 26 | +#define EXCP_INTERRUPT 256 /* async interruption */ | ||
| 27 | +#define EXCP_HLT 257 /* hlt instruction reached */ | ||
| 28 | +#define EXCP_DEBUG 258 /* cpu stopped after a breakpoint or singlestep */ | ||
| 29 | + | ||
| 30 | +#define MAX_BREAKPOINTS 32 | ||
| 31 | + | ||
| 32 | +#define CPU_TLB_SIZE 256 | ||
| 33 | + | ||
| 34 | +typedef struct CPUTLBEntry { | ||
| 35 | + uint32_t address; | ||
| 36 | + uint32_t addend; | ||
| 37 | +} CPUTLBEntry; | ||
| 38 | + | ||
| 39 | +#endif |
helper2-i386.c
0 → 100644
| 1 | +/* | ||
| 2 | + * i386 helpers (without register variable usage) | ||
| 3 | + * | ||
| 4 | + * Copyright (c) 2003 Fabrice Bellard | ||
| 5 | + * | ||
| 6 | + * This library is free software; you can redistribute it and/or | ||
| 7 | + * modify it under the terms of the GNU Lesser General Public | ||
| 8 | + * License as published by the Free Software Foundation; either | ||
| 9 | + * version 2 of the License, or (at your option) any later version. | ||
| 10 | + * | ||
| 11 | + * This library is distributed in the hope that it will be useful, | ||
| 12 | + * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 13 | + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
| 14 | + * Lesser General Public License for more details. | ||
| 15 | + * | ||
| 16 | + * You should have received a copy of the GNU Lesser General Public | ||
| 17 | + * License along with this library; if not, write to the Free Software | ||
| 18 | + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 19 | + */ | ||
| 20 | +#include <stdarg.h> | ||
| 21 | +#include <stdlib.h> | ||
| 22 | +#include <stdio.h> | ||
| 23 | +#include <string.h> | ||
| 24 | +#include <inttypes.h> | ||
| 25 | +#include <signal.h> | ||
| 26 | +#include <assert.h> | ||
| 27 | +#include <sys/mman.h> | ||
| 28 | + | ||
| 29 | +#include "cpu-i386.h" | ||
| 30 | +#include "exec.h" | ||
| 31 | + | ||
| 32 | +//#define DEBUG_MMU | ||
| 33 | + | ||
| 34 | +CPUX86State *cpu_x86_init(void) | ||
| 35 | +{ | ||
| 36 | + CPUX86State *env; | ||
| 37 | + int i; | ||
| 38 | + static int inited; | ||
| 39 | + | ||
| 40 | + cpu_exec_init(); | ||
| 41 | + | ||
| 42 | + env = malloc(sizeof(CPUX86State)); | ||
| 43 | + if (!env) | ||
| 44 | + return NULL; | ||
| 45 | + memset(env, 0, sizeof(CPUX86State)); | ||
| 46 | + /* basic FPU init */ | ||
| 47 | + for(i = 0;i < 8; i++) | ||
| 48 | + env->fptags[i] = 1; | ||
| 49 | + env->fpuc = 0x37f; | ||
| 50 | + /* flags setup : we activate the IRQs by default as in user mode */ | ||
| 51 | + env->eflags = 0x2 | IF_MASK; | ||
| 52 | + | ||
| 53 | + tlb_flush(env); | ||
| 54 | +#ifdef CONFIG_SOFTMMU | ||
| 55 | + env->soft_mmu = 1; | ||
| 56 | +#endif | ||
| 57 | + /* init various static tables */ | ||
| 58 | + if (!inited) { | ||
| 59 | + inited = 1; | ||
| 60 | + optimize_flags_init(); | ||
| 61 | + } | ||
| 62 | + return env; | ||
| 63 | +} | ||
| 64 | + | ||
| 65 | +void cpu_x86_close(CPUX86State *env) | ||
| 66 | +{ | ||
| 67 | + free(env); | ||
| 68 | +} | ||
| 69 | + | ||
| 70 | +/***********************************************************/ | ||
| 71 | +/* x86 debug */ | ||
| 72 | + | ||
| 73 | +static const char *cc_op_str[] = { | ||
| 74 | + "DYNAMIC", | ||
| 75 | + "EFLAGS", | ||
| 76 | + "MUL", | ||
| 77 | + "ADDB", | ||
| 78 | + "ADDW", | ||
| 79 | + "ADDL", | ||
| 80 | + "ADCB", | ||
| 81 | + "ADCW", | ||
| 82 | + "ADCL", | ||
| 83 | + "SUBB", | ||
| 84 | + "SUBW", | ||
| 85 | + "SUBL", | ||
| 86 | + "SBBB", | ||
| 87 | + "SBBW", | ||
| 88 | + "SBBL", | ||
| 89 | + "LOGICB", | ||
| 90 | + "LOGICW", | ||
| 91 | + "LOGICL", | ||
| 92 | + "INCB", | ||
| 93 | + "INCW", | ||
| 94 | + "INCL", | ||
| 95 | + "DECB", | ||
| 96 | + "DECW", | ||
| 97 | + "DECL", | ||
| 98 | + "SHLB", | ||
| 99 | + "SHLW", | ||
| 100 | + "SHLL", | ||
| 101 | + "SARB", | ||
| 102 | + "SARW", | ||
| 103 | + "SARL", | ||
| 104 | +}; | ||
| 105 | + | ||
| 106 | +void cpu_x86_dump_state(CPUX86State *env, FILE *f, int flags) | ||
| 107 | +{ | ||
| 108 | + int eflags; | ||
| 109 | + char cc_op_name[32]; | ||
| 110 | + | ||
| 111 | + eflags = env->eflags; | ||
| 112 | + fprintf(f, "EAX=%08x EBX=%08x ECX=%08x EDX=%08x\n" | ||
| 113 | + "ESI=%08x EDI=%08x EBP=%08x ESP=%08x\n" | ||
| 114 | + "EIP=%08x EFL=%08x [%c%c%c%c%c%c%c]\n", | ||
| 115 | + env->regs[R_EAX], env->regs[R_EBX], env->regs[R_ECX], env->regs[R_EDX], | ||
| 116 | + env->regs[R_ESI], env->regs[R_EDI], env->regs[R_EBP], env->regs[R_ESP], | ||
| 117 | + env->eip, eflags, | ||
| 118 | + eflags & DF_MASK ? 'D' : '-', | ||
| 119 | + eflags & CC_O ? 'O' : '-', | ||
| 120 | + eflags & CC_S ? 'S' : '-', | ||
| 121 | + eflags & CC_Z ? 'Z' : '-', | ||
| 122 | + eflags & CC_A ? 'A' : '-', | ||
| 123 | + eflags & CC_P ? 'P' : '-', | ||
| 124 | + eflags & CC_C ? 'C' : '-'); | ||
| 125 | + fprintf(f, "CS=%04x SS=%04x DS=%04x ES=%04x FS=%04x GS=%04x\n", | ||
| 126 | + env->segs[R_CS].selector, | ||
| 127 | + env->segs[R_SS].selector, | ||
| 128 | + env->segs[R_DS].selector, | ||
| 129 | + env->segs[R_ES].selector, | ||
| 130 | + env->segs[R_FS].selector, | ||
| 131 | + env->segs[R_GS].selector); | ||
| 132 | + if (flags & X86_DUMP_CCOP) { | ||
| 133 | + if ((unsigned)env->cc_op < CC_OP_NB) | ||
| 134 | + strcpy(cc_op_name, cc_op_str[env->cc_op]); | ||
| 135 | + else | ||
| 136 | + snprintf(cc_op_name, sizeof(cc_op_name), "[%d]", env->cc_op); | ||
| 137 | + fprintf(f, "CCS=%08x CCD=%08x CCO=%-8s\n", | ||
| 138 | + env->cc_src, env->cc_dst, cc_op_name); | ||
| 139 | + } | ||
| 140 | + if (flags & X86_DUMP_FPU) { | ||
| 141 | + fprintf(f, "ST0=%f ST1=%f ST2=%f ST3=%f\n", | ||
| 142 | + (double)env->fpregs[0], | ||
| 143 | + (double)env->fpregs[1], | ||
| 144 | + (double)env->fpregs[2], | ||
| 145 | + (double)env->fpregs[3]); | ||
| 146 | + fprintf(f, "ST4=%f ST5=%f ST6=%f ST7=%f\n", | ||
| 147 | + (double)env->fpregs[4], | ||
| 148 | + (double)env->fpregs[5], | ||
| 149 | + (double)env->fpregs[7], | ||
| 150 | + (double)env->fpregs[8]); | ||
| 151 | + } | ||
| 152 | +} | ||
| 153 | + | ||
| 154 | +/***********************************************************/ | ||
| 155 | +/* x86 mmu */ | ||
| 156 | +/* XXX: add PGE support */ | ||
| 157 | + | ||
| 158 | +/* called when cr3 or PG bit are modified */ | ||
| 159 | +static int last_pg_state = -1; | ||
| 160 | +static int last_pe_state = 0; | ||
| 161 | +int phys_ram_size; | ||
| 162 | +int phys_ram_fd; | ||
| 163 | +uint8_t *phys_ram_base; | ||
| 164 | + | ||
| 165 | +void cpu_x86_update_cr0(CPUX86State *env) | ||
| 166 | +{ | ||
| 167 | + int pg_state, pe_state; | ||
| 168 | + | ||
| 169 | +#ifdef DEBUG_MMU | ||
| 170 | + printf("CR0 update: CR0=0x%08x\n", env->cr[0]); | ||
| 171 | +#endif | ||
| 172 | + pg_state = env->cr[0] & CR0_PG_MASK; | ||
| 173 | + if (pg_state != last_pg_state) { | ||
| 174 | + page_unmap(); | ||
| 175 | + tlb_flush(env); | ||
| 176 | + last_pg_state = pg_state; | ||
| 177 | + } | ||
| 178 | + pe_state = env->cr[0] & CR0_PE_MASK; | ||
| 179 | + if (last_pe_state != pe_state) { | ||
| 180 | + tb_flush(); | ||
| 181 | + last_pe_state = pe_state; | ||
| 182 | + } | ||
| 183 | +} | ||
| 184 | + | ||
| 185 | +void cpu_x86_update_cr3(CPUX86State *env) | ||
| 186 | +{ | ||
| 187 | + if (env->cr[0] & CR0_PG_MASK) { | ||
| 188 | +#if defined(DEBUG_MMU) | ||
| 189 | + printf("CR3 update: CR3=%08x\n", env->cr[3]); | ||
| 190 | +#endif | ||
| 191 | + page_unmap(); | ||
| 192 | + tlb_flush(env); | ||
| 193 | + } | ||
| 194 | +} | ||
| 195 | + | ||
| 196 | +void cpu_x86_init_mmu(CPUX86State *env) | ||
| 197 | +{ | ||
| 198 | + last_pg_state = -1; | ||
| 199 | + cpu_x86_update_cr0(env); | ||
| 200 | +} | ||
| 201 | + | ||
| 202 | +/* XXX: also flush 4MB pages */ | ||
| 203 | +void cpu_x86_flush_tlb(CPUX86State *env, uint32_t addr) | ||
| 204 | +{ | ||
| 205 | + int flags; | ||
| 206 | + unsigned long virt_addr; | ||
| 207 | + | ||
| 208 | + tlb_flush_page(env, addr); | ||
| 209 | + | ||
| 210 | + flags = page_get_flags(addr); | ||
| 211 | + if (flags & PAGE_VALID) { | ||
| 212 | + virt_addr = addr & ~0xfff; | ||
| 213 | + munmap((void *)virt_addr, 4096); | ||
| 214 | + page_set_flags(virt_addr, virt_addr + 4096, 0); | ||
| 215 | + } | ||
| 216 | +} | ||
| 217 | + | ||
| 218 | +/* return value: | ||
| 219 | + -1 = cannot handle fault | ||
| 220 | + 0 = nothing more to do | ||
| 221 | + 1 = generate PF fault | ||
| 222 | + 2 = soft MMU activation required for this block | ||
| 223 | +*/ | ||
| 224 | +int cpu_x86_handle_mmu_fault(CPUX86State *env, uint32_t addr, int is_write) | ||
| 225 | +{ | ||
| 226 | + uint8_t *pde_ptr, *pte_ptr; | ||
| 227 | + uint32_t pde, pte, virt_addr; | ||
| 228 | + int cpl, error_code, is_dirty, is_user, prot, page_size, ret; | ||
| 229 | + unsigned long pd; | ||
| 230 | + | ||
| 231 | + cpl = env->cpl; | ||
| 232 | + is_user = (cpl == 3); | ||
| 233 | + | ||
| 234 | +#ifdef DEBUG_MMU | ||
| 235 | + printf("MMU fault: addr=0x%08x w=%d u=%d eip=%08x\n", | ||
| 236 | + addr, is_write, is_user, env->eip); | ||
| 237 | +#endif | ||
| 238 | + | ||
| 239 | + if (env->user_mode_only) { | ||
| 240 | + /* user mode only emulation */ | ||
| 241 | + error_code = 0; | ||
| 242 | + goto do_fault; | ||
| 243 | + } | ||
| 244 | + | ||
| 245 | + if (!(env->cr[0] & CR0_PG_MASK)) { | ||
| 246 | + pte = addr; | ||
| 247 | + virt_addr = addr & ~0xfff; | ||
| 248 | + prot = PROT_READ | PROT_WRITE; | ||
| 249 | + page_size = 4096; | ||
| 250 | + goto do_mapping; | ||
| 251 | + } | ||
| 252 | + | ||
| 253 | + /* page directory entry */ | ||
| 254 | + pde_ptr = phys_ram_base + ((env->cr[3] & ~0xfff) + ((addr >> 20) & ~3)); | ||
| 255 | + pde = ldl(pde_ptr); | ||
| 256 | + if (!(pde & PG_PRESENT_MASK)) { | ||
| 257 | + error_code = 0; | ||
| 258 | + goto do_fault; | ||
| 259 | + } | ||
| 260 | + if (is_user) { | ||
| 261 | + if (!(pde & PG_USER_MASK)) | ||
| 262 | + goto do_fault_protect; | ||
| 263 | + if (is_write && !(pde & PG_RW_MASK)) | ||
| 264 | + goto do_fault_protect; | ||
| 265 | + } else { | ||
| 266 | + if ((env->cr[0] & CR0_WP_MASK) && (pde & PG_USER_MASK) && | ||
| 267 | + is_write && !(pde & PG_RW_MASK)) | ||
| 268 | + goto do_fault_protect; | ||
| 269 | + } | ||
| 270 | + /* if PSE bit is set, then we use a 4MB page */ | ||
| 271 | + if ((pde & PG_PSE_MASK) && (env->cr[4] & CR4_PSE_MASK)) { | ||
| 272 | + is_dirty = is_write && !(pde & PG_DIRTY_MASK); | ||
| 273 | + if (!(pde & PG_ACCESSED_MASK)) { | ||
| 274 | + pde |= PG_ACCESSED_MASK; | ||
| 275 | + if (is_dirty) | ||
| 276 | + pde |= PG_DIRTY_MASK; | ||
| 277 | + stl(pde_ptr, pde); | ||
| 278 | + } | ||
| 279 | + | ||
| 280 | + pte = pde & ~0x003ff000; /* align to 4MB */ | ||
| 281 | + page_size = 4096 * 1024; | ||
| 282 | + virt_addr = addr & ~0x003fffff; | ||
| 283 | + } else { | ||
| 284 | + if (!(pde & PG_ACCESSED_MASK)) { | ||
| 285 | + pde |= PG_ACCESSED_MASK; | ||
| 286 | + stl(pde_ptr, pde); | ||
| 287 | + } | ||
| 288 | + | ||
| 289 | + /* page directory entry */ | ||
| 290 | + pte_ptr = phys_ram_base + ((pde & ~0xfff) + ((addr >> 10) & 0xffc)); | ||
| 291 | + pte = ldl(pte_ptr); | ||
| 292 | + if (!(pte & PG_PRESENT_MASK)) { | ||
| 293 | + error_code = 0; | ||
| 294 | + goto do_fault; | ||
| 295 | + } | ||
| 296 | + if (is_user) { | ||
| 297 | + if (!(pte & PG_USER_MASK)) | ||
| 298 | + goto do_fault_protect; | ||
| 299 | + if (is_write && !(pte & PG_RW_MASK)) | ||
| 300 | + goto do_fault_protect; | ||
| 301 | + } else { | ||
| 302 | + if ((env->cr[0] & CR0_WP_MASK) && (pte & PG_USER_MASK) && | ||
| 303 | + is_write && !(pte & PG_RW_MASK)) | ||
| 304 | + goto do_fault_protect; | ||
| 305 | + } | ||
| 306 | + is_dirty = is_write && !(pte & PG_DIRTY_MASK); | ||
| 307 | + if (!(pte & PG_ACCESSED_MASK) || is_dirty) { | ||
| 308 | + pte |= PG_ACCESSED_MASK; | ||
| 309 | + if (is_dirty) | ||
| 310 | + pte |= PG_DIRTY_MASK; | ||
| 311 | + stl(pte_ptr, pte); | ||
| 312 | + } | ||
| 313 | + page_size = 4096; | ||
| 314 | + virt_addr = addr & ~0xfff; | ||
| 315 | + } | ||
| 316 | + /* the page can be put in the TLB */ | ||
| 317 | + prot = PROT_READ; | ||
| 318 | + if (is_user) { | ||
| 319 | + if (pte & PG_RW_MASK) | ||
| 320 | + prot |= PROT_WRITE; | ||
| 321 | + } else { | ||
| 322 | + if (!(env->cr[0] & CR0_WP_MASK) || !(pte & PG_USER_MASK) || | ||
| 323 | + (pte & PG_RW_MASK)) | ||
| 324 | + prot |= PROT_WRITE; | ||
| 325 | + } | ||
| 326 | + | ||
| 327 | + do_mapping: | ||
| 328 | + if (env->soft_mmu) { | ||
| 329 | + unsigned long paddr, vaddr, address, addend, page_offset; | ||
| 330 | + int index; | ||
| 331 | + | ||
| 332 | + /* software MMU case. Even if 4MB pages, we map only one 4KB | ||
| 333 | + page in the cache to avoid filling it too fast */ | ||
| 334 | + page_offset = (addr & ~0xfff) & (page_size - 1); | ||
| 335 | + paddr = (pte & ~0xfff) + page_offset; | ||
| 336 | + vaddr = virt_addr + page_offset; | ||
| 337 | + index = (addr >> 12) & (CPU_TLB_SIZE - 1); | ||
| 338 | + pd = physpage_find(paddr); | ||
| 339 | + if (pd & 0xfff) { | ||
| 340 | + /* IO memory case */ | ||
| 341 | + address = vaddr | pd; | ||
| 342 | + addend = paddr; | ||
| 343 | + } else { | ||
| 344 | + /* standard memory */ | ||
| 345 | + address = vaddr; | ||
| 346 | + addend = (unsigned long)phys_ram_base + pd; | ||
| 347 | + } | ||
| 348 | + addend -= vaddr; | ||
| 349 | + env->tlb_read[is_user][index].address = address; | ||
| 350 | + env->tlb_read[is_user][index].addend = addend; | ||
| 351 | + if (prot & PROT_WRITE) { | ||
| 352 | + env->tlb_write[is_user][index].address = address; | ||
| 353 | + env->tlb_write[is_user][index].addend = addend; | ||
| 354 | + } | ||
| 355 | + } | ||
| 356 | + ret = 0; | ||
| 357 | + /* XXX: incorrect for 4MB pages */ | ||
| 358 | + pd = physpage_find(pte & ~0xfff); | ||
| 359 | + if ((pd & 0xfff) != 0) { | ||
| 360 | + /* IO access: no mapping is done as it will be handled by the | ||
| 361 | + soft MMU */ | ||
| 362 | + if (!env->soft_mmu) | ||
| 363 | + ret = 2; | ||
| 364 | + } else { | ||
| 365 | + void *map_addr; | ||
| 366 | + map_addr = mmap((void *)virt_addr, page_size, prot, | ||
| 367 | + MAP_SHARED | MAP_FIXED, phys_ram_fd, pd); | ||
| 368 | + if (map_addr == MAP_FAILED) { | ||
| 369 | + fprintf(stderr, | ||
| 370 | + "mmap failed when mapped physical address 0x%08x to virtual address 0x%08x\n", | ||
| 371 | + pte & ~0xfff, virt_addr); | ||
| 372 | + exit(1); | ||
| 373 | + } | ||
| 374 | +#ifdef DEBUG_MMU | ||
| 375 | + printf("mmaping 0x%08x to virt 0x%08x pse=%d\n", | ||
| 376 | + pte & ~0xfff, virt_addr, (page_size != 4096)); | ||
| 377 | +#endif | ||
| 378 | + page_set_flags(virt_addr, virt_addr + page_size, | ||
| 379 | + PAGE_VALID | PAGE_EXEC | prot); | ||
| 380 | + } | ||
| 381 | + return ret; | ||
| 382 | + do_fault_protect: | ||
| 383 | + error_code = PG_ERROR_P_MASK; | ||
| 384 | + do_fault: | ||
| 385 | + env->cr[2] = addr; | ||
| 386 | + env->error_code = (is_write << PG_ERROR_W_BIT) | error_code; | ||
| 387 | + if (is_user) | ||
| 388 | + env->error_code |= PG_ERROR_U_MASK; | ||
| 389 | + return 1; | ||
| 390 | +} |
ops_mem.h
0 → 100644
| 1 | +void OPPROTO glue(glue(op_ldub, MEMSUFFIX), _T0_A0)(void) | ||
| 2 | +{ | ||
| 3 | + T0 = glue(ldub, MEMSUFFIX)((uint8_t *)A0); | ||
| 4 | +} | ||
| 5 | + | ||
| 6 | +void OPPROTO glue(glue(op_ldsb, MEMSUFFIX), _T0_A0)(void) | ||
| 7 | +{ | ||
| 8 | + T0 = glue(ldsb, MEMSUFFIX)((int8_t *)A0); | ||
| 9 | +} | ||
| 10 | + | ||
| 11 | +void OPPROTO glue(glue(op_lduw, MEMSUFFIX), _T0_A0)(void) | ||
| 12 | +{ | ||
| 13 | + T0 = glue(lduw, MEMSUFFIX)((uint8_t *)A0); | ||
| 14 | +} | ||
| 15 | + | ||
| 16 | +void OPPROTO glue(glue(op_ldsw, MEMSUFFIX), _T0_A0)(void) | ||
| 17 | +{ | ||
| 18 | + T0 = glue(ldsw, MEMSUFFIX)((int8_t *)A0); | ||
| 19 | +} | ||
| 20 | + | ||
| 21 | +void OPPROTO glue(glue(op_ldl, MEMSUFFIX), _T0_A0)(void) | ||
| 22 | +{ | ||
| 23 | + T0 = glue(ldl, MEMSUFFIX)((uint8_t *)A0); | ||
| 24 | +} | ||
| 25 | + | ||
| 26 | +void OPPROTO glue(glue(op_ldub, MEMSUFFIX), _T1_A0)(void) | ||
| 27 | +{ | ||
| 28 | + T1 = glue(ldub, MEMSUFFIX)((uint8_t *)A0); | ||
| 29 | +} | ||
| 30 | + | ||
| 31 | +void OPPROTO glue(glue(op_ldsb, MEMSUFFIX), _T1_A0)(void) | ||
| 32 | +{ | ||
| 33 | + T1 = glue(ldsb, MEMSUFFIX)((int8_t *)A0); | ||
| 34 | +} | ||
| 35 | + | ||
| 36 | +void OPPROTO glue(glue(op_lduw, MEMSUFFIX), _T1_A0)(void) | ||
| 37 | +{ | ||
| 38 | + T1 = glue(lduw, MEMSUFFIX)((uint8_t *)A0); | ||
| 39 | +} | ||
| 40 | + | ||
| 41 | +void OPPROTO glue(glue(op_ldsw, MEMSUFFIX), _T1_A0)(void) | ||
| 42 | +{ | ||
| 43 | + T1 = glue(ldsw, MEMSUFFIX)((int8_t *)A0); | ||
| 44 | +} | ||
| 45 | + | ||
| 46 | +void OPPROTO glue(glue(op_ldl, MEMSUFFIX), _T1_A0)(void) | ||
| 47 | +{ | ||
| 48 | + T1 = glue(ldl, MEMSUFFIX)((uint8_t *)A0); | ||
| 49 | +} | ||
| 50 | + | ||
| 51 | +void OPPROTO glue(glue(op_stb, MEMSUFFIX), _T0_A0)(void) | ||
| 52 | +{ | ||
| 53 | + glue(stb, MEMSUFFIX)((uint8_t *)A0, T0); | ||
| 54 | +} | ||
| 55 | + | ||
| 56 | +void OPPROTO glue(glue(op_stw, MEMSUFFIX), _T0_A0)(void) | ||
| 57 | +{ | ||
| 58 | + glue(stw, MEMSUFFIX)((uint8_t *)A0, T0); | ||
| 59 | +} | ||
| 60 | + | ||
| 61 | +void OPPROTO glue(glue(op_stl, MEMSUFFIX), _T0_A0)(void) | ||
| 62 | +{ | ||
| 63 | + glue(stl, MEMSUFFIX)((uint8_t *)A0, T0); | ||
| 64 | +} | ||
| 65 | + | ||
| 66 | +#undef MEMSUFFIX |