|
@@ -0,0 +1,457 @@
|
|
|
+/*
|
|
|
+ * File : mmu.c
|
|
|
+ * This file is part of RT-Thread RTOS
|
|
|
+ * COPYRIGHT (C) 2006, RT-Thread Development Team
|
|
|
+ *
|
|
|
+ * The license and distribution terms for this file may be
|
|
|
+ * found in the file LICENSE in this distribution or at
|
|
|
+ * http://www.rt-thread.org/license/LICENSE
|
|
|
+ *
|
|
|
+ * Change Logs:
|
|
|
+ * Date Author Notes
|
|
|
+ * 2012-01-10 bernard porting to AM1808
|
|
|
+ */
|
|
|
+
|
|
|
+#include <rtthread.h>
|
|
|
+#include "am33xx.h"
|
|
|
+
|
|
|
+#define DESC_SEC (0x2|(1<<4))
|
|
|
+#define CB (3<<2) //cache_on, write_back
|
|
|
+#define CNB (2<<2) //cache_on, write_through
|
|
|
+#define NCB (1<<2) //cache_off,WR_BUF on
|
|
|
+#define NCNB (0<<2) //cache_off,WR_BUF off
|
|
|
+#define AP_RW (3<<10) //supervisor=RW, user=RW
|
|
|
+#define AP_RO (2<<10) //supervisor=RW, user=RO
|
|
|
+
|
|
|
+#define DOMAIN_FAULT (0x0)
|
|
|
+#define DOMAIN_CHK (0x1)
|
|
|
+#define DOMAIN_NOTCHK (0x3)
|
|
|
+#define DOMAIN0 (0x0<<5)
|
|
|
+#define DOMAIN1 (0x1<<5)
|
|
|
+
|
|
|
+#define DOMAIN0_ATTR (DOMAIN_CHK<<0)
|
|
|
+#define DOMAIN1_ATTR (DOMAIN_FAULT<<2)
|
|
|
+
|
|
|
+#define RW_CB (AP_RW|DOMAIN0|CB|DESC_SEC) /* Read/Write, cache, write back */
|
|
|
+#define RW_CNB (AP_RW|DOMAIN0|CNB|DESC_SEC) /* Read/Write, cache, write through */
|
|
|
+#define RW_NCNB (AP_RW|DOMAIN0|NCNB|DESC_SEC) /* Read/Write without cache and write buffer */
|
|
|
+#define RW_FAULT (AP_RW|DOMAIN1|NCNB|DESC_SEC) /* Read/Write without cache and write buffer */
|
|
|
+
|
|
|
+#ifdef __CC_ARM
|
|
|
+void mmu_setttbase(rt_uint32_t i)
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ /* Invalidates all TLBs.Domain access is selected as
|
|
|
+ * client by configuring domain access register,
|
|
|
+ * in that case access controlled by permission value
|
|
|
+ * set by page table entry
|
|
|
+ */
|
|
|
+ value = 0;
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mcr p15, 0, value, c8, c7, 0
|
|
|
+ }
|
|
|
+
|
|
|
+ value = 0x55555555;
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mcr p15, 0, value, c3, c0, 0
|
|
|
+ mcr p15, 0, i, c2, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_set_domain(rt_uint32_t i)
|
|
|
+{
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mcr p15,0, i, c3, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_enable()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mrc p15, 0, value, c1, c0, 0
|
|
|
+ orr value, value, #0x01
|
|
|
+ mcr p15, 0, value, c1, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_disable()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mrc p15, 0, value, c1, c0, 0
|
|
|
+ bic value, value, #0x01
|
|
|
+ mcr p15, 0, value, c1, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_enable_icache()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mrc p15, 0, value, c1, c0, 0
|
|
|
+ orr value, value, #0x1000
|
|
|
+ mcr p15, 0, value, c1, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_enable_dcache()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mrc p15, 0, value, c1, c0, 0
|
|
|
+ orr value, value, #0x04
|
|
|
+ mcr p15, 0, value, c1, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_disable_icache()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mrc p15, 0, value, c1, c0, 0
|
|
|
+ bic value, value, #0x1000
|
|
|
+ mcr p15, 0, value, c1, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_disable_dcache()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mrc p15, 0, value, c1, c0, 0
|
|
|
+ bic value, value, #0x04
|
|
|
+ mcr p15, 0, value, c1, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_enable_alignfault()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mrc p15, 0, value, c1, c0, 0
|
|
|
+ orr value, value, #0x02
|
|
|
+ mcr p15, 0, value, c1, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_disable_alignfault()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mrc p15, 0, value, c1, c0, 0
|
|
|
+ bic value, value, #0x02
|
|
|
+ mcr p15, 0, value, c1, c0, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_clean_invalidated_cache_index(int index)
|
|
|
+{
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mcr p15, 0, index, c7, c14, 2
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_clean_invalidated_dcache(rt_uint32_t buffer, rt_uint32_t size)
|
|
|
+{
|
|
|
+ unsigned int ptr;
|
|
|
+
|
|
|
+ ptr = buffer & ~0x1f;
|
|
|
+
|
|
|
+ while(ptr < buffer + size)
|
|
|
+ {
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ MCR p15, 0, ptr, c7, c14, 1
|
|
|
+ }
|
|
|
+ ptr += 32;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_clean_dcache(rt_uint32_t buffer, rt_uint32_t size)
|
|
|
+{
|
|
|
+ unsigned int ptr;
|
|
|
+
|
|
|
+ ptr = buffer & ~0x1f;
|
|
|
+
|
|
|
+ while (ptr < buffer + size)
|
|
|
+ {
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ MCR p15, 0, ptr, c7, c10, 1
|
|
|
+ }
|
|
|
+ ptr += 32;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_invalidate_dcache(rt_uint32_t buffer, rt_uint32_t size)
|
|
|
+{
|
|
|
+ unsigned int ptr;
|
|
|
+
|
|
|
+ ptr = buffer & ~0x1f;
|
|
|
+
|
|
|
+ while (ptr < buffer + size)
|
|
|
+ {
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ MCR p15, 0, ptr, c7, c6, 1
|
|
|
+ }
|
|
|
+ ptr += 32;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_invalidate_tlb()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ value = 0;
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mcr p15, 0, value, c8, c7, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_invalidate_icache()
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ value = 0;
|
|
|
+
|
|
|
+ __asm
|
|
|
+ {
|
|
|
+ mcr p15, 0, value, c7, c5, 0
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+#elif defined(__GNUC__)
|
|
|
+void mmu_setttbase(register rt_uint32_t i)
|
|
|
+{
|
|
|
+ register rt_uint32_t value;
|
|
|
+
|
|
|
+ /* Invalidates all TLBs.Domain access is selected as
|
|
|
+ * client by configuring domain access register,
|
|
|
+ * in that case access controlled by permission value
|
|
|
+ * set by page table entry
|
|
|
+ */
|
|
|
+ value = 0;
|
|
|
+ asm ("mcr p15, 0, %0, c8, c7, 0"::"r"(value));
|
|
|
+
|
|
|
+ value = 0x55555555;
|
|
|
+ asm ("mcr p15, 0, %0, c3, c0, 0"::"r"(value));
|
|
|
+ asm ("mcr p15, 0, %0, c2, c0, 0"::"r"(i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_set_domain(register rt_uint32_t i)
|
|
|
+{
|
|
|
+ asm ("mcr p15,0, %0, c3, c0, 0": :"r" (i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_enable()
|
|
|
+{
|
|
|
+ register rt_uint32_t i;
|
|
|
+
|
|
|
+ /* read control register */
|
|
|
+ asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
|
|
|
+
|
|
|
+ i |= 0x1;
|
|
|
+
|
|
|
+ /* write back to control register */
|
|
|
+ asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_disable()
|
|
|
+{
|
|
|
+ register rt_uint32_t i;
|
|
|
+
|
|
|
+ /* read control register */
|
|
|
+ asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
|
|
|
+
|
|
|
+ i &= ~0x1;
|
|
|
+
|
|
|
+ /* write back to control register */
|
|
|
+ asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_enable_icache()
|
|
|
+{
|
|
|
+ register rt_uint32_t i;
|
|
|
+
|
|
|
+ /* read control register */
|
|
|
+ asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
|
|
|
+
|
|
|
+ i |= (1 << 12);
|
|
|
+
|
|
|
+ /* write back to control register */
|
|
|
+ asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_enable_dcache()
|
|
|
+{
|
|
|
+ register rt_uint32_t i;
|
|
|
+
|
|
|
+ /* read control register */
|
|
|
+ asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
|
|
|
+
|
|
|
+ i |= (1 << 2);
|
|
|
+
|
|
|
+ /* write back to control register */
|
|
|
+ asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_disable_icache()
|
|
|
+{
|
|
|
+ register rt_uint32_t i;
|
|
|
+
|
|
|
+ /* read control register */
|
|
|
+ asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
|
|
|
+
|
|
|
+ i &= ~(1 << 12);
|
|
|
+
|
|
|
+ /* write back to control register */
|
|
|
+ asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_disable_dcache()
|
|
|
+{
|
|
|
+ register rt_uint32_t i;
|
|
|
+
|
|
|
+ /* read control register */
|
|
|
+ asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
|
|
|
+
|
|
|
+ i &= ~(1 << 2);
|
|
|
+
|
|
|
+ /* write back to control register */
|
|
|
+ asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_enable_alignfault()
|
|
|
+{
|
|
|
+ register rt_uint32_t i;
|
|
|
+
|
|
|
+ /* read control register */
|
|
|
+ asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
|
|
|
+
|
|
|
+ i |= (1 << 1);
|
|
|
+
|
|
|
+ /* write back to control register */
|
|
|
+ asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_disable_alignfault()
|
|
|
+{
|
|
|
+ register rt_uint32_t i;
|
|
|
+
|
|
|
+ /* read control register */
|
|
|
+ asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
|
|
|
+
|
|
|
+ i &= ~(1 << 1);
|
|
|
+
|
|
|
+ /* write back to control register */
|
|
|
+ asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_clean_invalidated_cache_index(int index)
|
|
|
+{
|
|
|
+ asm ("mcr p15, 0, %0, c7, c14, 2": :"r" (index));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_clean_dcache(rt_uint32_t buffer, rt_uint32_t size)
|
|
|
+{
|
|
|
+ unsigned int ptr;
|
|
|
+
|
|
|
+ ptr = buffer & ~0x1f;
|
|
|
+
|
|
|
+ while (ptr < buffer + size)
|
|
|
+ {
|
|
|
+ asm ("mcr p15, 0, %0, c7, c10, 1": :"r" (ptr));
|
|
|
+ ptr += 32;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_invalidate_dcache(rt_uint32_t buffer, rt_uint32_t size)
|
|
|
+{
|
|
|
+ unsigned int ptr;
|
|
|
+
|
|
|
+ ptr = buffer & ~0x1f;
|
|
|
+
|
|
|
+ while (ptr < buffer + size)
|
|
|
+ {
|
|
|
+ asm ("mcr p15, 0, %0, c7, c6, 1": :"r" (ptr));
|
|
|
+ ptr += 32;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_invalidate_tlb()
|
|
|
+{
|
|
|
+ asm ("mcr p15, 0, %0, c8, c7, 0": :"r" (0));
|
|
|
+}
|
|
|
+
|
|
|
+void mmu_invalidate_icache()
|
|
|
+{
|
|
|
+ asm ("mcr p15, 0, %0, c7, c5, 0": :"r" (0));
|
|
|
+}
|
|
|
+#endif
|
|
|
+
|
|
|
+/* level1 page table */
|
|
|
+static volatile unsigned int _page_table[4*1024] __attribute__((aligned(16*1024)));
|
|
|
+void mmu_setmtt(rt_uint32_t vaddrStart, rt_uint32_t vaddrEnd, rt_uint32_t paddrStart, rt_uint32_t attr)
|
|
|
+{
|
|
|
+ volatile rt_uint32_t *pTT;
|
|
|
+ volatile int i,nSec;
|
|
|
+ pTT=(rt_uint32_t *)_page_table+(vaddrStart>>20);
|
|
|
+ nSec=(vaddrEnd>>20)-(vaddrStart>>20);
|
|
|
+ for(i=0;i<=nSec;i++)
|
|
|
+ {
|
|
|
+ *pTT = attr |(((paddrStart>>20)+i)<<20);
|
|
|
+ pTT++;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+void rt_hw_mmu_init(void)
|
|
|
+{
|
|
|
+ /* disable I/D cache */
|
|
|
+ mmu_disable_dcache();
|
|
|
+ mmu_disable_icache();
|
|
|
+ mmu_disable();
|
|
|
+ mmu_invalidate_tlb();
|
|
|
+
|
|
|
+ /* set page table */
|
|
|
+ mmu_setmtt(0x00000000, 0xFFFFFFFF, 0x00000000, RW_NCNB); /* None cached for 4G memory */
|
|
|
+ mmu_setmtt(0xC0000000, 0xC8000000-1, 0xC0000000, RW_CB); /* 128M cached DDR memory */
|
|
|
+ mmu_setmtt(0xD0000000, 0xD8000000-1, 0xC0000000, RW_NCNB); /* 128M none-cached DDR memory */
|
|
|
+ mmu_setmtt(0x80000000, 0x80020000-1, 0x80000000, RW_CB); /* 128k OnChip memory */
|
|
|
+
|
|
|
+ /* set MMU table address */
|
|
|
+ mmu_setttbase((rt_uint32_t)_page_table);
|
|
|
+
|
|
|
+ /* enables MMU */
|
|
|
+ mmu_enable();
|
|
|
+
|
|
|
+ /* enable Instruction Cache */
|
|
|
+ mmu_enable_icache();
|
|
|
+
|
|
|
+ /* enable Data Cache */
|
|
|
+ mmu_enable_dcache();
|
|
|
+}
|
|
|
+
|