Fix usb debug dongle support

[coreboot.git] / src / lib / malloc.c

diff --git a/src/lib/malloc.c b/src/lib/malloc.c
index 99a7b614fb6bc1dcf1cefd039cc92a38c85a5411..3cedc8f82fbbbc883164334ace9320d5d77a88fc 100644 (file)
--- a/src/lib/malloc.c
+++ b/src/lib/malloc.c
@@ -1,70 +1,45 @@
 #include <stdlib.h>
-#include <string.h>
 #include <console/console.h>
 
-#if 0
-#define MALLOCDBG(x)
+#if CONFIG_DEBUG_MALLOC
+#define MALLOCDBG(x...) printk(BIOS_SPEW, x)
 #else
-#define MALLOCDBG(x) printk_spew x
+#define MALLOCDBG(x...)
 #endif
-extern unsigned char _heap, _eheap;
-static size_t free_mem_ptr = (size_t)&_heap;           /* Start of heap */
-static size_t free_mem_end_ptr = (size_t)&_eheap;      /* End of heap */
-
-
-void malloc_mark(malloc_mark_t *place)
-{
-       *place = free_mem_ptr;
-       printk_spew("malloc_mark 0x%08lx\n", (unsigned long)free_mem_ptr);
-}
 
-void malloc_release(malloc_mark_t *ptr)
-{
-       free_mem_ptr = *ptr;
-       printk_spew("malloc_release 0x%08lx\n", (unsigned long)free_mem_ptr);
-}
+extern unsigned char _heap, _eheap;
+static void *free_mem_ptr = &_heap;            /* Start of heap */
+static void *free_mem_end_ptr = &_eheap;       /* End of heap */
 
 void *malloc(size_t size)
 {
        void *p;
 
-       MALLOCDBG(("%s Enter, size %d, free_mem_ptr %p\n", __FUNCTION__, size, free_mem_ptr));
+       MALLOCDBG("%s Enter, size %ld, free_mem_ptr %p\n", __func__, size, free_mem_ptr);
+
+       /* Checking arguments */
        if (size < 0)
-               die("Error! malloc: Size < 0");
+               die("Error! malloc: size < 0");
+
+       /* Overzealous linker check */
        if (free_mem_ptr <= 0)
                die("Error! malloc: Free_mem_ptr <= 0");
 
-       free_mem_ptr = (free_mem_ptr + 3) & ~3; /* Align */
+       free_mem_ptr = (void *)ALIGN((unsigned long)free_mem_ptr, 4);
 
        p = (void *) free_mem_ptr;
        free_mem_ptr += size;
 
        if (free_mem_ptr >= free_mem_end_ptr)
-               die("Error! malloc: Free_mem_ptr >= free_mem_end_ptr");
+               die("Error! malloc: Out of memory (free_mem_ptr >= free_mem_end_ptr)");
 
-       MALLOCDBG(("malloc 0x%08lx\n", (unsigned long)p));
+       MALLOCDBG("malloc %p\n", p);
 
        return p;
 }
 
-void *realloc(void *mem, size_t size)
-{
-       void *new_mem;
-
-       if (mem == 0)
-               return malloc(size);
-       if (size == 0) {
-               free(mem);
-               return 0;
-       }
-
-       new_mem = malloc(size);
-       memcpy(new_mem, mem, size);
-       free(mem);
-       return new_mem;
-}
-
 void free(void *where)
 {
        /* Don't care */
+       MALLOCDBG("free %p\n", where);
 }