X-Git-Url: http://git.ozlabs.org/?a=blobdiff_plain;f=lib%2Fmalloc.c;h=b21490cdd95411eb6b7d2beefb3260a1bfdf15f3;hb=refs%2Fheads%2Fdevel;hp=672bb3e4004900b1cf82746ca94a1db174472ff1;hpb=a2b7bb030d78c61ef150f8c9f6926c9558a6f1b5;p=yaboot.git

diff --git a/lib/malloc.c b/lib/malloc.c
index 672bb3e..b21490c 100644
--- a/lib/malloc.c
+++ b/lib/malloc.c
@@ -21,6 +21,11 @@
 
 #include "types.h"
 #include "stddef.h"
+#include "string.h"
+
+/* Copied from asm-generic/errno-base.h */
+#define	ENOMEM		12	/* Out of memory */
+#define	EINVAL		22	/* Invalid argument */
 
 /* Imported functions */
 extern void prom_printf (char *fmt, ...);
@@ -59,6 +64,56 @@ void *malloc (unsigned int size)
     return caddr;
 }
 
+/* Do not fall back to the malloc above as posix_memalign is needed by
+ * external libraries not yaboot */
+int posix_memalign(void **memptr, size_t alignment, size_t size)
+{
+    char *caddr;
+    /* size of allocation including the alignment */
+    size_t alloc_size;
+
+    if (!malloc_ptr)
+        return EINVAL;
+
+    /* Minimal aligment is sizeof(void *) */
+    if (alignment < sizeof(void*))
+	alignment = sizeof(void*);
+
+    /* Check for valid alignment and power of 2 */
+    if ((alignment % sizeof(void*) != 0) || ((alignment-1)&alignment))
+        return EINVAL;
+
+    if (size == 0) {
+	*memptr=NULL;
+	return 0;
+    }
+
+    caddr = (char*)(
+             (size_t)((malloc_ptr + sizeof(int))+(alignment-1)) &
+             (~(alignment-1))
+            );
+
+    alloc_size = size + (caddr - (malloc_ptr+sizeof(int)));
+
+    if ((malloc_ptr + alloc_size + sizeof(int)) > malloc_top)
+        return ENOMEM;
+
+    *(int *)(caddr - sizeof(int)) = size;
+    malloc_ptr += alloc_size + sizeof(int);
+    last_alloc = caddr;
+    malloc_ptr = (char *) ((((unsigned int) malloc_ptr) + 3) & (~3));
+    *memptr=(void*)caddr;
+
+    return 0;
+}
+
+void *calloc(size_t nmemb, size_t size)
+{
+	unsigned char *p = malloc(nmemb * size);
+	memset(p, 0x0, nmemb * size);
+	return p;
+}
+
 void *realloc(void *ptr, unsigned int size)
 {
     char *caddr, *oaddr = ptr;