socket_helpers.h 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106
  1. #ifndef SOCKET_HELPERS_H
  2. #define SOCKET_HELPERS_H
  3. #include <string.h>
  4. #if defined(__MINGW32__ ) && (!defined(__MINGW64_VERSION_MAJOR) || __MINGW64_VERSION_MAJOR < 4)
  5. // Workaround for mingw-w64 < 4.0
  6. #ifndef IPV6_V6ONLY
  7. #define IPV6_V6ONLY 27
  8. #endif
  9. #endif
  10. // helpers for sockaddr -> IP_Address and back, should work for posix and winsock. All implementations should use this
  11. static size_t _set_sockaddr(struct sockaddr_storage* p_addr, const IP_Address& p_ip, int p_port, IP::Type p_sock_type = IP::TYPE_ANY) {
  12. memset(p_addr, 0, sizeof(struct sockaddr_storage));
  13. ERR_FAIL_COND_V(p_ip==IP_Address(),0);
  14. // IPv6 socket
  15. if (p_sock_type == IP::TYPE_IPV6 || p_sock_type == IP::TYPE_ANY) {
  16. // IPv6 only socket with IPv4 address
  17. ERR_FAIL_COND_V(p_sock_type == IP::TYPE_IPV6 && p_ip.is_ipv4(),0);
  18. struct sockaddr_in6* addr6 = (struct sockaddr_in6*)p_addr;
  19. addr6->sin6_family = AF_INET6;
  20. addr6->sin6_port = htons(p_port);
  21. copymem(&addr6->sin6_addr.s6_addr, p_ip.get_ipv6(), 16);
  22. return sizeof(sockaddr_in6);
  23. } else { // IPv4 socket
  24. // IPv4 socket with IPv6 address
  25. ERR_FAIL_COND_V(!p_ip.is_ipv4(),0);
  26. uint32_t ipv4 = *((uint32_t *)p_ip.get_ipv4());
  27. struct sockaddr_in* addr4 = (struct sockaddr_in*)p_addr;
  28. addr4->sin_family = AF_INET;
  29. addr4->sin_port = htons(p_port); // short, network byte order
  30. copymem(&addr4->sin_addr.s_addr, p_ip.get_ipv4(), 16);
  31. return sizeof(sockaddr_in);
  32. };
  33. };
  34. static size_t _set_listen_sockaddr(struct sockaddr_storage* p_addr, int p_port, IP::Type p_sock_type, const List<String> *p_accepted_hosts) {
  35. memset(p_addr, 0, sizeof(struct sockaddr_storage));
  36. if (p_sock_type == IP::TYPE_IPV4) {
  37. struct sockaddr_in* addr4 = (struct sockaddr_in*)p_addr;
  38. addr4->sin_family = AF_INET;
  39. addr4->sin_port = htons(p_port);
  40. addr4->sin_addr.s_addr = INADDR_ANY; // TODO: use accepted hosts list
  41. return sizeof(sockaddr_in);
  42. } else {
  43. struct sockaddr_in6* addr6 = (struct sockaddr_in6*)p_addr;
  44. addr6->sin6_family = AF_INET6;
  45. addr6->sin6_port = htons(p_port);
  46. addr6->sin6_addr = in6addr_any; // TODO: use accepted hosts list
  47. return sizeof(sockaddr_in6);
  48. };
  49. };
  50. static int _socket_create(IP::Type p_type, int type, int protocol) {
  51. ERR_FAIL_COND_V(p_type > IP::TYPE_ANY || p_type < IP::TYPE_NONE, ERR_INVALID_PARAMETER);
  52. int family = p_type == IP::TYPE_IPV4 ? AF_INET : AF_INET6;
  53. int sockfd = socket(family, type, protocol);
  54. ERR_FAIL_COND_V( sockfd == -1, -1 );
  55. if(family == AF_INET6) {
  56. // Select IPv4 over IPv6 mapping
  57. int opt = p_type != IP::TYPE_ANY;
  58. if(setsockopt(sockfd, IPPROTO_IPV6, IPV6_V6ONLY, (const char*)&opt, sizeof(opt)) != 0) {
  59. WARN_PRINT("Unable to set/unset IPv4 address mapping over IPv6");
  60. }
  61. }
  62. return sockfd;
  63. }
  64. static void _set_ip_addr_port(IP_Address& r_ip, int& r_port, struct sockaddr_storage* p_addr) {
  65. if (p_addr->ss_family == AF_INET) {
  66. struct sockaddr_in* addr4 = (struct sockaddr_in*)p_addr;
  67. r_ip.set_ipv4((uint8_t *)&(addr4->sin_addr.s_addr));
  68. r_port = ntohs(addr4->sin_port);
  69. } else if (p_addr->ss_family == AF_INET6) {
  70. struct sockaddr_in6* addr6 = (struct sockaddr_in6*)p_addr;
  71. r_ip.set_ipv6(addr6->sin6_addr.s6_addr);
  72. r_port = ntohs(addr6->sin6_port);
  73. };
  74. };
  75. #endif