3 * - Acess kernel emulation on another OS using SDL and UDP
16 # include <sys/socket.h>
17 # include <netinet/in.h>
19 #include "../syscalls.h"
23 #define MAX_CLIENTS 16
28 SDL_Thread *WorkerThread;
31 tRequestHeader *CurrentRequest;
32 struct sockaddr_in ClientAddr;
39 extern tRequestHeader *SyscallRecieve(tRequestHeader *Request, int *ReturnLength);
40 extern int Threads_CreateRootProcess(void);
41 // HACK: Should have these in a header
42 extern void Log_Debug(const char *Subsys, const char *Message, ...);
43 extern void Log_Notice(const char *Subsys, const char *Message, ...);
46 tClient *Server_GetClient(int ClientID);
47 int Server_WorkerThread(void *ClientPtr);
48 int SyscallServer(void);
53 SOCKET gSocket = INVALID_SOCKET;
55 # define INVALID_SOCKET -1
56 int gSocket = INVALID_SOCKET;
58 tClient gaServer_Clients[MAX_CLIENTS];
61 int Server_GetClientID(void)
64 Uint32 thisId = SDL_ThreadID();
66 for( i = 0; i < MAX_CLIENTS; i ++ )
68 if( SDL_GetThreadID(gaServer_Clients[i].WorkerThread) == thisId )
69 return gaServer_Clients[i].ClientID;
72 fprintf(stderr, "ERROR: Server_GetClientID - Thread is not allocated\n");
77 tClient *Server_GetClient(int ClientID)
82 // Allocate an ID if needed
84 ClientID = Threads_CreateRootProcess();
86 for( i = 0; i < MAX_CLIENTS; i ++ )
88 if( gaServer_Clients[i].ClientID == ClientID ) {
89 return &gaServer_Clients[i];
91 if(!ret && gaServer_Clients[i].ClientID == 0)
92 ret = &gaServer_Clients[i];
95 // Uh oh, no free slots
96 // TODO: Dynamic allocation
100 // Allocate a thread for the process
101 ret->ClientID = ClientID;
102 ret->CurrentRequest = NULL;
104 if( !ret->WorkerThread ) {
105 ret->WaitFlag = SDL_CreateCond();
106 ret->Mutex = SDL_CreateMutex();
107 SDL_mutexP( ret->Mutex );
108 ret->WorkerThread = SDL_CreateThread( Server_WorkerThread, ret );
114 int Server_WorkerThread(void *ClientPtr)
116 tClient *Client = ClientPtr;
117 tRequestHeader *retHeader;
118 tRequestHeader errorHeader;
126 // Wait for something to do
127 while( Client->CurrentRequest == NULL )
128 SDL_CondWait(Client->WaitFlag, Client->Mutex);
130 Log_Debug("AcessSrv", "Worker %i takes %p",
131 Client->ClientID, Client->CurrentRequest);
134 retHeader = SyscallRecieve(Client->CurrentRequest, &retSize);
137 // Return an error to the client
138 printf("ERROR: SyscallRecieve failed\n");
139 errorHeader.CallID = Client->CurrentRequest->CallID;
140 errorHeader.NParams = 0;
141 retHeader = &errorHeader;
142 retSize = sizeof(errorHeader);
146 retHeader->ClientID = Client->ClientID;
148 // Mark the thread as ready for another job
149 Client->CurrentRequest = 0;
151 Log_Debug("AcessSrv", "Sending %i to %x:%i (Client %i)",
152 retSize, ntohl(Client->ClientAddr.sin_addr.s_addr),
153 ntohs(Client->ClientAddr.sin_port),
158 sentSize = sendto(gSocket, retHeader, retSize, 0,
159 (struct sockaddr*)&Client->ClientAddr, sizeof(Client->ClientAddr)
161 if( sentSize != retSize ) {
162 perror("Server_WorkerThread - send");
165 // Free allocated header
166 if( retHeader != &errorHeader )
172 int SyscallServer(void)
174 struct sockaddr_in server;
177 /* Open windows connection */
178 if (WSAStartup(0x0101, &gWinsock) != 0)
180 fprintf(stderr, "Could not open Windows connection.\n");
186 // Open TCP Connection
187 gSocket = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
189 // Open UDP Connection
190 gSocket = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
192 if (gSocket == INVALID_SOCKET)
194 fprintf(stderr, "Could not create socket.\n");
201 // Set server address
202 memset(&server, 0, sizeof(struct sockaddr_in));
203 server.sin_family = AF_INET;
204 server.sin_port = htons(SERVER_PORT);
205 server.sin_addr.s_addr = htonl(INADDR_ANY);
208 if( bind(gSocket, (struct sockaddr *)&server, sizeof(struct sockaddr_in)) == -1 )
210 fprintf(stderr, "Cannot bind address to socket.\n");
211 perror("SyscallServer - bind");
213 closesocket(gSocket);
225 Log_Notice("AcessSrv", "Listening on 0.0.0.0:%i", SERVER_PORT);
227 // Wait for something to do :)
231 struct sockaddr_in client;
232 uint clientSize = sizeof(client);
233 int clientSock = accept(gSocket, (struct sockaddr*)&client, &clientSize);
234 if( clientSock < 0 ) {
235 perror("SyscallServer - accept");
239 Log("Client connection %x:%i\n",
240 ntohl(client.sin_addr), ntohs(client.sin_port)
245 tRequestHeader *req = (void*)data;
246 struct sockaddr_in addr;
247 uint clientSize = sizeof(addr);
248 int length = recvfrom(gSocket, data, BUFSIZ, 0, (struct sockaddr*)&addr, &clientSize);
252 perror("SyscallServer - recv");
256 // Hand off to a worker thread
257 // - TODO: Actually have worker threads
258 printf("%i bytes from %x:%i\n", length,
259 ntohl(addr.sin_addr.s_addr), ntohs(addr.sin_port));
261 client = Server_GetClient(req->ClientID);
262 if( req->ClientID == 0 )
264 memcpy(&client->ClientAddr, &addr, sizeof(addr));
266 else if( memcmp(&client->ClientAddr, &addr, sizeof(addr)) != 0 )
268 printf("ClientID %i used by %x:%i\n",
269 client->ClientID, ntohl(addr.sin_addr.s_addr), ntohs(addr.sin_port));
270 printf(" actually owned by %x:%i\n",
271 ntohl(client->ClientAddr.sin_addr.s_addr), ntohs(client->ClientAddr.sin_port));
275 if( client->CurrentRequest ) {
276 printf("Worker thread for %x:%i is busy\n",
277 ntohl(client->ClientAddr.sin_addr.s_addr), ntohs(client->ClientAddr.sin_port));
281 Log_Debug("AcessSrv", "Message from Client %i (%p)",
282 client->ClientID, client);
284 client->CurrentRequest = req;
285 SDL_CondSignal(client->WaitFlag);