load the JPEG dll when needed
[divverent/darkplaces.git] / lhnet.c
1
2 // Written by Forest Hale 2003-06-15 and placed into public domain.
3
4 #ifndef STANDALONETEST
5 #include "quakedef.h"
6 #endif
7
8 #include <stdlib.h>
9 #include <stdio.h>
10 #include <time.h>
11 #include <string.h>
12 #ifdef WIN32
13 #include <winsock.h>
14 #else
15 #include <unistd.h>
16 #include <sys/socket.h>
17 #include <sys/ioctl.h>
18 #include <errno.h>
19 #include <netdb.h>
20 #include <netinet/in.h>
21 #include <arpa/inet.h>
22 #endif
23
24 #ifdef __MORPHOS__
25 #include <proto/socket.h>
26 #endif
27
28 // for Z_Malloc/Z_Free in quake
29 #ifndef STANDALONETEST
30 #include "zone.h"
31 #include "sys.h"
32 #include "netconn.h"
33 #else
34 #define Con_Print printf
35 #define Con_Printf printf
36 #define Z_Malloc malloc
37 #define Z_Free free
38 #endif
39
40 #include "lhnet.h"
41
42 #if defined(WIN32)
43 #define EWOULDBLOCK WSAEWOULDBLOCK
44 #define ECONNREFUSED WSAECONNREFUSED
45
46 #define SOCKETERRNO WSAGetLastError()
47
48 #define IOC_VENDOR 0x18000000
49 #define _WSAIOW(x,y) (IOC_IN|(x)|(y))
50 #define SIO_UDP_CONNRESET _WSAIOW(IOC_VENDOR,12)
51
52 #define SOCKLEN_T int
53 #elif defined(__MORPHOS__)
54 #define ioctlsocket IoctlSocket
55 #define closesocket CloseSocket
56 #define SOCKETERRNO Errno()
57
58 #define SOCKLEN_T int
59 #else
60 #define ioctlsocket ioctl
61 #define closesocket close
62 #define SOCKETERRNO errno
63
64 #define SOCKLEN_T socklen_t
65 #endif
66
67 // to make LHNETADDRESS_FromString resolve repeated hostnames faster, cache them
68 #define MAX_NAMECACHE 64
69 static struct namecache_s
70 {
71         lhnetaddress_t address;
72         double expirationtime;
73         char name[64];
74 }
75 namecache[MAX_NAMECACHE];
76 static int namecacheposition = 0;
77
78 int LHNETADDRESS_FromPort(lhnetaddress_t *address, int addresstype, int port)
79 {
80         if (!address)
81                 return 0;
82         switch(addresstype)
83         {
84         case LHNETADDRESSTYPE_LOOP:
85                 // local:port  (loopback)
86                 memset(address, 0, sizeof(*address));
87                 address->addresstype = LHNETADDRESSTYPE_LOOP;
88                 address->addressdata.loop.port = port;
89                 return 1;
90         case LHNETADDRESSTYPE_INET4:
91                 // 0.0.0.0:port  (INADDR_ANY, binds to all interfaces)
92                 memset(address, 0, sizeof(*address));
93                 address->addresstype = LHNETADDRESSTYPE_INET4;
94                 address->addressdata.inet4.family = LHNETADDRESSTYPE_INET4_FAMILY;
95                 address->addressdata.inet4.port = htons((unsigned short)port);
96                 return 1;
97         case LHNETADDRESSTYPE_INET6:
98                 // [0:0:0:0:0:0:0:0]:port  (IN6ADDR_ANY, binds to all interfaces)
99                 memset(address, 0, sizeof(*address));
100                 address->addresstype = LHNETADDRESSTYPE_INET6;
101                 address->addressdata.inet6.family = LHNETADDRESSTYPE_INET6_FAMILY;
102                 address->addressdata.inet6.port = htons((unsigned short)port);
103                 return 1;
104         }
105         return 0;
106 }
107
108 int LHNETADDRESS_FromString(lhnetaddress_t *address, const char *string, int defaultport)
109 {
110         int i, port, namelen, d1, d2, d3, d4;
111         struct hostent *hostentry;
112         const char *colon;
113         char name[128];
114         if (!address || !string || !*string)
115                 return 0;
116         memset(address, 0, sizeof(*address));
117         address->addresstype = LHNETADDRESSTYPE_NONE;
118         port = 0;
119         colon = strrchr(string, ':');
120         if (colon)
121                 port = atoi(colon + 1);
122         else
123                 colon = string + strlen(string);
124         if (port == 0)
125                 port = defaultport;
126         namelen = colon - string;
127         if (namelen > 127)
128                 namelen = 127;
129         if (string[0] == '[' && namelen > 0 && string[namelen-1] == ']') // ipv6
130         {
131                 string++;
132                 namelen -= 2;
133         }
134         memcpy(name, string, namelen);
135         name[namelen] = 0;
136         // handle loopback
137         if (!strcmp(name, "local"))
138         {
139                 address->addresstype = LHNETADDRESSTYPE_LOOP;
140                 address->addressdata.loop.port = port;
141                 return 1;
142         }
143         // try to parse as dotted decimal ipv4 address first
144         // note this supports partial ip addresses
145         d1 = d2 = d3 = d4 = 0;
146 #if _MSC_VER >= 1400
147 #define sscanf sscanf_s
148 #endif
149         if (sscanf(name, "%d.%d.%d.%d", &d1, &d2, &d3, &d4) >= 1 && (unsigned int)d1 < 256 && (unsigned int)d2 < 256 && (unsigned int)d3 < 256 && (unsigned int)d4 < 256)
150         {
151                 // parsed a valid ipv4 address
152                 address->addresstype = LHNETADDRESSTYPE_INET4;
153                 address->addressdata.inet4.family = LHNETADDRESSTYPE_INET4_FAMILY;
154                 address->addressdata.inet4.port = htons((unsigned short)port);
155                 address->addressdata.inet4.address[0] = (unsigned char)d1;
156                 address->addressdata.inet4.address[1] = (unsigned char)d2;
157                 address->addressdata.inet4.address[2] = (unsigned char)d3;
158                 address->addressdata.inet4.address[3] = (unsigned char)d4;
159 #ifdef STANDALONETEST
160                 printf("manual parsing of ipv4 dotted decimal address \"%s\" successful: %d.%d.%d.%d:%d\n", string, (int)address->addressdata.inet4.address[0], (int)address->addressdata.inet4.address[1], (int)address->addressdata.inet4.address[2], (int)address->addressdata.inet4.address[3], (int)ntohs(address->addressdata.inet4.port));
161 #endif
162                 return 1;
163         }
164         for (i = 0;i < MAX_NAMECACHE;i++)
165                 if (!strcmp(namecache[i].name, name))
166                         break;
167 #ifdef STANDALONETEST
168         if (i < MAX_NAMECACHE)
169 #else
170         if (i < MAX_NAMECACHE && realtime < namecache[i].expirationtime)
171 #endif
172         {
173                 *address = namecache[i].address;
174                 if (address->addresstype == LHNETADDRESSTYPE_INET6)
175                 {
176                         address->addressdata.inet6.port = htons((unsigned short)port);
177                         return 1;
178                 }
179                 else if (address->addresstype == LHNETADDRESSTYPE_INET4)
180                 {
181                         address->addressdata.inet4.port = htons((unsigned short)port);
182                         return 1;
183                 }
184                 return 0;
185         }
186         // try gethostbyname (handles dns and other ip formats)
187         hostentry = gethostbyname(name);
188         if (hostentry)
189         {
190                 if (hostentry->h_addrtype == LHNETADDRESSTYPE_INET6_FAMILY)
191                 {
192                         // great it worked
193                         address->addresstype = LHNETADDRESSTYPE_INET6;
194                         address->addressdata.inet6.family = hostentry->h_addrtype;
195                         address->addressdata.inet6.port = htons((unsigned short)port);
196                         memcpy(address->addressdata.inet6.address, hostentry->h_addr_list[0], sizeof(address->addressdata.inet6.address));
197                         for (i = 0;i < (int)sizeof(namecache[namecacheposition].name)-1 && name[i];i++)
198                                 namecache[namecacheposition].name[i] = name[i];
199                         namecache[namecacheposition].name[i] = 0;
200 #ifndef STANDALONETEST
201                         namecache[namecacheposition].expirationtime = realtime + 12 * 3600; // 12 hours
202 #endif
203                         namecache[namecacheposition].address = *address;
204                         namecacheposition = (namecacheposition + 1) % MAX_NAMECACHE;
205 #ifdef STANDALONETEST
206                         printf("gethostbyname(\"%s\") returned ipv6 address [%x:%x:%x:%x:%x:%x:%x:%x]:%d\n", name, (int)address->addressdata.inet6.address[0], (int)address->addressdata.inet6.address[1], (int)address->addressdata.inet6.address[2], (int)address->addressdata.inet6.address[3], (int)address->addressdata.inet6.address[4], (int)address->addressdata.inet6.address[5], (int)address->addressdata.inet6.address[6], (int)address->addressdata.inet6.address[7], (int)ntohs(address->addressdata.inet6.port));
207 #endif
208                         return 1;
209                 }
210                 else if (hostentry->h_addrtype == LHNETADDRESSTYPE_INET4_FAMILY)
211                 {
212                         // great it worked
213                         address->addresstype = LHNETADDRESSTYPE_INET4;
214                         address->addressdata.inet4.family = hostentry->h_addrtype;
215                         address->addressdata.inet4.port = htons((unsigned short)port);
216                         memcpy(address->addressdata.inet4.address, hostentry->h_addr_list[0], sizeof(address->addressdata.inet4.address));
217                         for (i = 0;i < (int)sizeof(namecache[namecacheposition].name)-1 && name[i];i++)
218                                 namecache[namecacheposition].name[i] = name[i];
219                         namecache[namecacheposition].name[i] = 0;
220 #ifndef STANDALONETEST
221                         namecache[namecacheposition].expirationtime = realtime + 12 * 3600; // 12 hours
222 #endif
223                         namecache[namecacheposition].address = *address;
224                         namecacheposition = (namecacheposition + 1) % MAX_NAMECACHE;
225 #ifdef STANDALONETEST
226                         printf("gethostbyname(\"%s\") returned ipv4 address %d.%d.%d.%d:%d\n", name, (int)address->addressdata.inet4.address[0], (int)address->addressdata.inet4.address[1], (int)address->addressdata.inet4.address[2], (int)address->addressdata.inet4.address[3], (int)ntohs(address->addressdata.inet4.port));
227 #endif
228                         return 1;
229                 }
230         }
231 #ifdef STANDALONETEST
232         printf("gethostbyname failed on address \"%s\"\n", name);
233 #endif
234         for (i = 0;i < (int)sizeof(namecache[namecacheposition].name)-1 && name[i];i++)
235                 namecache[namecacheposition].name[i] = name[i];
236         namecache[namecacheposition].name[i] = 0;
237 #ifndef STANDALONETEST
238         namecache[namecacheposition].expirationtime = realtime + 12 * 3600; // 12 hours
239 #endif
240         namecache[namecacheposition].address.addresstype = LHNETADDRESSTYPE_NONE;
241         namecacheposition = (namecacheposition + 1) % MAX_NAMECACHE;
242         return 0;
243 }
244
245 int LHNETADDRESS_ToString(const lhnetaddress_t *address, char *string, int stringbuffersize, int includeport)
246 {
247         *string = 0;
248         if (!address || !string || stringbuffersize < 1)
249                 return 0;
250         switch(address->addresstype)
251         {
252         default:
253                 break;
254         case LHNETADDRESSTYPE_LOOP:
255                 if (includeport)
256                 {
257                         if (stringbuffersize >= 12)
258                         {
259                                 dpsnprintf(string, stringbuffersize, "local:%d", (int)address->addressdata.loop.port);
260                                 return 1;
261                         }
262                 }
263                 else
264                 {
265                         if (stringbuffersize >= 6)
266                         {
267                                 memcpy(string, "local", 6);
268                                 return 1;
269                         }
270                 }
271                 break;
272         case LHNETADDRESSTYPE_INET4:
273                 if (includeport)
274                 {
275                         if (stringbuffersize >= 22)
276                         {
277                                 dpsnprintf(string, stringbuffersize, "%d.%d.%d.%d:%d", (int)address->addressdata.inet4.address[0], (int)address->addressdata.inet4.address[1], (int)address->addressdata.inet4.address[2], (int)address->addressdata.inet4.address[3], (int)ntohs(address->addressdata.inet4.port));
278                                 return 1;
279                         }
280                 }
281                 else
282                 {
283                         if (stringbuffersize >= 16)
284                         {
285                                 dpsnprintf(string, stringbuffersize, "%d.%d.%d.%d", (int)address->addressdata.inet4.address[0], (int)address->addressdata.inet4.address[1], (int)address->addressdata.inet4.address[2], (int)address->addressdata.inet4.address[3]);
286                                 return 1;
287                         }
288                 }
289                 break;
290         case LHNETADDRESSTYPE_INET6:
291                 if (includeport)
292                 {
293                         if (stringbuffersize >= 88)
294                         {
295                                 dpsnprintf(string, stringbuffersize, "[%x:%x:%x:%x:%x:%x:%x:%x]:%d", (int)address->addressdata.inet6.address[0], (int)address->addressdata.inet6.address[1], (int)address->addressdata.inet6.address[2], (int)address->addressdata.inet6.address[3], (int)address->addressdata.inet6.address[4], (int)address->addressdata.inet6.address[5], (int)address->addressdata.inet6.address[6], (int)address->addressdata.inet6.address[7], (int)ntohs(address->addressdata.inet6.port));
296                                 return 1;
297                         }
298                 }
299                 else
300                 {
301                         if (stringbuffersize >= 80)
302                         {
303                                 dpsnprintf(string, stringbuffersize, "%x:%x:%x:%x:%x:%x:%x:%x", (int)address->addressdata.inet6.address[0], (int)address->addressdata.inet6.address[1], (int)address->addressdata.inet6.address[2], (int)address->addressdata.inet6.address[3], (int)address->addressdata.inet6.address[4], (int)address->addressdata.inet6.address[5], (int)address->addressdata.inet6.address[6], (int)address->addressdata.inet6.address[7]);
304                                 return 1;
305                         }
306                 }
307                 break;
308         }
309         return 0;
310 }
311
312 int LHNETADDRESS_GetAddressType(const lhnetaddress_t *address)
313 {
314         if (address)
315                 return address->addresstype;
316         else
317                 return LHNETADDRESSTYPE_NONE;
318 }
319
320 int LHNETADDRESS_GetPort(const lhnetaddress_t *address)
321 {
322         if (!address)
323                 return -1;
324         switch(address->addresstype)
325         {
326         case LHNETADDRESSTYPE_LOOP:
327                 return address->addressdata.loop.port;
328         case LHNETADDRESSTYPE_INET4:
329                 return ntohs(address->addressdata.inet4.port);
330         case LHNETADDRESSTYPE_INET6:
331                 return ntohs(address->addressdata.inet6.port);
332         default:
333                 return -1;
334         }
335 }
336
337 int LHNETADDRESS_SetPort(lhnetaddress_t *address, int port)
338 {
339         if (!address)
340                 return 0;
341         switch(address->addresstype)
342         {
343         case LHNETADDRESSTYPE_LOOP:
344                 address->addressdata.loop.port = port;
345                 return 1;
346         case LHNETADDRESSTYPE_INET4:
347                 address->addressdata.inet4.port = htons((unsigned short)port);
348                 return 1;
349         case LHNETADDRESSTYPE_INET6:
350                 address->addressdata.inet6.port = htons((unsigned short)port);
351                 return 1;
352         default:
353                 return 0;
354         }
355 }
356
357 int LHNETADDRESS_Compare(const lhnetaddress_t *address1, const lhnetaddress_t *address2)
358 {
359         if (!address1 || !address2)
360                 return 1;
361         if (address1->addresstype != address2->addresstype)
362                 return 1;
363         switch(address1->addresstype)
364         {
365         case LHNETADDRESSTYPE_LOOP:
366                 if (address1->addressdata.loop.port != address2->addressdata.loop.port)
367                         return -1;
368                 return 0;
369         case LHNETADDRESSTYPE_INET4:
370                 if (address1->addressdata.inet4.family != address2->addressdata.inet4.family)
371                         return 1;
372                 if (memcmp(address1->addressdata.inet4.address, address2->addressdata.inet4.address, sizeof(address1->addressdata.inet4.address)))
373                         return 1;
374                 if (address1->addressdata.inet4.port != address2->addressdata.inet4.port)
375                         return -1;
376                 return 0;
377         case LHNETADDRESSTYPE_INET6:
378                 if (address1->addressdata.inet6.family != address2->addressdata.inet6.family)
379                         return 1;
380                 if (memcmp(address1->addressdata.inet6.address, address2->addressdata.inet6.address, sizeof(address1->addressdata.inet6.address)))
381                         return 1;
382                 if (address1->addressdata.inet6.port != address2->addressdata.inet6.port)
383                         return -1;
384                 return 0;
385         default:
386                 return 1;
387         }
388 }
389
390 typedef struct lhnetpacket_s
391 {
392         void *data;
393         int length;
394         int sourceport;
395         int destinationport;
396         time_t timeout;
397 #ifndef STANDALONETEST
398         double sentdoubletime;
399 #endif
400         struct lhnetpacket_s *next, *prev;
401 }
402 lhnetpacket_t;
403
404 static int lhnet_active;
405 static lhnetsocket_t lhnet_socketlist;
406 static lhnetpacket_t lhnet_packetlist;
407 #ifdef WIN32
408 static int lhnet_didWSAStartup = 0;
409 static WSADATA lhnet_winsockdata;
410 #endif
411
412 void LHNET_Init(void)
413 {
414         if (lhnet_active)
415                 return;
416         lhnet_socketlist.next = lhnet_socketlist.prev = &lhnet_socketlist;
417         lhnet_packetlist.next = lhnet_packetlist.prev = &lhnet_packetlist;
418         lhnet_active = 1;
419 #ifdef WIN32
420         lhnet_didWSAStartup = !WSAStartup(MAKEWORD(1, 1), &lhnet_winsockdata);
421         if (!lhnet_didWSAStartup)
422                 Con_Print("LHNET_Init: WSAStartup failed, networking disabled\n");
423 #endif
424 }
425
426 void LHNET_Shutdown(void)
427 {
428         lhnetpacket_t *p;
429         if (!lhnet_active)
430                 return;
431         while (lhnet_socketlist.next != &lhnet_socketlist)
432                 LHNET_CloseSocket(lhnet_socketlist.next);
433         while (lhnet_packetlist.next != &lhnet_packetlist)
434         {
435                 p = lhnet_packetlist.next;
436                 p->prev->next = p->next;
437                 p->next->prev = p->prev;
438                 Z_Free(p);
439         }
440 #ifdef WIN32
441         if (lhnet_didWSAStartup)
442         {
443                 lhnet_didWSAStartup = 0;
444                 WSACleanup();
445         }
446 #endif
447         lhnet_active = 0;
448 }
449
450 static const char *LHNETPRIVATE_StrError(void)
451 {
452 #ifdef WIN32
453         int i = WSAGetLastError();
454         switch (i)
455         {
456                 case WSAEINTR:           return "WSAEINTR";
457                 case WSAEBADF:           return "WSAEBADF";
458                 case WSAEACCES:          return "WSAEACCES";
459                 case WSAEFAULT:          return "WSAEFAULT";
460                 case WSAEINVAL:          return "WSAEINVAL";
461                 case WSAEMFILE:          return "WSAEMFILE";
462                 case WSAEWOULDBLOCK:     return "WSAEWOULDBLOCK";
463                 case WSAEINPROGRESS:     return "WSAEINPROGRESS";
464                 case WSAEALREADY:        return "WSAEALREADY";
465                 case WSAENOTSOCK:        return "WSAENOTSOCK";
466                 case WSAEDESTADDRREQ:    return "WSAEDESTADDRREQ";
467                 case WSAEMSGSIZE:        return "WSAEMSGSIZE";
468                 case WSAEPROTOTYPE:      return "WSAEPROTOTYPE";
469                 case WSAENOPROTOOPT:     return "WSAENOPROTOOPT";
470                 case WSAEPROTONOSUPPORT: return "WSAEPROTONOSUPPORT";
471                 case WSAESOCKTNOSUPPORT: return "WSAESOCKTNOSUPPORT";
472                 case WSAEOPNOTSUPP:      return "WSAEOPNOTSUPP";
473                 case WSAEPFNOSUPPORT:    return "WSAEPFNOSUPPORT";
474                 case WSAEAFNOSUPPORT:    return "WSAEAFNOSUPPORT";
475                 case WSAEADDRINUSE:      return "WSAEADDRINUSE";
476                 case WSAEADDRNOTAVAIL:   return "WSAEADDRNOTAVAIL";
477                 case WSAENETDOWN:        return "WSAENETDOWN";
478                 case WSAENETUNREACH:     return "WSAENETUNREACH";
479                 case WSAENETRESET:       return "WSAENETRESET";
480                 case WSAECONNABORTED:    return "WSAECONNABORTED";
481                 case WSAECONNRESET:      return "WSAECONNRESET";
482                 case WSAENOBUFS:         return "WSAENOBUFS";
483                 case WSAEISCONN:         return "WSAEISCONN";
484                 case WSAENOTCONN:        return "WSAENOTCONN";
485                 case WSAESHUTDOWN:       return "WSAESHUTDOWN";
486                 case WSAETOOMANYREFS:    return "WSAETOOMANYREFS";
487                 case WSAETIMEDOUT:       return "WSAETIMEDOUT";
488                 case WSAECONNREFUSED:    return "WSAECONNREFUSED";
489                 case WSAELOOP:           return "WSAELOOP";
490                 case WSAENAMETOOLONG:    return "WSAENAMETOOLONG";
491                 case WSAEHOSTDOWN:       return "WSAEHOSTDOWN";
492                 case WSAEHOSTUNREACH:    return "WSAEHOSTUNREACH";
493                 case WSAENOTEMPTY:       return "WSAENOTEMPTY";
494                 case WSAEPROCLIM:        return "WSAEPROCLIM";
495                 case WSAEUSERS:          return "WSAEUSERS";
496                 case WSAEDQUOT:          return "WSAEDQUOT";
497                 case WSAESTALE:          return "WSAESTALE";
498                 case WSAEREMOTE:         return "WSAEREMOTE";
499                 case WSAEDISCON:         return "WSAEDISCON";
500                 case 0:                  return "no error";
501                 default:                 return "unknown WSAE error";
502         }
503 #else
504         return strerror(errno);
505 #endif
506 }
507
508 void LHNET_SleepUntilPacket_Microseconds(int microseconds)
509 {
510         fd_set fdreadset;
511         struct timeval tv;
512         int lastfd;
513         lhnetsocket_t *s;
514         FD_ZERO(&fdreadset);
515         lastfd = 0;
516         for (s = lhnet_socketlist.next;s != &lhnet_socketlist;s = s->next)
517         {
518                 if (s->address.addresstype == LHNETADDRESSTYPE_INET4 || s->address.addresstype == LHNETADDRESSTYPE_INET6)
519                 {
520                         if (lastfd < s->inetsocket)
521                                 lastfd = s->inetsocket;
522                         FD_SET((unsigned int)s->inetsocket, &fdreadset);
523                 }
524         }
525         tv.tv_sec = microseconds / 1000000;
526         tv.tv_usec = microseconds % 1000000;
527         select(lastfd + 1, &fdreadset, NULL, NULL, &tv);
528 }
529
530 lhnetsocket_t *LHNET_OpenSocket_Connectionless(lhnetaddress_t *address)
531 {
532         lhnetsocket_t *lhnetsocket, *s;
533         if (!address)
534                 return NULL;
535         lhnetsocket = (lhnetsocket_t *)Z_Malloc(sizeof(*lhnetsocket));
536         if (lhnetsocket)
537         {
538                 memset(lhnetsocket, 0, sizeof(*lhnetsocket));
539                 lhnetsocket->address = *address;
540                 switch(lhnetsocket->address.addresstype)
541                 {
542                 case LHNETADDRESSTYPE_LOOP:
543                         if (lhnetsocket->address.addressdata.loop.port == 0)
544                         {
545                                 // allocate a port dynamically
546                                 // this search will always terminate because there is never
547                                 // an allocated socket with port 0, so if the number wraps it
548                                 // will find the port is unused, and then refuse to use port
549                                 // 0, causing an intentional failure condition
550                                 lhnetsocket->address.addressdata.loop.port = 1024;
551                                 for (;;)
552                                 {
553                                         for (s = lhnet_socketlist.next;s != &lhnet_socketlist;s = s->next)
554                                                 if (s->address.addresstype == lhnetsocket->address.addresstype && s->address.addressdata.loop.port == lhnetsocket->address.addressdata.loop.port)
555                                                         break;
556                                         if (s == &lhnet_socketlist)
557                                                 break;
558                                         lhnetsocket->address.addressdata.loop.port++;
559                                 }
560                         }
561                         // check if the port is available
562                         for (s = lhnet_socketlist.next;s != &lhnet_socketlist;s = s->next)
563                                 if (s->address.addresstype == lhnetsocket->address.addresstype && s->address.addressdata.loop.port == lhnetsocket->address.addressdata.loop.port)
564                                         break;
565                         if (s == &lhnet_socketlist && lhnetsocket->address.addressdata.loop.port != 0)
566                         {
567                                 lhnetsocket->next = &lhnet_socketlist;
568                                 lhnetsocket->prev = lhnetsocket->next->prev;
569                                 lhnetsocket->next->prev = lhnetsocket;
570                                 lhnetsocket->prev->next = lhnetsocket;
571                                 return lhnetsocket;
572                         }
573                         break;
574                 case LHNETADDRESSTYPE_INET4:
575                 case LHNETADDRESSTYPE_INET6:
576 #ifdef WIN32
577                         if (lhnet_didWSAStartup)
578                         {
579 #endif
580                                 if ((lhnetsocket->inetsocket = socket(address->addresstype == LHNETADDRESSTYPE_INET6 ? LHNETADDRESSTYPE_INET6_FAMILY : LHNETADDRESSTYPE_INET4_FAMILY, SOCK_DGRAM, IPPROTO_UDP)) != -1)
581                                 {
582 #ifdef WIN32
583                                         u_long _true = 1;
584                                         u_long _false = 0;
585 #else
586                                         char _true = 1;
587 #endif
588                                         if (ioctlsocket(lhnetsocket->inetsocket, FIONBIO, &_true) != -1)
589                                         {
590                                                 SOCKLEN_T namelen;
591                                                 namelen = address->addresstype == LHNETADDRESSTYPE_INET6 ? sizeof(lhnetsocket->address.addressdata.inet6) : sizeof(lhnetsocket->address.addressdata.inet4);
592                                                 if (bind(lhnetsocket->inetsocket, (struct sockaddr *)&lhnetsocket->address.addressdata, namelen) != -1)
593                                                 {
594                                                         int i = 1;
595                                                         getsockname(lhnetsocket->inetsocket, (struct sockaddr *)&lhnetsocket->address.addressdata, &namelen);
596                                                         // enable broadcast on this socket
597                                                         setsockopt(lhnetsocket->inetsocket, SOL_SOCKET, SO_BROADCAST, (char *)&i, sizeof(i));
598                                                         lhnetsocket->next = &lhnet_socketlist;
599                                                         lhnetsocket->prev = lhnetsocket->next->prev;
600                                                         lhnetsocket->next->prev = lhnetsocket;
601                                                         lhnetsocket->prev->next = lhnetsocket;
602 #ifdef WIN32
603                                                         if (ioctlsocket(lhnetsocket->inetsocket, SIO_UDP_CONNRESET, &_false) == -1)
604                                                                 Con_DPrintf("LHNET_OpenSocket_Connectionless: ioctlsocket SIO_UDP_CONNRESET returned error: %s\n", LHNETPRIVATE_StrError());
605 #endif
606                                                         return lhnetsocket;
607                                                 }
608                                                 else
609                                                         Con_Printf("LHNET_OpenSocket_Connectionless: bind returned error: %s\n", LHNETPRIVATE_StrError());
610                                         }
611                                         else
612                                                 Con_Printf("LHNET_OpenSocket_Connectionless: ioctlsocket returned error: %s\n", LHNETPRIVATE_StrError());
613                                         closesocket(lhnetsocket->inetsocket);
614                                 }
615                                 else
616                                         Con_Printf("LHNET_OpenSocket_Connectionless: socket returned error: %s\n", LHNETPRIVATE_StrError());
617 #ifdef WIN32
618                         }
619                         else
620                                 Con_Print("LHNET_OpenSocket_Connectionless: can't open a socket (WSAStartup failed during LHNET_Init)\n");
621 #endif
622                         break;
623                 default:
624                         break;
625                 }
626                 Z_Free(lhnetsocket);
627         }
628         return NULL;
629 }
630
631 void LHNET_CloseSocket(lhnetsocket_t *lhnetsocket)
632 {
633         if (lhnetsocket)
634         {
635                 // unlink from socket list
636                 if (lhnetsocket->next == NULL)
637                         return; // invalid!
638                 lhnetsocket->next->prev = lhnetsocket->prev;
639                 lhnetsocket->prev->next = lhnetsocket->next;
640                 lhnetsocket->next = NULL;
641                 lhnetsocket->prev = NULL;
642
643                 // no special close code for loopback, just inet
644                 if (lhnetsocket->address.addresstype == LHNETADDRESSTYPE_INET4 || lhnetsocket->address.addresstype == LHNETADDRESSTYPE_INET6)
645                 {
646                         closesocket(lhnetsocket->inetsocket);
647                 }
648                 Z_Free(lhnetsocket);
649         }
650 }
651
652 lhnetaddress_t *LHNET_AddressFromSocket(lhnetsocket_t *sock)
653 {
654         if (sock)
655                 return &sock->address;
656         else
657                 return NULL;
658 }
659
660 int LHNET_Read(lhnetsocket_t *lhnetsocket, void *content, int maxcontentlength, lhnetaddress_t *address)
661 {
662         int value = 0;
663         if (!lhnetsocket || !address || !content || maxcontentlength < 1)
664                 return -1;
665         if (lhnetsocket->address.addresstype == LHNETADDRESSTYPE_LOOP)
666         {
667                 time_t currenttime;
668                 lhnetpacket_t *p, *pnext;
669                 // scan for any old packets to timeout while searching for a packet
670                 // that is waiting to be delivered to this socket
671                 currenttime = time(NULL);
672                 for (p = lhnet_packetlist.next;p != &lhnet_packetlist;p = pnext)
673                 {
674                         pnext = p->next;
675                         if (p->timeout < currenttime)
676                         {
677                                 // unlink and free
678                                 p->next->prev = p->prev;
679                                 p->prev->next = p->next;
680                                 Z_Free(p);
681                                 continue;
682                         }
683 #ifndef STANDALONETEST
684                         if (cl_netlocalping.value && (realtime - cl_netlocalping.value * (1.0 / 2000.0)) < p->sentdoubletime)
685                                 continue;
686 #endif
687                         if (value == 0 && p->destinationport == lhnetsocket->address.addressdata.loop.port)
688                         {
689                                 if (p->length <= maxcontentlength)
690                                 {
691                                         *address = lhnetsocket->address;
692                                         address->addressdata.loop.port = p->sourceport;
693                                         memcpy(content, p->data, p->length);
694                                         value = p->length;
695                                 }
696                                 else
697                                         value = -1;
698                                 // unlink and free
699                                 p->next->prev = p->prev;
700                                 p->prev->next = p->next;
701                                 Z_Free(p);
702                         }
703                 }
704         }
705         else if (lhnetsocket->address.addresstype == LHNETADDRESSTYPE_INET4)
706         {
707                 unsigned int inetaddresslength;
708                 address->addresstype = LHNETADDRESSTYPE_NONE;
709                 inetaddresslength = sizeof(address->addressdata.inet4);
710                 value = recvfrom(lhnetsocket->inetsocket, content, maxcontentlength, 0, (struct sockaddr *)&address->addressdata.inet4, &inetaddresslength);
711                 if (value > 0)
712                 {
713                         address->addresstype = LHNETADDRESSTYPE_INET4;
714                         return value;
715                 }
716                 else if (value == -1)
717                 {
718                         int e = SOCKETERRNO;
719                         if (e == EWOULDBLOCK)
720                                 return 0;
721                         switch (e)
722                         {
723                                 case ECONNREFUSED:
724                                         Con_Print("Connection refused\n");
725                                         return 0;
726                         }
727                         Con_Printf("LHNET_Read: recvfrom returned error: %s\n", LHNETPRIVATE_StrError());
728                 }
729         }
730         else if (lhnetsocket->address.addresstype == LHNETADDRESSTYPE_INET6)
731         {
732                 unsigned int inetaddresslength;
733                 address->addresstype = LHNETADDRESSTYPE_NONE;
734                 inetaddresslength = sizeof(address->addressdata.inet6);
735                 value = recvfrom(lhnetsocket->inetsocket, content, maxcontentlength, 0, (struct sockaddr *)&address->addressdata.inet6, &inetaddresslength);
736                 if (value > 0)
737                 {
738                         address->addresstype = LHNETADDRESSTYPE_INET6;
739                         return value;
740                 }
741                 else if (value == -1)
742                 {
743                         int e = SOCKETERRNO;
744                         if (e == EWOULDBLOCK)
745                                 return 0;
746                         switch (e)
747                         {
748                                 case ECONNREFUSED:
749                                         Con_Print("Connection refused\n");
750                                         return 0;
751                         }
752                         Con_Printf("LHNET_Read: recvfrom returned error: %s\n", LHNETPRIVATE_StrError());
753                 }
754         }
755         return value;
756 }
757
758 int LHNET_Write(lhnetsocket_t *lhnetsocket, const void *content, int contentlength, const lhnetaddress_t *address)
759 {
760         int value = -1;
761         if (!lhnetsocket || !address || !content || contentlength < 1)
762                 return -1;
763         if (lhnetsocket->address.addresstype != address->addresstype)
764                 return -1;
765         if (lhnetsocket->address.addresstype == LHNETADDRESSTYPE_LOOP)
766         {
767                 lhnetpacket_t *p;
768                 p = (lhnetpacket_t *)Z_Malloc(sizeof(*p) + contentlength);
769                 p->data = (void *)(p + 1);
770                 memcpy(p->data, content, contentlength);
771                 p->length = contentlength;
772                 p->sourceport = lhnetsocket->address.addressdata.loop.port;
773                 p->destinationport = address->addressdata.loop.port;
774                 p->timeout = time(NULL) + 10;
775                 p->next = &lhnet_packetlist;
776                 p->prev = p->next->prev;
777                 p->next->prev = p;
778                 p->prev->next = p;
779 #ifndef STANDALONETEST
780                 p->sentdoubletime = realtime;
781 #endif
782                 value = contentlength;
783         }
784         else if (lhnetsocket->address.addresstype == LHNETADDRESSTYPE_INET4)
785         {
786                 value = sendto(lhnetsocket->inetsocket, content, contentlength, 0, (struct sockaddr *)&address->addressdata.inet4, sizeof(address->addressdata.inet4));
787                 if (value == -1)
788                 {
789                         if (SOCKETERRNO == EWOULDBLOCK)
790                                 return 0;
791                         Con_Printf("LHNET_Write: sendto returned error: %s\n", LHNETPRIVATE_StrError());
792                 }
793         }
794         else if (lhnetsocket->address.addresstype == LHNETADDRESSTYPE_INET6)
795         {
796                 value = sendto(lhnetsocket->inetsocket, content, contentlength, 0, (struct sockaddr *)&address->addressdata.inet6, sizeof(address->addressdata.inet6));
797                 if (value == -1)
798                 {
799                         if (SOCKETERRNO == EWOULDBLOCK)
800                                 return 0;
801                         Con_Printf("LHNET_Write: sendto returned error: %s\n", LHNETPRIVATE_StrError());
802                 }
803         }
804         return value;
805 }
806
807 #ifdef STANDALONETEST
808 int main(int argc, char **argv)
809 {
810 #if 1
811         char *buffer = "test", buffer2[1024];
812         int blen = strlen(buffer);
813         int b2len = 1024;
814         lhnetsocket_t *sock1;
815         lhnetsocket_t *sock2;
816         lhnetaddress_t myaddy1;
817         lhnetaddress_t myaddy2;
818         lhnetaddress_t myaddy3;
819         lhnetaddress_t localhostaddy1;
820         lhnetaddress_t localhostaddy2;
821         int test1;
822         int test2;
823
824         printf("calling LHNET_Init\n");
825         LHNET_Init();
826
827         printf("calling LHNET_FromPort twice to create two local addresses\n");
828         LHNETADDRESS_FromPort(&myaddy1, LHNETADDRESSTYPE_INET4, 4000);
829         LHNETADDRESS_FromPort(&myaddy2, LHNETADDRESSTYPE_INET4, 4001);
830         LHNETADDRESS_FromString(&localhostaddy1, "127.0.0.1", 4000);
831         LHNETADDRESS_FromString(&localhostaddy2, "127.0.0.1", 4001);
832
833         printf("calling LHNET_OpenSocket_Connectionless twice to create two local sockets\n");
834         sock1 = LHNET_OpenSocket_Connectionless(&myaddy1);
835         sock2 = LHNET_OpenSocket_Connectionless(&myaddy2);
836
837         printf("calling LHNET_Write to send a packet from the first socket to the second socket\n");
838         test1 = LHNET_Write(sock1, buffer, blen, &localhostaddy2);
839         printf("sleeping briefly\n");
840 #ifdef WIN32
841         Sleep (100);
842 #else
843         usleep (100000);
844 #endif
845         printf("calling LHNET_Read on the second socket to read the packet sent from the first socket\n");
846         test2 = LHNET_Read(sock2, buffer2, b2len - 1, &myaddy3);
847         if (test2 > 0)
848                 Con_Printf("socket to socket test succeeded\n");
849         else
850                 Con_Printf("socket to socket test failed\n");
851
852 #ifdef WIN32
853         printf("press any key to exit\n");
854         getchar();
855 #endif
856
857         printf("calling LHNET_Shutdown\n");
858         LHNET_Shutdown();
859         printf("exiting\n");
860         return 0;
861 #else
862         lhnetsocket_t *sock[16], *sendsock;
863         int i;
864         int numsockets;
865         int count;
866         int length;
867         int port;
868         time_t oldtime;
869         time_t newtime;
870         char *sendmessage;
871         int sendmessagelength;
872         lhnetaddress_t destaddress;
873         lhnetaddress_t receiveaddress;
874         lhnetaddress_t sockaddress[16];
875         char buffer[1536], addressstring[128], addressstring2[128];
876         if ((argc == 2 || argc == 5) && (port = atoi(argv[1])) >= 1 && port < 65535)
877         {
878                 printf("calling LHNET_Init()\n");
879                 LHNET_Init();
880
881                 numsockets = 0;
882                 LHNETADDRESS_FromPort(&sockaddress[numsockets++], LHNETADDRESSTYPE_LOOP, port);
883                 LHNETADDRESS_FromPort(&sockaddress[numsockets++], LHNETADDRESSTYPE_INET4, port);
884                 LHNETADDRESS_FromPort(&sockaddress[numsockets++], LHNETADDRESSTYPE_INET6, port+1);
885
886                 sendsock = NULL;
887                 sendmessage = NULL;
888                 sendmessagelength = 0;
889
890                 for (i = 0;i < numsockets;i++)
891                 {
892                         LHNETADDRESS_ToString(&sockaddress[i], addressstring, sizeof(addressstring), 1);
893                         printf("calling LHNET_OpenSocket_Connectionless(<%s>)\n", addressstring);
894                         if ((sock[i] = LHNET_OpenSocket_Connectionless(&sockaddress[i])))
895                         {
896                                 LHNETADDRESS_ToString(LHNET_AddressFromSocket(sock[i]), addressstring2, sizeof(addressstring2), 1);
897                                 printf("opened socket successfully (address \"%s\")\n", addressstring2);
898                         }
899                         else
900                         {
901                                 printf("failed to open socket\n");
902                                 if (i == 0)
903                                 {
904                                         LHNET_Shutdown();
905                                         return -1;
906                                 }
907                         }
908                 }
909                 count = 0;
910                 if (argc == 5)
911                 {
912                         count = atoi(argv[2]);
913                         if (LHNETADDRESS_FromString(&destaddress, argv[3], -1))
914                         {
915                                 sendmessage = argv[4];
916                                 sendmessagelength = strlen(sendmessage);
917                                 sendsock = NULL;
918                                 for (i = 0;i < numsockets;i++)
919                                         if (sock[i] && LHNETADDRESS_GetAddressType(&destaddress) == LHNETADDRESS_GetAddressType(&sockaddress[i]))
920                                                 sendsock = sock[i];
921                                 if (sendsock == NULL)
922                                 {
923                                         printf("Could not find an open socket matching the addresstype (%i) of destination address, switching to listen only mode\n", LHNETADDRESS_GetAddressType(&destaddress));
924                                         argc = 2;
925                                 }
926                         }
927                         else
928                         {
929                                 printf("LHNETADDRESS_FromString did not like the address \"%s\", switching to listen only mode\n", argv[3]);
930                                 argc = 2;
931                         }
932                 }
933                 printf("started, now listening for \"exit\" on the opened sockets\n");
934                 oldtime = time(NULL);
935                 for(;;)
936                 {
937 #ifdef WIN32
938                         Sleep(1);
939 #else
940                         usleep(1);
941 #endif
942                         for (i = 0;i < numsockets;i++)
943                         {
944                                 if (sock[i])
945                                 {
946                                         length = LHNET_Read(sock[i], buffer, sizeof(buffer), &receiveaddress);
947                                         if (length < 0)
948                                                 printf("localsock read error: length < 0");
949                                         else if (length > 0 && length < (int)sizeof(buffer))
950                                         {
951                                                 buffer[length] = 0;
952                                                 LHNETADDRESS_ToString(&receiveaddress, addressstring, sizeof(addressstring), 1);
953                                                 LHNETADDRESS_ToString(LHNET_AddressFromSocket(sock[i]), addressstring2, sizeof(addressstring2), 1);
954                                                 printf("received message \"%s\" from \"%s\" on socket \"%s\"\n", buffer, addressstring, addressstring2);
955                                                 if (!strcmp(buffer, "exit"))
956                                                         break;
957                                         }
958                                 }
959                         }
960                         if (i < numsockets)
961                                 break;
962                         if (argc == 5 && count > 0)
963                         {
964                                 newtime = time(NULL);
965                                 if (newtime != oldtime)
966                                 {
967                                         LHNETADDRESS_ToString(&destaddress, addressstring, sizeof(addressstring), 1);
968                                         LHNETADDRESS_ToString(LHNET_AddressFromSocket(sendsock), addressstring2, sizeof(addressstring2), 1);
969                                         printf("calling LHNET_Write(<%s>, \"%s\", %i, <%s>)\n", addressstring2, sendmessage, sendmessagelength, addressstring);
970                                         length = LHNET_Write(sendsock, sendmessage, sendmessagelength, &destaddress);
971                                         if (length == sendmessagelength)
972                                                 printf("sent successfully\n");
973                                         else
974                                                 printf("LH_Write failed, returned %i (length of message was %i)\n", length, strlen(argv[4]));
975                                         oldtime = newtime;
976                                         count--;
977                                         if (count <= 0)
978                                                 printf("Done sending, still listening for \"exit\"\n");
979                                 }
980                         }
981                 }
982                 for (i = 0;i < numsockets;i++)
983                 {
984                         if (sock[i])
985                         {
986                                 LHNETADDRESS_ToString(LHNET_AddressFromSocket(sock[i]), addressstring2, sizeof(addressstring2), 1);
987                                 printf("calling LHNET_CloseSocket(<%s>)\n", addressstring2);
988                                 LHNET_CloseSocket(sock[i]);
989                         }
990                 }
991                 printf("calling LHNET_Shutdown()\n");
992                 LHNET_Shutdown();
993                 return 0;
994         }
995         printf("Testing code for lhnet.c\nusage: lhnettest <localportnumber> [<sendnumberoftimes> <sendaddress:port> <sendmessage>]\n");
996         return -1;
997 #endif
998 }
999 #endif
1000