Got bsdConnect working properly

This commit is contained in:
plutoo 2017-09-12 01:59:07 +02:00
parent c6ffc2a6e1
commit 22727bcf8d
3 changed files with 202 additions and 6 deletions

View File

@ -17,6 +17,7 @@ extern "C" {
#include <switch/kernel/tmem.h>
#include <switch/services/sm.h>
#include <switch/services/bsd.h>
#ifdef __cplusplus
}

View File

@ -119,6 +119,7 @@ static inline void* ipcPrepareHeader(IpcCommand* cmd, size_t sizeof_raw) {
for (i=0; i<cmd->NumStaticIn; i++, buf+=2) {
IpcStaticSendDescriptor* desc = (IpcStaticSendDescriptor*) buf;
uintptr_t ptr = (uintptr_t) cmd->Statics[i];
desc->Addr = ptr;
desc->Packed = cmd->Indices[i] | (cmd->StaticSizes[i] << 16) |

View File

@ -2,6 +2,7 @@
#include <switch.h>
static Handle g_bsdHandle = -1;
static int g_Errno = 0;
Result bsdInitialize(TransferMemory* tmem) {
Result rc = smGetService(&g_bsdHandle, "bsd:s");
@ -19,23 +20,216 @@ Result bsdInitialize(TransferMemory* tmem) {
struct {
u64 magic;
u64 cmd_id;
u64 unk[5];
u64 unk0[5];
u64 tmem_sz;
u64 pad[2];
} *raw;
raw = ipcPrepareHeader(&c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 0;
raw->unk[0] = 0;
raw->unk[1] = 0;
raw->unk[2] = 0;
raw->unk[3] = 0;
raw->unk[4] = 0;
raw->unk0[0] = 0;
raw->unk0[1] = 0;
raw->unk0[2] = 0;
raw->unk0[3] = 0;
raw->unk0[4] = 0;
raw->tmem_sz = tmem->Size;
rc = ipcDispatch(g_bsdHandle);
if (R_SUCCEEDED(rc)) {
IpcCommandResponse r;
ipcParseResponse(&r);
struct {
u64 magic;
u64 result;
} *resp = r.Raw;
rc = resp->result;
}
}
return rc;
}
int bsdGetErrno() {
return g_Errno;
}
int bsdSocket(int domain, int type, int protocol) {
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u32 domain;
u32 type;
u32 protocol;
u32 pad[4];
} *raw;
raw = ipcPrepareHeader(&c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 2;
raw->domain = domain;
raw->type = type;
raw->protocol = protocol;
Result rc = ipcDispatch(g_bsdHandle);
int fd = -1;
if (R_SUCCEEDED(rc)) {
IpcCommandResponse r;
ipcParseResponse(&r);
struct {
u64 magic;
u64 result;
u32 fd;
u32 errno;
} *resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc)) {
g_Errno = resp->errno;
fd = resp->fd;
}
}
return fd;
}
int bsdConnect(int sockfd, void* addr, u32 addrlen) {
IpcCommand c;
ipcInitialize(&c);
ipcAddSendBuffer(&c, addr, addrlen, 0);
ipcAddSendStatic(&c, addr, addrlen, 0);
struct {
u64 magic;
u64 cmd_id;
u32 sockfd;
u32 pad[4];
} *raw;
raw = ipcPrepareHeader(&c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 14;
raw->sockfd = sockfd;
Result rc = ipcDispatch(g_bsdHandle);
int fd = -1;
if (R_SUCCEEDED(rc)) {
IpcCommandResponse r;
ipcParseResponse(&r);
struct {
u64 magic;
u64 result;
u32 fd;
u32 errno;
} *resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc)) {
g_Errno = resp->errno;
fd = resp->fd;
}
}
return fd;
}
int bsdBind(int sockfd, void* addr, u32 addrlen) {
IpcCommand c;
ipcInitialize(&c);
ipcAddSendBuffer(&c, addr, addrlen, 0);
ipcAddSendStatic(&c, addr, addrlen, 0);
struct {
u64 magic;
u64 cmd_id;
u32 pad[5];
} *raw;
raw = ipcPrepareHeader(&c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 13;
Result rc = ipcDispatch(g_bsdHandle);
int ret = -1;
if (R_SUCCEEDED(rc)) {
IpcCommandResponse r;
ipcParseResponse(&r);
struct {
u64 magic;
u64 result;
u32 ret;
u32 errno;
} *resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc)) {
g_Errno = resp->errno;
ret = resp->ret;
}
}
return ret;
}
int bsdListen(int sockfd, int backlog) {
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u32 sockfd;
u32 backlog;
u32 pad[4];
} *raw;
raw = ipcPrepareHeader(&c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 18;
raw->sockfd = sockfd;
raw->backlog = backlog;
Result rc = ipcDispatch(g_bsdHandle);
int ret = -1;
if (R_SUCCEEDED(rc)) {
IpcCommandResponse r;
ipcParseResponse(&r);
struct {
u64 magic;
u64 result;
u32 ret;
u32 errno;
} *resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc)) {
g_Errno = resp->errno;
ret = resp->ret;
}
}
return ret;
}