kolibrios-fun/contrib/other/uarm/mem.c

97 lines
1.8 KiB
C
Raw Normal View History

#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;
}