Chinaunix首页 | 论坛 | 博客
  • 博客访问: 2224414
  • 博文数量: 668
  • 博客积分: 10016
  • 博客等级: 上将
  • 技术积分: 8588
  • 用 户 组: 普通用户
  • 注册时间: 2008-05-29 19:22
文章分类

全部博文(668)

文章存档

2011年(1)

2010年(2)

2009年(273)

2008年(392)

分类:

2008-05-31 08:45:59

这个例子把dram以1M为单位进行平板映射,分3步:填充页表;无效cache和TLB;使能MMU。
(1)mem_mapping_linear()进行页表填充:
static inline void mem_mapping_linear(void)
{
        unsigned long pageoffset, sectionNumber;

        putstr_hex("MMU table base address = 0x", (unsigned long)mmu_tlb_base);
        /* 4G, not cacacheable, not bufferable */
        for (sectionNumber = 0; sectionNumber < 4096; sectionNumber++) {
                pageoffset = (sectionNumber << 20);
                *(mmu_tlb_base + (pageoffset >> 20)) = pageoffset | MMU_SECDESC;
        }

        /* make dram cacheable */
        for (pageoffset = DRAM_BASE; pageoffset < (DRAM_BASE+DRAM_SIZE); pageoffset += SZ_1M) {
                /*DPRINTK(3, "Make DRAM section cacheable: 0x%08lx\n", pageoffset);*/
                *(mmu_tlb_base + (pageoffset >> 20)) = pageoffset | MMU_SECDESC | MMU_CACHEABLE;
        }       
} 
(2)无效cache和TLB:
 /*
  * cpu_arm920_cache_clean_invalidate_all()
  *
  * clean and invalidate all cache lines
  *
  */
 
 static inline void cpu_arm920_cache_clean_invalidate_all(void)
 {
 __asm__(
         "       mov     r1, #0\n"
   "     mov     r1, #7 << 5\n"            /* 8 segments */
         "1:     mov     r3, #0\n"         /* added by lane 2004-06-15 */
   "     orr     r3, r1,#63 << 26\n" /* 64 entries */
   "2:   mcr     p15, 0, r3, c7, c14, 2\n" /* clean & invalidate D index */
         "       subs    r3, r3, #1 << 26\n"
         "       bcs     2b\n"                     /* entries 64 to 0 */
         "       subs    r1, r1, #1 << 5\n"
         "       bcs     1b\n"                     /* segments 7 to 0 */
         "       mcr     p15, 0, r1, c7, c5, 0\n"  /* invalidate I cache */
         "       mcr     p15, 0, r1, c7, c10, 4\n" /* drain WB */
         );
 }
 
 void cache_clean_invalidate(void)
 {
         cpu_arm920_cache_clean_invalidate_all();
 }

 /*
  * cpu_arm920_tlb_invalidate_all()
  *
  * Invalidate all TLB entries
  */
 static inline void cpu_arm920_tlb_invalidate_all(void)
 {
         __asm__(
                 "mov    r0, #0\n"
                 "mcr    p15, 0, r0, c7, c10, 4\n"       /* drain WB */
                 "mcr    p15, 0, r0, c8, c7, 0\n"        /* invalidate I & D TLBs */
                 );
 }
 
 void tlb_invalidate(void)
 {
         cpu_arm920_tlb_invalidate_all();
 }
(3)使能MMU
static inline void arm920_setup(void)
{
        unsigned long ttb = MMU_TABLE_BASE;

__asm__(
        /* Invalidate caches */
        "mov    r0, #0\n"
        "mcr    p15, 0, r0, c7, c7, 0\n"        /* invalidate I,D caches on v4 */
        "mcr    p15, 0, r0, c7, c10, 4\n"       /* drain write buffer on v4 */
        "mcr    p15, 0, r0, c8, c7, 0\n"        /* invalidate I,D TLBs on v4 */
        /* Load page table pointer */
        "mov    r4, %0\n"
        "mcr    p15, 0, r4, c2, c0, 0\n"        /* load page table pointer */
        /* Write domain id (cp15_r3) */
        "mvn    r0, #0\n"                       /* Domains 0, 1 = client */
        "mcr    p15, 0, r0, c3, c0, 0\n"        /* load domain access register */
        /* Set control register v4 */
        "mrc    p15, 0, r0, c1, c0, 0\n"        /* get control register v4 */
        /* Clear out 'unwanted' bits (then put them in if we need them) */
                                                /* .RVI ..RS B... .CAM */
        "bic    r0, r0, #0x3000\n"              /* ..11 .... .... .... */
        "bic    r0, r0, #0x0300\n"              /* .... ..11 .... .... */
        "bic    r0, r0, #0x0087\n"              /* .... .... 1... .111 */
        /* Turn on what we want */
        /* Fault checking enabled */
        "orr    r0, r0, #0x0002\n"              /* .... .... .... ..1. */
#ifdef CONFIG_CPU_D_CACHE_ON
        "orr    r0, r0, #0x0004\n"              /* .... .... .... .1.. */
#endif
#ifdef CONFIG_CPU_I_CACHE_ON 
        "orr    r0, r0, #0x1000\n"              /* ...1 .... .... .... */
#endif
        /* MMU enabled */
        "orr    r0, r0, #0x0001\n"              /* .... .... .... ...1 */
        "mcr    p15, 0, r0, c1, c0, 0\n"        /* write control register */
        : /* no outputs */
        : "r" (ttb) );
}
阅读(2723) | 评论(0) | 转发(0) |
给主人留下些什么吧!~~