From 22727bcf8dfc6ce94de193767433f35b5165a294 Mon Sep 17 00:00:00 2001
From: plutoo <plutoo@universe>
Date: Tue, 12 Sep 2017 01:59:07 +0200
Subject: [PATCH] Got bsdConnect working properly

---
 nx/include/switch.h      |   1 +
 nx/include/switch/ipc.h  |   1 +
 nx/source/services/bsd.c | 206 +++++++++++++++++++++++++++++++++++++--
 3 files changed, 202 insertions(+), 6 deletions(-)

diff --git a/nx/include/switch.h b/nx/include/switch.h
index 21dd8886..30108008 100644
--- a/nx/include/switch.h
+++ b/nx/include/switch.h
@@ -17,6 +17,7 @@ extern "C" {
 #include <switch/kernel/tmem.h>
 
 #include <switch/services/sm.h>
+#include <switch/services/bsd.h>
 
 #ifdef __cplusplus
 }
diff --git a/nx/include/switch/ipc.h b/nx/include/switch/ipc.h
index c4bb5154..9e54273c 100644
--- a/nx/include/switch/ipc.h
+++ b/nx/include/switch/ipc.h
@@ -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) |
diff --git a/nx/source/services/bsd.c b/nx/source/services/bsd.c
index c1011b91..c48bc10e 100644
--- a/nx/source/services/bsd.c
+++ b/nx/source/services/bsd.c
@@ -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;
+}