[PATCH v4 10/27] lmb: introduce a function to add memory to the lmb memory map

[Sughosh Ganu]

Introduce a function lmb_add_memory() to add available memory to the
LMB memory map. Call this function during board init once the LMB data
structures have been initialised.

Signed-off-by: Sughosh Ganu <sughosh.g...@linaro.org>
Reviewed-by: Simon Glass <s...@chromium.org>
---
Changes since V3: None

 include/lmb.h | 11 +++++++++++
 lib/lmb.c     | 39 +++++++++++++++++++++++++++++++++++++++
 2 files changed, 50 insertions(+)

diff --git a/include/lmb.h b/include/lmb.h
index cc2c426c13..70191456e5 100644
--- a/include/lmb.h
+++ b/include/lmb.h
@@ -66,6 +66,17 @@ int lmb_init(void);
 void lmb_init_and_reserve(struct bd_info *bd, void *fdt_blob);
 void lmb_init_and_reserve_range(phys_addr_t base, phys_size_t size,
                                void *fdt_blob);
+
+/**
+ * lmb_add_memory() - Add memory range for LMB allocations
+ *
+ * Add the entire available memory range to the pool of memory that
+ * can be used by the LMB module for allocations.
+ *
+ * Return: None
+ */
+void lmb_add_memory(void);
+
 long lmb_add(phys_addr_t base, phys_size_t size);
 long lmb_reserve(phys_addr_t base, phys_size_t size);
 /**
diff --git a/lib/lmb.c b/lib/lmb.c
index 8be0c1a583..44ecf96811 100644
--- a/lib/lmb.c
+++ b/lib/lmb.c
@@ -246,6 +246,43 @@ void lmb_init_and_reserve_range(phys_addr_t base, 
phys_size_t size,
        lmb_reserve_common(fdt_blob);
 }
 
+/**
+ * lmb_add_memory() - Add memory range for LMB allocations
+ *
+ * Add the entire available memory range to the pool of memory that
+ * can be used by the LMB module for allocations.
+ *
+ * Return: None
+ */
+void lmb_add_memory(void)
+{
+       int i;
+       phys_size_t size;
+       phys_addr_t rgn_top;
+       u64 ram_top = gd->ram_top;
+       struct bd_info *bd = gd->bd;
+
+       /* Assume a 4GB ram_top if not defined */
+       if (!ram_top)
+               ram_top = 0x100000000ULL;
+
+       for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
+               size = bd->bi_dram[i].size;
+               if (size) {
+                       if (bd->bi_dram[i].start > ram_top)
+                               continue;
+
+                       rgn_top = bd->bi_dram[i].start +
+                               bd->bi_dram[i].size;
+
+                       if (rgn_top > ram_top)
+                               size -= rgn_top - ram_top;
+
+                       lmb_add(bd->bi_dram[i].start, size);
+               }
+       }
+}
+
 static long lmb_resize_regions(struct alist *lmb_rgn_lst,
                               unsigned long idx_start,
                               phys_addr_t base, phys_size_t size)
@@ -696,6 +733,8 @@ int lmb_init(void)
                return ret;
        }
 
+       lmb_add_memory();
+
        return 0;
 }
 
-- 
2.34.1