RtosHeap.cpp

//------------------------------------------------------------------------------
//This file is part of embKernel. 
//See license.txt for the full license governing this code.
//------------------------------------------------------------------------------
#include "RtosHeap.hpp"
#include "new"
#include <string.h>

//simbols given by linker script
extern unsigned long _heap;
extern unsigned long _eheap;

bool RtosHeap::sIsInitialized = false;
uint8_t RtosHeap::sSemaphoreLocation[sizeof(RtosSemaphore)];
RtosSemaphore* RtosHeap::sSemaphore;
uint8_t RtosHeap::sMemLocation[sizeof(LibDmem)];
LibDmem* RtosHeap::sMem;

void* RtosHeap::alloc(size_t size) {
    if (!sIsInitialized) {
        RtosHeap::sSemaphore = new (sSemaphoreLocation) RtosSemaphore(1, 1);
        RtosHeap::sMem = new (sMemLocation) LibDmem(&_heap, (uint32_t) &_eheap - (uint32_t) &_heap);
        sIsInitialized = true;
    }
    sSemaphore->take(Rtos::TICK_INFINITE);
    void* result = sMem->alloc(size);
    sSemaphore->give(Rtos::TICK_INFINITE);
    return result;
}

void RtosHeap::free(void* p) {
    sSemaphore->take(Rtos::TICK_INFINITE);
    sMem->free(p);
    sSemaphore->give(Rtos::TICK_INFINITE);
}

void* RtosHeap::resize(void* p, size_t size) {
    sSemaphore->take(Rtos::TICK_INFINITE);
    void* result = sMem->resize(p, size);
    sSemaphore->give(Rtos::TICK_INFINITE);
    return result;
}

void* RtosHeap::resizeLeft(void* p, size_t left) {
    sSemaphore->take(Rtos::TICK_INFINITE);
    void* result = sMem->resizeLeft(p, left);
    sSemaphore->give(Rtos::TICK_INFINITE);
    return result;
}

size_t RtosHeap::getTotalMemory() {
    return sMem->getTotalMemory();
}

size_t RtosHeap::getFreeMemory() {
    return sMem->getFreeMemory();
}

unsigned int RtosHeap::getBlockCount() {
    return sMem->getBlockCount();
}