Skip to content
Snippets Groups Projects
telnet_io.c 7.22 KiB
/* Copyright (C), 2007 by Stephen Hurd */

/* $Id: telnet_io.c,v 1.41 2020/05/02 03:09:15 rswindell Exp $ */

#include <stdlib.h>
#include <string.h>

#include "genwrap.h"
#include "sockwrap.h"
#ifndef TELNET_NO_DLL
 #define TELNET_NO_DLL
#endif
#include "bbslist.h"
#include "conn.h"
#include "conn_telnet.h"
#include "gen_defs.h"
#include "telnet.h"
#include "term.h"
#include "uifcinit.h"

#ifdef _MSC_VER
#pragma warning(disable : 4244 4267 4018)
#endif

#define TELNET_TERM_MAXLEN 40

uint         telnet_cmdlen = 0;
uchar        telnet_cmd[64];
char         terminal[TELNET_TERM_MAXLEN + 1];
uchar        telnet_local_option[0x100];
uchar        telnet_remote_option[0x100];

extern char *log_levels[];
extern FILE *log_fp;
int          telnet_log_level;

static int
lprintf(int level, const char *fmt, ...)
{
	char    sbuf[1024];
	va_list argptr;

	if ((log_fp == NULL) || (level > telnet_log_level))
		return 0;

	va_start(argptr, fmt);
	vsnprintf(sbuf, sizeof(sbuf), fmt, argptr);
	sbuf[sizeof(sbuf) - 1] = 0;
	va_end(argptr);
	return fprintf(log_fp, "Telnet %s %s\n", log_levels[level], sbuf);
}

void
putcom(char *buf, size_t len)
{
	conn_send_raw(buf, len, 10000);
	return;
}

static void
send_telnet_cmd(uchar cmd, uchar opt)
{
	char buf[16];

	if (cmd < TELNET_WILL) {
		lprintf(LOG_INFO, "TX: %s",
		    telnet_cmd_desc(cmd));
		sprintf(buf, "%c%c", TELNET_IAC, cmd);
		putcom(buf, 2);
	}
	else {
		lprintf(LOG_INFO, "TX: %s %s",
		    telnet_cmd_desc(cmd), telnet_opt_desc(opt));
		sprintf(buf, "%c%c%c", TELNET_IAC, cmd, opt);
		putcom(buf, 3);
	}
}

void
request_telnet_opt(uchar cmd, uchar opt)
{
	if ((cmd == TELNET_DO) || (cmd == TELNET_DONT)) { /* remote option */
		if (telnet_remote_option[opt] == telnet_opt_ack(cmd))
			return;                           /* already set in this mode, do nothing */
		telnet_remote_option[opt] = telnet_opt_ack(cmd);
	}
	else {                                            /* local option */
		if (telnet_local_option[opt] == telnet_opt_ack(cmd))
			return;                           /* already set in this mode, do nothing */
		telnet_local_option[opt] = telnet_opt_ack(cmd);
	}
	send_telnet_cmd(cmd, opt);
}

// Have conn_api.binary_mode auto-track (to true) when both sides are in binary TX mode
static inline void
update_binary_mode()
{
	conn_api.binary_mode = (telnet_remote_option[TELNET_BINARY_TX] == TELNET_WILL)
		&& (telnet_local_option[TELNET_BINARY_TX] == TELNET_DO);
}

