added ARM11 MMU from skyeye

This commit is contained in:
bunnei 2014-03-29 23:28:38 -04:00
parent bd38abf249
commit 328c415c74
6 changed files with 116 additions and 145 deletions

View File

@ -144,6 +144,7 @@
<ClCompile Include="src\arm\armsupp.cpp" /> <ClCompile Include="src\arm\armsupp.cpp" />
<ClCompile Include="src\arm\armvirt.cpp" /> <ClCompile Include="src\arm\armvirt.cpp" />
<ClCompile Include="src\arm\disassembler\arm_disasm.cpp" /> <ClCompile Include="src\arm\disassembler\arm_disasm.cpp" />
<ClCompile Include="src\arm\mmu\arm1176jzf_s_mmu.cpp" />
<ClCompile Include="src\core.cpp" /> <ClCompile Include="src\core.cpp" />
<ClCompile Include="src\core_timing.cpp" /> <ClCompile Include="src\core_timing.cpp" />
<ClCompile Include="src\elf\elf_reader.cpp" /> <ClCompile Include="src\elf\elf_reader.cpp" />

View File

@ -37,6 +37,9 @@
<ClCompile Include="src\arm\armos.cpp"> <ClCompile Include="src\arm\armos.cpp">
<Filter>arm</Filter> <Filter>arm</Filter>
</ClCompile> </ClCompile>
<ClCompile Include="src\arm\mmu\arm1176jzf_s_mmu.cpp">
<Filter>arm\mmu</Filter>
</ClCompile>
</ItemGroup> </ItemGroup>
<ItemGroup> <ItemGroup>
<Filter Include="arm"> <Filter Include="arm">

View File

@ -72,7 +72,7 @@ mmu_init (ARMul_State * state)
/* case 0x560f5810: */ /* case 0x560f5810: */
case 0x0007b000: case 0x0007b000:
NOTICE_LOG(ARM11, "SKYEYE: use arm11jzf-s mmu ops\n"); NOTICE_LOG(ARM11, "SKYEYE: use arm11jzf-s mmu ops\n");
//state->mmu.ops = arm1176jzf_s_mmu_ops; state->mmu.ops = arm1176jzf_s_mmu_ops;
_dbg_assert_msg_(ARM11, false, "ImplementMe: arm1176jzf_s_mmu_ops!"); _dbg_assert_msg_(ARM11, false, "ImplementMe: arm1176jzf_s_mmu_ops!");
break; break;

View File

@ -104,15 +104,15 @@ typedef enum mmu_regnum_t
/*virt_addr exchange according to CP15.R13(process id virtul mapping)*/ /*virt_addr exchange according to CP15.R13(process id virtul mapping)*/
#define PID_VA_MAP_MASK 0xfe000000 #define PID_VA_MAP_MASK 0xfe000000
#define mmu_pid_va_map(va) ({\ //#define mmu_pid_va_map(va) ({\
ARMword ret; \ // ARMword ret; \
if ((va) & PID_VA_MAP_MASK)\ // if ((va) & PID_VA_MAP_MASK)\
ret = (va); \ // ret = (va); \
else \ // else \
ret = ((va) | (state->mmu.process_id & PID_VA_MAP_MASK));\ // ret = ((va) | (state->mmu.process_id & PID_VA_MAP_MASK));\
ret;\ // ret;\
}) //})
#define mmu_pid_va_map(va) ((va) & PID_VA_MAP_MASK) ? (va) : ((va) | (state->mmu.process_id & PID_VA_MAP_MASK))
/* FS[3:0] in the fault status register: */ /* FS[3:0] in the fault status register: */

View File

