SocketManager.cpp 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708
  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. { u_long iMode=1; ioctlsocket(s,FIONBIO,&iMode); }
  334. #ifdef ZT_TCP_NODELAY
  335. { BOOL f = TRUE; setsockopt(s,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  336. #endif
  337. #else
  338. int s = ::socket(to.isV4() ? AF_INET : AF_INET6,SOCK_STREAM,0);
  339. if (s <= 0)
  340. return false;
  341. if (s >= FD_SETSIZE) {
  342. ::close(s);
  343. return false;
  344. }
  345. fcntl(s,F_SETFL,O_NONBLOCK);
  346. #ifdef ZT_TCP_NODELAY
  347. { int f = 1; setsockopt(s,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  348. #endif
  349. #endif
  350. bool connecting = false;
  351. if (::connect(s,to.saddr(),to.saddrLen())) {
  352. #ifdef __WINDOWS__
  353. if (WSAGetLastError() != WSAEWOULDBLOCK) {
  354. #else
  355. if (errno != EINPROGRESS) {
  356. #endif
  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. #ifdef __WINDOWS__
  418. // Windows signals failed connects in exceptfds
  419. {
  420. Mutex::Lock _l2(_tcpSockets_m);
  421. for(std::map< InetAddress,SharedPtr<Socket> >::iterator s(_tcpSockets.begin());s!=_tcpSockets.end();++s) {
  422. if (((TcpSocket *)s->second.ptr())->_connecting)
  423. FD_SET(s->second->_sock,&efds);
  424. }
  425. }
  426. #endif
  427. tv.tv_sec = (long)(timeout / 1000);
  428. tv.tv_usec = (long)((timeout % 1000) * 1000);
  429. select(_nfds + 1,&rfds,&wfds,&efds,(timeout > 0) ? &tv : (struct timeval *)0);
  430. if (FD_ISSET(_whackReceivePipe,&rfds)) {
  431. char tmp[16];
  432. #ifdef __WINDOWS__
  433. ::recv(_whackReceivePipe,tmp,16,0);
  434. #else
  435. ::read(_whackReceivePipe,tmp,16);
  436. #endif
  437. }
  438. if ((_tcpV4ListenSocket != INVALID_SOCKET)&&(FD_ISSET(_tcpV4ListenSocket,&rfds))) {
  439. struct sockaddr_in from;
  440. socklen_t fromlen = sizeof(from);
  441. sockfd = accept(_tcpV4ListenSocket,(struct sockaddr *)&from,&fromlen);
  442. #ifdef __WINDOWS__
  443. if (sockfd != INVALID_SOCKET) {
  444. #else
  445. if (sockfd > 0) {
  446. if (sockfd < FD_SETSIZE) {
  447. #endif
  448. InetAddress fromia((const struct sockaddr *)&from);
  449. Mutex::Lock _l2(_tcpSockets_m);
  450. try {
  451. _tcpSockets[fromia] = SharedPtr<Socket>(new TcpSocket(this,sockfd,false,fromia));
  452. #ifdef __WINDOWS__
  453. { u_long iMode=1; ioctlsocket(sockfd,FIONBIO,&iMode); }
  454. #ifdef ZT_TCP_NODELAY
  455. { BOOL f = TRUE; setsockopt(sockfd,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  456. #endif
  457. #else
  458. fcntl(sockfd,F_SETFL,O_NONBLOCK);
  459. #ifdef ZT_TCP_NODELAY
  460. { int f = 1; setsockopt(sockfd,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  461. #endif
  462. #endif
  463. _fdSetLock.lock();
  464. FD_SET(sockfd,&_readfds);
  465. _fdSetLock.unlock();
  466. if ((int)sockfd > (int)_nfds)
  467. _nfds = (int)sockfd;
  468. } catch ( ... ) {
  469. CLOSE_SOCKET(sockfd);
  470. }
  471. #ifndef __WINDOWS__
  472. } else {
  473. CLOSE_SOCKET(sockfd);
  474. }
  475. #endif
  476. }
  477. }
  478. if ((_tcpV6ListenSocket != INVALID_SOCKET)&&(FD_ISSET(_tcpV6ListenSocket,&rfds))) {
  479. struct sockaddr_in6 from;
  480. socklen_t fromlen = sizeof(from);
  481. sockfd = accept(_tcpV6ListenSocket,(struct sockaddr *)&from,&fromlen);
  482. #ifdef __WINDOWS__
  483. if (sockfd != INVALID_SOCKET) {
  484. #else
  485. if (sockfd > 0) {
  486. if (sockfd < FD_SETSIZE) {
  487. #endif
  488. InetAddress fromia((const struct sockaddr *)&from);
  489. Mutex::Lock _l2(_tcpSockets_m);
  490. try {
  491. _tcpSockets[fromia] = SharedPtr<Socket>(new TcpSocket(this,sockfd,false,fromia));
  492. #ifdef __WINDOWS__
  493. { u_long iMode=1; ioctlsocket(sockfd,FIONBIO,&iMode); }
  494. #ifdef ZT_TCP_NODELAY
  495. { BOOL f = TRUE; setsockopt(sockfd,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  496. #endif
  497. #else
  498. fcntl(sockfd,F_SETFL,O_NONBLOCK);
  499. #ifdef ZT_TCP_NODELAY
  500. { int f = 1; setsockopt(sockfd,IPPROTO_TCP,TCP_NODELAY,(char *)&f,sizeof(f)); }
  501. #endif
  502. #endif
  503. _fdSetLock.lock();
  504. FD_SET(sockfd,&_readfds);
  505. _fdSetLock.unlock();
  506. if ((int)sockfd > (int)_nfds)
  507. _nfds = (int)sockfd;
  508. } catch ( ... ) {
  509. CLOSE_SOCKET(sockfd);
  510. }
  511. #ifndef __WINDOWS__
  512. } else {
  513. CLOSE_SOCKET(sockfd);
  514. }
  515. #endif
  516. }
  517. }
  518. if ((_udpV4Socket)&&(FD_ISSET(_udpV4Socket->_sock,&rfds))) {
  519. _udpV4Socket->notifyAvailableForRead(_udpV4Socket,this);
  520. }
  521. if ((_udpV6Socket)&&(FD_ISSET(_udpV6Socket->_sock,&rfds))) {
  522. _udpV6Socket->notifyAvailableForRead(_udpV6Socket,this);
  523. }
  524. bool closedSockets = false;
  525. { // grab copy of TCP sockets list because _tcpSockets[] might be changed in a handler
  526. Mutex::Lock _l2(_tcpSockets_m);
  527. if (!_tcpSockets.empty()) {
  528. ts.reserve(_tcpSockets.size());
  529. uint64_t now = Utils::now();
  530. for(std::map< InetAddress,SharedPtr<Socket> >::iterator s(_tcpSockets.begin());s!=_tcpSockets.end();) {
  531. #ifdef __WINDOWS__
  532. if ( ((now - ((TcpSocket *)s->second.ptr())->_lastActivity) < ZT_TCP_TUNNEL_ACTIVITY_TIMEOUT) && (! ((((TcpSocket *)s->second.ptr())->_connecting)&&(FD_ISSET(s->second->_sock,&efds))) ) ) {
  533. #else
  534. if ((now - ((TcpSocket *)s->second.ptr())->_lastActivity) < ZT_TCP_TUNNEL_ACTIVITY_TIMEOUT) {
  535. #endif
  536. ts.push_back(s->second);
  537. ++s;
  538. } else {
  539. _fdSetLock.lock();
  540. FD_CLR(s->second->_sock,&_readfds);
  541. FD_CLR(s->second->_sock,&_writefds);
  542. _fdSetLock.unlock();
  543. _tcpSockets.erase(s++);
  544. closedSockets = true;
  545. }
  546. }
  547. }
  548. }
  549. for(std::vector< SharedPtr<Socket> >::iterator s(ts.begin());s!=ts.end();++s) {
  550. if (FD_ISSET((*s)->_sock,&wfds)) {
  551. if (!(*s)->notifyAvailableForWrite(*s,this)) {
  552. {
  553. Mutex::Lock _l2(_tcpSockets_m);
  554. _tcpSockets.erase(((TcpSocket *)s->ptr())->_remote);
  555. }
  556. _fdSetLock.lock();
  557. FD_CLR((*s)->_sock,&_readfds);
  558. FD_CLR((*s)->_sock,&_writefds);
  559. _fdSetLock.unlock();
  560. closedSockets = true;
  561. continue;
  562. }
  563. }
  564. if (FD_ISSET((*s)->_sock,&rfds)) {
  565. if (!(*s)->notifyAvailableForRead(*s,this)) {
  566. {
  567. Mutex::Lock _l2(_tcpSockets_m);
  568. _tcpSockets.erase(((TcpSocket *)s->ptr())->_remote);
  569. }
  570. _fdSetLock.lock();
  571. FD_CLR((*s)->_sock,&_readfds);
  572. FD_CLR((*s)->_sock,&_writefds);
  573. _fdSetLock.unlock();
  574. closedSockets = true;
  575. continue;
  576. }
  577. }
  578. }
  579. if (closedSockets)
  580. _updateNfds();
  581. }
  582. void SocketManager::whack()
  583. {
  584. _whackSendPipe_m.lock();
  585. #ifdef __WINDOWS__
  586. ::send(_whackSendPipe,(const char *)this,1,0);
  587. #else
  588. ::write(_whackSendPipe,(const void *)this,1); // data is arbitrary, just send a byte
  589. #endif
  590. _whackSendPipe_m.unlock();
  591. }
  592. void SocketManager::closeTcpSockets()
  593. {
  594. {
  595. Mutex::Lock _l2(_tcpSockets_m);
  596. _fdSetLock.lock();
  597. for(std::map< InetAddress,SharedPtr<Socket> >::iterator s(_tcpSockets.begin());s!=_tcpSockets.end();++s) {
  598. FD_CLR(s->second->_sock,&_readfds);
  599. FD_CLR(s->second->_sock,&_writefds);
  600. }
  601. _fdSetLock.unlock();
  602. _tcpSockets.clear();
  603. }
  604. _updateNfds();
  605. }
  606. void SocketManager::_closeSockets()
  607. throw()
  608. {
  609. #ifdef __WINDOWS__
  610. if (_whackSendPipe != INVALID_SOCKET)
  611. ::closesocket(_whackSendPipe);
  612. if (_whackReceivePipe != INVALID_SOCKET)
  613. ::closesocket(_whackReceivePipe);
  614. if (_tcpV4ListenSocket != INVALID_SOCKET)
  615. ::closesocket(_tcpV4ListenSocket);
  616. if (_tcpV6ListenSocket != INVALID_SOCKET)
  617. ::closesocket(_tcpV6ListenSocket);
  618. #else
  619. if (_whackSendPipe > 0)
  620. ::close(_whackSendPipe);
  621. if (_whackReceivePipe > 0)
  622. ::close(_whackReceivePipe);
  623. if (_tcpV4ListenSocket > 0)
  624. ::close(_tcpV4ListenSocket);
  625. if (_tcpV4ListenSocket > 0)
  626. ::close(_tcpV6ListenSocket);
  627. #endif
  628. }
  629. void SocketManager::_updateNfds()
  630. {
  631. #ifdef __WINDOWS__
  632. SOCKET nfds = _whackSendPipe;
  633. #else
  634. int nfds = _whackSendPipe;
  635. #endif
  636. if (_whackReceivePipe > nfds)
  637. nfds = _whackReceivePipe;
  638. if (_tcpV4ListenSocket > nfds)
  639. nfds = _tcpV4ListenSocket;
  640. if (_tcpV6ListenSocket > nfds)
  641. nfds = _tcpV6ListenSocket;
  642. if ((_udpV4Socket)&&(_udpV4Socket->_sock > nfds))
  643. nfds = _udpV4Socket->_sock;
  644. if ((_udpV6Socket)&&(_udpV6Socket->_sock > nfds))
  645. nfds = _udpV6Socket->_sock;
  646. Mutex::Lock _l(_tcpSockets_m);
  647. for(std::map< InetAddress,SharedPtr<Socket> >::const_iterator s(_tcpSockets.begin());s!=_tcpSockets.end();++s) {
  648. if (s->second->_sock > nfds)
  649. nfds = s->second->_sock;
  650. }
  651. _nfds = (int)nfds;
  652. }
  653. } // namespace ZeroTier