u32 svcMapMemoryBlock()
{
u32 handle = arm11_R(0);
u32 addr = arm11_R(1);
u32 my_perm = arm11_R(2);
u32 other_perm = arm11_R(3);
handleinfo* h = handle_Get(handle);
if(h == NULL) {
DEBUG("Invalid handle.\n");
PAUSE();
return 0xFFFFFFFF;
}
if (h->type == HANDLE_TYPE_SERVICE) {
switch (h->subtype) {
default:
DEBUG("Trying to map unknown mem\nhandle=%x, addr=%08x, my_perm=%x, other_perm=%x\n",
handle, addr, my_perm, other_perm);
PAUSE();
return 0xFFFFFFFF;
}
} else {
switch (h->subtype) {
case MEM_TYPE_GSP_0:
mem_AddMappingShared(addr, GSPsharebuffsize, GSPsharedbuff);
break;
case MEM_TYPE_HID_0:
mem_AddMappingShared(addr, 0x2000, HIDsharedbuff);
break;
default:
DEBUG("Trying to map unknown mem\nhandle=%x, addr=%08x, my_perm=%x, other_perm=%x\n",
handle, addr, my_perm, other_perm);
PAUSE();
return 0xFFFFFFFF;
}
}
return 0;
}
u32 svcControlMemory()
{
u32 op = arm11_R(0);
u32 addr0 = arm11_R(1);
u32 addr1 = arm11_R(2);
u32 size = arm11_R(3);
u32 perm = arm11_R(4);
const char* ops;
switch(op & 0xFF) {
case 1:
ops = "FREE";
break;
case 2:
ops = "RESERVE";
break;
case 3:
ops = "COMMIT";
break;
case 4:
ops = "MAP";
break;
case 5:
ops = "UNMAP";
break;
case 6:
ops = "PROTECT";
break;
default:
ops = "UNDEFINED";
break;
}
const char* perms;
switch(perm) {
case 0:
perms = "--";
break;
case 1:
perms = "-R";
break;
case 2:
perms = "W-";
break;
case 3:
perms = "WR";
break;
case 0x10000000:
perms = "DONTCARE";
break;
default:
perms = "UNDEFINED";
}
DEBUG("op=%s %s (%x), addr0=%x, addr1=%x, size=%x, perm=%s (%x)\n",
ops, op & CONTROL_GSP_FLAG ? "GSP" : "", op,
addr0, addr1, size, perms, perm);
PAUSE();
if(addr0 & 0xFFF)
return SVCERROR_ALIGN_ADDR;
if(addr1 & 0xFFF)
return SVCERROR_ALIGN_ADDR;
if(size & 0xFFF)
return SVCERROR_INVALID_SIZE;
if(op == 0x10003) { // FFF680A4
if(addr0 == 0) { // FFF680C4
if(addr1 != 0)
return SVCERROR_INVALID_PARAMS;
} else if(size == 0) { // FFF680D0
if(addr0 < 0x14000000)
return SVCERROR_INVALID_PARAMS;
if((addr0+size) >= 0x1C000000)
return SVCERROR_INVALID_PARAMS;
if(addr1 != 0)
return SVCERROR_INVALID_PARAMS;
} else {
if(addr0 < 0x14000000)
return SVCERROR_INVALID_PARAMS;
if(addr0 >= 0x1C000000)
return SVCERROR_INVALID_PARAMS;
if(addr1 != 0)
return SVCERROR_INVALID_PARAMS;
}
} else if(op == 1) {
if(size == 0) { // FFF68110
if(addr0 < 0x08000000) // FFF68130
return SVCERROR_INVALID_PARAMS;
if(addr0 <= 0x1C000000)
return SVCERROR_INVALID_PARAMS;
} else {
if(addr0 < 0x08000000)
return SVCERROR_INVALID_PARAMS;
if((addr0+size) <= 0x1C000000)
return SVCERROR_INVALID_PARAMS;
}
} else {
if(size == 0) { // FFF68148
if(addr0 < 0x08000000)
return SVCERROR_INVALID_PARAMS;
if(addr0 >= 0x14000000)
return SVCERROR_INVALID_PARAMS;
} else {
if(addr0 < 0x08000000)
return SVCERROR_INVALID_PARAMS;
if((addr0+size) >= 0x14000000)
return SVCERROR_INVALID_PARAMS;
}
if(op == 4 || op == 5) { // FFF680E8
if(size == 0) {
if(addr1 < 0x100000) // FFF681CC
return SVCERROR_INVALID_PARAMS;
if(addr1 >= 0x14000000)
return SVCERROR_INVALID_PARAMS;
}
if(addr1 < 0x100000)
return SVCERROR_INVALID_PARAMS;
if((addr1+size) >= 0x14000000)
return SVCERROR_INVALID_PARAMS;
}
}
// ????
switch(op & 0xff) {
case 1:
case 3:
case 4:
case 5:
case 6:
break;
default:
return SVCERROR_INVALID_OPERATION;
}
if(size == 0)
return 0;
//kprocess = *0xFFFF9004;
//*(SP+0x10) = kprocess + 0x1c;
// ???
/*
u32 flags = outaddr & 0xff;
if(flags != 1) {
if(perms != 0 && perms != 1 && perms != 2 && perms != 3)
return SVCERROR_INVALID_OPERATION;
}
*/
/*if ((op&0xF) == 3) //COMMIT
{
arm11_SetR(1, addr0); // outaddr is in R1
return mem_AddSegment(addr0, size, NULL);
}*/
/*if(op == 0x10003) {
DEBUG("Mapping GSP heap..\n");
arm11_SetR(1, 0x08000000); // outaddr is in R1
return mem_AddSegment(0x08000000, size, NULL);
}*/
if ((op & 0xF) == 0x3 || (op & 0xF) == 0x0) { //COMMIT
if ((op & 0x10000) == 0x10000) { //LINEAR
if (size > 0x08000000) {
//Console.WriteLine("out of linear mem");
return 0xFFFFFFFF;
}
}
if (addr0 != 0) {
if ((op & 0x10000) == 0x10000) { //LINEAR
addr0 = 0x08000000;
}
arm11_SetR(1, addr0); // outaddr is in R1
return mem_AddSegment(addr0, size, NULL);
} else {
if ((op & 0x10000) == 0x10000) { //LINEAR
addr0 = 0x14000000 + linearalloced;
linearalloced += size;
arm11_SetR(1, addr0); // outaddr is in R1
return mem_AddMappingShared(addr0, size, LINEmembuffer);
}
/*else
{
addr0 = mallocarm11(0x20000000, 0xFFFFF000, size);
}*/
arm11_SetR(1, addr0); // outaddr is in R1
return mem_AddSegment(addr0, size, NULL);
}
}
if ((op & 0xF) == 0x4) { //MAP
u8* buffer = mem_rawaddr(addr1, size);
if (buffer == 0)return -1;
return mem_AddMappingShared(addr0, size, buffer);
}
if ((op & 0xF) == 0x6) { //Protect we don't protect mem sorry
DEBUG("STUBBED!\n");
return 0;
}
DEBUG("STUBBED!\n");
PAUSE();
/*
// FFF6824C
r11 = outaddr & 0xFFFFFF;
is_ldr = GetKProcessID() == 1 ? 0xFFFFFFFF : 0;
r2 = r2 & r11;
if(r2 & 0xF00) {
r2 = *(kprocess + 0xa0);
r11 = (r11 & 0xFFFFF0FF) | (r2 & 0xF00);
}
if(flags == 3 && !is_ldr) {
if(sub_FFF72828(*r10, 1, r5) == 0)
return 0xC860180A;
}
s32 rc = sub_FFF741B4(*(SP+16), (returnval in r1) SP+12, r4, r6, r5, r11, r7);
if(rc < 0) {
//FFF682F8
if(flags == 1)
sub_FFF7A0E8(*r10, 1, r5);
}
if(flags == 3)
sub_FFF7A0E8(*r10, 1, r5);
*/
return -1;
}
u32 svcMapMemoryBlock()
{
u32 handle = arm11_R(0);
u32 addr = arm11_R(1);
u32 my_perm = arm11_R(2);
u32 other_perm = arm11_R(3);
handleinfo* h = handle_Get(handle);
DEBUG("handle=%x, addr=%08x, my_perm=%x, other_perm=%x\n",
handle, addr, my_perm, other_perm);
if(h == NULL) {
DEBUG("Invalid handle.\n");
PAUSE();
return -1;
}
DEBUG("h->type=%x, h->subtype=%08x\n",
h->type, (unsigned int)h->subtype);
if(h->type == HANDLE_TYPE_SHAREDMEM) {
switch (h->subtype) {
case MEM_TYPE_GSP_0:
mem_AddMappingShared(addr, GSPsharebuffsize, GSPsharedbuff);
break;
case MEM_TYPE_HID_0:
mem_AddMappingShared(addr, 0x2000, HIDsharedbuff);
break;
case MEM_TYPE_HID_SPVR_0:
mem_AddMappingShared(addr, 0x2000, HIDsharedbuffSPVR);
break;
case MEM_TYPE_CSND:
mem_AddMappingShared(addr, CSND_sharedmemsize, CSND_sharedmem);
break;
case MEM_TYPE_APT_SHARED_FONT:
// If user has supplied the shared font, map it.
if(APTsharedfont == NULL) {
ERROR("No shared font supplied\n");
return -1;
}
mem_AddMappingShared(0xDEAD0000, APTsharedfontsize, APTsharedfont); //todo ichfly
break;
case MEM_TYPE_APT_S_SHARED_FONT:
// If user has supplied the shared font, map it.
if (APTs_sharedfont == NULL) {
ERROR("No shared font supplied\n");
return -1;
}
mem_AddMappingShared(0xDEAD0000, APTs_sharedfontsize, APTs_sharedfont); //todo ichfly
break;
case MEM_TYPE_ALLOC:
if (h->misc[0] != 0) {
DEBUG("meaning of addr unk %08x", h->misc[0]);
}
mem_AddMappingShared(addr,h->misc[1] ,h->misc_ptr[0] );
break;
default:
ERROR("Trying to map unknown memory\n");
return -1;
}
} else {
ERROR("Handle has incorrect type\n");
return -1;
}
return 0;
}
