AcessNative - Fixed CLIShell
[tpg/acess2.git] / AcessNative / acesskernel_src / server.c
index 78f7fa1..37694bf 100644 (file)
 # include <unistd.h>
 # include <sys/socket.h>
 # include <netinet/in.h>
+# include <arpa/inet.h>        // inet_ntop
 #endif
 #include "../syscalls.h"
 //#include <debug.h>
 
-#define        USE_TCP 0
+#define        USE_TCP 1
 #define MAX_CLIENTS    16
 
 // === TYPES ===
@@ -27,6 +28,7 @@ typedef struct {
         int    ClientID;
        SDL_Thread      *WorkerThread;
        #if USE_TCP
+        int    Socket;
        #else
        tRequestHeader  *CurrentRequest;
        struct sockaddr_in      ClientAddr;
@@ -42,6 +44,7 @@ extern void   Threads_SetThread(int TID);
 // HACK: Should have these in a header
 extern void    Log_Debug(const char *Subsys, const char *Message, ...);
 extern void    Log_Notice(const char *Subsys, const char *Message, ...);
+extern void    Log_Warning(const char *Subsys, const char *Message, ...);
 
 // === PROTOTYPES ===
 tClient        *Server_GetClient(int ClientID);
@@ -102,12 +105,20 @@ tClient *Server_GetClient(int ClientID)
        
        // Allocate a thread for the process
        ret->ClientID = ClientID;
+       #if USE_TCP
+       ret->Socket = 0;
+       #else
        ret->CurrentRequest = NULL;
+       #endif
                
        if( !ret->WorkerThread ) {
+               #if USE_TCP
+               #else
                ret->WaitFlag = SDL_CreateCond();
                ret->Mutex = SDL_CreateMutex();
                SDL_mutexP( ret->Mutex );
+               #endif
+               Log_Debug("Server", "Creating worker for %p", ret);
                ret->WorkerThread = SDL_CreateThread( Server_WorkerThread, ret );
        }
        
@@ -117,14 +128,105 @@ tClient *Server_GetClient(int ClientID)
 int Server_WorkerThread(void *ClientPtr)
 {
        tClient *Client = ClientPtr;
+
+       Log_Debug("Server", "Worker %p", ClientPtr);    
+
+       #if USE_TCP
+
+       while( *((volatile typeof(Client->Socket)*)&Client->Socket) == 0 )
+               ;
+       Threads_SetThread( Client->ClientID );
+       
+       for( ;; )
+       {
+               fd_set  fds;
+                int    nfd = Client->Socket+1;
+               FD_ZERO(&fds);
+               FD_SET(Client->Socket, &fds);
+               
+               int rv = select(nfd, &fds, NULL, NULL, NULL);   // TODO: Timeouts?
+               if(rv < 0) {
+                       perror("select");
+                       continue ;
+               }
+               Log_Debug("Server", "%p: rv=%i", Client, rv);           
+
+               if( FD_ISSET(Client->Socket, &fds) )
+               {
+                       const int       ciMaxParamCount = 6;
+                       char    lbuf[sizeof(tRequestHeader) + ciMaxParamCount*sizeof(tRequestValue)];
+                       tRequestHeader  *hdr = (void*)lbuf;
+                       size_t  len = recv(Client->Socket, hdr, sizeof(*hdr), 0);
+                       Log_Debug("Server", "%i bytes of header", len);
+                       if( len == 0 )  break;
+                       if( len != sizeof(*hdr) ) {
+                               // Oops?
+                               Log_Warning("Server", "FD%i bad sized (%i != exp %i)",
+                                       Client->Socket, len, sizeof(*hdr));
+                               continue ;
+                       }
+
+                       if( hdr->NParams > ciMaxParamCount ) {
+                               // Oops.
+                               Log_Warning("Server", "FD%i too many params (%i > max %i)",
+                                       Client->Socket, hdr->NParams, ciMaxParamCount);
+                               continue ;
+                       }
+
+                       len = recv(Client->Socket, hdr->Params, hdr->NParams*sizeof(tRequestValue), 0);
+                       Log_Debug("Server", "%i bytes of params", len);
+                       if( len != hdr->NParams*sizeof(tRequestValue) ) {
+                               // Oops.
+                       }
+
+                       // Get buffer size
+                       size_t  hdrsize = sizeof(tRequestHeader) + hdr->NParams*sizeof(tRequestValue);
+                       size_t  bufsize = hdrsize;
+                        int    i;
+                       for( i = 0; i < hdr->NParams; i ++ )
+                       {
+                               if( hdr->Params[i].Flags & ARG_FLAG_ZEROED )
+                                       ;
+                               else {
+                                       bufsize += hdr->Params[i].Length;
+                               }
+                       }
+
+                       // Allocate full buffer
+                       hdr = malloc(bufsize);
+                       memcpy(hdr, lbuf, hdrsize);
+                       if( bufsize > hdrsize )
+                       {
+                               len = recv(Client->Socket, hdr->Params + hdr->NParams, bufsize - hdrsize, 0);
+                               Log_Debug("Server", "%i bytes of data", len);
+                               if( len != bufsize - hdrsize ) {
+                                       // Oops?
+                               }
+                       }
+                       else
+                               Log_Debug("Server", "no data");
+
+                        int    retlen;
+                       tRequestHeader  *retHeader;
+                       retHeader = SyscallRecieve(hdr, &retlen);
+                       if( !retHeader ) {
+                               // Some sort of error
+                               Log_Warning("Server", "SyscallRecieve failed?");
+                               continue ;
+                       }
+                       
+                       send(Client->Socket, retHeader, retlen, 0); 
+
+                       // Clean up
+                       free(hdr);
+               }
+       }
+       #else
        tRequestHeader  *retHeader;
        tRequestHeader  errorHeader;
         int    retSize = 0;
         int    sentSize;
         int    cur_client_id = 0;
-       
-       #if USE_TCP
-       #else
        for( ;; )
        {
                // Wait for something to do
@@ -187,6 +289,8 @@ int Server_WorkerThread(void *ClientPtr)
                        free( retHeader );
        }
        #endif
+       Log_Notice("Server", "Terminated Worker %p", ClientPtr);        
+       return 0;
 }
 
 int SyscallServer(void)
@@ -253,18 +357,69 @@ int Server_ListenThread(void *Unused)
        for( ;; )
        {
                #if USE_TCP
-               struct sockaddr_in      client;
-               uint    clientSize = sizeof(client);
-                int    clientSock = accept(gSocket, (struct sockaddr*)&client, &clientSize);
+               struct sockaddr_in      clientaddr;
+               socklen_t       clientSize = sizeof(clientaddr);
+                int    clientSock = accept(gSocket, (struct sockaddr*)&clientaddr, &clientSize);
                if( clientSock < 0 ) {
                        perror("SyscallServer - accept");
                        break ;
                }
+
+               char    addrstr[4*8+8+1];
+               inet_ntop(clientaddr.sin_family, &clientaddr.sin_addr, addrstr, sizeof(addrstr));
+               Log_Debug("Server", "Client connection %s:%i", addrstr, ntohs(clientaddr.sin_port));
+               
+               // Perform auth
+               size_t  len;
+               tRequestAuthHdr authhdr;
+               len = recv(clientSock, &authhdr, sizeof(authhdr), 0);
+               if( len != sizeof(authhdr) ) {
+                       // Some form of error?
+                       Log_Warning("Server", "Client auth block bad size (%i != exp %i)",
+                               len, sizeof(authhdr));
+                       close(clientSock);
+                       continue ;
+               }
                
-               Log("Client connection %x:%i\n",
-                       ntohl(client.sin_addr), ntohs(client.sin_port)
-                       );
+               Log_Debug("Server", "Client assumed PID %i", authhdr.pid);
+
+               tClient *client;
+               if( authhdr.pid == 0 ) {
+                       // Allocate PID and client structure/thread
+                       client = Server_GetClient(0);
+                       client->Socket = clientSock;
+                       authhdr.pid = client->ClientID;
+               }
+               else {
+                       // Get client structure and make sure it's unused
+                       // - Auth token / verifcation?
+                       client = Server_GetClient(authhdr.pid);
+                       if( !client ) {
+                               Log_Warning("Server", "Can't allocate a client struct for %s:%i",
+                                       addrstr, clientaddr.sin_port);
+                               close(clientSock);
+                               continue ;
+                       }
+                       if( client->Socket != 0 ) {
+                               Log_Warning("Server", "Client (%i)%p owned by FD%i but %s:%i tried to use it",
+                                       authhdr.pid, client, addrstr, clientaddr.sin_port);
+                               close(clientSock);
+                               continue;
+                       }
+                       else {
+                               client->Socket = clientSock;
+                       }
+               }
+               Log_Debug("Server", "Client given PID %i - info %p", authhdr.pid, client);
                
+               len = send(clientSock, &authhdr, sizeof(authhdr), 0);
+               if( len != sizeof(authhdr) ) {
+                       // Ok, this is an error
+                       perror("Sending auth reply");
+               }
+
+               // All done, client thread should be watching now               
+
                #else
                char    data[BUFSIZ];
                tRequestHeader  *req = (void*)data;

UCC git Repository :: git.ucc.asn.au