mmu.c
上传用户:jankzhpno
上传日期:2022-08-03
资源大小:4763k
文件大小:4k
源码类别:

Windows CE

开发平台:

Visual C++

  1. /************************************************ 
  2.   NAME    : MMU.C
  3.   DESC   :
  4.   Revision: 2002.2.28 ver 0.0
  5.  ************************************************/
  6. #include "def.h"
  7. #include "option.h"
  8. #include "2440addr.h"
  9. #include "2440lib.h"
  10. #include "2440slib.h"
  11. #include "mmu.h"
  12. // 1) Only the section table is used. 
  13. // 2) The cachable/non-cachable area can be changed by MMT_DEFAULT value.
  14. //    The section size is 1MB.
  15.  
  16. extern char __ENTRY[];
  17. void MMU_Init(void)
  18. {
  19.     int i,j;
  20.     //========================== IMPORTANT NOTE =========================
  21.     //The current stack and code area can't be re-mapped in this routine.
  22.     //If you want memory map mapped freely, your own sophiscated MMU
  23.     //initialization code is needed.
  24.     //===================================================================
  25.     MMU_DisableDCache();
  26.     MMU_DisableICache();
  27.     //If write-back is used,the DCache should be cleared.
  28.     for(i=0;i<64;i++)
  29.      for(j=0;j<8;j++)
  30.          MMU_CleanInvalidateDCacheIndex((i<<26)|(j<<5));
  31.     MMU_InvalidateICache();
  32.     
  33.     #if 0
  34.     //To complete MMU_Init() fast, Icache may be turned on here.
  35.     MMU_EnableICache(); 
  36.     #endif
  37.     
  38.     MMU_DisableMMU();
  39.     MMU_InvalidateTLB();
  40.     //MMU_SetMTT(int vaddrStart,int vaddrEnd,int paddrStart,int attr)
  41.     //MMU_SetMTT(0x00000000,0x07f00000,0x00000000,RW_CNB);  //bank0
  42.     MMU_SetMTT(0x00000000,0x03f00000,(int)__ENTRY,RW_CB);  //bank0
  43.     MMU_SetMTT(0x04000000,0x07f00000,0,RW_NCNB);   //bank0
  44.     MMU_SetMTT(0x08000000,0x0ff00000,0x08000000,RW_CNB);  //bank1
  45.     MMU_SetMTT(0x10000000,0x17f00000,0x10000000,RW_NCNB); //bank2
  46.     MMU_SetMTT(0x18000000,0x1ff00000,0x18000000,RW_NCNB); //bank3
  47.     //MMU_SetMTT(0x20000000,0x27f00000,0x20000000,RW_CB); //bank4
  48.     MMU_SetMTT(0x20000000,0x27f00000,0x20000000,RW_CNB); //bank4 for STRATA Flash
  49.     MMU_SetMTT(0x28000000,0x2ff00000,0x28000000,RW_NCNB); //bank5
  50.     //30f00000->30100000, 31000000->30200000
  51.     MMU_SetMTT(0x30000000,0x30100000,0x30000000,RW_CB);   //bank6-1
  52.     MMU_SetMTT(0x30200000,0x33e00000,0x30200000,RW_NCNB); //bank6-2
  53.     //
  54.     MMU_SetMTT(0x33f00000,0x33f00000,0x33f00000,RW_CB);   //bank6-3
  55.     MMU_SetMTT(0x38000000,0x3ff00000,0x38000000,RW_NCNB); //bank7
  56.     
  57.     MMU_SetMTT(0x40000000,0x47f00000,0x40000000,RW_NCNB); //SFR
  58.     MMU_SetMTT(0x48000000,0x5af00000,0x48000000,RW_NCNB); //SFR
  59.     MMU_SetMTT(0x5b000000,0x5b000000,0x5b000000,RW_NCNB); //SFR
  60.     MMU_SetMTT(0x5b100000,0xfff00000,0x5b100000,RW_FAULT);//not used
  61.     
  62.     MMU_SetTTBase(_MMUTT_STARTADDRESS);
  63.     MMU_SetDomain(0x55555550|DOMAIN1_ATTR|DOMAIN0_ATTR); 
  64.      //DOMAIN1: no_access, DOMAIN0,2~15=client(AP is checked)
  65.     MMU_SetProcessId(0x0);
  66.     MMU_EnableAlignFault();
  67.     
  68.     MMU_EnableMMU();
  69.     MMU_EnableICache();
  70.     MMU_EnableDCache(); //DCache should be turned on after MMU is turned on.
  71. }    
  72. // attr=RW_CB,RW_CNB,RW_NCNB,RW_FAULT
  73. void ChangeRomCacheStatus(int attr)
  74. {
  75.     int i,j;
  76.     MMU_DisableDCache();
  77.     MMU_DisableICache();
  78.     //If write-back is used,the DCache should be cleared.
  79.     for(i=0;i<64;i++)
  80.      for(j=0;j<8;j++)
  81.          MMU_CleanInvalidateDCacheIndex((i<<26)|(j<<5));
  82.     MMU_InvalidateICache();
  83.     MMU_DisableMMU();
  84.     MMU_InvalidateTLB();
  85.     MMU_SetMTT(0x00000000,0x07f00000,0x00000000,attr); //bank0
  86.     MMU_SetMTT(0x08000000,0x0ff00000,0x08000000,attr); //bank1
  87.     MMU_EnableMMU();
  88.     MMU_EnableICache();
  89.     MMU_EnableDCache();
  90. }    
  91.     
  92. void MMU_SetMTT(int vaddrStart,int vaddrEnd,int paddrStart,int attr)
  93. {
  94.     volatile U32 *pTT;
  95.     volatile int i,nSec;
  96.     pTT=(U32 *)_MMUTT_STARTADDRESS+(vaddrStart>>20);
  97.     nSec=(vaddrEnd>>20)-(vaddrStart>>20);
  98.     for(i=0;i<=nSec;i++)*pTT++=attr |(((paddrStart>>20)+i)<<20);
  99. }