mirror of
https://github.com/tio/tio.git
synced 2026-05-01 14:57:59 +02:00
Introduced tty_configure()
Moved tty configuration actions to tty_configure() in tty.c. This way options.c is strictly about parsing options nothing else.
This commit is contained in:
Martin Lund
parent
1f45b8d91d
commit
e920cc9b32
5 changed files with 205 additions and 197 deletions
|
|
@ -31,16 +31,15 @@
|
||||||
struct option_t
|
struct option_t
|
||||||
{
|
{
|
||||||
const char *tty_device;
|
const char *tty_device;
|
||||||
bool log;
|
unsigned int baudrate;
|
||||||
const char *log_filename;
|
|
||||||
bool no_autoconnect;
|
|
||||||
int output_delay;
|
|
||||||
struct termios tio;
|
|
||||||
int baudrate;
|
|
||||||
int databits;
|
int databits;
|
||||||
char *flow;
|
char *flow;
|
||||||
int stopbits;
|
int stopbits;
|
||||||
char *parity;
|
char *parity;
|
||||||
|
int output_delay;
|
||||||
|
bool no_autoconnect;
|
||||||
|
bool log;
|
||||||
|
const char *log_filename;
|
||||||
};
|
};
|
||||||
|
|
||||||
extern struct option_t option;
|
extern struct option_t option;
|
||||||
|
|
|
||||||
|
|
@ -31,6 +31,7 @@
|
||||||
|
|
||||||
void stdout_configure(void);
|
void stdout_configure(void);
|
||||||
void stdout_restore(void);
|
void stdout_restore(void);
|
||||||
|
void tty_configure(void);
|
||||||
int tty_connect(void);
|
int tty_connect(void);
|
||||||
void tty_wait_for_device(void);
|
void tty_wait_for_device(void);
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -39,6 +39,9 @@ int main(int argc, char *argv[])
|
||||||
/* Parse options */
|
/* Parse options */
|
||||||
parse_options(argc, argv);
|
parse_options(argc, argv);
|
||||||
|
|
||||||
|
/* Configure tty device */
|
||||||
|
tty_configure();
|
||||||
|
|
||||||
/* Configure output terminal */
|
/* Configure output terminal */
|
||||||
stdout_configure();
|
stdout_configure();
|
||||||
|
|
||||||
|
|
|
||||||
190
src/options.c
190
src/options.c
|
|
@ -32,19 +32,19 @@
|
||||||
#include "tio/options.h"
|
#include "tio/options.h"
|
||||||
#include "tio/error.h"
|
#include "tio/error.h"
|
||||||
|
|
||||||
|
/* Default options */
|
||||||
struct option_t option =
|
struct option_t option =
|
||||||
{
|
{
|
||||||
"", // Device name
|
"", // Device name
|
||||||
false, // No log
|
|
||||||
"", // Log filename
|
|
||||||
false, // No autoconnect
|
|
||||||
0, // No output delay
|
|
||||||
{},
|
|
||||||
115200, // Baudrate
|
115200, // Baudrate
|
||||||
8, // Databits
|
8, // Databits
|
||||||
"none", // Flow
|
"none", // Flow
|
||||||
1, // Stopbits
|
1, // Stopbits
|
||||||
"none" // Parity
|
"none", // Parity
|
||||||
|
0, // No output delay
|
||||||
|
false, // No autoconnect
|
||||||
|
false, // No log
|
||||||
|
"" // Log filename
|
||||||
};
|
};
|
||||||
|
|
||||||
void print_help(char *argv[])
|
void print_help(char *argv[])
|
||||||
|
|
@ -70,7 +70,6 @@ void print_help(char *argv[])
|
||||||
void parse_options(int argc, char *argv[])
|
void parse_options(int argc, char *argv[])
|
||||||
{
|
{
|
||||||
int c;
|
int c;
|
||||||
int baudrate;
|
|
||||||
|
|
||||||
if (argc == 1)
|
if (argc == 1)
|
||||||
{
|
{
|
||||||
|
|
@ -78,14 +77,6 @@ void parse_options(int argc, char *argv[])
|
||||||
exit(EXIT_SUCCESS);
|
exit(EXIT_SUCCESS);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Set default termios settings:
|
|
||||||
* (115200 baud, 8 data bits, no flow control, 1 stop bit, no parity) */
|
|
||||||
bzero(&option.tio, sizeof(option.tio));
|
|
||||||
option.tio.c_cflag = B115200 | CS8;
|
|
||||||
|
|
||||||
/* Set default output delay */
|
|
||||||
option.output_delay = 0;
|
|
||||||
|
|
||||||
while (1)
|
while (1)
|
||||||
{
|
{
|
||||||
static struct option long_options[] =
|
static struct option long_options[] =
|
||||||
|
|
@ -126,190 +117,23 @@ void parse_options(int argc, char *argv[])
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 'b':
|
case 'b':
|
||||||
option.baudrate = baudrate = atoi(optarg);
|
option.baudrate = atoi(optarg);
|
||||||
switch (baudrate)
|
|
||||||
{
|
|
||||||
case 0:
|
|
||||||
baudrate = B0;
|
|
||||||
break;
|
|
||||||
case 50:
|
|
||||||
baudrate = B50;
|
|
||||||
break;
|
|
||||||
case 75:
|
|
||||||
baudrate = B75;
|
|
||||||
break;
|
|
||||||
case 110:
|
|
||||||
baudrate = B110;
|
|
||||||
break;
|
|
||||||
case 134:
|
|
||||||
baudrate = B134;
|
|
||||||
break;
|
|
||||||
case 150:
|
|
||||||
baudrate = B150;
|
|
||||||
break;
|
|
||||||
case 300:
|
|
||||||
baudrate = B300;
|
|
||||||
break;
|
|
||||||
case 600:
|
|
||||||
baudrate = B600;
|
|
||||||
break;
|
|
||||||
case 1200:
|
|
||||||
baudrate = B1200;
|
|
||||||
break;
|
|
||||||
case 2400:
|
|
||||||
baudrate = B2400;
|
|
||||||
break;
|
|
||||||
case 4800:
|
|
||||||
baudrate = B4800;
|
|
||||||
break;
|
|
||||||
case 9600:
|
|
||||||
baudrate = B9600;
|
|
||||||
break;
|
|
||||||
case 19200:
|
|
||||||
baudrate = B19200;
|
|
||||||
break;
|
|
||||||
case 38400:
|
|
||||||
baudrate = B38400;
|
|
||||||
break;
|
|
||||||
case 57600:
|
|
||||||
baudrate = B57600;
|
|
||||||
break;
|
|
||||||
case 115200:
|
|
||||||
baudrate = B115200;
|
|
||||||
break;
|
|
||||||
case 230400:
|
|
||||||
baudrate = B230400;
|
|
||||||
break;
|
|
||||||
case 460800:
|
|
||||||
baudrate = B460800;
|
|
||||||
break;
|
|
||||||
case 500000:
|
|
||||||
baudrate = B500000;
|
|
||||||
break;
|
|
||||||
case 576000:
|
|
||||||
baudrate = B576000;
|
|
||||||
break;
|
|
||||||
case 921600:
|
|
||||||
baudrate = B921600;
|
|
||||||
break;
|
|
||||||
case 1000000:
|
|
||||||
baudrate = B1000000;
|
|
||||||
break;
|
|
||||||
case 1152000:
|
|
||||||
baudrate = B1152000;
|
|
||||||
break;
|
|
||||||
case 1500000:
|
|
||||||
baudrate = B1500000;
|
|
||||||
break;
|
|
||||||
case 2000000:
|
|
||||||
baudrate = B2000000;
|
|
||||||
break;
|
|
||||||
case 2500000:
|
|
||||||
baudrate = B2500000;
|
|
||||||
break;
|
|
||||||
case 3000000:
|
|
||||||
baudrate = B3000000;
|
|
||||||
break;
|
|
||||||
case 3500000:
|
|
||||||
baudrate = B3500000;
|
|
||||||
break;
|
|
||||||
case 4000000:
|
|
||||||
baudrate = B4000000;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
error_printf("Invalid baud rate");
|
|
||||||
exit(EXIT_FAILURE);
|
|
||||||
}
|
|
||||||
|
|
||||||
cfsetispeed(&option.tio, baudrate);
|
|
||||||
cfsetospeed(&option.tio, baudrate);
|
|
||||||
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 'd':
|
case 'd':
|
||||||
option.databits = atoi(optarg);
|
option.databits = atoi(optarg);
|
||||||
option.tio.c_cflag &= ~CSIZE;
|
|
||||||
switch (option.databits)
|
|
||||||
{
|
|
||||||
case 5:
|
|
||||||
option.tio.c_cflag |= CS5;
|
|
||||||
break;
|
|
||||||
case 6:
|
|
||||||
option.tio.c_cflag |= CS6;
|
|
||||||
break;
|
|
||||||
case 7:
|
|
||||||
option.tio.c_cflag |= CS7;
|
|
||||||
break;
|
|
||||||
case 8:
|
|
||||||
option.tio.c_cflag |= CS8;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
error_printf("Invalid data bits");
|
|
||||||
exit(EXIT_FAILURE);
|
|
||||||
}
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 'f':
|
case 'f':
|
||||||
option.flow = optarg;
|
option.flow = optarg;
|
||||||
|
|
||||||
if (strcmp("hard", optarg) == 0)
|
|
||||||
{
|
|
||||||
option.tio.c_cflag |= CRTSCTS;
|
|
||||||
option.tio.c_iflag &= ~(IXON | IXOFF | IXANY);
|
|
||||||
}
|
|
||||||
else if (strcmp("soft", optarg) == 0)
|
|
||||||
{
|
|
||||||
option.tio.c_cflag &= ~CRTSCTS;
|
|
||||||
option.tio.c_iflag |= IXON | IXOFF;
|
|
||||||
}
|
|
||||||
else if (strcmp("none", optarg) == 0)
|
|
||||||
{
|
|
||||||
option.tio.c_cflag &= ~CRTSCTS;
|
|
||||||
option.tio.c_iflag &= ~(IXON | IXOFF | IXANY);
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
error_printf("Invalid flow control");
|
|
||||||
exit(EXIT_FAILURE);
|
|
||||||
}
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 's':
|
case 's':
|
||||||
option.stopbits = atoi(optarg);
|
option.stopbits = atoi(optarg);
|
||||||
switch (option.stopbits)
|
|
||||||
{
|
|
||||||
case 1:
|
|
||||||
option.tio.c_cflag &= ~CSTOPB;
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
option.tio.c_cflag |= CSTOPB;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
error_printf("Invalid stop bits");
|
|
||||||
exit(EXIT_FAILURE);
|
|
||||||
}
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 'p':
|
case 'p':
|
||||||
option.parity = optarg;
|
option.parity = optarg;
|
||||||
|
|
||||||
if (strcmp("odd", optarg) == 0)
|
|
||||||
{
|
|
||||||
option.tio.c_cflag |= PARENB;
|
|
||||||
option.tio.c_cflag |= PARODD;
|
|
||||||
}
|
|
||||||
else if (strcmp("even", optarg) == 0)
|
|
||||||
{
|
|
||||||
option.tio.c_cflag |= PARENB;
|
|
||||||
option.tio.c_cflag &= ~PARODD;
|
|
||||||
}
|
|
||||||
else if (strcmp("none", optarg) == 0)
|
|
||||||
option.tio.c_cflag &= ~PARENB;
|
|
||||||
else
|
|
||||||
{
|
|
||||||
error_printf("Invalid parity");
|
|
||||||
exit(EXIT_FAILURE);
|
|
||||||
}
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 'o':
|
case 'o':
|
||||||
|
|
|
||||||
197
src/tty.c
197
src/tty.c
|
|
@ -41,7 +41,7 @@
|
||||||
#include "tio/log.h"
|
#include "tio/log.h"
|
||||||
#include "tio/error.h"
|
#include "tio/error.h"
|
||||||
|
|
||||||
static struct termios new_stdout, old_stdout, old_tio;
|
static struct termios tio, new_stdout, old_stdout, old_tio;
|
||||||
static unsigned long rx_total = 0, tx_total = 0;
|
static unsigned long rx_total = 0, tx_total = 0;
|
||||||
static bool connected = false;
|
static bool connected = false;
|
||||||
static bool tainted = false;
|
static bool tainted = false;
|
||||||
|
|
@ -154,6 +154,187 @@ void stdout_restore(void)
|
||||||
tcsetattr(STDOUT_FILENO, TCSAFLUSH, &old_stdout);
|
tcsetattr(STDOUT_FILENO, TCSAFLUSH, &old_stdout);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void tty_configure(void)
|
||||||
|
{
|
||||||
|
unsigned int baudrate;
|
||||||
|
|
||||||
|
bzero(&tio, sizeof(tio));
|
||||||
|
|
||||||
|
/* Set speed */
|
||||||
|
switch (option.baudrate)
|
||||||
|
{
|
||||||
|
case 0:
|
||||||
|
baudrate = B0;
|
||||||
|
break;
|
||||||
|
case 50:
|
||||||
|
baudrate = B50;
|
||||||
|
break;
|
||||||
|
case 75:
|
||||||
|
baudrate = B75;
|
||||||
|
break;
|
||||||
|
case 110:
|
||||||
|
baudrate = B110;
|
||||||
|
break;
|
||||||
|
case 134:
|
||||||
|
baudrate = B134;
|
||||||
|
break;
|
||||||
|
case 150:
|
||||||
|
baudrate = B150;
|
||||||
|
break;
|
||||||
|
case 300:
|
||||||
|
baudrate = B300;
|
||||||
|
break;
|
||||||
|
case 600:
|
||||||
|
baudrate = B600;
|
||||||
|
break;
|
||||||
|
case 1200:
|
||||||
|
baudrate = B1200;
|
||||||
|
break;
|
||||||
|
case 2400:
|
||||||
|
baudrate = B2400;
|
||||||
|
break;
|
||||||
|
case 4800:
|
||||||
|
baudrate = B4800;
|
||||||
|
break;
|
||||||
|
case 9600:
|
||||||
|
baudrate = B9600;
|
||||||
|
break;
|
||||||
|
case 19200:
|
||||||
|
baudrate = B19200;
|
||||||
|
break;
|
||||||
|
case 38400:
|
||||||
|
baudrate = B38400;
|
||||||
|
break;
|
||||||
|
case 57600:
|
||||||
|
baudrate = B57600;
|
||||||
|
break;
|
||||||
|
case 115200:
|
||||||
|
baudrate = B115200;
|
||||||
|
break;
|
||||||
|
case 230400:
|
||||||
|
baudrate = B230400;
|
||||||
|
break;
|
||||||
|
case 460800:
|
||||||
|
baudrate = B460800;
|
||||||
|
break;
|
||||||
|
case 500000:
|
||||||
|
baudrate = B500000;
|
||||||
|
break;
|
||||||
|
case 576000:
|
||||||
|
baudrate = B576000;
|
||||||
|
break;
|
||||||
|
case 921600:
|
||||||
|
baudrate = B921600;
|
||||||
|
break;
|
||||||
|
case 1000000:
|
||||||
|
baudrate = B1000000;
|
||||||
|
break;
|
||||||
|
case 1152000:
|
||||||
|
baudrate = B1152000;
|
||||||
|
break;
|
||||||
|
case 1500000:
|
||||||
|
baudrate = B1500000;
|
||||||
|
break;
|
||||||
|
case 2000000:
|
||||||
|
baudrate = B2000000;
|
||||||
|
break;
|
||||||
|
case 2500000:
|
||||||
|
baudrate = B2500000;
|
||||||
|
break;
|
||||||
|
case 3000000:
|
||||||
|
baudrate = B3000000;
|
||||||
|
break;
|
||||||
|
case 3500000:
|
||||||
|
baudrate = B3500000;
|
||||||
|
break;
|
||||||
|
case 4000000:
|
||||||
|
baudrate = B4000000;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
error_printf("Invalid baud rate");
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
cfsetispeed(&tio, baudrate);
|
||||||
|
cfsetospeed(&tio, baudrate);
|
||||||
|
|
||||||
|
/* Set databits */
|
||||||
|
tio.c_cflag &= ~CSIZE; // ?
|
||||||
|
switch (option.databits)
|
||||||
|
{
|
||||||
|
case 5:
|
||||||
|
tio.c_cflag |= CS5;
|
||||||
|
break;
|
||||||
|
case 6:
|
||||||
|
tio.c_cflag |= CS6;
|
||||||
|
break;
|
||||||
|
case 7:
|
||||||
|
tio.c_cflag |= CS7;
|
||||||
|
break;
|
||||||
|
case 8:
|
||||||
|
tio.c_cflag |= CS8;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
error_printf("Invalid data bits");
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Set flow control */
|
||||||
|
if (strcmp("hard", option.flow) == 0)
|
||||||
|
{
|
||||||
|
tio.c_cflag |= CRTSCTS;
|
||||||
|
tio.c_iflag &= ~(IXON | IXOFF | IXANY);
|
||||||
|
}
|
||||||
|
else if (strcmp("soft", option.flow) == 0)
|
||||||
|
{
|
||||||
|
tio.c_cflag &= ~CRTSCTS;
|
||||||
|
tio.c_iflag |= IXON | IXOFF;
|
||||||
|
}
|
||||||
|
else if (strcmp("none", option.flow) == 0)
|
||||||
|
{
|
||||||
|
tio.c_cflag &= ~CRTSCTS;
|
||||||
|
tio.c_iflag &= ~(IXON | IXOFF | IXANY);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
error_printf("Invalid flow control");
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Set stopbits */
|
||||||
|
switch (option.stopbits)
|
||||||
|
{
|
||||||
|
case 1:
|
||||||
|
tio.c_cflag &= ~CSTOPB;
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
tio.c_cflag |= CSTOPB;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
error_printf("Invalid stop bits");
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Set parity */
|
||||||
|
if (strcmp("odd", option.parity) == 0)
|
||||||
|
{
|
||||||
|
tio.c_cflag |= PARENB;
|
||||||
|
tio.c_cflag |= PARODD;
|
||||||
|
}
|
||||||
|
else if (strcmp("even", option.parity) == 0)
|
||||||
|
{
|
||||||
|
tio.c_cflag |= PARENB;
|
||||||
|
tio.c_cflag &= ~PARODD;
|
||||||
|
}
|
||||||
|
else if (strcmp("none", option.parity) == 0)
|
||||||
|
tio.c_cflag &= ~PARENB;
|
||||||
|
else
|
||||||
|
{
|
||||||
|
error_printf("Invalid parity");
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
void tty_wait_for_device(void)
|
void tty_wait_for_device(void)
|
||||||
{
|
{
|
||||||
fd_set rdfs;
|
fd_set rdfs;
|
||||||
|
|
@ -284,17 +465,17 @@ int tty_connect(void)
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Control, input, output, local modes for tty device */
|
/* Control, input, output, local modes for tty device */
|
||||||
option.tio.c_cflag |= CLOCAL | CREAD;
|
tio.c_cflag |= CLOCAL | CREAD;
|
||||||
option.tio.c_oflag = 0;
|
tio.c_oflag = 0;
|
||||||
option.tio.c_lflag = 0;
|
tio.c_lflag = 0;
|
||||||
|
|
||||||
/* Control characters */
|
/* Control characters */
|
||||||
option.tio.c_cc[VTIME] = 0; /* Inter-character timer unused */
|
tio.c_cc[VTIME] = 0; /* Inter-character timer unused */
|
||||||
option.tio.c_cc[VMIN] = 1; /* Blocking read until 1 character received */
|
tio.c_cc[VMIN] = 1; /* Blocking read until 1 character received */
|
||||||
|
|
||||||
/* Activate new port settings */
|
/* Activate new port settings */
|
||||||
tcsetattr(fd, TCSANOW, &option.tio);
|
tcsetattr(fd, TCSANOW, &tio);
|
||||||
tcsetattr(fd, TCSAFLUSH, &option.tio);
|
tcsetattr(fd, TCSAFLUSH, &tio);
|
||||||
|
|
||||||
maxfd = MAX(fd, STDIN_FILENO) + 1; /* Maximum bit entry (fd) to test */
|
maxfd = MAX(fd, STDIN_FILENO) + 1; /* Maximum bit entry (fd) to test */
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Add table
Add a link
Reference in a new issue