From 494dd0db324af343e1596a295506bc1748ed584f Mon Sep 17 00:00:00 2001
From: Robin Mueller <robin.mueller.m@gmail.com>
Date: Mon, 8 Mar 2021 23:55:58 +0100
Subject: [PATCH] continued tcp server

---
 osal/windows/TcWinTcpServer.cpp   | 76 +++++++++++++++++++++++++++++--
 osal/windows/TcWinTcpServer.h     | 14 +++++-
 osal/windows/TmTcWinUdpBridge.cpp |  3 +-
 3 files changed, 87 insertions(+), 6 deletions(-)

diff --git a/osal/windows/TcWinTcpServer.cpp b/osal/windows/TcWinTcpServer.cpp
index 756e77767..d090df459 100644
--- a/osal/windows/TcWinTcpServer.cpp
+++ b/osal/windows/TcWinTcpServer.cpp
@@ -2,10 +2,32 @@
 #include "../../serviceinterface/ServiceInterface.h"
 #include <winsock2.h>
 
-TcWinTcpServer::TcWinTcpServer(object_id_t objectId, object_id_t tmtcUnixUdpBridge):
+
+TcWinTcpServer::TcWinTcpServer(object_id_t objectId, object_id_t tmtcUnixUdpBridge,
+        uint16_t customTcpServerPort):
         SystemObject(objectId) {
-    /* Open TCP socket */
+    /* Initiates Winsock DLL. */
+    WSAData wsaData;
+    WORD wVersionRequested = MAKEWORD(2, 2);
+    int err = WSAStartup(wVersionRequested, &wsaData);
+    if (err != 0) {
+        /* Tell the user that we could not find a usable */
+        /* Winsock DLL.                                  */
+#if FSFW_CPP_OSTREAM_ENABLED == 1
+        sif::error << "TmTcWinUdpBridge::TmTcWinUdpBridge:"
+                "WSAStartup failed with error: " << err << std::endl;
+#endif
+        return;
+    }
+
+    /* Open TCP (stream) socket */
     serverTcpSocket = socket(AF_INET, SOCK_STREAM, 0);
+    uint16_t tcpPort = customTcpServerPort;
+
+    if(customTcpServerPort == 0xffff) {
+        tcpPort = DEFAULT_TCP_SERVER_PORT;
+    }
+
     if(serverTcpSocket == 0) {
 #if FSFW_CPP_OSTREAM_ENABLED == 1
         sif::warning << "TcWinTcpServer::TcWinTcpServer: Socket creation failed!" << std::endl;
@@ -16,11 +38,52 @@ TcWinTcpServer::TcWinTcpServer(object_id_t objectId, object_id_t tmtcUnixUdpBrid
     int retval = setsockopt(serverTcpSocket, SOL_SOCKET, SO_REUSEADDR | SO_BROADCAST,
             reinterpret_cast<const char*>(&tcpSockOpt), sizeof(tcpSockOpt));
     if(retval != 0) {
-
+        sif::warning << "TcWinTcpServer::TcWinTcpServer: Setting socket options failed!" <<
+                std::endl;
+        handleError(ErrorSources::SETSOCKOPT_CALL);
     }
+    tcpAddress.sin_family = AF_INET;
+    tcpAddress.sin_addr.s_addr = htonl(INADDR_ANY);
+    tcpAddress.sin_port = htons(tcpPort);
+
+    retval = bind(serverTcpSocket, reinterpret_cast<const sockaddr*>(&tcpAddress),
+            tcpAddrLen);
+    if(retval != 0) {
+        sif::warning << "TcWinTcpServer::TcWinTcpServer: Binding socket failed!" <<
+                std::endl;
+        handleError(ErrorSources::BIND_CALL);
+    }
+
 }
 
 TcWinTcpServer::~TcWinTcpServer() {
+    closesocket(serverTcpSocket);
+    WSACleanup();
+}
+
+ReturnValue_t TcWinTcpServer::initialize() {
+    return HasReturnvaluesIF::RETURN_OK;
+}
+
+ReturnValue_t TcWinTcpServer::performOperation(uint8_t opCode) {
+    /* If a connection is accepted, the corresponding scoket will be assigned to the new socket */
+    SOCKET connectorSocket;
+    sockaddr_in connectorSockAddr;
+    int connectorSockAddrLen = 0;
+    /* Listen for connection requests permanently for lifetime of program */
+    while(true) {
+        int retval = listen(serverTcpSocket, backlog);
+        if(retval != 0) {
+            handleError(ErrorSources::LISTEN_CALL);
+        }
+
+        connectorSocket = accept(serverTcpSocket, reinterpret_cast<sockaddr*>(&connectorSockAddr),
+                &connectorSockAddrLen);
+
+        if(connectorSocket) {};
+
+    }
+    return HasReturnvaluesIF::RETURN_OK;
 }
 
 void TcWinTcpServer::handleError(ErrorSources errorSrc) {
@@ -33,6 +96,13 @@ void TcWinTcpServer::handleError(ErrorSources errorSrc) {
     else if(errorSrc == ErrorSources::SOCKET_CALL) {
         errorSrcString = "socket call";
     }
+    else if(errorSrc == ErrorSources::LISTEN_CALL) {
+        errorSrcString = "listen call";
+    }
+    else if(errorSrc == ErrorSources::ACCEPT_CALL) {
+        errorSrcString = "accept call";
+    }
+
     switch(errCode) {
     case(WSANOTINITIALISED): {
         sif::warning << "TmTcWinUdpBridge::handleError: " << errorSrcString << " | "
diff --git a/osal/windows/TcWinTcpServer.h b/osal/windows/TcWinTcpServer.h
index 4f53dda42..45d92ff80 100644
--- a/osal/windows/TcWinTcpServer.h
+++ b/osal/windows/TcWinTcpServer.h
@@ -14,19 +14,29 @@ public:
     static constexpr uint16_t DEFAULT_TCP_SERVER_PORT = 7301;
     static constexpr uint16_t DEFAULT_TCP_CLIENT_PORT = 7302;
 
-    TcWinTcpServer(object_id_t objectId, object_id_t tmtcUnixUdpBridge);
+    TcWinTcpServer(object_id_t objectId, object_id_t tmtcUnixUdpBridge,
+            uint16_t customTcpServerPort = 0xffff);
     virtual~ TcWinTcpServer();
 
+    ReturnValue_t initialize() override;
+    ReturnValue_t performOperation(uint8_t opCode) override;
+
 private:
 
     SOCKET serverTcpSocket = 0;
+    struct sockaddr_in tcpAddress;
+    int tcpAddrLen = sizeof(tcpAddress);
+    int backlog = 3;
 
     std::vector<uint8_t> receptionBuffer;
     int tcpSockOpt = 0;
 
     enum class ErrorSources {
         SOCKET_CALL,
-        SETSOCKOPT_CALL
+        SETSOCKOPT_CALL,
+        BIND_CALL,
+        LISTEN_CALL,
+        ACCEPT_CALL
     };
 
     void handleError(ErrorSources errorSrc);
diff --git a/osal/windows/TmTcWinUdpBridge.cpp b/osal/windows/TmTcWinUdpBridge.cpp
index 375e45e7c..d4467e441 100644
--- a/osal/windows/TmTcWinUdpBridge.cpp
+++ b/osal/windows/TmTcWinUdpBridge.cpp
@@ -14,7 +14,7 @@ TmTcWinUdpBridge::TmTcWinUdpBridge(object_id_t objectId,
     mutex = MutexFactory::instance()->createMutex();
     communicationLinkUp = false;
 
-    // Initiates Winsock DLL.
+    /* Initiates Winsock DLL. */
     WSAData wsaData;
     WORD wVersionRequested = MAKEWORD(2, 2);
     int err = WSAStartup(wVersionRequested, &wsaData);
@@ -87,6 +87,7 @@ TmTcWinUdpBridge::TmTcWinUdpBridge(object_id_t objectId,
 }
 
 TmTcWinUdpBridge::~TmTcWinUdpBridge() {
+    closesocket(serverSocket);
     WSACleanup();
 }