networking/telnet.c

   1 /* vi: set sw=4 ts=4: */
   2 /*
   3  * telnet implementation for busybox
   4  *
   5  * Author: Tomi Ollila <too@iki.fi>
   6  * Copyright (C) 1994-2000 by Tomi Ollila
   7  *
   8  * Created: Thu Apr  7 13:29:41 1994 too
   9  * Last modified: Fri Jun  9 14:34:24 2000 too
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License as published by
  13  * the Free Software Foundation; either version 2 of the License, or
  14  * (at your option) any later version.
  15  *
  16  * This program is distributed in the hope that it will be useful,
  17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  19  * General Public License for more details.
  20  *
  21  * You should have received a copy of the GNU General Public License
  22  * along with this program; if not, write to the Free Software
  23  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  24  *
  25  * HISTORY
  26  * Revision 3.1  1994/04/17  11:31:54  too
  27  * initial revision
  28  * Modified 2000/06/13 for inclusion into BusyBox by Erik Andersen
  29  * <andersen@lineo.com>
  30  * Modified 2001/05/07 to add ability to pass TTYPE to remote host by Jim McQuillan
  31  * <jam@ltsp.org>
  32  *
  33  */
  34
  35 #include <termios.h>
  36 #include <unistd.h>
  37 #include <errno.h>
  38 #include <stdlib.h>
  39 #include <stdarg.h>
  40 #include <string.h>
  41 #include <signal.h>
  42 #include <arpa/telnet.h>
  43 #include <sys/types.h>
  44 #include <sys/socket.h>
  45 #include <netinet/in.h>
  46 #include <netdb.h>
  47 #include "busybox.h"
  48
  49 #ifdef CONFIG_FEATURE_AUTOWIDTH
  50 #   include <sys/ioctl.h>
  51 #endif
  52
  53 #if 0
  54 static const int DOTRACE = 1;
  55 #endif
  56
  57 #ifdef DOTRACE
  58 #include <arpa/inet.h> /* for inet_ntoa()... */
  59 #define TRACE(x, y) do { if (x) printf y; } while (0)
  60 #else
  61 #define TRACE(x, y)
  62 #endif
  63
  64 #if 0
  65 #define USE_POLL
  66 #include <sys/poll.h>
  67 #else
  68 #include <sys/time.h>
  69 #endif
  70
  71 #define DATABUFSIZE  128
  72 #define IACBUFSIZE   128
  73
  74 static const int CHM_TRY = 0;
  75 static const int CHM_ON = 1;
  76 static const int CHM_OFF = 2;
  77
  78 static const int UF_ECHO = 0x01;
  79 static const int UF_SGA = 0x02;
  80
  81 enum {
  82         TS_0 = 1,
  83         TS_IAC = 2,
  84         TS_OPT = 3,
  85         TS_SUB1 = 4,
  86         TS_SUB2 = 5,
  87 };
  88
  89 #define WriteCS(fd, str) write(fd, str, sizeof str -1)
  90
  91 typedef unsigned char byte;
  92
  93 /* use globals to reduce size ??? */ /* test this hypothesis later */
  94 static struct Globalvars {
  95         int             netfd; /* console fd:s are 0 and 1 (and 2) */
  96     /* same buffer used both for network and console read/write */
  97         char    buf[DATABUFSIZE]; /* allocating so static size is smaller */
  98         byte    telstate; /* telnet negotiation state from network input */
  99         byte    telwish;  /* DO, DONT, WILL, WONT */
 100         byte    charmode;
 101         byte    telflags;
 102         byte    gotsig;
 103         /* buffer to handle telnet negotiations */
 104         char    iacbuf[IACBUFSIZE];
 105         short   iaclen; /* could even use byte */
 106         struct termios termios_def;
 107         struct termios termios_raw;
 108 } G;
 109
 110 #define xUSE_GLOBALVAR_PTR /* xUSE... -> don't use :D (makes smaller code) */
 111
 112 #ifdef USE_GLOBALVAR_PTR
 113 struct Globalvars * Gptr;
 114 #define G (*Gptr)
 115 #else
 116 static struct Globalvars G;
 117 #endif
 118
 119 static inline void iacflush(void)
 120 {
 121         write(G.netfd, G.iacbuf, G.iaclen);
 122         G.iaclen = 0;
 123 }
 124
 125 /* Function prototypes */
 126 static int getport(char * p);
 127 static struct in_addr getserver(char * p);
 128 static void setup_sockaddr_in(struct sockaddr_in * addr, int port);
 129 static int remote_connect(struct in_addr addr, int port);
 130 static void rawmode(void);
 131 static void cookmode(void);
 132 static void do_linemode(void);
 133 static void will_charmode(void);
 134 static void telopt(byte c);
 135 static int subneg(byte c);
 136 #if 0
 137 static int local_bind(int port);
 138 #endif
 139
 140 /* Some globals */
 141 static int one = 1;
 142
 143 #ifdef CONFIG_FEATURE_TELNET_TTYPE
 144 static char *ttype;
 145 #endif
 146
 147 #ifdef CONFIG_FEATURE_AUTOWIDTH
 148 static int win_width, win_height;
 149 #endif
 150
 151 static void doexit(int ev)
 152 {
 153         cookmode();
 154         exit(ev);
 155 }
 156
 157 static void conescape(void)
 158 {
 159         char b;
 160
 161         if (G.gotsig)   /* came from line  mode... go raw */
 162                 rawmode();
 163
 164         WriteCS(1, "\r\nConsole escape. Commands are:\r\n\n"
 165                         " l     go to line mode\r\n"
 166                         " c     go to character mode\r\n"
 167                         " z     suspend telnet\r\n"
 168                         " e     exit telnet\r\n");
 169
 170         if (read(0, &b, 1) <= 0)
 171                 doexit(1);
 172
 173         switch (b)
 174         {
 175         case 'l':
 176                 if (!G.gotsig)
 177                 {
 178                         do_linemode();
 179                         goto rrturn;
 180                 }
 181                 break;
 182         case 'c':
 183                 if (G.gotsig)
 184                 {
 185                         will_charmode();
 186                         goto rrturn;
 187                 }
 188                 break;
 189         case 'z':
 190                 cookmode();
 191                 kill(0, SIGTSTP);
 192                 rawmode();
 193                 break;
 194         case 'e':
 195                 doexit(0);
 196         }
 197
 198         WriteCS(1, "continuing...\r\n");
 199
 200         if (G.gotsig)
 201                 cookmode();
 202
 203  rrturn:
 204         G.gotsig = 0;
 205
 206 }
 207 static void handlenetoutput(int len)
 208 {
 209         /*      here we could do smart tricks how to handle 0xFF:s in output
 210          *      stream  like writing twice every sequence of FF:s (thus doing
 211          *      many write()s. But I think interactive telnet application does
 212          *      not need to be 100% 8-bit clean, so changing every 0xff:s to
 213          *      0x7f:s
 214          *
 215          *      2002-mar-21, Przemyslaw Czerpak (druzus@polbox.com)
 216          *      I don't agree.
 217          *      first - I cannot use programs like sz/rz
 218          *      second - the 0x0D is sent as one character and if the next
 219          *               char is 0x0A then it's eaten by a server side.
 220          *      third - whay doy you have to make 'many write()s'?
 221          *              I don't understand.
 222          *      So I implemented it. It's realy useful for me. I hope that
 223          *      others people will find it interesting to.
 224          */
 225
 226         int i, j;
 227         byte * p = G.buf;
 228         byte outbuf[4*DATABUFSIZE];
 229
 230         for (i = len, j = 0; i > 0; i--, p++)
 231         {
 232                 if (*p == 0x1d)
 233                 {
 234                         conescape();
 235                         return;
 236                 }
 237                 outbuf[j++] = *p;
 238                 if (*p == 0xff)
 239                     outbuf[j++] = 0xff;
 240                 else if (*p == 0x0d)
 241                     outbuf[j++] = 0x00;
 242         }
 243         if (j > 0 )
 244             write(G.netfd, outbuf, j);
 245 }
 246
 247
 248 static void handlenetinput(int len)
 249 {
 250         int i;
 251         int cstart = 0;
 252
 253         for (i = 0; i < len; i++)
 254         {
 255                 byte c = G.buf[i];
 256
 257                 if (G.telstate == 0) /* most of the time state == 0 */
 258                 {
 259                         if (c == IAC)
 260                         {
 261                                 cstart = i;
 262                                 G.telstate = TS_IAC;
 263                         }
 264                 }
 265                 else
 266                         switch (G.telstate)
 267                          {
 268                          case TS_0:
 269                                  if (c == IAC)
 270                                          G.telstate = TS_IAC;
 271                                  else
 272                                          G.buf[cstart++] = c;
 273                                  break;
 274
 275                          case TS_IAC:
 276                                  if (c == IAC) /* IAC IAC -> 0xFF */
 277                                  {
 278                                          G.buf[cstart++] = c;
 279                                          G.telstate = TS_0;
 280                                          break;
 281                                  }
 282                                  /* else */
 283                                  switch (c)
 284                                  {
 285                                  case SB:
 286                                          G.telstate = TS_SUB1;
 287                                          break;
 288                                  case DO:
 289                                  case DONT:
 290                                  case WILL:
 291                                  case WONT:
 292                                          G.telwish =  c;
 293                                          G.telstate = TS_OPT;
 294                                          break;
 295                                  default:
 296                                          G.telstate = TS_0;     /* DATA MARK must be added later */
 297                                  }
 298                                  break;
 299                          case TS_OPT: /* WILL, WONT, DO, DONT */
 300                                  telopt(c);
 301                                  G.telstate = TS_0;
 302                                  break;
 303                          case TS_SUB1: /* Subnegotiation */
 304                          case TS_SUB2: /* Subnegotiation */
 305                                  if (subneg(c))
 306                                          G.telstate = TS_0;
 307                                  break;
 308                          }
 309         }
 310         if (G.telstate)
 311         {
 312                 if (G.iaclen)                   iacflush();
 313                 if (G.telstate == TS_0) G.telstate = 0;
 314
 315                 len = cstart;
 316         }
 317
 318         if (len)
 319                 write(1, G.buf, len);
 320 }
 321
 322
 323 /* ******************************* */
 324
 325 static inline void putiac(int c)
 326 {
 327         G.iacbuf[G.iaclen++] = c;
 328 }
 329
 330
 331 static void putiac2(byte wwdd, byte c)
 332 {
 333         if (G.iaclen + 3 > IACBUFSIZE)
 334                 iacflush();
 335
 336         putiac(IAC);
 337         putiac(wwdd);
 338         putiac(c);
 339 }
 340
 341 #if 0
 342 static void putiac1(byte c)
 343 {
 344         if (G.iaclen + 2 > IACBUFSIZE)
 345                 iacflush();
 346
 347         putiac(IAC);
 348         putiac(c);
 349 }
 350 #endif
 351
 352 #ifdef CONFIG_FEATURE_TELNET_TTYPE
 353 static void putiac_subopt(byte c, char *str)
 354 {
 355         int     len = strlen(str) + 6;   // ( 2 + 1 + 1 + strlen + 2 )
 356
 357         if (G.iaclen + len > IACBUFSIZE)
 358                 iacflush();
 359
 360         putiac(IAC);
 361         putiac(SB);
 362         putiac(c);
 363         putiac(0);
 364
 365         while(*str)
 366                 putiac(*str++);
 367
 368         putiac(IAC);
 369         putiac(SE);
 370 }
 371 #endif
 372
 373 #ifdef CONFIG_FEATURE_AUTOWIDTH
 374 static void putiac_naws(byte c, int x, int y)
 375 {
 376         if (G.iaclen + 9 > IACBUFSIZE)
 377                 iacflush();
 378
 379         putiac(IAC);
 380         putiac(SB);
 381         putiac(c);
 382
 383         putiac((x >> 8) & 0xff);
 384         putiac(x & 0xff);
 385         putiac((y >> 8) & 0xff);
 386         putiac(y & 0xff);
 387
 388         putiac(IAC);
 389         putiac(SE);
 390 }
 391 #endif
 392
 393 /* void putiacstring (subneg strings) */
 394
 395 /* ******************************* */
 396
 397 static char const escapecharis[] = "\r\nEscape character is ";
 398
 399 static void setConMode(void)
 400 {
 401         if (G.telflags & UF_ECHO)
 402         {
 403                 if (G.charmode == CHM_TRY) {
 404                         G.charmode = CHM_ON;
 405                         printf("\r\nEntering character mode%s'^]'.\r\n", escapecharis);
 406                         rawmode();
 407                 }
 408         }
 409         else
 410         {
 411                 if (G.charmode != CHM_OFF) {
 412                         G.charmode = CHM_OFF;
 413                         printf("\r\nEntering line mode%s'^C'.\r\n", escapecharis);
 414                         cookmode();
 415                 }
 416         }
 417 }
 418
 419 /* ******************************* */
 420
 421 static void will_charmode(void)
 422 {
 423         G.charmode = CHM_TRY;
 424         G.telflags |= (UF_ECHO | UF_SGA);
 425         setConMode();
 426
 427         putiac2(DO, TELOPT_ECHO);
 428         putiac2(DO, TELOPT_SGA);
 429         iacflush();
 430 }
 431
 432 static void do_linemode(void)
 433 {
 434         G.charmode = CHM_TRY;
 435         G.telflags &= ~(UF_ECHO | UF_SGA);
 436         setConMode();
 437
 438         putiac2(DONT, TELOPT_ECHO);
 439         putiac2(DONT, TELOPT_SGA);
 440         iacflush();
 441 }
 442
 443 /* ******************************* */
 444
 445 static inline void to_notsup(char c)
 446 {
 447         if      (G.telwish == WILL)     putiac2(DONT, c);
 448         else if (G.telwish == DO)       putiac2(WONT, c);
 449 }
 450
 451 static inline void to_echo(void)
 452 {
 453         /* if server requests ECHO, don't agree */
 454         if      (G.telwish == DO) {     putiac2(WONT, TELOPT_ECHO);     return; }
 455         else if (G.telwish == DONT)     return;
 456
 457         if (G.telflags & UF_ECHO)
 458         {
 459                 if (G.telwish == WILL)
 460                         return;
 461         }
 462         else
 463                 if (G.telwish == WONT)
 464                         return;
 465
 466         if (G.charmode != CHM_OFF)
 467                 G.telflags ^= UF_ECHO;
 468
 469         if (G.telflags & UF_ECHO)
 470                 putiac2(DO, TELOPT_ECHO);
 471         else
 472                 putiac2(DONT, TELOPT_ECHO);
 473
 474         setConMode();
 475         WriteCS(1, "\r\n");  /* sudden modec */
 476 }
 477
 478 static inline void to_sga(void)
 479 {
 480         /* daemon always sends will/wont, client do/dont */
 481
 482         if (G.telflags & UF_SGA)
 483         {
 484                 if (G.telwish == WILL)
 485                         return;
 486         }
 487         else
 488                 if (G.telwish == WONT)
 489                         return;
 490
 491         if ((G.telflags ^= UF_SGA) & UF_SGA) /* toggle */
 492                 putiac2(DO, TELOPT_SGA);
 493         else
 494                 putiac2(DONT, TELOPT_SGA);
 495
 496         return;
 497 }
 498
 499 #ifdef CONFIG_FEATURE_TELNET_TTYPE
 500 static inline void to_ttype(void)
 501 {
 502         /* Tell server we will (or won't) do TTYPE */
 503
 504         if(ttype)
 505                 putiac2(WILL, TELOPT_TTYPE);
 506         else
 507                 putiac2(WONT, TELOPT_TTYPE);
 508
 509         return;
 510 }
 511 #endif
 512
 513 #ifdef CONFIG_FEATURE_AUTOWIDTH
 514 static inline void to_naws(void)
 515 {
 516         /* Tell server we will do NAWS */
 517         putiac2(WILL, TELOPT_NAWS);
 518         return;
 519 }
 520 #endif
 521
 522 static void telopt(byte c)
 523 {
 524         switch (c)
 525         {
 526                 case TELOPT_ECHO:               to_echo(c);     break;
 527                 case TELOPT_SGA:                to_sga(c);      break;
 528 #ifdef CONFIG_FEATURE_TELNET_TTYPE
 529                 case TELOPT_TTYPE:              to_ttype(c);break;
 530 #endif
 531 #ifdef CONFIG_FEATURE_AUTOWIDTH
 532                 case TELOPT_NAWS:               to_naws(c);
 533                                                                 putiac_naws(c, win_width, win_height);
 534                                                                 break;
 535 #endif
 536                 default:                        to_notsup(c);   break;
 537         }
 538 }
 539
 540
 541 /* ******************************* */
 542
 543 /* subnegotiation -- ignore all (except TTYPE,NAWS) */
 544
 545 static int subneg(byte c)
 546 {
 547         switch (G.telstate)
 548         {
 549         case TS_SUB1:
 550                 if (c == IAC)
 551                         G.telstate = TS_SUB2;
 552 #ifdef CONFIG_FEATURE_TELNET_TTYPE
 553                 else
 554                 if (c == TELOPT_TTYPE)
 555                         putiac_subopt(TELOPT_TTYPE,ttype);
 556 #endif
 557                 break;
 558         case TS_SUB2:
 559                 if (c == SE)
 560                         return TRUE;
 561                 G.telstate = TS_SUB1;
 562                 /* break; */
 563         }
 564         return FALSE;
 565 }
 566
 567 /* ******************************* */
 568
 569 static void fgotsig(int sig)
 570 {
 571         G.gotsig = sig;
 572 }
 573
 574
 575 static void rawmode(void)
 576 {
 577         tcsetattr(0, TCSADRAIN, &G.termios_raw);
 578 }
 579
 580 static void cookmode(void)
 581 {
 582         tcsetattr(0, TCSADRAIN, &G.termios_def);
 583 }
 584
 585 extern int telnet_main(int argc, char** argv)
 586 {
 587         struct in_addr host;
 588         int port;
 589         int len;
 590 #ifdef USE_POLL
 591         struct pollfd ufds[2];
 592 #else
 593         fd_set readfds;
 594         int maxfd;
 595 #endif
 596
 597 #ifdef CONFIG_FEATURE_AUTOWIDTH
 598     struct winsize winp;
 599     if( ioctl(0, TIOCGWINSZ, &winp) == 0 ) {
 600         win_width  = winp.ws_col;
 601         win_height = winp.ws_row;
 602     }
 603 #endif
 604
 605 #ifdef CONFIG_FEATURE_TELNET_TTYPE
 606     ttype = getenv("TERM");
 607 #endif
 608
 609         memset(&G, 0, sizeof G);
 610
 611         if (tcgetattr(0, &G.termios_def) < 0)
 612                 exit(1);
 613
 614         G.termios_raw = G.termios_def;
 615         cfmakeraw(&G.termios_raw);
 616
 617         if (argc < 2)   show_usage();
 618         port = (argc > 2)? getport(argv[2]): 23;
 619
 620         host = getserver(argv[1]);
 621
 622         G.netfd = remote_connect(host, port);
 623
 624         signal(SIGINT, fgotsig);
 625
 626 #ifdef USE_POLL
 627         ufds[0].fd = 0; ufds[1].fd = G.netfd;
 628         ufds[0].events = ufds[1].events = POLLIN;
 629 #else
 630         FD_ZERO(&readfds);
 631         FD_SET(0, &readfds);
 632         FD_SET(G.netfd, &readfds);
 633         maxfd = G.netfd + 1;
 634 #endif
 635
 636         while (1)
 637         {
 638 #ifndef USE_POLL
 639                 fd_set rfds = readfds;
 640
 641                 switch (select(maxfd, &rfds, NULL, NULL, NULL))
 642 #else
 643                 switch (poll(ufds, 2, -1))
 644 #endif
 645                 {
 646                 case 0:
 647                         /* timeout */
 648                 case -1:
 649                         /* error, ignore and/or log something, bay go to loop */
 650                         if (G.gotsig)
 651                                 conescape();
 652                         else
 653                                 sleep(1);
 654                         break;
 655                 default:
 656
 657 #ifdef USE_POLL
 658                         if (ufds[0].revents) /* well, should check POLLIN, but ... */
 659 #else
 660                         if (FD_ISSET(0, &rfds))
 661 #endif
 662                         {
 663                                 len = read(0, G.buf, DATABUFSIZE);
 664
 665                                 if (len <= 0)
 666                                         doexit(0);
 667
 668                                 TRACE(0, ("Read con: %d\n", len));
 669
 670                                 handlenetoutput(len);
 671                         }
 672
 673 #ifdef USE_POLL
 674                         if (ufds[1].revents) /* well, should check POLLIN, but ... */
 675 #else
 676                         if (FD_ISSET(G.netfd, &rfds))
 677 #endif
 678                         {
 679                                 len = read(G.netfd, G.buf, DATABUFSIZE);
 680
 681                                 if (len <= 0)
 682                                 {
 683                                         WriteCS(1, "Connection closed by foreign host.\r\n");
 684                                         doexit(1);
 685                                 }
 686                                 TRACE(0, ("Read netfd (%d): %d\n", G.netfd, len));
 687
 688                                 handlenetinput(len);
 689                         }
 690                 }
 691         }
 692 }
 693
 694 static int getport(char * p)
 695 {
 696         unsigned int port = atoi(p);
 697
 698         if ((unsigned)(port - 1 ) > 65534)
 699         {
 700                 error_msg_and_die("%s: bad port number", p);
 701         }
 702         return port;
 703 }
 704
 705 static struct in_addr getserver(char * host)
 706 {
 707         struct in_addr addr;
 708
 709         struct hostent * he;
 710         he = xgethostbyname(host);
 711         memcpy(&addr, he->h_addr, sizeof addr);
 712
 713         TRACE(1, ("addr: %s\n", inet_ntoa(addr)));
 714
 715         return addr;
 716 }
 717
 718 static int create_socket(void)
 719 {
 720         return socket(AF_INET, SOCK_STREAM, 0);
 721 }
 722
 723 static void setup_sockaddr_in(struct sockaddr_in * addr, int port)
 724 {
 725         memset(addr, 0, sizeof(struct sockaddr_in));
 726         addr->sin_family = AF_INET;
 727         addr->sin_port = htons(port);
 728 }
 729
 730 #if 0
 731 static int local_bind(int port)
 732 {
 733         struct sockaddr_in s_addr;
 734         int s = create_socket();
 735
 736         setup_sockaddr_in(&s_addr, port);
 737
 738         setsockopt(s, SOL_SOCKET, SO_REUSEADDR, &one, sizeof one);
 739
 740         if (bind(s, &s_addr, sizeof s_addr) < 0)
 741         {
 742                 char * e = sys_errlist[errno];
 743                 syserrorexit("bind");
 744                 exit(1);
 745         }
 746         listen(s, 1);
 747
 748         return s;
 749 }
 750 #endif
 751
 752 static int remote_connect(struct in_addr addr, int port)
 753 {
 754         struct sockaddr_in s_addr;
 755         int s = create_socket();
 756
 757         setup_sockaddr_in(&s_addr, port);
 758         s_addr.sin_addr = addr;
 759
 760         setsockopt(s, SOL_SOCKET, SO_KEEPALIVE, &one, sizeof one);
 761
 762         if (connect(s, (struct sockaddr *)&s_addr, sizeof s_addr) < 0)
 763         {
 764                 perror_msg_and_die("Unable to connect to remote host");
 765         }
 766         return s;
 767 }
 768
 769 /*
 770 Local Variables:
 771 c-file-style: "linux"
 772 c-basic-offset: 4
 773 tab-width: 4
 774 End:
 775 */