blob: 351646fe3e48f664bded5f3abbcd7a5bb6ff6db8 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
|
#include <memory.h>
static MemoryAllocator* mem_alloc = nullptr;
MemoryAllocator::MemoryAllocator(uint32_t start, size_t size) {
if (size < sizeof(MemoryChunk)) {
begin = nullptr;
return;
}
begin = new (reinterpret_cast<void*>(start)) MemoryChunk{.size = static_cast<size_t>(size - sizeof(MemoryChunk))};
if (mem_alloc == nullptr) mem_alloc = this;
}
void* MemoryAllocator::allocate(size_t size) {
// TODO spinlock
// TODO memset 0 over allocated memory
MemoryChunk* result = nullptr;
// find the first chunk that is at least size and not allocated
for (auto* iter = begin; iter != nullptr; iter = iter->next) {
if (iter->size >= size && !iter->allocated) {
result = iter;
// split chunk if there is at least one byte left over
if (result->size >= size + sizeof(MemoryChunk) + 1) {
auto* _new = new (result + sizeof(MemoryChunk) + size) MemoryChunk{
.prev = result, .next = result->next, .size = static_cast<size_t>(result->size - sizeof(MemoryChunk))};
result->next = _new;
}
break;
}
}
return result + sizeof(MemoryChunk);
}
void MemoryAllocator::deallocate(void* ptr) {
auto* chunk = reinterpret_cast<MemoryChunk*>(reinterpret_cast<uint32_t>(ptr) - sizeof(MemoryChunk));
chunk->allocated = false;
// merge in next chunk
if (chunk->next != nullptr && !chunk->next->allocated) {
chunk->size += chunk->next->size + sizeof(MemoryChunk);
chunk->next = chunk->next->next;
if (chunk->next != nullptr) chunk->next->prev = chunk;
}
// merge into previous chunk
if (chunk->prev != nullptr && !chunk->prev->allocated) {
chunk->prev->size += chunk->size + sizeof(MemoryChunk);
chunk->prev->next = chunk->next;
if (chunk->next != nullptr) chunk->next->prev = chunk->prev;
}
};
size_t MemoryAllocator::free_space() const {
size_t r = 0;
for (auto* iter = begin; iter != nullptr; iter = iter->next)
if (!iter->allocated) r += iter->size;
return r;
}
size_t MemoryAllocator::used_space() const {
size_t r = 0;
for (auto* iter = begin; iter != nullptr; iter = iter->next)
if (iter->allocated) r += iter->size;
return r;
}
void* operator new(unsigned sz, const std::nothrow_t&) noexcept {
if (mem_alloc == nullptr) return nullptr;
return mem_alloc->allocate(sz);
}
void* operator new[](unsigned sz, const std::nothrow_t&) noexcept {
if (mem_alloc == nullptr) return nullptr;
return mem_alloc->allocate(sz);
}
void operator delete(void* ptr) {
if (mem_alloc != nullptr) mem_alloc->deallocate(ptr);
}
void operator delete[](void* ptr) {
if (mem_alloc != nullptr) mem_alloc->deallocate(ptr);
}
void* operator new(unsigned /* size_bytes */, void* ptr) {
return ptr;
}
void* operator new[](unsigned /* size_bytes */, void* ptr) {
return ptr;
}
|