vcs.maemo.org Git - qemu/blob - slirp/misc.c

   1 /*
   2  * Copyright (c) 1995 Danny Gasparovski.
   3  *
   4  * Please read the file COPYRIGHT for the
   5  * terms and conditions of the copyright.
   6  */
   7
   8 #define WANT_SYS_IOCTL_H
   9 #include <slirp.h>
  10
  11 u_int curtime, time_fasttimo, last_slowtimo, detach_time;
  12 u_int detach_wait = 600000;     /* 10 minutes */
  13
  14 #if 0
  15 int x_port = -1;
  16 int x_display = 0;
  17 int x_screen = 0;
  18
  19 int
  20 show_x(buff, inso)
  21         char *buff;
  22         struct socket *inso;
  23 {
  24         if (x_port < 0) {
  25                 lprint("X Redir: X not being redirected.\r\n");
  26         } else {
  27                 lprint("X Redir: In sh/bash/zsh/etc. type: DISPLAY=%s:%d.%d; export DISPLAY\r\n",
  28                       inet_ntoa(our_addr), x_port, x_screen);
  29                 lprint("X Redir: In csh/tcsh/etc. type:    setenv DISPLAY %s:%d.%d\r\n",
  30                       inet_ntoa(our_addr), x_port, x_screen);
  31                 if (x_display)
  32                    lprint("X Redir: Redirecting to display %d\r\n", x_display);
  33         }
  34
  35         return CFG_OK;
  36 }
  37
  38
  39 /*
  40  * XXX Allow more than one X redirection?
  41  */
  42 void
  43 redir_x(inaddr, start_port, display, screen)
  44         u_int32_t inaddr;
  45         int start_port;
  46         int display;
  47         int screen;
  48 {
  49         int i;
  50
  51         if (x_port >= 0) {
  52                 lprint("X Redir: X already being redirected.\r\n");
  53                 show_x(0, 0);
  54         } else {
  55                 for (i = 6001 + (start_port-1); i <= 6100; i++) {
  56                         if (solisten(htons(i), inaddr, htons(6000 + display), 0)) {
  57                                 /* Success */
  58                                 x_port = i - 6000;
  59                                 x_display = display;
  60                                 x_screen = screen;
  61                                 show_x(0, 0);
  62                                 return;
  63                         }
  64                 }
  65                 lprint("X Redir: Error: Couldn't redirect a port for X. Weird.\r\n");
  66         }
  67 }
  68 #endif
  69
  70 #ifndef HAVE_INET_ATON
  71 int
  72 inet_aton(cp, ia)
  73         const char *cp;
  74         struct in_addr *ia;
  75 {
  76         u_int32_t addr = inet_addr(cp);
  77         if (addr == 0xffffffff)
  78                 return 0;
  79         ia->s_addr = addr;
  80         return 1;
  81 }
  82 #endif
  83
  84 /*
  85  * Get our IP address and put it in our_addr
  86  */
  87 void
  88 getouraddr()
  89 {
  90         char buff[256];
  91         struct hostent *he;
  92
  93         if (gethostname(buff,256) < 0)
  94            return;
  95
  96         if ((he = gethostbyname(buff)) == NULL)
  97            return;
  98
  99         our_addr = *(struct in_addr *)he->h_addr;
 100 }
 101
 102 #if SIZEOF_CHAR_P == 8
 103
 104 struct quehead_32 {
 105         u_int32_t qh_link;
 106         u_int32_t qh_rlink;
 107 };
 108
 109 inline void
 110 insque_32(a, b)
 111         void *a;
 112         void *b;
 113 {
 114         register struct quehead_32 *element = (struct quehead_32 *) a;
 115         register struct quehead_32 *head = (struct quehead_32 *) b;
 116         element->qh_link = head->qh_link;
 117         head->qh_link = (u_int32_t)element;
 118         element->qh_rlink = (u_int32_t)head;
 119         ((struct quehead_32 *)(element->qh_link))->qh_rlink
 120         = (u_int32_t)element;
 121 }
 122
 123 inline void
 124 remque_32(a)
 125         void *a;
 126 {
 127         register struct quehead_32 *element = (struct quehead_32 *) a;
 128         ((struct quehead_32 *)(element->qh_link))->qh_rlink = element->qh_rlink;
 129         ((struct quehead_32 *)(element->qh_rlink))->qh_link = element->qh_link;
 130         element->qh_rlink = 0;
 131 }
 132
 133 #endif /* SIZEOF_CHAR_P == 8 */
 134
 135 struct quehead {
 136         struct quehead *qh_link;
 137         struct quehead *qh_rlink;
 138 };
 139
 140 inline void
 141 insque(a, b)
 142         void *a, *b;
 143 {
 144         register struct quehead *element = (struct quehead *) a;
 145         register struct quehead *head = (struct quehead *) b;
 146         element->qh_link = head->qh_link;
 147         head->qh_link = (struct quehead *)element;
 148         element->qh_rlink = (struct quehead *)head;
 149         ((struct quehead *)(element->qh_link))->qh_rlink
 150         = (struct quehead *)element;
 151 }
 152
 153 inline void
 154 remque(a)
 155      void *a;
 156 {
 157   register struct quehead *element = (struct quehead *) a;
 158   ((struct quehead *)(element->qh_link))->qh_rlink = element->qh_rlink;
 159   ((struct quehead *)(element->qh_rlink))->qh_link = element->qh_link;
 160   element->qh_rlink = NULL;
 161   /*  element->qh_link = NULL;  TCP FIN1 crashes if you do this.  Why ? */
 162 }
 163
 164 /* #endif */
 165
 166
 167 int
 168 add_exec(ex_ptr, do_pty, exec, addr, port)
 169         struct ex_list **ex_ptr;
 170         int do_pty;
 171         char *exec;
 172         int addr;
 173         int port;
 174 {
 175         struct ex_list *tmp_ptr;
 176
 177         /* First, check if the port is "bound" */
 178         for (tmp_ptr = *ex_ptr; tmp_ptr; tmp_ptr = tmp_ptr->ex_next) {
 179                 if (port == tmp_ptr->ex_fport && addr == tmp_ptr->ex_addr)
 180                    return -1;
 181         }
 182
 183         tmp_ptr = *ex_ptr;
 184         *ex_ptr = (struct ex_list *)malloc(sizeof(struct ex_list));
 185         (*ex_ptr)->ex_fport = port;
 186         (*ex_ptr)->ex_addr = addr;
 187         (*ex_ptr)->ex_pty = do_pty;
 188         (*ex_ptr)->ex_exec = strdup(exec);
 189         (*ex_ptr)->ex_next = tmp_ptr;
 190         return 0;
 191 }
 192
 193 #ifndef HAVE_STRERROR
 194
 195 /*
 196  * For systems with no strerror
 197  */
 198
 199 extern int sys_nerr;
 200 extern char *sys_errlist[];
 201
 202 char *
 203 strerror(error)
 204         int error;
 205 {
 206         if (error < sys_nerr)
 207            return sys_errlist[error];
 208         else
 209            return "Unknown error.";
 210 }
 211
 212 #endif
 213
 214
 215 #ifdef _WIN32
 216
 217 int
 218 fork_exec(so, ex, do_pty)
 219         struct socket *so;
 220         char *ex;
 221         int do_pty;
 222 {
 223     /* not implemented */
 224     return 0;
 225 }
 226
 227 #else
 228
 229 int
 230 slirp_openpty(amaster, aslave)
 231      int *amaster, *aslave;
 232 {
 233         register int master, slave;
 234
 235 #ifdef HAVE_GRANTPT
 236         char *ptr;
 237
 238         if ((master = open("/dev/ptmx", O_RDWR)) < 0 ||
 239             grantpt(master) < 0 ||
 240             unlockpt(master) < 0 ||
 241             (ptr = ptsname(master)) == NULL)  {
 242                 close(master);
 243                 return -1;
 244         }
 245
 246         if ((slave = open(ptr, O_RDWR)) < 0 ||
 247             ioctl(slave, I_PUSH, "ptem") < 0 ||
 248             ioctl(slave, I_PUSH, "ldterm") < 0 ||
 249             ioctl(slave, I_PUSH, "ttcompat") < 0) {
 250                 close(master);
 251                 close(slave);
 252                 return -1;
 253         }
 254
 255         *amaster = master;
 256         *aslave = slave;
 257         return 0;
 258
 259 #else
 260
 261         static char line[] = "/dev/ptyXX";
 262         register const char *cp1, *cp2;
 263
 264         for (cp1 = "pqrsPQRS"; *cp1; cp1++) {
 265                 line[8] = *cp1;
 266                 for (cp2 = "0123456789abcdefghijklmnopqrstuv"; *cp2; cp2++) {
 267                         line[9] = *cp2;
 268                         if ((master = open(line, O_RDWR, 0)) == -1) {
 269                                 if (errno == ENOENT)
 270                                    return (-1);    /* out of ptys */
 271                         } else {
 272                                 line[5] = 't';
 273                                 /* These will fail */
 274                                 (void) chown(line, getuid(), 0);
 275                                 (void) chmod(line, S_IRUSR|S_IWUSR|S_IWGRP);
 276 #ifdef HAVE_REVOKE
 277                                 (void) revoke(line);
 278 #endif
 279                                 if ((slave = open(line, O_RDWR, 0)) != -1) {
 280                                         *amaster = master;
 281                                         *aslave = slave;
 282                                         return 0;
 283                                 }
 284                                 (void) close(master);
 285                                 line[5] = 'p';
 286                         }
 287                 }
 288         }
 289         errno = ENOENT; /* out of ptys */
 290         return (-1);
 291 #endif
 292 }
 293
 294 /*
 295  * XXX This is ugly
 296  * We create and bind a socket, then fork off to another
 297  * process, which connects to this socket, after which we
 298  * exec the wanted program.  If something (strange) happens,
 299  * the accept() call could block us forever.
 300  *
 301  * do_pty = 0   Fork/exec inetd style
 302  * do_pty = 1   Fork/exec using slirp.telnetd
 303  * do_ptr = 2   Fork/exec using pty
 304  */
 305 int
 306 fork_exec(so, ex, do_pty)
 307         struct socket *so;
 308         char *ex;
 309         int do_pty;
 310 {
 311         int s;
 312         struct sockaddr_in addr;
 313         int addrlen = sizeof(addr);
 314         int opt;
 315         int master;
 316         char *argv[256];
 317 #if 0
 318         char buff[256];
 319 #endif
 320         /* don't want to clobber the original */
 321         char *bptr;
 322         char *curarg;
 323         int c, i, ret;
 324
 325         DEBUG_CALL("fork_exec");
 326         DEBUG_ARG("so = %lx", (long)so);
 327         DEBUG_ARG("ex = %lx", (long)ex);
 328         DEBUG_ARG("do_pty = %lx", (long)do_pty);
 329
 330         if (do_pty == 2) {
 331                 if (slirp_openpty(&master, &s) == -1) {
 332                         lprint("Error: openpty failed: %s\n", strerror(errno));
 333                         return 0;
 334                 }
 335         } else {
 336                 addr.sin_family = AF_INET;
 337                 addr.sin_port = 0;
 338                 addr.sin_addr.s_addr = INADDR_ANY;
 339
 340                 if ((s = socket(AF_INET, SOCK_STREAM, 0)) < 0 ||
 341                     bind(s, (struct sockaddr *)&addr, addrlen) < 0 ||
 342                     listen(s, 1) < 0) {
 343                         lprint("Error: inet socket: %s\n", strerror(errno));
 344                         closesocket(s);
 345
 346                         return 0;
 347                 }
 348         }
 349
 350         switch(fork()) {
 351          case -1:
 352                 lprint("Error: fork failed: %s\n", strerror(errno));
 353                 close(s);
 354                 if (do_pty == 2)
 355                    close(master);
 356                 return 0;
 357
 358          case 0:
 359                 /* Set the DISPLAY */
 360                 if (do_pty == 2) {
 361                         (void) close(master);
 362 #ifdef TIOCSCTTY /* XXXXX */
 363                         (void) setsid();
 364                         ioctl(s, TIOCSCTTY, (char *)NULL);
 365 #endif
 366                 } else {
 367                         getsockname(s, (struct sockaddr *)&addr, &addrlen);
 368                         close(s);
 369                         /*
 370                          * Connect to the socket
 371                          * XXX If any of these fail, we're in trouble!
 372                          */
 373                         s = socket(AF_INET, SOCK_STREAM, 0);
 374                         addr.sin_addr = loopback_addr;
 375                         do {
 376                             ret = connect(s, (struct sockaddr *)&addr, addrlen);
 377                         } while (ret < 0 && errno == EINTR);
 378                 }
 379
 380 #if 0
 381                 if (x_port >= 0) {
 382 #ifdef HAVE_SETENV
 383                         sprintf(buff, "%s:%d.%d", inet_ntoa(our_addr), x_port, x_screen);
 384                         setenv("DISPLAY", buff, 1);
 385 #else
 386                         sprintf(buff, "DISPLAY=%s:%d.%d", inet_ntoa(our_addr), x_port, x_screen);
 387                         putenv(buff);
 388 #endif
 389                 }
 390 #endif
 391                 dup2(s, 0);
 392                 dup2(s, 1);
 393                 dup2(s, 2);
 394                 for (s = 3; s <= 255; s++)
 395                    close(s);
 396
 397                 i = 0;
 398                 bptr = strdup(ex); /* No need to free() this */
 399                 if (do_pty == 1) {
 400                         /* Setup "slirp.telnetd -x" */
 401                         argv[i++] = "slirp.telnetd";
 402                         argv[i++] = "-x";
 403                         argv[i++] = bptr;
 404                 } else
 405                    do {
 406                         /* Change the string into argv[] */
 407                         curarg = bptr;
 408                         while (*bptr != ' ' && *bptr != (char)0)
 409                            bptr++;
 410                         c = *bptr;
 411                         *bptr++ = (char)0;
 412                         argv[i++] = strdup(curarg);
 413                    } while (c);
 414
 415                 argv[i] = 0;
 416                 execvp(argv[0], argv);
 417
 418                 /* Ooops, failed, let's tell the user why */
 419                   {
 420                           char buff[256];
 421
 422                           sprintf(buff, "Error: execvp of %s failed: %s\n",
 423                                   argv[0], strerror(errno));
 424                           write(2, buff, strlen(buff)+1);
 425                   }
 426                 close(0); close(1); close(2); /* XXX */
 427                 exit(1);
 428
 429          default:
 430                 if (do_pty == 2) {
 431                         close(s);
 432                         so->s = master;
 433                 } else {
 434                         /*
 435                          * XXX this could block us...
 436                          * XXX Should set a timer here, and if accept() doesn't
 437                          * return after X seconds, declare it a failure
 438                          * The only reason this will block forever is if socket()
 439                          * of connect() fail in the child process
 440                          */
 441                         do {
 442                             so->s = accept(s, (struct sockaddr *)&addr, &addrlen);
 443                         } while (so->s < 0 && errno == EINTR);
 444                         closesocket(s);
 445                         opt = 1;
 446                         setsockopt(so->s,SOL_SOCKET,SO_REUSEADDR,(char *)&opt,sizeof(int));
 447                         opt = 1;
 448                         setsockopt(so->s,SOL_SOCKET,SO_OOBINLINE,(char *)&opt,sizeof(int));
 449                 }
 450                 fd_nonblock(so->s);
 451
 452                 /* Append the telnet options now */
 453                 if (so->so_m != 0 && do_pty == 1)  {
 454                         sbappend(so, so->so_m);
 455                         so->so_m = 0;
 456                 }
 457
 458                 return 1;
 459         }
 460 }
 461 #endif
 462
 463 #ifndef HAVE_STRDUP
 464 char *
 465 strdup(str)
 466         const char *str;
 467 {
 468         char *bptr;
 469
 470         bptr = (char *)malloc(strlen(str)+1);
 471         strcpy(bptr, str);
 472
 473         return bptr;
 474 }
 475 #endif
 476
 477 #if 0
 478 void
 479 snooze_hup(num)
 480         int num;
 481 {
 482         int s, ret;
 483 #ifndef NO_UNIX_SOCKETS
 484         struct sockaddr_un sock_un;
 485 #endif
 486         struct sockaddr_in sock_in;
 487         char buff[256];
 488
 489         ret = -1;
 490         if (slirp_socket_passwd) {
 491                 s = socket(AF_INET, SOCK_STREAM, 0);
 492                 if (s < 0)
 493                    slirp_exit(1);
 494                 sock_in.sin_family = AF_INET;
 495                 sock_in.sin_addr.s_addr = slirp_socket_addr;
 496                 sock_in.sin_port = htons(slirp_socket_port);
 497                 if (connect(s, (struct sockaddr *)&sock_in, sizeof(sock_in)) != 0)
 498                    slirp_exit(1); /* just exit...*/
 499                 sprintf(buff, "kill %s:%d", slirp_socket_passwd, slirp_socket_unit);
 500                 write(s, buff, strlen(buff)+1);
 501         }
 502 #ifndef NO_UNIX_SOCKETS
 503           else {
 504                 s = socket(AF_UNIX, SOCK_STREAM, 0);
 505                 if (s < 0)
 506                    slirp_exit(1);
 507                 sock_un.sun_family = AF_UNIX;
 508                 strcpy(sock_un.sun_path, socket_path);
 509                 if (connect(s, (struct sockaddr *)&sock_un,
 510                               sizeof(sock_un.sun_family) + sizeof(sock_un.sun_path)) != 0)
 511                    slirp_exit(1);
 512                 sprintf(buff, "kill none:%d", slirp_socket_unit);
 513                 write(s, buff, strlen(buff)+1);
 514         }
 515 #endif
 516         slirp_exit(0);
 517 }
 518
 519
 520 void
 521 snooze()
 522 {
 523         sigset_t s;
 524         int i;
 525
 526         /* Don't need our data anymore */
 527         /* XXX This makes SunOS barf */
 528 /*      brk(0); */
 529
 530         /* Close all fd's */
 531         for (i = 255; i >= 0; i--)
 532            close(i);
 533
 534         signal(SIGQUIT, slirp_exit);
 535         signal(SIGHUP, snooze_hup);
 536         sigemptyset(&s);
 537
 538         /* Wait for any signal */
 539         sigsuspend(&s);
 540
 541         /* Just in case ... */
 542         exit(255);
 543 }
 544
 545 void
 546 relay(s)
 547         int s;
 548 {
 549         char buf[8192];
 550         int n;
 551         fd_set readfds;
 552         struct ttys *ttyp;
 553
 554         /* Don't need our data anymore */
 555         /* XXX This makes SunOS barf */
 556 /*      brk(0); */
 557
 558         signal(SIGQUIT, slirp_exit);
 559         signal(SIGHUP, slirp_exit);
 560         signal(SIGINT, slirp_exit);
 561         signal(SIGTERM, slirp_exit);
 562
 563         /* Fudge to get term_raw and term_restore to work */
 564         if (NULL == (ttyp = tty_attach (0, slirp_tty))) {
 565          lprint ("Error: tty_attach failed in misc.c:relay()\r\n");
 566          slirp_exit (1);
 567     }
 568         ttyp->fd = 0;
 569         ttyp->flags |= TTY_CTTY;
 570         term_raw(ttyp);
 571
 572         while (1) {
 573                 FD_ZERO(&readfds);
 574
 575                 FD_SET(0, &readfds);
 576                 FD_SET(s, &readfds);
 577
 578                 n = select(s+1, &readfds, (fd_set *)0, (fd_set *)0, (struct timeval *)0);
 579
 580                 if (n <= 0)
 581                    slirp_exit(0);
 582
 583                 if (FD_ISSET(0, &readfds)) {
 584                         n = read(0, buf, 8192);
 585                         if (n <= 0)
 586                            slirp_exit(0);
 587                         n = writen(s, buf, n);
 588                         if (n <= 0)
 589                            slirp_exit(0);
 590                 }
 591
 592                 if (FD_ISSET(s, &readfds)) {
 593                         n = read(s, buf, 8192);
 594                         if (n <= 0)
 595                            slirp_exit(0);
 596                         n = writen(0, buf, n);
 597                         if (n <= 0)
 598                            slirp_exit(0);
 599                 }
 600         }
 601
 602         /* Just in case.... */
 603         exit(1);
 604 }
 605 #endif
 606
 607 int (*lprint_print) _P((void *, const char *, va_list));
 608 char *lprint_ptr, *lprint_ptr2, **lprint_arg;
 609
 610 void
 611 #ifdef __STDC__
 612 lprint(const char *format, ...)
 613 #else
 614 lprint(va_alist) va_dcl
 615 #endif
 616 {
 617         va_list args;
 618
 619 #ifdef __STDC__
 620         va_start(args, format);
 621 #else
 622         char *format;
 623         va_start(args);
 624         format = va_arg(args, char *);
 625 #endif
 626 #if 0
 627         /* If we're printing to an sbuf, make sure there's enough room */
 628         /* XXX +100? */
 629         if (lprint_sb) {
 630                 if ((lprint_ptr - lprint_sb->sb_wptr) >=
 631                     (lprint_sb->sb_datalen - (strlen(format) + 100))) {
 632                         int deltaw = lprint_sb->sb_wptr - lprint_sb->sb_data;
 633                         int deltar = lprint_sb->sb_rptr - lprint_sb->sb_data;
 634                         int deltap = lprint_ptr -         lprint_sb->sb_data;
 635
 636                         lprint_sb->sb_data = (char *)realloc(lprint_sb->sb_data,
 637                                                              lprint_sb->sb_datalen + TCP_SNDSPACE);
 638
 639                         /* Adjust all values */
 640                         lprint_sb->sb_wptr = lprint_sb->sb_data + deltaw;
 641                         lprint_sb->sb_rptr = lprint_sb->sb_data + deltar;
 642                         lprint_ptr =         lprint_sb->sb_data + deltap;
 643
 644                         lprint_sb->sb_datalen += TCP_SNDSPACE;
 645                 }
 646         }
 647 #endif
 648         if (lprint_print)
 649            lprint_ptr += (*lprint_print)(*lprint_arg, format, args);
 650
 651         /* Check if they want output to be logged to file as well */
 652         if (lfd) {
 653                 /*
 654                  * Remove \r's
 655                  * otherwise you'll get ^M all over the file
 656                  */
 657                 int len = strlen(format);
 658                 char *bptr1, *bptr2;
 659
 660                 bptr1 = bptr2 = strdup(format);
 661
 662                 while (len--) {
 663                         if (*bptr1 == '\r')
 664                            memcpy(bptr1, bptr1+1, len+1);
 665                         else
 666                            bptr1++;
 667                 }
 668                 vfprintf(lfd, bptr2, args);
 669                 free(bptr2);
 670         }
 671         va_end(args);
 672 }
 673
 674 void
 675 add_emu(buff)
 676         char *buff;
 677 {
 678         u_int lport, fport;
 679         u_int8_t tos = 0, emu = 0;
 680         char buff1[256], buff2[256], buff4[128];
 681         char *buff3 = buff4;
 682         struct emu_t *emup;
 683         struct socket *so;
 684
 685         if (sscanf(buff, "%256s %256s", buff2, buff1) != 2) {
 686                 lprint("Error: Bad arguments\r\n");
 687                 return;
 688         }
 689
 690         if (sscanf(buff1, "%d:%d", &lport, &fport) != 2) {
 691                 lport = 0;
 692                 if (sscanf(buff1, "%d", &fport) != 1) {
 693                         lprint("Error: Bad first argument\r\n");
 694                         return;
 695                 }
 696         }
 697
 698         if (sscanf(buff2, "%128[^:]:%128s", buff1, buff3) != 2) {
 699                 buff3 = 0;
 700                 if (sscanf(buff2, "%256s", buff1) != 1) {
 701                         lprint("Error: Bad second argument\r\n");
 702                         return;
 703                 }
 704         }
 705
 706         if (buff3) {
 707                 if (strcmp(buff3, "lowdelay") == 0)
 708                    tos = IPTOS_LOWDELAY;
 709                 else if (strcmp(buff3, "throughput") == 0)
 710                    tos = IPTOS_THROUGHPUT;
 711                 else {
 712                         lprint("Error: Expecting \"lowdelay\"/\"throughput\"\r\n");
 713                         return;
 714                 }
 715         }
 716
 717         if (strcmp(buff1, "ftp") == 0)
 718            emu = EMU_FTP;
 719         else if (strcmp(buff1, "irc") == 0)
 720            emu = EMU_IRC;
 721         else if (strcmp(buff1, "none") == 0)
 722            emu = EMU_NONE; /* ie: no emulation */
 723         else {
 724                 lprint("Error: Unknown service\r\n");
 725                 return;
 726         }
 727
 728         /* First, check that it isn't already emulated */
 729         for (emup = tcpemu; emup; emup = emup->next) {
 730                 if (emup->lport == lport && emup->fport == fport) {
 731                         lprint("Error: port already emulated\r\n");
 732                         return;
 733                 }
 734         }
 735
 736         /* link it */
 737         emup = (struct emu_t *)malloc(sizeof (struct emu_t));
 738         emup->lport = (u_int16_t)lport;
 739         emup->fport = (u_int16_t)fport;
 740         emup->tos = tos;
 741         emup->emu = emu;
 742         emup->next = tcpemu;
 743         tcpemu = emup;
 744
 745         /* And finally, mark all current sessions, if any, as being emulated */
 746         for (so = tcb.so_next; so != &tcb; so = so->so_next) {
 747                 if ((lport && lport == ntohs(so->so_lport)) ||
 748                     (fport && fport == ntohs(so->so_fport))) {
 749                         if (emu)
 750                            so->so_emu = emu;
 751                         if (tos)
 752                            so->so_iptos = tos;
 753                 }
 754         }
 755
 756         lprint("Adding emulation for %s to port %d/%d\r\n", buff1, emup->lport, emup->fport);
 757 }
 758
 759 #ifdef BAD_SPRINTF
 760
 761 #undef vsprintf
 762 #undef sprintf
 763
 764 /*
 765  * Some BSD-derived systems have a sprintf which returns char *
 766  */
 767
 768 int
 769 vsprintf_len(string, format, args)
 770         char *string;
 771         const char *format;
 772         va_list args;
 773 {
 774         vsprintf(string, format, args);
 775         return strlen(string);
 776 }
 777
 778 int
 779 #ifdef __STDC__
 780 sprintf_len(char *string, const char *format, ...)
 781 #else
 782 sprintf_len(va_alist) va_dcl
 783 #endif
 784 {
 785         va_list args;
 786 #ifdef __STDC__
 787         va_start(args, format);
 788 #else
 789         char *string;
 790         char *format;
 791         va_start(args);
 792         string = va_arg(args, char *);
 793         format = va_arg(args, char *);
 794 #endif
 795         vsprintf(string, format, args);
 796         return strlen(string);
 797 }
 798
 799 #endif
 800
 801 void
 802 u_sleep(usec)
 803         int usec;
 804 {
 805         struct timeval t;
 806         fd_set fdset;
 807
 808         FD_ZERO(&fdset);
 809
 810         t.tv_sec = 0;
 811         t.tv_usec = usec * 1000;
 812
 813         select(0, &fdset, &fdset, &fdset, &t);
 814 }
 815
 816 /*
 817  * Set fd blocking and non-blocking
 818  */
 819
 820 void
 821 fd_nonblock(fd)
 822         int fd;
 823 {
 824 #ifdef FIONBIO
 825         int opt = 1;
 826
 827         ioctlsocket(fd, FIONBIO, &opt);
 828 #else
 829         int opt;
 830
 831         opt = fcntl(fd, F_GETFL, 0);
 832         opt |= O_NONBLOCK;
 833         fcntl(fd, F_SETFL, opt);
 834 #endif
 835 }
 836
 837 void
 838 fd_block(fd)
 839         int fd;
 840 {
 841 #ifdef FIONBIO
 842         int opt = 0;
 843
 844         ioctlsocket(fd, FIONBIO, &opt);
 845 #else
 846         int opt;
 847
 848         opt = fcntl(fd, F_GETFL, 0);
 849         opt &= ~O_NONBLOCK;
 850         fcntl(fd, F_SETFL, opt);
 851 #endif
 852 }
 853
 854
 855 #if 0
 856 /*
 857  * invoke RSH
 858  */
 859 int
 860 rsh_exec(so,ns, user, host, args)
 861         struct socket *so;
 862         struct socket *ns;
 863         char *user;
 864         char *host;
 865         char *args;
 866 {
 867         int fd[2];
 868         int fd0[2];
 869         int s;
 870         char buff[256];
 871
 872         DEBUG_CALL("rsh_exec");
 873         DEBUG_ARG("so = %lx", (long)so);
 874
 875         if (pipe(fd)<0) {
 876           lprint("Error: pipe failed: %s\n", strerror(errno));
 877           return 0;
 878         }
 879 /* #ifdef HAVE_SOCKETPAIR */
 880 #if 1
 881         if (socketpair(PF_UNIX,SOCK_STREAM,0, fd0) == -1) {
 882           close(fd[0]);
 883           close(fd[1]);
 884           lprint("Error: openpty failed: %s\n", strerror(errno));
 885           return 0;
 886         }
 887 #else
 888         if (slirp_openpty(&fd0[0], &fd0[1]) == -1) {
 889           close(fd[0]);
 890           close(fd[1]);
 891           lprint("Error: openpty failed: %s\n", strerror(errno));
 892           return 0;
 893         }
 894 #endif
 895
 896         switch(fork()) {
 897          case -1:
 898            lprint("Error: fork failed: %s\n", strerror(errno));
 899            close(fd[0]);
 900            close(fd[1]);
 901            close(fd0[0]);
 902            close(fd0[1]);
 903            return 0;
 904
 905          case 0:
 906            close(fd[0]);
 907            close(fd0[0]);
 908
 909                 /* Set the DISPLAY */
 910            if (x_port >= 0) {
 911 #ifdef HAVE_SETENV
 912              sprintf(buff, "%s:%d.%d", inet_ntoa(our_addr), x_port, x_screen);
 913              setenv("DISPLAY", buff, 1);
 914 #else
 915              sprintf(buff, "DISPLAY=%s:%d.%d", inet_ntoa(our_addr), x_port, x_screen);
 916              putenv(buff);
 917 #endif
 918            }
 919
 920            dup2(fd0[1], 0);
 921            dup2(fd0[1], 1);
 922            dup2(fd[1], 2);
 923            for (s = 3; s <= 255; s++)
 924              close(s);
 925
 926            execlp("rsh","rsh","-l", user, host, args, NULL);
 927
 928            /* Ooops, failed, let's tell the user why */
 929
 930            sprintf(buff, "Error: execlp of %s failed: %s\n",
 931                    "rsh", strerror(errno));
 932            write(2, buff, strlen(buff)+1);
 933            close(0); close(1); close(2); /* XXX */
 934            exit(1);
 935
 936         default:
 937           close(fd[1]);
 938           close(fd0[1]);
 939           ns->s=fd[0];
 940           so->s=fd0[0];
 941
 942           return 1;
 943         }
 944 }
 945 #endif