Changeset 037e8ae5 in rtems

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()

Location:

c/src/lib

Files:

• libbsp/arm/lpc32xx/Makefile.am (modified) (2 diffs)
• libbsp/arm/lpc32xx/include/mmu.h (modified) (1 diff)
• libbsp/arm/shared/arm-cp15-set-ttb-entries.c (moved) (moved from c/src/lib/libbsp/arm/lpc32xx/misc/mmu.c) (4 diffs)
• libcpu/arm/shared/include/arm-cp15.h (modified) (1 diff)

c/src/lib/libbsp/arm/lpc32xx/Makefile.am

@@ -94 +94 @@
 libbsp_a_SOURCES += ../shared/abort/simple_abort.c
 libbsp_a_SOURCES += ../shared/startup/bsp-start-memcpy.S
+libbsp_a_SOURCES += ../shared/arm-cp15-set-ttb-entries.c
 
 # Startup
@@ -129 +130 @@
 libbsp_a_SOURCES += misc/emc.c
 libbsp_a_SOURCES += misc/i2c.c
-libbsp_a_SOURCES += misc/mmu.c
 libbsp_a_SOURCES += misc/nand-mlc.c
 libbsp_a_SOURCES += misc/nand-mlc-erase-block-safe.c

c/src/lib/libbsp/arm/lpc32xx/include/mmu.h

@@ -62 +62 @@
  * @return Previous section flags of the first modified entry.
  */
-uint32_t lpc32xx_set_translation_table_entries(
+static inline uint32_t lpc32xx_set_translation_table_entries(
   const void *begin,
   const void *end,
   uint32_t section_flags
-);
+)
+{
+  return arm_cp15_set_translation_table_entries(begin, end, section_flags);
+}
 
 /** @} */

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);

c/src/lib/libcpu/arm/shared/include/arm-cp15.h

@@ -775 +775 @@
 }
 
+/**
+ * @brief Sets the @a section_flags for the address range [@a begin, @a end).
+ *
+ * @return Previous section flags of the first modified entry.
+ */
+uint32_t arm_cp15_set_translation_table_entries(
+  const void *begin,
+  const void *end,
+  uint32_t section_flags
+);
+
 /** @} */