Make RPLs functional

libraries/wutcrt/crt0_rpl.s

@@ -23,6 +23,8 @@ load:
    lwz 3, 0x8(1)
    lwz 4, 0xC(1)
    bl rpl_entry
+   lwz 0, 0x14(1)
+   mtlr 0
    addi 1, 1, 0x10
    blr
 

libraries/wutmalloc/wut_malloc.c

@@ -1,9 +1,11 @@
 #include <coreinit/memexpheap.h>
 #include <coreinit/memdefaultheap.h>
 #include <coreinit/memorymap.h>
+#include <coreinit/debug.h>
 #include <malloc.h>
 #include <string.h>
 #include <errno.h>
+#include <assert.h>
 
 void
 __init_wut_malloc(void)
@@ -15,58 +17,95 @@ __fini_wut_malloc(void)
 {
 }
 
+#define WUT_MALLOC_CANARY  (0x376296a9)
+
+struct wut_alloc_header
+{
+   uint32_t canary;
+   size_t size;
+   size_t offset;
+};
+
+static struct wut_alloc_header *get_alloc_header(const void* ptr)
+{
+   struct wut_alloc_header *header = (struct wut_alloc_header*)ptr - 1;
+   assert(header->canary == WUT_MALLOC_CANARY);
+   if(header->canary != WUT_MALLOC_CANARY)
+      OSFatal("WUT detected a memory corruption in get_alloc_header");
+   return header;
+}
+
+static void *get_alloc_base(struct wut_alloc_header* header)
+{
+   return (char*)header - header->offset;
+}
+
 void *
 _malloc_r(struct _reent *r, size_t size)
 {
-   void *ptr = MEMAllocFromDefaultHeapEx(size, 0x40);
-   if (!ptr) {
-      r->_errno = ENOMEM;
-   }
-   return ptr;
+	return _memalign_r(r, 0x40, size);
 }
 
 void
 _free_r(struct _reent *r, void *ptr)
 {
    if (ptr) {
-      MEMFreeToDefaultHeap(ptr);
+      void *basePtr = get_alloc_base(get_alloc_header(ptr));
+      MEMFreeToDefaultHeap(basePtr);
    }
 }
 
 void *
 _realloc_r(struct _reent *r, void *ptr, size_t size)
 {
-   void *new_ptr = MEMAllocFromDefaultHeapEx(size, 0x40);
+   void *new_ptr = _malloc_r(r, size);
    if (!new_ptr) {
       r->_errno = ENOMEM;
       return new_ptr;
    }
 
    if (ptr) {
-      size_t old_size = MEMGetSizeForMBlockExpHeap(ptr);
+      struct wut_alloc_header *header = get_alloc_header(ptr);
+      size_t old_size = header->size;
       memcpy(new_ptr, ptr, old_size <= size ? old_size : size);
-      MEMFreeToDefaultHeap(ptr);
+      MEMFreeToDefaultHeap(get_alloc_base(header));
    }
    return new_ptr;
 }
 
 void *
 _calloc_r(struct _reent *r, size_t num, size_t size)
 {
-   void *ptr = MEMAllocFromDefaultHeapEx(num * size, 0x40);
+   void *ptr = _malloc_r(r, num * size);
    if (ptr) {
       memset(ptr, 0, num * size);
    } else {
       r->_errno = ENOMEM;
    }
-
    return ptr;
 }
 
 void *
 _memalign_r(struct _reent *r, size_t align, size_t size)
 {
-   return MEMAllocFromDefaultHeapEx((size + align - 1) & ~(align - 1), align);
+    if(align < 0x40)
+        align = 0x40;
+   size_t offset;
+   void* basePtr;
+   if(sizeof(struct wut_alloc_header) > align)
+      offset = align - (sizeof(struct wut_alloc_header) % align);
+   else
+      offset = align - sizeof(struct wut_alloc_header);
+   basePtr = MEMAllocFromDefaultHeapEx(offset + sizeof(struct wut_alloc_header) + size, align);
+   if (!basePtr) {
+      r->_errno = ENOMEM;
+      return basePtr;
+   }
+   struct wut_alloc_header *header = (struct wut_alloc_header*)((char*)basePtr + offset);
+   header->canary = WUT_MALLOC_CANARY;
+   header->size = size;
+   header->offset = offset;
+   return (header+1);
 }
 
 struct mallinfo _mallinfo_r(struct _reent *r)
@@ -89,19 +128,19 @@ _mallopt_r(struct _reent *r, int param, int value)
 size_t
 _malloc_usable_size_r(struct _reent *r, void *ptr)
 {
-   return MEMGetSizeForMBlockExpHeap(ptr);
+   return 0; // we do not know the total available size
 }
 
 void *
 _valloc_r(struct _reent *r, size_t size)
 {
-   return MEMAllocFromDefaultHeapEx(size, OS_PAGE_SIZE);
+   return _memalign_r(r, OS_PAGE_SIZE, size);
 }
 
 void *
 _pvalloc_r(struct _reent *r, size_t size)
 {
-   return MEMAllocFromDefaultHeapEx((size + (OS_PAGE_SIZE - 1)) & ~(OS_PAGE_SIZE - 1), OS_PAGE_SIZE);
+   return _memalign_r(r, OS_PAGE_SIZE, (size + (OS_PAGE_SIZE - 1)) & ~(OS_PAGE_SIZE - 1));
 }
 
 int