3 Copyright (C) 2013 celeron55, Perttu Ahola <celeron55@gmail.com>
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU Lesser General Public License as published by
7 the Free Software Foundation; either version 2.1 of the License, or
8 (at your option) any later version.
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU Lesser General Public License for more details.
15 You should have received a copy of the GNU Lesser General Public License along
16 with this program; if not, write to the Free Software Foundation, Inc.,
17 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
23 #ifndef WIN32_LEAN_AND_MEAN
24 #define WIN32_LEAN_AND_MEAN
26 // Without this some of the network functions are not found on mingw
28 #define _WIN32_WINNT 0x0501
34 #pragma comment(lib, "ws2_32.lib")
36 typedef SOCKET socket_t;
37 typedef int socklen_t;
39 #include <sys/types.h>
40 #include <sys/socket.h>
41 #include <netinet/in.h>
45 #include <arpa/inet.h>
49 #include "constants.h"
52 #include "main.h" // for g_settings
59 #include "util/string.h"
60 #include "util/numeric.h"
62 // Set to true to enable verbose debug output
63 bool socket_enable_debug_output = false;
65 bool g_sockets_initialized = false;
71 // Windows needs sockets to be initialized before use
73 if(WSAStartup( MAKEWORD(2,2), &WsaData ) != NO_ERROR)
74 throw SocketException("WSAStartup failed");
76 g_sockets_initialized = true;
79 void sockets_cleanup()
82 // On Windows, cleanup sockets after use
94 memset(&m_address, 0, sizeof m_address);
98 Address::Address(u32 address, u16 port)
104 Address::Address(u8 a, u8 b, u8 c, u8 d, u16 port)
106 setAddress(a, b, c, d);
110 Address::Address(const IPv6AddressBytes * ipv6_bytes, u16 port)
112 setAddress(ipv6_bytes);
116 // Equality (address family, address and port must be equal)
117 bool Address::operator==(Address &address)
119 if(address.m_addr_family != m_addr_family || address.m_port != m_port)
121 else if(m_addr_family == AF_INET)
123 return m_address.ipv4.sin_addr.s_addr ==
124 address.m_address.ipv4.sin_addr.s_addr;
126 else if(m_addr_family == AF_INET6)
128 return memcmp(m_address.ipv6.sin6_addr.s6_addr,
129 address.m_address.ipv6.sin6_addr.s6_addr, 16) == 0;
135 bool Address::operator!=(Address &address)
137 return !(*this == address);
140 void Address::Resolve(const char *name)
142 struct addrinfo *resolved, hints;
143 memset(&hints, 0, sizeof(hints));
146 hints.ai_socktype = 0;
147 hints.ai_protocol = 0;
149 if(g_settings->getBool("enable_ipv6"))
151 // AF_UNSPEC allows both IPv6 and IPv4 addresses to be returned
152 hints.ai_family = AF_UNSPEC;
156 hints.ai_family = AF_INET;
160 int e = getaddrinfo(name, NULL, &hints, &resolved);
162 throw ResolveError(gai_strerror(e));
165 if(resolved->ai_family == AF_INET)
167 struct sockaddr_in *t = (struct sockaddr_in *) resolved->ai_addr;
168 m_addr_family = AF_INET;
171 else if(resolved->ai_family == AF_INET6)
173 struct sockaddr_in6 *t = (struct sockaddr_in6 *) resolved->ai_addr;
174 m_addr_family = AF_INET6;
179 freeaddrinfo(resolved);
180 throw ResolveError("");
182 freeaddrinfo(resolved);
185 // IP address -> textual representation
186 std::string Address::serializeString() const
188 char str[INET6_ADDRSTRLEN];
189 if (inet_ntop(m_addr_family, (m_addr_family == AF_INET) ? (void*)&(m_address.ipv4.sin_addr) : (void*)&(m_address.ipv6.sin6_addr), str, INET6_ADDRSTRLEN) == NULL) {
190 return std::string("");
192 return std::string(str);
195 struct sockaddr_in Address::getAddress() const
197 return m_address.ipv4; // NOTE: NO PORT INCLUDED, use getPort()
200 struct sockaddr_in6 Address::getAddress6() const
202 return m_address.ipv6; // NOTE: NO PORT INCLUDED, use getPort()
205 u16 Address::getPort() const
210 int Address::getFamily() const
212 return m_addr_family;
215 bool Address::isIPv6() const
217 return m_addr_family == AF_INET6;
220 void Address::setAddress(u32 address)
222 m_addr_family = AF_INET;
223 m_address.ipv4.sin_family = AF_INET;
224 m_address.ipv4.sin_addr.s_addr = htonl(address);
227 void Address::setAddress(u8 a, u8 b, u8 c, u8 d)
229 m_addr_family = AF_INET;
230 m_address.ipv4.sin_family = AF_INET;
231 u32 addr = htonl((a << 24) | (b << 16) | (c << 8) | d);
232 m_address.ipv4.sin_addr.s_addr = addr;
235 void Address::setAddress(const IPv6AddressBytes * ipv6_bytes)
237 m_addr_family = AF_INET6;
238 m_address.ipv6.sin6_family = AF_INET6;
240 memcpy(m_address.ipv6.sin6_addr.s6_addr, ipv6_bytes->bytes, 16);
242 memset(m_address.ipv6.sin6_addr.s6_addr, 0, 16);
245 void Address::setPort(u16 port)
250 void Address::print(std::ostream *s) const
252 if(m_addr_family == AF_INET6)
254 (*s) << "[" << serializeString() << "]:" << m_port;
258 (*s) << serializeString() << ":" << m_port;
266 UDPSocket::UDPSocket(bool ipv6)
268 if(g_sockets_initialized == false)
269 throw SocketException("Sockets not initialized");
271 // Use IPv6 if specified
272 m_addr_family = ipv6 ? AF_INET6 : AF_INET;
273 m_handle = socket(m_addr_family, SOCK_DGRAM, IPPROTO_UDP);
275 if(socket_enable_debug_output)
277 dstream << "UDPSocket(" << (int) m_handle
278 << ")::UDPSocket(): ipv6 = "
279 << (ipv6 ? "true" : "false")
285 throw SocketException("Failed to create socket");
291 UDPSocket::~UDPSocket()
293 if(socket_enable_debug_output)
295 dstream << "UDPSocket( " << (int) m_handle << ")::~UDPSocket()"
300 closesocket(m_handle);
306 void UDPSocket::Bind(u16 port)
308 if(socket_enable_debug_output)
310 dstream << "UDPSocket(" << (int) m_handle << ")::Bind(): "
311 << "port=" << port << std::endl;
314 if(m_addr_family == AF_INET6)
316 struct sockaddr_in6 address;
317 address.sin6_family = AF_INET6;
318 address.sin6_addr = in6addr_any;
319 address.sin6_port = htons(port);
321 if(bind(m_handle, (const struct sockaddr *) &address,
322 sizeof(struct sockaddr_in6)) < 0)
324 dstream << (int) m_handle << ": Bind failed: "
325 << strerror(errno) << std::endl;
326 throw SocketException("Failed to bind socket");
331 struct sockaddr_in address;
332 address.sin_family = AF_INET;
333 address.sin_addr.s_addr = INADDR_ANY;
334 address.sin_port = htons(port);
336 if(bind(m_handle, (const struct sockaddr *) &address,
337 sizeof(struct sockaddr_in)) < 0)
339 dstream << (int) m_handle << ": Bind failed: "
340 << strerror(errno) << std::endl;
341 throw SocketException("Failed to bind socket");
346 void UDPSocket::Send(const Address & destination, const void * data, int size)
348 bool dumping_packet = false; // for INTERNET_SIMULATOR
350 if(INTERNET_SIMULATOR)
351 dumping_packet = (myrand() % INTERNET_SIMULATOR_PACKET_LOSS == 0);
353 if(socket_enable_debug_output)
355 // Print packet destination and size
356 dstream << (int) m_handle << " -> ";
357 destination.print(&dstream);
358 dstream << ", size=" << size;
360 // Print packet contents
361 dstream << ", data=";
362 for(int i = 0; i < size && i < 20; i++)
366 unsigned int a = ((const unsigned char *) data)[i];
367 DEBUGPRINT("%.2X", a);
374 dstream << " (DUMPED BY INTERNET_SIMULATOR)";
376 dstream << std::endl;
381 // Lol let's forget it
382 dstream << "UDPSocket::Send(): "
383 "INTERNET_SIMULATOR: dumping packet."
388 if(destination.getFamily() != m_addr_family)
389 throw SendFailedException("Address family mismatch");
392 if(m_addr_family == AF_INET6)
394 struct sockaddr_in6 address = destination.getAddress6();
395 address.sin6_port = htons(destination.getPort());
396 sent = sendto(m_handle, (const char *) data, size,
397 0, (struct sockaddr *) &address, sizeof(struct sockaddr_in6));
401 struct sockaddr_in address = destination.getAddress();
402 address.sin_port = htons(destination.getPort());
403 sent = sendto(m_handle, (const char *) data, size,
404 0, (struct sockaddr *) &address, sizeof(struct sockaddr_in));
409 throw SendFailedException("Failed to send packet");
413 int UDPSocket::Receive(Address & sender, void * data, int size)
416 if(WaitData(m_timeout_ms) == false)
422 if(m_addr_family == AF_INET6)
424 struct sockaddr_in6 address;
425 socklen_t address_len = sizeof(address);
427 received = recvfrom(m_handle, (char *) data,
428 size, 0, (struct sockaddr *) &address, &address_len);
433 u16 address_port = ntohs(address.sin6_port);
434 IPv6AddressBytes bytes;
435 memcpy(bytes.bytes, address.sin6_addr.s6_addr, 16);
436 sender = Address(&bytes, address_port);
440 struct sockaddr_in address;
441 socklen_t address_len = sizeof(address);
443 received = recvfrom(m_handle, (char *) data,
444 size, 0, (struct sockaddr *) &address, &address_len);
449 u32 address_ip = ntohl(address.sin_addr.s_addr);
450 u16 address_port = ntohs(address.sin_port);
452 sender = Address(address_ip, address_port);
455 if(socket_enable_debug_output)
457 // Print packet sender and size
458 dstream << (int) m_handle << " <- ";
459 sender.print(&dstream);
460 dstream << ", size=" << received;
462 // Print packet contents
463 dstream << ", data=";
464 for(int i = 0; i < received && i < 20; i++)
468 unsigned int a = ((const unsigned char *) data)[i];
469 DEBUGPRINT("%.2X", a);
474 dstream << std::endl;
480 int UDPSocket::GetHandle()
485 void UDPSocket::setTimeoutMs(int timeout_ms)
487 m_timeout_ms = timeout_ms;
490 bool UDPSocket::WaitData(int timeout_ms)
495 // Initialize the set
497 FD_SET(m_handle, &readset);
499 // Initialize time out struct
502 tv.tv_usec = timeout_ms * 1000;
505 result = select(m_handle+1, &readset, NULL, NULL, &tv);
509 else if(result < 0 && errno == EINTR)
513 dstream << (int) m_handle << ": Select failed: "
514 << strerror(errno) << std::endl;
517 int e = WSAGetLastError();
518 dstream << (int) m_handle << ": WSAGetLastError()="
520 if(e == 10004 /* = WSAEINTR */)
522 dstream << "WARNING: Ignoring WSAEINTR." << std::endl;
527 throw SocketException("Select failed");
529 else if(FD_ISSET(m_handle, &readset) == false)