Merge tag 'tpm-030822' of https://source.denx.de/u-boot/custodians/u-boot-tpm
[platform/kernel/u-boot.git] / lib / lmb.c
index 75082f3..f21fe67 100644 (file)
--- a/lib/lmb.c
+++ b/lib/lmb.c
 #include <log.h>
 #include <malloc.h>
 
+#include <asm/global_data.h>
+#include <asm/sections.h>
+
+DECLARE_GLOBAL_DATA_PTR;
+
 #define LMB_ALLOC_ANYWHERE     0
 
-void lmb_dump_all_force(struct lmb *lmb)
+static void lmb_dump_region(struct lmb_region *rgn, char *name)
 {
-       unsigned long i;
+       unsigned long long base, size, end;
+       enum lmb_flags flags;
+       int i;
 
-       printf("lmb_dump_all:\n");
-       printf("    memory.cnt             = 0x%lx\n", lmb->memory.cnt);
-       printf("    memory.size            = 0x%llx\n",
-              (unsigned long long)lmb->memory.size);
-       for (i = 0; i < lmb->memory.cnt; i++) {
-               printf("    memory.reg[0x%lx].base   = 0x%llx\n", i,
-                      (unsigned long long)lmb->memory.region[i].base);
-               printf("                   .size   = 0x%llx\n",
-                      (unsigned long long)lmb->memory.region[i].size);
-       }
+       printf(" %s.cnt  = 0x%lx\n", name, rgn->cnt);
 
-       printf("\n    reserved.cnt         = 0x%lx\n", lmb->reserved.cnt);
-       printf("    reserved.size          = 0x%llx\n",
-              (unsigned long long)lmb->reserved.size);
-       for (i = 0; i < lmb->reserved.cnt; i++) {
-               printf("    reserved.reg[0x%lx].base = 0x%llx\n", i,
-                      (unsigned long long)lmb->reserved.region[i].base);
-               printf("                     .size = 0x%llx\n",
-                      (unsigned long long)lmb->reserved.region[i].size);
+       for (i = 0; i < rgn->cnt; i++) {
+               base = rgn->region[i].base;
+               size = rgn->region[i].size;
+               end = base + size - 1;
+               flags = rgn->region[i].flags;
+
+               printf(" %s[%d]\t[0x%llx-0x%llx], 0x%08llx bytes flags: %x\n",
+                      name, i, base, end, size, flags);
        }
 }
 
+void lmb_dump_all_force(struct lmb *lmb)
+{
+       printf("lmb_dump_all:\n");
+       lmb_dump_region(&lmb->memory, "memory");
+       lmb_dump_region(&lmb->reserved, "reserved");
+}
+
 void lmb_dump_all(struct lmb *lmb)
 {
 #ifdef DEBUG
@@ -85,6 +90,7 @@ static void lmb_remove_region(struct lmb_region *rgn, unsigned long r)
        for (i = r; i < rgn->cnt - 1; i++) {
                rgn->region[i].base = rgn->region[i + 1].base;
                rgn->region[i].size = rgn->region[i + 1].size;
+               rgn->region[i].flags = rgn->region[i + 1].flags;
        }
        rgn->cnt--;
 }
@@ -99,10 +105,52 @@ static void lmb_coalesce_regions(struct lmb_region *rgn, unsigned long r1,
 
 void lmb_init(struct lmb *lmb)
 {
+#if IS_ENABLED(CONFIG_LMB_USE_MAX_REGIONS)
+       lmb->memory.max = CONFIG_LMB_MAX_REGIONS;
+       lmb->reserved.max = CONFIG_LMB_MAX_REGIONS;
+#elif IS_ENABLED(CONFIG_LMB_MEMORY_REGIONS)
+       lmb->memory.max = CONFIG_LMB_MEMORY_REGIONS;
+       lmb->reserved.max = CONFIG_LMB_RESERVED_REGIONS;
+       lmb->memory.region = lmb->memory_regions;
+       lmb->reserved.region = lmb->reserved_regions;
+#endif
        lmb->memory.cnt = 0;
-       lmb->memory.size = 0;
        lmb->reserved.cnt = 0;
-       lmb->reserved.size = 0;
+}
+
+void arch_lmb_reserve_generic(struct lmb *lmb, ulong sp, ulong end, ulong align)
+{
+       ulong bank_end;
+       int bank;
+
+       /*
+        * Reserve memory from aligned address below the bottom of U-Boot stack
+        * until end of U-Boot area using LMB to prevent U-Boot from overwriting
+        * that memory.
+        */
+       debug("## Current stack ends at 0x%08lx ", sp);
+
+       /* adjust sp by 4K to be safe */
+       sp -= align;
+       for (bank = 0; bank < CONFIG_NR_DRAM_BANKS; bank++) {
+               if (!gd->bd->bi_dram[bank].size ||
+                   sp < gd->bd->bi_dram[bank].start)
+                       continue;
+               /* Watch out for RAM at end of address space! */
+               bank_end = gd->bd->bi_dram[bank].start +
+                       gd->bd->bi_dram[bank].size - 1;
+               if (sp > bank_end)
+                       continue;
+               if (bank_end > end)
+                       bank_end = end - 1;
+
+               lmb_reserve(lmb, sp, bank_end - sp + 1);
+
+               if (gd->flags & GD_FLG_SKIP_RELOC)
+                       lmb_reserve(lmb, (phys_addr_t)(uintptr_t)_start, gd->mon_len);
+
+               break;
+       }
 }
 
 static void lmb_reserve_common(struct lmb *lmb, void *fdt_blob)
@@ -110,29 +158,24 @@ static void lmb_reserve_common(struct lmb *lmb, void *fdt_blob)
        arch_lmb_reserve(lmb);
        board_lmb_reserve(lmb);
 
-       if (IMAGE_ENABLE_OF_LIBFDT && fdt_blob)
+       if (CONFIG_IS_ENABLED(OF_LIBFDT) && fdt_blob)
                boot_fdt_add_mem_rsv_regions(lmb, fdt_blob);
 }
 
 /* Initialize the struct, add memory and call arch/board reserve functions */
 void lmb_init_and_reserve(struct lmb *lmb, struct bd_info *bd, void *fdt_blob)
 {
-#ifdef CONFIG_NR_DRAM_BANKS
        int i;
-#endif
 
        lmb_init(lmb);
-#ifdef CONFIG_NR_DRAM_BANKS
+
        for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
                if (bd->bi_dram[i].size) {
                        lmb_add(lmb, bd->bi_dram[i].start,
                                bd->bi_dram[i].size);
                }
        }
-#else
-       if (bd->bi_memsize)
-               lmb_add(lmb, bd->bi_memstart, bd->bi_memsize);
-#endif
+
        lmb_reserve_common(lmb, fdt_blob);
 }
 
