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