Changeset 037e8ae5 in rtems for c/src/lib/libbsp/arm/shared/arm-cp15-set-ttb-entries.c

Timestamp:

May 2, 2013, 3:42:20 PM (8 years ago)

Author:

Sebastian Huber <sebastian.huber@…>

Branches:

4.11, 5, master

Children:

88cf23f

Parents:

544615d

git-author:

Sebastian Huber <sebastian.huber@…> (05/02/13 15:42:20)

git-committer:

Sebastian Huber <sebastian.huber@…> (05/03/13 15:30:55)

Message:

bsps/arm: Add arm_cp15_set_trans*_table_entries()

File:

• c/src/lib/libbsp/arm/shared/arm-cp15-set-ttb-entries.c (moved) (moved from c/src/lib/libbsp/arm/lpc32xx/misc/mmu.c) (4 diffs)

c/src/lib/libbsp/arm/shared/arm-cp15-set-ttb-entries.c

@@ -1 @@
-/**
- * @file
- *
- * @ingroup lpc32xx_mmu
- *
- * @brief MMU support implementation.
- */
-
 /*
- * Copyright (c) 2010-2011 embedded brains GmbH.  All rights reserved.
+ * Copyright (c) 2010-2013 embedded brains GmbH.  All rights reserved.
  *
  *  embedded brains GmbH
@@ -21 +13 @@
  */
 
-#include <bsp/mmu.h>
+#include <libcpu/arm-cp15.h>
 
-static uint32_t disable_mmu(void)
-{
-  uint32_t ctrl = 0;
-
-  arm_cp15_data_cache_test_and_clean_and_invalidate();
-
-  ctrl = arm_cp15_get_control();
-  arm_cp15_set_control(ctrl & ~ARM_CP15_CTRL_M);
-
-  arm_cp15_tlb_invalidate();
-
-  return ctrl;
-}
-
-static void restore_mmu_control(uint32_t ctrl)
-{
-  arm_cp15_set_control(ctrl);
-}
-
-uint32_t set_translation_table_entries(
+static uint32_t set_translation_table_entries(
   const void *begin,
   const void *end,
@@ -48 +21 @@
 )
 {
+  uint32_t cl_size = arm_cp15_get_min_cache_line_size();
   uint32_t *ttb = arm_cp15_get_translation_table_base();
   uint32_t i = ARM_MMU_SECT_GET_INDEX(begin);
   uint32_t iend = ARM_MMU_SECT_GET_INDEX(ARM_MMU_SECT_MVA_ALIGN_UP(end));
-  uint32_t ctrl = disable_mmu();
-  uint32_t section_flags_of_first_entry = ttb [i];
+  uint32_t ctrl;
+  uint32_t section_flags_of_first_entry;
+
+  ctrl = arm_cp15_mmu_disable(cl_size);
+  arm_cp15_tlb_invalidate();
+  section_flags_of_first_entry = ttb [i];
 
   while (i < iend) {
-    ttb [i] = (i << ARM_MMU_SECT_BASE_SHIFT) | section_flags;
+    uint32_t addr = i << ARM_MMU_SECT_BASE_SHIFT;
+
+    ttb [i] = addr | section_flags;
+
     ++i;
   }
 
-  restore_mmu_control(ctrl);
+  arm_cp15_set_control(ctrl);
 
   return section_flags_of_first_entry;
 }
 
-uint32_t lpc32xx_set_translation_table_entries(
+uint32_t arm_cp15_set_translation_table_entries(
   const void *begin,
   const void *end,
@@ -71 +52 @@
 {
   rtems_interrupt_level level;
-  uint32_t section_flags_of_first_entry = 0;
+  uint32_t section_flags_of_first_entry;
 
   rtems_interrupt_disable(level);