BYTE *
telnet_interpret(BYTE *inbuf, size_t inlen, BYTE *outbuf, size_t *outlen)
{
	BYTE  command;
	BYTE  option;
	BYTE *first_cr = NULL;
	BYTE *first_int = NULL;
	int   i;

	if (inlen < 1) {
		*outlen = 0;
		return inbuf; /* no length? No interpretation */
	}

	first_int = (BYTE *)memchr(inbuf, TELNET_IAC, inlen);
	if (telnet_remote_option[TELNET_BINARY_TX] != TELNET_WILL) {
		first_cr = (BYTE *)memchr(inbuf, '\r', inlen);
		if (first_cr) {
			if ((first_int == NULL) || (first_cr < first_int))
				first_int = first_cr;
		}
	}

	if ((telnet_cmdlen == 0) && (first_int == NULL)) {
		*outlen = inlen;
		return inbuf; /* no interpretation needed */
	}

	if (telnet_cmdlen == 0 /* If we haven't returned and telnet_cmdlen==0 then first_int is not NULL */) {
		*outlen = first_int - inbuf;
		memcpy(outbuf, inbuf, *outlen);
	}
	else {
		*outlen = 0;
	}

	for (i = *outlen; i < inlen; i++) {
		if (telnet_remote_option[TELNET_BINARY_TX] != TELNET_WILL) {
			if ((telnet_cmdlen == 1) && (telnet_cmd[0] == '\r')) {
				outbuf[(*outlen)++] = '\r';
				if ((inbuf[i] != 0) && (inbuf[i] != TELNET_IAC))
					outbuf[(*outlen)++] = inbuf[i];
				telnet_cmdlen = 0;
				if (inbuf[i] != TELNET_IAC)
					continue;
			}
			if ((inbuf[i] == '\r') && (telnet_cmdlen == 0)) {
				telnet_cmd[telnet_cmdlen++] = '\r';
				continue;
			}
		}

		if ((inbuf[i] == TELNET_IAC) && (telnet_cmdlen == 1)) { /* escaped 255 */
			telnet_cmdlen = 0;
			outbuf[(*outlen)++] = TELNET_IAC;
			continue;
		}
		if ((inbuf[i] == TELNET_IAC) || telnet_cmdlen) {
			if (telnet_cmdlen < sizeof(telnet_cmd))
				telnet_cmd[telnet_cmdlen++] = inbuf[i];

			command = telnet_cmd[1];
			option = telnet_cmd[2];

			if ((telnet_cmdlen >= 2) && (command == TELNET_SB)) {
				if ((inbuf[i] == TELNET_SE)
				    && (telnet_cmd[telnet_cmdlen - 2] == TELNET_IAC)) {
                                        /* sub-option terminated */
					if ((option == TELNET_TERM_TYPE) && (telnet_cmd[3] == TELNET_TERM_SEND)) {
						char        buf[32];
						const char *emu = get_emulation_str(conn_api.emulation);
						int         len = sprintf(buf, "%c%c%c%c%s%c%c",
						        TELNET_IAC, TELNET_SB,
						        TELNET_TERM_TYPE, TELNET_TERM_IS,
						        emu,
						        TELNET_IAC, TELNET_SE);

						lprintf(LOG_INFO, "TX: Terminal Type is %s", emu);
						putcom(buf, len);
						request_telnet_opt(TELNET_WILL, TELNET_NEGOTIATE_WINDOW_SIZE);
					}
					telnet_cmdlen = 0;
				}
			}
			else if ((telnet_cmdlen == 2) && (inbuf[i] < TELNET_WILL)) {
				telnet_cmdlen = 0;
			}
			else if (telnet_cmdlen >= 3) { /* telnet option negotiation */
				lprintf(LOG_INFO, "RX: %s %s",
				    telnet_cmd_desc(command), telnet_opt_desc(option));

				if ((command == TELNET_DO) || (command == TELNET_DONT)) { /* local options */
					if (telnet_local_option[option] != command) {
						switch (option) {
							case TELNET_BINARY_TX:
							case TELNET_TERM_TYPE:
							case TELNET_SUP_GA:
							case TELNET_NEGOTIATE_WINDOW_SIZE:
								telnet_local_option[option] = command;
								send_telnet_cmd(telnet_opt_ack(command), option);
								if(option == TELNET_BINARY_TX)
									update_binary_mode();
								break;
							default:                          /* unsupported local options
                                                                                           */
								if (command == TELNET_DO) /* NAK */
									send_telnet_cmd(telnet_opt_nak(command),
									    option);
								break;
						}
					}

					if ((command == TELNET_DO) && (option == TELNET_NEGOTIATE_WINDOW_SIZE)) {
						int  rows, cols;
						BYTE buf[32];

						get_cterm_size(&cols, &rows, conn_api.nostatus);
						buf[0] = TELNET_IAC;
						buf[1] = TELNET_SB;
						buf[2] = TELNET_NEGOTIATE_WINDOW_SIZE;
						buf[3] = (cols >> 8) & 0xff;
						buf[4] = cols & 0xff;
						buf[5] = (rows >> 8) & 0xff;
						buf[6] = rows & 0xff;
						buf[7] = TELNET_IAC;
						buf[8] = TELNET_SE;
						lprintf(LOG_INFO, "TX: Window Size is %u x %u",
						    cols, rows);
						putcom((char *)buf, 9);
					}
				}
				else { /* WILL/WONT (remote options) */
					if (telnet_remote_option[option] != command) {
						switch (option) {
							case TELNET_BINARY_TX:
							case TELNET_ECHO:
							case TELNET_TERM_TYPE:
							case TELNET_SUP_GA:
							case TELNET_NEGOTIATE_WINDOW_SIZE:
								telnet_remote_option[option] = command;
								send_telnet_cmd(telnet_opt_ack(command), option);
								if(option == TELNET_BINARY_TX)
									update_binary_mode();
								break;
							default:                            /* unsupported remote
                                                                                             * options */
								if (command == TELNET_WILL) /* NAK */
									send_telnet_cmd(telnet_opt_nak(command),
									    option);
								break;
						}
					}
				}

				telnet_cmdlen = 0;
			}
		}
		else {
			outbuf[(*outlen)++] = inbuf[i];
		}
	}
	return outbuf;
}