Heap.cc

#include "egg/core/ExpHeap.hh"
 
using namespace Abstract::Memory;
 
namespace EGG {
 
Heap::Heap(MEMiHeapHead *handle) : m_handle(handle), m_children(Disposer::getLinkOffset()) {
    m_block = nullptr;
    m_parentHeap = nullptr;
    m_name = "NoName";
    m_flags.makeAllZero();
 
    s_heapList.append(this);
}
 
Heap::~Heap() {
    s_heapList.remove(this);
}
 
void Heap::dispose() {
    Disposer *node = nullptr;
    while ((node = reinterpret_cast<Disposer *>(m_children.getFirst()))) {
        node->~Disposer();
    }
 
    ASSERT(!m_children.m_headObject && !m_children.m_tailObject);
}
 
Heap *Heap::becomeAllocatableHeap() {
    Heap *oldHeap = s_allocatableHeap;
    s_allocatableHeap = this;
    return oldHeap;
}
 
Heap *Heap::becomeCurrentHeap() {
    Heap *oldHeap = s_currentHeap;
    s_currentHeap = this;
    return oldHeap;
}
 
void *Heap::alloc(size_t size, int align, Heap *pHeap) {
    Heap *currentHeap = s_currentHeap;
 
    if (s_allocatableHeap) {
        if (currentHeap && !pHeap) {
            pHeap = currentHeap;
        }
 
        if (pHeap != s_allocatableHeap) {
            WARN("HEAP ALLOC FAIL (%p, %s): Allocatable heap is %p (%s)", pHeap, pHeap->getName(),
                    s_allocatableHeap, s_allocatableHeap->getName());
 
            return nullptr;
        }
    }
 
    if (pHeap) {
        return pHeap->alloc(size, align);
    }
 
    if (currentHeap) {
        void *block = currentHeap->alloc(size, align);
 
        if (!block) {
            u32 heapFreeSize = currentHeap->getAllocatableSize(0x4);
            s32 heapSize = GetAddrNum(currentHeap->getEndAddress()) -
                    GetAddrNum(currentHeap->getStartAddress());
 
            constexpr f32 BYTES_TO_MBYTES = 1024.0f * 1024.0f;
            f32 heapSizeMB = static_cast<f32>(heapSize) / BYTES_TO_MBYTES;
            f32 heapFreeSizeMB = static_cast<f32>(heapFreeSize) / BYTES_TO_MBYTES;
            f32 sizeMB = static_cast<f32>(size) / BYTES_TO_MBYTES;
 
            WARN("HEAP ALLOC FAIL (%p, %s):\nTotal bytes: %d (%.1fMBytes)\nFree bytes: %d "
                 "(%.1fMBytes)\nAlloc bytes: %d "
                 "(%.1fMBytes)\nAlign: %d",
                    currentHeap, currentHeap->getName(), static_cast<f64>(heapSize),
                    static_cast<f64>(heapSizeMB), heapFreeSize, static_cast<f64>(heapFreeSizeMB),
                    size, static_cast<f64>(sizeMB), align);
        }
 
        return block;
    }
 
    WARN("HEAP ALLOC FAIL: Cannot allocate %d from heap %p", size, pHeap);
    return nullptr;
}
 
void Heap::free(void *block, Heap *pHeap) {
    if (!pHeap) {
        MEMiHeapHead *handle = MEMiHeapHead::findContainHeap(block);
        if (!handle) {
            return;
        }
 
        pHeap = findHeap(handle);
        if (!pHeap) {
            return;
        }
    }
 
    pHeap->free(block);
}
 
Heap *Heap::findHeap(MEMiHeapHead *handle) {
    Heap *node = nullptr;
    while ((node = reinterpret_cast<Heap *>(s_heapList.getNext(node)))) {
        if (node->m_handle == handle) {
            return node;
        }
    }
 
    return nullptr;
}
 
Heap *Heap::findContainHeap(const void *block) {
    MEMiHeapHead *handle = MEMiHeapHead::findContainHeap(block);
    return handle ? findHeap(handle) : nullptr;
}
 
} // namespace EGG
 
void *operator new(size_t size) noexcept {
    return EGG::Heap::alloc(size, 4, nullptr);
}
 
void *operator new(size_t size, int align) noexcept {
    return EGG::Heap::alloc(size, align, nullptr);
}
 
void *operator new(size_t size, EGG::Heap *heap, int align) noexcept {
    return EGG::Heap::alloc(size, align, heap);
}
 
void *operator new[](size_t size) noexcept {
    return EGG::Heap::alloc(size, 4, nullptr);
}
 
void *operator new[](size_t size, int align) noexcept {
    return EGG::Heap::alloc(size, align, nullptr);
}
 
void *operator new[](size_t size, EGG::Heap *heap, int align) noexcept {
    return EGG::Heap::alloc(size, align, heap);
}
 
void operator delete(void *block) noexcept {
    EGG::Heap::free(block, nullptr);
}
 
void operator delete(void *block, size_t /* size */) noexcept {
    EGG::Heap::free(block, nullptr);
}
 
void operator delete[](void *block) noexcept {
    EGG::Heap::free(block, nullptr);
}
 
void operator delete[](void *block, size_t /* size */) noexcept {
    EGG::Heap::free(block, nullptr);
}
 
MEMList EGG::Heap::s_heapList = MEMList(EGG::Heap::getOffset()); 
 
EGG::Heap *EGG::Heap::s_currentHeap = nullptr;     
EGG::Heap *EGG::Heap::s_allocatableHeap = nullptr;