add memory map finder

This commit is contained in:
Chiharu Shirasaka 2021-03-04 20:18:15 +09:00 committed by GitHub
parent 1559a0e69b
commit 1ed83389f2
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 113 additions and 0 deletions

113
x1/memmap.c Normal file
View File

@ -0,0 +1,113 @@
unsigned int pow(unsigned int base, unsigned int exponent) {
unsigned int ans = 1;
for (unsigned int i = 0; i < exponent; i++) {
ans *= base;
}
return ans;
}
void printhex(unsigned int num,unsigned int *addr) {
digit=8;
print("0x");
while (digit) {
unsigned int weight = pow(16, digit - 1);
unsigned int ans = num / weight;
if (ans < 10)
*addr |= '0' + ans;
else
*addr |= 'A' + ans - 10;
num -= ans * weight;
digit--;
}
}
void print(char *string,unsigned int *addr) {
do {
*addr |= *string;
string++;
} while (*string != '\0');
}
void main(){
unsigned int TTBCR,addrmask,TTBR0,TTBR1,*table0,*table1,ram=0,ahp=0;
asm volatile(
"mrc p15, 0, %0, c2, c0, 2\n"
"mrc p15, 0, %1, c2, c0, 0\n"
"mrc p15, 0, %2, c2, c0, 1\n"
: "=r" (TTBCR),"=r" (TTBR0),"=r" (TTBR1)
);
addrmask=TTBCR&0x7;
for(unsigned int i=0;i<0xffffffff;i+=4096){
if(i>(0xffffffff>>addrmask)){
table0=((TTBR1&0xFFFFC000)|((i>>19)<<2));
}else{
table0=((TTBR0&0xFFFFC000)|(((i<<addrmask)>>(19+addrmask))<<2));
}
if((*table0&0x3)==0)continue; //Invalid
else if((*table0&0x3)==1){ //Page Table
table1=((*table&0xFFFFFC00)|((i&0xFF000)>>9));
if(*table1&0x3==1){//large page
if(((*table&0xFFFF0000)|(i&0xFFFF))==0x60000000)ram=i;
else if(((*table&0xFFFF0000)|(i&0xFFFF0000))==0x40000000)ahp=i;
}else{//small page
if(((*table&0xFFFFF000)|(i&0xFFF))==0x60000000)ram=i;
else if(((*table&0xFFFFF000)|(i&0xFFF))==0x40000000)ahp=i;
}
}else if((*table0&0x40000)){ //Section
if(((*table0&0xFFF00000)|(i&0xFFFFF))==0x60000000)ram=i;
else if(((*table0&0xFFF00000)|(i&0xFFFFF))==0x40000000)ahp=i;
}else continue; //Supersection
}
if(ahp){
*(unsigned int *)(ahp+0x2D0000+0x8) |= 0x2 //UART4 reset
*(unsigned int *)(ahp+0x2E0000+0x8) |= 0x2 //UART5 reset
*(unsigned int *)(ahp+0x800000+0x260000+0x8) |= 0x2 //UART6 reset
*(unsigned int *)(ahp+0x800000+0x270000+0x8) |= 0x2 //UART7 reset
*(unsigned int *)(ahp+0x2D0000+0x8) &= ~0x2 //UART4 unreset
*(unsigned int *)(ahp+0x2E0000+0x8) &= ~0x2 //UART5 unreset
*(unsigned int *)(ahp+0x800000+0x260000+0x8) &= ~0x2 //UART6 unreset
*(unsigned int *)(ahp+0x800000+0x270000+0x8) &= ~0x2 //UART7 unreset
*(unsigned int *)(ahp+0x2D0000+0x18) |= 0x80000 //UART4 Tx Enable
*(unsigned int *)(ahp+0x2E0000+0x18) |= 0x80000 //UART5 Tx Enable
*(unsigned int *)(ahp+0x800000+0x260000+0x18) |= 0x80000 //UART6 Tx Enable
*(unsigned int *)(ahp+0x800000+0x270000+0x18) |= 0x80000 //UART7 Tx Enable
print("UART4=",(unsigned int *)ahp+0x2D0000+0x1C);
printhex(ahp+0x2D0000+0x1C,(unsigned int *)ahp+0x2D0000+0x1C);
print("\n",(unsigned int *)ahp+0x2D0000+0x1C);
print("UART5=",(unsigned int *)ahp+0x2E0000+0x1C);
printhex(ahp+0x2E0000+0x1C,(unsigned int *)ahp+0x2E0000+0x1C);
print("\n",(unsigned int *)ahp+0x2E0000+0x1C);
print("UART6=",(unsigned int *)ahp+0x800000+0x260000+0x1C);
printhex(ahp+0x800000+0x260000+0x1C,(unsigned int *)ahp+0x800000+0x260000+0x1C);
print("\n",(unsigned int *)ahp+0x800000+0x260000+0x1C);
print("UART6=",(unsigned int *)ahp+0x800000+0x270000+0x1C);
printhex(ahp+0x800000+0x270000+0x1C,(unsigned int *)ahp+0x800000+0x270000+0x1C);
print("\n",(unsigned int *)ahp+0x800000+0x270000+0x1C);
if(ram){
print("DRAM=",(unsigned int *)ahp+0x2D0000+0x1C);
printhex(ram,(unsigned int *)ahp+0x2D0000+0x1C);
print("\n",(unsigned int *)ahp+0x2D0000+0x1C);
print("DRAM=",(unsigned int *)ahp+0x2E0000+0x1C);
printhex(ram,(unsigned int *)ahp+0x2E0000+0x1C);
print("\n",(unsigned int *)ahp+0x2E0000+0x1C);
print("DRAM=",(unsigned int *)ahp+0x800000+0x260000+0x1C);
printhex(ram,(unsigned int *)ahp+0x800000+0x260000+0x1C);
print("\n",(unsigned int *)ahp+0x800000+0x260000+0x1C);
print("DRAM=",(unsigned int *)ahp+0x800000+0x270000+0x1C);
printhex(ram,(unsigned int *)ahp+0x800000+0x270000+0x1C);
print("\n",(unsigned int *)ahp+0x800000+0x270000+0x1C);
}
}
}