common/malloc_simple.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Simple malloc implementation
   4  *
   5  * Copyright (c) 2014 Google, Inc
   6  */
   7
   8 #include <common.h>
   9 #include <malloc.h>
  10 #include <mapmem.h>
  11 #include <asm/io.h>
  12
  13 DECLARE_GLOBAL_DATA_PTR;
  14
  15 void *malloc_simple(size_t bytes)
  16 {
  17         ulong new_ptr;
  18         void *ptr;
  19
  20         new_ptr = gd->malloc_ptr + bytes;
  21         debug("%s: size=%zx, ptr=%lx, limit=%lx: ", __func__, bytes, new_ptr,
  22               gd->malloc_limit);
  23         if (new_ptr > gd->malloc_limit) {
  24                 debug("space exhausted\n");
  25                 return NULL;
  26         }
  27         ptr = map_sysmem(gd->malloc_base + gd->malloc_ptr, bytes);
  28         gd->malloc_ptr = ALIGN(new_ptr, sizeof(new_ptr));
  29         debug("%lx\n", (ulong)ptr);
  30
  31         return ptr;
  32 }
  33
  34 void *memalign_simple(size_t align, size_t bytes)
  35 {
  36         ulong addr, new_ptr;
  37         void *ptr;
  38
  39         addr = ALIGN(gd->malloc_base + gd->malloc_ptr, align);
  40         new_ptr = addr + bytes - gd->malloc_base;
  41         if (new_ptr > gd->malloc_limit) {
  42                 debug("space exhausted\n");
  43                 return NULL;
  44         }
  45
  46         ptr = map_sysmem(addr, bytes);
  47         gd->malloc_ptr = ALIGN(new_ptr, sizeof(new_ptr));
  48         debug("%lx\n", (ulong)ptr);
  49
  50         return ptr;
  51 }
  52
  53 #if CONFIG_IS_ENABLED(SYS_MALLOC_SIMPLE)
  54 void *calloc(size_t nmemb, size_t elem_size)
  55 {
  56         size_t size = nmemb * elem_size;
  57         void *ptr;
  58
  59         ptr = malloc(size);
  60         if (ptr)
  61                 memset(ptr, '\0', size);
  62
  63         return ptr;
  64 }
  65 #endif