Simon Glass | c9356be | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Simple malloc implementation |
| 3 | * |
| 4 | * Copyright (c) 2014 Google, Inc |
| 5 | * |
| 6 | * SPDX-License-Identifier: GPL-2.0+ |
| 7 | */ |
| 8 | |
| 9 | #include <common.h> |
| 10 | #include <malloc.h> |
Joe Hershberger | 0eb25b6 | 2015-03-22 17:08:59 -0500 | [diff] [blame] | 11 | #include <mapmem.h> |
Simon Glass | c9356be | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 12 | #include <asm/io.h> |
| 13 | |
| 14 | DECLARE_GLOBAL_DATA_PTR; |
| 15 | |
| 16 | void *malloc_simple(size_t bytes) |
| 17 | { |
| 18 | ulong new_ptr; |
| 19 | void *ptr; |
| 20 | |
| 21 | new_ptr = gd->malloc_ptr + bytes; |
Simon Glass | 836ac74 | 2015-09-08 17:52:46 -0600 | [diff] [blame^] | 22 | debug("%s: size=%zx, ptr=%lx, limit=%lx\n", __func__, bytes, new_ptr, |
| 23 | gd->malloc_limit); |
Simon Glass | c9356be | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 24 | if (new_ptr > gd->malloc_limit) |
Hans de Goede | 2c85717 | 2015-02-04 13:05:50 +0100 | [diff] [blame] | 25 | return NULL; |
Simon Glass | c9356be | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 26 | ptr = map_sysmem(gd->malloc_base + gd->malloc_ptr, bytes); |
| 27 | gd->malloc_ptr = ALIGN(new_ptr, sizeof(new_ptr)); |
Simon Glass | 836ac74 | 2015-09-08 17:52:46 -0600 | [diff] [blame^] | 28 | |
Simon Glass | c9356be | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 29 | return ptr; |
| 30 | } |
| 31 | |
Simon Glass | b6bfb6f | 2015-05-12 14:55:06 -0600 | [diff] [blame] | 32 | void *memalign_simple(size_t align, size_t bytes) |
| 33 | { |
| 34 | ulong addr, new_ptr; |
| 35 | void *ptr; |
| 36 | |
Simon Glass | 972ea53 | 2015-08-14 13:26:43 -0600 | [diff] [blame] | 37 | addr = ALIGN(gd->malloc_base + gd->malloc_ptr, align); |
Philipp Rosenberger | 596380d | 2015-09-08 12:41:24 +0200 | [diff] [blame] | 38 | new_ptr = addr + bytes - gd->malloc_base; |
Simon Glass | b6bfb6f | 2015-05-12 14:55:06 -0600 | [diff] [blame] | 39 | if (new_ptr > gd->malloc_limit) |
| 40 | return NULL; |
| 41 | ptr = map_sysmem(addr, bytes); |
| 42 | gd->malloc_ptr = ALIGN(new_ptr, sizeof(new_ptr)); |
Simon Glass | 836ac74 | 2015-09-08 17:52:46 -0600 | [diff] [blame^] | 43 | |
Simon Glass | b6bfb6f | 2015-05-12 14:55:06 -0600 | [diff] [blame] | 44 | return ptr; |
| 45 | } |
| 46 | |
Simon Glass | c9356be | 2014-11-10 17:16:43 -0700 | [diff] [blame] | 47 | #ifdef CONFIG_SYS_MALLOC_SIMPLE |
| 48 | void *calloc(size_t nmemb, size_t elem_size) |
| 49 | { |
| 50 | size_t size = nmemb * elem_size; |
| 51 | void *ptr; |
| 52 | |
| 53 | ptr = malloc(size); |
| 54 | memset(ptr, '\0', size); |
| 55 | |
| 56 | return ptr; |
| 57 | } |
| 58 | #endif |