Allocate aligned heaps

soh/src/buffers/heaps.c

@@ -1,7 +1,44 @@
 #include "z64.h"
+#include <assert.h>
+#include <malloc.h>
 
-// 0x38000 bytes
-u8 gAudioHeap[0x38000];
+#ifndef _MSC_VER
+#include <unistd.h>
+#endif
 
-//u8 gSystemHeap[UNK_SIZE];
-u8 gSystemHeap[1024 * 1024 * 128];
+#define AUDIO_HEAP_SIZE 0x38000
+#define SYSTEM_HEAP_SIZE (1024 * 1024 * 128)
+
+u8* gAudioHeap;
+
+u8* gSystemHeap;
+
+void Heaps_Alloc(void)
+{
+#ifdef _MSC_VER
+    gAudioHeap = (u8*)_aligned_malloc(AUDIO_HEAP_SIZE, 16);
+    gSystemHeap = (u8*)_aligned_malloc(SYSTEM_HEAP_SIZE, 16);
+#elif defined(_POSIX_VERSION) && (_POSIX_VERSION >= 200112L)
+    if (posix_memalign((void**)&gAudioHeap, 16, AUDIO_HEAP_SIZE) != 0)
+        gAudioHeap = NULL;
+    if (posix_memalign((void**)&gSystemHeap, 16, SYSTEM_HEAP_SIZE) != 0)
+        gSystemHeap = NULL;
+#else
+    gAudioHeap = (u8*)memalign(16, AUDIO_HEAP_SIZE);
+    gSystemHeap = (u8*)memalign(16, SYSTEM_HEAP_SIZE);
+#endif
+
+    assert(gAudioHeap != NULL);
+    assert(gSystemHeap != NULL);
+}
+
+void Heaps_Free(void)
+{
+#ifdef _MSC_VER
+    _aligned_free(gAudioHeap);
+    _aligned_free(gSystemHeap);
+#else
+    free(gAudioHeap);
+    free(gSystemHeap);
+#endif
+}