InetAddress.cpp 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426
  1. /*
  2. * ZeroTier One - Network Virtualization Everywhere
  3. * Copyright (C) 2011-2015 ZeroTier, Inc.
  4. *
  5. * This program is free software: you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation, either version 3 of the License, or
  8. * (at your option) any later version.
  9. *
  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 General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  17. *
  18. * --
  19. *
  20. * ZeroTier may be used and distributed under the terms of the GPLv3, which
  21. * are available at: http://www.gnu.org/licenses/gpl-3.0.html
  22. *
  23. * If you would like to embed ZeroTier into a commercial application or
  24. * redistribute it in a modified binary form, please contact ZeroTier Networks
  25. * LLC. Start here: http://www.zerotier.com/
  26. */
  27. #include <stdio.h>
  28. #include <string.h>
  29. #include <stdint.h>
  30. #include <string>
  31. #include "Constants.hpp"
  32. #include "InetAddress.hpp"
  33. #include "Utils.hpp"
  34. namespace ZeroTier {
  35. const InetAddress InetAddress::LO4((const void *)("\x7f\x00\x00\x01"),4,0);
  36. const InetAddress InetAddress::LO6((const void *)("\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x01"),16,0);
  37. InetAddress::IpScope InetAddress::ipScope() const
  38. throw()
  39. {
  40. switch(ss_family) {
  41. case AF_INET: {
  42. const uint32_t ip = Utils::ntoh((uint32_t)reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr);
  43. switch(ip >> 24) {
  44. case 0x00: return IP_SCOPE_NONE; // 0.0.0.0/8 (reserved, never used)
  45. case 0x06: return IP_SCOPE_PSEUDOPRIVATE; // 6.0.0.0/8 (US Army)
  46. case 0x0a: return IP_SCOPE_PRIVATE; // 10.0.0.0/8
  47. case 0x0b: return IP_SCOPE_PSEUDOPRIVATE; // 11.0.0.0/8 (US DoD)
  48. case 0x15: return IP_SCOPE_PSEUDOPRIVATE; // 21.0.0.0/8 (US DDN-RVN)
  49. case 0x16: return IP_SCOPE_PSEUDOPRIVATE; // 22.0.0.0/8 (US DISA)
  50. case 0x19: return IP_SCOPE_PSEUDOPRIVATE; // 25.0.0.0/8 (UK Ministry of Defense)
  51. case 0x1a: return IP_SCOPE_PSEUDOPRIVATE; // 26.0.0.0/8 (US DISA)
  52. case 0x1c: return IP_SCOPE_PSEUDOPRIVATE; // 28.0.0.0/8 (US DSI-North)
  53. case 0x1d: return IP_SCOPE_PSEUDOPRIVATE; // 29.0.0.0/8 (US DISA)
  54. case 0x1e: return IP_SCOPE_PSEUDOPRIVATE; // 30.0.0.0/8 (US DISA)
  55. case 0x2c: return IP_SCOPE_PSEUDOPRIVATE; // 44.0.0.0/8 (Amateur Radio)
  56. case 0x33: return IP_SCOPE_PSEUDOPRIVATE; // 51.0.0.0/8 (UK Department of Social Security)
  57. case 0x37: return IP_SCOPE_PSEUDOPRIVATE; // 55.0.0.0/8 (US DoD)
  58. case 0x38: return IP_SCOPE_PSEUDOPRIVATE; // 56.0.0.0/8 (US Postal Service)
  59. case 0x64:
  60. if ((ip & 0xffc00000) == 0x64400000) return IP_SCOPE_SHARED; // 100.64.0.0/10
  61. break;
  62. case 0x7f: return IP_SCOPE_LOOPBACK; // 127.0.0.0/8
  63. case 0xa9:
  64. if ((ip & 0xffff0000) == 0xa9fe0000) return IP_SCOPE_LINK_LOCAL; // 169.254.0.0/16
  65. break;
  66. case 0xac:
  67. if ((ip & 0xfff00000) == 0xac100000) return IP_SCOPE_PRIVATE; // 172.16.0.0/12
  68. break;
  69. case 0xc0:
  70. if ((ip & 0xffff0000) == 0xc0a80000) return IP_SCOPE_PRIVATE; // 192.168.0.0/16
  71. break;
  72. case 0xff: return IP_SCOPE_NONE; // 255.0.0.0/8 (broadcast, or unused/unusable)
  73. }
  74. switch(ip >> 28) {
  75. case 0xe: return IP_SCOPE_MULTICAST; // 224.0.0.0/4
  76. case 0xf: return IP_SCOPE_PSEUDOPRIVATE; // 240.0.0.0/4 ("reserved," usually unusable)
  77. }
  78. return IP_SCOPE_GLOBAL;
  79. } break;
  80. case AF_INET6: {
  81. const unsigned char *ip = reinterpret_cast<const unsigned char *>(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr);
  82. if ((ip[0] & 0xf0) == 0xf0) {
  83. if (ip[0] == 0xff) return IP_SCOPE_MULTICAST; // ff00::/8
  84. if ((ip[0] == 0xfe)&&((ip[1] & 0xc0) == 0x80)) {
  85. unsigned int k = 2;
  86. while ((!ip[k])&&(k < 15)) ++k;
  87. if ((k == 15)&&(ip[15] == 0x01))
  88. return IP_SCOPE_LOOPBACK; // fe80::1/128
  89. else return IP_SCOPE_LINK_LOCAL; // fe80::/10
  90. }
  91. if ((ip[0] & 0xfe) == 0xfc) return IP_SCOPE_PRIVATE; // fc00::/7
  92. }
  93. unsigned int k = 0;
  94. while ((!ip[k])&&(k < 15)) ++k;
  95. if (k == 15) { // all 0's except last byte
  96. if (ip[15] == 0x01) return IP_SCOPE_LOOPBACK; // ::1/128
  97. if (ip[15] == 0x00) return IP_SCOPE_NONE; // ::/128
  98. }
  99. return IP_SCOPE_GLOBAL;
  100. } break;
  101. }
  102. return IP_SCOPE_NONE;
  103. }
  104. void InetAddress::set(const std::string &ip,unsigned int port)
  105. throw()
  106. {
  107. memset(this,0,sizeof(InetAddress));
  108. if (ip.find(':') != std::string::npos) {
  109. struct sockaddr_in6 *sin6 = reinterpret_cast<struct sockaddr_in6 *>(this);
  110. ss_family = AF_INET6;
  111. sin6->sin6_port = Utils::hton((uint16_t)port);
  112. if (inet_pton(AF_INET6,ip.c_str(),(void *)&(sin6->sin6_addr.s6_addr)) <= 0)
  113. memset(this,0,sizeof(InetAddress));
  114. } else {
  115. struct sockaddr_in *sin = reinterpret_cast<struct sockaddr_in *>(this);
  116. ss_family = AF_INET;
  117. sin->sin_port = Utils::hton((uint16_t)port);
  118. if (inet_pton(AF_INET,ip.c_str(),(void *)&(sin->sin_addr.s_addr)) <= 0)
  119. memset(this,0,sizeof(InetAddress));
  120. }
  121. }
  122. void InetAddress::set(const void *ipBytes,unsigned int ipLen,unsigned int port)
  123. throw()
  124. {
  125. memset(this,0,sizeof(InetAddress));
  126. if (ipLen == 4) {
  127. ss_family = AF_INET;
  128. reinterpret_cast<struct sockaddr_in *>(this)->sin_addr.s_addr = *(reinterpret_cast<const uint32_t *>(ipBytes));
  129. reinterpret_cast<struct sockaddr_in *>(this)->sin_port = Utils::hton((uint16_t)port);
  130. } else if (ipLen == 16) {
  131. ss_family = AF_INET6;
  132. memcpy(reinterpret_cast<struct sockaddr_in6 *>(this)->sin6_addr.s6_addr,ipBytes,16);
  133. reinterpret_cast<struct sockaddr_in6 *>(this)->sin6_port = Utils::hton((uint16_t)port);
  134. }
  135. }
  136. std::string InetAddress::toString() const
  137. {
  138. char buf[128];
  139. switch(ss_family) {
  140. case AF_INET:
  141. Utils::snprintf(buf,sizeof(buf),"%d.%d.%d.%d/%d",
  142. (int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[0],
  143. (int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[1],
  144. (int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[2],
  145. (int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[3],
  146. (int)Utils::ntoh((uint16_t)(reinterpret_cast<const struct sockaddr_in *>(this)->sin_port))
  147. );
  148. return std::string(buf);
  149. case AF_INET6:
  150. Utils::snprintf(buf,sizeof(buf),"%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x/%d",
  151. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[0]),
  152. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[1]),
  153. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[2]),
  154. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[3]),
  155. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[4]),
  156. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[5]),
  157. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[6]),
  158. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[7]),
  159. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[8]),
  160. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[9]),
  161. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[10]),
  162. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[11]),
  163. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[12]),
  164. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[13]),
  165. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[14]),
  166. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[15]),
  167. (int)Utils::ntoh((uint16_t)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port))
  168. );
  169. return std::string(buf);
  170. }
  171. return std::string();
  172. }
  173. std::string InetAddress::toIpString() const
  174. {
  175. char buf[128];
  176. switch(ss_family) {
  177. case AF_INET:
  178. Utils::snprintf(buf,sizeof(buf),"%d.%d.%d.%d",
  179. (int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[0],
  180. (int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[1],
  181. (int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[2],
  182. (int)(reinterpret_cast<const unsigned char *>(&(reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr)))[3]
  183. );
  184. return std::string(buf);
  185. case AF_INET6:
  186. Utils::snprintf(buf,sizeof(buf),"%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x:%.2x%.2x",
  187. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[0]),
  188. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[1]),
  189. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[2]),
  190. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[3]),
  191. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[4]),
  192. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[5]),
  193. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[6]),
  194. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[7]),
  195. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[8]),
  196. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[9]),
  197. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[10]),
  198. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[11]),
  199. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[12]),
  200. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[13]),
  201. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[14]),
  202. (int)(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr[15])
  203. );
  204. return std::string(buf);
  205. }
  206. return std::string();
  207. }
  208. void InetAddress::fromString(const std::string &ipSlashPort)
  209. {
  210. const std::size_t slashAt = ipSlashPort.find('/');
  211. if (slashAt == std::string::npos) {
  212. set(ipSlashPort,0);
  213. } else {
  214. long p = strtol(ipSlashPort.substr(slashAt+1).c_str(),(char **)0,10);
  215. if ((p > 0)&&(p <= 0xffff))
  216. set(ipSlashPort.substr(0,slashAt),(unsigned int)p);
  217. else set(ipSlashPort.substr(0,slashAt),0);
  218. }
  219. }
  220. InetAddress InetAddress::netmask() const
  221. throw()
  222. {
  223. InetAddress r(*this);
  224. switch(r.ss_family) {
  225. case AF_INET:
  226. reinterpret_cast<struct sockaddr_in *>(&r)->sin_addr.s_addr = Utils::hton((uint32_t)(0xffffffff << (32 - netmaskBits())));
  227. break;
  228. case AF_INET6: {
  229. unsigned char *bf = reinterpret_cast<unsigned char *>(reinterpret_cast<struct sockaddr_in6 *>(&r)->sin6_addr.s6_addr);
  230. signed int bitsLeft = (signed int)netmaskBits();
  231. for(unsigned int i=0;i<16;++i) {
  232. if (bitsLeft > 0) {
  233. bf[i] |= (unsigned char)((bitsLeft >= 8) ? 0x00 : (0xff >> bitsLeft));
  234. bitsLeft -= 8;
  235. }
  236. }
  237. } break;
  238. }
  239. return r;
  240. }
  241. InetAddress InetAddress::broadcast() const
  242. throw()
  243. {
  244. InetAddress r(*this);
  245. switch(r.ss_family) {
  246. case AF_INET:
  247. reinterpret_cast<struct sockaddr_in *>(&r)->sin_addr.s_addr |= Utils::hton((uint32_t)(0xffffffff >> netmaskBits()));
  248. break;
  249. case AF_INET6: {
  250. unsigned char *bf = reinterpret_cast<unsigned char *>(reinterpret_cast<struct sockaddr_in6 *>(&r)->sin6_addr.s6_addr);
  251. signed int bitsLeft = (signed int)netmaskBits();
  252. for(unsigned int i=0;i<16;++i) {
  253. if (bitsLeft > 0) {
  254. bf[i] |= (unsigned char)((bitsLeft >= 8) ? 0x00 : (0xff >> bitsLeft));
  255. bitsLeft -= 8;
  256. }
  257. }
  258. } break;
  259. }
  260. return r;
  261. }
  262. bool InetAddress::isNetwork() const
  263. throw()
  264. {
  265. switch(ss_family) {
  266. case AF_INET: {
  267. unsigned int bits = netmaskBits();
  268. if (bits <= 0)
  269. return false;
  270. if (bits >= 32)
  271. return false;
  272. uint32_t ip = Utils::ntoh((uint32_t)reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr);
  273. return ((ip & (0xffffffff >> bits)) == 0);
  274. }
  275. case AF_INET6: {
  276. unsigned int bits = netmaskBits();
  277. if (bits <= 0)
  278. return false;
  279. if (bits >= 128)
  280. return false;
  281. const unsigned char *ip = reinterpret_cast<const unsigned char *>(reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_addr.s6_addr);
  282. unsigned int p = bits / 8;
  283. if ((ip[p++] & (0xff >> (bits % 8))) != 0)
  284. return false;
  285. while (p < 16) {
  286. if (ip[p++])
  287. return false;
  288. }
  289. return true;
  290. }
  291. }
  292. return false;
  293. }
  294. bool InetAddress::operator==(const InetAddress &a) const
  295. throw()
  296. {
  297. if (ss_family == a.ss_family) {
  298. switch(ss_family) {
  299. case AF_INET:
  300. return (
  301. (reinterpret_cast<const struct sockaddr_in *>(this)->sin_port == reinterpret_cast<const struct sockaddr_in *>(&a)->sin_port)&&
  302. (reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr == reinterpret_cast<const struct sockaddr_in *>(&a)->sin_addr.s_addr));
  303. break;
  304. case AF_INET6:
  305. return (
  306. (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_port)&&
  307. (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_flowinfo == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_flowinfo)&&
  308. (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)&&
  309. (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_scope_id == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_scope_id));
  310. break;
  311. default:
  312. return (memcmp(this,&a,sizeof(InetAddress)) == 0);
  313. }
  314. }
  315. return false;
  316. }
  317. bool InetAddress::operator<(const InetAddress &a) const
  318. throw()
  319. {
  320. if (ss_family < a.ss_family)
  321. return true;
  322. else if (ss_family == a.ss_family) {
  323. switch(ss_family) {
  324. case AF_INET:
  325. if (reinterpret_cast<const struct sockaddr_in *>(this)->sin_port < reinterpret_cast<const struct sockaddr_in *>(&a)->sin_port)
  326. return true;
  327. else if (reinterpret_cast<const struct sockaddr_in *>(this)->sin_port == reinterpret_cast<const struct sockaddr_in *>(&a)->sin_port) {
  328. if (reinterpret_cast<const struct sockaddr_in *>(this)->sin_addr.s_addr < reinterpret_cast<const struct sockaddr_in *>(&a)->sin_addr.s_addr)
  329. return true;
  330. }
  331. break;
  332. case AF_INET6:
  333. if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port < reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_port)
  334. return true;
  335. else if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_port == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_port) {
  336. if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_flowinfo < reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_flowinfo)
  337. return true;
  338. else if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_flowinfo == reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_flowinfo) {
  339. 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)
  340. return true;
  341. 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) {
  342. if (reinterpret_cast<const struct sockaddr_in6 *>(this)->sin6_scope_id < reinterpret_cast<const struct sockaddr_in6 *>(&a)->sin6_scope_id)
  343. return true;
  344. }
  345. }
  346. }
  347. break;
  348. default:
  349. return (memcmp(this,&a,sizeof(InetAddress)) < 0);
  350. }
  351. }
  352. return false;
  353. }
  354. InetAddress InetAddress::makeIpv6LinkLocal(const MAC &mac)
  355. throw()
  356. {
  357. struct sockaddr_in6 sin6;
  358. sin6.sin6_family = AF_INET6;
  359. sin6.sin6_addr.s6_addr[0] = 0xfe;
  360. sin6.sin6_addr.s6_addr[1] = 0x80;
  361. sin6.sin6_addr.s6_addr[2] = 0x00;
  362. sin6.sin6_addr.s6_addr[3] = 0x00;
  363. sin6.sin6_addr.s6_addr[4] = 0x00;
  364. sin6.sin6_addr.s6_addr[5] = 0x00;
  365. sin6.sin6_addr.s6_addr[6] = 0x00;
  366. sin6.sin6_addr.s6_addr[7] = 0x00;
  367. sin6.sin6_addr.s6_addr[8] = mac[0] & 0xfd;
  368. sin6.sin6_addr.s6_addr[9] = mac[1];
  369. sin6.sin6_addr.s6_addr[10] = mac[2];
  370. sin6.sin6_addr.s6_addr[11] = 0xff;
  371. sin6.sin6_addr.s6_addr[12] = 0xfe;
  372. sin6.sin6_addr.s6_addr[13] = mac[3];
  373. sin6.sin6_addr.s6_addr[14] = mac[4];
  374. sin6.sin6_addr.s6_addr[15] = mac[5];
  375. sin6.sin6_port = Utils::hton((uint16_t)64);
  376. return InetAddress(sin6);
  377. }
  378. InetAddress InetAddress::makeIpv6rfc4193(uint64_t nwid,uint64_t zeroTierAddress)
  379. throw()
  380. {
  381. InetAddress r;
  382. struct sockaddr_in6 *const sin6 = reinterpret_cast<struct sockaddr_in6 *>(&r);
  383. sin6->sin6_family = AF_INET6;
  384. sin6->sin6_addr.s6_addr[0] = 0xfd;
  385. sin6->sin6_addr.s6_addr[1] = (uint8_t)(nwid >> 56);
  386. sin6->sin6_addr.s6_addr[2] = (uint8_t)(nwid >> 48);
  387. sin6->sin6_addr.s6_addr[3] = (uint8_t)(nwid >> 40);
  388. sin6->sin6_addr.s6_addr[4] = (uint8_t)(nwid >> 32);
  389. sin6->sin6_addr.s6_addr[5] = (uint8_t)(nwid >> 24);
  390. sin6->sin6_addr.s6_addr[6] = (uint8_t)(nwid >> 16);
  391. sin6->sin6_addr.s6_addr[7] = (uint8_t)(nwid >> 8);
  392. sin6->sin6_addr.s6_addr[8] = (uint8_t)nwid;
  393. sin6->sin6_addr.s6_addr[9] = 0x99;
  394. sin6->sin6_addr.s6_addr[10] = 0x93;
  395. sin6->sin6_addr.s6_addr[11] = (uint8_t)(zeroTierAddress >> 32);
  396. sin6->sin6_addr.s6_addr[12] = (uint8_t)(zeroTierAddress >> 24);
  397. sin6->sin6_addr.s6_addr[13] = (uint8_t)(zeroTierAddress >> 16);
  398. sin6->sin6_addr.s6_addr[14] = (uint8_t)(zeroTierAddress >> 8);
  399. sin6->sin6_addr.s6_addr[15] = (uint8_t)zeroTierAddress;
  400. sin6->sin6_port = Utils::hton((uint16_t)88); // /88 includes 0xfd + network ID, discriminating by device ID below that
  401. return r;
  402. }
  403. } // namespace ZeroTier