97 lines
1.8 KiB
C
Executable File
97 lines
1.8 KiB
C
Executable File
#include "mem.h"
|
|
|
|
|
|
|
|
void memInit(ArmMem* mem){
|
|
|
|
UInt8 i;
|
|
|
|
for(i = 0; i < MAX_MEM_REGIONS; i++){
|
|
mem->regions[i].sz = 0;
|
|
}
|
|
}
|
|
|
|
|
|
void memDeinit(_UNUSED_ ArmMem* mem){
|
|
|
|
//nothing here
|
|
}
|
|
|
|
Boolean memRegionAdd(ArmMem* mem, UInt32 pa, UInt32 sz, ArmMemAccessF aF, void* uD){
|
|
|
|
UInt8 i;
|
|
|
|
//check for intersection with another region
|
|
|
|
for(i = 0; i < MAX_MEM_REGIONS; i++){
|
|
|
|
if(!mem->regions[i].sz) continue;
|
|
if((mem->regions[i].pa <= pa && mem->regions[i].pa + mem->regions[i].sz > pa) || (pa <= mem->regions[i].pa && pa + sz > mem->regions[i].pa)){
|
|
|
|
return false; //intersection -> fail
|
|
}
|
|
}
|
|
|
|
|
|
//find a free region and put it there
|
|
|
|
for(i = 0; i < MAX_MEM_REGIONS; i++){
|
|
if(mem->regions[i].sz == 0){
|
|
|
|
mem->regions[i].pa = pa;
|
|
mem->regions[i].sz = sz;
|
|
mem->regions[i].aF = aF;
|
|
mem->regions[i].uD = uD;
|
|
|
|
return true;
|
|
}
|
|
}
|
|
|
|
|
|
//fail miserably
|
|
|
|
return false;
|
|
}
|
|
|
|
Boolean memRegionDel(ArmMem* mem, UInt32 pa, UInt32 sz){
|
|
|
|
UInt8 i;
|
|
|
|
for(i = 0; i < MAX_MEM_REGIONS; i++){
|
|
if(mem->regions[i].pa == pa && mem->regions[i].sz ==sz){
|
|
|
|
mem->regions[i].sz = 0;
|
|
return true;
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
Boolean memAccess(ArmMem* mem, UInt32 addr, UInt8 size, Boolean write, void* buf){
|
|
|
|
UInt8 i;
|
|
|
|
for(i = 0; i < MAX_MEM_REGIONS; i++){
|
|
if(mem->regions[i].pa <= addr && mem->regions[i].pa + mem->regions[i].sz > addr){
|
|
|
|
return mem->regions[i].aF(mem->regions[i].uD, addr, size, write & 0x7F, buf);
|
|
}
|
|
}
|
|
|
|
if(!(write & 0x80)){ //high bit in write tells us to not print this error (used by gdb stub)
|
|
|
|
err_str("Memory ");
|
|
err_str(write ? "write" : "read");
|
|
err_str(" of ");
|
|
err_dec(size);
|
|
err_str(" bytes at physical addr 0x");
|
|
err_hex(addr);
|
|
err_str(" fails, halting\r\n");
|
|
while(1);
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|