rpcsx/rpcs3/Emu/Cell/Modules/sys_mempool.cpp
scribam 299f627321 Stub cell (#2785)
* Update cellGcmSys

* Update cellStorage

* Update cellSubdisplay

* Update sceNpTrophy
- Use error_code as return type
- Add few checks

* Update cellKey2char

* Update cellKb:
- Use error_code as return type
- Replace UNIMPLEMENTED_FUNC by .todo

* Update cellNetCtl

* Update cellSpudll

* Update cellSysutilAp

* Update cellUserInfo

* Stub sys_mempool_allocate_block (bad idea)
2017-05-15 14:30:14 +03:00

144 lines
3.4 KiB
C++

#include "stdafx.h"
#include "Emu/System.h"
#include "Emu/IdManager.h"
#include "Emu/Cell/PPUModule.h"
#include "sysPrxForUser.h"
extern logs::channel sysPrxForUser;
using sys_mempool_t = u32;
struct memory_pool_t
{
static const u32 id_base = 1;
static const u32 id_step = 1;
static const u32 id_count = 1023;
vm::ptr<void> chunk;
u64 chunk_size;
u64 block_size;
u64 ralignment;
std::vector<vm::ptr<void>> free_blocks;
};
vm::ptr<void> sys_mempool_allocate_block(sys_mempool_t mempool)
{
sysPrxForUser.todo("sys_mempool_allocate_block(mempool=%d)", mempool);
return vm::null;
}
s32 sys_mempool_create(vm::ptr<sys_mempool_t> mempool, vm::ptr<void> chunk, const u64 chunk_size, const u64 block_size, const u64 ralignment)
{
sysPrxForUser.warning("sys_mempool_create(mempool=*0x%x, chunk=*0x%x, chunk_size=%d, block_size=%d, ralignment=%d)", mempool, chunk, chunk_size, block_size, ralignment);
if (block_size > chunk_size)
{
return CELL_EINVAL;
}
u64 alignment = ralignment;
if (ralignment == 0 || ralignment == 2)
{
alignment = 4;
}
// Check if alignment is power of two
if ((alignment & (alignment - 1)) != 0)
{
return CELL_EINVAL;
}
// Test chunk address aligment
if (chunk % 8)
{
return CELL_EINVAL;
}
auto id = idm::make<memory_pool_t>();
*mempool = id;
auto memory_pool = idm::get<memory_pool_t>(id);
memory_pool->chunk = chunk;
memory_pool->chunk_size = chunk_size;
memory_pool->block_size = block_size;
memory_pool->ralignment = alignment;
// TODO: check blocks alignment wrt ralignment
u64 num_blocks = chunk_size / block_size;
memory_pool->free_blocks.resize(num_blocks);
for (int i = 0; i < num_blocks; ++i)
{
memory_pool->free_blocks[i] = vm::ptr<void>::make(chunk.addr() + i * block_size);
}
return CELL_OK;
}
void sys_mempool_destroy(sys_mempool_t mempool)
{
sysPrxForUser.warning("sys_mempool_destroy(mempool=%d)", mempool);
idm::remove<memory_pool_t>(mempool);
}
s32 sys_mempool_free_block(sys_mempool_t mempool, vm::ptr<void> block)
{
sysPrxForUser.warning("sys_mempool_free_block(mempool=%d, block=*0x%x)", mempool, block);
auto memory_pool = idm::get<memory_pool_t>(mempool);
if (!memory_pool)
{
return CELL_EINVAL;
}
// Cannot free a block not belonging to this memory pool
if (block.addr() > memory_pool->chunk.addr() + memory_pool->chunk_size)
{
return CELL_EINVAL;
}
memory_pool->free_blocks.push_back(block);
return CELL_OK;
}
u64 sys_mempool_get_count(sys_mempool_t mempool)
{
sysPrxForUser.warning("sys_mempool_get_count(mempool=%d)", mempool);
auto memory_pool = idm::get<memory_pool_t>(mempool);
if (!memory_pool)
{
return CELL_EINVAL;
}
return memory_pool->free_blocks.size();
}
vm::ptr<void> sys_mempool_try_allocate_block(sys_mempool_t mempool)
{
sysPrxForUser.warning("sys_mempool_try_allocate_block(mempool=%d)", mempool);
auto memory_pool = idm::get<memory_pool_t>(mempool);
if (!memory_pool || memory_pool->free_blocks.size() == 0)
{
return vm::null;
}
auto block_ptr = memory_pool->free_blocks.back();
memory_pool->free_blocks.pop_back();
return block_ptr;
}
void sysPrxForUser_sys_mempool_init()
{
REG_FUNC(sysPrxForUser, sys_mempool_allocate_block);
REG_FUNC(sysPrxForUser, sys_mempool_create);
REG_FUNC(sysPrxForUser, sys_mempool_destroy);
REG_FUNC(sysPrxForUser, sys_mempool_free_block);
REG_FUNC(sysPrxForUser, sys_mempool_get_count);
REG_FUNC(sysPrxForUser, sys_mempool_try_allocate_block);
}