PageRenderTime 56ms CodeModel.GetById 23ms RepoModel.GetById 0ms app.codeStats 0ms

/io.c

https://github.com/stirnim/polipo
C | 1143 lines | 988 code | 118 blank | 37 comment | 303 complexity | 185399c741953cc35522f58879caafb3 MD5 | raw file
  1. /*
  2. Copyright (c) 2003-2006 by Juliusz Chroboczek
  3. Permission is hereby granted, free of charge, to any person obtaining a copy
  4. of this software and associated documentation files (the "Software"), to deal
  5. in the Software without restriction, including without limitation the rights
  6. to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  7. copies of the Software, and to permit persons to whom the Software is
  8. furnished to do so, subject to the following conditions:
  9. The above copyright notice and this permission notice shall be included in
  10. all copies or substantial portions of the Software.
  11. THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  12. IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  13. FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  14. AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  15. LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  16. OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  17. THE SOFTWARE.
  18. */
  19. #include "polipo.h"
  20. #ifdef HAVE_IPv6
  21. #ifdef IPV6_PREFER_TEMPADDR
  22. #define HAVE_IPV6_PREFER_TEMPADDR 1
  23. #endif
  24. #endif
  25. #ifdef HAVE_IPV6_PREFER_TEMPADDR
  26. int useTemporarySourceAddress = 1;
  27. #endif
  28. void
  29. preinitIo()
  30. {
  31. #ifdef HAVE_IPV6_PREFER_TEMPADDR
  32. CONFIG_VARIABLE_SETTABLE(useTemporarySourceAddress, CONFIG_TRISTATE,
  33. configIntSetter,
  34. "Prefer IPv6 temporary source address.");
  35. #endif
  36. #ifdef HAVE_WINSOCK
  37. /* Load the winsock dll */
  38. WSADATA wsaData;
  39. WORD wVersionRequested = MAKEWORD(2, 2);
  40. int err = WSAStartup( wVersionRequested, &wsaData );
  41. if (err != 0) {
  42. do_log_error(L_ERROR, err, "Couldn't load winsock dll");
  43. exit(-1);
  44. }
  45. #endif
  46. return;
  47. }
  48. void
  49. initIo()
  50. {
  51. return;
  52. }
  53. FdEventHandlerPtr
  54. do_stream(int operation, int fd, int offset, char *buf, int len,
  55. int (*handler)(int, FdEventHandlerPtr, StreamRequestPtr),
  56. void *data)
  57. {
  58. assert(len > offset || (operation & (IO_END | IO_IMMEDIATE)));
  59. return schedule_stream(operation, fd, offset,
  60. NULL, 0, buf, len, NULL, 0, NULL, 0, NULL,
  61. handler, data);
  62. }
  63. FdEventHandlerPtr
  64. do_stream_2(int operation, int fd, int offset,
  65. char *buf, int len, char *buf2, int len2,
  66. int (*handler)(int, FdEventHandlerPtr, StreamRequestPtr),
  67. void *data)
  68. {
  69. assert(len + len2 > offset || (operation & (IO_END | IO_IMMEDIATE)));
  70. return schedule_stream(operation, fd, offset,
  71. NULL, 0, buf, len, buf2, len2, NULL, 0, NULL,
  72. handler, data);
  73. }
  74. FdEventHandlerPtr
  75. do_stream_3(int operation, int fd, int offset,
  76. char *buf, int len, char *buf2, int len2, char *buf3, int len3,
  77. int (*handler)(int, FdEventHandlerPtr, StreamRequestPtr),
  78. void *data)
  79. {
  80. assert(len + len2 > offset || (operation & (IO_END | IO_IMMEDIATE)));
  81. return schedule_stream(operation, fd, offset,
  82. NULL, 0, buf, len, buf2, len2, buf3, len3, NULL,
  83. handler, data);
  84. }
  85. FdEventHandlerPtr
  86. do_stream_h(int operation, int fd, int offset,
  87. char *header, int hlen, char *buf, int len,
  88. int (*handler)(int, FdEventHandlerPtr, StreamRequestPtr),
  89. void *data)
  90. {
  91. assert(hlen + len > offset || (operation & (IO_END | IO_IMMEDIATE)));
  92. return schedule_stream(operation, fd, offset,
  93. header, hlen, buf, len, NULL, 0, NULL, 0, NULL,
  94. handler, data);
  95. }
  96. FdEventHandlerPtr
  97. do_stream_buf(int operation, int fd, int offset, char **buf_location, int len,
  98. int (*handler)(int, FdEventHandlerPtr, StreamRequestPtr),
  99. void *data)
  100. {
  101. assert((len > offset || (operation & (IO_END | IO_IMMEDIATE)))
  102. && len <= CHUNK_SIZE);
  103. return schedule_stream(operation, fd, offset,
  104. NULL, 0, *buf_location, len,
  105. NULL, 0, NULL, 0, buf_location,
  106. handler, data);
  107. }
  108. static int
  109. chunkHeaderLen(int i)
  110. {
  111. if(i <= 0)
  112. return 0;
  113. if(i < 0x10)
  114. return 3;
  115. else if(i < 0x100)
  116. return 4;
  117. else if(i < 0x1000)
  118. return 5;
  119. else if(i < 0x10000)
  120. return 6;
  121. else
  122. abort();
  123. }
  124. static int
  125. chunkHeader(char *buf, int buflen, int i)
  126. {
  127. int n;
  128. if(i <= 0)
  129. return 0;
  130. n = snprintf(buf, buflen, "%x\r\n", i);
  131. return n;
  132. }
  133. FdEventHandlerPtr
  134. schedule_stream(int operation, int fd, int offset,
  135. char *header, int hlen,
  136. char *buf, int len, char *buf2, int len2, char *buf3, int len3,
  137. char **buf_location,
  138. int (*handler)(int, FdEventHandlerPtr, StreamRequestPtr),
  139. void *data)
  140. {
  141. StreamRequestRec request;
  142. FdEventHandlerPtr event;
  143. int done;
  144. request.operation = operation;
  145. request.fd = fd;
  146. if(len3) {
  147. assert(hlen == 0 && buf_location == NULL);
  148. request.u.b.len3 = len3;
  149. request.u.b.buf3 = buf3;
  150. request.operation |= IO_BUF3;
  151. } else if(buf_location) {
  152. assert(hlen == 0);
  153. request.u.l.buf_location = buf_location;
  154. request.operation |= IO_BUF_LOCATION;
  155. } else {
  156. request.u.h.hlen = hlen;
  157. request.u.h.header = header;
  158. }
  159. request.buf = buf;
  160. request.len = len;
  161. request.buf2 = buf2;
  162. request.len2 = len2;
  163. if((operation & IO_CHUNKED) ||
  164. (!(request.operation & (IO_BUF3 | IO_BUF_LOCATION)) && hlen > 0)) {
  165. assert(offset == 0);
  166. request.offset = -hlen;
  167. if(operation & IO_CHUNKED)
  168. request.offset += -chunkHeaderLen(len + len2);
  169. } else {
  170. request.offset = offset;
  171. }
  172. request.handler = handler;
  173. request.data = data;
  174. event = makeFdEvent(fd,
  175. (operation & IO_MASK) == IO_WRITE ?
  176. POLLOUT : POLLIN,
  177. do_scheduled_stream,
  178. sizeof(StreamRequestRec), &request);
  179. if(!event) {
  180. done = (*handler)(-ENOMEM, NULL, &request);
  181. assert(done);
  182. return NULL;
  183. }
  184. if(!(operation & IO_NOTNOW)) {
  185. done = event->handler(0, event);
  186. if(done) {
  187. free(event);
  188. return NULL;
  189. }
  190. }
  191. if(operation & IO_IMMEDIATE) {
  192. assert(hlen == 0 && !(operation & IO_CHUNKED));
  193. done = (*handler)(0, event, &request);
  194. if(done) {
  195. free(event);
  196. return NULL;
  197. }
  198. }
  199. event = registerFdEventHelper(event);
  200. return event;
  201. }
  202. static const char *endChunkTrailer = "\r\n0\r\n\r\n";
  203. int
  204. do_scheduled_stream(int status, FdEventHandlerPtr event)
  205. {
  206. StreamRequestPtr request = (StreamRequestPtr)&event->data;
  207. int rc, done, i;
  208. struct iovec iov[6];
  209. int chunk_header_len;
  210. char chunk_header[10];
  211. int len12 = request->len + request->len2;
  212. int len123 =
  213. request->len + request->len2 +
  214. ((request->operation & IO_BUF3) ? request->u.b.len3 : 0);
  215. if(status) {
  216. done = request->handler(status, event, request);
  217. return done;
  218. }
  219. i = 0;
  220. if(request->offset < 0) {
  221. assert((request->operation & (IO_MASK | IO_BUF3 | IO_BUF_LOCATION)) ==
  222. IO_WRITE);
  223. if(request->operation & IO_CHUNKED) {
  224. chunk_header_len = chunkHeaderLen(len123);
  225. } else {
  226. chunk_header_len = 0;
  227. }
  228. if(request->offset < -chunk_header_len) {
  229. assert(request->offset >= -(request->u.h.hlen + chunk_header_len));
  230. iov[i].iov_base = request->u.h.header;
  231. iov[i].iov_len = -request->offset - chunk_header_len;
  232. i++;
  233. }
  234. if(chunk_header_len > 0) {
  235. chunkHeader(chunk_header, 10, len123);
  236. if(request->offset < -chunk_header_len) {
  237. iov[i].iov_base = chunk_header;
  238. iov[i].iov_len = chunk_header_len;
  239. } else {
  240. iov[i].iov_base = chunk_header +
  241. chunk_header_len + request->offset;
  242. iov[i].iov_len = -request->offset;
  243. }
  244. i++;
  245. }
  246. }
  247. if(request->len > 0) {
  248. if(request->buf == NULL &&
  249. (request->operation & IO_BUF_LOCATION)) {
  250. assert(*request->u.l.buf_location == NULL);
  251. request->buf = *request->u.l.buf_location = get_chunk();
  252. if(request->buf == NULL) {
  253. done = request->handler(-ENOMEM, event, request);
  254. return done;
  255. }
  256. }
  257. if(request->offset <= 0) {
  258. iov[i].iov_base = request->buf;
  259. iov[i].iov_len = request->len;
  260. i++;
  261. } else if(request->offset < request->len) {
  262. iov[i].iov_base = request->buf + request->offset;
  263. iov[i].iov_len = request->len - request->offset;
  264. i++;
  265. }
  266. }
  267. if(request->len2 > 0) {
  268. if(request->offset <= request->len) {
  269. iov[i].iov_base = request->buf2;
  270. iov[i].iov_len = request->len2;
  271. i++;
  272. } else if(request->offset < request->len + request->len2) {
  273. iov[i].iov_base = request->buf2 + request->offset - request->len;
  274. iov[i].iov_len = request->len2 - request->offset + request->len;
  275. i++;
  276. }
  277. }
  278. if((request->operation & IO_BUF3) && request->u.b.len3 > 0) {
  279. if(request->offset <= len12) {
  280. iov[i].iov_base = request->u.b.buf3;
  281. iov[i].iov_len = request->u.b.len3;
  282. i++;
  283. } else if(request->offset < len12 + request->u.b.len3) {
  284. iov[i].iov_base = request->u.b.buf3 + request->offset - len12;
  285. iov[i].iov_len = request->u.b.len3 - request->offset + len12;
  286. i++;
  287. }
  288. }
  289. if((request->operation & IO_CHUNKED)) {
  290. int l;
  291. const char *trailer;
  292. if(request->operation & IO_END) {
  293. if(len123 == 0) {
  294. trailer = endChunkTrailer + 2;
  295. l = 5;
  296. } else {
  297. trailer = endChunkTrailer;
  298. l = 7;
  299. }
  300. } else {
  301. trailer = endChunkTrailer;
  302. l = 2;
  303. }
  304. if(request->offset <= len123) {
  305. iov[i].iov_base = (char*)trailer;
  306. iov[i].iov_len = l;
  307. i++;
  308. } else if(request->offset < len123 + l) {
  309. iov[i].iov_base =
  310. (char*)endChunkTrailer + request->offset - len123;
  311. iov[i].iov_len = l - request->offset + len123;
  312. i++;
  313. }
  314. }
  315. assert(i > 0);
  316. if((request->operation & IO_MASK) == IO_WRITE) {
  317. if(i > 1)
  318. rc = WRITEV(request->fd, iov, i);
  319. else
  320. rc = WRITE(request->fd, iov[0].iov_base, iov[0].iov_len);
  321. } else {
  322. if(i > 1)
  323. rc = READV(request->fd, iov, i);
  324. else
  325. rc = READ(request->fd, iov[0].iov_base, iov[0].iov_len);
  326. }
  327. if(rc > 0) {
  328. request->offset += rc;
  329. if(request->offset < 0) return 0;
  330. done = request->handler(0, event, request);
  331. return done;
  332. } else if(rc == 0 || errno == EPIPE) {
  333. done = request->handler(1, event, request);
  334. } else if(errno == EAGAIN || errno == EINTR) {
  335. return 0;
  336. } else if(errno == EFAULT || errno == EBADF) {
  337. abort();
  338. } else {
  339. done = request->handler(-errno, event, request);
  340. }
  341. assert(done);
  342. return done;
  343. }
  344. int
  345. streamRequestDone(StreamRequestPtr request)
  346. {
  347. int len123 =
  348. request->len + request->len2 +
  349. ((request->operation & IO_BUF3) ? request->u.b.len3 : 0);
  350. if(request->offset < 0)
  351. return 0;
  352. else if(request->offset < len123)
  353. return 0;
  354. else if(request->operation & IO_CHUNKED) {
  355. if(request->operation & IO_END) {
  356. if(request->offset < len123 + (len123 ? 7 : 5))
  357. return 0;
  358. } else {
  359. if(request->offset < len123 + 2)
  360. return 0;
  361. }
  362. }
  363. return 1;
  364. }
  365. static int
  366. serverSocket(int af)
  367. {
  368. int fd, rc;
  369. if(af == 4) {
  370. fd = socket(PF_INET, SOCK_STREAM, 0);
  371. } else if(af == 6) {
  372. #ifdef HAVE_IPv6
  373. fd = socket(PF_INET6, SOCK_STREAM, 0);
  374. #else
  375. fd = -1;
  376. errno = EAFNOSUPPORT;
  377. #endif
  378. } else {
  379. abort();
  380. }
  381. if(fd >= 0) {
  382. rc = setNonblocking(fd, 1);
  383. if(rc < 0) {
  384. int errno_save = errno;
  385. CLOSE(fd);
  386. errno = errno_save;
  387. return -1;
  388. }
  389. #ifdef HAVE_IPV6_PREFER_TEMPADDR
  390. if (af == 6 && useTemporarySourceAddress != 1) {
  391. int value;
  392. value = (useTemporarySourceAddress == 2) ? 1 : 0;
  393. rc = setsockopt(fd, IPPROTO_IPV6, IPV6_PREFER_TEMPADDR,
  394. &value, sizeof(value));
  395. if (rc < 0) {
  396. /* no error, warning only */
  397. do_log_error(L_WARN, errno, "Couldn't set IPV6CTL_USETEMPADDR");
  398. }
  399. }
  400. #endif
  401. }
  402. return fd;
  403. }
  404. FdEventHandlerPtr
  405. do_connect(AtomPtr addr, int index, int port,
  406. int (*handler)(int, FdEventHandlerPtr, ConnectRequestPtr),
  407. void *data)
  408. {
  409. ConnectRequestRec request;
  410. FdEventHandlerPtr event;
  411. int done, fd, af;
  412. assert(addr->length > 0 && addr->string[0] == DNS_A);
  413. assert(addr->length % sizeof(HostAddressRec) == 1);
  414. if(index >= (addr->length - 1)/ sizeof(HostAddressRec))
  415. index = 0;
  416. request.firstindex = index;
  417. request.port = port;
  418. request.handler = handler;
  419. request.data = data;
  420. again:
  421. af = addr->string[1 + index * sizeof(HostAddressRec)];
  422. fd = serverSocket(af);
  423. request.fd = fd;
  424. request.af = af;
  425. request.addr = addr;
  426. request.index = index;
  427. if(fd < 0) {
  428. int n = (addr->length - 1) / sizeof(HostAddressRec);
  429. if(errno == EAFNOSUPPORT || errno == EPROTONOSUPPORT) {
  430. if((index + 1) % n != request.firstindex) {
  431. index = (index + 1) % n;
  432. goto again;
  433. }
  434. }
  435. do_log_error(L_ERROR, errno, "Couldn't create socket");
  436. done = (*handler)(-errno, NULL, &request);
  437. assert(done);
  438. return NULL;
  439. }
  440. /* POLLIN is apparently needed on Windows */
  441. event = registerFdEvent(fd, POLLIN | POLLOUT,
  442. do_scheduled_connect,
  443. sizeof(ConnectRequestRec), &request);
  444. if(event == NULL) {
  445. done = (*handler)(-ENOMEM, NULL, &request);
  446. assert(done);
  447. return NULL;
  448. }
  449. done = event->handler(0, event);
  450. if(done) {
  451. unregisterFdEvent(event);
  452. return NULL;
  453. }
  454. return event;
  455. }
  456. int
  457. do_scheduled_connect(int status, FdEventHandlerPtr event)
  458. {
  459. ConnectRequestPtr request = (ConnectRequestPtr)&event->data;
  460. AtomPtr addr = request->addr;
  461. int done;
  462. int rc;
  463. HostAddressPtr host;
  464. struct sockaddr_in servaddr;
  465. #ifdef HAVE_IPv6
  466. struct sockaddr_in6 servaddr6;
  467. #endif
  468. assert(addr->length > 0 && addr->string[0] == DNS_A);
  469. assert(addr->length % sizeof(HostAddressRec) == 1);
  470. assert(request->index < (addr->length - 1) / sizeof(HostAddressRec));
  471. if(status) {
  472. done = request->handler(status, event, request);
  473. if(done) {
  474. releaseAtom(addr);
  475. request->addr = NULL;
  476. return 1;
  477. }
  478. return 0;
  479. }
  480. again:
  481. host = (HostAddressPtr)&addr->string[1 +
  482. request->index *
  483. sizeof(HostAddressRec)];
  484. if(host->af != request->af) {
  485. int newfd;
  486. /* Ouch. Our socket has a different protocol than the host
  487. address. */
  488. CLOSE(request->fd);
  489. newfd = serverSocket(host->af);
  490. if(newfd < 0) {
  491. if(errno == EAFNOSUPPORT || errno == EPROTONOSUPPORT) {
  492. int n = request->addr->length / sizeof(HostAddressRec);
  493. if((request->index + 1) % n != request->firstindex) {
  494. request->index = (request->index + 1) % n;
  495. goto again;
  496. }
  497. }
  498. request->fd = -1;
  499. done = request->handler(-errno, event, request);
  500. assert(done);
  501. return 1;
  502. }
  503. if(newfd != request->fd) {
  504. request->fd = dup2(newfd, request->fd);
  505. CLOSE(newfd);
  506. if(request->fd < 0) {
  507. done = request->handler(-errno, event, request);
  508. assert(done);
  509. return 1;
  510. }
  511. }
  512. request->af = host->af;
  513. }
  514. switch(host->af) {
  515. case 4:
  516. memset(&servaddr, 0, sizeof(servaddr));
  517. servaddr.sin_family = AF_INET;
  518. servaddr.sin_port = htons(request->port);
  519. memcpy(&servaddr.sin_addr, &host->data, sizeof(struct in_addr));
  520. rc = connect(request->fd,
  521. (struct sockaddr*)&servaddr, sizeof(servaddr));
  522. break;
  523. case 6:
  524. #ifdef HAVE_IPv6
  525. memset(&servaddr6, 0, sizeof(servaddr6));
  526. servaddr6.sin6_family = AF_INET6;
  527. servaddr6.sin6_port = htons(request->port);
  528. memcpy(&servaddr6.sin6_addr, &host->data, sizeof(struct in6_addr));
  529. rc = connect(request->fd,
  530. (struct sockaddr*)&servaddr6, sizeof(servaddr6));
  531. #else
  532. rc = -1;
  533. errno = EAFNOSUPPORT;
  534. #endif
  535. break;
  536. default:
  537. abort();
  538. }
  539. if(rc >= 0 || errno == EISCONN) {
  540. done = request->handler(1, event, request);
  541. assert(done);
  542. releaseAtom(request->addr);
  543. request->addr = NULL;
  544. return 1;
  545. }
  546. if(errno == EINPROGRESS || errno == EINTR) {
  547. return 0;
  548. } else if(errno == EFAULT || errno == EBADF) {
  549. abort();
  550. } else {
  551. int n = request->addr->length / sizeof(HostAddressRec);
  552. if((request->index + 1) % n != request->firstindex) {
  553. request->index = (request->index + 1) % n;
  554. goto again;
  555. }
  556. done = request->handler(-errno, event, request);
  557. assert(done);
  558. releaseAtom(request->addr);
  559. request->addr = NULL;
  560. return 1;
  561. }
  562. }
  563. FdEventHandlerPtr
  564. do_accept(int fd,
  565. int (*handler)(int, FdEventHandlerPtr, AcceptRequestPtr),
  566. void *data)
  567. {
  568. FdEventHandlerPtr event;
  569. int done;
  570. event = schedule_accept(fd, handler, data);
  571. if(event == NULL) {
  572. done = (*handler)(-ENOMEM, NULL, NULL);
  573. assert(done);
  574. }
  575. /* But don't invoke it now - this will delay accept if under load. */
  576. return event;
  577. }
  578. FdEventHandlerPtr
  579. schedule_accept(int fd,
  580. int (*handler)(int, FdEventHandlerPtr, AcceptRequestPtr),
  581. void *data)
  582. {
  583. FdEventHandlerPtr event;
  584. AcceptRequestRec request;
  585. int done;
  586. request.fd = fd;
  587. request.handler = handler;
  588. request.data = data;
  589. event = registerFdEvent(fd, POLLIN,
  590. do_scheduled_accept, sizeof(request), &request);
  591. if(!event) {
  592. done = (*handler)(-ENOMEM, NULL, NULL);
  593. assert(done);
  594. }
  595. return event;
  596. }
  597. int
  598. do_scheduled_accept(int status, FdEventHandlerPtr event)
  599. {
  600. AcceptRequestPtr request = (AcceptRequestPtr)&event->data;
  601. int rc, done;
  602. unsigned len;
  603. struct sockaddr_in addr;
  604. if(status) {
  605. done = request->handler(status, event, request);
  606. if(done) return done;
  607. }
  608. len = sizeof(struct sockaddr_in);
  609. rc = accept(request->fd, (struct sockaddr*)&addr, &len);
  610. if(rc >= 0)
  611. done = request->handler(rc, event, request);
  612. else
  613. done = request->handler(-errno, event, request);
  614. return done;
  615. }
  616. FdEventHandlerPtr
  617. create_listener(char *address, int port,
  618. int (*handler)(int, FdEventHandlerPtr, AcceptRequestPtr),
  619. void *data)
  620. {
  621. int fd, rc;
  622. int one = 1;
  623. int done;
  624. struct sockaddr_in addr;
  625. #ifdef HAVE_IPv6
  626. int inet6 = 1;
  627. struct sockaddr_in6 addr6;
  628. #else
  629. int inet6 = 0;
  630. #endif
  631. if(inet6 && address) {
  632. struct in_addr buf;
  633. rc = inet_aton(address, &buf);
  634. if(rc == 1)
  635. inet6 = 0;
  636. }
  637. fd = -1;
  638. errno = EAFNOSUPPORT;
  639. #ifdef HAVE_IPv6
  640. if(inet6) {
  641. fd = socket(PF_INET6, SOCK_STREAM, 0);
  642. }
  643. #endif
  644. if(fd < 0 && (errno == EPROTONOSUPPORT || errno == EAFNOSUPPORT)) {
  645. inet6 = 0;
  646. fd = socket(PF_INET, SOCK_STREAM, 0);
  647. }
  648. if(fd < 0) {
  649. done = (*handler)(-errno, NULL, NULL);
  650. assert(done);
  651. return NULL;
  652. }
  653. #ifndef WIN32
  654. /* on WIN32 SO_REUSEADDR allows two sockets bind to the same port */
  655. rc = setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (char *)&one, sizeof(one));
  656. if(rc < 0) do_log_error(L_WARN, errno, "Couldn't set SO_REUSEADDR");
  657. #endif
  658. if(inet6) {
  659. #ifdef HAVE_IPv6
  660. rc = setV6only(fd, 0);
  661. if(rc < 0)
  662. /* Reportedly OpenBSD returns an error for that. So only
  663. log it as a debugging message. */
  664. do_log_error(D_CLIENT_CONN, errno, "Couldn't reset IPV6_V6ONLY");
  665. memset(&addr6, 0, sizeof(addr6));
  666. rc = inet_pton(AF_INET6, address, &addr6.sin6_addr);
  667. if(rc != 1) {
  668. done = (*handler)(rc == 0 ? -ESYNTAX : -errno, NULL, NULL);
  669. assert(done);
  670. return NULL;
  671. }
  672. addr6.sin6_family = AF_INET6;
  673. addr6.sin6_port = htons(port);
  674. rc = bind(fd, (struct sockaddr*)&addr6, sizeof(addr6));
  675. #else
  676. rc = -1;
  677. errno = EAFNOSUPPORT;
  678. #endif
  679. } else {
  680. memset(&addr, 0, sizeof(addr));
  681. rc = inet_aton(address, &addr.sin_addr);
  682. if(rc != 1) {
  683. done = (*handler)(rc == 0 ? -ESYNTAX : -errno, NULL, NULL);
  684. assert(done);
  685. return NULL;
  686. }
  687. addr.sin_family = AF_INET;
  688. addr.sin_port = htons(port);
  689. rc = bind(fd, (struct sockaddr*)&addr, sizeof(addr));
  690. }
  691. if(rc < 0) {
  692. do_log_error(L_ERROR, errno, "Couldn't bind");
  693. CLOSE(fd);
  694. done = (*handler)(-errno, NULL, NULL);
  695. assert(done);
  696. return NULL;
  697. }
  698. rc = setNonblocking(fd, 1);
  699. if(rc < 0) {
  700. do_log_error(L_ERROR, errno, "Couldn't set non blocking mode");
  701. CLOSE(fd);
  702. done = (*handler)(-errno, NULL, NULL);
  703. assert(done);
  704. return NULL;
  705. }
  706. rc = listen(fd, 1024);
  707. if(rc < 0) {
  708. do_log_error(L_ERROR, errno, "Couldn't listen");
  709. CLOSE(fd);
  710. done = (*handler)(-errno, NULL, NULL);
  711. assert(done);
  712. return NULL;
  713. }
  714. do_log(L_INFO, "Established listening socket on port %d.\n", port);
  715. return schedule_accept(fd, handler, data);
  716. }
  717. #ifndef SOL_TCP
  718. /* BSD */
  719. #define SOL_TCP IPPROTO_TCP
  720. #endif
  721. int
  722. setNonblocking(int fd, int nonblocking)
  723. {
  724. #ifdef WIN32 /*MINGW*/
  725. return win32_setnonblocking(fd, nonblocking);
  726. #else
  727. int rc;
  728. rc = fcntl(fd, F_GETFL, 0);
  729. if(rc < 0)
  730. return -1;
  731. rc = fcntl(fd, F_SETFL, nonblocking?(rc | O_NONBLOCK):(rc & ~O_NONBLOCK));
  732. if(rc < 0)
  733. return -1;
  734. return 0;
  735. #endif
  736. }
  737. int
  738. setNodelay(int fd, int nodelay)
  739. {
  740. int val = nodelay ? 1 : 0;
  741. int rc;
  742. rc = setsockopt(fd, SOL_TCP, TCP_NODELAY, (char *)&val, sizeof(val));
  743. if(rc < 0)
  744. return -1;
  745. return 0;
  746. }
  747. #ifdef IPV6_V6ONLY
  748. int
  749. setV6only(int fd, int v6only)
  750. {
  751. int val = v6only ? 1 : 0;
  752. int rc;
  753. rc = setsockopt(fd, IPPROTO_IPV6, IPV6_V6ONLY, (char *)&val, sizeof(val));
  754. if(rc < 0)
  755. return -1;
  756. return 0;
  757. }
  758. #else
  759. int
  760. setV6only(int fd, int v6only)
  761. {
  762. return 0;
  763. }
  764. #endif
  765. typedef struct _LingeringClose {
  766. int fd;
  767. FdEventHandlerPtr handler;
  768. TimeEventHandlerPtr timeout;
  769. } LingeringCloseRec, *LingeringClosePtr;
  770. static int
  771. lingeringCloseTimeoutHandler(TimeEventHandlerPtr event)
  772. {
  773. LingeringClosePtr l = *(LingeringClosePtr*)event->data;
  774. assert(l->timeout == event);
  775. l->timeout = NULL;
  776. if(l->handler)
  777. pokeFdEvent(l->fd, -ESHUTDOWN, POLLIN | POLLOUT);
  778. else {
  779. CLOSE(l->fd);
  780. free(l);
  781. }
  782. return 1;
  783. }
  784. static int
  785. lingeringCloseHandler(int status, FdEventHandlerPtr event)
  786. {
  787. LingeringClosePtr l = *(LingeringClosePtr*)event->data;
  788. char buf[17];
  789. int rc;
  790. assert(l->handler == event);
  791. l->handler = NULL;
  792. if(status && status != -EDOGRACEFUL)
  793. goto done;
  794. rc = READ(l->fd, &buf, 17);
  795. if(rc == 0 || (rc < 0 && errno != EAGAIN && errno != EINTR))
  796. goto done;
  797. /* The client is still sending data. Ignore it in order to let
  798. TCP's flow control do its work. The timeout will close the
  799. connection. */
  800. return 1;
  801. done:
  802. if(l->timeout) {
  803. cancelTimeEvent(l->timeout);
  804. l->timeout = NULL;
  805. }
  806. CLOSE(l->fd);
  807. free(l);
  808. return 1;
  809. }
  810. int
  811. lingeringClose(int fd)
  812. {
  813. int rc;
  814. LingeringClosePtr l;
  815. rc = shutdown(fd, 1);
  816. if(rc < 0) {
  817. if(errno != ENOTCONN) {
  818. do_log_error(L_ERROR, errno, "Shutdown failed");
  819. } else if(errno == EFAULT || errno == EBADF) {
  820. abort();
  821. }
  822. CLOSE(fd);
  823. return 1;
  824. }
  825. l = malloc(sizeof(LingeringCloseRec));
  826. if(l == NULL)
  827. goto fail;
  828. l->fd = fd;
  829. l->handler = NULL;
  830. l->timeout = NULL;
  831. l->timeout = scheduleTimeEvent(10, lingeringCloseTimeoutHandler,
  832. sizeof(LingeringClosePtr), &l);
  833. if(l->timeout == NULL) {
  834. free(l);
  835. goto fail;
  836. }
  837. l->handler = registerFdEvent(fd, POLLIN,
  838. lingeringCloseHandler,
  839. sizeof(LingeringClosePtr), &l);
  840. if(l->handler == NULL) {
  841. do_log(L_ERROR, "Couldn't schedule lingering close handler.\n");
  842. /* But don't close -- the timeout will do its work. */
  843. }
  844. return 1;
  845. fail:
  846. do_log(L_ERROR, "Couldn't schedule lingering close.\n");
  847. CLOSE(fd);
  848. return 1;
  849. }
  850. NetAddressPtr
  851. parseNetAddress(AtomListPtr list)
  852. {
  853. NetAddressPtr nl;
  854. int i, rc, rc6;
  855. char buf[100];
  856. struct in_addr ina;
  857. #ifdef HAVE_IPv6
  858. struct in6_addr ina6;
  859. #endif
  860. nl = malloc((list->length + 1) * sizeof(NetAddressRec));
  861. if(nl == NULL) {
  862. do_log(L_ERROR, "Couldn't allocate network list.\n");
  863. return NULL;
  864. }
  865. for(i = 0; i < list->length; i++) {
  866. int prefix;
  867. char *s = list->list[i]->string, *p;
  868. int n = list->list[i]->length;
  869. char *suffix;
  870. while(*s == ' ' || *s == '\t') {
  871. s++;
  872. n--;
  873. }
  874. if(n >= 100) {
  875. do_log(L_ERROR, "Network name too long.\n");
  876. goto fail;
  877. }
  878. p = memchr(s, '/', n);
  879. if(p) {
  880. memcpy(buf, s, p - s);
  881. buf[p - s] = '\0';
  882. prefix = strtol(p + 1, &suffix, 10);
  883. } else {
  884. char *s1, *s2;
  885. prefix = -1;
  886. strcpy(buf, s);
  887. s1 = strchr(s, ' ');
  888. s2 = strchr(s, '\t');
  889. if(s1 == NULL) suffix = s2;
  890. else if(s2 == NULL) suffix = s1;
  891. else if(s1 < s2) suffix = s1;
  892. else suffix = s2;
  893. if(suffix == NULL)
  894. suffix = s + n;
  895. }
  896. if(!isWhitespace(suffix)) {
  897. do_log(L_ERROR, "Couldn't parse network %s.\n", buf);
  898. goto fail;
  899. }
  900. rc = 0; rc6 = 0;
  901. rc = inet_aton(buf, &ina);
  902. #ifdef HAVE_IPv6
  903. if(rc == 0) {
  904. rc6 = inet_pton(AF_INET6, buf, &ina6);
  905. }
  906. #endif
  907. if(rc == 0 && rc6 == 0) {
  908. do_log(L_ERROR, "Couldn't parse network %s.\n", buf);
  909. goto fail;
  910. }
  911. nl[i].prefix = prefix;
  912. if(rc) {
  913. nl[i].af = 4;
  914. memcpy(nl[i].data, &ina, 4);
  915. } else {
  916. #ifdef HAVE_IPv6
  917. nl[i].af = 6;
  918. memcpy(nl[i].data, &ina6, 16);
  919. #else
  920. abort();
  921. #endif
  922. }
  923. }
  924. nl[i].af = 0;
  925. return nl;
  926. fail:
  927. free(nl);
  928. return NULL;
  929. }
  930. /* Returns 1 if the first n bits of a and b are equal */
  931. static int
  932. bitmatch(const unsigned char *a, const unsigned char *b, int n)
  933. {
  934. if(n >= 8) {
  935. if(memcmp(a, b, n / 8) != 0)
  936. return 0;
  937. }
  938. if(n % 8 != 0) {
  939. int mask = (~0) << (8 - n % 8);
  940. if((a[n / 8] & mask) != (b[n / 8] & mask))
  941. return 0;
  942. }
  943. return 1;
  944. }
  945. /* Returns 1 if the address in data is in list */
  946. static int
  947. match(int af, unsigned char *data, NetAddressPtr list)
  948. {
  949. int i;
  950. #ifdef HAVE_IPv6
  951. static const unsigned char v6mapped[] =
  952. { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0xFF, 0xFF };
  953. #endif
  954. i = 0;
  955. while(list[i].af != 0) {
  956. if(af == 4 && list[i].af == 4) {
  957. if(bitmatch(data, list[i].data,
  958. list[i].prefix >= 0 ? list[i].prefix : 32))
  959. return 1;
  960. #ifdef HAVE_IPv6
  961. } else if(af == 6 && list[i].af == 6) {
  962. if(bitmatch(data, list[i].data,
  963. list[i].prefix >= 0 ? list[i].prefix : 128))
  964. return 1;
  965. } else if(af == 6 && list[i].af == 4) {
  966. if(bitmatch(data, v6mapped, 96)) {
  967. if(bitmatch(data + 12, list[i].data,
  968. list[i].prefix >= 0 ? list[i].prefix : 32))
  969. return 1;
  970. }
  971. } else if(af == 4 && list[i].af == 6) {
  972. if(bitmatch(list[i].data, v6mapped, 96)) {
  973. if(bitmatch(data, list[i].data + 12,
  974. list[i].prefix >= 96 ?
  975. list[i].prefix - 96 : 32))
  976. return 1;
  977. }
  978. #endif
  979. } else {
  980. abort();
  981. }
  982. i++;
  983. }
  984. return 0;
  985. }
  986. int
  987. netAddressMatch(int fd, NetAddressPtr list)
  988. {
  989. int rc;
  990. unsigned int len;
  991. struct sockaddr_in sain;
  992. #ifdef HAVE_IPv6
  993. struct sockaddr_in6 sain6;
  994. #endif
  995. len = sizeof(sain);
  996. rc = getpeername(fd, (struct sockaddr*)&sain, &len);
  997. if(rc < 0) {
  998. do_log_error(L_ERROR, errno, "Couldn't get peer name");
  999. return -1;
  1000. }
  1001. if(sain.sin_family == AF_INET) {
  1002. return match(4, (unsigned char*)&sain.sin_addr, list);
  1003. #ifdef HAVE_IPv6
  1004. } else if(sain.sin_family == AF_INET6) {
  1005. len = sizeof(sain6);
  1006. rc = getpeername(fd, (struct sockaddr*)&sain6, &len);
  1007. if(rc < 0) {
  1008. do_log_error(L_ERROR, errno, "Couldn't get peer name");
  1009. return -1;
  1010. }
  1011. if(sain6.sin6_family != AF_INET6) {
  1012. do_log(L_ERROR, "Inconsistent peer name");
  1013. return -1;
  1014. }
  1015. return match(6, (unsigned char*)&sain6.sin6_addr, list);
  1016. #endif
  1017. } else {
  1018. do_log(L_ERROR, "Unknown address family %d\n", sain.sin_family);
  1019. return -1;
  1020. }
  1021. return 0;
  1022. }