xref: /openbmc/u-boot/common/malloc_simple.c (revision 9450ab2b)
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