@ -21,10 +21,13 @@
#include <assert.h> #include <assert.h>
#include <string.h> #include <string.h>
#include <stdint.h> #include <stdint.h>
#include <skyeye_ram.h>
#include "armdefs.h" #include "mem_map.h"
#include "bank_defs.h"
#include "arm/skyeye_defs.h"
#include "arm/armdefs.h"
//#include "bank_defs.h"
#if 0 #if 0
#define TLB_SIZE 1024 * 1024 #define TLB_SIZE 1024 * 1024
#define ASID 255 #define ASID 255
@ -59,44 +62,10 @@ static inline void insert_tlb(ARMul_State* state, ARMword va, ARMword pa){
#endif #endif
#define BANK0_START 0x50000000 #define BANK0_START 0x50000000
static void* mem_ptr = NULL; static void* mem_ptr = NULL;
//static void mem_read_raw(uint32_t offset, uint32_t &value, int size)
static void mem_read_raw(int size, uint32_t offset, uint32_t *value)
{
#if 0
if(mem_ptr == NULL)
mem_ptr = (uint8_t*)get_dma_addr(BANK0_START);
//printf("In %s, offset=0x%x, mem_ptr=0x%llx\n", __FUNCTION__, offset, mem_ptr);
if(offset >= 0x50000000 && offset < 0x70000000){
mem_read(size, offset, value);
}
else{
bus_read(size, offset, value);
}
#endif
bus_read(size, offset, value);
}
//static void mem_write_raw(uint32_t offset, uint32_t value, int size)
static void mem_write_raw(int size, uint32_t offset, uint32_t value)
{
#if 0
if(mem_ptr == NULL)
mem_ptr = (uint8_t*)get_dma_addr(BANK0_START);
//printf("In %s, offset=0x%x, mem_ptr=0x%llx\n", __FUNCTION__, offset, mem_ptr);
if(offset >= 0x50000000 && offset < 0x70000000){
mem_write(size, offset, value);
}
else{
bus_write(size, offset, value);
}
#endif
bus_write(size, offset, value);
}
static int exclusive_detect(ARMul_State* state, ARMword addr){ static int exclusive_detect(ARMul_State* state, ARMword addr){
int i;
#if 0 #if 0
for(i = 0; i < 128; i++){ for(int i = 0; i < 128; i++){
if(state->exclusive_tag_array[i] == addr) if(state->exclusive_tag_array[i] == addr)
return 0; return 0;
} }
@ -108,9 +77,8 @@ static int exclusive_detect(ARMul_State* state, ARMword addr){
} }
static void add_exclusive_addr(ARMul_State* state, ARMword addr){ static void add_exclusive_addr(ARMul_State* state, ARMword addr){
int i;
#if 0 #if 0
for(i = 0; i < 128; i++){ for(int i = 0; i < 128; i++){
if(state->exclusive_tag_array[i] == 0xffffffff){ if(state->exclusive_tag_array[i] == 0xffffffff){
state->exclusive_tag_array[i] = addr; state->exclusive_tag_array[i] = addr;
//printf("In %s, add addr 0x%x\n", __func__, addr); //printf("In %s, add addr 0x%x\n", __func__, addr);
@ -265,7 +233,8 @@ mmu_translate (ARMul_State *state, ARMword virt_addr, ARMword *phys_addr, int *a
if (state->space.conf_obj != NULL) if (state->space.conf_obj != NULL)
state->space.read(state->space.conf_obj, l1addr, &l1desc, 4); state->space.read(state->space.conf_obj, l1addr, &l1desc, 4);
else else
mem_read_raw(32, l1addr, &l1desc); l1desc = Memory::Read32(l1addr); //mem_read_raw(32, l1addr, &l1desc);
#if 0 #if 0
if (virt_addr == 0xc000d2bc) { if (virt_addr == 0xc000d2bc) {
printf("mmu_control is %x\n", state->mmu.translation_table_ctrl); printf("mmu_control is %x\n", state->mmu.translation_table_ctrl);
@ -298,7 +267,8 @@ mmu_translate (ARMul_State *state, ARMword virt_addr, ARMword *phys_addr, int *a
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.read(state->space.conf_obj, l2addr, &l2desc, 4); state->space.read(state->space.conf_obj, l2addr, &l2desc, 4);
else else
mem_read_raw(32, l2addr, &l2desc); l2desc = Memory::Read32(l2addr); //mem_read_raw(32, l2addr, &l2desc);
/* chy 2003-09-02 for xscale */ /* chy 2003-09-02 for xscale */
*ap = (l2desc >> 4) & 0x3; *ap = (l2desc >> 4) & 0x3;
*sop = 1; /* page */ *sop = 1; /* page */
@ -385,7 +355,7 @@ arm1176jzf_s_mmu_load_instr (ARMul_State *state, ARMword va, ARMword *instr)
static int debug_count = 0; /* used for debug */ static int debug_count = 0; /* used for debug */
d_msg ("va = %x\n", va); DEBUG_LOG(ARM11, "va = %x\n", va);
va = mmu_pid_va_map (va); va = mmu_pid_va_map (va);
if (MMU_Enabled) { if (MMU_Enabled) {
@ -393,7 +363,7 @@ arm1176jzf_s_mmu_load_instr (ARMul_State *state, ARMword va, ARMword *instr)
// sleep(1); // sleep(1);
/* align check */ /* align check */
if ((va & (WORD_SIZE - 1)) && MMU_Aligned) { if ((va & (WORD_SIZE - 1)) && MMU_Aligned) {
d_msg ("align\n"); DEBUG_LOG(ARM11, "align\n");
return ALIGNMENT_FAULT; return ALIGNMENT_FAULT;
} else } else
va &= ~(WORD_SIZE - 1); va &= ~(WORD_SIZE - 1);
@ -401,7 +371,7 @@ arm1176jzf_s_mmu_load_instr (ARMul_State *state, ARMword va, ARMword *instr)
/* translate tlb */ /* translate tlb */
fault = mmu_translate (state, va, &pa, &ap, &sop); fault = mmu_translate (state, va, &pa, &ap, &sop);
if (fault) { if (fault) {
d_msg ("translate\n"); DEBUG_LOG(ARM11, "translate\n");
printf("va=0x%x, icounter=%lld, fault=%d\n", va, state->NumInstrs, fault); printf("va=0x%x, icounter=%lld, fault=%d\n", va, state->NumInstrs, fault);
return fault; return fault;
} }
@ -420,7 +390,7 @@ arm1176jzf_s_mmu_load_instr (ARMul_State *state, ARMword va, ARMword *instr)
/*check access */ /*check access */
fault = check_access (state, va, tlb, 1); fault = check_access (state, va, tlb, 1);
if (fault) { if (fault) {
d_msg ("check_fault\n"); DEBUG_LOG(ARM11, "check_fault\n");
return fault; return fault;
} }
#endif #endif
@ -435,9 +405,9 @@ arm1176jzf_s_mmu_load_instr (ARMul_State *state, ARMword va, ARMword *instr)
if(state->space.conf_obj == NULL) if(state->space.conf_obj == NULL)
state->space.read(state->space.conf_obj, pa, instr, 4); state->space.read(state->space.conf_obj, pa, instr, 4);
else else
mem_read_raw(32, pa, instr); *instr = Memory::Read32(pa); //mem_read_raw(32, pa, instr);
return 0; return NO_FAULT;
} }
static fault_t static fault_t
@ -474,7 +444,7 @@ arm1176jzf_s_mmu_read (ARMul_State *state, ARMword va, ARMword *data,
ARMword perm; /* physical addr access permissions */ ARMword perm; /* physical addr access permissions */
int ap, sop; int ap, sop;
d_msg ("va = %x\n", va); DEBUG_LOG(ARM11, "va = %x\n", va);
va = mmu_pid_va_map (va); va = mmu_pid_va_map (va);
real_va = va; real_va = va;
@ -489,25 +459,24 @@ arm1176jzf_s_mmu_read (ARMul_State *state, ARMword va, ARMword *data,
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.read(state->space.conf_obj, va, data, 1); state->space.read(state->space.conf_obj, va, data, 1);
else else
mem_read_raw(8, va, data); *data = Memory::Read8(va); //mem_read_raw(8, va, data);
else if (datatype == ARM_HALFWORD_TYPE) else if (datatype == ARM_HALFWORD_TYPE)
/* *data = mem_read_halfword (state, va); */ /* *data = mem_read_halfword (state, va); */
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.read(state->space.conf_obj, va, data, 2); state->space.read(state->space.conf_obj, va, data, 2);
else else
mem_read_raw(16, va, data); *data = Memory::Read16(va); //mem_read_raw(16, va, data);
else if (datatype == ARM_WORD_TYPE) else if (datatype == ARM_WORD_TYPE)
/* *data = mem_read_word (state, va); */ /* *data = mem_read_word (state, va); */
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.read(state->space.conf_obj, va, data, 4); state->space.read(state->space.conf_obj, va, data, 4);
else else
mem_read_raw(32, va, data); *data = Memory::Read32(va); //mem_read_raw(32, va, data);
else { else {
printf ("SKYEYE:1 arm1176jzf_s_mmu_read error: unknown data type %d\n", datatype); ERROR_LOG(ARM11, "SKYEYE:1 arm1176jzf_s_mmu_read error: unknown data type %d\n", datatype);
skyeye_exit (-1);
} }
return 0; return NO_FAULT;
} }
// printf("MMU enabled.\n"); // printf("MMU enabled.\n");
// sleep(1); // sleep(1);
@ -515,7 +484,7 @@ arm1176jzf_s_mmu_read (ARMul_State *state, ARMword va, ARMword *data,
/* align check */ /* align check */
if (((va & 3) && (datatype == ARM_WORD_TYPE) && MMU_Aligned) || if (((va & 3) && (datatype == ARM_WORD_TYPE) && MMU_Aligned) ||
((va & 1) && (datatype == ARM_HALFWORD_TYPE) && MMU_Aligned)) { ((va & 1) && (datatype == ARM_HALFWORD_TYPE) && MMU_Aligned)) {
d_msg ("align\n"); DEBUG_LOG(ARM11, "align\n");
return ALIGNMENT_FAULT; return ALIGNMENT_FAULT;
} }
@ -544,7 +513,7 @@ arm1176jzf_s_mmu_read (ARMul_State *state, ARMword va, ARMword *data,
} }
#endif #endif
if (fault) { if (fault) {
d_msg ("translate\n"); DEBUG_LOG(ARM11, "translate\n");
//printf("mmu read fault at %x\n", va); //printf("mmu read fault at %x\n", va);
//printf("fault is %d\n", fault); //printf("fault is %d\n", fault);
return fault; return fault;
@ -574,24 +543,23 @@ skip_translation:
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.read(state->space.conf_obj, pa | (real_va & 3), data, 1); state->space.read(state->space.conf_obj, pa | (real_va & 3), data, 1);
else else
mem_read_raw(8, pa | (real_va & 3), data); *data = Memory::Read8(pa | (real_va & 3)); //mem_read_raw(8, pa | (real_va & 3), data);
/* mem_read_raw(32, pa | (real_va & 3), data); */ /* mem_read_raw(32, pa | (real_va & 3), data); */
} else if (datatype == ARM_HALFWORD_TYPE) { } else if (datatype == ARM_HALFWORD_TYPE) {
/* *data = mem_read_halfword (state, pa | (real_va & 2)); */ /* *data = mem_read_halfword (state, pa | (real_va & 2)); */
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.read(state->space.conf_obj, pa | (real_va & 3), data, 2); state->space.read(state->space.conf_obj, pa | (real_va & 3), data, 2);
else else
mem_read_raw(16, pa | (real_va & 3), data); *data = Memory::Read16(pa | (real_va & 3)); //mem_read_raw(16, pa | (real_va & 3), data);
/* mem_read_raw(32, pa | (real_va & 2), data); */ /* mem_read_raw(32, pa | (real_va & 2), data); */
} else if (datatype == ARM_WORD_TYPE) } else if (datatype == ARM_WORD_TYPE)
/* *data = mem_read_word (state, pa); */ /* *data = mem_read_word (state, pa); */
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.read(state->space.conf_obj, pa , data, 4); state->space.read(state->space.conf_obj, pa , data, 4);
else else
mem_read_raw(32, pa, data); *data = Memory::Read32(pa); //mem_read_raw(32, pa, data);
else { else {
printf ("SKYEYE:2 arm1176jzf_s_mmu_read error: unknown data type %d\n", datatype); ERROR_LOG(ARM11, "SKYEYE:2 arm1176jzf_s_mmu_read error: unknown data type %d\n", datatype);
skyeye_exit (-1);
} }
if(0 && (va == 0x2869c)){ if(0 && (va == 0x2869c)){
printf("In %s, pa is %x va=0x%x, value is %x pc %x, instr=0x%x\n", __FUNCTION__, pa, va, *data, state->Reg[15], state->CurrInstr); printf("In %s, pa is %x va=0x%x, value is %x pc %x, instr=0x%x\n", __FUNCTION__, pa, va, *data, state->Reg[15], state->CurrInstr);
@ -614,7 +582,7 @@ skip_translation:
} }
#endif #endif
return 0; return NO_FAULT;
} }
@ -661,7 +629,7 @@ arm1176jzf_s_mmu_write (ARMul_State *state, ARMword va, ARMword data,
} }
#endif #endif
d_msg ("va = %x, val = %x\n", va, data); DEBUG_LOG(ARM11, "va = %x, val = %x\n", va, data);
va = mmu_pid_va_map (va); va = mmu_pid_va_map (va);
real_va = va; real_va = va;
@ -672,22 +640,21 @@ arm1176jzf_s_mmu_write (ARMul_State *state, ARMword va, ARMword data,
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.write(state->space.conf_obj, va, &data, 1); state->space.write(state->space.conf_obj, va, &data, 1);
else else
mem_write_raw(8, va, data); Memory::Write8(va, data);
else if (datatype == ARM_HALFWORD_TYPE) else if (datatype == ARM_HALFWORD_TYPE)
/* mem_write_halfword (state, va, data); */ /* mem_write_halfword (state, va, data); */
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.write(state->space.conf_obj, va, &data, 2); state->space.write(state->space.conf_obj, va, &data, 2);
else else
mem_write_raw(16, va, data); Memory::Write16(va, data);
else if (datatype == ARM_WORD_TYPE) else if (datatype == ARM_WORD_TYPE)
/* mem_write_word (state, va, data); */ /* mem_write_word (state, va, data); */
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.write(state->space.conf_obj, va, &data, 4); state->space.write(state->space.conf_obj, va, &data, 4);
else else
mem_write_raw(32, va, data); Memory::Write32(va, data);
else { else {
printf ("SKYEYE:1 arm1176jzf_s_mmu_write error: unknown data type %d\n", datatype); ERROR_LOG (ARM11, "SKYEYE:1 arm1176jzf_s_mmu_write error: unknown data type %d\n", datatype);
skyeye_exit (-1);
} }
goto finished_write; goto finished_write;
//return 0; //return 0;
@ -696,7 +663,7 @@ arm1176jzf_s_mmu_write (ARMul_State *state, ARMword va, ARMword data,
/* if ((va & (WORD_SIZE - 1)) && MMU_Aligned){ */ /* if ((va & (WORD_SIZE - 1)) && MMU_Aligned){ */
if (((va & 3) && (datatype == ARM_WORD_TYPE) && MMU_Aligned) || if (((va & 3) && (datatype == ARM_WORD_TYPE) && MMU_Aligned) ||
((va & 1) && (datatype == ARM_HALFWORD_TYPE) && MMU_Aligned)) { ((va & 1) && (datatype == ARM_HALFWORD_TYPE) && MMU_Aligned)) {
d_msg ("align\n"); DEBUG_LOG(ARM11, "align\n");
return ALIGNMENT_FAULT; return ALIGNMENT_FAULT;
} }
va &= ~(WORD_SIZE - 1); va &= ~(WORD_SIZE - 1);
@ -721,7 +688,7 @@ arm1176jzf_s_mmu_write (ARMul_State *state, ARMword va, ARMword data,
} }
#endif #endif
if (fault) { if (fault) {
d_msg ("translate\n"); DEBUG_LOG(ARM11, "translate\n");
//printf("mmu write fault at %x\n", va); //printf("mmu write fault at %x\n", va);
return fault; return fault;
} }
@ -740,7 +707,7 @@ arm1176jzf_s_mmu_write (ARMul_State *state, ARMword va, ARMword data,
/* tlb check access */ /* tlb check access */
fault = check_access (state, va, tlb, 0); fault = check_access (state, va, tlb, 0);
if (fault) { if (fault) {
d_msg ("check_access\n"); DEBUG_LOG(ARM11, "check_access\n");
return fault; return fault;
} }
#endif #endif
@ -771,7 +738,7 @@ skip_translation:
else{ else{
state->Reg[dest_reg] = 1; state->Reg[dest_reg] = 1;
//printf("In %s, try to strex a monitored address 0x%x\n", __FUNCTION__, pa); //printf("In %s, try to strex a monitored address 0x%x\n", __FUNCTION__, pa);
return 0; return NO_FAULT;
} }
} }
@ -783,7 +750,7 @@ skip_translation:
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.write(state->space.conf_obj, (pa | (real_va & 3)), &data, 1); state->space.write(state->space.conf_obj, (pa | (real_va & 3)), &data, 1);
else else
mem_write_raw(8, (pa | (real_va & 3)), data); Memory::Write8((pa | (real_va & 3)), data);
} else if (datatype == ARM_HALFWORD_TYPE) } else if (datatype == ARM_HALFWORD_TYPE)
/* mem_write_halfword (state, /* mem_write_halfword (state,
@ -794,13 +761,13 @@ skip_translation:
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.write(state->space.conf_obj, (pa | (real_va & 3)), &data, 2); state->space.write(state->space.conf_obj, (pa | (real_va & 3)), &data, 2);
else else
mem_write_raw(16, (pa | (real_va & 3)), data); Memory::Write16((pa | (real_va & 3)), data);
else if (datatype == ARM_WORD_TYPE) else if (datatype == ARM_WORD_TYPE)
/* mem_write_word (state, pa, data); */ /* mem_write_word (state, pa, data); */
if(state->space.conf_obj != NULL) if(state->space.conf_obj != NULL)
state->space.write(state->space.conf_obj, pa, &data, 4); state->space.write(state->space.conf_obj, pa, &data, 4);
else else
mem_write_raw(32, pa, data); Memory::Write32(pa, data);
#if 0 #if 0
if (state->NumInstrs > 236403) { if (state->NumInstrs > 236403) {
printf("write memory\n"); printf("write memory\n");
@ -829,13 +796,13 @@ finished_write:
} }
#endif #endif
return 0; return NO_FAULT;
} }
ARMword ARMword
arm1176jzf_s_mmu_mrc (ARMul_State *state, ARMword instr, ARMword *value) arm1176jzf_s_mmu_mrc (ARMul_State *state, ARMword instr, ARMword *value)
{ {
mmu_regnum_t creg = BITS (16, 19) & 0xf; int creg = BITS (16, 19) & 0xf;
int OPC_1 = BITS (21, 23) & 0x7; int OPC_1 = BITS (21, 23) & 0x7;
int OPC_2 = BITS (5, 7) & 0x7; int OPC_2 = BITS (5, 7) & 0x7;
ARMword data; ARMword data;
@ -921,8 +888,8 @@ arm1176jzf_s_mmu_mrc (ARMul_State *state, ARMword instr, ARMword *value)
static ARMword static ARMword
arm1176jzf_s_mmu_mcr (ARMul_State *state, ARMword instr, ARMword value) arm1176jzf_s_mmu_mcr (ARMul_State *state, ARMword instr, ARMword value)
{ {
mmu_regnum_t creg = BITS (16, 19) & 0xf; int creg = BITS (16, 19) & 0xf;
mmu_regnum_t CRm = BITS (0, 3) & 0xf; int CRm = BITS (0, 3) & 0xf;
int OPC_1 = BITS (21, 23) & 0x7; int OPC_1 = BITS (21, 23) & 0x7;
int OPC_2 = BITS (5, 7) & 0x7; int OPC_2 = BITS (5, 7) & 0x7;
if (!strncmp (state->cpu->cpu_arch_name, "armv6", 5)) { if (!strncmp (state->cpu->cpu_arch_name, "armv6", 5)) {
@ -1093,56 +1060,56 @@ arm1176jzf_s_mmu_mcr (ARMul_State *state, ARMword instr, ARMword value)
return No_exp; return No_exp;
} }
/* teawater add for arm2x86 2005.06.19------------------------------------------- */ ///* teawater add for arm2x86 2005.06.19------------------------------------------- */
static int //static int
arm1176jzf_s_mmu_v2p_dbct (ARMul_State *state, ARMword virt_addr, //arm1176jzf_s_mmu_v2p_dbct (ARMul_State *state, ARMword virt_addr,
ARMword *phys_addr) // ARMword *phys_addr)
{ //{
fault_t fault; // fault_t fault;
int ap, sop; // int ap, sop;
//
ARMword perm; /* physical addr access permissions */ // ARMword perm; /* physical addr access permissions */
virt_addr = mmu_pid_va_map (virt_addr); // virt_addr = mmu_pid_va_map (virt_addr);
if (MMU_Enabled) { // if (MMU_Enabled) {
//
/*align check */ // /*align check */
if ((virt_addr & (WORD_SIZE - 1)) && MMU_Aligned) { // if ((virt_addr & (WORD_SIZE - 1)) && MMU_Aligned) {
d_msg ("align\n"); // DEBUG_LOG(ARM11, "align\n");
return ALIGNMENT_FAULT; // return ALIGNMENT_FAULT;
} else // } else
virt_addr &= ~(WORD_SIZE - 1); // virt_addr &= ~(WORD_SIZE - 1);
//
/*translate tlb */ // /*translate tlb */
fault = mmu_translate (state, virt_addr, phys_addr, &ap, &sop); // fault = mmu_translate (state, virt_addr, phys_addr, &ap, &sop);
if (fault) { // if (fault) {
d_msg ("translate\n"); // DEBUG_LOG(ARM11, "translate\n");
return fault; // return fault;
} // }
//
/* permission check */ // /* permission check */
if (!check_perms(state, ap, 1)) { // if (!check_perms(state, ap, 1)) {
if (sop == 0) { // if (sop == 0) {
return SECTION_PERMISSION_FAULT; // return SECTION_PERMISSION_FAULT;
} else { // } else {
return SUBPAGE_PERMISSION_FAULT; // return SUBPAGE_PERMISSION_FAULT;
} // }
} // }
#if 0 //#if 0
/*check access */ // /*check access */
fault = check_access (state, virt_addr, tlb, 1); // fault = check_access (state, virt_addr, tlb, 1);
if (fault) { // if (fault) {
d_msg ("check_fault\n"); // DEBUG_LOG(ARM11, "check_fault\n");
return fault; // return fault;
} // }
#endif //#endif
} // }
//
if (MMU_Disabled) { // if (MMU_Disabled) {
*phys_addr = virt_addr; // *phys_addr = virt_addr;
} // }
//
return 0; // return 0;
} //}
/* AJ2D-------------------------------------------------------------------------- */ /* AJ2D-------------------------------------------------------------------------- */

View File

@ -71,8 +71,8 @@ u32 Read32(const u32 addr);
u32 Read8_ZX(const u32 addr); u32 Read8_ZX(const u32 addr);
u32 Read16_ZX(const u32 addr); u32 Read16_ZX(const u32 addr);
void Write8(const u32 addr, const u32 data); void Write8(const u32 addr, const u8 data);
void Write16(const u32 addr, const u32 data); void Write16(const u32 addr, const u16 data);
void Write32(const u32 addr, const u32 data); void Write32(const u32 addr, const u32 data);
u8* GetPointer(const u32 Address); u8* GetPointer(const u32 Address);