@@ -146,7 +189,8 @@ void lmb_init_and_reserve_range(struct lmb *lmb, phys_addr_t base,
 }
 
 /* This routine called with relocation disabled. */
-static long lmb_add_region(struct lmb_region *rgn, phys_addr_t base, phys_size_t size)
+static long lmb_add_region_flags(struct lmb_region *rgn, phys_addr_t base,
+                                phys_size_t size, enum lmb_flags flags)
 {
        unsigned long coalesced = 0;
        long adjacent, i;
@@ -154,6 +198,7 @@ static long lmb_add_region(struct lmb_region *rgn, phys_addr_t base, phys_size_t
        if (rgn->cnt == 0) {
                rgn->region[0].base = base;
                rgn->region[0].size = size;
+               rgn->region[0].flags = flags;
                rgn->cnt = 1;
                return 0;
        }
@@ -162,18 +207,27 @@ static long lmb_add_region(struct lmb_region *rgn, phys_addr_t base, phys_size_t
        for (i = 0; i < rgn->cnt; i++) {
                phys_addr_t rgnbase = rgn->region[i].base;
                phys_size_t rgnsize = rgn->region[i].size;
+               phys_size_t rgnflags = rgn->region[i].flags;
 
-               if ((rgnbase == base) && (rgnsize == size))
-                       /* Already have this region, so we're done */
-                       return 0;
+               if (rgnbase == base && rgnsize == size) {
+                       if (flags == rgnflags)
+                               /* Already have this region, so we're done */
+                               return 0;
+                       else
+                               return -1; /* regions with new flags */
+               }
 
                adjacent = lmb_addrs_adjacent(base, size, rgnbase, rgnsize);
                if (adjacent > 0) {
+                       if (flags != rgnflags)
+                               break;
                        rgn->region[i].base -= size;
                        rgn->region[i].size += size;
                        coalesced++;
                        break;
                } else if (adjacent < 0) {
+                       if (flags != rgnflags)
+                               break;
                        rgn->region[i].size += size;
                        coalesced++;
                        break;
@@ -184,13 +238,15 @@ static long lmb_add_region(struct lmb_region *rgn, phys_addr_t base, phys_size_t
        }
 
        if ((i < rgn->cnt - 1) && lmb_regions_adjacent(rgn, i, i + 1)) {
-               lmb_coalesce_regions(rgn, i, i + 1);
-               coalesced++;
+               if (rgn->region[i].flags == rgn->region[i + 1].flags) {
+                       lmb_coalesce_regions(rgn, i, i + 1);
+                       coalesced++;
+               }
        }
 
        if (coalesced)
                return coalesced;
-       if (rgn->cnt >= MAX_LMB_REGIONS)
+       if (rgn->cnt >= rgn->max)
                return -1;
 
        /* Couldn't coalesce the LMB, so add it to the sorted table. */
@@ -198,9 +254,11 @@ static long lmb_add_region(struct lmb_region *rgn, phys_addr_t base, phys_size_t
                if (base < rgn->region[i].base) {
                        rgn->region[i + 1].base = rgn->region[i].base;
                        rgn->region[i + 1].size = rgn->region[i].size;
+                       rgn->region[i + 1].flags = rgn->region[i].flags;
                } else {
                        rgn->region[i + 1].base = base;
                        rgn->region[i + 1].size = size;
+                       rgn->region[i + 1].flags = flags;
                        break;
                }
        }
@@ -208,6 +266,7 @@ static long lmb_add_region(struct lmb_region *rgn, phys_addr_t base, phys_size_t
        if (base < rgn->region[0].base) {
                rgn->region[0].base = base;
                rgn->region[0].size = size;
+               rgn->region[0].flags = flags;
        }
 
        rgn->cnt++;
@@ -215,6 +274,12 @@ static long lmb_add_region(struct lmb_region *rgn, phys_addr_t base, phys_size_t
        return 0;
 }
 
+static long lmb_add_region(struct lmb_region *rgn, phys_addr_t base,
+                          phys_size_t size)
+{
+       return lmb_add_region_flags(rgn, base, size, LMB_NONE);
+}
+
 /* This routine may be called with relocation disabled. */
 long lmb_add(struct lmb *lmb, phys_addr_t base, phys_size_t size)
 {
@@ -269,14 +334,21 @@ long lmb_free(struct lmb *lmb, phys_addr_t base, phys_size_t size)
         * beginging of the hole and add the region after hole.
         */
        rgn->region[i].size = base - rgn->region[i].base;
-       return lmb_add_region(rgn, end + 1, rgnend - end);
+       return lmb_add_region_flags(rgn, end + 1, rgnend - end,
+                                   rgn->region[i].flags);
 }
 
-long lmb_reserve(struct lmb *lmb, phys_addr_t base, phys_size_t size)
+long lmb_reserve_flags(struct lmb *lmb, phys_addr_t base, phys_size_t size,
+                      enum lmb_flags flags)
 {
        struct lmb_region *_rgn = &(lmb->reserved);
 
-       return lmb_add_region(_rgn, base, size);
+       return lmb_add_region_flags(_rgn, base, size, flags);
+}
+
+long lmb_reserve(struct lmb *lmb, phys_addr_t base, phys_size_t size)
+{
+       return lmb_reserve_flags(lmb, base, size, LMB_NONE);
 }
 
 static long lmb_overlaps_region(struct lmb_region *rgn, phys_addr_t base,
@@ -411,7 +483,7 @@ phys_size_t lmb_get_free_size(struct lmb *lmb, phys_addr_t addr)
        return 0;
 }
 
-int lmb_is_reserved(struct lmb *lmb, phys_addr_t addr)
+int lmb_is_reserved_flags(struct lmb *lmb, phys_addr_t addr, int flags)
 {
        int i;
 
@@ -419,11 +491,16 @@ int lmb_is_reserved(struct lmb *lmb, phys_addr_t addr)
                phys_addr_t upper = lmb->reserved.region[i].base +
                        lmb->reserved.region[i].size - 1;
                if ((addr >= lmb->reserved.region[i].base) && (addr <= upper))
-                       return 1;
+                       return (lmb->reserved.region[i].flags & flags) == flags;
        }
        return 0;
 }
 
+int lmb_is_reserved(struct lmb *lmb, phys_addr_t addr)
+{
+       return lmb_is_reserved_flags(lmb, addr, LMB_NONE);
+}
+
 __weak void board_lmb_reserve(struct lmb *lmb)
 {
        /* please define platform specific board_lmb_reserve() */