mirror of
https://github.com/CTCaer/hekate.git
synced 2024-11-09 20:11:50 +00:00
bdk: heap: improvements
Correct types everywhere. Add BDK_MALLOC_NO_DEFRAG that disables defragmentation on the heap.
This commit is contained in:
parent
ad4014f295
commit
83b895a062
2 changed files with 42 additions and 27 deletions
|
@ -19,33 +19,43 @@
|
||||||
#include "heap.h"
|
#include "heap.h"
|
||||||
#include <gfx_utils.h>
|
#include <gfx_utils.h>
|
||||||
|
|
||||||
static void _heap_create(heap_t *heap, u32 start)
|
heap_t _heap;
|
||||||
|
|
||||||
|
static void _heap_create(void *start)
|
||||||
{
|
{
|
||||||
heap->start = start;
|
_heap.start = start;
|
||||||
heap->first = NULL;
|
_heap.first = NULL;
|
||||||
|
_heap.last = NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Node info is before node address.
|
// Node info is before node address.
|
||||||
static u32 _heap_alloc(heap_t *heap, u32 size)
|
static void *_heap_alloc(u32 size)
|
||||||
{
|
{
|
||||||
hnode_t *node, *new_node;
|
hnode_t *node, *new_node;
|
||||||
|
|
||||||
// Align to cache line size.
|
// Align to cache line size.
|
||||||
size = ALIGN(size, sizeof(hnode_t));
|
size = ALIGN(size, sizeof(hnode_t));
|
||||||
|
|
||||||
if (!heap->first)
|
// First allocation.
|
||||||
|
if (!_heap.first)
|
||||||
{
|
{
|
||||||
node = (hnode_t *)heap->start;
|
node = (hnode_t *)_heap.start;
|
||||||
node->used = 1;
|
node->used = 1;
|
||||||
node->size = size;
|
node->size = size;
|
||||||
node->prev = NULL;
|
node->prev = NULL;
|
||||||
node->next = NULL;
|
node->next = NULL;
|
||||||
heap->first = node;
|
_heap.first = node;
|
||||||
|
_heap.last = node;
|
||||||
|
|
||||||
return (u32)node + sizeof(hnode_t);
|
return (void *)node + sizeof(hnode_t);
|
||||||
}
|
}
|
||||||
|
|
||||||
node = heap->first;
|
#ifdef BDK_MALLOC_NO_DEFRAG
|
||||||
|
// Get the last allocated block.
|
||||||
|
node = _heap.last;
|
||||||
|
#else
|
||||||
|
// Get first block and find the first available one.
|
||||||
|
node = _heap.first;
|
||||||
while (true)
|
while (true)
|
||||||
{
|
{
|
||||||
// Check if there's available unused node.
|
// Check if there's available unused node.
|
||||||
|
@ -53,7 +63,7 @@ static u32 _heap_alloc(heap_t *heap, u32 size)
|
||||||
{
|
{
|
||||||
// Size and offset of the new unused node.
|
// Size and offset of the new unused node.
|
||||||
u32 new_size = node->size - size;
|
u32 new_size = node->size - size;
|
||||||
new_node = (hnode_t *)((u32)node + sizeof(hnode_t) + size);
|
new_node = (hnode_t *)((void *)node + sizeof(hnode_t) + size);
|
||||||
|
|
||||||
// If there's aligned unused space from the old node,
|
// If there's aligned unused space from the old node,
|
||||||
// create a new one and set the leftover size.
|
// create a new one and set the leftover size.
|
||||||
|
@ -76,7 +86,7 @@ static u32 _heap_alloc(heap_t *heap, u32 size)
|
||||||
node->size = size;
|
node->size = size;
|
||||||
node->used = 1;
|
node->used = 1;
|
||||||
|
|
||||||
return (u32)node + sizeof(hnode_t);
|
return (void *)node + sizeof(hnode_t);
|
||||||
}
|
}
|
||||||
|
|
||||||
// No unused node found, try the next one.
|
// No unused node found, try the next one.
|
||||||
|
@ -85,23 +95,28 @@ static u32 _heap_alloc(heap_t *heap, u32 size)
|
||||||
else
|
else
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
// No unused node found, create a new one.
|
// No unused node found, create a new one.
|
||||||
new_node = (hnode_t *)((u32)node + sizeof(hnode_t) + node->size);
|
new_node = (hnode_t *)((void *)node + sizeof(hnode_t) + node->size);
|
||||||
new_node->used = 1;
|
new_node->used = 1;
|
||||||
new_node->size = size;
|
new_node->size = size;
|
||||||
new_node->prev = node;
|
new_node->prev = node;
|
||||||
new_node->next = NULL;
|
new_node->next = NULL;
|
||||||
node->next = new_node;
|
node->next = new_node;
|
||||||
|
_heap.last = new_node;
|
||||||
|
|
||||||
return (u32)new_node + sizeof(hnode_t);
|
return (void *)new_node + sizeof(hnode_t);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void _heap_free(heap_t *heap, u32 addr)
|
static void _heap_free(void *addr)
|
||||||
{
|
{
|
||||||
hnode_t *node = (hnode_t *)(addr - sizeof(hnode_t));
|
hnode_t *node = (hnode_t *)(addr - sizeof(hnode_t));
|
||||||
node->used = 0;
|
node->used = 0;
|
||||||
node = heap->first;
|
node = _heap.first;
|
||||||
|
|
||||||
|
#ifndef BDK_MALLOC_NO_DEFRAG
|
||||||
|
// Do simple defragmentation on next blocks.
|
||||||
while (node)
|
while (node)
|
||||||
{
|
{
|
||||||
if (!node->used)
|
if (!node->used)
|
||||||
|
@ -117,36 +132,35 @@ static void _heap_free(heap_t *heap, u32 addr)
|
||||||
}
|
}
|
||||||
node = node->next;
|
node = node->next;
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
heap_t _heap;
|
void heap_init(void *base)
|
||||||
|
|
||||||
void heap_init(u32 base)
|
|
||||||
{
|
{
|
||||||
_heap_create(&_heap, base);
|
_heap_create(base);
|
||||||
}
|
}
|
||||||
|
|
||||||
void heap_copy(heap_t *heap)
|
void heap_set(heap_t *heap)
|
||||||
{
|
{
|
||||||
memcpy(&_heap, heap, sizeof(heap_t));
|
memcpy(&_heap, heap, sizeof(heap_t));
|
||||||
}
|
}
|
||||||
|
|
||||||
void *malloc(u32 size)
|
void *malloc(u32 size)
|
||||||
{
|
{
|
||||||
return (void *)_heap_alloc(&_heap, size);
|
return _heap_alloc(size);
|
||||||
}
|
}
|
||||||
|
|
||||||
void *calloc(u32 num, u32 size)
|
void *calloc(u32 num, u32 size)
|
||||||
{
|
{
|
||||||
void *res = (void *)_heap_alloc(&_heap, num * size);
|
void *res = (void *)_heap_alloc(num * size);
|
||||||
memset(res, 0, ALIGN(num * size, sizeof(hnode_t))); // Clear the aligned size.
|
memset(res, 0, ALIGN(num * size, sizeof(hnode_t))); // Clear the aligned size.
|
||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
|
|
||||||
void free(void *buf)
|
void free(void *buf)
|
||||||
{
|
{
|
||||||
if ((u32)buf >= _heap.start)
|
if (buf >= _heap.start)
|
||||||
_heap_free(&_heap, (u32)buf);
|
_heap_free(buf);
|
||||||
}
|
}
|
||||||
|
|
||||||
void heap_monitor(heap_monitor_t *mon, bool print_node_stats)
|
void heap_monitor(heap_monitor_t *mon, bool print_node_stats)
|
||||||
|
|
|
@ -31,8 +31,9 @@ typedef struct _hnode
|
||||||
|
|
||||||
typedef struct _heap
|
typedef struct _heap
|
||||||
{
|
{
|
||||||
u32 start;
|
void *start;
|
||||||
hnode_t *first;
|
hnode_t *first;
|
||||||
|
hnode_t *last;
|
||||||
} heap_t;
|
} heap_t;
|
||||||
|
|
||||||
typedef struct
|
typedef struct
|
||||||
|
@ -41,8 +42,8 @@ typedef struct
|
||||||
u32 used;
|
u32 used;
|
||||||
} heap_monitor_t;
|
} heap_monitor_t;
|
||||||
|
|
||||||
void heap_init(u32 base);
|
void heap_init(void *base);
|
||||||
void heap_copy(heap_t *heap);
|
void heap_set(heap_t *heap);
|
||||||
void *malloc(u32 size);
|
void *malloc(u32 size);
|
||||||
void *calloc(u32 num, u32 size);
|
void *calloc(u32 num, u32 size);
|
||||||
void free(void *buf);
|
void free(void *buf);
|
||||||
|
|
Loading…
Reference in a new issue