continue implementing mmu.S in C

This commit is contained in:
Markus Fröschle
2013-08-01 16:24:58 +00:00
parent 951447352c
commit 21139924fc
2 changed files with 58 additions and 1 deletions

View File

@@ -10,7 +10,7 @@
#define STD_MMUTR (MCF_MMU_MMUTR_SG | MCF_MMU_MMUTR_V)
#define MMUORD_D (MCF_MMU_MMUOR_ACC | MCF_MMU_MMUOR_UAA)
#define MMUORD_I (MCF_MMU_MMUOR_ITLB | MCF_MMU_MUOR_ACC | MCF_MMU_MMUOR_UAA)
#define MMUORD_I (MCF_MMU_MMUOR_ITLB | MCF_MMU_MMUOR_ACC | MCF_MMU_MMUOR_UAA)
#define WRITETHROUGH_MMUDR (MCF_MMU_MMUDR_SZ(00) | MCF_MMU_MMUDR_CM(00) | MCF_MMU_MMUDR_R | MCF_MMU_MMUDR_W | MCF_MMU_MMUDR_X)
#define COPYBACK_MMUDR (MCF_MMU_MMUDR_SZ(00) | MCF_MMU_MMUDR_CM(01) | MCF_MMU_MMUDR_R | MCF_MMU_MMUDR_W | MCF_MMU_MMUDR_X)

View File

@@ -11,13 +11,70 @@
void mmu_init(void)
{
uint32_t regval;
/*
* set ASID and shadow register
*/
__asm__ __volatile__("clr.l d0\n\t"
"movec d0,ASID\n\t"
"move.l d0,_rt_asid\n\t");
/*
* set ACR0 and shadow register
*/
__asm__ __volatile__("move.l #0xc03fc040,d0\n\t"
"movec d0,ACR0\n\t"
"move.l d0,_rt_acr0\n\t");
/*
* set ACR1 and shadow register
*/
__asm__ __volatile__("move.l #0x601fc000, d0\n\t"
"movec d0,ACR1\n\t"
"move.l d0,_rt_acr1\n\t");
/*
* set ACR2 and shadow register
*/
__asm__ __volatile__("move.l #0xe007c400,d0\n\t"
"movec d0,ACR2\n\t"
"move.l d0,_rt_acr2\n\t");
/*
* set ACR3 and shadow register (currently unused)
*/
__asm__ __volatile__("clr.l d0\n\t"
"movec d0,ACR3\n\t"
"move.l d0,_rt_acr3\n\t");
/*
* set MMUBAR
*/
__asm__ __volatile__("movel. #__MMUBAR+1,d0\n\t"
"movec d0,MMUBAR\n\t"
"move.l d0,_rt_mmubar\n\t"
"nop\n\t");
MCF_MMU_MMUOR = MCF_MMU_MMUOR; /* clear all entries */
/*
* 0x00000000 locked
*/
MCF_MMU_MMUTR = 0x0L | STD_MMUTR;
MCF_MMU_MMUDR = 0x0L | COPYBACK_MMUDR | MCF_MMU_MMUDR_LK;
MCF_MMU_MMUOR = MMUORD_D;
MCF_MMU_MMUOR = MMUORD_I;
/*
* 0x00d00000 locked ID=6
* video RAM: read write execute normal write true
*/
MCF_MMU_MMUTR = 0x00d00000 | MCF_MMU_MMUTR_ID(sca_page_ID) | STD_MMUTR;
MCF_MMU_MMUDR = 0x60d00000 | WRITETHROUGH_MMUDR | MCF_MMU_MMUDR_LK;
MCF_MMU_MMUOR = MMUORD_D;
MCF_MMU_MMUOR = 0x00d00000 | std_mmutr;
video_tlb = 0x2000;
video_sbt = 0;
}