Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 1 | #include <stdlib.h> |
| 2 | #include <console/console.h> |
| 3 | |
Uwe Hermann | a953f37 | 2010-11-10 00:14:32 +0000 | [diff] [blame] | 4 | #if CONFIG_DEBUG_MALLOC |
Stefan Reinauer | c02b4fc | 2010-03-22 11:42:32 +0000 | [diff] [blame] | 5 | #define MALLOCDBG(x...) printk(BIOS_SPEW, x) |
Uwe Hermann | a953f37 | 2010-11-10 00:14:32 +0000 | [diff] [blame] | 6 | #else |
Peter Stuge | 5015f79 | 2010-11-10 02:00:32 +0000 | [diff] [blame] | 7 | #define MALLOCDBG(x...) |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 8 | #endif |
Uwe Hermann | a953f37 | 2010-11-10 00:14:32 +0000 | [diff] [blame] | 9 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 10 | extern unsigned char _heap, _eheap; |
Stefan Reinauer | 054c723 | 2009-03-06 17:22:35 +0000 | [diff] [blame] | 11 | static void *free_mem_ptr = &_heap; /* Start of heap */ |
| 12 | static void *free_mem_end_ptr = &_eheap; /* End of heap */ |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 13 | |
Ron Minnich | eb59636 | 2012-04-11 10:30:15 -0700 | [diff] [blame^] | 14 | /* We don't restrict the boundary. This is firmware, |
| 15 | * you are supposed to know what you are doing. |
| 16 | */ |
| 17 | void *memalign(size_t boundary, size_t size) |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 18 | { |
| 19 | void *p; |
| 20 | |
Ron Minnich | eb59636 | 2012-04-11 10:30:15 -0700 | [diff] [blame^] | 21 | MALLOCDBG("%s Enter, boundary %ld, size %ld, free_mem_ptr %p\n", |
| 22 | __func__, boundary, size, free_mem_ptr); |
Stefan Reinauer | 6bd571e | 2009-09-25 21:59:57 +0000 | [diff] [blame] | 23 | |
Stefan Reinauer | 6bd571e | 2009-09-25 21:59:57 +0000 | [diff] [blame] | 24 | /* Overzealous linker check */ |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 25 | if (free_mem_ptr <= 0) |
Ron Minnich | eb59636 | 2012-04-11 10:30:15 -0700 | [diff] [blame^] | 26 | die("Error! memalign: Free_mem_ptr <= 0"); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 27 | |
Ron Minnich | eb59636 | 2012-04-11 10:30:15 -0700 | [diff] [blame^] | 28 | free_mem_ptr = (void *)ALIGN((unsigned long)free_mem_ptr, boundary); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 29 | |
Ron Minnich | eb59636 | 2012-04-11 10:30:15 -0700 | [diff] [blame^] | 30 | p = free_mem_ptr; |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 31 | free_mem_ptr += size; |
| 32 | |
| 33 | if (free_mem_ptr >= free_mem_end_ptr) |
Ron Minnich | eb59636 | 2012-04-11 10:30:15 -0700 | [diff] [blame^] | 34 | die("Error! memalign: Out of memory (free_mem_ptr >= free_mem_end_ptr)"); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 35 | |
Ron Minnich | eb59636 | 2012-04-11 10:30:15 -0700 | [diff] [blame^] | 36 | MALLOCDBG("memalign %p\n", p); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 37 | |
| 38 | return p; |
| 39 | } |
| 40 | |
Ron Minnich | eb59636 | 2012-04-11 10:30:15 -0700 | [diff] [blame^] | 41 | void *malloc(size_t size) |
| 42 | { |
| 43 | return memalign(sizeof(u64), size); |
| 44 | } |
| 45 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 46 | void free(void *where) |
| 47 | { |
| 48 | /* Don't care */ |
Stefan Reinauer | 6bd571e | 2009-09-25 21:59:57 +0000 | [diff] [blame] | 49 | MALLOCDBG("free %p\n", where); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 50 | } |