tests/server/sockfilt.c

   1 /***************************************************************************
   2  *                                  _   _ ____  _
   3  *  Project                     ___| | | |  _ \| |
   4  *                             / __| | | | |_) | |
   5  *                            | (__| |_| |  _ <| |___
   6  *                             \___|\___/|_| \_\_____|
   7  *
   8  * Copyright (C) 1998 - 2009, Daniel Stenberg, <daniel@haxx.se>, et al.
   9  *
  10  * This software is licensed as described in the file COPYING, which
  11  * you should have received as part of this distribution. The terms
  12  * are also available at http://curl.haxx.se/docs/copyright.html.
  13  *
  14  * You may opt to use, copy, modify, merge, publish, distribute and/or sell
  15  * copies of the Software, and permit persons to whom the Software is
  16  * furnished to do so, under the terms of the COPYING file.
  17  *
  18  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  19  * KIND, either express or implied.
  20  *
  21  * $Id$
  22  ***************************************************************************/
  23
  24 /* Purpose
  25  *
  26  * 1. Accept a TCP connection on a custom port (ipv4 or ipv6), or connect
  27  *    to a given (localhost) port.
  28  *
  29  * 2. Get commands on STDIN. Pass data on to the TCP stream.
  30  *    Get data from TCP stream and pass on to STDOUT.
  31  *
  32  * This program is made to perform all the socket/stream/connection stuff for
  33  * the test suite's (perl) FTP server. Previously the perl code did all of
  34  * this by its own, but I decided to let this program do the socket layer
  35  * because of several things:
  36  *
  37  * o We want the perl code to work with rather old perl installations, thus
  38  *   we cannot use recent perl modules or features.
  39  *
  40  * o We want IPv6 support for systems that provide it, and doing optional IPv6
  41  *   support in perl seems if not impossible so at least awkward.
  42  *
  43  * o We want FTP-SSL support, which means that a connection that starts with
  44  *   plain sockets needs to be able to "go SSL" in the midst. This would also
  45  *   require some nasty perl stuff I'd rather avoid.
  46  *
  47  * (Source originally based on sws.c)
  48  */
  49
  50 /*
  51  * Signal handling notes for sockfilt
  52  * ----------------------------------
  53  *
  54  * This program is a single-threaded process.
  55  *
  56  * This program is intended to be highly portable and as such it must be kept as
  57  * simple as possible, due to this the only signal handling mechanisms used will
  58  * be those of ANSI C, and used only in the most basic form which is good enough
  59  * for the purpose of this program.
  60  *
  61  * For the above reason and the specific needs of this program signals SIGHUP,
  62  * SIGPIPE and SIGALRM will be simply ignored on systems where this can be done.
  63  * If possible, signals SIGINT and SIGTERM will be handled by this program as an
  64  * indication to cleanup and finish execution as soon as possible.  This will be
  65  * achieved with a single signal handler 'exit_signal_handler' for both signals.
  66  *
  67  * The 'exit_signal_handler' upon the first SIGINT or SIGTERM received signal
  68  * will just set to one the global var 'got_exit_signal' storing in global var
  69  * 'exit_signal' the signal that triggered this change.
  70  *
  71  * Nothing fancy that could introduce problems is used, the program at certain
  72  * points in its normal flow checks if var 'got_exit_signal' is set and in case
  73  * this is true it just makes its way out of loops and functions in structured
  74  * and well behaved manner to achieve proper program cleanup and termination.
  75  *
  76  * Even with the above mechanism implemented it is worthwile to note that other
  77  * signals might still be received, or that there might be systems on which it
  78  * is not possible to trap and ignore some of the above signals.  This implies
  79  * that for increased portability and reliability the program must be coded as
  80  * if no signal was being ignored or handled at all.  Enjoy it!
  81  */
  82
  83 #include "setup.h" /* portability help from the lib directory */
  84
  85 #ifdef HAVE_SIGNAL_H
  86 #include <signal.h>
  87 #endif
  88 #ifdef HAVE_UNISTD_H
  89 #include <unistd.h>
  90 #endif
  91 #ifdef HAVE_SYS_SOCKET_H
  92 #include <sys/socket.h>
  93 #endif
  94 #ifdef HAVE_NETINET_IN_H
  95 #include <netinet/in.h>
  96 #endif
  97 #ifdef HAVE_ARPA_INET_H
  98 #include <arpa/inet.h>
  99 #endif
 100 #ifdef HAVE_NETDB_H
 101 #include <netdb.h>
 102 #endif
 103
 104 #define ENABLE_CURLX_PRINTF
 105 /* make the curlx header define all printf() functions to use the curlx_*
 106    versions instead */
 107 #include "curlx.h" /* from the private lib dir */
 108 #include "getpart.h"
 109 #include "inet_pton.h"
 110 #include "util.h"
 111
 112 /* include memdebug.h last */
 113 #include "memdebug.h"
 114
 115 #define DEFAULT_PORT 8999
 116
 117 #ifndef DEFAULT_LOGFILE
 118 #define DEFAULT_LOGFILE "log/sockfilt.log"
 119 #endif
 120
 121 const char *serverlogfile = DEFAULT_LOGFILE;
 122
 123 static bool verbose = FALSE;
 124 #ifdef ENABLE_IPV6
 125 static bool use_ipv6 = FALSE;
 126 #endif
 127 static const char *ipv_inuse = "IPv4";
 128 static unsigned short port = DEFAULT_PORT;
 129 static unsigned short connectport = 0; /* if non-zero, we activate this mode */
 130
 131 enum sockmode {
 132   PASSIVE_LISTEN,    /* as a server waiting for connections */
 133   PASSIVE_CONNECT,   /* as a server, connected to a client */
 134   ACTIVE,            /* as a client, connected to a server */
 135   ACTIVE_DISCONNECT  /* as a client, disconnected from server */
 136 };
 137
 138 /* do-nothing macro replacement for systems which lack siginterrupt() */
 139
 140 #ifndef HAVE_SIGINTERRUPT
 141 #define siginterrupt(x,y) do {} while(0)
 142 #endif
 143
 144 /* vars used to keep around previous signal handlers */
 145
 146 typedef RETSIGTYPE (*SIGHANDLER_T)(int);
 147
 148 #ifdef SIGHUP
 149 static SIGHANDLER_T old_sighup_handler  = SIG_ERR;
 150 #endif
 151
 152 #ifdef SIGPIPE
 153 static SIGHANDLER_T old_sigpipe_handler = SIG_ERR;
 154 #endif
 155
 156 #ifdef SIGALRM
 157 static SIGHANDLER_T old_sigalrm_handler = SIG_ERR;
 158 #endif
 159
 160 #ifdef SIGINT
 161 static SIGHANDLER_T old_sigint_handler  = SIG_ERR;
 162 #endif
 163
 164 #ifdef SIGTERM
 165 static SIGHANDLER_T old_sigterm_handler = SIG_ERR;
 166 #endif
 167
 168 /* var which if set indicates that the program should finish execution */
 169
 170 SIG_ATOMIC_T got_exit_signal = 0;
 171
 172 /* if next is set indicates the first signal handled in exit_signal_handler */
 173
 174 static volatile int exit_signal = 0;
 175
 176 /* signal handler that will be triggered to indicate that the program
 177   should finish its execution in a controlled manner as soon as possible.
 178   The first time this is called it will set got_exit_signal to one and
 179   store in exit_signal the signal that triggered its execution. */
 180
 181 static RETSIGTYPE exit_signal_handler(int signum)
 182 {
 183   int old_errno = ERRNO;
 184   if(got_exit_signal == 0) {
 185     got_exit_signal = 1;
 186     exit_signal = signum;
 187   }
 188   (void)signal(signum, exit_signal_handler);
 189   SET_ERRNO(old_errno);
 190 }
 191
 192 static void install_signal_handlers(void)
 193 {
 194 #ifdef SIGHUP
 195   /* ignore SIGHUP signal */
 196   if((old_sighup_handler = signal(SIGHUP, SIG_IGN)) == SIG_ERR)
 197     logmsg("cannot install SIGHUP handler: %s", strerror(ERRNO));
 198 #endif
 199 #ifdef SIGPIPE
 200   /* ignore SIGPIPE signal */
 201   if((old_sigpipe_handler = signal(SIGPIPE, SIG_IGN)) == SIG_ERR)
 202     logmsg("cannot install SIGPIPE handler: %s", strerror(ERRNO));
 203 #endif
 204 #ifdef SIGALRM
 205   /* ignore SIGALRM signal */
 206   if((old_sigalrm_handler = signal(SIGALRM, SIG_IGN)) == SIG_ERR)
 207     logmsg("cannot install SIGALRM handler: %s", strerror(ERRNO));
 208 #endif
 209 #ifdef SIGINT
 210   /* handle SIGINT signal with our exit_signal_handler */
 211   if((old_sigint_handler = signal(SIGINT, exit_signal_handler)) == SIG_ERR)
 212     logmsg("cannot install SIGINT handler: %s", strerror(ERRNO));
 213   else
 214     siginterrupt(SIGINT, 1);
 215 #endif
 216 #ifdef SIGTERM
 217   /* handle SIGTERM signal with our exit_signal_handler */
 218   if((old_sigterm_handler = signal(SIGTERM, exit_signal_handler)) == SIG_ERR)
 219     logmsg("cannot install SIGTERM handler: %s", strerror(ERRNO));
 220   else
 221     siginterrupt(SIGTERM, 1);
 222 #endif
 223 }
 224
 225 static void restore_signal_handlers(void)
 226 {
 227 #ifdef SIGHUP
 228   if(SIG_ERR != old_sighup_handler)
 229     (void)signal(SIGHUP, old_sighup_handler);
 230 #endif
 231 #ifdef SIGPIPE
 232   if(SIG_ERR != old_sigpipe_handler)
 233     (void)signal(SIGPIPE, old_sigpipe_handler);
 234 #endif
 235 #ifdef SIGALRM
 236   if(SIG_ERR != old_sigalrm_handler)
 237     (void)signal(SIGALRM, old_sigalrm_handler);
 238 #endif
 239 #ifdef SIGINT
 240   if(SIG_ERR != old_sigint_handler)
 241     (void)signal(SIGINT, old_sigint_handler);
 242 #endif
 243 #ifdef SIGTERM
 244   if(SIG_ERR != old_sigterm_handler)
 245     (void)signal(SIGTERM, old_sigterm_handler);
 246 #endif
 247 }
 248
 249 /*
 250  * fullread is a wrapper around the read() function. This will repeat the call
 251  * to read() until it actually has read the complete number of bytes indicated
 252  * in nbytes or it fails with a condition that cannot be handled with a simple
 253  * retry of the read call.
 254  */
 255
 256 static ssize_t fullread(int filedes, void *buffer, size_t nbytes)
 257 {
 258   int error;
 259   ssize_t rc;
 260   ssize_t nread = 0;
 261
 262   do {
 263     rc = read(filedes, (unsigned char *)buffer + nread, nbytes - nread);
 264
 265     if(got_exit_signal) {
 266       logmsg("signalled to die");
 267       return -1;
 268     }
 269
 270     if(rc < 0) {
 271       error = ERRNO;
 272       if((error == EINTR) || (error == EAGAIN))
 273         continue;
 274       logmsg("unrecoverable read() failure: %s", strerror(error));
 275       return -1;
 276     }
 277
 278     if(rc == 0) {
 279       logmsg("got 0 reading from stdin");
 280       return 0;
 281     }
 282
 283     nread += rc;
 284
 285   } while((size_t)nread < nbytes);
 286
 287   if(verbose)
 288     logmsg("read %zd bytes", nread);
 289
 290   return nread;
 291 }
 292
 293 /*
 294  * fullwrite is a wrapper around the write() function. This will repeat the
 295  * call to write() until it actually has written the complete number of bytes
 296  * indicated in nbytes or it fails with a condition that cannot be handled
 297  * with a simple retry of the write call.
 298  */
 299
 300 static ssize_t fullwrite(int filedes, const void *buffer, size_t nbytes)
 301 {
 302   int error;
 303   ssize_t wc;
 304   ssize_t nwrite = 0;
 305
 306   do {
 307     wc = write(filedes, (unsigned char *)buffer + nwrite, nbytes - nwrite);
 308
 309     if(got_exit_signal) {
 310       logmsg("signalled to die");
 311       return -1;
 312     }
 313
 314     if(wc < 0) {
 315       error = ERRNO;
 316       if((error == EINTR) || (error == EAGAIN))
 317         continue;
 318       logmsg("unrecoverable write() failure: %s", strerror(error));
 319       return -1;
 320     }
 321
 322     if(wc == 0) {
 323       logmsg("put 0 writing to stdout");
 324       return 0;
 325     }
 326
 327     nwrite += wc;
 328
 329   } while((size_t)nwrite < nbytes);
 330
 331   if(verbose)
 332     logmsg("wrote %zd bytes", nwrite);
 333
 334   return nwrite;
 335 }
 336
 337 /*
 338  * read_stdin tries to read from stdin nbytes into the given buffer. This is a
 339  * blocking function that will only return TRUE when nbytes have actually been
 340  * read or FALSE when an unrecoverable error has been detected. Failure of this
 341  * function is an indication that the sockfilt process should terminate.
 342  */
 343
 344 static bool read_stdin(void *buffer, size_t nbytes)
 345 {
 346   ssize_t nread = fullread(fileno(stdin), buffer, nbytes);
 347   if(nread != (ssize_t)nbytes) {
 348     logmsg("exiting...");
 349     return FALSE;
 350   }
 351   return TRUE;
 352 }
 353
 354 /*
 355  * write_stdout tries to write to stdio nbytes from the given buffer. This is a
 356  * blocking function that will only return TRUE when nbytes have actually been
 357  * written or FALSE when an unrecoverable error has been detected. Failure of
 358  * this function is an indication that the sockfilt process should terminate.
 359  */
 360
 361 static bool write_stdout(const void *buffer, size_t nbytes)
 362 {
 363   ssize_t nwrite = fullwrite(fileno(stdout), buffer, nbytes);
 364   if(nwrite != (ssize_t)nbytes) {
 365     logmsg("exiting...");
 366     return FALSE;
 367   }
 368   return TRUE;
 369 }
 370
 371 static void lograw(unsigned char *buffer, ssize_t len)
 372 {
 373   char data[120];
 374   ssize_t i;
 375   unsigned char *ptr = buffer;
 376   char *optr = data;
 377   ssize_t width=0;
 378
 379   for(i=0; i<len; i++) {
 380     switch(ptr[i]) {
 381     case '\n':
 382       sprintf(optr, "\\n");
 383       width += 2;
 384       optr += 2;
 385       break;
 386     case '\r':
 387       sprintf(optr, "\\r");
 388       width += 2;
 389       optr += 2;
 390       break;
 391     default:
 392       sprintf(optr, "%c", (ISGRAPH(ptr[i]) || ptr[i]==0x20) ?ptr[i]:'.');
 393       width++;
 394       optr++;
 395       break;
 396     }
 397
 398     if(width>60) {
 399       logmsg("'%s'", data);
 400       width = 0;
 401       optr = data;
 402     }
 403   }
 404   if(width)
 405     logmsg("'%s'", data);
 406 }
 407
 408 /*
 409   sockfdp is a pointer to an established stream or CURL_SOCKET_BAD
 410
 411   if sockfd is CURL_SOCKET_BAD, listendfd is a listening socket we must
 412   accept()
 413 */
 414 static bool juggle(curl_socket_t *sockfdp,
 415                    curl_socket_t listenfd,
 416                    enum sockmode *mode)
 417 {
 418   struct timeval timeout;
 419   fd_set fds_read;
 420   fd_set fds_write;
 421   fd_set fds_err;
 422   curl_socket_t sockfd = CURL_SOCKET_BAD;
 423   curl_socket_t maxfd = CURL_SOCKET_BAD;
 424   ssize_t rc;
 425   ssize_t nread_socket;
 426   ssize_t bytes_written;
 427   ssize_t buffer_len;
 428   int error = 0;
 429
 430  /* 'buffer' is this excessively large only to be able to support things like
 431     test 1003 which tests exceedingly large server response lines */
 432   unsigned char buffer[17010];
 433   char data[16];
 434
 435   if(got_exit_signal) {
 436     logmsg("signalled to die, exiting...");
 437     return FALSE;
 438   }
 439
 440 #ifdef HAVE_GETPPID
 441   /* As a last resort, quit if sockfilt process becomes orphan. Just in case
 442      parent ftpserver process has died without killing its sockfilt children */
 443   if(getppid() <= 1) {
 444     logmsg("process becomes orphan, exiting");
 445     return FALSE;
 446   }
 447 #endif
 448
 449   timeout.tv_sec = 120;
 450   timeout.tv_usec = 0;
 451
 452   FD_ZERO(&fds_read);
 453   FD_ZERO(&fds_write);
 454   FD_ZERO(&fds_err);
 455
 456   FD_SET(fileno(stdin), &fds_read);
 457
 458   switch(*mode) {
 459
 460   case PASSIVE_LISTEN:
 461
 462     /* server mode */
 463     sockfd = listenfd;
 464     /* there's always a socket to wait for */
 465     FD_SET(sockfd, &fds_read);
 466     maxfd = sockfd;
 467     break;
 468
 469   case PASSIVE_CONNECT:
 470
 471     sockfd = *sockfdp;
 472     if(CURL_SOCKET_BAD == sockfd) {
 473       /* eeek, we are supposedly connected and then this cannot be -1 ! */
 474       logmsg("socket is -1! on %s:%d", __FILE__, __LINE__);
 475       maxfd = 0; /* stdin */
 476     }
 477     else {
 478       /* there's always a socket to wait for */
 479       FD_SET(sockfd, &fds_read);
 480       maxfd = sockfd;
 481     }
 482     break;
 483
 484   case ACTIVE:
 485
 486     sockfd = *sockfdp;
 487     /* sockfd turns CURL_SOCKET_BAD when our connection has been closed */
 488     if(CURL_SOCKET_BAD != sockfd) {
 489       FD_SET(sockfd, &fds_read);
 490       maxfd = sockfd;
 491     }
 492     else {
 493       logmsg("No socket to read on");
 494       maxfd = 0;
 495     }
 496     break;
 497
 498   case ACTIVE_DISCONNECT:
 499
 500     logmsg("disconnected, no socket to read on");
 501     maxfd = 0;
 502     sockfd = CURL_SOCKET_BAD;
 503     break;
 504
 505   } /* switch(*mode) */
 506
 507
 508   do {
 509
 510     rc = select((int)maxfd + 1, &fds_read, &fds_write, &fds_err, &timeout);
 511
 512     if(got_exit_signal) {
 513       logmsg("signalled to die, exiting...");
 514       return FALSE;
 515     }
 516
 517   } while((rc == -1) && ((error = SOCKERRNO) == EINTR));
 518
 519   if(rc < 0) {
 520     logmsg("select() failed with error: (%d) %s",
 521            error, strerror(error));
 522     return FALSE;
 523   }
 524
 525   if(rc == 0)
 526     /* timeout */
 527     return TRUE;
 528
 529
 530   if(FD_ISSET(fileno(stdin), &fds_read)) {
 531     /* read from stdin, commands/data to be dealt with and possibly passed on
 532        to the socket
 533
 534        protocol:
 535
 536        4 letter command + LF [mandatory]
 537
 538        4-digit hexadecimal data length + LF [if the command takes data]
 539        data                       [the data being as long as set above]
 540
 541        Commands:
 542
 543        DATA - plain pass-thru data
 544     */
 545
 546     if(!read_stdin(buffer, 5))
 547       return FALSE;
 548
 549     logmsg("Received %c%c%c%c (on stdin)",
 550            buffer[0], buffer[1], buffer[2], buffer[3] );
 551
 552     if(!memcmp("PING", buffer, 4)) {
 553       /* send reply on stdout, just proving we are alive */
 554       if(!write_stdout("PONG\n", 5))
 555         return FALSE;
 556     }
 557
 558     else if(!memcmp("PORT", buffer, 4)) {
 559       /* Question asking us what PORT number we are listening to.
 560          Replies to PORT with "IPv[num]/[port]" */
 561       sprintf((char *)buffer, "%s/%hu\n", ipv_inuse, port);
 562       buffer_len = (ssize_t)strlen((char *)buffer);
 563       snprintf(data, sizeof(data), "PORT\n%04zx\n", buffer_len);
 564       if(!write_stdout(data, 10))
 565         return FALSE;
 566       if(!write_stdout(buffer, buffer_len))
 567         return FALSE;
 568     }
 569     else if(!memcmp("QUIT", buffer, 4)) {
 570       /* just die */
 571       logmsg("quits");
 572       return FALSE;
 573     }
 574     else if(!memcmp("DATA", buffer, 4)) {
 575       /* data IN => data OUT */
 576
 577       if(!read_stdin(buffer, 5))
 578         return FALSE;
 579
 580       buffer[5] = '\0';
 581
 582       buffer_len = (ssize_t)strtol((char *)buffer, NULL, 16);
 583       if (buffer_len > (ssize_t)sizeof(buffer)) {
 584         logmsg("ERROR: Buffer size (%zu bytes) too small for data size "
 585                "(%zd bytes)", sizeof(buffer), buffer_len);
 586         return FALSE;
 587       }
 588       logmsg("> %zd bytes data, server => client", buffer_len);
 589
 590       if(!read_stdin(buffer, buffer_len))
 591         return FALSE;
 592
 593       lograw(buffer, buffer_len);
 594
 595       if(*mode == PASSIVE_LISTEN) {
 596         logmsg("*** We are disconnected!");
 597         if(!write_stdout("DISC\n", 5))
 598           return FALSE;
 599       }
 600       else {
 601         /* send away on the socket */
 602         bytes_written = swrite(sockfd, buffer, buffer_len);
 603         if(bytes_written != buffer_len) {
 604           logmsg("Not all data was sent. Bytes to send: %zd sent: %zd",
 605                  buffer_len, bytes_written);
 606         }
 607       }
 608     }
 609     else if(!memcmp("DISC", buffer, 4)) {
 610       /* disconnect! */
 611       if(!write_stdout("DISC\n", 5))
 612         return FALSE;
 613       if(sockfd != CURL_SOCKET_BAD) {
 614         logmsg("====> Client forcibly disconnected");
 615         sclose(sockfd);
 616         *sockfdp = CURL_SOCKET_BAD;
 617         if(*mode == PASSIVE_CONNECT)
 618           *mode = PASSIVE_LISTEN;
 619         else
 620           *mode = ACTIVE_DISCONNECT;
 621       }
 622       else
 623         logmsg("attempt to close already dead connection");
 624       return TRUE;
 625     }
 626   }
 627
 628
 629   if((sockfd != CURL_SOCKET_BAD) && (FD_ISSET(sockfd, &fds_read)) ) {
 630
 631     if(*mode == PASSIVE_LISTEN) {
 632       /* there's no stream set up yet, this is an indication that there's a
 633          client connecting. */
 634       sockfd = accept(sockfd, NULL, NULL);
 635       if(CURL_SOCKET_BAD == sockfd)
 636         logmsg("accept() failed");
 637       else {
 638         logmsg("====> Client connect");
 639         if(!write_stdout("CNCT\n", 5))
 640           return FALSE;
 641         *sockfdp = sockfd; /* store the new socket */
 642         *mode = PASSIVE_CONNECT; /* we have connected */
 643       }
 644       return TRUE;
 645     }
 646
 647     /* read from socket, pass on data to stdout */
 648     nread_socket = sread(sockfd, buffer, sizeof(buffer));
 649
 650     if(nread_socket <= 0) {
 651       logmsg("====> Client disconnect");
 652       if(!write_stdout("DISC\n", 5))
 653         return FALSE;
 654       sclose(sockfd);
 655       *sockfdp = CURL_SOCKET_BAD;
 656       if(*mode == PASSIVE_CONNECT)
 657         *mode = PASSIVE_LISTEN;
 658       else
 659         *mode = ACTIVE_DISCONNECT;
 660       return TRUE;
 661     }
 662
 663     snprintf(data, sizeof(data), "DATA\n%04zx\n", nread_socket);
 664     if(!write_stdout(data, 10))
 665       return FALSE;
 666     if(!write_stdout(buffer, nread_socket))
 667       return FALSE;
 668
 669     logmsg("< %zd bytes data, client => server", nread_socket);
 670     lograw(buffer, nread_socket);
 671   }
 672
 673   return TRUE;
 674 }
 675
 676 static curl_socket_t sockdaemon(curl_socket_t sock,
 677                                 unsigned short *listenport)
 678 {
 679   /* passive daemon style */
 680   struct sockaddr_in me;
 681 #ifdef ENABLE_IPV6
 682   struct sockaddr_in6 me6;
 683 #endif /* ENABLE_IPV6 */
 684   int flag;
 685   int rc;
 686   int totdelay = 0;
 687   int maxretr = 10;
 688   int delay= 20;
 689   int attempt = 0;
 690   int error = 0;
 691
 692   do {
 693     attempt++;
 694     flag = 1;
 695     rc = setsockopt(sock, SOL_SOCKET, SO_REUSEADDR,
 696          (void *)&flag, sizeof(flag));
 697     if(rc) {
 698       error = SOCKERRNO;
 699       logmsg("setsockopt(SO_REUSEADDR) failed with error: (%d) %s",
 700              error, strerror(error));
 701       if(maxretr) {
 702         rc = wait_ms(delay);
 703         if(rc) {
 704           /* should not happen */
 705           error = SOCKERRNO;
 706           logmsg("wait_ms() failed with error: (%d) %s",
 707                  error, strerror(error));
 708           sclose(sock);
 709           return CURL_SOCKET_BAD;
 710         }
 711         if(got_exit_signal) {
 712           logmsg("signalled to die, exiting...");
 713           sclose(sock);
 714           return CURL_SOCKET_BAD;
 715         }
 716         totdelay += delay;
 717         delay *= 2; /* double the sleep for next attempt */
 718       }
 719     }
 720   } while(rc && maxretr--);
 721
 722   if(rc) {
 723     logmsg("setsockopt(SO_REUSEADDR) failed %d times in %d ms. Error: (%d) %s",
 724            attempt, totdelay, error, strerror(error));
 725     logmsg("Continuing anyway...");
 726   }
 727
 728   /* When the specified listener port is zero, it is actually a
 729      request to let the system choose a non-zero available port. */
 730
 731 #ifdef ENABLE_IPV6
 732   if(!use_ipv6) {
 733 #endif
 734     memset(&me, 0, sizeof(me));
 735     me.sin_family = AF_INET;
 736     me.sin_addr.s_addr = INADDR_ANY;
 737     me.sin_port = htons(*listenport);
 738     rc = bind(sock, (struct sockaddr *) &me, sizeof(me));
 739 #ifdef ENABLE_IPV6
 740   }
 741   else {
 742     memset(&me6, 0, sizeof(me6));
 743     me6.sin6_family = AF_INET6;
 744     me6.sin6_addr = in6addr_any;
 745     me6.sin6_port = htons(*listenport);
 746     rc = bind(sock, (struct sockaddr *) &me6, sizeof(me6));
 747   }
 748 #endif /* ENABLE_IPV6 */
 749   if(rc) {
 750     error = SOCKERRNO;
 751     logmsg("Error binding socket: (%d) %s", error, strerror(error));
 752     sclose(sock);
 753     return CURL_SOCKET_BAD;
 754   }
 755
 756   if(!*listenport) {
 757     /* The system was supposed to choose a port number, figure out which
 758        port we actually got and update the listener port value with it. */
 759     curl_socklen_t la_size;
 760     struct sockaddr *localaddr;
 761     struct sockaddr_in localaddr4;
 762 #ifdef ENABLE_IPV6
 763     struct sockaddr_in6 localaddr6;
 764     if(!use_ipv6) {
 765 #endif
 766       la_size = sizeof(localaddr4);
 767       localaddr = (struct sockaddr *)&localaddr4;
 768 #ifdef ENABLE_IPV6
 769     }
 770     else {
 771       la_size = sizeof(localaddr6);
 772       localaddr = (struct sockaddr *)&localaddr6;
 773     }
 774 #endif
 775     memset(localaddr, 0, (size_t)la_size);
 776     if(getsockname(sock, localaddr, &la_size) < 0) {
 777       error = SOCKERRNO;
 778       logmsg("getsockname() failed with error: (%d) %s",
 779              error, strerror(error));
 780       sclose(sock);
 781       return CURL_SOCKET_BAD;
 782     }
 783     switch (localaddr->sa_family) {
 784     case AF_INET:
 785       *listenport = ntohs(localaddr4.sin_port);
 786       break;
 787 #ifdef ENABLE_IPV6
 788     case AF_INET6:
 789       *listenport = ntohs(localaddr6.sin6_port);
 790       break;
 791 #endif
 792     default:
 793       break;
 794     }
 795     if(!*listenport) {
 796       /* Real failure, listener port shall not be zero beyond this point. */
 797       logmsg("Successfull getsockname() but unknown listener port.");
 798       sclose(sock);
 799       return CURL_SOCKET_BAD;
 800     }
 801   }
 802
 803   /* start accepting connections */
 804   rc = listen(sock, 5);
 805   if(0 != rc) {
 806     error = SOCKERRNO;
 807     logmsg("listen() failed with error: (%d) %s",
 808            error, strerror(error));
 809     sclose(sock);
 810     return CURL_SOCKET_BAD;
 811   }
 812
 813   return sock;
 814 }
 815
 816
 817 int main(int argc, char *argv[])
 818 {
 819   struct sockaddr_in me;
 820 #ifdef ENABLE_IPV6
 821   struct sockaddr_in6 me6;
 822 #endif /* ENABLE_IPV6 */
 823   curl_socket_t sock = CURL_SOCKET_BAD;
 824   curl_socket_t msgsock = CURL_SOCKET_BAD;
 825   int wrotepidfile = 0;
 826   char *pidname= (char *)".sockfilt.pid";
 827   int rc;
 828   int error;
 829   int arg=1;
 830   enum sockmode mode = PASSIVE_LISTEN; /* default */
 831   const char *addr = NULL;
 832
 833   while(argc>arg) {
 834     if(!strcmp("--version", argv[arg])) {
 835       printf("sockfilt IPv4%s\n",
 836 #ifdef ENABLE_IPV6
 837              "/IPv6"
 838 #else
 839              ""
 840 #endif
 841              );
 842       return 0;
 843     }
 844     else if(!strcmp("--verbose", argv[arg])) {
 845       verbose = TRUE;
 846       arg++;
 847     }
 848     else if(!strcmp("--pidfile", argv[arg])) {
 849       arg++;
 850       if(argc>arg)
 851         pidname = argv[arg++];
 852     }
 853     else if(!strcmp("--logfile", argv[arg])) {
 854       arg++;
 855       if(argc>arg)
 856         serverlogfile = argv[arg++];
 857     }
 858     else if(!strcmp("--ipv6", argv[arg])) {
 859 #ifdef ENABLE_IPV6
 860       ipv_inuse = "IPv6";
 861       use_ipv6 = TRUE;
 862 #endif
 863       arg++;
 864     }
 865     else if(!strcmp("--ipv4", argv[arg])) {
 866       /* for completeness, we support this option as well */
 867 #ifdef ENABLE_IPV6
 868       ipv_inuse = "IPv4";
 869       use_ipv6 = FALSE;
 870 #endif
 871       arg++;
 872     }
 873     else if(!strcmp("--port", argv[arg])) {
 874       arg++;
 875       if(argc>arg) {
 876         port = (unsigned short)atoi(argv[arg]);
 877         arg++;
 878       }
 879     }
 880     else if(!strcmp("--connect", argv[arg])) {
 881       /* Asked to actively connect to the specified local port instead of
 882          doing a passive server-style listening. */
 883       arg++;
 884       if(argc>arg) {
 885         connectport = (unsigned short)atoi(argv[arg]);
 886         arg++;
 887       }
 888     }
 889     else if(!strcmp("--addr", argv[arg])) {
 890       /* Set an IP address to use with --connect; otherwise use localhost */
 891       arg++;
 892       if(argc>arg) {
 893         addr = argv[arg];
 894         arg++;
 895       }
 896     }
 897     else {
 898       puts("Usage: sockfilt [option]\n"
 899            " --version\n"
 900            " --verbose\n"
 901            " --logfile [file]\n"
 902            " --pidfile [file]\n"
 903            " --ipv4\n"
 904            " --ipv6\n"
 905            " --port [port]\n"
 906            " --connect [port]\n"
 907            " --addr [address]");
 908       return 0;
 909     }
 910   }
 911
 912 #ifdef WIN32
 913   win32_init();
 914   atexit(win32_cleanup);
 915 #endif
 916
 917   install_signal_handlers();
 918
 919 #ifdef ENABLE_IPV6
 920   if(!use_ipv6)
 921 #endif
 922     sock = socket(AF_INET, SOCK_STREAM, 0);
 923 #ifdef ENABLE_IPV6
 924   else
 925     sock = socket(AF_INET6, SOCK_STREAM, 0);
 926 #endif
 927
 928   if(CURL_SOCKET_BAD == sock) {
 929     error = SOCKERRNO;
 930     logmsg("Error creating socket: (%d) %s",
 931            error, strerror(error));
 932     goto sockfilt_cleanup;
 933   }
 934
 935   if(connectport) {
 936     /* Active mode, we should connect to the given port number */
 937     mode = ACTIVE;
 938 #ifdef ENABLE_IPV6
 939     if(!use_ipv6) {
 940 #endif
 941       memset(&me, 0, sizeof(me));
 942       me.sin_family = AF_INET;
 943       me.sin_port = htons(connectport);
 944       me.sin_addr.s_addr = INADDR_ANY;
 945       if (!addr)
 946         addr = "127.0.0.1";
 947       Curl_inet_pton(AF_INET, addr, &me.sin_addr);
 948
 949       rc = connect(sock, (struct sockaddr *) &me, sizeof(me));
 950 #ifdef ENABLE_IPV6
 951     }
 952     else {
 953       memset(&me6, 0, sizeof(me6));
 954       me6.sin6_family = AF_INET6;
 955       me6.sin6_port = htons(connectport);
 956       if (!addr)
 957         addr = "::1";
 958       Curl_inet_pton(AF_INET6, addr, &me6.sin6_addr);
 959
 960       rc = connect(sock, (struct sockaddr *) &me6, sizeof(me6));
 961     }
 962 #endif /* ENABLE_IPV6 */
 963     if(rc) {
 964       error = SOCKERRNO;
 965       logmsg("Error connecting to port %hu: (%d) %s",
 966              connectport, error, strerror(error));
 967       goto sockfilt_cleanup;
 968     }
 969     logmsg("====> Client connect");
 970     msgsock = sock; /* use this as stream */
 971   }
 972   else {
 973     /* passive daemon style */
 974     sock = sockdaemon(sock, &port);
 975     if(CURL_SOCKET_BAD == sock)
 976       goto sockfilt_cleanup;
 977     msgsock = CURL_SOCKET_BAD; /* no stream socket yet */
 978   }
 979
 980   logmsg("Running %s version", ipv_inuse);
 981
 982   if(connectport)
 983     logmsg("Connected to port %hu", connectport);
 984   else
 985     logmsg("Listening on port %hu", port);
 986
 987   wrotepidfile = write_pidfile(pidname);
 988   if(!wrotepidfile)
 989     goto sockfilt_cleanup;
 990
 991   while(juggle(&msgsock, sock, &mode));
 992
 993 sockfilt_cleanup:
 994
 995   if((msgsock != sock) && (msgsock != CURL_SOCKET_BAD))
 996     sclose(msgsock);
 997
 998   if(sock != CURL_SOCKET_BAD)
 999     sclose(sock);
1000
1001   if(wrotepidfile)
1002     unlink(pidname);
1003
1004   restore_signal_handlers();
1005
1006   if(got_exit_signal) {
1007     logmsg("============> sockfilt exits with signal (%d)", exit_signal);
1008     /*
1009      * To properly set the return status of the process we
1010      * must raise the same signal SIGINT or SIGTERM that we
1011      * caught and let the old handler take care of it.
1012      */
1013     raise(exit_signal);
1014   }
1015
1016   logmsg("============> sockfilt quits");
1017   return 0;
1018 }
1019