tests/server/sockfilt.c

   1 /***************************************************************************
   2  *                                  _   _ ____  _
   3  *  Project                     ___| | | |  _ \| |
   4  *                             / __| | | | |_) | |
   5  *                            | (__| |_| |  _ <| |___
   6  *                             \___|\___/|_| \_\_____|
   7  *
   8  * Copyright (C) 1998 - 2007, 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 #include "setup.h" /* portability help from the lib directory */
  50
  51 #include <stdio.h>
  52 #include <stdlib.h>
  53 #include <string.h>
  54 #include <stdarg.h>
  55 #include <signal.h>
  56 #include <time.h>
  57 #include <ctype.h>
  58 #include <sys/time.h>
  59 #include <sys/types.h>
  60
  61 #ifdef HAVE_UNISTD_H
  62 #include <unistd.h>
  63 #endif
  64 #ifdef HAVE_SYS_SOCKET_H
  65 #include <sys/socket.h>
  66 #endif
  67 #ifdef HAVE_NETINET_IN_H
  68 #include <netinet/in.h>
  69 #endif
  70 #ifdef _XOPEN_SOURCE_EXTENDED
  71 /* This define is "almost" required to build on HPUX 11 */
  72 #include <arpa/inet.h>
  73 #endif
  74 #ifdef HAVE_NETDB_H
  75 #include <netdb.h>
  76 #endif
  77
  78 #define ENABLE_CURLX_PRINTF
  79 /* make the curlx header define all printf() functions to use the curlx_*
  80    versions instead */
  81 #include "curlx.h" /* from the private lib dir */
  82 #include "getpart.h"
  83 #include "inet_pton.h"
  84 #include "util.h"
  85
  86 /* include memdebug.h last */
  87 #include "memdebug.h"
  88
  89 #define DEFAULT_PORT 8999
  90
  91 #ifndef DEFAULT_LOGFILE
  92 #define DEFAULT_LOGFILE "log/sockfilt.log"
  93 #endif
  94
  95 #ifdef SIGPIPE
  96 static volatile int sigpipe;  /* Why? It's not used */
  97 #endif
  98
  99 const char *serverlogfile = (char *)DEFAULT_LOGFILE;
 100
 101 static void lograw(unsigned char *buffer, ssize_t len)
 102 {
 103   char data[120];
 104   ssize_t i;
 105   unsigned char *ptr = buffer;
 106   char *optr = data;
 107   ssize_t width=0;
 108
 109   for(i=0; i<len; i++) {
 110     switch(ptr[i]) {
 111     case '\n':
 112       sprintf(optr, "\\n");
 113       width += 2;
 114       optr += 2;
 115       break;
 116     case '\r':
 117       sprintf(optr, "\\r");
 118       width += 2;
 119       optr += 2;
 120       break;
 121     default:
 122       sprintf(optr, "%c", (ISGRAPH(ptr[i]) || ptr[i]==0x20) ?ptr[i]:'.');
 123       width++;
 124       optr++;
 125       break;
 126     }
 127
 128     if(width>60) {
 129       logmsg("'%s'", data);
 130       width = 0;
 131       optr = data;
 132     }
 133   }
 134   if(width)
 135     logmsg("'%s'", data);
 136 }
 137
 138 #ifdef SIGPIPE
 139 static void sigpipe_handler(int sig)
 140 {
 141   (void)sig; /* prevent warning */
 142   sigpipe = 1;
 143 }
 144 #endif
 145
 146 char use_ipv6=FALSE;
 147 unsigned short port = DEFAULT_PORT;
 148 unsigned short connectport = 0; /* if non-zero, we activate this mode */
 149
 150 enum sockmode {
 151   PASSIVE_LISTEN,    /* as a server waiting for connections */
 152   PASSIVE_CONNECT,   /* as a server, connected to a client */
 153   ACTIVE,            /* as a client, connected to a server */
 154   ACTIVE_DISCONNECT  /* as a client, disconnected from server */
 155 };
 156
 157 /*
 158   sockfdp is a pointer to an established stream or CURL_SOCKET_BAD
 159
 160   if sockfd is CURL_SOCKET_BAD, listendfd is a listening socket we must
 161   accept()
 162 */
 163 static int juggle(curl_socket_t *sockfdp,
 164                   curl_socket_t listenfd,
 165                   enum sockmode *mode)
 166 {
 167   struct timeval timeout;
 168   fd_set fds_read;
 169   fd_set fds_write;
 170   fd_set fds_err;
 171   curl_socket_t sockfd;
 172   curl_socket_t maxfd;
 173   ssize_t rc;
 174   ssize_t nread_stdin;
 175   ssize_t nread_socket;
 176   ssize_t bytes_written;
 177   ssize_t buffer_len;
 178   unsigned char buffer[256]; /* FIX: bigger buffer */
 179   char data[256];
 180
 181   timeout.tv_sec = 120;
 182   timeout.tv_usec = 0;
 183
 184   FD_ZERO(&fds_read);
 185   FD_ZERO(&fds_write);
 186   FD_ZERO(&fds_err);
 187
 188   FD_SET(fileno(stdin), &fds_read);
 189
 190   switch(*mode) {
 191
 192   case PASSIVE_LISTEN:
 193
 194     /* server mode */
 195     sockfd = listenfd;
 196     /* there's always a socket to wait for */
 197     FD_SET(sockfd, &fds_read);
 198     maxfd = sockfd;
 199     break;
 200
 201   case PASSIVE_CONNECT:
 202
 203     sockfd = *sockfdp;
 204     if(CURL_SOCKET_BAD == sockfd) {
 205       /* eeek, we are supposedly connected and then this cannot be -1 ! */
 206       logmsg("socket is -1! on %s:%d", __FILE__, __LINE__);
 207       maxfd = 0; /* stdin */
 208     }
 209     else {
 210       /* there's always a socket to wait for */
 211       FD_SET(sockfd, &fds_read);
 212       maxfd = sockfd;
 213     }
 214     break;
 215
 216   case ACTIVE:
 217
 218     sockfd = *sockfdp;
 219     /* sockfd turns CURL_SOCKET_BAD when our connection has been closed */
 220     if(CURL_SOCKET_BAD != sockfd) {
 221       FD_SET(sockfd, &fds_read);
 222       maxfd = sockfd;
 223     }
 224     else {
 225       logmsg("No socket to read on");
 226       maxfd = 0;
 227     }
 228     break;
 229
 230   case ACTIVE_DISCONNECT:
 231
 232     logmsg("disconnected, no socket to read on");
 233     maxfd = 0;
 234     sockfd = CURL_SOCKET_BAD;
 235     break;
 236
 237   } /* switch(*mode) */
 238
 239   do {
 240     rc = select(maxfd + 1, &fds_read, &fds_write, &fds_err, &timeout);
 241   } while((rc == -1) && (SOCKERRNO == EINTR));
 242
 243   switch(rc) {
 244   case -1:
 245     return FALSE;
 246
 247   case 0: /* timeout! */
 248     return TRUE;
 249   }
 250
 251
 252   if(FD_ISSET(fileno(stdin), &fds_read)) {
 253     /* read from stdin, commands/data to be dealt with and possibly passed on
 254        to the socket
 255
 256        protocol:
 257
 258        4 letter command + LF [mandatory]
 259
 260        4-digit hexadecimal data length + LF [if the command takes data]
 261        data                       [the data being as long as set above]
 262
 263        Commands:
 264
 265        DATA - plain pass-thru data
 266     */
 267     nread_stdin = read(fileno(stdin), buffer, 5);
 268     if(5 == nread_stdin) {
 269
 270       logmsg("Received %c%c%c%c (on stdin)",
 271              buffer[0], buffer[1], buffer[2], buffer[3] );
 272
 273       if(!memcmp("PING", buffer, 4)) {
 274         /* send reply on stdout, just proving we are alive */
 275         write(fileno(stdout), "PONG\n", 5);
 276       }
 277
 278       else if(!memcmp("PORT", buffer, 4)) {
 279         /* Question asking us what PORT number we are listening to.
 280            Replies to PORT with "IPv[num]/[port]" */
 281         sprintf((char *)buffer, "IPv%d/%d\n", use_ipv6?6:4, (int)port);
 282         buffer_len = (ssize_t)strlen((char *)buffer);
 283         sprintf(data, "PORT\n%04x\n", buffer_len);
 284         write(fileno(stdout), data, 10);
 285         write(fileno(stdout), buffer, buffer_len);
 286       }
 287       else if(!memcmp("QUIT", buffer, 4)) {
 288         /* just die */
 289         logmsg("quits");
 290         return FALSE;
 291       }
 292       else if(!memcmp("DATA", buffer, 4)) {
 293         /* data IN => data OUT */
 294
 295         if(5 != read(fileno(stdin), buffer, 5))
 296           return FALSE;
 297         buffer[5] = '\0';
 298
 299         buffer_len = (ssize_t)strtol((char *)buffer, NULL, 16);
 300         if (buffer_len > (ssize_t)sizeof(buffer)) {
 301           logmsg("Buffer size %d too small for data size %d",
 302                    (int)sizeof(buffer), buffer_len);
 303           return FALSE;
 304         }
 305         nread_stdin = read(fileno(stdin), buffer, buffer_len);
 306         if(nread_stdin != buffer_len)
 307           return FALSE;
 308
 309         logmsg("> %d bytes data, server => client", buffer_len);
 310         lograw(buffer, buffer_len);
 311
 312         if(*mode == PASSIVE_LISTEN) {
 313           logmsg("*** We are disconnected!");
 314           write(fileno(stdout), "DISC\n", 5);
 315         }
 316         else {
 317           /* send away on the socket */
 318           bytes_written = swrite(sockfd, buffer, buffer_len);
 319           if(bytes_written != buffer_len) {
 320             logmsg("Not all data was sent. Bytes to send: %d sent: %d",
 321                    buffer_len, bytes_written);
 322           }
 323         }
 324       }
 325       else if(!memcmp("DISC", buffer, 4)) {
 326         /* disconnect! */
 327         write(fileno(stdout), "DISC\n", 5);
 328         if(sockfd != CURL_SOCKET_BAD) {
 329           logmsg("====> Client forcibly disconnected");
 330           sclose(sockfd);
 331           *sockfdp = CURL_SOCKET_BAD;
 332           if(*mode == PASSIVE_CONNECT)
 333             *mode = PASSIVE_LISTEN;
 334           else
 335             *mode = ACTIVE_DISCONNECT;
 336         }
 337         else
 338           logmsg("attempt to close already dead connection");
 339         return TRUE;
 340       }
 341     }
 342     else if(-1 == nread_stdin) {
 343       logmsg("read %d from stdin, exiting", nread_stdin);
 344       return FALSE;
 345     }
 346   }
 347
 348
 349   if((sockfd != CURL_SOCKET_BAD) && (FD_ISSET(sockfd, &fds_read)) ) {
 350
 351     if(*mode == PASSIVE_LISTEN) {
 352       /* there's no stream set up yet, this is an indication that there's a
 353          client connecting. */
 354       sockfd = accept(sockfd, NULL, NULL);
 355       if(CURL_SOCKET_BAD == sockfd)
 356         logmsg("accept() failed\n");
 357       else {
 358         logmsg("====> Client connect");
 359         write(fileno(stdout), "CNCT\n", 5);
 360         *sockfdp = sockfd; /* store the new socket */
 361         *mode = PASSIVE_CONNECT; /* we have connected */
 362       }
 363       return TRUE;
 364     }
 365
 366     /* read from socket, pass on data to stdout */
 367     nread_socket = sread(sockfd, buffer, sizeof(buffer));
 368
 369     if(nread_socket <= 0) {
 370       logmsg("====> Client disconnect");
 371       write(fileno(stdout), "DISC\n", 5);
 372       sclose(sockfd);
 373       *sockfdp = CURL_SOCKET_BAD;
 374       if(*mode == PASSIVE_CONNECT)
 375         *mode = PASSIVE_LISTEN;
 376       else
 377         *mode = ACTIVE_DISCONNECT;
 378       return TRUE;
 379     }
 380
 381     sprintf(data, "DATA\n%04x\n", nread_socket);
 382     write(fileno(stdout), data, 10);
 383     write(fileno(stdout), buffer, nread_socket);
 384
 385     logmsg("< %d bytes data, client => server", nread_socket);
 386     lograw(buffer, nread_socket);
 387   }
 388
 389   return TRUE;
 390 }
 391
 392 static curl_socket_t sockdaemon(curl_socket_t sock,
 393                                 unsigned short *port)
 394 {
 395   /* passive daemon style */
 396   struct sockaddr_in me;
 397 #ifdef ENABLE_IPV6
 398   struct sockaddr_in6 me6;
 399 #endif /* ENABLE_IPV6 */
 400   int flag = 1;
 401   int rc;
 402
 403   if (setsockopt
 404       (sock, SOL_SOCKET, SO_REUSEADDR, (void *)&flag,
 405        sizeof(flag)) < 0) {
 406     perror("setsockopt(SO_REUSEADDR)");
 407   }
 408
 409 #ifdef ENABLE_IPV6
 410   if(!use_ipv6) {
 411 #endif
 412     me.sin_family = AF_INET;
 413     me.sin_addr.s_addr = INADDR_ANY;
 414     me.sin_port = htons(*port);
 415     rc = bind(sock, (struct sockaddr *) &me, sizeof(me));
 416 #ifdef ENABLE_IPV6
 417   }
 418   else {
 419     memset(&me6, 0, sizeof(struct sockaddr_in6));
 420     me6.sin6_family = AF_INET6;
 421     me6.sin6_addr = in6addr_any;
 422     me6.sin6_port = htons(*port);
 423     rc = bind(sock, (struct sockaddr *) &me6, sizeof(me6));
 424   }
 425 #endif /* ENABLE_IPV6 */
 426   if(rc < 0) {
 427     perror("binding stream socket");
 428     logmsg("Error binding socket");
 429     return CURL_SOCKET_BAD;
 430   }
 431
 432   if(!*port) {
 433     /* The system picked a port number, now figure out which port we actually
 434        got */
 435     /* we succeeded to bind */
 436     struct sockaddr_in add;
 437     socklen_t socksize = sizeof(add);
 438
 439     if(getsockname(sock, (struct sockaddr *) &add,
 440                    &socksize)<0) {
 441       fprintf(stderr, "getsockname() failed");
 442       return CURL_SOCKET_BAD;
 443     }
 444     *port = ntohs(add.sin_port);
 445   }
 446
 447   /* start accepting connections */
 448   rc = listen(sock, 4);
 449   if(0 != rc) {
 450     logmsg("listen() failed with error: %d", SOCKERRNO);
 451     sclose(sock);
 452     return CURL_SOCKET_BAD;
 453   }
 454
 455   return sock;
 456 }
 457
 458 static curl_socket_t mksock(bool use_ipv6)
 459 {
 460   curl_socket_t sock;
 461 #ifdef ENABLE_IPV6
 462   if(!use_ipv6)
 463 #else
 464     (void)use_ipv6;
 465 #endif
 466   sock = socket(AF_INET, SOCK_STREAM, 0);
 467 #ifdef ENABLE_IPV6
 468   else
 469     sock = socket(AF_INET6, SOCK_STREAM, 0);
 470 #endif
 471
 472   if (CURL_SOCKET_BAD == sock) {
 473     perror("opening stream socket");
 474     logmsg("Error opening socket");
 475   }
 476
 477   return sock;
 478 }
 479
 480
 481 int main(int argc, char *argv[])
 482 {
 483   struct sockaddr_in me;
 484 #ifdef ENABLE_IPV6
 485   struct sockaddr_in6 me6;
 486 #endif /* ENABLE_IPV6 */
 487   curl_socket_t sock;
 488   curl_socket_t msgsock;
 489   FILE *pidfile;
 490   char *pidname= (char *)".sockfilt.pid";
 491   int rc;
 492   int arg=1;
 493   enum sockmode mode = PASSIVE_LISTEN; /* default */
 494
 495   while(argc>arg) {
 496     if(!strcmp("--version", argv[arg])) {
 497       printf("sockfilt IPv4%s\n",
 498 #ifdef ENABLE_IPV6
 499              "/IPv6"
 500 #else
 501              ""
 502 #endif
 503              );
 504       return 0;
 505     }
 506     else if(!strcmp("--pidfile", argv[arg])) {
 507       arg++;
 508       if(argc>arg)
 509         pidname = argv[arg++];
 510     }
 511     else if(!strcmp("--logfile", argv[arg])) {
 512       arg++;
 513       if(argc>arg)
 514         serverlogfile = argv[arg++];
 515     }
 516     else if(!strcmp("--ipv6", argv[arg])) {
 517 #ifdef ENABLE_IPV6
 518       use_ipv6=TRUE;
 519 #endif
 520       arg++;
 521     }
 522     else if(!strcmp("--ipv4", argv[arg])) {
 523       /* for completeness, we support this option as well */
 524       use_ipv6=FALSE;
 525       arg++;
 526     }
 527     else if(!strcmp("--port", argv[arg])) {
 528       arg++;
 529       if(argc>arg) {
 530         port = (unsigned short)atoi(argv[arg]);
 531         arg++;
 532       }
 533     }
 534     else if(!strcmp("--connect", argv[arg])) {
 535       /* Asked to actively connect to the specified local port instead of
 536          doing a passive server-style listening. */
 537       arg++;
 538       if(argc>arg) {
 539         connectport = (unsigned short)atoi(argv[arg]);
 540         arg++;
 541       }
 542     }
 543     else {
 544       puts("Usage: sockfilt [option]\n"
 545            " --version\n"
 546            " --logfile [file]\n"
 547            " --pidfile [file]\n"
 548            " --ipv4\n"
 549            " --ipv6\n"
 550            " --port [port]");
 551       return 0;
 552     }
 553   }
 554
 555 #ifdef WIN32
 556   win32_init();
 557   atexit(win32_cleanup);
 558 #else
 559
 560 #ifdef SIGPIPE
 561 #ifdef HAVE_SIGNAL
 562   signal(SIGPIPE, sigpipe_handler);
 563 #endif
 564 #ifdef HAVE_SIGINTERRUPT
 565   siginterrupt(SIGPIPE, 1);
 566 #endif
 567 #endif
 568 #endif
 569
 570
 571   sock = mksock(use_ipv6);
 572   if (CURL_SOCKET_BAD == sock) {
 573     logmsg("Error opening socket: %d", SOCKERRNO);
 574     return 1;
 575   }
 576
 577   if(connectport) {
 578     /* Active mode, we should connect to the given port number */
 579     mode = ACTIVE;
 580 #ifdef ENABLE_IPV6
 581     if(!use_ipv6) {
 582 #endif
 583       memset(&me, 0, sizeof(me));
 584       me.sin_family = AF_INET;
 585       me.sin_port = htons(connectport);
 586       me.sin_addr.s_addr = INADDR_ANY;
 587       Curl_inet_pton(AF_INET, "127.0.0.1", &me.sin_addr);
 588
 589       rc = connect(sock, (struct sockaddr *) &me, sizeof(me));
 590 #ifdef ENABLE_IPV6
 591     }
 592     else {
 593       memset(&me6, 0, sizeof(me6));
 594       me6.sin6_family = AF_INET6;
 595       me6.sin6_port = htons(connectport);
 596       Curl_inet_pton(AF_INET6, "::1", &me6.sin6_addr);
 597
 598       rc = connect(sock, (struct sockaddr *) &me6, sizeof(me6));
 599     }
 600 #endif /* ENABLE_IPV6 */
 601     if(rc) {
 602       perror("connecting stream socket");
 603       logmsg("Error connecting to port %d", port);
 604       sclose(sock);
 605       return 1;
 606     }
 607     logmsg("====> Client connect");
 608     msgsock = sock; /* use this as stream */
 609   }
 610   else {
 611     /* passive daemon style */
 612     sock = sockdaemon(sock, &port);
 613     if(CURL_SOCKET_BAD == sock)
 614       return 1;
 615     msgsock = CURL_SOCKET_BAD; /* no stream socket yet */
 616   }
 617
 618   logmsg("Running IPv%d version",
 619          (use_ipv6?6:4));
 620
 621   if(connectport)
 622     logmsg("Connected to port %d", connectport);
 623   else
 624     logmsg("Listening on port %d", port);
 625
 626   pidfile = fopen(pidname, "w");
 627   if(pidfile) {
 628     int pid = (int)getpid();
 629     fprintf(pidfile, "%d\n", pid);
 630     fclose(pidfile);
 631     logmsg("Wrote pid %d to %s", pid, pidname);
 632   }
 633   else {
 634     fprintf(stderr, "Couldn't write pid file\n");
 635     sclose(sock);
 636     return 1;
 637   }
 638
 639   while(juggle(&msgsock, sock, &mode));
 640
 641   sclose(sock);
 642
 643   return 0;
 644 }
 645