bsp/atsam: New

Close #2529.

2 files changed, 183 insertions, 0 deletions

diff --git a/c/src/lib/libbsp/arm/shared/armv7m/include/cache_.h b/c/src/lib/libbsp/arm/shared/armv7m/include/cache_.h
new file mode 100644
index 0000000000..ef94c11734
--- /dev/null
+++ b/c/src/lib/libbsp/arm/shared/armv7m/include/cache_.h
@@ -0,0 +1,144 @@
+/*
+ * Copyright (c) 2016 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Dornierstr. 4
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.org/license/LICENSE.
+ */
+
+#ifndef LIBBSP_ARM_ARMV7M_CACHE__H
+#define LIBBSP_ARM_ARMV7M_CACHE__H
+
+#include <rtems.h>
+#include <chip.h>
+
+#define CPU_DATA_CACHE_ALIGNMENT 32
+
+#define CPU_INSTRUCTION_CACHE_ALIGNMENT 32
+
+#define CPU_CACHE_SUPPORT_PROVIDES_RANGE_FUNCTIONS
+
+static inline void _CPU_cache_flush_data_range(
+  const void *d_addr,
+  size_t n_bytes
+)
+{
+  SCB_CleanInvalidateDCache_by_Addr(
+    RTEMS_DECONST(uint32_t *, (const uint32_t *) d_addr),
+    n_bytes
+  );
+}
+
+static inline void _CPU_cache_invalidate_data_range(
+  const void *d_addr,
+  size_t n_bytes
+)
+{
+  SCB_InvalidateDCache_by_Addr(
+    RTEMS_DECONST(uint32_t *, (const uint32_t *) d_addr),
+    n_bytes
+  );
+}
+
+static inline void _CPU_cache_freeze_data(void)
+{
+  /* TODO */
+}
+
+static inline void _CPU_cache_unfreeze_data(void)
+{
+  /* TODO */
+}
+
+static inline void _CPU_cache_invalidate_instruction_range(
+  const void *i_addr,
+  size_t n_bytes
+)
+{
+  rtems_interrupt_level level;
+
+  rtems_interrupt_disable(level);
+  SCB_InvalidateICache();
+  rtems_interrupt_enable(level);
+}
+
+static inline void _CPU_cache_freeze_instruction(void)
+{
+  /* TODO */
+}
+
+static inline void _CPU_cache_unfreeze_instruction(void)
+{
+  /* TODO */
+}
+
+static inline void _CPU_cache_flush_entire_data(void)
+{
+  rtems_interrupt_level level;
+
+  rtems_interrupt_disable(level);
+  SCB_CleanDCache();
+  rtems_interrupt_enable(level);
+}
+
+static inline void _CPU_cache_invalidate_entire_data(void)
+{
+  rtems_interrupt_level level;
+
+  rtems_interrupt_disable(level);
+  SCB_InvalidateDCache();
+  rtems_interrupt_enable(level);
+}
+
+static inline void _CPU_cache_enable_data(void)
+{
+  rtems_interrupt_level level;
+
+  rtems_interrupt_disable(level);
+  SCB_EnableDCache();
+  rtems_interrupt_enable(level);
+}
+
+static inline void _CPU_cache_disable_data(void)
+{
+  rtems_interrupt_level level;
+
+  rtems_interrupt_disable(level);
+  SCB_DisableDCache();
+  rtems_interrupt_enable(level);
+}
+
+static inline void _CPU_cache_invalidate_entire_instruction(void)
+{
+  rtems_interrupt_level level;
+
+  rtems_interrupt_disable(level);
+  SCB_InvalidateICache();
+  rtems_interrupt_enable(level);
+}
+
+static inline void _CPU_cache_enable_instruction(void)
+{
+  rtems_interrupt_level level;
+
+  rtems_interrupt_disable(level);
+  SCB_EnableICache();
+  rtems_interrupt_enable(level);
+}
+
+static inline void _CPU_cache_disable_instruction(void)
+{
+  rtems_interrupt_level level;
+
+  rtems_interrupt_disable(level);
+  SCB_DisableICache();
+  rtems_interrupt_enable(level);
+}
+
+#endif /* LIBBSP_ARM_ARMV7M_CACHE__H */
diff --git a/c/src/lib/libbsp/arm/shared/include/start.h b/c/src/lib/libbsp/arm/shared/include/start.h
index 9df6df4f3f..f61eed398e 100644
--- a/c/src/lib/libbsp/arm/shared/include/start.h
+++ b/c/src/lib/libbsp/arm/shared/include/start.h
@@ -121,6 +121,45 @@ BSP_START_TEXT_SECTION static inline void bsp_start_copy_sections(void)
   );
 }
 
+BSP_START_TEXT_SECTION static inline void
+bsp_start_memcpy_libc(void *dest, const void *src, size_t n)
+{
+  if (dest != src) {
+    memcpy(dest, src, n);
+  }
+}
+
+/**
+ * @brief Copies the .data, .fast_text and .fast_data sections from the load to
+ * the runtime area using the C library memcpy().
+ *
+ * Works only in case the .start, .text and .rodata sections reside in one
+ * memory region.
+ */
+BSP_START_TEXT_SECTION static inline void bsp_start_copy_sections_compact(void)
+{
+  /* Copy .data section */
+  bsp_start_memcpy_libc(
+    bsp_section_data_begin,
+    bsp_section_data_load_begin,
+    (size_t) bsp_section_data_size
+  );
+
+  /* Copy .fast_text section */
+  bsp_start_memcpy_libc(
+    bsp_section_fast_text_begin,
+    bsp_section_fast_text_load_begin,
+    (size_t) bsp_section_fast_text_size
+  );
+
+  /* Copy .fast_data section */
+  bsp_start_memcpy_libc(
+    bsp_section_fast_data_begin,
+    bsp_section_fast_data_load_begin,
+    (size_t) bsp_section_fast_data_size
+  );
+}
+
 BSP_START_TEXT_SECTION static inline void bsp_start_clear_bss(void)
 {
   memset(bsp_section_bss_begin, 0, (size_t) bsp_section_bss_size);