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