183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2c9356be3SSimon Glass /*
3c9356be3SSimon Glass * Simple malloc implementation
4c9356be3SSimon Glass *
5c9356be3SSimon Glass * Copyright (c) 2014 Google, Inc
6c9356be3SSimon Glass */
7c9356be3SSimon Glass
8*7cbd2d2eSSimon Glass #define LOG_CATEGORY LOGC_ALLOC
9*7cbd2d2eSSimon Glass
10c9356be3SSimon Glass #include <common.h>
11c9356be3SSimon Glass #include <malloc.h>
120eb25b61SJoe Hershberger #include <mapmem.h>
13c9356be3SSimon Glass #include <asm/io.h>
14c9356be3SSimon Glass
15c9356be3SSimon Glass DECLARE_GLOBAL_DATA_PTR;
16c9356be3SSimon Glass
alloc_simple(size_t bytes,int align)17*7cbd2d2eSSimon Glass static void *alloc_simple(size_t bytes, int align)
18b6bfb6ffSSimon Glass {
19b6bfb6ffSSimon Glass ulong addr, new_ptr;
20b6bfb6ffSSimon Glass void *ptr;
21b6bfb6ffSSimon Glass
22972ea533SSimon Glass addr = ALIGN(gd->malloc_base + gd->malloc_ptr, align);
23596380dbSPhilipp Rosenberger new_ptr = addr + bytes - gd->malloc_base;
24*7cbd2d2eSSimon Glass log_debug("size=%zx, ptr=%lx, limit=%lx: ", bytes, new_ptr,
25*7cbd2d2eSSimon Glass gd->malloc_limit);
261923d54bSAndrew F. Davis if (new_ptr > gd->malloc_limit) {
27*7cbd2d2eSSimon Glass log_err("alloc space exhausted\n");
28b6bfb6ffSSimon Glass return NULL;
291923d54bSAndrew F. Davis }
301923d54bSAndrew F. Davis
31b6bfb6ffSSimon Glass ptr = map_sysmem(addr, bytes);
32b6bfb6ffSSimon Glass gd->malloc_ptr = ALIGN(new_ptr, sizeof(new_ptr));
33*7cbd2d2eSSimon Glass
34*7cbd2d2eSSimon Glass return ptr;
35*7cbd2d2eSSimon Glass }
36*7cbd2d2eSSimon Glass
malloc_simple(size_t bytes)37*7cbd2d2eSSimon Glass void *malloc_simple(size_t bytes)
38*7cbd2d2eSSimon Glass {
39*7cbd2d2eSSimon Glass void *ptr;
40*7cbd2d2eSSimon Glass
41*7cbd2d2eSSimon Glass ptr = alloc_simple(bytes, 1);
42*7cbd2d2eSSimon Glass if (!ptr)
43*7cbd2d2eSSimon Glass return ptr;
44*7cbd2d2eSSimon Glass
45*7cbd2d2eSSimon Glass log_debug("%lx\n", (ulong)ptr);
46*7cbd2d2eSSimon Glass
47*7cbd2d2eSSimon Glass return ptr;
48*7cbd2d2eSSimon Glass }
49*7cbd2d2eSSimon Glass
memalign_simple(size_t align,size_t bytes)50*7cbd2d2eSSimon Glass void *memalign_simple(size_t align, size_t bytes)
51*7cbd2d2eSSimon Glass {
52*7cbd2d2eSSimon Glass void *ptr;
53*7cbd2d2eSSimon Glass
54*7cbd2d2eSSimon Glass ptr = alloc_simple(bytes, align);
55*7cbd2d2eSSimon Glass if (!ptr)
56*7cbd2d2eSSimon Glass return ptr;
57*7cbd2d2eSSimon Glass log_debug("aligned to %lx\n", (ulong)ptr);
58836ac74cSSimon Glass
59b6bfb6ffSSimon Glass return ptr;
60b6bfb6ffSSimon Glass }
61b6bfb6ffSSimon Glass
621eb0c03cSHans de Goede #if CONFIG_IS_ENABLED(SYS_MALLOC_SIMPLE)
calloc(size_t nmemb,size_t elem_size)63c9356be3SSimon Glass void *calloc(size_t nmemb, size_t elem_size)
64c9356be3SSimon Glass {
65c9356be3SSimon Glass size_t size = nmemb * elem_size;
66c9356be3SSimon Glass void *ptr;
67c9356be3SSimon Glass
68c9356be3SSimon Glass ptr = malloc(size);
69*7cbd2d2eSSimon Glass if (!ptr)
70*7cbd2d2eSSimon Glass return ptr;
71c9356be3SSimon Glass memset(ptr, '\0', size);
72c9356be3SSimon Glass
73c9356be3SSimon Glass return ptr;
74c9356be3SSimon Glass }
75c9356be3SSimon Glass #endif
76*7cbd2d2eSSimon Glass
malloc_simple_info(void)77*7cbd2d2eSSimon Glass void malloc_simple_info(void)
78*7cbd2d2eSSimon Glass {
79*7cbd2d2eSSimon Glass log_info("malloc_simple: %lx bytes used, %lx remain\n", gd->malloc_ptr,
80*7cbd2d2eSSimon Glass CONFIG_VAL(SYS_MALLOC_F_LEN) - gd->malloc_ptr);
81*7cbd2d2eSSimon Glass }
82