X-Git-Url: http://git.ozlabs.org/?p=yaboot.git;a=blobdiff_plain;f=lib%2Fmalloc.c;h=0121112a349059a922656074061a8d69685bb17a;hp=3279c073755d9e6fcf8fa18b9d489ca0f26b383b;hb=94adb3aee138118174e34f519ff6ce3e8ece707c;hpb=2ad0d7649e5042cad43a16b4a03bf53f39948316

diff --git a/lib/malloc.c b/lib/malloc.c
index 3279c07..0121112 100644
--- a/lib/malloc.c
+++ b/lib/malloc.c
@@ -1,5 +1,5 @@
 /*  malloc.c - Dumb memory allocation routines
- *  
+ *
  *  Copyright (C) 1997 Paul Mackerras
  *                1996 Maurizio Plaza
  *                1996 Jakub Jelinek
@@ -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,49 @@ 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 *realloc(void *ptr, unsigned int size)
 {
     char *caddr, *oaddr = ptr;