blob: dd59de9d4980dd74405e8b34ee6670c8be24dc29 [file] [log] [blame]
Bernhard Reutner-Fischer2c998512006-04-12 18:09:26 +00001/* vi: set sw=4 ts=4: */
Bernhard Reutner-Fischerdac7ff12006-04-12 17:55:51 +00002/*
Eric Andersen08a72202002-09-30 20:52:10 +00003 * Simple telnet server
4 * Bjorn Wesen, Axis Communications AB (bjornw@axis.com)
5 *
Rob Landley1ec5b292006-05-29 07:42:02 +00006 * Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
Eric Andersen08a72202002-09-30 20:52:10 +00007 *
8 * ---------------------------------------------------------------------------
9 * (C) Copyright 2000, Axis Communications AB, LUND, SWEDEN
10 ****************************************************************************
11 *
12 * The telnetd manpage says it all:
13 *
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +020014 * Telnetd operates by allocating a pseudo-terminal device (see pty(4)) for
15 * a client, then creating a login process which has the slave side of the
16 * pseudo-terminal as stdin, stdout, and stderr. Telnetd manipulates the
17 * master side of the pseudo-terminal, implementing the telnet protocol and
18 * passing characters between the remote client and the login process.
Eric Andersen08a72202002-09-30 20:52:10 +000019 *
20 * Vladimir Oleynik <dzo@simtreas.ru> 2001
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +020021 * Set process group corrections, initial busybox port
Eric Andersen08a72202002-09-30 20:52:10 +000022 */
23
Denis Vlasenko75f8d082006-11-22 15:54:52 +000024#define DEBUG 0
Eric Andersen08a72202002-09-30 20:52:10 +000025
Denis Vlasenkob6adbf12007-05-26 19:00:18 +000026#include "libbb.h"
Bernhard Reutner-Fischerf4701962008-01-27 12:50:12 +000027#include <syslog.h>
Rob Landley099ed502006-08-28 09:41:49 +000028
Denis Vlasenko75f8d082006-11-22 15:54:52 +000029#if DEBUG
Eric Andersen08a72202002-09-30 20:52:10 +000030#define TELCMDS
31#define TELOPTS
32#endif
33#include <arpa/telnet.h>
Eric Andersen08a72202002-09-30 20:52:10 +000034
Eric Andersen08a72202002-09-30 20:52:10 +000035struct tsession {
36 struct tsession *next;
Denis Vlasenkod814c982009-02-02 23:43:57 +000037 pid_t shell_pid;
Denys Vlasenko1d77db82009-06-10 13:38:08 +020038 int sockfd_read;
39 int sockfd_write;
40 int ptyfd;
Denis Vlasenko59d7c432007-10-15 15:19:36 +000041
Eric Andersen08a72202002-09-30 20:52:10 +000042 /* two circular buffers */
Denis Vlasenko59d7c432007-10-15 15:19:36 +000043 /*char *buf1, *buf2;*/
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +020044/*#define TS_BUF1(ts) ts->buf1*/
45/*#define TS_BUF2(ts) TS_BUF2(ts)*/
46#define TS_BUF1(ts) ((unsigned char*)(ts + 1))
47#define TS_BUF2(ts) (((unsigned char*)(ts + 1)) + BUFSIZE)
Eric Andersen08a72202002-09-30 20:52:10 +000048 int rdidx1, wridx1, size1;
49 int rdidx2, wridx2, size2;
50};
51
Denis Vlasenko88308fe2007-06-25 10:35:11 +000052/* Two buffers are directly after tsession in malloced memory.
53 * Make whole thing fit in 4k */
Denis Vlasenko59d7c432007-10-15 15:19:36 +000054enum { BUFSIZE = (4 * 1024 - sizeof(struct tsession)) / 2 };
Denis Vlasenko88308fe2007-06-25 10:35:11 +000055
Eric Andersen08a72202002-09-30 20:52:10 +000056
Denis Vlasenko59d7c432007-10-15 15:19:36 +000057/* Globals */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +020058struct globals {
59 struct tsession *sessions;
60 const char *loginpath;
61 const char *issuefile;
62 int maxfd;
Denys Vlasenko98a4c7c2010-02-04 15:00:15 +010063} FIX_ALIASING;
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +020064#define G (*(struct globals*)&bb_common_bufsiz1)
65#define INIT_G() do { \
66 G.loginpath = "/bin/login"; \
67 G.issuefile = "/etc/issue.net"; \
68} while (0)
Eric Andersen08a72202002-09-30 20:52:10 +000069
70
71/*
Denis Vlasenko59d7c432007-10-15 15:19:36 +000072 Remove all IAC's from buf1 (received IACs are ignored and must be removed
73 so as to not be interpreted by the terminal). Make an uninterrupted
74 string of characters fit for the terminal. Do this by packing
75 all characters meant for the terminal sequentially towards the end of buf.
Eric Andersen08a72202002-09-30 20:52:10 +000076
77 Return a pointer to the beginning of the characters meant for the terminal.
78 and make *num_totty the number of characters that should be sent to
79 the terminal.
80
81 Note - If an IAC (3 byte quantity) starts before (bf + len) but extends
Denis Vlasenko59d7c432007-10-15 15:19:36 +000082 past (bf + len) then that IAC will be left unprocessed and *processed
83 will be less than len.
Eric Andersen08a72202002-09-30 20:52:10 +000084
Denis Vlasenko10916c52007-10-15 17:28:00 +000085 CR-LF ->'s CR mapping is also done here, for convenience.
86
87 NB: may fail to remove iacs which wrap around buffer!
Denis Vlasenko75f8d082006-11-22 15:54:52 +000088 */
Denis Vlasenko10916c52007-10-15 17:28:00 +000089static unsigned char *
Denis Vlasenko75f8d082006-11-22 15:54:52 +000090remove_iacs(struct tsession *ts, int *pnum_totty)
91{
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +020092 unsigned char *ptr0 = TS_BUF1(ts) + ts->wridx1;
Eric Andersen08a72202002-09-30 20:52:10 +000093 unsigned char *ptr = ptr0;
94 unsigned char *totty = ptr;
95 unsigned char *end = ptr + MIN(BUFSIZE - ts->wridx1, ts->size1);
Eric Andersen08a72202002-09-30 20:52:10 +000096 int num_totty;
97
98 while (ptr < end) {
99 if (*ptr != IAC) {
Denis Vlasenko10916c52007-10-15 17:28:00 +0000100 char c = *ptr;
101
102 *totty++ = c;
103 ptr++;
Denis Vlasenkob0150d22008-11-07 01:58:21 +0000104 /* We map \r\n ==> \r for pragmatic reasons.
Eric Andersen3752d332003-12-19 11:30:13 +0000105 * Many client implementations send \r\n when
106 * the user hits the CarriageReturn key.
107 */
Denis Vlasenko10916c52007-10-15 17:28:00 +0000108 if (c == '\r' && ptr < end && (*ptr == '\n' || *ptr == '\0'))
Eric Andersen3752d332003-12-19 11:30:13 +0000109 ptr++;
Denis Vlasenkob0150d22008-11-07 01:58:21 +0000110 continue;
Eric Andersen08a72202002-09-30 20:52:10 +0000111 }
Denis Vlasenkob0150d22008-11-07 01:58:21 +0000112
113 if ((ptr+1) >= end)
114 break;
115 if (ptr[1] == NOP) { /* Ignore? (putty keepalive, etc.) */
116 ptr += 2;
117 continue;
118 }
119 if (ptr[1] == IAC) { /* Literal IAC? (emacs M-DEL) */
120 *totty++ = ptr[1];
121 ptr += 2;
122 continue;
123 }
124
125 /*
126 * TELOPT_NAWS support!
127 */
128 if ((ptr+2) >= end) {
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200129 /* Only the beginning of the IAC is in the
Denis Vlasenkob0150d22008-11-07 01:58:21 +0000130 buffer we were asked to process, we can't
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200131 process this char */
Denis Vlasenkob0150d22008-11-07 01:58:21 +0000132 break;
133 }
134 /*
135 * IAC -> SB -> TELOPT_NAWS -> 4-byte -> IAC -> SE
136 */
137 if (ptr[1] == SB && ptr[2] == TELOPT_NAWS) {
138 struct winsize ws;
139 if ((ptr+8) >= end)
140 break; /* incomplete, can't process */
141 ws.ws_col = (ptr[3] << 8) | ptr[4];
142 ws.ws_row = (ptr[5] << 8) | ptr[6];
143 ioctl(ts->ptyfd, TIOCSWINSZ, (char *)&ws);
144 ptr += 9;
145 continue;
146 }
147 /* skip 3-byte IAC non-SB cmd */
148#if DEBUG
149 fprintf(stderr, "Ignoring IAC %s,%s\n",
150 TELCMD(ptr[1]), TELOPT(ptr[2]));
151#endif
152 ptr += 3;
Eric Andersen08a72202002-09-30 20:52:10 +0000153 }
154
Denis Vlasenko0de37e12007-10-17 11:08:53 +0000155 num_totty = totty - ptr0;
Eric Andersen08a72202002-09-30 20:52:10 +0000156 *pnum_totty = num_totty;
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200157 /* The difference between ptr and totty is number of iacs
158 we removed from the stream. Adjust buf1 accordingly */
Denis Vlasenko10916c52007-10-15 17:28:00 +0000159 if ((ptr - totty) == 0) /* 99.999% of cases */
160 return ptr0;
161 ts->wridx1 += ptr - totty;
162 ts->size1 -= ptr - totty;
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200163 /* Move chars meant for the terminal towards the end of the buffer */
Eric Andersen08a72202002-09-30 20:52:10 +0000164 return memmove(ptr - num_totty, ptr0, num_totty);
165}
166
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000167/*
Denis Vlasenko81c6a912008-11-12 21:14:50 +0000168 * Converting single IAC into double on output
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000169 */
170static size_t iac_safe_write(int fd, const char *buf, size_t count)
171{
Denis Vlasenko81c6a912008-11-12 21:14:50 +0000172 const char *IACptr;
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000173 size_t wr, rc, total;
174
175 total = 0;
176 while (1) {
177 if (count == 0)
178 return total;
Denis Vlasenko81c6a912008-11-12 21:14:50 +0000179 if (*buf == (char)IAC) {
180 static const char IACIAC[] ALIGN1 = { IAC, IAC };
181 rc = safe_write(fd, IACIAC, 2);
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000182 if (rc != 2)
183 break;
184 buf++;
185 total++;
186 count--;
187 continue;
188 }
Denis Vlasenko81c6a912008-11-12 21:14:50 +0000189 /* count != 0, *buf != IAC */
190 IACptr = memchr(buf, IAC, count);
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000191 wr = count;
Denis Vlasenko81c6a912008-11-12 21:14:50 +0000192 if (IACptr)
193 wr = IACptr - buf;
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000194 rc = safe_write(fd, buf, wr);
195 if (rc != wr)
196 break;
197 buf += rc;
198 total += rc;
199 count -= rc;
200 }
201 /* here: rc - result of last short write */
202 if ((ssize_t)rc < 0) { /* error? */
203 if (total == 0)
204 return rc;
205 rc = 0;
206 }
207 return total + rc;
208}
Eric Andersen08a72202002-09-30 20:52:10 +0000209
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200210/* Must match getopt32 string */
211enum {
212 OPT_WATCHCHILD = (1 << 2), /* -K */
213 OPT_INETD = (1 << 3) * ENABLE_FEATURE_TELNETD_STANDALONE, /* -i */
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200214 OPT_PORT = (1 << 4) * ENABLE_FEATURE_TELNETD_STANDALONE, /* -p PORT */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200215 OPT_FOREGROUND = (1 << 6) * ENABLE_FEATURE_TELNETD_STANDALONE, /* -F */
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200216 OPT_SYSLOG = (1 << 7) * ENABLE_FEATURE_TELNETD_INETD_WAIT, /* -S */
217 OPT_WAIT = (1 << 8) * ENABLE_FEATURE_TELNETD_INETD_WAIT, /* -w SEC */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200218};
219
Eric Andersen08a72202002-09-30 20:52:10 +0000220static struct tsession *
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000221make_new_session(
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200222 IF_FEATURE_TELNETD_STANDALONE(int sock)
Denis Vlasenko5e34ff22009-04-21 11:09:40 +0000223 IF_NOT_FEATURE_TELNETD_STANDALONE(void)
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000224) {
Denis Vlasenko88308fe2007-06-25 10:35:11 +0000225 const char *login_argv[2];
Eric Andersen08a72202002-09-30 20:52:10 +0000226 struct termios termbuf;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000227 int fd, pid;
Denis Vlasenko85c24712008-03-17 09:04:04 +0000228 char tty_name[GETPTY_BUFSIZE];
Rob Landley1ec5b292006-05-29 07:42:02 +0000229 struct tsession *ts = xzalloc(sizeof(struct tsession) + BUFSIZE * 2);
Eric Andersen08a72202002-09-30 20:52:10 +0000230
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000231 /*ts->buf1 = (char *)(ts + 1);*/
232 /*ts->buf2 = ts->buf1 + BUFSIZE;*/
Eric Andersen08a72202002-09-30 20:52:10 +0000233
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200234 /* Got a new connection, set up a tty */
Bernhard Reutner-Fischerae4342c2008-05-19 08:18:50 +0000235 fd = xgetpty(tty_name);
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200236 if (fd > G.maxfd)
237 G.maxfd = fd;
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000238 ts->ptyfd = fd;
239 ndelay_on(fd);
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200240 close_on_exec_on(fd);
241
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000242#if ENABLE_FEATURE_TELNETD_STANDALONE
Denis Vlasenko6d044352008-11-09 00:44:40 +0000243 /* SO_KEEPALIVE by popular demand */
244 setsockopt(sock, SOL_SOCKET, SO_KEEPALIVE, &const_int_1, sizeof(const_int_1));
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200245 ts->sockfd_read = sock;
Denis Vlasenkof472b232007-10-16 21:35:17 +0000246 ndelay_on(sock);
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200247 if (sock == 0) { /* We are called with fd 0 - we are in inetd mode */
Denis Vlasenko9e237672007-10-17 11:18:49 +0000248 sock++; /* so use fd 1 for output */
249 ndelay_on(sock);
250 }
Denis Vlasenkof472b232007-10-16 21:35:17 +0000251 ts->sockfd_write = sock;
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200252 if (sock > G.maxfd)
253 G.maxfd = sock;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000254#else
Denis Vlasenko6d044352008-11-09 00:44:40 +0000255 /* SO_KEEPALIVE by popular demand */
256 setsockopt(0, SOL_SOCKET, SO_KEEPALIVE, &const_int_1, sizeof(const_int_1));
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000257 /* ts->sockfd_read = 0; - done by xzalloc */
Denis Vlasenkof472b232007-10-16 21:35:17 +0000258 ts->sockfd_write = 1;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000259 ndelay_on(0);
260 ndelay_on(1);
261#endif
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200262
Eric Andersen08a72202002-09-30 20:52:10 +0000263 /* Make the telnet client understand we will echo characters so it
264 * should not do it locally. We don't tell the client to run linemode,
265 * because we want to handle line editing and tab completion and other
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000266 * stuff that requires char-by-char support. */
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000267 {
268 static const char iacs_to_send[] ALIGN1 = {
269 IAC, DO, TELOPT_ECHO,
270 IAC, DO, TELOPT_NAWS,
Denis Vlasenkod814c982009-02-02 23:43:57 +0000271 /* This requires telnetd.ctrlSQ.patch (incomplete) */
272 /* IAC, DO, TELOPT_LFLOW, */
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000273 IAC, WILL, TELOPT_ECHO,
274 IAC, WILL, TELOPT_SGA
275 };
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000276 /* This confuses iac_safe_write(), it will try to duplicate
277 * each IAC... */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200278 //memcpy(TS_BUF2(ts), iacs_to_send, sizeof(iacs_to_send));
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000279 //ts->rdidx2 = sizeof(iacs_to_send);
280 //ts->size2 = sizeof(iacs_to_send);
Denis Vlasenko81c6a912008-11-12 21:14:50 +0000281 /* So just stuff it into TCP stream! (no error check...) */
282#if ENABLE_FEATURE_TELNETD_STANDALONE
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000283 safe_write(sock, iacs_to_send, sizeof(iacs_to_send));
Denis Vlasenko81c6a912008-11-12 21:14:50 +0000284#else
285 safe_write(1, iacs_to_send, sizeof(iacs_to_send));
286#endif
287 /*ts->rdidx2 = 0; - xzalloc did it */
Denis Vlasenko9f2f8082008-11-11 02:56:39 +0000288 /*ts->size2 = 0;*/
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000289 }
Eric Andersen08a72202002-09-30 20:52:10 +0000290
Denys Vlasenko8131eea2009-11-02 14:19:51 +0100291 fflush_all();
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000292 pid = vfork(); /* NOMMU-friendly */
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000293 if (pid < 0) {
294 free(ts);
295 close(fd);
Denis Vlasenko23c81282007-10-16 22:01:23 +0000296 /* sock will be closed by caller */
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000297 bb_perror_msg("vfork");
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000298 return NULL;
Eric Andersen08a72202002-09-30 20:52:10 +0000299 }
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000300 if (pid > 0) {
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000301 /* Parent */
Denis Vlasenko2450c452007-10-15 22:09:15 +0000302 ts->shell_pid = pid;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000303 return ts;
Eric Andersen08a72202002-09-30 20:52:10 +0000304 }
Denis Vlasenkof7996f32007-01-11 17:20:00 +0000305
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000306 /* Child */
307 /* Careful - we are after vfork! */
Eric Andersen08a72202002-09-30 20:52:10 +0000308
Denis Vlasenkod814c982009-02-02 23:43:57 +0000309 /* Restore default signal handling ASAP */
Denis Vlasenko25591c32008-02-16 22:58:56 +0000310 bb_signals((1 << SIGCHLD) + (1 << SIGPIPE), SIG_DFL);
Denis Vlasenko018b1552007-11-06 01:38:46 +0000311
Denis Vlasenkod814c982009-02-02 23:43:57 +0000312 /* Make new session and process group */
313 setsid();
314
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200315 /* Open the child's side of the tty */
Denis Vlasenko9af7c9d2007-01-19 21:19:35 +0000316 /* NB: setsid() disconnects from any previous ctty's. Therefore
317 * we must open child's side of the tty AFTER setsid! */
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200318 close(0);
Denis Vlasenko1101d1c2008-07-21 09:22:28 +0000319 xopen(tty_name, O_RDWR); /* becomes our ctty */
320 xdup2(0, 1);
321 xdup2(0, 2);
Denis Vlasenko88308fe2007-06-25 10:35:11 +0000322 tcsetpgrp(0, getpid()); /* switch this tty's process group to us */
Eric Andersen08a72202002-09-30 20:52:10 +0000323
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200324 /* The pseudo-terminal allocated to the client is configured to operate
325 * in cooked mode, and with XTABS CRMOD enabled (see tty(4)) */
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000326 tcgetattr(0, &termbuf);
327 termbuf.c_lflag |= ECHO; /* if we use readline we dont want this */
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000328 termbuf.c_oflag |= ONLCR | XTABS;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000329 termbuf.c_iflag |= ICRNL;
330 termbuf.c_iflag &= ~IXOFF;
331 /*termbuf.c_lflag &= ~ICANON;*/
Denis Vlasenko202ac502008-11-05 13:20:58 +0000332 tcsetattr_stdin_TCSANOW(&termbuf);
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000333
Denys Vlasenko8131eea2009-11-02 14:19:51 +0100334 /* Uses FILE-based I/O to stdout, but does fflush_all(),
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000335 * so should be safe with vfork.
336 * I fear, though, that some users will have ridiculously big
Denis Vlasenko018b1552007-11-06 01:38:46 +0000337 * issue files, and they may block writing to fd 1,
338 * (parent is supposed to read it, but parent waits
339 * for vforked child to exec!) */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200340 print_login_issue(G.issuefile, tty_name);
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000341
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000342 /* Exec shell / login / whatever */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200343 login_argv[0] = G.loginpath;
Denis Vlasenko88308fe2007-06-25 10:35:11 +0000344 login_argv[1] = NULL;
Denis Vlasenko018b1552007-11-06 01:38:46 +0000345 /* exec busybox applet (if PREFER_APPLETS=y), if that fails,
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200346 * exec external program.
347 * NB: sock is either 0 or has CLOEXEC set on it.
348 * fd has CLOEXEC set on it too. These two fds will be closed here.
349 */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200350 BB_EXECVP(G.loginpath, (char **)login_argv);
Denis Vlasenko018b1552007-11-06 01:38:46 +0000351 /* _exit is safer with vfork, and we shouldn't send message
Denis Vlasenko2450c452007-10-15 22:09:15 +0000352 * to remote clients anyway */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200353 _exit(EXIT_FAILURE); /*bb_perror_msg_and_die("execv %s", G.loginpath);*/
Eric Andersen08a72202002-09-30 20:52:10 +0000354}
355
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000356#if ENABLE_FEATURE_TELNETD_STANDALONE
357
Eric Andersen08a72202002-09-30 20:52:10 +0000358static void
359free_session(struct tsession *ts)
360{
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200361 struct tsession *t = G.sessions;
Eric Andersen08a72202002-09-30 20:52:10 +0000362
Denis Vlasenkoe87b8682007-10-17 14:33:31 +0000363 if (option_mask32 & OPT_INETD)
Bernhard Reutner-Fischer636a1f82008-05-19 09:29:47 +0000364 exit(EXIT_SUCCESS);
Denis Vlasenkoe87b8682007-10-17 14:33:31 +0000365
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000366 /* Unlink this telnet session from the session list */
Mike Frysinger731f81c2006-05-10 15:23:12 +0000367 if (t == ts)
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200368 G.sessions = ts->next;
Eric Andersen08a72202002-09-30 20:52:10 +0000369 else {
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000370 while (t->next != ts)
Eric Andersen08a72202002-09-30 20:52:10 +0000371 t = t->next;
372 t->next = ts->next;
373 }
374
Denis Vlasenkof472b232007-10-16 21:35:17 +0000375#if 0
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000376 /* It was said that "normal" telnetd just closes ptyfd,
377 * doesn't send SIGKILL. When we close ptyfd,
378 * kernel sends SIGHUP to processes having slave side opened. */
Denis Vlasenkof472b232007-10-16 21:35:17 +0000379 kill(ts->shell_pid, SIGKILL);
Denis Vlasenkod814c982009-02-02 23:43:57 +0000380 waitpid(ts->shell_pid, NULL, 0);
Denis Vlasenkof472b232007-10-16 21:35:17 +0000381#endif
Eric Andersen08a72202002-09-30 20:52:10 +0000382 close(ts->ptyfd);
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000383 close(ts->sockfd_read);
Denis Vlasenkof472b232007-10-16 21:35:17 +0000384 /* We do not need to close(ts->sockfd_write), it's the same
385 * as sockfd_read unless we are in inetd mode. But in inetd mode
Denis Vlasenkoe87b8682007-10-17 14:33:31 +0000386 * we do not reach this */
Eric Andersen08a72202002-09-30 20:52:10 +0000387 free(ts);
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000388
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000389 /* Scan all sessions and find new maxfd */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200390 G.maxfd = 0;
391 ts = G.sessions;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000392 while (ts) {
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200393 if (G.maxfd < ts->ptyfd)
394 G.maxfd = ts->ptyfd;
395 if (G.maxfd < ts->sockfd_read)
396 G.maxfd = ts->sockfd_read;
Denis Vlasenkof472b232007-10-16 21:35:17 +0000397#if 0
398 /* Again, sockfd_write == sockfd_read here */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200399 if (G.maxfd < ts->sockfd_write)
400 G.maxfd = ts->sockfd_write;
Denis Vlasenkof472b232007-10-16 21:35:17 +0000401#endif
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000402 ts = ts->next;
403 }
Eric Andersen08a72202002-09-30 20:52:10 +0000404}
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000405
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000406#else /* !FEATURE_TELNETD_STANDALONE */
407
Bernhard Reutner-Fischer636a1f82008-05-19 09:29:47 +0000408/* Used in main() only, thus "return 0" actually is exit(EXIT_SUCCESS). */
Denis Vlasenkoe87b8682007-10-17 14:33:31 +0000409#define free_session(ts) return 0
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000410
411#endif
412
Denis Vlasenkoa60f84e2008-07-05 09:18:54 +0000413static void handle_sigchld(int sig UNUSED_PARAM)
Denis Vlasenko2450c452007-10-15 22:09:15 +0000414{
415 pid_t pid;
416 struct tsession *ts;
417
Denis Vlasenko018b1552007-11-06 01:38:46 +0000418 /* Looping: more than one child may have exited */
419 while (1) {
Denis Vlasenkofb0eba72008-01-02 19:55:04 +0000420 pid = wait_any_nohang(NULL);
Denis Vlasenko018b1552007-11-06 01:38:46 +0000421 if (pid <= 0)
422 break;
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200423 ts = G.sessions;
Denis Vlasenko2450c452007-10-15 22:09:15 +0000424 while (ts) {
425 if (ts->shell_pid == pid) {
426 ts->shell_pid = -1;
Denis Vlasenko018b1552007-11-06 01:38:46 +0000427 break;
Denis Vlasenko2450c452007-10-15 22:09:15 +0000428 }
429 ts = ts->next;
430 }
431 }
432}
433
Denis Vlasenko9b49a5e2007-10-11 10:05:36 +0000434int telnetd_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
Denis Vlasenkoa60f84e2008-07-05 09:18:54 +0000435int telnetd_main(int argc UNUSED_PARAM, char **argv)
Eric Andersen08a72202002-09-30 20:52:10 +0000436{
Eric Andersen08a72202002-09-30 20:52:10 +0000437 fd_set rdfdset, wrfdset;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000438 unsigned opt;
Denis Vlasenko10916c52007-10-15 17:28:00 +0000439 int count;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000440 struct tsession *ts;
441#if ENABLE_FEATURE_TELNETD_STANDALONE
442#define IS_INETD (opt & OPT_INETD)
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200443 int master_fd = master_fd; /* for compiler */
444 int sec_linger = sec_linger;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000445 char *opt_bindaddr = NULL;
446 char *opt_portnbr;
447#else
448 enum {
449 IS_INETD = 1,
450 master_fd = -1,
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000451 };
Glenn L McGrathc2b91862003-09-12 11:27:15 +0000452#endif
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200453 INIT_G();
454
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200455 /* -w NUM, and implies -F. -w and -i don't mix */
456 IF_FEATURE_TELNETD_INETD_WAIT(opt_complementary = "wF:w+:i--w:w--i";)
Denis Vlasenko2450c452007-10-15 22:09:15 +0000457 /* Even if !STANDALONE, we accept (and ignore) -i, thus people
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000458 * don't need to guess whether it's ok to pass -i to us */
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200459 opt = getopt32(argv, "f:l:Ki"
460 IF_FEATURE_TELNETD_STANDALONE("p:b:F")
461 IF_FEATURE_TELNETD_INETD_WAIT("Sw:"),
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200462 &G.issuefile, &G.loginpath
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200463 IF_FEATURE_TELNETD_STANDALONE(, &opt_portnbr, &opt_bindaddr)
464 IF_FEATURE_TELNETD_INETD_WAIT(, &sec_linger)
465 );
Denis Vlasenko2450c452007-10-15 22:09:15 +0000466 if (!IS_INETD /*&& !re_execed*/) {
467 /* inform that we start in standalone mode?
468 * May be useful when people forget to give -i */
469 /*bb_error_msg("listening for connections");*/
470 if (!(opt & OPT_FOREGROUND)) {
471 /* DAEMON_CHDIR_ROOT was giving inconsistent
Denis Vlasenko008eda22007-10-16 10:47:27 +0000472 * behavior with/without -F, -i */
Denis Vlasenko018b1552007-11-06 01:38:46 +0000473 bb_daemonize_or_rexec(0 /*was DAEMON_CHDIR_ROOT*/, argv);
Denis Vlasenko2450c452007-10-15 22:09:15 +0000474 }
475 }
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000476 /* Redirect log to syslog early, if needed */
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200477 if (IS_INETD || (opt & OPT_SYSLOG) || !(opt & OPT_FOREGROUND)) {
Denis Vlasenko5e4fda02009-03-08 23:46:48 +0000478 openlog(applet_name, LOG_PID, LOG_DAEMON);
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000479 logmode = LOGMODE_SYSLOG;
480 }
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000481#if ENABLE_FEATURE_TELNETD_STANDALONE
482 if (IS_INETD) {
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200483 G.sessions = make_new_session(0);
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200484 if (!G.sessions) /* pty opening or vfork problem, exit */
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200485 return 1; /* make_new_session printed error message */
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000486 } else {
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200487 master_fd = 0;
488 if (!(opt & OPT_WAIT)) {
489 unsigned portnbr = 23;
490 if (opt & OPT_PORT)
491 portnbr = xatou16(opt_portnbr);
492 master_fd = create_and_bind_stream_or_die(opt_bindaddr, portnbr);
493 xlisten(master_fd, 1);
494 }
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200495 close_on_exec_on(master_fd);
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000496 }
Rob Landley00e76cb2005-05-10 23:53:33 +0000497#else
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200498 G.sessions = make_new_session();
499 if (!G.sessions) /* pty opening or vfork problem, exit */
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200500 return 1; /* make_new_session printed error message */
Rob Landley00e76cb2005-05-10 23:53:33 +0000501#endif
Eric Andersen08a72202002-09-30 20:52:10 +0000502
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000503 /* We don't want to die if just one session is broken */
504 signal(SIGPIPE, SIG_IGN);
Eric Andersen08a72202002-09-30 20:52:10 +0000505
Denis Vlasenko2450c452007-10-15 22:09:15 +0000506 if (opt & OPT_WATCHCHILD)
507 signal(SIGCHLD, handle_sigchld);
Denis Vlasenko018b1552007-11-06 01:38:46 +0000508 else /* prevent dead children from becoming zombies */
509 signal(SIGCHLD, SIG_IGN);
Denis Vlasenko2450c452007-10-15 22:09:15 +0000510
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000511/*
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200512 This is how the buffers are used. The arrows indicate data flow.
513
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000514 +-------+ wridx1++ +------+ rdidx1++ +----------+
515 | | <-------------- | buf1 | <-------------- | |
516 | | size1-- +------+ size1++ | |
517 | pty | | socket |
518 | | rdidx2++ +------+ wridx2++ | |
519 | | --------------> | buf2 | --------------> | |
520 +-------+ size2++ +------+ size2-- +----------+
521
522 size1: "how many bytes are buffered for pty between rdidx1 and wridx1?"
523 size2: "how many bytes are buffered for socket between rdidx2 and wridx2?"
524
525 Each session has got two buffers. Buffers are circular. If sizeN == 0,
526 buffer is empty. If sizeN == BUFSIZE, buffer is full. In both these cases
527 rdidxN == wridxN.
528*/
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000529 again:
530 FD_ZERO(&rdfdset);
531 FD_ZERO(&wrfdset);
Eric Andersen08a72202002-09-30 20:52:10 +0000532
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000533 /* Select on the master socket, all telnet sockets and their
534 * ptys if there is room in their session buffers.
535 * NB: scalability problem: we recalculate entire bitmap
536 * before each select. Can be a problem with 500+ connections. */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200537 ts = G.sessions;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000538 while (ts) {
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200539 struct tsession *next = ts->next; /* in case we free ts */
Denis Vlasenko2450c452007-10-15 22:09:15 +0000540 if (ts->shell_pid == -1) {
Denis Vlasenko018b1552007-11-06 01:38:46 +0000541 /* Child died and we detected that */
Denis Vlasenko2450c452007-10-15 22:09:15 +0000542 free_session(ts);
543 } else {
544 if (ts->size1 > 0) /* can write to pty */
545 FD_SET(ts->ptyfd, &wrfdset);
546 if (ts->size1 < BUFSIZE) /* can read from socket */
547 FD_SET(ts->sockfd_read, &rdfdset);
548 if (ts->size2 > 0) /* can write to socket */
549 FD_SET(ts->sockfd_write, &wrfdset);
550 if (ts->size2 < BUFSIZE) /* can read from pty */
551 FD_SET(ts->ptyfd, &rdfdset);
552 }
553 ts = next;
554 }
555 if (!IS_INETD) {
556 FD_SET(master_fd, &rdfdset);
557 /* This is needed because free_session() does not
Denis Vlasenko018b1552007-11-06 01:38:46 +0000558 * take master_fd into account when it finds new
Denis Vlasenko2450c452007-10-15 22:09:15 +0000559 * maxfd among remaining fd's */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200560 if (master_fd > G.maxfd)
561 G.maxfd = master_fd;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000562 }
563
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200564 {
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200565 struct timeval *tv_ptr = NULL;
Denys Vlasenko36df0482009-10-19 16:07:28 +0200566#if ENABLE_FEATURE_TELNETD_INETD_WAIT
567 struct timeval tv;
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200568 if ((opt & OPT_WAIT) && !G.sessions) {
569 tv.tv_sec = sec_linger;
570 tv.tv_usec = 0;
571 tv_ptr = &tv;
572 }
Denys Vlasenko36df0482009-10-19 16:07:28 +0200573#endif
Denys Vlasenkoed1667e2009-09-04 02:21:13 +0200574 count = select(G.maxfd + 1, &rdfdset, &wrfdset, NULL, tv_ptr);
575 }
576 if (count == 0) /* "telnetd -w SEC" timed out */
577 return 0;
Denis Vlasenko10916c52007-10-15 17:28:00 +0000578 if (count < 0)
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000579 goto again; /* EINTR or ENOMEM */
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000580
581#if ENABLE_FEATURE_TELNETD_STANDALONE
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200582 /* Check for and accept new sessions */
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000583 if (!IS_INETD && FD_ISSET(master_fd, &rdfdset)) {
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000584 int fd;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000585 struct tsession *new_ts;
586
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000587 fd = accept(master_fd, NULL, NULL);
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000588 if (fd < 0)
589 goto again;
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200590 close_on_exec_on(fd);
591
592 /* Create a new session and link it into active list */
593 new_ts = make_new_session(fd);
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000594 if (new_ts) {
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200595 new_ts->next = G.sessions;
596 G.sessions = new_ts;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000597 } else {
598 close(fd);
Eric Andersen08a72202002-09-30 20:52:10 +0000599 }
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000600 }
601#endif
Eric Andersen08a72202002-09-30 20:52:10 +0000602
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200603 /* Then check for data tunneling */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200604 ts = G.sessions;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000605 while (ts) { /* For all sessions... */
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200606 struct tsession *next = ts->next; /* in case we free ts */
Eric Andersen08a72202002-09-30 20:52:10 +0000607
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000608 if (/*ts->size1 &&*/ FD_ISSET(ts->ptyfd, &wrfdset)) {
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000609 int num_totty;
Denis Vlasenko10916c52007-10-15 17:28:00 +0000610 unsigned char *ptr;
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200611 /* Write to pty from buffer 1 */
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000612 ptr = remove_iacs(ts, &num_totty);
Denis Vlasenko10916c52007-10-15 17:28:00 +0000613 count = safe_write(ts->ptyfd, ptr, num_totty);
614 if (count < 0) {
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000615 if (errno == EAGAIN)
616 goto skip1;
Denis Vlasenkof472b232007-10-16 21:35:17 +0000617 goto kill_session;
Eric Andersen08a72202002-09-30 20:52:10 +0000618 }
Denis Vlasenko10916c52007-10-15 17:28:00 +0000619 ts->size1 -= count;
620 ts->wridx1 += count;
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000621 if (ts->wridx1 >= BUFSIZE) /* actually == BUFSIZE */
Eric Andersen08a72202002-09-30 20:52:10 +0000622 ts->wridx1 = 0;
Eric Andersen08a72202002-09-30 20:52:10 +0000623 }
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000624 skip1:
625 if (/*ts->size2 &&*/ FD_ISSET(ts->sockfd_write, &wrfdset)) {
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200626 /* Write to socket from buffer 2 */
Denis Vlasenko10916c52007-10-15 17:28:00 +0000627 count = MIN(BUFSIZE - ts->wridx2, ts->size2);
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200628 count = iac_safe_write(ts->sockfd_write, (void*)(TS_BUF2(ts) + ts->wridx2), count);
Denis Vlasenko10916c52007-10-15 17:28:00 +0000629 if (count < 0) {
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000630 if (errno == EAGAIN)
631 goto skip2;
Denis Vlasenkof472b232007-10-16 21:35:17 +0000632 goto kill_session;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000633 }
Denis Vlasenko10916c52007-10-15 17:28:00 +0000634 ts->size2 -= count;
635 ts->wridx2 += count;
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000636 if (ts->wridx2 >= BUFSIZE) /* actually == BUFSIZE */
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000637 ts->wridx2 = 0;
638 }
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000639 skip2:
Denis Vlasenko10916c52007-10-15 17:28:00 +0000640 /* Should not be needed, but... remove_iacs is actually buggy
641 * (it cannot process iacs which wrap around buffer's end)!
642 * Since properly fixing it requires writing bigger code,
Denis Vlasenkof472b232007-10-16 21:35:17 +0000643 * we rely instead on this code making it virtually impossible
Denis Vlasenko10916c52007-10-15 17:28:00 +0000644 * to have wrapped iac (people don't type at 2k/second).
645 * It also allows for bigger reads in common case. */
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000646 if (ts->size1 == 0) {
647 ts->rdidx1 = 0;
648 ts->wridx1 = 0;
649 }
650 if (ts->size2 == 0) {
651 ts->rdidx2 = 0;
652 ts->wridx2 = 0;
653 }
Denis Vlasenko10916c52007-10-15 17:28:00 +0000654
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000655 if (/*ts->size1 < BUFSIZE &&*/ FD_ISSET(ts->sockfd_read, &rdfdset)) {
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200656 /* Read from socket to buffer 1 */
Denis Vlasenko10916c52007-10-15 17:28:00 +0000657 count = MIN(BUFSIZE - ts->rdidx1, BUFSIZE - ts->size1);
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200658 count = safe_read(ts->sockfd_read, TS_BUF1(ts) + ts->rdidx1, count);
Denis Vlasenko10916c52007-10-15 17:28:00 +0000659 if (count <= 0) {
660 if (count < 0 && errno == EAGAIN)
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000661 goto skip3;
Denis Vlasenkof472b232007-10-16 21:35:17 +0000662 goto kill_session;
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000663 }
664 /* Ignore trailing NUL if it is there */
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200665 if (!TS_BUF1(ts)[ts->rdidx1 + count - 1]) {
Denis Vlasenkof472b232007-10-16 21:35:17 +0000666 --count;
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000667 }
Denis Vlasenko10916c52007-10-15 17:28:00 +0000668 ts->size1 += count;
669 ts->rdidx1 += count;
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000670 if (ts->rdidx1 >= BUFSIZE) /* actually == BUFSIZE */
671 ts->rdidx1 = 0;
672 }
673 skip3:
674 if (/*ts->size2 < BUFSIZE &&*/ FD_ISSET(ts->ptyfd, &rdfdset)) {
Denys Vlasenko1d77db82009-06-10 13:38:08 +0200675 /* Read from pty to buffer 2 */
Denis Vlasenko10916c52007-10-15 17:28:00 +0000676 count = MIN(BUFSIZE - ts->rdidx2, BUFSIZE - ts->size2);
Denys Vlasenkoa4bcbd02009-06-09 23:01:24 +0200677 count = safe_read(ts->ptyfd, TS_BUF2(ts) + ts->rdidx2, count);
Denis Vlasenko10916c52007-10-15 17:28:00 +0000678 if (count <= 0) {
679 if (count < 0 && errno == EAGAIN)
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000680 goto skip4;
Denis Vlasenkof472b232007-10-16 21:35:17 +0000681 goto kill_session;
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000682 }
Denis Vlasenko10916c52007-10-15 17:28:00 +0000683 ts->size2 += count;
684 ts->rdidx2 += count;
Denis Vlasenko59d7c432007-10-15 15:19:36 +0000685 if (ts->rdidx2 >= BUFSIZE) /* actually == BUFSIZE */
686 ts->rdidx2 = 0;
687 }
688 skip4:
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000689 ts = next;
Denis Vlasenkof472b232007-10-16 21:35:17 +0000690 continue;
691 kill_session:
692 free_session(ts);
693 ts = next;
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000694 }
Denis Vlasenkof472b232007-10-16 21:35:17 +0000695
Denis Vlasenko75f8d082006-11-22 15:54:52 +0000696 goto again;
Eric Andersen08a72202002-09-30 20:52:10 +0000697}