Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 2 | /* |
| 3 | * Simple malloc implementation |
| 4 | * |
| 5 | * Copyright (c) 2014 Google, Inc |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 6 | */ |
| 7 | |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 8 | #define LOG_CATEGORY LOGC_ALLOC |
| 9 | |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 10 | #include <common.h> |
Simon Glass | 0f2af88 | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 11 | #include <log.h> |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 12 | #include <malloc.h> |
Joe Hershberger | 65b905b | 2015-03-22 17:08:59 -0500 | [diff] [blame] | 13 | #include <mapmem.h> |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 14 | #include <asm/io.h> |
| 15 | |
| 16 | DECLARE_GLOBAL_DATA_PTR; |
| 17 | |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 18 | static void *alloc_simple(size_t bytes, int align) |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 19 | { |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 20 | ulong addr, new_ptr; |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 21 | void *ptr; |
| 22 | |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 23 | addr = ALIGN(gd->malloc_base + gd->malloc_ptr, align); |
| 24 | new_ptr = addr + bytes - gd->malloc_base; |
| 25 | log_debug("size=%zx, ptr=%lx, limit=%lx: ", bytes, new_ptr, |
| 26 | gd->malloc_limit); |
Simon Glass | e8211b4 | 2016-03-06 19:27:55 -0700 | [diff] [blame] | 27 | if (new_ptr > gd->malloc_limit) { |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 28 | log_err("alloc space exhausted\n"); |
Hans de Goede | 8b4e728 | 2015-02-04 13:05:50 +0100 | [diff] [blame] | 29 | return NULL; |
Simon Glass | e8211b4 | 2016-03-06 19:27:55 -0700 | [diff] [blame] | 30 | } |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 31 | |
| 32 | ptr = map_sysmem(addr, bytes); |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 33 | gd->malloc_ptr = ALIGN(new_ptr, sizeof(new_ptr)); |
Simon Glass | 65ba412 | 2015-09-08 17:52:46 -0600 | [diff] [blame] | 34 | |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 35 | return ptr; |
| 36 | } |
| 37 | |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 38 | void *malloc_simple(size_t bytes) |
Simon Glass | de9d70f | 2015-05-12 14:55:06 -0600 | [diff] [blame] | 39 | { |
Simon Glass | de9d70f | 2015-05-12 14:55:06 -0600 | [diff] [blame] | 40 | void *ptr; |
| 41 | |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 42 | ptr = alloc_simple(bytes, 1); |
| 43 | if (!ptr) |
| 44 | return ptr; |
Andrew F. Davis | 34597e4 | 2017-01-27 10:39:18 -0600 | [diff] [blame] | 45 | |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 46 | log_debug("%lx\n", (ulong)ptr); |
| 47 | |
| 48 | return ptr; |
| 49 | } |
| 50 | |
| 51 | void *memalign_simple(size_t align, size_t bytes) |
| 52 | { |
| 53 | void *ptr; |
| 54 | |
| 55 | ptr = alloc_simple(bytes, align); |
| 56 | if (!ptr) |
| 57 | return ptr; |
| 58 | log_debug("aligned to %lx\n", (ulong)ptr); |
Simon Glass | 65ba412 | 2015-09-08 17:52:46 -0600 | [diff] [blame] | 59 | |
Simon Glass | de9d70f | 2015-05-12 14:55:06 -0600 | [diff] [blame] | 60 | return ptr; |
| 61 | } |
| 62 | |
Hans de Goede | 9f9df6f | 2015-09-13 14:45:15 +0200 | [diff] [blame] | 63 | #if CONFIG_IS_ENABLED(SYS_MALLOC_SIMPLE) |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 64 | void *calloc(size_t nmemb, size_t elem_size) |
| 65 | { |
| 66 | size_t size = nmemb * elem_size; |
| 67 | void *ptr; |
| 68 | |
| 69 | ptr = malloc(size); |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 70 | if (!ptr) |
| 71 | return ptr; |
| 72 | memset(ptr, '\0', size); |
Simon Glass | 9489046 | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 73 | |
| 74 | return ptr; |
| 75 | } |
| 76 | #endif |
Simon Glass | 8ed64a4 | 2018-11-18 08:14:26 -0700 | [diff] [blame] | 77 | |
| 78 | void malloc_simple_info(void) |
| 79 | { |
| 80 | log_info("malloc_simple: %lx bytes used, %lx remain\n", gd->malloc_ptr, |
| 81 | CONFIG_VAL(SYS_MALLOC_F_LEN) - gd->malloc_ptr); |
| 82 | } |