InetAddress.cpp 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571
  1. /*
  2. * Copyright (c)2013-2020 ZeroTier, Inc.
  3. *
  4. * Use of this software is governed by the Business Source License included
  5. * in the LICENSE.TXT file in the project's root directory.
  6. *
  7. * Change Date: 2024-01-01
  8. *
  9. * On the date above, in accordance with the Business Source License, use
  10. * of this software will be governed by version 2.0 of the Apache License.
  11. */
  12. /****/
  13. #include <cstring>
  14. #include <cstdint>
  15. #include "Constants.hpp"
  16. #include "InetAddress.hpp"
  17. #include "Utils.hpp"
  18. namespace ZeroTier {
  19. const InetAddress InetAddress::LO4((const void *)("\x7f\x00\x00\x01"),4,0);
  20. const InetAddress InetAddress::LO6((const void *)("\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x01"),16,0);
  21. const InetAddress InetAddress::NIL;
  22. InetAddress::IpScope InetAddress::ipScope() const noexcept
  23. {
  24. switch(_data.ss_family) {
  25. case AF_INET: {
  26. const uint32_t ip = Utils::ntoh((uint32_t)reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr);
  27. switch(ip >> 24U) {
  28. case 0x00: return IP_SCOPE_NONE; // 0.0.0.0/8 (reserved, never used)
  29. case 0x06: return IP_SCOPE_PSEUDOPRIVATE; // 6.0.0.0/8 (US Army)
  30. case 0x0a: return IP_SCOPE_PRIVATE; // 10.0.0.0/8
  31. case 0x0b: //return IP_SCOPE_PSEUDOPRIVATE; // 11.0.0.0/8 (US DoD)
  32. case 0x15: //return IP_SCOPE_PSEUDOPRIVATE; // 21.0.0.0/8 (US DDN-RVN)
  33. case 0x16: //return IP_SCOPE_PSEUDOPRIVATE; // 22.0.0.0/8 (US DISA)
  34. case 0x19: //return IP_SCOPE_PSEUDOPRIVATE; // 25.0.0.0/8 (UK Ministry of Defense)
  35. case 0x1a: //return IP_SCOPE_PSEUDOPRIVATE; // 26.0.0.0/8 (US DISA)
  36. case 0x1c: //return IP_SCOPE_PSEUDOPRIVATE; // 28.0.0.0/8 (US DSI-North)
  37. case 0x1d: //return IP_SCOPE_PSEUDOPRIVATE; // 29.0.0.0/8 (US DISA)
  38. case 0x1e: //return IP_SCOPE_PSEUDOPRIVATE; // 30.0.0.0/8 (US DISA)
  39. case 0x33: //return IP_SCOPE_PSEUDOPRIVATE; // 51.0.0.0/8 (UK Department of Social Security)
  40. case 0x37: //return IP_SCOPE_PSEUDOPRIVATE; // 55.0.0.0/8 (US DoD)
  41. case 0x38: return IP_SCOPE_PSEUDOPRIVATE; // 56.0.0.0/8 (US Postal Service)
  42. case 0x64:
  43. if ((ip & 0xffc00000) == 0x64400000) return IP_SCOPE_PRIVATE; // 100.64.0.0/10
  44. break;
  45. case 0x7f: return IP_SCOPE_LOOPBACK; // 127.0.0.0/8
  46. case 0xa9:
  47. if ((ip & 0xffff0000) == 0xa9fe0000) return IP_SCOPE_LINK_LOCAL; // 169.254.0.0/16
  48. break;
  49. case 0xac:
  50. if ((ip & 0xfff00000) == 0xac100000) return IP_SCOPE_PRIVATE; // 172.16.0.0/12
  51. break;
  52. case 0xc0:
  53. if ((ip & 0xffff0000) == 0xc0a80000) return IP_SCOPE_PRIVATE; // 192.168.0.0/16
  54. break;
  55. case 0xff: return IP_SCOPE_NONE; // 255.0.0.0/8 (broadcast, or unused/unusable)
  56. }
  57. switch(ip >> 28) {
  58. case 0xe: return IP_SCOPE_MULTICAST; // 224.0.0.0/4
  59. case 0xf: return IP_SCOPE_PSEUDOPRIVATE; // 240.0.0.0/4 ("reserved," usually unusable)
  60. }
  61. return IP_SCOPE_GLOBAL;
  62. } break;
  63. case AF_INET6: {
  64. const unsigned char *ip = reinterpret_cast<const unsigned char *>(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  65. if ((ip[0] & 0xf0U) == 0xf0) {
  66. if (ip[0] == 0xff) return IP_SCOPE_MULTICAST; // ff00::/8
  67. if ((ip[0] == 0xfe)&&((ip[1] & 0xc0U) == 0x80)) {
  68. unsigned int k = 2;
  69. while ((!ip[k])&&(k < 15)) ++k;
  70. if ((k == 15)&&(ip[15] == 0x01))
  71. return IP_SCOPE_LOOPBACK; // fe80::1/128
  72. else return IP_SCOPE_LINK_LOCAL; // fe80::/10
  73. }
  74. if ((ip[0] & 0xfeU) == 0xfc) return IP_SCOPE_PRIVATE; // fc00::/7
  75. }
  76. unsigned int k = 0;
  77. while ((!ip[k])&&(k < 15)) ++k;
  78. if (k == 15) { // all 0's except last byte
  79. if (ip[15] == 0x01) return IP_SCOPE_LOOPBACK; // ::1/128
  80. if (ip[15] == 0x00) return IP_SCOPE_NONE; // ::/128
  81. }
  82. return IP_SCOPE_GLOBAL;
  83. } break;
  84. }
  85. return IP_SCOPE_NONE;
  86. }
  87. void InetAddress::set(const void *ipBytes,unsigned int ipLen,unsigned int port) noexcept
  88. {
  89. memoryZero(this);
  90. if (ipLen == 4) {
  91. uint32_t ipb[1];
  92. Utils::copy<4>(ipb,ipBytes);
  93. _data.ss_family = AF_INET;
  94. reinterpret_cast<struct sockaddr_in *>(this)->sin_addr.s_addr = ipb[0];
  95. reinterpret_cast<struct sockaddr_in *>(this)->sin_port = Utils::hton((uint16_t)port);
  96. } else if (ipLen == 16) {
  97. _data.ss_family = AF_INET6;
  98. Utils::copy<16>(reinterpret_cast<struct sockaddr_in6 *>(this)->sin6_addr.s6_addr,ipBytes);
  99. reinterpret_cast<struct sockaddr_in6 *>(this)->sin6_port = Utils::hton((uint16_t)port);
  100. }
  101. }
  102. bool InetAddress::isDefaultRoute() const noexcept
  103. {
  104. switch(_data.ss_family) {
  105. case AF_INET:
  106. return ( (reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr == 0) && (reinterpret_cast<const struct sockaddr_in *>(this)->sin_port == 0) );
  107. case AF_INET6:
  108. const uint8_t *ipb = reinterpret_cast<const uint8_t *>(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  109. for(int i=0;i<16;++i) {
  110. if (ipb[i])
  111. return false;
  112. }
  113. return (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port == 0);
  114. }
  115. return false;
  116. }
  117. char *InetAddress::toString(char buf[ZT_INETADDRESS_STRING_SIZE_MAX]) const noexcept
  118. {
  119. char *p = toIpString(buf);
  120. if (*p) {
  121. while (*p) ++p;
  122. *(p++) = '/';
  123. Utils::decimal(port(),p);
  124. }
  125. return buf;
  126. }
  127. char *InetAddress::toIpString(char buf[ZT_INETADDRESS_STRING_SIZE_MAX]) const noexcept
  128. {
  129. buf[0] = (char)0;
  130. switch(_data.ss_family) {
  131. case AF_INET: {
  132. #ifdef _WIN32
  133. inet_ntop(AF_INET, (void*)&reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr, buf, INET_ADDRSTRLEN);
  134. #else
  135. inet_ntop(AF_INET, &reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr, buf, INET_ADDRSTRLEN);
  136. #endif
  137. } break;
  138. case AF_INET6: {
  139. #ifdef _WIN32
  140. inet_ntop(AF_INET6, (void*)reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr, buf, INET6_ADDRSTRLEN);
  141. #else
  142. inet_ntop(AF_INET6, reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr, buf, INET6_ADDRSTRLEN);
  143. #endif
  144. } break;
  145. }
  146. return buf;
  147. }
  148. bool InetAddress::fromString(const char *ipSlashPort) noexcept
  149. {
  150. char buf[64];
  151. memoryZero(this);
  152. if (!*ipSlashPort)
  153. return true;
  154. if (!Utils::scopy(buf,sizeof(buf),ipSlashPort))
  155. return false;
  156. char *portAt = buf;
  157. while ((*portAt)&&(*portAt != '/'))
  158. ++portAt;
  159. unsigned int port = 0;
  160. if (*portAt) {
  161. *(portAt++) = (char)0;
  162. port = Utils::strToUInt(portAt) & 0xffffU;
  163. }
  164. if (strchr(buf,':')) {
  165. struct sockaddr_in6 *const in6 = reinterpret_cast<struct sockaddr_in6 *>(this); // NOLINT(hicpp-use-auto,modernize-use-auto)
  166. inet_pton(AF_INET6, buf, &in6->sin6_addr.s6_addr);
  167. in6->sin6_family = AF_INET6;
  168. in6->sin6_port = Utils::hton((uint16_t)port);
  169. return true;
  170. } else if (strchr(buf,'.')) {
  171. struct sockaddr_in *const in = reinterpret_cast<struct sockaddr_in *>(this); // NOLINT(hicpp-use-auto,modernize-use-auto)
  172. inet_pton(AF_INET, buf, &in->sin_addr.s_addr);
  173. in->sin_family = AF_INET;
  174. in->sin_port = Utils::hton((uint16_t)port);
  175. return true;
  176. }
  177. return false;
  178. }
  179. InetAddress InetAddress::netmask() const noexcept
  180. {
  181. InetAddress r(*this);
  182. switch(r._data.ss_family) {
  183. case AF_INET:
  184. reinterpret_cast<struct sockaddr_in *>(&r)->sin_addr.s_addr = Utils::hton((uint32_t)(0xffffffffU << (32 - netmaskBits())));
  185. break;
  186. case AF_INET6: {
  187. uint64_t nm[2];
  188. const unsigned int bits = netmaskBits();
  189. if(bits) {
  190. nm[0] = Utils::hton((uint64_t)((bits >= 64) ? 0xffffffffffffffffULL : (0xffffffffffffffffULL << (64 - bits))));
  191. nm[1] = Utils::hton((uint64_t)((bits <= 64) ? 0ULL : (0xffffffffffffffffULL << (128 - bits))));
  192. } else {
  193. nm[0] = 0;
  194. nm[1] = 0;
  195. }
  196. Utils::copy<16>(reinterpret_cast<struct sockaddr_in6 *>(&r)->sin6_addr.s6_addr,nm);
  197. } break;
  198. }
  199. return r;
  200. }
  201. InetAddress InetAddress::broadcast() const noexcept
  202. {
  203. if (_data.ss_family == AF_INET) {
  204. InetAddress r(*this);
  205. reinterpret_cast<struct sockaddr_in *>(&r)->sin_addr.s_addr |= Utils::hton((uint32_t)(0xffffffffU >> netmaskBits()));
  206. return r;
  207. }
  208. return InetAddress();
  209. }
  210. InetAddress InetAddress::network() const noexcept
  211. {
  212. InetAddress r(*this);
  213. switch(r._data.ss_family) {
  214. case AF_INET:
  215. reinterpret_cast<struct sockaddr_in *>(&r)->sin_addr.s_addr &= Utils::hton((uint32_t)(0xffffffffU << (32 - netmaskBits())));
  216. break;
  217. case AF_INET6: {
  218. uint64_t nm[2];
  219. const unsigned int bits = netmaskBits();
  220. Utils::copy<16>(nm,reinterpret_cast<struct sockaddr_in6 *>(&r)->sin6_addr.s6_addr);
  221. nm[0] &= Utils::hton((uint64_t)((bits >= 64) ? 0xffffffffffffffffULL : (0xffffffffffffffffULL << (64 - bits))));
  222. nm[1] &= Utils::hton((uint64_t)((bits <= 64) ? 0ULL : (0xffffffffffffffffULL << (128 - bits))));
  223. Utils::copy<16>(reinterpret_cast<struct sockaddr_in6 *>(&r)->sin6_addr.s6_addr,nm);
  224. } break;
  225. }
  226. return r;
  227. }
  228. bool InetAddress::isEqualPrefix(const InetAddress &addr) const noexcept
  229. {
  230. if (addr._data.ss_family == _data.ss_family) {
  231. switch(_data.ss_family) {
  232. case AF_INET6: {
  233. const InetAddress mask(netmask());
  234. InetAddress addr_mask(addr.netmask());
  235. const uint8_t *n = reinterpret_cast<const uint8_t *>(reinterpret_cast<const struct sockaddr_in6 *>(&addr_mask)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  236. const uint8_t *m = reinterpret_cast<const uint8_t *>(reinterpret_cast<const struct sockaddr_in6 *>(&mask)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  237. const uint8_t *a = reinterpret_cast<const uint8_t *>(reinterpret_cast<const struct sockaddr_in6 *>(&addr)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  238. const uint8_t *b = reinterpret_cast<const uint8_t *>(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  239. for(unsigned int i=0;i<16;++i) {
  240. if ((a[i] & m[i]) != (b[i] & n[i]))
  241. return false;
  242. }
  243. return true;
  244. }
  245. }
  246. }
  247. return false;
  248. }
  249. bool InetAddress::containsAddress(const InetAddress &addr) const noexcept
  250. {
  251. if (addr._data.ss_family == _data.ss_family) {
  252. switch(_data.ss_family) {
  253. case AF_INET: {
  254. const unsigned int bits = netmaskBits();
  255. if (bits == 0)
  256. return true;
  257. return (
  258. (Utils::ntoh((uint32_t)reinterpret_cast<const struct sockaddr_in *>(&addr)->sin_addr.s_addr) >> (32 - bits)) ==
  259. (Utils::ntoh((uint32_t)reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr) >> (32 - bits))
  260. );
  261. }
  262. case AF_INET6: {
  263. const InetAddress mask(netmask());
  264. const uint8_t *m = reinterpret_cast<const uint8_t *>(reinterpret_cast<const struct sockaddr_in6 *>(&mask)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  265. const uint8_t *a = reinterpret_cast<const uint8_t *>(reinterpret_cast<const struct sockaddr_in6 *>(&addr)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  266. const uint8_t *b = reinterpret_cast<const uint8_t *>(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  267. for(unsigned int i=0;i<16;++i) {
  268. if ((a[i] & m[i]) != b[i])
  269. return false;
  270. }
  271. return true;
  272. }
  273. }
  274. }
  275. return false;
  276. }
  277. unsigned long InetAddress::hashCode() const noexcept
  278. {
  279. if (_data.ss_family == AF_INET) {
  280. return ((unsigned long)reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr + (unsigned long)reinterpret_cast<const struct sockaddr_in *>(this)->sin_port);
  281. } else if (_data.ss_family == AF_INET6) {
  282. unsigned long tmp = reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port;
  283. const uint8_t *a = reinterpret_cast<const uint8_t *>(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  284. for(long i=0;i<16;++i)
  285. reinterpret_cast<uint8_t *>(&tmp)[i % sizeof(tmp)] ^= a[i];
  286. return tmp;
  287. } else {
  288. unsigned long tmp = reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port;
  289. const uint8_t *a = reinterpret_cast<const uint8_t *>(this); // NOLINT(hicpp-use-auto,modernize-use-auto)
  290. for(long i=0;i<(long)sizeof(InetAddress);++i)
  291. reinterpret_cast<uint8_t *>(&tmp)[i % sizeof(tmp)] ^= a[i];
  292. return tmp;
  293. }
  294. }
  295. void InetAddress::forTrace(ZT_TraceEventPathAddress &ta) const noexcept
  296. {
  297. uint32_t tmp;
  298. switch(_data.ss_family) {
  299. default:
  300. Utils::zero<sizeof(ZT_TraceEventPathAddress)>(&ta);
  301. break;
  302. case AF_INET:
  303. ta.type = ZT_TRACE_EVENT_PATH_TYPE_INETADDR_V4;
  304. tmp = (uint32_t)(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr);
  305. ta.address[0] = reinterpret_cast<const uint8_t *>(&tmp)[0];
  306. ta.address[1] = reinterpret_cast<const uint8_t *>(&tmp)[1];
  307. ta.address[2] = reinterpret_cast<const uint8_t *>(&tmp)[2];
  308. ta.address[3] = reinterpret_cast<const uint8_t *>(&tmp)[3];
  309. Utils::zero<sizeof(ta.address) - 4>(ta.address + 4);
  310. ta.port = reinterpret_cast<const struct sockaddr_in *>(this)->sin_port;
  311. break;
  312. case AF_INET6:
  313. ta.type = ZT_TRACE_EVENT_PATH_TYPE_INETADDR_V6;
  314. Utils::copy<16>(ta.address,reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr);
  315. Utils::zero<sizeof(ta.address) - 16>(ta.address + 16);
  316. ta.port = reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port;
  317. break;
  318. }
  319. }
  320. bool InetAddress::isNetwork() const noexcept
  321. {
  322. switch(_data.ss_family) {
  323. case AF_INET: {
  324. unsigned int bits = netmaskBits();
  325. if (bits <= 0)
  326. return false;
  327. if (bits >= 32)
  328. return false;
  329. uint32_t ip = Utils::ntoh((uint32_t)reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr);
  330. return ((ip & (0xffffffffU >> bits)) == 0);
  331. }
  332. case AF_INET6: {
  333. unsigned int bits = netmaskBits();
  334. if (bits <= 0)
  335. return false;
  336. if (bits >= 128)
  337. return false;
  338. const unsigned char *ip = reinterpret_cast<const unsigned char *>(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr); // NOLINT(hicpp-use-auto,modernize-use-auto)
  339. unsigned int p = bits / 8;
  340. if ((ip[p++] & (0xffU >> (bits % 8))) != 0)
  341. return false;
  342. while (p < 16) {
  343. if (ip[p++])
  344. return false;
  345. }
  346. return true;
  347. }
  348. }
  349. return false;
  350. }
  351. int InetAddress::marshal(uint8_t data[ZT_INETADDRESS_MARSHAL_SIZE_MAX]) const noexcept
  352. {
  353. unsigned int port;
  354. switch(_data.ss_family) {
  355. case AF_INET:
  356. port = Utils::ntoh((uint16_t)reinterpret_cast<const sockaddr_in *>(this)->sin_port);
  357. data[0] = 4;
  358. data[1] = reinterpret_cast<const uint8_t *>(&(reinterpret_cast<const sockaddr_in *>(this)->sin_addr.s_addr))[0];
  359. data[2] = reinterpret_cast<const uint8_t *>(&(reinterpret_cast<const sockaddr_in *>(this)->sin_addr.s_addr))[1];
  360. data[3] = reinterpret_cast<const uint8_t *>(&(reinterpret_cast<const sockaddr_in *>(this)->sin_addr.s_addr))[2];
  361. data[4] = reinterpret_cast<const uint8_t *>(&(reinterpret_cast<const sockaddr_in *>(this)->sin_addr.s_addr))[3];
  362. data[5] = (uint8_t)(port >> 8U);
  363. data[6] = (uint8_t)port;
  364. return 7;
  365. case AF_INET6:
  366. port = Utils::ntoh((uint16_t)reinterpret_cast<const sockaddr_in6 *>(this)->sin6_port);
  367. data[0] = 6;
  368. for(int i=0;i<16;++i)
  369. data[i+1] = reinterpret_cast<const sockaddr_in6 *>(this)->sin6_addr.s6_addr[i];
  370. data[17] = (uint8_t)(port >> 8U);
  371. data[18] = (uint8_t)port;
  372. return 19;
  373. default:
  374. data[0] = 0;
  375. return 1;
  376. }
  377. }
  378. int InetAddress::unmarshal(const uint8_t *restrict data,const int len) noexcept
  379. {
  380. if (len <= 0)
  381. return -1;
  382. switch(data[0]) {
  383. case 0:
  384. return 1;
  385. case 4:
  386. if (len < 7)
  387. return -1;
  388. memoryZero(this);
  389. reinterpret_cast<sockaddr_in *>(this)->sin_family = AF_INET;
  390. reinterpret_cast<uint8_t *>(&(reinterpret_cast<sockaddr_in *>(this)->sin_addr.s_addr))[0] = data[1];
  391. reinterpret_cast<uint8_t *>(&(reinterpret_cast<sockaddr_in *>(this)->sin_addr.s_addr))[1] = data[2];
  392. reinterpret_cast<uint8_t *>(&(reinterpret_cast<sockaddr_in *>(this)->sin_addr.s_addr))[2] = data[3];
  393. reinterpret_cast<uint8_t *>(&(reinterpret_cast<sockaddr_in *>(this)->sin_addr.s_addr))[3] = data[4];
  394. reinterpret_cast<uint8_t *>(&(reinterpret_cast<sockaddr_in *>(this)->sin_port))[sizeof(reinterpret_cast<sockaddr_in *>(this)->sin_port)-2] = data[5];
  395. reinterpret_cast<uint8_t *>(&(reinterpret_cast<sockaddr_in *>(this)->sin_port))[sizeof(reinterpret_cast<sockaddr_in *>(this)->sin_port)-1] = data[6];
  396. return 7;
  397. case 6:
  398. if (len < 19)
  399. return -1;
  400. memoryZero(this);
  401. reinterpret_cast<sockaddr_in6 *>(this)->sin6_family = AF_INET6;
  402. for(int i=0;i<16;i++)
  403. (reinterpret_cast<sockaddr_in6 *>(this)->sin6_addr.s6_addr)[i] = data[i+1];
  404. reinterpret_cast<uint8_t *>(&(reinterpret_cast<sockaddr_in6 *>(this)->sin6_port))[sizeof(reinterpret_cast<sockaddr_in6 *>(this)->sin6_port)-2] = data[17];
  405. reinterpret_cast<uint8_t *>(&(reinterpret_cast<sockaddr_in6 *>(this)->sin6_port))[sizeof(reinterpret_cast<sockaddr_in6 *>(this)->sin6_port)-1] = data[18];
  406. return 19;
  407. default:
  408. return -1;
  409. }
  410. }
  411. bool InetAddress::operator==(const InetAddress &a) const noexcept
  412. {
  413. if (_data.ss_family == a._data.ss_family) {
  414. switch(_data.ss_family) {
  415. case AF_INET:
  416. return (
  417. (reinterpret_cast<const struct sockaddr_in *>(this)->sin_port == reinterpret_cast<const struct sockaddr_in *>(&a)->sin_port)&&
  418. (reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr == reinterpret_cast<const struct sockaddr_in *>(&a)->sin_addr.s_addr));
  419. case AF_INET6:
  420. return (
  421. (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_port)&&
  422. (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_flowinfo == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_flowinfo)&&
  423. (memcmp(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr,reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_addr.s6_addr,16) == 0)&&
  424. (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_scope_id == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_scope_id));
  425. default:
  426. return (memcmp(this,&a,sizeof(InetAddress)) == 0);
  427. }
  428. }
  429. return false;
  430. }
  431. bool InetAddress::operator<(const InetAddress &a) const noexcept
  432. {
  433. if (_data.ss_family < a._data.ss_family)
  434. return true;
  435. else if (_data.ss_family == a._data.ss_family) {
  436. switch(_data.ss_family) {
  437. case AF_INET:
  438. if (reinterpret_cast<const struct sockaddr_in *>(this)->sin_port < reinterpret_cast<const struct sockaddr_in *>(&a)->sin_port)
  439. return true;
  440. else if (reinterpret_cast<const struct sockaddr_in *>(this)->sin_port == reinterpret_cast<const struct sockaddr_in *>(&a)->sin_port) {
  441. if (reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr < reinterpret_cast<const struct sockaddr_in *>(&a)->sin_addr.s_addr)
  442. return true;
  443. }
  444. break;
  445. case AF_INET6:
  446. if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port < reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_port)
  447. return true;
  448. else if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_port) {
  449. if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_flowinfo < reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_flowinfo)
  450. return true;
  451. else if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_flowinfo == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_flowinfo) {
  452. if (memcmp(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr,reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_addr.s6_addr,16) < 0)
  453. return true;
  454. else if (memcmp(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr,reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_addr.s6_addr,16) == 0) {
  455. if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_scope_id < reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_scope_id)
  456. return true;
  457. }
  458. }
  459. }
  460. break;
  461. default:
  462. return (memcmp(this,&a,sizeof(InetAddress)) < 0);
  463. }
  464. }
  465. return false;
  466. }
  467. InetAddress InetAddress::makeIpv6LinkLocal(const MAC &mac) noexcept
  468. {
  469. InetAddress r;
  470. sockaddr_in6 *const sin6 = reinterpret_cast<sockaddr_in6 *>(&r); // NOLINT(hicpp-use-auto,modernize-use-auto)
  471. sin6->sin6_family = AF_INET6;
  472. sin6->sin6_addr.s6_addr[0] = 0xfe;
  473. sin6->sin6_addr.s6_addr[1] = 0x80;
  474. sin6->sin6_addr.s6_addr[2] = 0x00;
  475. sin6->sin6_addr.s6_addr[3] = 0x00;
  476. sin6->sin6_addr.s6_addr[4] = 0x00;
  477. sin6->sin6_addr.s6_addr[5] = 0x00;
  478. sin6->sin6_addr.s6_addr[6] = 0x00;
  479. sin6->sin6_addr.s6_addr[7] = 0x00;
  480. sin6->sin6_addr.s6_addr[8] = mac[0] & 0xfdU;
  481. sin6->sin6_addr.s6_addr[9] = mac[1];
  482. sin6->sin6_addr.s6_addr[10] = mac[2];
  483. sin6->sin6_addr.s6_addr[11] = 0xff;
  484. sin6->sin6_addr.s6_addr[12] = 0xfe;
  485. sin6->sin6_addr.s6_addr[13] = mac[3];
  486. sin6->sin6_addr.s6_addr[14] = mac[4];
  487. sin6->sin6_addr.s6_addr[15] = mac[5];
  488. sin6->sin6_port = Utils::hton((uint16_t)64);
  489. return r;
  490. }
  491. InetAddress InetAddress::makeIpv6rfc4193(uint64_t nwid,uint64_t zeroTierAddress) noexcept
  492. {
  493. InetAddress r;
  494. sockaddr_in6 *const sin6 = reinterpret_cast<sockaddr_in6 *>(&r); // NOLINT(hicpp-use-auto,modernize-use-auto)
  495. sin6->sin6_family = AF_INET6;
  496. sin6->sin6_addr.s6_addr[0] = 0xfd;
  497. sin6->sin6_addr.s6_addr[1] = (uint8_t)(nwid >> 56U);
  498. sin6->sin6_addr.s6_addr[2] = (uint8_t)(nwid >> 48U);
  499. sin6->sin6_addr.s6_addr[3] = (uint8_t)(nwid >> 40U);
  500. sin6->sin6_addr.s6_addr[4] = (uint8_t)(nwid >> 32U);
  501. sin6->sin6_addr.s6_addr[5] = (uint8_t)(nwid >> 24U);
  502. sin6->sin6_addr.s6_addr[6] = (uint8_t)(nwid >> 16U);
  503. sin6->sin6_addr.s6_addr[7] = (uint8_t)(nwid >> 8U);
  504. sin6->sin6_addr.s6_addr[8] = (uint8_t)nwid;
  505. sin6->sin6_addr.s6_addr[9] = 0x99;
  506. sin6->sin6_addr.s6_addr[10] = 0x93;
  507. sin6->sin6_addr.s6_addr[11] = (uint8_t)(zeroTierAddress >> 32U);
  508. sin6->sin6_addr.s6_addr[12] = (uint8_t)(zeroTierAddress >> 24U);
  509. sin6->sin6_addr.s6_addr[13] = (uint8_t)(zeroTierAddress >> 16U);
  510. sin6->sin6_addr.s6_addr[14] = (uint8_t)(zeroTierAddress >> 8U);
  511. sin6->sin6_addr.s6_addr[15] = (uint8_t)zeroTierAddress;
  512. sin6->sin6_port = Utils::hton((uint16_t)88); // /88 includes 0xfd + network ID, discriminating by device ID below that
  513. return r;
  514. }
  515. InetAddress InetAddress::makeIpv66plane(uint64_t nwid,uint64_t zeroTierAddress) noexcept
  516. {
  517. nwid ^= (nwid >> 32U);
  518. InetAddress r;
  519. sockaddr_in6 *const sin6 = reinterpret_cast<sockaddr_in6 *>(&r); // NOLINT(hicpp-use-auto,modernize-use-auto)
  520. sin6->sin6_family = AF_INET6;
  521. sin6->sin6_addr.s6_addr[0] = 0xfc;
  522. sin6->sin6_addr.s6_addr[1] = (uint8_t)(nwid >> 24U);
  523. sin6->sin6_addr.s6_addr[2] = (uint8_t)(nwid >> 16U);
  524. sin6->sin6_addr.s6_addr[3] = (uint8_t)(nwid >> 8U);
  525. sin6->sin6_addr.s6_addr[4] = (uint8_t)nwid;
  526. sin6->sin6_addr.s6_addr[5] = (uint8_t)(zeroTierAddress >> 32U);
  527. sin6->sin6_addr.s6_addr[6] = (uint8_t)(zeroTierAddress >> 24U);
  528. sin6->sin6_addr.s6_addr[7] = (uint8_t)(zeroTierAddress >> 16U);
  529. sin6->sin6_addr.s6_addr[8] = (uint8_t)(zeroTierAddress >> 8U);
  530. sin6->sin6_addr.s6_addr[9] = (uint8_t)zeroTierAddress;
  531. sin6->sin6_addr.s6_addr[15] = 0x01;
  532. sin6->sin6_port = Utils::hton((uint16_t)40);
  533. return r;
  534. }
  535. } // namespace ZeroTier