tests/server/tftpd.c

   1 /***************************************************************************
   2  *                                  _   _ ____  _
   3  *  Project                     ___| | | |  _ \| |
   4  *                             / __| | | | |_) | |
   5  *                            | (__| |_| |  _ <| |___
   6  *                             \___|\___/|_| \_\_____|
   7  *
   8  *
   9  * Trivial file transfer protocol server.
  10  *
  11  * This code includes many modifications by Jim Guyton <guyton@rand-unix>
  12  *
  13  * This source file was started based on netkit-tftpd 0.17
  14  * Heavily modified for curl's test suite
  15  */
  16
  17 /*
  18  * Copyright (c) 1983 Regents of the University of California.
  19  * All rights reserved.
  20  *
  21  * Redistribution and use in source and binary forms, with or without
  22  * modification, are permitted provided that the following conditions
  23  * are met:
  24  * 1. Redistributions of source code must retain the above copyright
  25  *    notice, this list of conditions and the following disclaimer.
  26  * 2. Redistributions in binary form must reproduce the above copyright
  27  *    notice, this list of conditions and the following disclaimer in the
  28  *    documentation and/or other materials provided with the distribution.
  29  * 3. All advertising materials mentioning features or use of this software
  30  *    must display the following acknowledgement:
  31  *      This product includes software developed by the University of
  32  *      California, Berkeley and its contributors.
  33  * 4. Neither the name of the University nor the names of its contributors
  34  *    may be used to endorse or promote products derived from this software
  35  *    without specific prior written permission.
  36  *
  37  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  38  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  39  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  40  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  41  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  42  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  43  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  44  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  45  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  46  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  47  * SUCH DAMAGE.
  48  */
  49
  50 #include "server_setup.h"
  51
  52 #ifdef HAVE_SYS_IOCTL_H
  53 #include <sys/ioctl.h>
  54 #endif
  55 #ifdef HAVE_SIGNAL_H
  56 #include <signal.h>
  57 #endif
  58 #ifdef HAVE_FCNTL_H
  59 #include <fcntl.h>
  60 #endif
  61 #ifdef HAVE_NETINET_IN_H
  62 #include <netinet/in.h>
  63 #endif
  64 #ifdef HAVE_ARPA_INET_H
  65 #include <arpa/inet.h>
  66 #endif
  67 #ifdef HAVE_ARPA_TFTP_H
  68 #include <arpa/tftp.h>
  69 #else
  70 #include "tftp.h"
  71 #endif
  72 #ifdef HAVE_NETDB_H
  73 #include <netdb.h>
  74 #endif
  75 #ifdef HAVE_SYS_FILIO_H
  76 /* FIONREAD on Solaris 7 */
  77 #include <sys/filio.h>
  78 #endif
  79
  80 #include <setjmp.h>
  81
  82 #ifdef HAVE_PWD_H
  83 #include <pwd.h>
  84 #endif
  85
  86 #define ENABLE_CURLX_PRINTF
  87 /* make the curlx header define all printf() functions to use the curlx_*
  88    versions instead */
  89 #include "curlx.h" /* from the private lib dir */
  90 #include "getpart.h"
  91 #include "util.h"
  92 #include "server_sockaddr.h"
  93
  94 /* include memdebug.h last */
  95 #include "memdebug.h"
  96
  97 /*****************************************************************************
  98 *                      STRUCT DECLARATIONS AND DEFINES                       *
  99 *****************************************************************************/
 100
 101 #ifndef PKTSIZE
 102 #define PKTSIZE (SEGSIZE + 4)  /* SEGSIZE defined in arpa/tftp.h */
 103 #endif
 104
 105 struct testcase {
 106   char *buffer;   /* holds the file data to send to the client */
 107   size_t bufsize; /* size of the data in buffer */
 108   char *rptr;     /* read pointer into the buffer */
 109   size_t rcount;  /* amount of data left to read of the file */
 110   long num;       /* test case number */
 111   int ofile;      /* file descriptor for output file when uploading to us */
 112 };
 113
 114 struct formats {
 115   const char *f_mode;
 116   int f_convert;
 117 };
 118
 119 struct errmsg {
 120   int e_code;
 121   const char *e_msg;
 122 };
 123
 124 typedef union {
 125   struct tftphdr hdr;
 126   char storage[PKTSIZE];
 127 } tftphdr_storage_t;
 128
 129 /*
 130  * bf.counter values in range [-1 .. SEGSIZE] represents size of data in the
 131  * bf.buf buffer. Additionally it can also hold flags BF_ALLOC or BF_FREE.
 132  */
 133
 134 struct bf {
 135   int counter;            /* size of data in buffer, or flag */
 136   tftphdr_storage_t buf;  /* room for data packet */
 137 };
 138
 139 #define BF_ALLOC -3       /* alloc'd but not yet filled */
 140 #define BF_FREE  -2       /* free */
 141
 142 #define opcode_RRQ   1
 143 #define opcode_WRQ   2
 144 #define opcode_DATA  3
 145 #define opcode_ACK   4
 146 #define opcode_ERROR 5
 147
 148 #define TIMEOUT      5
 149
 150 #undef MIN
 151 #define MIN(x,y) ((x)<(y)?(x):(y))
 152
 153 #ifndef DEFAULT_LOGFILE
 154 #define DEFAULT_LOGFILE "log/tftpd.log"
 155 #endif
 156
 157 #define REQUEST_DUMP  "log/server.input"
 158
 159 #define DEFAULT_PORT 8999 /* UDP */
 160
 161 /*****************************************************************************
 162 *                              GLOBAL VARIABLES                              *
 163 *****************************************************************************/
 164
 165 static struct errmsg errmsgs[] = {
 166   { EUNDEF,       "Undefined error code" },
 167   { ENOTFOUND,    "File not found" },
 168   { EACCESS,      "Access violation" },
 169   { ENOSPACE,     "Disk full or allocation exceeded" },
 170   { EBADOP,       "Illegal TFTP operation" },
 171   { EBADID,       "Unknown transfer ID" },
 172   { EEXISTS,      "File already exists" },
 173   { ENOUSER,      "No such user" },
 174   { -1,           0 }
 175 };
 176
 177 static struct formats formata[] = {
 178   { "netascii",   1 },
 179   { "octet",      0 },
 180   { NULL,         0 }
 181 };
 182
 183 static struct bf bfs[2];
 184
 185 static int nextone;     /* index of next buffer to use */
 186 static int current;     /* index of buffer in use */
 187
 188                            /* control flags for crlf conversions */
 189 static int newline = 0;    /* fillbuf: in middle of newline expansion */
 190 static int prevchar = -1;  /* putbuf: previous char (cr check) */
 191
 192 static tftphdr_storage_t buf;
 193 static tftphdr_storage_t ackbuf;
 194
 195 static srvr_sockaddr_union_t from;
 196 static curl_socklen_t fromlen;
 197
 198 static curl_socket_t peer = CURL_SOCKET_BAD;
 199
 200 static int timeout;
 201 static int maxtimeout = 5 * TIMEOUT;
 202
 203 static unsigned short sendblock; /* block count used by sendtftp() */
 204 static struct tftphdr *sdp;      /* data buffer used by sendtftp() */
 205 static struct tftphdr *sap;      /* ack buffer  used by sendtftp() */
 206
 207 static unsigned short recvblock; /* block count used by recvtftp() */
 208 static struct tftphdr *rdp;      /* data buffer used by recvtftp() */
 209 static struct tftphdr *rap;      /* ack buffer  used by recvtftp() */
 210
 211 #ifdef ENABLE_IPV6
 212 static bool use_ipv6 = FALSE;
 213 #endif
 214 static const char *ipv_inuse = "IPv4";
 215
 216 const  char *serverlogfile = DEFAULT_LOGFILE;
 217 static char *pidname= (char *)".tftpd.pid";
 218 static int serverlogslocked = 0;
 219 static int wrotepidfile = 0;
 220
 221 #ifdef HAVE_SIGSETJMP
 222 static sigjmp_buf timeoutbuf;
 223 #endif
 224
 225 #if defined(HAVE_ALARM) && defined(SIGALRM)
 226 static int rexmtval = TIMEOUT;
 227 #endif
 228
 229 /* do-nothing macro replacement for systems which lack siginterrupt() */
 230
 231 #ifndef HAVE_SIGINTERRUPT
 232 #define siginterrupt(x,y) do {} while(0)
 233 #endif
 234
 235 /* vars used to keep around previous signal handlers */
 236
 237 typedef RETSIGTYPE (*SIGHANDLER_T)(int);
 238
 239 #ifdef SIGHUP
 240 static SIGHANDLER_T old_sighup_handler  = SIG_ERR;
 241 #endif
 242
 243 #ifdef SIGPIPE
 244 static SIGHANDLER_T old_sigpipe_handler = SIG_ERR;
 245 #endif
 246
 247 #ifdef SIGINT
 248 static SIGHANDLER_T old_sigint_handler  = SIG_ERR;
 249 #endif
 250
 251 #ifdef SIGTERM
 252 static SIGHANDLER_T old_sigterm_handler = SIG_ERR;
 253 #endif
 254
 255 /* var which if set indicates that the program should finish execution */
 256
 257 SIG_ATOMIC_T got_exit_signal = 0;
 258
 259 /* if next is set indicates the first signal handled in exit_signal_handler */
 260
 261 static volatile int exit_signal = 0;
 262
 263 /*****************************************************************************
 264 *                            FUNCTION PROTOTYPES                             *
 265 *****************************************************************************/
 266
 267 static struct tftphdr *rw_init(int);
 268
 269 static struct tftphdr *w_init(void);
 270
 271 static struct tftphdr *r_init(void);
 272
 273 static int readit(struct testcase *test,
 274                   struct tftphdr **dpp,
 275                   int convert);
 276
 277 static int writeit(struct testcase *test,
 278                    struct tftphdr **dpp,
 279                    int ct,
 280                    int convert);
 281
 282 static void read_ahead(struct testcase *test, int convert);
 283
 284 static ssize_t write_behind(struct testcase *test, int convert);
 285
 286 static int synchnet(curl_socket_t);
 287
 288 static int do_tftp(struct testcase *test, struct tftphdr *tp, ssize_t size);
 289
 290 static int validate_access(struct testcase *test, const char *fname, int mode);
 291
 292 static void sendtftp(struct testcase *test, struct formats *pf);
 293
 294 static void recvtftp(struct testcase *test, struct formats *pf);
 295
 296 static void nak(int error);
 297
 298 #if defined(HAVE_ALARM) && defined(SIGALRM)
 299
 300 static void mysignal(int sig, void (*handler)(int));
 301
 302 static void timer(int signum);
 303
 304 static void justtimeout(int signum);
 305
 306 #endif /* HAVE_ALARM && SIGALRM */
 307
 308 static RETSIGTYPE exit_signal_handler(int signum);
 309
 310 static void install_signal_handlers(void);
 311
 312 static void restore_signal_handlers(void);
 313
 314 /*****************************************************************************
 315 *                          FUNCTION IMPLEMENTATIONS                          *
 316 *****************************************************************************/
 317
 318 #if defined(HAVE_ALARM) && defined(SIGALRM)
 319
 320 /*
 321  * Like signal(), but with well-defined semantics.
 322  */
 323 static void mysignal(int sig, void (*handler)(int))
 324 {
 325   struct sigaction sa;
 326   memset(&sa, 0, sizeof(sa));
 327   sa.sa_handler = handler;
 328   sigaction(sig, &sa, NULL);
 329 }
 330
 331 static void timer(int signum)
 332 {
 333   (void)signum;
 334
 335   logmsg("alarm!");
 336
 337   timeout += rexmtval;
 338   if(timeout >= maxtimeout) {
 339     if(wrotepidfile) {
 340       wrotepidfile = 0;
 341       unlink(pidname);
 342     }
 343     if(serverlogslocked) {
 344       serverlogslocked = 0;
 345       clear_advisor_read_lock(SERVERLOGS_LOCK);
 346     }
 347     exit(1);
 348   }
 349 #ifdef HAVE_SIGSETJMP
 350   siglongjmp(timeoutbuf, 1);
 351 #endif
 352 }
 353
 354 static void justtimeout(int signum)
 355 {
 356   (void)signum;
 357 }
 358
 359 #endif /* HAVE_ALARM && SIGALRM */
 360
 361 /* signal handler that will be triggered to indicate that the program
 362   should finish its execution in a controlled manner as soon as possible.
 363   The first time this is called it will set got_exit_signal to one and
 364   store in exit_signal the signal that triggered its execution. */
 365
 366 static RETSIGTYPE exit_signal_handler(int signum)
 367 {
 368   int old_errno = ERRNO;
 369   if(got_exit_signal == 0) {
 370     got_exit_signal = 1;
 371     exit_signal = signum;
 372   }
 373   (void)signal(signum, exit_signal_handler);
 374   SET_ERRNO(old_errno);
 375 }
 376
 377 static void install_signal_handlers(void)
 378 {
 379 #ifdef SIGHUP
 380   /* ignore SIGHUP signal */
 381   if((old_sighup_handler = signal(SIGHUP, SIG_IGN)) == SIG_ERR)
 382     logmsg("cannot install SIGHUP handler: %s", strerror(ERRNO));
 383 #endif
 384 #ifdef SIGPIPE
 385   /* ignore SIGPIPE signal */
 386   if((old_sigpipe_handler = signal(SIGPIPE, SIG_IGN)) == SIG_ERR)
 387     logmsg("cannot install SIGPIPE handler: %s", strerror(ERRNO));
 388 #endif
 389 #ifdef SIGINT
 390   /* handle SIGINT signal with our exit_signal_handler */
 391   if((old_sigint_handler = signal(SIGINT, exit_signal_handler)) == SIG_ERR)
 392     logmsg("cannot install SIGINT handler: %s", strerror(ERRNO));
 393   else
 394     siginterrupt(SIGINT, 1);
 395 #endif
 396 #ifdef SIGTERM
 397   /* handle SIGTERM signal with our exit_signal_handler */
 398   if((old_sigterm_handler = signal(SIGTERM, exit_signal_handler)) == SIG_ERR)
 399     logmsg("cannot install SIGTERM handler: %s", strerror(ERRNO));
 400   else
 401     siginterrupt(SIGTERM, 1);
 402 #endif
 403 }
 404
 405 static void restore_signal_handlers(void)
 406 {
 407 #ifdef SIGHUP
 408   if(SIG_ERR != old_sighup_handler)
 409     (void)signal(SIGHUP, old_sighup_handler);
 410 #endif
 411 #ifdef SIGPIPE
 412   if(SIG_ERR != old_sigpipe_handler)
 413     (void)signal(SIGPIPE, old_sigpipe_handler);
 414 #endif
 415 #ifdef SIGINT
 416   if(SIG_ERR != old_sigint_handler)
 417     (void)signal(SIGINT, old_sigint_handler);
 418 #endif
 419 #ifdef SIGTERM
 420   if(SIG_ERR != old_sigterm_handler)
 421     (void)signal(SIGTERM, old_sigterm_handler);
 422 #endif
 423 }
 424
 425 /*
 426  * init for either read-ahead or write-behind.
 427  * zero for write-behind, one for read-head.
 428  */
 429 static struct tftphdr *rw_init(int x)
 430 {
 431   newline = 0;                    /* init crlf flag */
 432   prevchar = -1;
 433   bfs[0].counter =  BF_ALLOC;     /* pass out the first buffer */
 434   current = 0;
 435   bfs[1].counter = BF_FREE;
 436   nextone = x;                    /* ahead or behind? */
 437   return &bfs[0].buf.hdr;
 438 }
 439
 440 static struct tftphdr *w_init(void)
 441 {
 442   return rw_init(0); /* write-behind */
 443 }
 444
 445 static struct tftphdr *r_init(void)
 446 {
 447   return rw_init(1); /* read-ahead */
 448 }
 449
 450 /* Have emptied current buffer by sending to net and getting ack.
 451    Free it and return next buffer filled with data.
 452  */
 453 static int readit(struct testcase *test, struct tftphdr **dpp,
 454                   int convert /* if true, convert to ascii */)
 455 {
 456   struct bf *b;
 457
 458   bfs[current].counter = BF_FREE; /* free old one */
 459   current = !current;             /* "incr" current */
 460
 461   b = &bfs[current];              /* look at new buffer */
 462   if (b->counter == BF_FREE)      /* if it's empty */
 463     read_ahead(test, convert);    /* fill it */
 464
 465   *dpp = &b->buf.hdr;             /* set caller's ptr */
 466   return b->counter;
 467 }
 468
 469 /*
 470  * fill the input buffer, doing ascii conversions if requested
 471  * conversions are  lf -> cr,lf  and cr -> cr, nul
 472  */
 473 static void read_ahead(struct testcase *test,
 474                        int convert /* if true, convert to ascii */)
 475 {
 476   int i;
 477   char *p;
 478   int c;
 479   struct bf *b;
 480   struct tftphdr *dp;
 481
 482   b = &bfs[nextone];              /* look at "next" buffer */
 483   if (b->counter != BF_FREE)      /* nop if not free */
 484     return;
 485   nextone = !nextone;             /* "incr" next buffer ptr */
 486
 487   dp = &b->buf.hdr;
 488
 489   if (convert == 0) {
 490     /* The former file reading code did this:
 491        b->counter = read(fileno(file), dp->th_data, SEGSIZE); */
 492     size_t copy_n = MIN(SEGSIZE, test->rcount);
 493     memcpy(dp->th_data, test->rptr, copy_n);
 494
 495     /* decrease amount, advance pointer */
 496     test->rcount -= copy_n;
 497     test->rptr += copy_n;
 498     b->counter = (int)copy_n;
 499     return;
 500   }
 501
 502   p = dp->th_data;
 503   for (i = 0 ; i < SEGSIZE; i++) {
 504     if (newline) {
 505       if (prevchar == '\n')
 506         c = '\n';       /* lf to cr,lf */
 507       else
 508         c = '\0';       /* cr to cr,nul */
 509       newline = 0;
 510     }
 511     else {
 512       if(test->rcount) {
 513         c=test->rptr[0];
 514         test->rptr++;
 515         test->rcount--;
 516       }
 517       else
 518         break;
 519       if (c == '\n' || c == '\r') {
 520         prevchar = c;
 521         c = '\r';
 522         newline = 1;
 523       }
 524     }
 525     *p++ = (char)c;
 526   }
 527   b->counter = (int)(p - dp->th_data);
 528 }
 529
 530 /* Update count associated with the buffer, get new buffer from the queue.
 531    Calls write_behind only if next buffer not available.
 532  */
 533 static int writeit(struct testcase *test, struct tftphdr **dpp,
 534                    int ct, int convert)
 535 {
 536   bfs[current].counter = ct;      /* set size of data to write */
 537   current = !current;             /* switch to other buffer */
 538   if (bfs[current].counter != BF_FREE)     /* if not free */
 539     write_behind(test, convert);     /* flush it */
 540   bfs[current].counter = BF_ALLOC;        /* mark as alloc'd */
 541   *dpp =  &bfs[current].buf.hdr;
 542   return ct;                      /* this is a lie of course */
 543 }
 544
 545 /*
 546  * Output a buffer to a file, converting from netascii if requested.
 547  * CR,NUL -> CR  and CR,LF => LF.
 548  * Note spec is undefined if we get CR as last byte of file or a
 549  * CR followed by anything else.  In this case we leave it alone.
 550  */
 551 static ssize_t write_behind(struct testcase *test, int convert)
 552 {
 553   char *writebuf;
 554   int count;
 555   int ct;
 556   char *p;
 557   int c;                          /* current character */
 558   struct bf *b;
 559   struct tftphdr *dp;
 560
 561   b = &bfs[nextone];
 562   if (b->counter < -1)            /* anything to flush? */
 563     return 0;                     /* just nop if nothing to do */
 564
 565   if(!test->ofile) {
 566     char outfile[256];
 567     snprintf(outfile, sizeof(outfile), "log/upload.%ld", test->num);
 568     test->ofile=open(outfile, O_CREAT|O_RDWR, 0777);
 569     if(test->ofile == -1) {
 570       logmsg("Couldn't create and/or open file %s for upload!", outfile);
 571       return -1; /* failure! */
 572     }
 573   }
 574
 575   count = b->counter;             /* remember byte count */
 576   b->counter = BF_FREE;           /* reset flag */
 577   dp = &b->buf.hdr;
 578   nextone = !nextone;             /* incr for next time */
 579   writebuf = dp->th_data;
 580
 581   if (count <= 0)
 582     return -1;                    /* nak logic? */
 583
 584   if (convert == 0)
 585     return write(test->ofile, writebuf, count);
 586
 587   p = writebuf;
 588   ct = count;
 589   while (ct--) {                  /* loop over the buffer */
 590     c = *p++;                     /* pick up a character */
 591     if (prevchar == '\r') {       /* if prev char was cr */
 592       if (c == '\n')              /* if have cr,lf then just */
 593         lseek(test->ofile, -1, SEEK_CUR); /* smash lf on top of the cr */
 594       else
 595         if (c == '\0')            /* if have cr,nul then */
 596           goto skipit;            /* just skip over the putc */
 597       /* else just fall through and allow it */
 598     }
 599     /* formerly
 600        putc(c, file); */
 601     if(1 != write(test->ofile, &c, 1))
 602       break;
 603     skipit:
 604     prevchar = c;
 605   }
 606   return count;
 607 }
 608
 609 /* When an error has occurred, it is possible that the two sides are out of
 610  * synch.  Ie: that what I think is the other side's response to packet N is
 611  * really their response to packet N-1.
 612  *
 613  * So, to try to prevent that, we flush all the input queued up for us on the
 614  * network connection on our host.
 615  *
 616  * We return the number of packets we flushed (mostly for reporting when trace
 617  * is active).
 618  */
 619
 620 static int synchnet(curl_socket_t f /* socket to flush */)
 621 {
 622
 623 #if defined(HAVE_IOCTLSOCKET)
 624   unsigned long i;
 625 #else
 626   int i;
 627 #endif
 628   int j = 0;
 629   char rbuf[PKTSIZE];
 630   srvr_sockaddr_union_t fromaddr;
 631   curl_socklen_t fromaddrlen;
 632
 633   for (;;) {
 634 #if defined(HAVE_IOCTLSOCKET)
 635     (void) ioctlsocket(f, FIONREAD, &i);
 636 #else
 637     (void) ioctl(f, FIONREAD, &i);
 638 #endif
 639     if (i) {
 640       j++;
 641 #ifdef ENABLE_IPV6
 642       if(!use_ipv6)
 643 #endif
 644         fromaddrlen = sizeof(fromaddr.sa4);
 645 #ifdef ENABLE_IPV6
 646       else
 647         fromaddrlen = sizeof(fromaddr.sa6);
 648 #endif
 649       (void) recvfrom(f, rbuf, sizeof(rbuf), 0,
 650                       &fromaddr.sa, &fromaddrlen);
 651     }
 652     else
 653       break;
 654   }
 655   return j;
 656 }
 657
 658 int main(int argc, char **argv)
 659 {
 660   srvr_sockaddr_union_t me;
 661   struct tftphdr *tp;
 662   ssize_t n = 0;
 663   int arg = 1;
 664   unsigned short port = DEFAULT_PORT;
 665   curl_socket_t sock = CURL_SOCKET_BAD;
 666   int flag;
 667   int rc;
 668   int error;
 669   long pid;
 670   struct testcase test;
 671   int result = 0;
 672
 673   memset(&test, 0, sizeof(test));
 674
 675   while(argc>arg) {
 676     if(!strcmp("--version", argv[arg])) {
 677       printf("tftpd IPv4%s\n",
 678 #ifdef ENABLE_IPV6
 679              "/IPv6"
 680 #else
 681              ""
 682 #endif
 683              );
 684       return 0;
 685     }
 686     else if(!strcmp("--pidfile", argv[arg])) {
 687       arg++;
 688       if(argc>arg)
 689         pidname = argv[arg++];
 690     }
 691     else if(!strcmp("--logfile", argv[arg])) {
 692       arg++;
 693       if(argc>arg)
 694         serverlogfile = argv[arg++];
 695     }
 696     else if(!strcmp("--ipv4", argv[arg])) {
 697 #ifdef ENABLE_IPV6
 698       ipv_inuse = "IPv4";
 699       use_ipv6 = FALSE;
 700 #endif
 701       arg++;
 702     }
 703     else if(!strcmp("--ipv6", argv[arg])) {
 704 #ifdef ENABLE_IPV6
 705       ipv_inuse = "IPv6";
 706       use_ipv6 = TRUE;
 707 #endif
 708       arg++;
 709     }
 710     else if(!strcmp("--port", argv[arg])) {
 711       arg++;
 712       if(argc>arg) {
 713         char *endptr;
 714         unsigned long ulnum = strtoul(argv[arg], &endptr, 10);
 715         if((endptr != argv[arg] + strlen(argv[arg])) ||
 716            (ulnum < 1025UL) || (ulnum > 65535UL)) {
 717           fprintf(stderr, "tftpd: invalid --port argument (%s)\n",
 718                   argv[arg]);
 719           return 0;
 720         }
 721         port = curlx_ultous(ulnum);
 722         arg++;
 723       }
 724     }
 725     else if(!strcmp("--srcdir", argv[arg])) {
 726       arg++;
 727       if(argc>arg) {
 728         path = argv[arg];
 729         arg++;
 730       }
 731     }
 732     else {
 733       puts("Usage: tftpd [option]\n"
 734            " --version\n"
 735            " --logfile [file]\n"
 736            " --pidfile [file]\n"
 737            " --ipv4\n"
 738            " --ipv6\n"
 739            " --port [port]\n"
 740            " --srcdir [path]");
 741       return 0;
 742     }
 743   }
 744
 745 #ifdef WIN32
 746   win32_init();
 747   atexit(win32_cleanup);
 748 #endif
 749
 750   install_signal_handlers();
 751
 752   pid = (long)getpid();
 753
 754 #ifdef ENABLE_IPV6
 755   if(!use_ipv6)
 756 #endif
 757     sock = socket(AF_INET, SOCK_DGRAM, 0);
 758 #ifdef ENABLE_IPV6
 759   else
 760     sock = socket(AF_INET6, SOCK_DGRAM, 0);
 761 #endif
 762
 763   if(CURL_SOCKET_BAD == sock) {
 764     error = SOCKERRNO;
 765     logmsg("Error creating socket: (%d) %s",
 766            error, strerror(error));
 767     result = 1;
 768     goto tftpd_cleanup;
 769   }
 770
 771   flag = 1;
 772   if (0 != setsockopt(sock, SOL_SOCKET, SO_REUSEADDR,
 773             (void *)&flag, sizeof(flag))) {
 774     error = SOCKERRNO;
 775     logmsg("setsockopt(SO_REUSEADDR) failed with error: (%d) %s",
 776            error, strerror(error));
 777     result = 1;
 778     goto tftpd_cleanup;
 779   }
 780
 781 #ifdef ENABLE_IPV6
 782   if(!use_ipv6) {
 783 #endif
 784     memset(&me.sa4, 0, sizeof(me.sa4));
 785     me.sa4.sin_family = AF_INET;
 786     me.sa4.sin_addr.s_addr = INADDR_ANY;
 787     me.sa4.sin_port = htons(port);
 788     rc = bind(sock, &me.sa, sizeof(me.sa4));
 789 #ifdef ENABLE_IPV6
 790   }
 791   else {
 792     memset(&me.sa6, 0, sizeof(me.sa6));
 793     me.sa6.sin6_family = AF_INET6;
 794     me.sa6.sin6_addr = in6addr_any;
 795     me.sa6.sin6_port = htons(port);
 796     rc = bind(sock, &me.sa, sizeof(me.sa6));
 797   }
 798 #endif /* ENABLE_IPV6 */
 799   if(0 != rc) {
 800     error = SOCKERRNO;
 801     logmsg("Error binding socket on port %hu: (%d) %s",
 802            port, error, strerror(error));
 803     result = 1;
 804     goto tftpd_cleanup;
 805   }
 806
 807   wrotepidfile = write_pidfile(pidname);
 808   if(!wrotepidfile) {
 809     result = 1;
 810     goto tftpd_cleanup;
 811   }
 812
 813   logmsg("Running %s version on port UDP/%d", ipv_inuse, (int)port);
 814
 815   for (;;) {
 816     fromlen = sizeof(from);
 817 #ifdef ENABLE_IPV6
 818     if(!use_ipv6)
 819 #endif
 820       fromlen = sizeof(from.sa4);
 821 #ifdef ENABLE_IPV6
 822     else
 823       fromlen = sizeof(from.sa6);
 824 #endif
 825     n = (ssize_t)recvfrom(sock, &buf.storage[0], sizeof(buf.storage), 0,
 826                           &from.sa, &fromlen);
 827     if(got_exit_signal)
 828       break;
 829     if (n < 0) {
 830       logmsg("recvfrom");
 831       result = 3;
 832       break;
 833     }
 834
 835     set_advisor_read_lock(SERVERLOGS_LOCK);
 836     serverlogslocked = 1;
 837
 838 #ifdef ENABLE_IPV6
 839     if(!use_ipv6) {
 840 #endif
 841       from.sa4.sin_family = AF_INET;
 842       peer = socket(AF_INET, SOCK_DGRAM, 0);
 843       if(CURL_SOCKET_BAD == peer) {
 844         logmsg("socket");
 845         result = 2;
 846         break;
 847       }
 848       if(connect(peer, &from.sa, sizeof(from.sa4)) < 0) {
 849         logmsg("connect: fail");
 850         result = 1;
 851         break;
 852       }
 853 #ifdef ENABLE_IPV6
 854     }
 855     else {
 856       from.sa6.sin6_family = AF_INET6;
 857       peer = socket(AF_INET6, SOCK_DGRAM, 0);
 858       if(CURL_SOCKET_BAD == peer) {
 859         logmsg("socket");
 860         result = 2;
 861         break;
 862       }
 863       if (connect(peer, &from.sa, sizeof(from.sa6)) < 0) {
 864         logmsg("connect: fail");
 865         result = 1;
 866         break;
 867       }
 868     }
 869 #endif
 870
 871     maxtimeout = 5*TIMEOUT;
 872
 873     tp = &buf.hdr;
 874     tp->th_opcode = ntohs(tp->th_opcode);
 875     if (tp->th_opcode == opcode_RRQ || tp->th_opcode == opcode_WRQ) {
 876       memset(&test, 0, sizeof(test));
 877       if (do_tftp(&test, tp, n) < 0)
 878         break;
 879       if(test.buffer)
 880         free(test.buffer);
 881     }
 882     sclose(peer);
 883     peer = CURL_SOCKET_BAD;
 884
 885     if(test.ofile > 0) {
 886       close(test.ofile);
 887       test.ofile = 0;
 888     }
 889
 890     if(got_exit_signal)
 891       break;
 892
 893     if(serverlogslocked) {
 894       serverlogslocked = 0;
 895       clear_advisor_read_lock(SERVERLOGS_LOCK);
 896     }
 897
 898     logmsg("end of one transfer");
 899
 900   }
 901
 902 tftpd_cleanup:
 903
 904   if(test.ofile > 0)
 905     close(test.ofile);
 906
 907   if((peer != sock) && (peer != CURL_SOCKET_BAD))
 908     sclose(peer);
 909
 910   if(sock != CURL_SOCKET_BAD)
 911     sclose(sock);
 912
 913   if(got_exit_signal)
 914     logmsg("signalled to die");
 915
 916   if(wrotepidfile)
 917     unlink(pidname);
 918
 919   if(serverlogslocked) {
 920     serverlogslocked = 0;
 921     clear_advisor_read_lock(SERVERLOGS_LOCK);
 922   }
 923
 924   restore_signal_handlers();
 925
 926   if(got_exit_signal) {
 927     logmsg("========> %s tftpd (port: %d pid: %ld) exits with signal (%d)",
 928            ipv_inuse, (int)port, pid, exit_signal);
 929     /*
 930      * To properly set the return status of the process we
 931      * must raise the same signal SIGINT or SIGTERM that we
 932      * caught and let the old handler take care of it.
 933      */
 934     raise(exit_signal);
 935   }
 936
 937   logmsg("========> tftpd quits");
 938   return result;
 939 }
 940
 941 /*
 942  * Handle initial connection protocol.
 943  */
 944 static int do_tftp(struct testcase *test, struct tftphdr *tp, ssize_t size)
 945 {
 946   char *cp;
 947   int first = 1, ecode;
 948   struct formats *pf;
 949   char *filename, *mode = NULL;
 950   int error;
 951   FILE *server;
 952
 953   /* Open request dump file. */
 954   server = fopen(REQUEST_DUMP, "ab");
 955   if(!server) {
 956     error = ERRNO;
 957     logmsg("fopen() failed with error: %d %s", error, strerror(error));
 958     logmsg("Error opening file: %s", REQUEST_DUMP);
 959     return -1;
 960   }
 961
 962   /* store input protocol */
 963   fprintf(server, "opcode: %x\n", tp->th_opcode);
 964
 965   cp = (char *)&tp->th_stuff;
 966   filename = cp;
 967 again:
 968   while (cp < &buf.storage[size]) {
 969     if (*cp == '\0')
 970       break;
 971     cp++;
 972   }
 973   if (*cp) {
 974     nak(EBADOP);
 975     fclose(server);
 976     return 3;
 977   }
 978   if (first) {
 979     mode = ++cp;
 980     first = 0;
 981     goto again;
 982   }
 983   /* store input protocol */
 984   fprintf(server, "filename: %s\n", filename);
 985
 986   for (cp = mode; cp && *cp; cp++)
 987     if(ISUPPER(*cp))
 988       *cp = (char)tolower((int)*cp);
 989
 990   /* store input protocol */
 991   fprintf(server, "mode: %s\n", mode);
 992   fclose(server);
 993
 994   for (pf = formata; pf->f_mode; pf++)
 995     if (strcmp(pf->f_mode, mode) == 0)
 996       break;
 997   if (!pf->f_mode) {
 998     nak(EBADOP);
 999     return 2;
1000   }
1001   ecode = validate_access(test, filename, tp->th_opcode);
1002   if (ecode) {
1003     nak(ecode);
1004     return 1;
1005   }
1006   if (tp->th_opcode == opcode_WRQ)
1007     recvtftp(test, pf);
1008   else
1009     sendtftp(test, pf);
1010
1011   return 0;
1012 }
1013
1014 /*
1015  * Validate file access.
1016  */
1017 static int validate_access(struct testcase *test,
1018                            const char *filename, int mode)
1019 {
1020   char *ptr;
1021   long testno, partno;
1022   int error;
1023   char partbuf[80]="data";
1024
1025   logmsg("trying to get file: %s mode %x", filename, mode);
1026
1027   if(!strncmp("verifiedserver", filename, 14)) {
1028     char weare[128];
1029     size_t count = sprintf(weare, "WE ROOLZ: %ld\r\n", (long)getpid());
1030
1031     logmsg("Are-we-friendly question received");
1032     test->buffer = strdup(weare);
1033     test->rptr = test->buffer; /* set read pointer */
1034     test->bufsize = count;    /* set total count */
1035     test->rcount = count;     /* set data left to read */
1036     return 0; /* fine */
1037   }
1038
1039   /* find the last slash */
1040   ptr = strrchr(filename, '/');
1041
1042   if(ptr) {
1043     char *file;
1044
1045     ptr++; /* skip the slash */
1046
1047     /* skip all non-numericals following the slash */
1048     while(*ptr && !ISDIGIT(*ptr))
1049       ptr++;
1050
1051     /* get the number */
1052     testno = strtol(ptr, &ptr, 10);
1053
1054     if(testno > 10000) {
1055       partno = testno % 10000;
1056       testno /= 10000;
1057     }
1058     else
1059       partno = 0;
1060
1061
1062     logmsg("requested test number %ld part %ld", testno, partno);
1063
1064     test->num = testno;
1065
1066     file = test2file(testno);
1067
1068     if(0 != partno)
1069       sprintf(partbuf, "data%ld", partno);
1070
1071     if(file) {
1072       FILE *stream=fopen(file, "rb");
1073       if(!stream) {
1074         error = ERRNO;
1075         logmsg("fopen() failed with error: %d %s", error, strerror(error));
1076         logmsg("Error opening file: %s", file);
1077         logmsg("Couldn't open test file: %s", file);
1078         return EACCESS;
1079       }
1080       else {
1081         size_t count;
1082         error = getpart(&test->buffer, &count, "reply", partbuf, stream);
1083         fclose(stream);
1084         if(error) {
1085           logmsg("getpart() failed with error: %d", error);
1086           return EACCESS;
1087         }
1088         if(test->buffer) {
1089           test->rptr = test->buffer; /* set read pointer */
1090           test->bufsize = count;    /* set total count */
1091           test->rcount = count;     /* set data left to read */
1092         }
1093         else
1094           return EACCESS;
1095       }
1096
1097     }
1098     else
1099       return EACCESS;
1100   }
1101   else {
1102     logmsg("no slash found in path");
1103     return EACCESS; /* failure */
1104   }
1105
1106   logmsg("file opened and all is good");
1107   return 0;
1108 }
1109
1110 /*
1111  * Send the requested file.
1112  */
1113 static void sendtftp(struct testcase *test, struct formats *pf)
1114 {
1115   int size;
1116   ssize_t n;
1117   sendblock = 1;
1118 #if defined(HAVE_ALARM) && defined(SIGALRM)
1119   mysignal(SIGALRM, timer);
1120 #endif
1121   sdp = r_init();
1122   sap = &ackbuf.hdr;
1123   do {
1124     size = readit(test, &sdp, pf->f_convert);
1125     if (size < 0) {
1126       nak(ERRNO + 100);
1127       return;
1128     }
1129     sdp->th_opcode = htons((unsigned short)opcode_DATA);
1130     sdp->th_block = htons(sendblock);
1131     timeout = 0;
1132 #ifdef HAVE_SIGSETJMP
1133     (void) sigsetjmp(timeoutbuf, 1);
1134 #endif
1135     send_data:
1136     if (swrite(peer, sdp, size + 4) != size + 4) {
1137       logmsg("write");
1138       return;
1139     }
1140     read_ahead(test, pf->f_convert);
1141     for ( ; ; ) {
1142 #ifdef HAVE_ALARM
1143       alarm(rexmtval);        /* read the ack */
1144 #endif
1145       n = sread(peer, &ackbuf.storage[0], sizeof(ackbuf.storage));
1146 #ifdef HAVE_ALARM
1147       alarm(0);
1148 #endif
1149       if(got_exit_signal)
1150         return;
1151       if (n < 0) {
1152         logmsg("read: fail");
1153         return;
1154       }
1155       sap->th_opcode = ntohs((unsigned short)sap->th_opcode);
1156       sap->th_block = ntohs(sap->th_block);
1157
1158       if (sap->th_opcode == opcode_ERROR) {
1159         logmsg("got ERROR");
1160         return;
1161       }
1162
1163       if (sap->th_opcode == opcode_ACK) {
1164         if (sap->th_block == sendblock) {
1165           break;
1166         }
1167         /* Re-synchronize with the other side */
1168         (void) synchnet(peer);
1169         if (sap->th_block == (sendblock-1)) {
1170           goto send_data;
1171         }
1172       }
1173
1174     }
1175     sendblock++;
1176   } while (size == SEGSIZE);
1177 }
1178
1179 /*
1180  * Receive a file.
1181  */
1182 static void recvtftp(struct testcase *test, struct formats *pf)
1183 {
1184   ssize_t n, size;
1185   recvblock = 0;
1186 #if defined(HAVE_ALARM) && defined(SIGALRM)
1187   mysignal(SIGALRM, timer);
1188 #endif
1189   rdp = w_init();
1190   rap = &ackbuf.hdr;
1191   do {
1192     timeout = 0;
1193     rap->th_opcode = htons((unsigned short)opcode_ACK);
1194     rap->th_block = htons(recvblock);
1195     recvblock++;
1196 #ifdef HAVE_SIGSETJMP
1197     (void) sigsetjmp(timeoutbuf, 1);
1198 #endif
1199 send_ack:
1200     if (swrite(peer, &ackbuf.storage[0], 4) != 4) {
1201       logmsg("write: fail\n");
1202       goto abort;
1203     }
1204     write_behind(test, pf->f_convert);
1205     for ( ; ; ) {
1206 #ifdef HAVE_ALARM
1207       alarm(rexmtval);
1208 #endif
1209       n = sread(peer, rdp, PKTSIZE);
1210 #ifdef HAVE_ALARM
1211       alarm(0);
1212 #endif
1213       if(got_exit_signal)
1214         goto abort;
1215       if (n < 0) {                       /* really? */
1216         logmsg("read: fail\n");
1217         goto abort;
1218       }
1219       rdp->th_opcode = ntohs((unsigned short)rdp->th_opcode);
1220       rdp->th_block = ntohs(rdp->th_block);
1221       if (rdp->th_opcode == opcode_ERROR)
1222         goto abort;
1223       if (rdp->th_opcode == opcode_DATA) {
1224         if (rdp->th_block == recvblock) {
1225           break;                         /* normal */
1226         }
1227         /* Re-synchronize with the other side */
1228         (void) synchnet(peer);
1229         if (rdp->th_block == (recvblock-1))
1230           goto send_ack;                 /* rexmit */
1231       }
1232     }
1233
1234     size = writeit(test, &rdp, (int)(n - 4), pf->f_convert);
1235     if (size != (n-4)) {                 /* ahem */
1236       if (size < 0)
1237         nak(ERRNO + 100);
1238       else
1239         nak(ENOSPACE);
1240       goto abort;
1241     }
1242   } while (size == SEGSIZE);
1243   write_behind(test, pf->f_convert);
1244
1245   rap->th_opcode = htons((unsigned short)opcode_ACK);  /* send the "final" ack */
1246   rap->th_block = htons(recvblock);
1247   (void) swrite(peer, &ackbuf.storage[0], 4);
1248 #if defined(HAVE_ALARM) && defined(SIGALRM)
1249   mysignal(SIGALRM, justtimeout);        /* just abort read on timeout */
1250   alarm(rexmtval);
1251 #endif
1252   /* normally times out and quits */
1253   n = sread(peer, &buf.storage[0], sizeof(buf.storage));
1254 #ifdef HAVE_ALARM
1255   alarm(0);
1256 #endif
1257   if(got_exit_signal)
1258     goto abort;
1259   if (n >= 4 &&                               /* if read some data */
1260       rdp->th_opcode == opcode_DATA &&        /* and got a data block */
1261       recvblock == rdp->th_block) {           /* then my last ack was lost */
1262     (void) swrite(peer, &ackbuf.storage[0], 4);  /* resend final ack */
1263   }
1264 abort:
1265   return;
1266 }
1267
1268 /*
1269  * Send a nak packet (error message).  Error code passed in is one of the
1270  * standard TFTP codes, or a UNIX errno offset by 100.
1271  */
1272 static void nak(int error)
1273 {
1274   struct tftphdr *tp;
1275   int length;
1276   struct errmsg *pe;
1277
1278   tp = &buf.hdr;
1279   tp->th_opcode = htons((unsigned short)opcode_ERROR);
1280   tp->th_code = htons((unsigned short)error);
1281   for (pe = errmsgs; pe->e_code >= 0; pe++)
1282     if (pe->e_code == error)
1283       break;
1284   if (pe->e_code < 0) {
1285     pe->e_msg = strerror(error - 100);
1286     tp->th_code = EUNDEF;   /* set 'undef' errorcode */
1287   }
1288   length = (int)strlen(pe->e_msg);
1289
1290   /* we use memcpy() instead of strcpy() in order to avoid buffer overflow
1291    * report from glibc with FORTIFY_SOURCE */
1292   memcpy(tp->th_msg, pe->e_msg, length + 1);
1293   length += 5;
1294   if (swrite(peer, &buf.storage[0], length) != length)
1295     logmsg("nak: fail\n");
1296 }