SocketManager.cpp 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689
  1. /*
  2. * ZeroTier One - Global Peer to Peer Ethernet
  3. * Copyright (C) 2011-2014 ZeroTier Networks LLC
  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 <stdlib.h>
  30. #include <fcntl.h>
  31. #include <time.h>
  32. #include <sys/types.h>
  33. #include "SocketManager.hpp"
  34. #include "UdpSocket.hpp"
  35. #include "TcpSocket.hpp"
  36. #ifndef __WINDOWS__
  37. #include <errno.h>
  38. #include <unistd.h>
  39. #include <sys/socket.h>
  40. #include <arpa/inet.h>
  41. #include <signal.h>
  42. #include <netinet/in.h>
  43. #include <netinet/tcp.h>
  44. #endif
  45. // Uncomment to turn off TCP Nagle
  46. //#define ZT_TCP_NODELAY
  47. // Allow us to use the same value on Windows and *nix
  48. #ifndef INVALID_SOCKET
  49. #define INVALID_SOCKET (-1)
  50. #endif
  51. #ifdef __WINDOWS__
  52. #define CLOSE_SOCKET(s) ::closesocket(s)
  53. #else
  54. #define CLOSE_SOCKET(s) ::close(s)
  55. #endif
  56. namespace ZeroTier {
  57. #ifdef __WINDOWS__
  58. // hack copied from StackOverflow, behaves a bit like pipe() on *nix systems
  59. static inline void winPipeHack(SOCKET fds[2])
  60. {
  61. struct sockaddr_in inaddr;
  62. struct sockaddr addr;
  63. SOCKET lst=::socket(AF_INET, SOCK_STREAM,IPPROTO_TCP);
  64. memset(&inaddr, 0, sizeof(inaddr));
  65. memset(&addr, 0, sizeof(addr));
  66. inaddr.sin_family = AF_INET;
  67. inaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
  68. inaddr.sin_port = 0;
  69. int yes=1;
  70. setsockopt(lst,SOL_SOCKET,SO_REUSEADDR,(char*)&yes,sizeof(yes));
  71. bind(lst,(struct sockaddr *)&inaddr,sizeof(inaddr));
  72. listen(lst,1);
  73. int len=sizeof(inaddr);
  74. getsockname(lst, &addr,&len);
  75. fds[0]=::socket(AF_INET, SOCK_STREAM,0);
  76. connect(fds[0],&addr,len);
  77. fds[1]=accept(lst,0,0);
  78. closesocket(lst);
  79. }
  80. #endif
  81. SocketManager::SocketManager(
  82. int localUdpPort,
  83. int localTcpPort,
  84. void (*packetHandler)(const SharedPtr<Socket> &,void *,const InetAddress &,Buffer<ZT_SOCKET_MAX_MESSAGE_LEN> &),
  85. void *arg) :
  86. _whackSendPipe(INVALID_SOCKET),
  87. _whackReceivePipe(INVALID_SOCKET),
  88. _tcpV4ListenSocket(INVALID_SOCKET),
  89. _tcpV6ListenSocket(INVALID_SOCKET),
  90. _nfds(0),
  91. _packetHandler(packetHandler),
  92. _arg(arg)
  93. {
  94. FD_ZERO(&_readfds);
  95. FD_ZERO(&_writefds);
  96. // Create a pipe or socket pair that can be used to interrupt select()
  97. #ifdef __WINDOWS__
  98. {
  99. SOCKET tmps[2] = { INVALID_SOCKET,INVALID_SOCKET };
  100. winPipeHack(tmps);
  101. _whackSendPipe = tmps[0];
  102. _whackReceivePipe = tmps[1];
  103. u_long iMode=1;
  104. ioctlsocket(tmps[1],FIONBIO,&iMode);
  105. }
  106. #else
  107. {
  108. int tmpfds[2];
  109. if (::pipe(tmpfds))
  110. throw std::runtime_error("pipe() failed");
  111. _whackSendPipe = tmpfds[1];
  112. _whackReceivePipe = tmpfds[0];
  113. fcntl(_whackReceivePipe,F_SETFL,O_NONBLOCK);
  114. }
  115. #endif
  116. FD_SET(_whackReceivePipe,&_readfds);
  117. if (localTcpPort > 0) {
  118. if (localTcpPort > 0xffff) {
  119. _closeSockets();
  120. throw std::runtime_error("invalid local TCP port number");
  121. }
  122. { // bind TCP IPv6
  123. _tcpV6ListenSocket = ::socket(AF_INET6,SOCK_STREAM,0);
  124. #ifdef __WINDOWS__
  125. if (_tcpV6ListenSocket == INVALID_SOCKET) {
  126. #else
  127. if (_tcpV6ListenSocket <= 0) {
  128. #endif
  129. _closeSockets();
  130. throw std::runtime_error("unable to create IPv6 SOCK_STREAM socket");
  131. }
  132. #ifdef __WINDOWS__
  133. {
  134. BOOL f;
  135. f = TRUE; ::setsockopt(_tcpV6ListenSocket,IPPROTO_IPV6,IPV6_V6ONLY,(const char *)&f,sizeof(f));
  136. f = TRUE; ::setsockopt(_tcpV6ListenSocket,SOL_SOCKET,SO_REUSEADDR,(const char *)&f,sizeof(f));
  137. u_long iMode=1;
  138. ioctlsocket(_tcpV6ListenSocket,FIONBIO,&iMode);
  139. }
  140. #else
  141. {
  142. int f;
  143. f = 1; ::setsockopt(_tcpV6ListenSocket,IPPROTO_IPV6,IPV6_V6ONLY,(void *)&f,sizeof(f));
  144. f = 1; ::setsockopt(_tcpV6ListenSocket,SOL_SOCKET,SO_REUSEADDR,(void *)&f,sizeof(f));
  145. fcntl(_tcpV6ListenSocket,F_SETFL,O_NONBLOCK);
  146. }
  147. #endif
  148. struct sockaddr_in6 sin6;
  149. memset(&sin6,0,sizeof(sin6));
  150. sin6.sin6_family = AF_INET6;
  151. sin6.sin6_port = htons(localTcpPort);
  152. memcpy(&(sin6.sin6_addr),&in6addr_any,sizeof(struct in6_addr));
  153. if (::bind(_tcpV6ListenSocket,(const struct sockaddr *)&sin6,sizeof(sin6))) {
  154. _closeSockets();
  155. throw std::runtime_error("unable to bind to local TCP port");
  156. }
  157. if (::listen(_tcpV6ListenSocket,16)) {
  158. _closeSockets();
  159. throw std::runtime_error("listen() failed");
  160. }
  161. FD_SET(_tcpV6ListenSocket,&_readfds);
  162. }
  163. { // bind TCP IPv4
  164. _tcpV4ListenSocket = ::socket(AF_INET,SOCK_STREAM,0);
  165. #ifdef __WINDOWS__
  166. if (_tcpV4ListenSocket == INVALID_SOCKET) {
  167. #else
  168. if (_tcpV4ListenSocket <= 0) {
  169. #endif
  170. _closeSockets();
  171. throw std::runtime_error("unable to create IPv4 SOCK_STREAM socket");
  172. }
  173. #ifdef __WINDOWS__
  174. {
  175. BOOL f = TRUE; ::setsockopt(_tcpV4ListenSocket,SOL_SOCKET,SO_REUSEADDR,(const char *)&f,sizeof(f));
  176. u_long iMode=1;
  177. ioctlsocket(_tcpV4ListenSocket,FIONBIO,&iMode);
  178. }
  179. #else
  180. {
  181. int f = 1; ::setsockopt(_tcpV4ListenSocket,SOL_SOCKET,SO_REUSEADDR,(void *)&f,sizeof(f));
  182. fcntl(_tcpV4ListenSocket,F_SETFL,O_NONBLOCK);
  183. }
  184. #endif
  185. struct sockaddr_in sin4;
  186. memset(&sin4,0,sizeof(sin4));
  187. sin4.sin_family = AF_INET;
  188. sin4.sin_port = htons(localTcpPort);
  189. sin4.sin_addr.s_addr = INADDR_ANY;
  190. if (::bind(_tcpV4ListenSocket,(const struct sockaddr *)&sin4,sizeof(sin4))) {
  191. _closeSockets();
  192. throw std::runtime_error("unable to bind to local TCP port");
  193. }
  194. if (::listen(_tcpV4ListenSocket,16)) {
  195. _closeSockets();
  196. throw std::runtime_error("listen() failed");
  197. }
  198. FD_SET(_tcpV4ListenSocket,&_readfds);
  199. }
  200. }
  201. if (localUdpPort > 0) {
  202. if (localUdpPort > 0xffff) {
  203. _closeSockets();
  204. throw std::runtime_error("invalid local UDP port number");
  205. }
  206. { // bind UDP IPv6
  207. #ifdef __WINDOWS__
  208. SOCKET s = ::socket(AF_INET6,SOCK_DGRAM,0);
  209. if (s == INVALID_SOCKET) {
  210. _closeSockets();
  211. throw std::runtime_error("unable to create IPv6 SOCK_DGRAM socket");
  212. }
  213. #else
  214. int s = ::socket(AF_INET6,SOCK_DGRAM,0);
  215. if (s <= 0) {
  216. _closeSockets();
  217. throw std::runtime_error("unable to create IPv6 SOCK_DGRAM socket");
  218. }
  219. #endif
  220. {
  221. #ifdef __WINDOWS__
  222. BOOL f;
  223. f = TRUE; setsockopt(s,IPPROTO_IPV6,IPV6_V6ONLY,(const char *)&f,sizeof(f));
  224. f = FALSE; setsockopt(s,SOL_SOCKET,SO_REUSEADDR,(const char *)&f,sizeof(f));
  225. f = FALSE; setsockopt(s,IPPROTO_IPV6,IPV6_DONTFRAG,(const char *)&f,sizeof(f));
  226. #else
  227. int f;
  228. f = 1; setsockopt(s,IPPROTO_IPV6,IPV6_V6ONLY,(void *)&f,sizeof(f));
  229. f = 0; setsockopt(s,SOL_SOCKET,SO_REUSEADDR,(void *)&f,sizeof(f));
  230. #ifdef IP_DONTFRAG
  231. f = 0; setsockopt(s,IPPROTO_IP,IP_DONTFRAG,&f,sizeof(f));
  232. #endif
  233. #ifdef IP_MTU_DISCOVER
  234. f = 0; setsockopt(s,IPPROTO_IP,IP_MTU_DISCOVER,&f,sizeof(f));
  235. #endif
  236. #ifdef IPV6_MTU_DISCOVER
  237. f = 0; setsockopt(s,IPPROTO_IPV6,IPV6_MTU_DISCOVER,&f,sizeof(f));
  238. #endif
  239. #endif
  240. }
  241. struct sockaddr_in6 sin6;
  242. memset(&sin6,0,sizeof(sin6));
  243. sin6.sin6_family = AF_INET6;
  244. sin6.sin6_port = htons(localUdpPort);
  245. memcpy(&(sin6.sin6_addr),&in6addr_any,sizeof(struct in6_addr));
  246. if (::bind(s,(const struct sockaddr *)&sin6,sizeof(sin6))) {
  247. CLOSE_SOCKET(s);
  248. _closeSockets();
  249. throw std::runtime_error("unable to bind to port");
  250. }
  251. _udpV6Socket = SharedPtr<Socket>(new UdpSocket(Socket::ZT_SOCKET_TYPE_UDP_V6,s));
  252. #ifdef __WINDOWS__
  253. u_long iMode=1;
  254. ioctlsocket(s,FIONBIO,&iMode);
  255. #else
  256. fcntl(s,F_SETFL,O_NONBLOCK);
  257. #endif
  258. FD_SET(s,&_readfds);
  259. }
  260. { // bind UDP IPv4
  261. #ifdef __WINDOWS__
  262. SOCKET s = ::socket(AF_INET,SOCK_DGRAM,0);
  263. if (s == INVALID_SOCKET) {
  264. _closeSockets();
  265. throw std::runtime_error("unable to create IPv4 SOCK_DGRAM socket");
  266. }
  267. #else
  268. int s = ::socket(AF_INET,SOCK_DGRAM,0);
  269. if (s <= 0) {
  270. _closeSockets();
  271. throw std::runtime_error("unable to create IPv4 SOCK_DGRAM socket");
  272. }
  273. #endif
  274. {
  275. #ifdef __WINDOWS__
  276. BOOL f;
  277. f = FALSE; setsockopt(s,SOL_SOCKET,SO_REUSEADDR,(const char *)&f,sizeof(f));
  278. f = FALSE; setsockopt(s,IPPROTO_IP,IP_DONTFRAGMENT,(const char *)&f,sizeof(f));
  279. #else
  280. int f;
  281. f = 0; setsockopt(s,SOL_SOCKET,SO_REUSEADDR,(void *)&f,sizeof(f));
  282. #ifdef IP_DONTFRAG
  283. f = 0; setsockopt(s,IPPROTO_IP,IP_DONTFRAG,&f,sizeof(f));
  284. #endif
  285. #ifdef IP_MTU_DISCOVER
  286. f = 0; setsockopt(s,IPPROTO_IP,IP_MTU_DISCOVER,&f,sizeof(f));
  287. #endif
  288. #endif
  289. }
  290. struct sockaddr_in sin4;
  291. memset(&sin4,0,sizeof(sin4));
  292. sin4.sin_family = AF_INET;
  293. sin4.sin_port = htons(localUdpPort);
  294. sin4.sin_addr.s_addr = INADDR_ANY;
  295. if (::bind(s,(const struct sockaddr *)&sin4,sizeof(sin4))) {
  296. CLOSE_SOCKET(s);
  297. _closeSockets();
  298. throw std::runtime_error("unable to bind to port");
  299. }
  300. _udpV4Socket = SharedPtr<Socket>(new UdpSocket(Socket::ZT_SOCKET_TYPE_UDP_V4,s));
  301. #ifdef __WINDOWS__
  302. u_long iMode=1;
  303. ioctlsocket(s,FIONBIO,&iMode);
  304. #else
  305. fcntl(s,F_SETFL,O_NONBLOCK);
  306. #endif
  307. FD_SET(s,&_readfds);
  308. }
  309. }
  310. _updateNfds();
  311. }
  312. SocketManager::~SocketManager()
  313. {
  314. Mutex::Lock _l(_pollLock);
  315. _closeSockets();
  316. }
  317. bool SocketManager::send(const InetAddress &to,bool tcp,const void *msg,unsigned int msglen)
  318. {
  319. if (tcp) {
  320. SharedPtr<Socket> ts;
  321. {
  322. Mutex::Lock _l(_tcpSockets_m);
  323. std::map< InetAddress,SharedPtr<Socket> >::iterator opents(_tcpSockets.find(to));
  324. if (opents != _tcpSockets.end())
  325. ts = opents->second;
  326. }
  327. if (ts)
  328. return ts->send(to,msg,msglen);
  329. #ifdef __WINDOWS__
  330. SOCKET s = ::socket(to.isV4() ? AF_INET : AF_INET6,SOCK_STREAM,0);
  331. if (s == INVALID_SOCKET)
  332. return false;
  333. if (s >= FD_SETSIZE) {
  334. ::closesocket(s);
  335. return false;
  336. }
  337. { u_long iMode=1; ioctlsocket(s,FIONBIO,&iMode); }
  338. #ifdef ZT_TCP_NODELAY
  339. { BOOL f = TRUE; setsockopt(s,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  340. #endif
  341. #else
  342. int s = ::socket(to.isV4() ? AF_INET : AF_INET6,SOCK_STREAM,0);
  343. if (s <= 0)
  344. return false;
  345. if (s >= FD_SETSIZE) {
  346. ::close(s);
  347. return false;
  348. }
  349. fcntl(s,F_SETFL,O_NONBLOCK);
  350. #ifdef ZT_TCP_NODELAY
  351. { int f = 1; setsockopt(s,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  352. #endif
  353. #endif
  354. bool connecting = false;
  355. if (connect(s,to.saddr(),to.saddrLen())) {
  356. if (errno != EINPROGRESS) {
  357. CLOSE_SOCKET(s);
  358. return false;
  359. } else connecting = true;
  360. }
  361. ts = SharedPtr<Socket>(new TcpSocket(this,s,connecting,to));
  362. if (!ts->send(to,msg,msglen)) {
  363. _fdSetLock.lock();
  364. FD_CLR(s,&_readfds);
  365. FD_CLR(s,&_writefds);
  366. _fdSetLock.unlock();
  367. return false;
  368. }
  369. {
  370. Mutex::Lock _l(_tcpSockets_m);
  371. _tcpSockets[to] = ts;
  372. }
  373. _fdSetLock.lock();
  374. FD_SET(s,&_readfds);
  375. if (connecting)
  376. FD_SET(s,&_writefds);
  377. _fdSetLock.unlock();
  378. _updateNfds();
  379. whack();
  380. return true;
  381. } else if (to.isV4()) {
  382. if (_udpV4Socket)
  383. return _udpV4Socket->send(to,msg,msglen);
  384. } else if (to.isV6()) {
  385. if (_udpV6Socket)
  386. return _udpV6Socket->send(to,msg,msglen);
  387. }
  388. return false;
  389. }
  390. bool SocketManager::sendFirewallOpener(const InetAddress &to,int hopLimit)
  391. {
  392. if (to.isV4()) {
  393. if (_udpV4Socket)
  394. return ((UdpSocket *)_udpV4Socket.ptr())->sendWithHopLimit(to,"",1,hopLimit);
  395. } else if (to.isV6()) {
  396. if (_udpV6Socket)
  397. return ((UdpSocket *)_udpV6Socket.ptr())->sendWithHopLimit(to,"",1,hopLimit);
  398. }
  399. return false;
  400. }
  401. void SocketManager::poll(unsigned long timeout)
  402. {
  403. fd_set rfds,wfds,efds;
  404. struct timeval tv;
  405. std::vector< SharedPtr<Socket> > ts;
  406. #ifdef __WINDOWS__
  407. SOCKET sockfd;
  408. #else
  409. int sockfd;
  410. #endif
  411. Mutex::Lock _l(_pollLock);
  412. _fdSetLock.lock();
  413. memcpy(&rfds,&_readfds,sizeof(rfds));
  414. memcpy(&wfds,&_writefds,sizeof(wfds));
  415. _fdSetLock.unlock();
  416. FD_ZERO(&efds);
  417. tv.tv_sec = (long)(timeout / 1000);
  418. tv.tv_usec = (long)((timeout % 1000) * 1000);
  419. select(_nfds + 1,&rfds,&wfds,&efds,(timeout > 0) ? &tv : (struct timeval *)0);
  420. if (FD_ISSET(_whackReceivePipe,&rfds)) {
  421. char tmp[16];
  422. #ifdef __WINDOWS__
  423. ::recv(_whackReceivePipe,&tmp,16,0);
  424. #else
  425. ::read(_whackReceivePipe,&tmp,16);
  426. #endif
  427. }
  428. if ((_tcpV4ListenSocket != INVALID_SOCKET)&&(FD_ISSET(_tcpV4ListenSocket,&rfds))) {
  429. struct sockaddr_in from;
  430. socklen_t fromlen = sizeof(from);
  431. sockfd = accept(_tcpV4ListenSocket,(struct sockaddr *)&from,&fromlen);
  432. #ifdef __WINDOWS__
  433. if (sockfd != INVALID_SOCKET) {
  434. #else
  435. if (sockfd > 0) {
  436. #endif
  437. if (sockfd < FD_SETSIZE) {
  438. InetAddress fromia((const struct sockaddr *)&from);
  439. Mutex::Lock _l2(_tcpSockets_m);
  440. try {
  441. _tcpSockets[fromia] = SharedPtr<Socket>(new TcpSocket(this,sockfd,false,fromia));
  442. #ifdef __WINDOWS__
  443. { u_long iMode=1; ioctlsocket(sockfd,FIONBIO,&iMode); }
  444. #ifdef ZT_TCP_NODELAY
  445. { BOOL f = TRUE; setsockopt(sockfd,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  446. #endif
  447. #else
  448. fcntl(sockfd,F_SETFL,O_NONBLOCK);
  449. #ifdef ZT_TCP_NODELAY
  450. { int f = 1; setsockopt(sockfd,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  451. #endif
  452. #endif
  453. _fdSetLock.lock();
  454. FD_SET(sockfd,&_readfds);
  455. _fdSetLock.unlock();
  456. if ((int)sockfd > (int)_nfds)
  457. _nfds = (int)sockfd;
  458. } catch ( ... ) {
  459. CLOSE_SOCKET(sockfd);
  460. }
  461. } else {
  462. CLOSE_SOCKET(sockfd);
  463. }
  464. }
  465. }
  466. if ((_tcpV6ListenSocket != INVALID_SOCKET)&&(FD_ISSET(_tcpV6ListenSocket,&rfds))) {
  467. struct sockaddr_in6 from;
  468. socklen_t fromlen = sizeof(from);
  469. sockfd = accept(_tcpV6ListenSocket,(struct sockaddr *)&from,&fromlen);
  470. #ifdef __WINDOWS__
  471. if (sockfd != INVALID_SOCKET) {
  472. #else
  473. if (sockfd > 0) {
  474. #endif
  475. if (sockfd < FD_SETSIZE) {
  476. InetAddress fromia((const struct sockaddr *)&from);
  477. Mutex::Lock _l2(_tcpSockets_m);
  478. try {
  479. _tcpSockets[fromia] = SharedPtr<Socket>(new TcpSocket(this,sockfd,false,fromia));
  480. #ifdef __WINDOWS__
  481. { u_long iMode=1; ioctlsocket(sockfd,FIONBIO,&iMode); }
  482. #ifdef ZT_TCP_NODELAY
  483. { BOOL f = TRUE; setsockopt(sockfd,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  484. #endif
  485. #else
  486. fcntl(sockfd,F_SETFL,O_NONBLOCK);
  487. #ifdef ZT_TCP_NODELAY
  488. { int f = 1; setsockopt(sockfd,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  489. #endif
  490. #endif
  491. _fdSetLock.lock();
  492. FD_SET(sockfd,&_readfds);
  493. _fdSetLock.unlock();
  494. if ((int)sockfd > (int)_nfds)
  495. _nfds = (int)sockfd;
  496. } catch ( ... ) {
  497. CLOSE_SOCKET(sockfd);
  498. }
  499. } else {
  500. CLOSE_SOCKET(sockfd);
  501. }
  502. }
  503. }
  504. if ((_udpV4Socket)&&(FD_ISSET(_udpV4Socket->_sock,&rfds))) {
  505. _udpV4Socket->notifyAvailableForRead(_udpV4Socket,this);
  506. }
  507. if ((_udpV6Socket)&&(FD_ISSET(_udpV6Socket->_sock,&rfds))) {
  508. _udpV6Socket->notifyAvailableForRead(_udpV6Socket,this);
  509. }
  510. bool closedSockets = false;
  511. { // grab copy of TCP sockets list because _tcpSockets[] might be changed in a handler
  512. Mutex::Lock _l2(_tcpSockets_m);
  513. if (!_tcpSockets.empty()) {
  514. ts.reserve(_tcpSockets.size());
  515. uint64_t now = Utils::now();
  516. for(std::map< InetAddress,SharedPtr<Socket> >::iterator s(_tcpSockets.begin());s!=_tcpSockets.end();) {
  517. if ((now - ((TcpSocket *)s->second.ptr())->_lastActivity) < ZT_TCP_TUNNEL_ACTIVITY_TIMEOUT) {
  518. ts.push_back(s->second);
  519. ++s;
  520. } else {
  521. _fdSetLock.lock();
  522. FD_CLR(s->second->_sock,&_readfds);
  523. FD_CLR(s->second->_sock,&_writefds);
  524. _fdSetLock.unlock();
  525. _tcpSockets.erase(s++);
  526. closedSockets = true;
  527. }
  528. }
  529. }
  530. }
  531. for(std::vector< SharedPtr<Socket> >::iterator s(ts.begin());s!=ts.end();++s) {
  532. if (FD_ISSET((*s)->_sock,&wfds)) {
  533. if (!(*s)->notifyAvailableForWrite(*s,this)) {
  534. {
  535. Mutex::Lock _l2(_tcpSockets_m);
  536. _tcpSockets.erase(((TcpSocket *)s->ptr())->_remote);
  537. }
  538. _fdSetLock.lock();
  539. FD_CLR((*s)->_sock,&_readfds);
  540. FD_CLR((*s)->_sock,&_writefds);
  541. _fdSetLock.unlock();
  542. closedSockets = true;
  543. continue;
  544. }
  545. }
  546. if (FD_ISSET((*s)->_sock,&rfds)) {
  547. if (!(*s)->notifyAvailableForRead(*s,this)) {
  548. {
  549. Mutex::Lock _l2(_tcpSockets_m);
  550. _tcpSockets.erase(((TcpSocket *)s->ptr())->_remote);
  551. }
  552. _fdSetLock.lock();
  553. FD_CLR((*s)->_sock,&_readfds);
  554. FD_CLR((*s)->_sock,&_writefds);
  555. _fdSetLock.unlock();
  556. closedSockets = true;
  557. continue;
  558. }
  559. }
  560. }
  561. if (closedSockets)
  562. _updateNfds();
  563. }
  564. void SocketManager::whack()
  565. {
  566. _whackSendPipe_m.lock();
  567. #ifdef __WINDOWS__
  568. ::send(_whackSendPipe,(const char *)this,1,0);
  569. #else
  570. ::write(_whackSendPipe,(const void *)this,1); // data is arbitrary, just send a byte
  571. #endif
  572. _whackSendPipe_m.unlock();
  573. }
  574. void SocketManager::closeTcpSockets()
  575. {
  576. {
  577. Mutex::Lock _l2(_tcpSockets_m);
  578. _fdSetLock.lock();
  579. for(std::map< InetAddress,SharedPtr<Socket> >::iterator s(_tcpSockets.begin());s!=_tcpSockets.end();++s) {
  580. FD_CLR(s->second->_sock,&_readfds);
  581. FD_CLR(s->second->_sock,&_writefds);
  582. }
  583. _fdSetLock.unlock();
  584. _tcpSockets.clear();
  585. }
  586. _updateNfds();
  587. }
  588. void SocketManager::_closeSockets()
  589. throw()
  590. {
  591. #ifdef __WINDOWS__
  592. if (_whackSendPipe != INVALID_SOCKET)
  593. ::closesocket(_whackSendPipe);
  594. if (_whackReceivePipe != INVALID_SOCKET)
  595. ::closesocket(_whackReceivePipe);
  596. if (_tcpV4ListenSocket != INVALID_SOCKET)
  597. ::closesocket(_tcpV4ListenSocket);
  598. if (_tcpV6ListenSocket != INVALID_SOCKET)
  599. ::closesocket(_tcpV6ListenSocket);
  600. #else
  601. if (_whackSendPipe > 0)
  602. ::close(_whackSendPipe);
  603. if (_whackReceivePipe > 0)
  604. ::close(_whackReceivePipe);
  605. if (_tcpV4ListenSocket > 0)
  606. ::close(_tcpV4ListenSocket);
  607. if (_tcpV4ListenSocket > 0)
  608. ::close(_tcpV6ListenSocket);
  609. #endif
  610. }
  611. void SocketManager::_updateNfds()
  612. {
  613. #ifdef __WINDOWS__
  614. SOCKET nfds = _whackSendPipe;
  615. #else
  616. int nfds = _whackSendPipe;
  617. #endif
  618. if (_whackReceivePipe > nfds)
  619. nfds = _whackReceivePipe;
  620. if (_tcpV4ListenSocket > nfds)
  621. nfds = _tcpV4ListenSocket;
  622. if (_tcpV6ListenSocket > nfds)
  623. nfds = _tcpV6ListenSocket;
  624. if ((_udpV4Socket)&&(_udpV4Socket->_sock > nfds))
  625. nfds = _udpV4Socket->_sock;
  626. if ((_udpV6Socket)&&(_udpV6Socket->_sock > nfds))
  627. nfds = _udpV6Socket->_sock;
  628. Mutex::Lock _l(_tcpSockets_m);
  629. for(std::map< InetAddress,SharedPtr<Socket> >::const_iterator s(_tcpSockets.begin());s!=_tcpSockets.end();++s) {
  630. if (s->second->_sock > nfds)
  631. nfds = s->second->_sock;
  632. }
  633. _nfds = (int)nfds;
  634. }
  635. } // namespace ZeroTier