From f0e5e17c4461ced35b9ecd9977801c2fa4a051a1 Mon Sep 17 00:00:00 2001
From: Sebastian Huber <sebastian.huber@embedded-brains.de>
Date: Tue, 19 Dec 2017 11:42:10 +0100
Subject: bsp/altera-cyclone-v: Adjust work area

Use FDT to adjust the work area.  Reduce work area of linker command
file.
---
 c/src/lib/libbsp/arm/altera-cyclone-v/Makefile.am  |  2 +-
 .../arm/altera-cyclone-v/startup/bspgetworkarea.c  | 92 ++++++++++++++++++++++
 .../startup/linkcmds.altcycv_devkit                |  2 +-
 3 files changed, 94 insertions(+), 2 deletions(-)
 create mode 100644 c/src/lib/libbsp/arm/altera-cyclone-v/startup/bspgetworkarea.c

diff --git a/c/src/lib/libbsp/arm/altera-cyclone-v/Makefile.am b/c/src/lib/libbsp/arm/altera-cyclone-v/Makefile.am
index abf0b5dacc..0605229126 100644
--- a/c/src/lib/libbsp/arm/altera-cyclone-v/Makefile.am
+++ b/c/src/lib/libbsp/arm/altera-cyclone-v/Makefile.am
@@ -146,7 +146,6 @@ libbsp_a_SOURCES += hwlib/src/hwmgr/alt_reset_manager.c
 # Shared
 libbsp_a_SOURCES += ../../shared/bootcard.c
 libbsp_a_SOURCES += ../../shared/getentropy-cpucounter.c
-libbsp_a_SOURCES += ../../shared/bspgetworkarea.c
 libbsp_a_SOURCES += ../../shared/bsppredriverhook.c
 libbsp_a_SOURCES += ../../shared/cpucounterdiff.c
 libbsp_a_SOURCES += ../../shared/gnatinstallhandler.c
@@ -160,6 +159,7 @@ libbsp_a_SOURCES += ../shared/arm-cp15-set-ttb-entries.c
 
 # Startup
 libbsp_a_SOURCES += startup/bspclean.c
+libbsp_a_SOURCES += startup/bspgetworkarea.c
 libbsp_a_SOURCES += startup/bspreset.c
 libbsp_a_SOURCES += startup/bspstart.c
 libbsp_a_SOURCES += startup/bspstarthooks.c
diff --git a/c/src/lib/libbsp/arm/altera-cyclone-v/startup/bspgetworkarea.c b/c/src/lib/libbsp/arm/altera-cyclone-v/startup/bspgetworkarea.c
new file mode 100644
index 0000000000..5a3af5d762
--- /dev/null
+++ b/c/src/lib/libbsp/arm/altera-cyclone-v/startup/bspgetworkarea.c
@@ -0,0 +1,92 @@
+/*
+ * Copyright (c) 2017 embedded brains GmbH
+ *
+ * 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.
+ */
+
+#include <bsp/bootcard.h>
+#include <bsp/arm-cp15-start.h>
+#include <bsp/fdt.h>
+#include <bsp/linker-symbols.h>
+
+#include <libcpu/arm-cp15.h>
+
+#include <libfdt.h>
+
+#define AREA_COUNT_MAX 16
+
+static const char memory_path[] = "/memory";
+
+static void adjust_memory_size(const void *fdt, Heap_Area *area)
+{
+  int node;
+
+  node = fdt_path_offset_namelen(
+    fdt,
+    memory_path,
+    (int) sizeof(memory_path) - 1
+  );
+
+  if (node >= 0) {
+    int len;
+    const void *val;
+    uintptr_t begin;
+    uintptr_t size;
+    uintptr_t a_bit;
+
+    val = fdt_getprop(fdt, node, "reg", &len);
+    if (len == 8) {
+      begin = fdt32_to_cpu(((fdt32_t *) val)[0]);
+      size = fdt32_to_cpu(((fdt32_t *) val)[1]);
+    } else {
+      begin = 0;
+      size = 0;
+    }
+
+    /*
+     * Remove a bit to avoid problems with speculative memory accesses beyond
+     * the valid memory area.
+     */
+    a_bit = 0x100000;
+    if (size >= a_bit) {
+      size -= a_bit;
+    }
+
+    if (
+      begin == 0
+        && size > (uintptr_t) bsp_section_work_end
+        && (uintptr_t) bsp_section_nocache_end
+          < (uintptr_t) bsp_section_work_end
+    ) {
+      area->size += size - (uintptr_t) bsp_section_work_end;
+    }
+  }
+}
+
+void bsp_work_area_initialize(void)
+{
+  const void *fdt;
+  Heap_Area areas[AREA_COUNT_MAX];
+  size_t area_count;
+  size_t i;
+
+  areas[0].begin = bsp_section_work_begin;
+  areas[0].size = (uintptr_t) bsp_section_work_size;
+  area_count = 1;
+
+  fdt = bsp_fdt_get();
+
+  adjust_memory_size(fdt, &areas[0]);
+
+  for (i = 0; i < area_count; ++i) {
+    arm_cp15_set_translation_table_entries(
+      areas[i].begin,
+      (void *) ((uintptr_t) areas[i].begin + areas[i].size),
+      ARMV7_MMU_READ_WRITE_CACHED
+    );
+  }
+
+  bsp_work_area_initialize_with_table(areas, area_count);
+}
diff --git a/c/src/lib/libbsp/arm/altera-cyclone-v/startup/linkcmds.altcycv_devkit b/c/src/lib/libbsp/arm/altera-cyclone-v/startup/linkcmds.altcycv_devkit
index c36b3ce323..546db0e123 100644
--- a/c/src/lib/libbsp/arm/altera-cyclone-v/startup/linkcmds.altcycv_devkit
+++ b/c/src/lib/libbsp/arm/altera-cyclone-v/startup/linkcmds.altcycv_devkit
@@ -1,7 +1,7 @@
 MEMORY {
    RAM_MMU : ORIGIN = 0x00100000, LENGTH = 16k
    NOCACHE : ORIGIN = 0x00200000, LENGTH = 1M
-   RAM     : ORIGIN = 0x00300000, LENGTH = 1024M - 1M - 1M - 1M
+   RAM     : ORIGIN = 0x00300000, LENGTH = 256M - 1M - 1M - 1M
 }
 
 INCLUDE linkcmds.altcycv
-- 
cgit v1.2.3