LinuxNetLink.cpp 30 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206
  1. /*
  2. * Copyright (c)2019 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: 2025-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 "../node/Constants.hpp"
  14. #include <cerrno>
  15. //#define ZT_NETLINK_TRACE
  16. #ifdef __LINUX__
  17. #include "LinuxNetLink.hpp"
  18. #include <unistd.h>
  19. #include <linux/if_tun.h>
  20. #ifndef IFNAMSIZ
  21. #define IFNAMSIZ 16
  22. #endif
  23. const int ZT_RTE_METRIC = 5000;
  24. namespace ZeroTier {
  25. struct nl_route_req {
  26. struct nlmsghdr nl;
  27. struct rtmsg rt;
  28. char buf[8192];
  29. };
  30. struct nl_if_req {
  31. struct nlmsghdr nl;
  32. struct ifinfomsg ifa;
  33. char buf[8192];
  34. };
  35. struct nl_adr_req {
  36. struct nlmsghdr nl;
  37. struct ifaddrmsg ifa;
  38. char buf[8192];
  39. };
  40. LinuxNetLink::LinuxNetLink()
  41. : _t()
  42. , _running(false)
  43. , _seq(0)
  44. , _interfaces()
  45. , _if_m()
  46. , _fd(socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE))
  47. , _la({0})
  48. {
  49. // set socket timeout to 1 sec so we're not permablocking recv() calls
  50. _setSocketTimeout(_fd, 1);
  51. _la.nl_family = AF_NETLINK;
  52. _la.nl_pid = 0; //getpid()+1;
  53. _la.nl_groups = RTMGRP_LINK|RTMGRP_IPV4_IFADDR|RTMGRP_IPV6_IFADDR|RTMGRP_IPV4_ROUTE|RTMGRP_IPV6_ROUTE|RTMGRP_NOTIFY;
  54. if (bind(_fd, (struct sockaddr*)&_la, sizeof(_la))) {
  55. fprintf(stderr, "Error connecting to RTNETLINK: %s\n", strerror(errno));
  56. ::exit(1);
  57. }
  58. _requestIPv4Routes();
  59. _requestIPv6Routes();
  60. _requestInterfaceList();
  61. _running = true;
  62. _t = Thread::start(this);
  63. }
  64. LinuxNetLink::~LinuxNetLink()
  65. {
  66. _running = false;
  67. Thread::join(_t);
  68. ::close(_fd);
  69. }
  70. void LinuxNetLink::_setSocketTimeout(int fd, int seconds)
  71. {
  72. struct timeval tv;
  73. tv.tv_sec = seconds;
  74. tv.tv_usec = 0;
  75. if(setsockopt(fd, SOL_SOCKET, SO_RCVTIMEO, (const char*)&tv, sizeof(tv)) != 0) {
  76. #ifdef ZT_NETLINK_TRACE
  77. fprintf(stderr, "setsockopt failed: %s\n", strerror(errno));
  78. #endif
  79. }
  80. }
  81. #define ZT_NL_BUF_SIZE 16384
  82. int LinuxNetLink::_doRecv(int fd)
  83. {
  84. char *buf = nullptr;
  85. if (posix_memalign((void **)&buf,16,ZT_NL_BUF_SIZE) != 0) {
  86. fprintf(stderr,"malloc failed!\n");
  87. ::exit(1);
  88. }
  89. if (!buf) {
  90. fprintf(stderr,"malloc failed!\n");
  91. ::exit(1);
  92. }
  93. char *p = NULL;
  94. struct nlmsghdr *nlp;
  95. int nll = 0;
  96. int rtn = 0;
  97. p = buf;
  98. for(;;) {
  99. rtn = recv(fd, p, ZT_NL_BUF_SIZE - nll, 0);
  100. if (rtn > 0) {
  101. nlp = (struct nlmsghdr *)p;
  102. if(nlp->nlmsg_type == NLMSG_ERROR && (nlp->nlmsg_flags & NLM_F_ACK) != NLM_F_ACK) {
  103. struct nlmsgerr *err = (struct nlmsgerr*)NLMSG_DATA(nlp);
  104. if (err->error != 0) {
  105. #ifdef ZT_NETLINK_TRACE
  106. fprintf(stderr, "rtnetlink error: %s\n", strerror(-(err->error)));
  107. #endif
  108. }
  109. p = buf;
  110. nll = 0;
  111. break;
  112. }
  113. if (nlp->nlmsg_type == NLMSG_NOOP) {
  114. break;
  115. }
  116. if( (nlp->nlmsg_flags & NLM_F_MULTI) == NLM_F_MULTI || (nlp->nlmsg_type == NLMSG_DONE))
  117. {
  118. if (nlp->nlmsg_type == NLMSG_DONE) {
  119. _processMessage(nlp, nll);
  120. p = buf;
  121. nll = 0;
  122. break;
  123. }
  124. p += rtn;
  125. nll += rtn;
  126. }
  127. if (nlp->nlmsg_type == NLMSG_OVERRUN) {
  128. #ifdef ZT_NETLINK_TRACE
  129. fprintf(stderr, "NLMSG_OVERRUN: Data lost\n");
  130. #endif
  131. p = buf;
  132. nll = 0;
  133. break;
  134. }
  135. nll += rtn;
  136. _processMessage(nlp, nll);
  137. p = buf;
  138. nll = 0;
  139. break;
  140. } else {
  141. break;
  142. }
  143. }
  144. free(buf);
  145. return rtn;
  146. }
  147. void LinuxNetLink::threadMain() throw()
  148. {
  149. int rtn = 0;
  150. while(_running) {
  151. rtn = _doRecv(_fd);
  152. if (rtn <= 0) {
  153. Thread::sleep(250);
  154. continue;
  155. }
  156. }
  157. }
  158. void LinuxNetLink::_processMessage(struct nlmsghdr *nlp, int nll)
  159. {
  160. for(; NLMSG_OK(nlp, nll); nlp=NLMSG_NEXT(nlp, nll))
  161. {
  162. switch(nlp->nlmsg_type)
  163. {
  164. case RTM_NEWLINK:
  165. _linkAdded(nlp);
  166. break;
  167. case RTM_DELLINK:
  168. _linkDeleted(nlp);
  169. break;
  170. case RTM_NEWADDR:
  171. _ipAddressAdded(nlp);
  172. break;
  173. case RTM_DELADDR:
  174. _ipAddressDeleted(nlp);
  175. break;
  176. case RTM_NEWROUTE:
  177. _routeAdded(nlp);
  178. break;
  179. case RTM_DELROUTE:
  180. _routeDeleted(nlp);
  181. break;
  182. default:
  183. break;
  184. }
  185. }
  186. }
  187. void LinuxNetLink::_ipAddressAdded(struct nlmsghdr *nlp)
  188. {
  189. #ifdef ZT_NETLINK_TRACE
  190. struct ifaddrmsg *ifap = (struct ifaddrmsg *)NLMSG_DATA(nlp);
  191. struct rtattr *rtap = (struct rtattr *)IFA_RTA(ifap);
  192. int ifal = IFA_PAYLOAD(nlp);
  193. char addr[40] = {0};
  194. char local[40] = {0};
  195. char label[40] = {0};
  196. char bcast[40] = {0};
  197. for(;RTA_OK(rtap, ifal); rtap=RTA_NEXT(rtap,ifal))
  198. {
  199. switch(rtap->rta_type) {
  200. case IFA_ADDRESS:
  201. inet_ntop(ifap->ifa_family, RTA_DATA(rtap), addr, 40);
  202. break;
  203. case IFA_LOCAL:
  204. inet_ntop(ifap->ifa_family, RTA_DATA(rtap), local, 40);
  205. break;
  206. case IFA_LABEL:
  207. memcpy(label, RTA_DATA(rtap), 40);
  208. break;
  209. case IFA_BROADCAST:
  210. inet_ntop(ifap->ifa_family, RTA_DATA(rtap), bcast, 40);
  211. break;
  212. }
  213. }
  214. fprintf(stderr,"Added IP Address %s local: %s label: %s broadcast: %s\n", addr, local, label, bcast);
  215. #endif
  216. }
  217. void LinuxNetLink::_ipAddressDeleted(struct nlmsghdr *nlp)
  218. {
  219. #ifdef ZT_NETLINK_TRACE
  220. struct ifaddrmsg *ifap = (struct ifaddrmsg *)NLMSG_DATA(nlp);
  221. struct rtattr *rtap = (struct rtattr *)IFA_RTA(ifap);
  222. int ifal = IFA_PAYLOAD(nlp);
  223. char addr[40] = {0};
  224. char local[40] = {0};
  225. char label[40] = {0};
  226. char bcast[40] = {0};
  227. for(;RTA_OK(rtap, ifal); rtap=RTA_NEXT(rtap,ifal))
  228. {
  229. switch(rtap->rta_type) {
  230. case IFA_ADDRESS:
  231. inet_ntop(ifap->ifa_family, RTA_DATA(rtap), addr, 40);
  232. break;
  233. case IFA_LOCAL:
  234. inet_ntop(ifap->ifa_family, RTA_DATA(rtap), local, 40);
  235. break;
  236. case IFA_LABEL:
  237. memcpy(label, RTA_DATA(rtap), 40);
  238. break;
  239. case IFA_BROADCAST:
  240. inet_ntop(ifap->ifa_family, RTA_DATA(rtap), bcast, 40);
  241. break;
  242. }
  243. }
  244. fprintf(stderr, "Removed IP Address %s local: %s label: %s broadcast: %s\n", addr, local, label, bcast);
  245. #endif
  246. }
  247. void LinuxNetLink::_routeAdded(struct nlmsghdr *nlp)
  248. {
  249. char dsts[40] = {0};
  250. char gws[40] = {0};
  251. char srcs[40] = {0};
  252. char ifs[16] = {0};
  253. char ms[24] = {0};
  254. struct rtmsg *rtp = (struct rtmsg *)NLMSG_DATA(nlp);
  255. struct rtattr *rtap = (struct rtattr *)RTM_RTA(rtp);
  256. int rtl = RTM_PAYLOAD(nlp);
  257. Route r;
  258. bool wecare = false;
  259. for(;RTA_OK(rtap, rtl); rtap=RTA_NEXT(rtap, rtl))
  260. {
  261. switch(rtap->rta_type)
  262. {
  263. case RTA_DST:
  264. switch(rtp->rtm_family) {
  265. case AF_INET:
  266. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), dsts, 24);
  267. r.target.set(RTA_DATA(rtap), 4, 0);
  268. wecare = true;
  269. break;
  270. case AF_INET6:
  271. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), dsts, 24);
  272. r.target.set(RTA_DATA(rtap), 16, 0);
  273. wecare = true;
  274. break;
  275. }
  276. break;
  277. case RTA_SRC:
  278. switch(rtp->rtm_family) {
  279. case AF_INET:
  280. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), srcs, 24);
  281. r.src.set(RTA_DATA(rtap), 4, 0);
  282. wecare = true;
  283. break;
  284. case AF_INET6:
  285. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), srcs, 24);
  286. r.src.set(RTA_DATA(rtap), 16, 0);
  287. wecare = true;
  288. break;
  289. }
  290. break;
  291. case RTA_GATEWAY:
  292. switch(rtp->rtm_family) {
  293. case AF_INET:
  294. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), gws, 24);
  295. r.via.set(RTA_DATA(rtap), 4, 0);
  296. wecare = true;
  297. break;
  298. case AF_INET6:
  299. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), gws, 24);
  300. r.via.set(RTA_DATA(rtap), 16, 0);
  301. wecare = true;
  302. break;
  303. }
  304. break;
  305. case RTA_OIF:
  306. switch(rtp->rtm_family) {
  307. case AF_INET:
  308. r.ifidx = *((int*)RTA_DATA(rtap));
  309. wecare = true;
  310. break;
  311. case AF_INET6:
  312. r.ifidx = *((int*)RTA_DATA(rtap));
  313. wecare = true;
  314. break;
  315. }
  316. sprintf(ifs, "%d", *((int*)RTA_DATA(rtap)));
  317. break;
  318. }
  319. }
  320. if (wecare) {
  321. Mutex::Lock rl(_routes_m);
  322. _routes[r.target].insert(r);
  323. }
  324. #ifdef ZT_NETLINK_TRACE
  325. sprintf(ms, "%d", rtp->rtm_dst_len);
  326. fprintf(stderr, "Route Added: dst %s/%s gw %s src %s if %s\n", dsts, ms, gws, srcs, ifs);
  327. #endif
  328. }
  329. void LinuxNetLink::_routeDeleted(struct nlmsghdr *nlp)
  330. {
  331. char dsts[40] = {0};
  332. char gws[40] = {0};
  333. char srcs[40] = {0};
  334. char ifs[16] = {0};
  335. char ms[24] = {0};
  336. struct rtmsg *rtp = (struct rtmsg *) NLMSG_DATA(nlp);
  337. struct rtattr *rtap = (struct rtattr *)RTM_RTA(rtp);
  338. int rtl = RTM_PAYLOAD(nlp);
  339. Route r;
  340. bool wecare = false;
  341. for(;RTA_OK(rtap, rtl); rtap=RTA_NEXT(rtap, rtl))
  342. {
  343. switch(rtap->rta_type)
  344. {
  345. case RTA_DST:
  346. switch(rtp->rtm_family) {
  347. case AF_INET:
  348. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), dsts, 24);
  349. r.target.set(RTA_DATA(rtap), 4, 0);
  350. wecare = true;
  351. break;
  352. case AF_INET6:
  353. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), dsts, 24);
  354. r.target.set(RTA_DATA(rtap), 16, 0);
  355. wecare = true;
  356. break;
  357. }
  358. break;
  359. case RTA_SRC:
  360. switch(rtp->rtm_family) {
  361. case AF_INET:
  362. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), srcs, 24);
  363. r.src.set(RTA_DATA(rtap), 4, 0);
  364. wecare = true;
  365. break;
  366. case AF_INET6:
  367. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), srcs, 24);
  368. r.src.set(RTA_DATA(rtap), 16, 0);
  369. wecare = true;
  370. break;
  371. }
  372. break;
  373. case RTA_GATEWAY:
  374. switch(rtp->rtm_family) {
  375. case AF_INET:
  376. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), gws, 24);
  377. r.via.set(RTA_DATA(rtap), 4, 0);
  378. wecare = true;
  379. break;
  380. case AF_INET6:
  381. inet_ntop(rtp->rtm_family, RTA_DATA(rtap), gws, 24);
  382. r.via.set(RTA_DATA(rtap), 16, 0);
  383. wecare = true;
  384. break;
  385. }
  386. break;
  387. case RTA_OIF:
  388. switch(rtp->rtm_family) {
  389. case AF_INET:
  390. r.ifidx = *((int*)RTA_DATA(rtap));
  391. wecare = true;
  392. break;
  393. case AF_INET6:
  394. r.ifidx = *((int*)RTA_DATA(rtap));
  395. wecare = true;
  396. break;
  397. }
  398. sprintf(ifs, "%d", *((int*)RTA_DATA(rtap)));
  399. break;
  400. }
  401. }
  402. if (wecare) {
  403. Mutex::Lock rl(_routes_m);
  404. _routes[r.target].erase(r);
  405. }
  406. #ifdef ZT_NETLINK_TRACE
  407. sprintf(ms, "%d", rtp->rtm_dst_len);
  408. fprintf(stderr, "Route Deleted: dst %s/%s gw %s src %s if %s\n", dsts, ms, gws, srcs, ifs);
  409. #endif
  410. }
  411. void LinuxNetLink::_linkAdded(struct nlmsghdr *nlp)
  412. {
  413. unsigned char mac_bin[6] = {0};
  414. unsigned int mtu = 0;
  415. char ifname[IFNAMSIZ] = {0};
  416. struct ifinfomsg *ifip = (struct ifinfomsg *)NLMSG_DATA(nlp);
  417. struct rtattr *rtap = (struct rtattr *)IFLA_RTA(ifip);
  418. int ifil = RTM_PAYLOAD(nlp);
  419. const char *ptr = (const char *)0;
  420. for(;RTA_OK(rtap, ifil);rtap=RTA_NEXT(rtap, ifil))
  421. {
  422. switch(rtap->rta_type) {
  423. case IFLA_ADDRESS:
  424. ptr = (const char *)RTA_DATA(rtap);
  425. memcpy(mac_bin, ptr, 6);
  426. break;
  427. case IFLA_IFNAME:
  428. ptr = (const char *)RTA_DATA(rtap);
  429. memcpy(ifname, ptr, strlen(ptr));
  430. break;
  431. case IFLA_MTU:
  432. memcpy(&mtu, RTA_DATA(rtap), sizeof(unsigned int));
  433. break;
  434. }
  435. }
  436. {
  437. Mutex::Lock l(_if_m);
  438. struct iface_entry &entry = _interfaces[ifip->ifi_index];
  439. entry.index = ifip->ifi_index;
  440. memcpy(entry.ifacename, ifname, sizeof(ifname));
  441. snprintf(entry.mac,sizeof(entry.mac),"%.02x:%.02x:%.02x:%.02x:%.02x:%.02x",(unsigned int)mac_bin[0],(unsigned int)mac_bin[1],(unsigned int)mac_bin[2],(unsigned int)mac_bin[3],(unsigned int)mac_bin[4],(unsigned int)mac_bin[5]);
  442. memcpy(entry.mac_bin, mac_bin, 6);
  443. entry.mtu = mtu;
  444. }
  445. }
  446. void LinuxNetLink::_linkDeleted(struct nlmsghdr *nlp)
  447. {
  448. unsigned int mtu = 0;
  449. char ifname[40] = {0};
  450. struct ifinfomsg *ifip = (struct ifinfomsg *)NLMSG_DATA(nlp);
  451. struct rtattr *rtap = (struct rtattr *)IFLA_RTA(ifip);
  452. int ifil = RTM_PAYLOAD(nlp);
  453. const char *ptr = (const char *)0;
  454. for(;RTA_OK(rtap, ifil);rtap=RTA_NEXT(rtap, ifil))
  455. {
  456. switch(rtap->rta_type) {
  457. case IFLA_IFNAME:
  458. ptr = (const char*)RTA_DATA(rtap);
  459. memcpy(ifname, ptr, strlen(ptr));
  460. break;
  461. case IFLA_MTU:
  462. memcpy(&mtu, RTA_DATA(rtap), sizeof(unsigned int));
  463. break;
  464. }
  465. }
  466. {
  467. Mutex::Lock l(_if_m);
  468. if(_interfaces.contains(ifip->ifi_index)) {
  469. _interfaces.erase(ifip->ifi_index);
  470. }
  471. }
  472. }
  473. void LinuxNetLink::_requestIPv4Routes()
  474. {
  475. int fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
  476. if (fd == -1) {
  477. fprintf(stderr, "Error opening RTNETLINK socket: %s\n", strerror(errno));
  478. return;
  479. }
  480. _setSocketTimeout(fd);
  481. struct sockaddr_nl la;
  482. la.nl_family = AF_NETLINK;
  483. la.nl_pid = 0; //getpid();
  484. la.nl_groups = RTMGRP_IPV4_ROUTE;
  485. if(bind(fd, (struct sockaddr*)&la, sizeof(la))) {
  486. fprintf(stderr, "Error binding RTNETLINK (_requiestIPv4Routes #1): %s\n", strerror(errno));
  487. close(fd);
  488. return;
  489. }
  490. struct nl_route_req req;
  491. bzero(&req, sizeof(req));
  492. req.nl.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg));
  493. req.nl.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
  494. req.nl.nlmsg_type = RTM_GETROUTE;
  495. req.nl.nlmsg_pid = 0;
  496. req.nl.nlmsg_seq = ++_seq;
  497. req.rt.rtm_family = AF_INET;
  498. req.rt.rtm_table = RT_TABLE_MAIN;
  499. struct sockaddr_nl pa;
  500. bzero(&pa, sizeof(pa));
  501. pa.nl_family = AF_NETLINK;
  502. struct msghdr msg;
  503. bzero(&msg, sizeof(msg));
  504. msg.msg_name = (void*)&pa;
  505. msg.msg_namelen = sizeof(pa);
  506. struct iovec iov;
  507. bzero(&iov, sizeof(iov));
  508. iov.iov_base = (void*)&req.nl;
  509. iov.iov_len = req.nl.nlmsg_len;
  510. msg.msg_iov = &iov;
  511. msg.msg_iovlen = 1;
  512. sendmsg(fd, &msg, 0);
  513. _doRecv(fd);
  514. close(fd);
  515. }
  516. void LinuxNetLink::_requestIPv6Routes()
  517. {
  518. int fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
  519. if (fd == -1) {
  520. fprintf(stderr, "Error opening RTNETLINK socket: %s\n", strerror(errno));
  521. return;
  522. }
  523. _setSocketTimeout(fd);
  524. struct sockaddr_nl la;
  525. la.nl_family = AF_NETLINK;
  526. la.nl_pid = 0; //getpid();
  527. la.nl_groups = RTMGRP_IPV6_ROUTE;
  528. if(bind(fd, (struct sockaddr*)&la, sizeof(struct sockaddr_nl))) {
  529. fprintf(stderr, "Error binding RTNETLINK (_requestIPv6Routes #1): %s\n", strerror(errno));
  530. close(fd);
  531. return;
  532. }
  533. struct nl_route_req req;
  534. bzero(&req, sizeof(req));
  535. req.nl.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg));
  536. req.nl.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
  537. req.nl.nlmsg_type = RTM_GETROUTE;
  538. req.nl.nlmsg_pid = 0;
  539. req.nl.nlmsg_seq = ++_seq;
  540. req.rt.rtm_family = AF_INET6;
  541. req.rt.rtm_table = RT_TABLE_MAIN;
  542. struct sockaddr_nl pa;
  543. bzero(&pa, sizeof(pa));
  544. pa.nl_family = AF_NETLINK;
  545. struct msghdr msg;
  546. bzero(&msg, sizeof(msg));
  547. msg.msg_name = (void*)&pa;
  548. msg.msg_namelen = sizeof(pa);
  549. struct iovec iov;
  550. bzero(&iov, sizeof(iov));
  551. iov.iov_base = (void*)&req.nl;
  552. iov.iov_len = req.nl.nlmsg_len;
  553. msg.msg_iov = &iov;
  554. msg.msg_iovlen = 1;
  555. sendmsg(fd, &msg, 0);
  556. _doRecv(fd);
  557. close(fd);
  558. }
  559. void LinuxNetLink::_requestInterfaceList()
  560. {
  561. int fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
  562. if (fd == -1) {
  563. fprintf(stderr, "Error opening RTNETLINK socket: %s\n", strerror(errno));
  564. return;
  565. }
  566. _setSocketTimeout(fd);
  567. struct sockaddr_nl la;
  568. la.nl_family = AF_NETLINK;
  569. la.nl_pid = 0; //getpid();
  570. la.nl_groups = RTMGRP_LINK;
  571. if(bind(fd, (struct sockaddr*)&la, sizeof(struct sockaddr_nl))) {
  572. fprintf(stderr, "Error binding RTNETLINK (_requestInterfaceList #1): %s\n", strerror(errno));
  573. close(fd);
  574. return;
  575. }
  576. struct nl_if_req req;
  577. bzero(&req, sizeof(req));
  578. req.nl.nlmsg_len = NLMSG_LENGTH(sizeof(struct ifinfomsg));
  579. req.nl.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
  580. req.nl.nlmsg_type = RTM_GETLINK;
  581. req.nl.nlmsg_pid = 0;
  582. req.nl.nlmsg_seq = ++_seq;
  583. req.ifa.ifi_family = AF_UNSPEC;
  584. struct sockaddr_nl pa;
  585. bzero(&pa, sizeof(pa));
  586. pa.nl_family = AF_NETLINK;
  587. struct msghdr msg;
  588. bzero(&msg, sizeof(msg));
  589. msg.msg_name = (void*)&pa;
  590. msg.msg_namelen = sizeof(pa);
  591. struct iovec iov;
  592. bzero(&iov, sizeof(iov));
  593. iov.iov_base = (void*)&req.nl;
  594. iov.iov_len = req.nl.nlmsg_len;
  595. msg.msg_iov = &iov;
  596. msg.msg_iovlen = 1;
  597. sendmsg(fd, &msg, 0);
  598. _doRecv(fd);
  599. close(fd);
  600. }
  601. void LinuxNetLink::addRoute(const InetAddress &target, const InetAddress &via, const InetAddress &src, const char *ifaceName)
  602. {
  603. if (!target) return;
  604. int fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
  605. if (fd == -1) {
  606. fprintf(stderr, "Error opening RTNETLINK socket: %s\n", strerror(errno));
  607. return;
  608. }
  609. _setSocketTimeout(fd);
  610. struct sockaddr_nl la;
  611. bzero(&la, sizeof(la));
  612. la.nl_family = AF_NETLINK;
  613. la.nl_pid = 0; //getpid();
  614. if(bind(fd, (struct sockaddr*)&la, sizeof(struct sockaddr_nl))) {
  615. fprintf(stderr, "Error binding RTNETLINK (addRoute #1): %s\n", strerror(errno));
  616. close(fd);
  617. return;
  618. }
  619. #ifdef ZT_NETLINK_TRACE
  620. char tmp[64];
  621. char tmp2[64];
  622. char tmp3[64];
  623. fprintf(stderr, "Adding Route. target: %s via: %s src: %s iface: %s\n", target.toString(tmp), via.toString(tmp2), src.toString(tmp3), ifaceName);
  624. #endif
  625. int rtl = sizeof(struct rtmsg);
  626. struct nl_route_req req;
  627. bzero(&req, sizeof(req));
  628. struct rtattr *rtap = (struct rtattr *)req.buf;
  629. rtap->rta_type = RTA_DST;
  630. if (target.isV4()) {
  631. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  632. memcpy(RTA_DATA(rtap), &((struct sockaddr_in*)&target)->sin_addr, sizeof(struct in_addr));
  633. } else {
  634. rtap->rta_len = RTA_LENGTH(sizeof(struct in6_addr));
  635. memcpy(RTA_DATA(rtap), &((struct sockaddr_in6*)&target)->sin6_addr, sizeof(struct in6_addr));
  636. }
  637. rtl += rtap->rta_len;
  638. if(via) {
  639. /*
  640. * Setting a metric keeps zerotier routes from taking priority over physical
  641. * At best the computer would use zerotier through the router instead of the LAN.
  642. * At worst it stops working at all.
  643. *
  644. * default via 192.168.82.1 dev eth0 proto dhcp src 192.168.82.169 metric 202
  645. * 10.147.17.0/24 dev zt5u4uptmb proto kernel scope link src 10.147.17.94
  646. * 192.168.82.0/24 dev eth0 proto dhcp scope link src 192.168.82.169 metric 202
  647. * 192.168.82.0/24 via 10.147.17.1 dev zt5u4uptmb proto static metric 5000
  648. *
  649. */
  650. rtap = (struct rtattr*)(((char*)rtap) + rtap->rta_len);
  651. rtap->rta_type = RTA_PRIORITY;
  652. rtap->rta_len = RTA_LENGTH(sizeof(ZT_RTE_METRIC));
  653. memcpy(RTA_DATA(rtap), &ZT_RTE_METRIC, sizeof(ZT_RTE_METRIC));
  654. rtl += rtap->rta_len;
  655. rtap = (struct rtattr *)(((char*)rtap)+rtap->rta_len);
  656. rtap->rta_type = RTA_GATEWAY;
  657. if(via.isV4()) {
  658. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  659. memcpy(RTA_DATA(rtap), &((struct sockaddr_in*)&via)->sin_addr, sizeof(struct in_addr));
  660. } else {
  661. rtap->rta_len = RTA_LENGTH(sizeof(struct in6_addr));
  662. memcpy(RTA_DATA(rtap), &((struct sockaddr_in6*)&via)->sin6_addr, sizeof(struct in6_addr));
  663. }
  664. rtl += rtap->rta_len;
  665. } else if (src) {
  666. rtap = (struct rtattr *)(((char*)rtap)+rtap->rta_len);
  667. rtap->rta_type = RTA_SRC;
  668. if(src.isV4()) {
  669. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  670. memcpy(RTA_DATA(rtap), &((struct sockaddr_in*)&src)->sin_addr, sizeof(struct in_addr));
  671. } else {
  672. rtap->rta_len = RTA_LENGTH(sizeof(struct in6_addr));
  673. memcpy(RTA_DATA(rtap), &((struct sockaddr_in6*)&src)->sin6_addr, sizeof(struct in6_addr));
  674. }
  675. req.rt.rtm_src_len = src.netmaskBits();
  676. }
  677. if (ifaceName != NULL) {
  678. int interface_index = _indexForInterface(ifaceName);
  679. if (interface_index != -1) {
  680. rtap = (struct rtattr *) (((char*)rtap) + rtap->rta_len);
  681. rtap->rta_type = RTA_OIF;
  682. rtap->rta_len = RTA_LENGTH(sizeof(int));
  683. memcpy(RTA_DATA(rtap), &interface_index, sizeof(int));
  684. rtl += rtap->rta_len;
  685. }
  686. }
  687. req.nl.nlmsg_len = NLMSG_LENGTH(rtl);
  688. req.nl.nlmsg_flags = NLM_F_REQUEST | NLM_F_EXCL | NLM_F_CREATE | NLM_F_ACK;
  689. req.nl.nlmsg_type = RTM_NEWROUTE;
  690. req.nl.nlmsg_pid = 0;
  691. req.nl.nlmsg_seq = ++_seq;
  692. req.rt.rtm_family = target.ss_family;
  693. req.rt.rtm_table = RT_TABLE_MAIN;
  694. req.rt.rtm_protocol = RTPROT_STATIC;
  695. req.rt.rtm_scope = RT_SCOPE_UNIVERSE;
  696. req.rt.rtm_type = RTN_UNICAST;
  697. req.rt.rtm_dst_len = target.netmaskBits();
  698. req.rt.rtm_flags = 0;
  699. struct sockaddr_nl pa;
  700. bzero(&pa, sizeof(pa));
  701. pa.nl_family = AF_NETLINK;
  702. struct msghdr msg;
  703. bzero(&msg, sizeof(msg));
  704. msg.msg_name = (void*)&pa;
  705. msg.msg_namelen = sizeof(pa);
  706. struct iovec iov;
  707. bzero(&iov, sizeof(iov));
  708. iov.iov_base = (void*)&req.nl;
  709. iov.iov_len = req.nl.nlmsg_len;
  710. msg.msg_iov = &iov;
  711. msg.msg_iovlen = 1;
  712. sendmsg(fd, &msg, 0);
  713. _doRecv(fd);
  714. close(fd);
  715. }
  716. void LinuxNetLink::delRoute(const InetAddress &target, const InetAddress &via, const InetAddress &src, const char *ifaceName)
  717. {
  718. if (!target) return;
  719. int fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
  720. if (fd == -1) {
  721. fprintf(stderr, "Error opening RTNETLINK socket: %s\n", strerror(errno));
  722. return;
  723. }
  724. _setSocketTimeout(fd);
  725. struct sockaddr_nl la;
  726. la.nl_family = AF_NETLINK;
  727. la.nl_pid = 0; //getpid();
  728. if(bind(fd, (struct sockaddr*)&la, sizeof(struct sockaddr_nl))) {
  729. fprintf(stderr, "Error binding RTNETLINK (delRoute #1): %s\n", strerror(errno));
  730. close(fd);
  731. return;
  732. }
  733. #ifdef ZT_NETLINK_TRACE
  734. char tmp[64];
  735. char tmp2[64];
  736. char tmp3[64];
  737. fprintf(stderr, "Removing Route. target: %s via: %s src: %s iface: %s\n", target.toString(tmp), via.toString(tmp2), src.toString(tmp3), ifaceName);
  738. #endif
  739. int rtl = sizeof(struct rtmsg);
  740. struct nl_route_req req;
  741. bzero(&req, sizeof(req));
  742. struct rtattr *rtap = (struct rtattr *)req.buf;
  743. rtap->rta_type = RTA_DST;
  744. if (target.isV4()) {
  745. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  746. memcpy(RTA_DATA(rtap), &((struct sockaddr_in*)&target)->sin_addr, sizeof(struct in_addr));
  747. } else {
  748. rtap->rta_len = RTA_LENGTH(sizeof(struct in6_addr));
  749. memcpy(RTA_DATA(rtap), &((struct sockaddr_in6*)&target)->sin6_addr, sizeof(struct in6_addr));
  750. }
  751. rtl += rtap->rta_len;
  752. if(via) {
  753. rtap = (struct rtattr *)(((char*)rtap)+rtap->rta_len);
  754. rtap->rta_type = RTA_GATEWAY;
  755. if(via.isV4()) {
  756. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  757. memcpy(RTA_DATA(rtap), &((struct sockaddr_in*)&via)->sin_addr, sizeof(struct in_addr));
  758. } else {
  759. rtap->rta_len = RTA_LENGTH(sizeof(struct in6_addr));
  760. memcpy(RTA_DATA(rtap), &((struct sockaddr_in6*)&via)->sin6_addr, sizeof(struct in6_addr));
  761. }
  762. rtl += rtap->rta_len;
  763. } else if (src) {
  764. rtap = (struct rtattr *)(((char*)rtap)+rtap->rta_len);
  765. rtap->rta_type = RTA_SRC;
  766. if(src.isV4()) {
  767. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  768. memcpy(RTA_DATA(rtap), &((struct sockaddr_in*)&src)->sin_addr, sizeof(struct in_addr));
  769. } else {
  770. rtap->rta_len = RTA_LENGTH(sizeof(struct in6_addr));
  771. memcpy(RTA_DATA(rtap), &((struct sockaddr_in6*)&src)->sin6_addr, sizeof(struct in6_addr));
  772. }
  773. req.rt.rtm_src_len = src.netmaskBits();
  774. }
  775. if (ifaceName != NULL) {
  776. int interface_index = _indexForInterface(ifaceName);
  777. if (interface_index != -1) {
  778. rtap = (struct rtattr *) (((char*)rtap) + rtap->rta_len);
  779. rtap->rta_type = RTA_OIF;
  780. rtap->rta_len = RTA_LENGTH(sizeof(int));
  781. memcpy(RTA_DATA(rtap), &interface_index, sizeof(int));
  782. rtl += rtap->rta_len;
  783. }
  784. }
  785. req.nl.nlmsg_len = NLMSG_LENGTH(rtl);
  786. req.nl.nlmsg_flags = NLM_F_REQUEST;
  787. req.nl.nlmsg_type = RTM_DELROUTE;
  788. req.nl.nlmsg_pid = 0;
  789. req.nl.nlmsg_seq = ++_seq;
  790. req.rt.rtm_family = target.ss_family;
  791. req.rt.rtm_table = RT_TABLE_MAIN;
  792. req.rt.rtm_protocol = RTPROT_STATIC;
  793. req.rt.rtm_scope = RT_SCOPE_UNIVERSE;
  794. req.rt.rtm_type = RTN_UNICAST;
  795. req.rt.rtm_dst_len = target.netmaskBits();
  796. req.rt.rtm_flags = 0;
  797. struct sockaddr_nl pa;
  798. bzero(&pa, sizeof(pa));
  799. pa.nl_family = AF_NETLINK;
  800. struct msghdr msg;
  801. bzero(&msg, sizeof(msg));
  802. msg.msg_name = (void*)&pa;
  803. msg.msg_namelen = sizeof(pa);
  804. struct iovec iov;
  805. bzero(&iov, sizeof(iov));
  806. iov.iov_base = (void*)&req.nl;
  807. iov.iov_len = req.nl.nlmsg_len;
  808. msg.msg_iov = &iov;
  809. msg.msg_iovlen = 1;
  810. sendmsg(fd, &msg, 0);
  811. _doRecv(fd);
  812. close(fd);
  813. }
  814. void LinuxNetLink::addAddress(const InetAddress &addr, const char *iface)
  815. {
  816. int fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
  817. if (fd == -1) {
  818. fprintf(stderr, "Error opening RTNETLINK socket: %s\n", strerror(errno));
  819. return;
  820. }
  821. _setSocketTimeout(fd);
  822. struct sockaddr_nl la;
  823. memset(&la,0,sizeof(la));
  824. la.nl_family = AF_NETLINK;
  825. la.nl_pid = 0; //getpid();
  826. if (addr.isV4()) {
  827. la.nl_groups = RTMGRP_IPV4_IFADDR;
  828. } else {
  829. la.nl_groups = RTMGRP_IPV6_IFADDR;
  830. }
  831. if(bind(fd, (struct sockaddr*)&la, sizeof(struct sockaddr_nl))) {
  832. fprintf(stderr, "Error binding RTNETLINK (addAddress #1): %s\n", strerror(errno));
  833. close(fd);
  834. return;
  835. }
  836. #ifdef ZT_NETLINK_TRACE
  837. char tmp[128];
  838. fprintf(stderr, "Adding IP address %s to interface %s\n", addr.toString(tmp), iface);
  839. #endif
  840. int interface_index = _indexForInterface(iface);
  841. for (int reps = 0; interface_index == -1 && reps < 10; ++reps) {
  842. Thread::sleep(100);
  843. interface_index = _indexForInterface(iface);
  844. }
  845. if (interface_index == -1) {
  846. fprintf(stderr, "Unable to find index for interface %s\n", iface);
  847. close(fd);
  848. return;
  849. }
  850. int rtl = sizeof(struct ifaddrmsg);
  851. struct nl_adr_req req;
  852. bzero(&req, sizeof(struct nl_adr_req));
  853. struct rtattr *rtap = (struct rtattr *)req.buf;;
  854. if(addr.isV4()) {
  855. struct sockaddr_in *addr_v4 = (struct sockaddr_in*)&addr;
  856. rtap->rta_type = IFA_ADDRESS;
  857. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  858. memcpy(RTA_DATA(rtap), &addr_v4->sin_addr, sizeof(struct in_addr));
  859. rtl += rtap->rta_len;
  860. rtap = (struct rtattr*)(((char*)rtap) + rtap->rta_len);
  861. rtap->rta_type = IFA_LOCAL;
  862. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  863. memcpy(RTA_DATA(rtap), &addr_v4->sin_addr, sizeof(struct in_addr));
  864. rtl += rtap->rta_len;
  865. InetAddress broadcast = addr.broadcast();
  866. if(broadcast) {
  867. rtap = (struct rtattr*)(((char*)rtap)+rtap->rta_len);
  868. struct sockaddr_in *bcast = (struct sockaddr_in*)&broadcast;
  869. rtap->rta_type = IFA_BROADCAST;
  870. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  871. memcpy(RTA_DATA(rtap), &bcast->sin_addr, sizeof(struct in_addr));
  872. rtl += rtap->rta_len;
  873. }
  874. } else { //V6
  875. rtap->rta_type = IFA_ADDRESS;
  876. struct sockaddr_in6 *addr_v6 = (struct sockaddr_in6*)&addr;
  877. rtap->rta_len = RTA_LENGTH(sizeof(struct in6_addr));
  878. memcpy(RTA_DATA(rtap), &addr_v6->sin6_addr, sizeof(struct in6_addr));
  879. rtl += rtap->rta_len;
  880. }
  881. if (iface) {
  882. rtap = (struct rtattr*)(((char*)rtap)+rtap->rta_len);
  883. rtap->rta_type = IFA_LABEL;
  884. rtap->rta_len = RTA_LENGTH(strlen(iface));
  885. memcpy(RTA_DATA(rtap), iface, strlen(iface));
  886. rtl += rtap->rta_len;
  887. }
  888. req.nl.nlmsg_len = NLMSG_LENGTH(rtl);
  889. req.nl.nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE | NLM_F_EXCL;
  890. req.nl.nlmsg_type = RTM_NEWADDR;
  891. req.nl.nlmsg_pid = 0;
  892. req.nl.nlmsg_seq = ++_seq;
  893. req.ifa.ifa_family = addr.ss_family;
  894. req.ifa.ifa_prefixlen = addr.port();
  895. req.ifa.ifa_flags = IFA_F_PERMANENT;
  896. req.ifa.ifa_scope = 0;
  897. req.ifa.ifa_index = interface_index;
  898. struct sockaddr_nl pa;
  899. bzero(&pa, sizeof(sockaddr_nl));
  900. pa.nl_family = AF_NETLINK;
  901. struct msghdr msg;
  902. bzero(&msg, sizeof(msg));
  903. msg.msg_name = (void*)&pa;
  904. msg.msg_namelen = sizeof(pa);
  905. struct iovec iov;
  906. iov.iov_base = (void*)&req.nl;
  907. iov.iov_len = req.nl.nlmsg_len;
  908. msg.msg_iov = &iov;
  909. msg.msg_iovlen = 1;
  910. sendmsg(fd, &msg, 0);
  911. _doRecv(fd);
  912. close(fd);
  913. }
  914. void LinuxNetLink::removeAddress(const InetAddress &addr, const char *iface)
  915. {
  916. int fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
  917. if (fd == -1) {
  918. fprintf(stderr, "Error opening RTNETLINK socket: %s\n", strerror(errno));
  919. return;
  920. }
  921. _setSocketTimeout(fd);
  922. struct sockaddr_nl la;
  923. la.nl_family = AF_NETLINK;
  924. la.nl_pid = 0; //getpid();
  925. if (addr.isV4()) {
  926. la.nl_groups = RTMGRP_IPV4_IFADDR;
  927. } else {
  928. la.nl_groups = RTMGRP_IPV6_IFADDR;
  929. }
  930. if(bind(fd, (struct sockaddr*)&la, sizeof(struct sockaddr_nl))) {
  931. fprintf(stderr, "Error binding RTNETLINK (removeAddress #1): %s\n", strerror(errno));
  932. close(fd);
  933. return;
  934. }
  935. #ifdef ZT_NETLINK_TRACE
  936. char tmp[128];
  937. fprintf(stderr, "Removing IP address %s from interface %s\n", addr.toString(tmp), iface);
  938. #endif
  939. int interface_index = _indexForInterface(iface);
  940. if (interface_index == -1) {
  941. fprintf(stderr, "Unable to find index for interface %s\n", iface);
  942. close(fd);
  943. return;
  944. }
  945. int rtl = sizeof(struct ifaddrmsg);
  946. struct nl_adr_req req;
  947. bzero(&req, sizeof(struct nl_adr_req));
  948. struct rtattr *rtap = (struct rtattr *)req.buf;
  949. if(addr.isV4()) {
  950. struct sockaddr_in *addr_v4 = (struct sockaddr_in*)&addr;
  951. rtap->rta_type = IFA_ADDRESS;
  952. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  953. memcpy(RTA_DATA(rtap), &addr_v4->sin_addr, sizeof(struct in_addr));
  954. rtl += rtap->rta_len;
  955. rtap = (struct rtattr*)(((char*)rtap) + rtap->rta_len);
  956. rtap->rta_type = IFA_LOCAL;
  957. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  958. memcpy(RTA_DATA(rtap), &addr_v4->sin_addr, sizeof(struct in_addr));
  959. rtl += rtap->rta_len;
  960. InetAddress broadcast = addr.broadcast();
  961. if(broadcast) {
  962. rtap = (struct rtattr*)(((char*)rtap)+rtap->rta_len);
  963. struct sockaddr_in *bcast = (struct sockaddr_in*)&broadcast;
  964. rtap->rta_type = IFA_BROADCAST;
  965. rtap->rta_len = RTA_LENGTH(sizeof(struct in_addr));
  966. memcpy(RTA_DATA(rtap), &bcast->sin_addr, sizeof(struct in_addr));
  967. rtl += rtap->rta_len;
  968. }
  969. } else { //V6
  970. rtap->rta_type = IFA_ADDRESS;
  971. struct sockaddr_in6 *addr_v6 = (struct sockaddr_in6*)&addr;
  972. rtap->rta_len = RTA_LENGTH(sizeof(struct in6_addr));
  973. memcpy(RTA_DATA(rtap), &addr_v6->sin6_addr, sizeof(struct in6_addr));
  974. rtl += rtap->rta_len;
  975. }
  976. if (iface) {
  977. rtap = (struct rtattr*)(((char*)rtap)+rtap->rta_len);
  978. rtap->rta_type = IFA_LABEL;
  979. rtap->rta_len = RTA_LENGTH(strlen(iface));
  980. memcpy(RTA_DATA(rtap), iface, strlen(iface));
  981. rtl += rtap->rta_len;
  982. }
  983. req.nl.nlmsg_len = NLMSG_LENGTH(rtl);
  984. req.nl.nlmsg_flags = NLM_F_REQUEST;
  985. req.nl.nlmsg_type = RTM_DELADDR;
  986. req.nl.nlmsg_pid = 0;
  987. req.nl.nlmsg_seq = ++_seq;
  988. req.ifa.ifa_family = addr.ss_family;
  989. req.ifa.ifa_prefixlen = addr.port();
  990. req.ifa.ifa_flags = IFA_F_PERMANENT;
  991. req.ifa.ifa_scope = 0;
  992. req.ifa.ifa_index = interface_index;
  993. struct sockaddr_nl pa;
  994. bzero(&pa, sizeof(sockaddr_nl));
  995. pa.nl_family = AF_NETLINK;
  996. struct msghdr msg;
  997. bzero(&msg, sizeof(msg));
  998. msg.msg_name = (void*)&pa;
  999. msg.msg_namelen = sizeof(pa);
  1000. struct iovec iov;
  1001. iov.iov_base = (void*)&req.nl;
  1002. iov.iov_len = req.nl.nlmsg_len;
  1003. msg.msg_iov = &iov;
  1004. msg.msg_iovlen = 1;
  1005. sendmsg(fd, &msg, 0);
  1006. _doRecv(fd);
  1007. close(fd);
  1008. }
  1009. bool LinuxNetLink::routeIsSet(const InetAddress &target, const InetAddress &via, const InetAddress &src, const char *ifname)
  1010. {
  1011. Mutex::Lock rl(_routes_m);
  1012. const std::set<LinuxNetLink::Route> &rs = _routes[target];
  1013. for(std::set<LinuxNetLink::Route>::const_iterator ri(rs.begin());ri!=rs.end();++ri) {
  1014. if ((ri->via == via)&&(ri->src == src)) {
  1015. if (ifname) {
  1016. Mutex::Lock ifl(_if_m);
  1017. const iface_entry *ife = _interfaces.get(ri->ifidx);
  1018. if ((ife)&&(!strncmp(ife->ifacename,ifname,IFNAMSIZ)))
  1019. return true;
  1020. } else {
  1021. return true;
  1022. }
  1023. }
  1024. }
  1025. return false;
  1026. }
  1027. int LinuxNetLink::_indexForInterface(const char *iface)
  1028. {
  1029. Mutex::Lock l(_if_m);
  1030. int interface_index = -1;
  1031. Hashtable<int, iface_entry>::Iterator iter(_interfaces);
  1032. int *k = NULL;
  1033. iface_entry *v = NULL;
  1034. while(iter.next(k,v)) {
  1035. if(strcmp(iface, v->ifacename) == 0) {
  1036. interface_index = v->index;
  1037. break;
  1038. }
  1039. }
  1040. return interface_index;
  1041. }
  1042. } // namespace ZeroTier
  1043. #endif