360 lines
7.3 KiB
C
360 lines
7.3 KiB
C
/*
|
|
|
|
ttymodes.c
|
|
|
|
Author: Tatu Ylonen <ylo@cs.hut.fi>
|
|
|
|
Copyright (c) 1995 Tatu Ylonen <ylo@cs.hut.fi>, Espoo, Finland
|
|
All rights reserved
|
|
|
|
Created: Tue Mar 21 15:59:15 1995 ylo
|
|
|
|
Encoding and decoding of terminal modes in a portable way.
|
|
Much of the format is defined in ttymodes.h; it is included multiple times
|
|
into this file with the appropriate macro definitions to generate the
|
|
suitable code.
|
|
|
|
*/
|
|
|
|
#include "includes.h"
|
|
RCSID("$Id: ttymodes.c,v 1.1 1999/10/27 03:42:46 damien Exp $");
|
|
|
|
#include "packet.h"
|
|
#include "ssh.h"
|
|
|
|
#define TTY_OP_END 0
|
|
#define TTY_OP_ISPEED 192 /* int follows */
|
|
#define TTY_OP_OSPEED 193 /* int follows */
|
|
|
|
/* Converts POSIX speed_t to a baud rate. The values of the constants
|
|
for speed_t are not themselves portable. */
|
|
|
|
static int speed_to_baud(speed_t speed)
|
|
{
|
|
switch (speed)
|
|
{
|
|
case B0:
|
|
return 0;
|
|
case B50:
|
|
return 50;
|
|
case B75:
|
|
return 75;
|
|
case B110:
|
|
return 110;
|
|
case B134:
|
|
return 134;
|
|
case B150:
|
|
return 150;
|
|
case B200:
|
|
return 200;
|
|
case B300:
|
|
return 300;
|
|
case B600:
|
|
return 600;
|
|
case B1200:
|
|
return 1200;
|
|
case B1800:
|
|
return 1800;
|
|
case B2400:
|
|
return 2400;
|
|
case B4800:
|
|
return 4800;
|
|
case B9600:
|
|
return 9600;
|
|
|
|
#ifdef B19200
|
|
case B19200:
|
|
return 19200;
|
|
#else /* B19200 */
|
|
#ifdef EXTA
|
|
case EXTA:
|
|
return 19200;
|
|
#endif /* EXTA */
|
|
#endif /* B19200 */
|
|
|
|
#ifdef B38400
|
|
case B38400:
|
|
return 38400;
|
|
#else /* B38400 */
|
|
#ifdef EXTB
|
|
case EXTB:
|
|
return 38400;
|
|
#endif /* EXTB */
|
|
#endif /* B38400 */
|
|
|
|
#ifdef B7200
|
|
case B7200:
|
|
return 7200;
|
|
#endif /* B7200 */
|
|
#ifdef B14400
|
|
case B14400:
|
|
return 14400;
|
|
#endif /* B14400 */
|
|
#ifdef B28800
|
|
case B28800:
|
|
return 28800;
|
|
#endif /* B28800 */
|
|
#ifdef B57600
|
|
case B57600:
|
|
return 57600;
|
|
#endif /* B57600 */
|
|
#ifdef B76800
|
|
case B76800:
|
|
return 76800;
|
|
#endif /* B76800 */
|
|
#ifdef B115200
|
|
case B115200:
|
|
return 115200;
|
|
#endif /* B115200 */
|
|
#ifdef B230400
|
|
case B230400:
|
|
return 230400;
|
|
#endif /* B230400 */
|
|
default:
|
|
return 9600;
|
|
}
|
|
}
|
|
|
|
/* Converts a numeric baud rate to a POSIX speed_t. */
|
|
|
|
static speed_t baud_to_speed(int baud)
|
|
{
|
|
switch (baud)
|
|
{
|
|
case 0:
|
|
return B0;
|
|
case 50:
|
|
return B50;
|
|
case 75:
|
|
return B75;
|
|
case 110:
|
|
return B110;
|
|
case 134:
|
|
return B134;
|
|
case 150:
|
|
return B150;
|
|
case 200:
|
|
return B200;
|
|
case 300:
|
|
return B300;
|
|
case 600:
|
|
return B600;
|
|
case 1200:
|
|
return B1200;
|
|
case 1800:
|
|
return B1800;
|
|
case 2400:
|
|
return B2400;
|
|
case 4800:
|
|
return B4800;
|
|
case 9600:
|
|
return B9600;
|
|
|
|
#ifdef B19200
|
|
case 19200:
|
|
return B19200;
|
|
#else /* B19200 */
|
|
#ifdef EXTA
|
|
case 19200:
|
|
return EXTA;
|
|
#endif /* EXTA */
|
|
#endif /* B19200 */
|
|
|
|
#ifdef B38400
|
|
case 38400:
|
|
return B38400;
|
|
#else /* B38400 */
|
|
#ifdef EXTB
|
|
case 38400:
|
|
return EXTB;
|
|
#endif /* EXTB */
|
|
#endif /* B38400 */
|
|
|
|
#ifdef B7200
|
|
case 7200:
|
|
return B7200;
|
|
#endif /* B7200 */
|
|
#ifdef B14400
|
|
case 14400:
|
|
return B14400;
|
|
#endif /* B14400 */
|
|
#ifdef B28800
|
|
case 28800:
|
|
return B28800;
|
|
#endif /* B28800 */
|
|
#ifdef B57600
|
|
case 57600:
|
|
return B57600;
|
|
#endif /* B57600 */
|
|
#ifdef B76800
|
|
case 76800:
|
|
return B76800;
|
|
#endif /* B76800 */
|
|
#ifdef B115200
|
|
case 115200:
|
|
return B115200;
|
|
#endif /* B115200 */
|
|
#ifdef B230400
|
|
case 230400:
|
|
return B230400;
|
|
#endif /* B230400 */
|
|
default:
|
|
return B9600;
|
|
}
|
|
}
|
|
|
|
/* Encodes terminal modes for the terminal referenced by fd in a portable
|
|
manner, and appends the modes to a packet being constructed. */
|
|
|
|
void tty_make_modes(int fd)
|
|
{
|
|
struct termios tio;
|
|
int baud;
|
|
|
|
/* Get the modes. */
|
|
if (tcgetattr(fd, &tio) < 0)
|
|
{
|
|
packet_put_char(TTY_OP_END);
|
|
log("tcgetattr: %.100s", strerror(errno));
|
|
return;
|
|
}
|
|
|
|
/* Store input and output baud rates. */
|
|
baud = speed_to_baud(cfgetospeed(&tio));
|
|
packet_put_char(TTY_OP_OSPEED);
|
|
packet_put_int(baud);
|
|
baud = speed_to_baud(cfgetispeed(&tio));
|
|
packet_put_char(TTY_OP_ISPEED);
|
|
packet_put_int(baud);
|
|
|
|
/* Store values of mode flags. */
|
|
#define TTYCHAR(NAME, OP) \
|
|
packet_put_char(OP); packet_put_char(tio.c_cc[NAME]);
|
|
#define TTYMODE(NAME, FIELD, OP) \
|
|
packet_put_char(OP); packet_put_char((tio.FIELD & NAME) != 0);
|
|
#define SGTTYCHAR(NAME, OP)
|
|
#define SGTTYMODE(NAME, FIELD, OP)
|
|
#define SGTTYMODEN(NAME, FIELD, OP)
|
|
|
|
#include "ttymodes.h"
|
|
|
|
#undef TTYCHAR
|
|
#undef TTYMODE
|
|
#undef SGTTYCHAR
|
|
#undef SGTTYMODE
|
|
#undef SGTTYMODEN
|
|
|
|
/* Mark end of mode data. */
|
|
packet_put_char(TTY_OP_END);
|
|
}
|
|
|
|
/* Decodes terminal modes for the terminal referenced by fd in a portable
|
|
manner from a packet being read. */
|
|
|
|
void tty_parse_modes(int fd, int *n_bytes_ptr)
|
|
{
|
|
struct termios tio;
|
|
int opcode, baud;
|
|
int n_bytes = 0;
|
|
int failure = 0;
|
|
|
|
/* Get old attributes for the terminal. We will modify these flags.
|
|
I am hoping that if there are any machine-specific modes, they will
|
|
initially have reasonable values. */
|
|
if (tcgetattr(fd, &tio) < 0)
|
|
failure = -1;
|
|
|
|
for (;;)
|
|
{
|
|
n_bytes += 1;
|
|
opcode = packet_get_char();
|
|
switch (opcode)
|
|
{
|
|
case TTY_OP_END:
|
|
goto set;
|
|
|
|
case TTY_OP_ISPEED:
|
|
n_bytes += 4;
|
|
baud = packet_get_int();
|
|
if (failure != -1 && cfsetispeed(&tio, baud_to_speed(baud)) < 0)
|
|
error("cfsetispeed failed for %d", baud);
|
|
break;
|
|
|
|
case TTY_OP_OSPEED:
|
|
n_bytes += 4;
|
|
baud = packet_get_int();
|
|
if (failure != -1 && cfsetospeed(&tio, baud_to_speed(baud)) < 0)
|
|
error("cfsetospeed failed for %d", baud);
|
|
break;
|
|
|
|
#define TTYCHAR(NAME, OP) \
|
|
case OP: \
|
|
n_bytes += 1; \
|
|
tio.c_cc[NAME] = packet_get_char(); \
|
|
break;
|
|
#define TTYMODE(NAME, FIELD, OP) \
|
|
case OP: \
|
|
n_bytes += 1; \
|
|
if (packet_get_char()) \
|
|
tio.FIELD |= NAME; \
|
|
else \
|
|
tio.FIELD &= ~NAME; \
|
|
break;
|
|
#define SGTTYCHAR(NAME, OP)
|
|
#define SGTTYMODE(NAME, FIELD, OP)
|
|
#define SGTTYMODEN(NAME, FIELD, OP)
|
|
|
|
#include "ttymodes.h"
|
|
|
|
#undef TTYCHAR
|
|
#undef TTYMODE
|
|
#undef SGTTYCHAR
|
|
#undef SGTTYMODE
|
|
#undef SGTTYMODEN
|
|
|
|
default:
|
|
debug("Ignoring unsupported tty mode opcode %d (0x%x)",
|
|
opcode, opcode);
|
|
/* Opcodes 0 to 127 are defined to have a one-byte argument. */
|
|
if (opcode >= 0 && opcode < 128)
|
|
{
|
|
n_bytes += 1;
|
|
(void)packet_get_char();
|
|
break;
|
|
}
|
|
else
|
|
{
|
|
/* Opcodes 128 to 159 are defined to have an integer argument. */
|
|
if (opcode >= 128 && opcode < 160)
|
|
{
|
|
n_bytes += 4;
|
|
(void)packet_get_int();
|
|
break;
|
|
}
|
|
}
|
|
/* It is a truly undefined opcode (160 to 255). We have no idea
|
|
about its arguments. So we must stop parsing. Note that some
|
|
data may be left in the packet; hopefully there is nothing more
|
|
coming after the mode data. */
|
|
log("parse_tty_modes: unknown opcode %d", opcode);
|
|
packet_integrity_check(0, 1, SSH_CMSG_REQUEST_PTY);
|
|
goto set;
|
|
}
|
|
}
|
|
|
|
set:
|
|
if (*n_bytes_ptr != n_bytes)
|
|
{
|
|
*n_bytes_ptr = n_bytes;
|
|
return; /* Don't process bytes passed */
|
|
}
|
|
|
|
if (failure == -1)
|
|
return; /* Packet parsed ok but tty stuff failed */
|
|
|
|
/* Set the new modes for the terminal. */
|
|
if (tcsetattr(fd, TCSANOW, &tio) < 0)
|
|
log("Setting tty modes failed: %.100s", strerror(errno));
|
|
return;
|
|
}
|