ultimatepp/uppsrc/Core/sheap.cpp
cxl 5561a805f1 Core: Allocator fix
git-svn-id: svn://ultimatepp.org/upp/trunk@9354 f0d560ea-af0d-0410-9eb7-867de7ffcac7
2015-12-27 16:29:59 +00:00

405 lines
9 KiB
C++

#include <Core/Core.h>
#include <Core/Core.h>
//#BLITZ_APPROVE
NAMESPACE_UPP
#ifdef UPP_HEAP
#include "HeapImp.h"
#define LLOG(x) // LOG((void *)this << ' ' << x)
inline void Heap::Page::Format(int k)
{
DbgFreeFill(Begin(), End() - Begin());
klass = k;
active = 0;
int sz = Ksz(k);
byte *ptr = End() - sz;
byte *b = Begin();
FreeLink *l = NULL;
while(ptr >= b) {
((FreeLink *)ptr)->next = l;
l = (FreeLink *)ptr;
ptr -= sz;
}
freelist = l;
}
Heap::Page *Heap::WorkPage(int k) // get a new workpage with empty blocks
{
LLOG("AllocK - next work not available " << k << " empty: " << (void *)empty[k]);
Page *page = empty[k]; // hot empty page of the same klass
empty[k] = NULL;
if(!page) { // try to reacquire pages freed remotely
LLOG("AllocK - trying FreeRemote");
if(remote_list)
FreeRemote();
if(work[k]->freelist) { // partially free page found
LLOG("AllocK - work available after FreeRemote " << k);
return work[k];
}
page = empty[k]; // hot empty page
empty[k] = NULL;
}
if(!page)
for(int i = 0; i < NKLASS; i++) // Try hot empty page of different klass
if(empty[i]) {
LLOG("AllocK - free page available for reformatting " << k);
page = empty[i];
empty[i] = NULL;
page->Format(k); // reformat the page for the required class
break;
}
if(!page) { // Attempt to find page in global storage of free pages
Mutex::Lock __(mutex);
aux.FreeRemoteRaw();
if(aux.work[k]->next != aux.work[k]) { // Try page of the same klass first
page = aux.work[k]->next;
page->Unlink();
page->heap = this;
LLOG("AllocK - adopting aux page " << k << " page: " << (void *)page << ", free " << (void *)page->freelist);
}
if(!page && aux.empty[k]) { // Try hot empty page of the same klass
page = aux.empty[k];
aux.empty[k] = page->next;
LLOG("AllocK - empty aux page available of the same format " << k << " page: " << (void *)page << ", free " << (void *)page->freelist);
}
if(!page)
for(int i = 0; i < NKLASS; i++) // Finally try to to find hot page of different klass
if(aux.empty[i]) {
page = aux.empty[i];
aux.empty[i] = page->next;
page->Format(k);
LLOG("AllocK - empty aux page available for reformatting " << k << " page: " << (void *)page << ", free " << (void *)page->freelist);
break;
}
if(!page) { // No free memory was found, ask system for the new page
page = (Page *)AllocRaw4KB(Ksz(k));
LLOG("AllocK - allocated new system page " << (void *)page << " " << k);
page->Format(k);
}
page->heap = this;
}
page->Link(work[k]);
ASSERT(page->klass == k);
return page;
}
void *Heap::AllocK(int k)
{
LLOG("AllocK " << k);
if(!initialized)
Init();
Page *page = work[k]->next;
for(;;) {
ASSERT(page->klass == k);
FreeLink *p = page->freelist;
if(p) {
LLOG("AllocK allocating from " << (void *)page << " " << (void *)p);
page->freelist = p->next;
++page->active;
return p;
}
LLOG("AllocK - page exhausted " << k << " page: " << (void *)page);
if(page->next != page) {
LLOG("Moving " << (void *)page << " to full");
page->Unlink();
page->Link(full[k]);
page = work[k]->next;
}
if(page->next == page)
page = WorkPage(k);
}
}
inline
void *Heap::Allok(int k)
{ // Try to alloc from the front-cache first
FreeLink *ptr = cache[k];
if(ptr) {
cachen[k]++;
cache[k] = ptr->next;
return DbgFreeCheckK(ptr, k);
}
return DbgFreeCheckK(AllocK(k), k);
}
inline
void *Heap::Alloc(size_t sz)
{
Stat(sz);
if(sz <= 224) {
if(sz == 0) sz = 1;
return Allok(((int)sz - 1) >> 4);
}
if(sz <= 576)
return Allok(sz <= 368 ? sz <= 288 ? 14 : 15 : sz <= 448 ? 16 : 17);
return LAlloc(sz);
}
inline
void *Heap::AllocSz(size_t& sz)
{
Stat(sz);
if(sz <= 224) {
if(sz == 0) sz = 1;
int k = ((int)sz - 1) >> 4;
sz = (k + 1) << 4;
return Allok(k);
}
if(sz <= 576) {
int k;
if(sz <= 368)
if(sz <= 288)
sz = 288, k = 14;
else
sz = 368, k = 15;
else
if(sz <= 448)
sz = 448, k = 16;
else
sz = 576, k = 17;
return Allok(k);
}
return LAlloc(sz);
}
inline
void Heap::FreeK(void *ptr, Page *page, int k)
{
if(page->freelist) {
LLOG("Free next in work page " << k);
((FreeLink *)ptr)->next = page->freelist;
}
else {
LLOG("Free full to work " << k << " heap: " << (void *)page->heap);
page->Unlink();
page->Link(work[k]);
((FreeLink *)ptr)->next = NULL;
}
page->freelist = (FreeLink *)ptr;
if(--page->active == 0) { // there are no more allocated blocks in this page
LLOG("Free page is empty " << (void *)page);
page->Unlink();
if(this == &aux) {
LLOG("...is aux");
page->next = empty[k];
empty[k] = page;
}
else {
if(empty[k]) { // Keep one hot empty page per klass in thread, put rest to 'aux' global storage
LLOG("Global free " << k << " " << (void *)empty[k]);
Mutex::Lock __(mutex);
empty[k]->heap = &aux;
empty[k]->next = aux.empty[k];
aux.empty[k] = empty[k];
}
empty[k] = page;
}
}
}
void Heap::Free(void *ptr)
{
if(!ptr) return;
LLOG("Free " << ptr);
if((((dword)(uintptr_t)ptr) & 8) == 0) {
Page *page = (Page *)((uintptr_t)ptr & ~(uintptr_t)4095);
int k = page->klass;
LLOG("Small free page: " << (void *)page << ", k: " << k << ", ksz: " << Ksz(k));
ASSERT((4096 - ((uintptr_t)ptr & (uintptr_t)4095)) % Ksz(k) == 0);
#ifdef _MULTITHREADED
if(page->heap != this) { // freeing page allocated in different thread
RemoteFree(ptr, Ksz(k)); // add to originating heap's list of free pages to be properly freed later
return;
}
#endif
DbgFreeFillK(ptr, k);
if(cachen[k]) {
cachen[k]--;
FreeLink *l = (FreeLink *)ptr;
l->next = cache[k];
cache[k] = l;
return;
}
FreeK(ptr, page, k);
}
else
LFree(ptr);
}
size_t Heap::GetBlockSize(void *ptr)
{
if(!ptr) return 0;
LLOG("GetBlockSize " << ptr);
if((((dword)(uintptr_t)ptr) & 8) == 0) {
Page *page = (Page *)((uintptr_t)ptr & ~(uintptr_t)4095);
int k = page->klass;
return Ksz(k);
}
return LGetBlockSize(ptr);
}
bool Heap::TryRealloc(void *ptr, size_t newsize)
{
if(!ptr) return 0;
LLOG("GetBlockSize " << ptr);
if((((dword)(uintptr_t)ptr) & 8) == 0) {
Page *page = (Page *)((uintptr_t)ptr & ~(uintptr_t)4095);
int k = page->klass;
return newsize <= (size_t)Ksz(k);
}
return LTryRealloc(ptr, newsize);
}
void Heap::FreeDirect(void *ptr)
{
LLOG("Free Direct " << ptr);
if((((dword)(uintptr_t)ptr) & 8) == 0) {
Page *page = (Page *)((uintptr_t)ptr & ~(uintptr_t)4095);
int k = page->klass;
LLOG("Small free page: " << (void *)page << ", k: " << k << ", ksz: " << Ksz(k));
ASSERT((4096 - ((uintptr_t)ptr & (uintptr_t)4095)) % Ksz(k) == 0);
DbgFreeFillK(ptr, k);
FreeK(ptr, page, k);
}
else
LFree(ptr);
}
inline
void *Heap::Alloc32()
{
Stat(32);
return Allok(1);
}
inline
void Heap::Free32(void *ptr)
{
Page *page = (Page *)((uintptr_t)ptr & ~(uintptr_t)4095);
LLOG("Small free page: " << (void *)page << ", k: " << k << ", ksz: " << Ksz(k));
ASSERT((4096 - ((uintptr_t)ptr & (uintptr_t)4095)) % Ksz(1) == 0);
#ifdef _MULTITHREADED
if(page->heap != this) {
RemoteFree(ptr, 32);
return;
}
#endif
DbgFreeFillK(ptr, 1);
if(cachen[1]) {
cachen[1]--;
FreeLink *l = (FreeLink *)ptr;
l->next = cache[1];
cache[1] = l;
return;
}
FreeK(ptr, page, 1);
}
inline
void *Heap::Alloc48()
{
Stat(48);
return Allok(2);
}
inline
void Heap::Free48(void *ptr)
{
Page *page = (Page *)((uintptr_t)ptr & ~(uintptr_t)4095);
LLOG("Small free page: " << (void *)page << ", k: " << k << ", ksz: " << Ksz(k));
ASSERT((4096 - ((uintptr_t)ptr & (uintptr_t)4095)) % Ksz(2) == 0);
#ifdef _MULTITHREADED
if(page->heap != this) {
RemoteFree(ptr, 48);
return;
}
#endif
DbgFreeFillK(ptr, 2);
if(cachen[2]) {
cachen[2]--;
FreeLink *l = (FreeLink *)ptr;
l->next = cache[2];
cache[2] = l;
return;
}
FreeK(ptr, page, 2);
}
Heap::Page dummy;
#define DI { { 0, 0, 0, 0, &dummy, &dummy } }
thread__ Heap heap = {
{ DI, DI, DI, DI, DI, DI, DI, DI, DI, DI, DI, DI, DI, DI, DI, DI, DI, DI }
};
#if defined(HEAPDBG)
void *MemoryAlloc_(size_t sz)
{
return heap.Alloc(sz);
}
void MemoryFree_(void *ptr)
{
heap.Free(ptr);
}
size_t GetMemoryBlockSize_(void *ptr)
{
return heap.GetBlockSize(ptr);
}
#else
void *MemoryAlloc(size_t sz)
{
return heap.Alloc(sz);
}
void *MemoryAllocSz(size_t& sz)
{
return heap.AllocSz(sz);
}
void MemoryFree(void *ptr)
{
heap.Free(ptr);
}
size_t GetMemoryBlockSize(void *ptr)
{
return heap.GetBlockSize(ptr);
}
bool TryRealloc(void *ptr, size_t size)
{
return heap.TryRealloc(ptr, size);
}
void *MemoryAlloc32()
{
return heap.Alloc32();
}
void MemoryFree32(void *ptr)
{
heap.Free32(ptr);
}
void *MemoryAlloc48()
{
return heap.Alloc48();
}
void MemoryFree48(void *ptr)
{
heap.Free48(ptr);
}
#endif
#endif
END_UPP_NAMESPACE