blob: a7fcca7c9e2e3ee5796ef30e34503aaa7de3d8da (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
|
#include <unistd.h>
#include <termios.h>
#include <sys/types.h>
#include <asm/errno.h>
extern int errno;
/* Hack around a kernel bug; value must correspond to the one used in tcsetattr.c */
#define IBAUD0 020000000000
/* Return the output baud rate stored in *TERMIOS_P. */
speed_t cfgetospeed (struct termios *termios_p)
{
return termios_p->c_cflag & (CBAUD | CBAUDEX);
}
/* Return the input baud rate stored in *TERMIOS_P.
Although for Linux there is no difference between input and output
speed, the numerical 0 is a special case for the input baud rate. It
should set the input baud rate to the output baud rate. */
speed_t cfgetispeed (struct termios *termios_p)
{
return ((termios_p->c_iflag & IBAUD0)
? 0 : termios_p->c_cflag & (CBAUD | CBAUDEX));
}
/* Set the output baud rate stored in *TERMIOS_P to SPEED. */
int cfsetospeed (struct termios *termios_p, speed_t speed)
{
if ((speed & ~CBAUD) != 0 && (speed < B57600 || speed > B460800)) {
errno = EINVAL;
return -1;
}
termios_p->c_cflag &= ~(CBAUD | CBAUDEX);
termios_p->c_cflag |= speed;
return 0;
}
/* Set the input baud rate stored in *TERMIOS_P to SPEED.
Although for Linux there is no difference between input and output
speed, the numerical 0 is a special case for the input baud rate. It
should set the input baud rate to the output baud rate. */
int cfsetispeed (struct termios *termios_p, speed_t speed)
{
if ((speed & ~CBAUD) != 0 && (speed < B57600 || speed > B460800)) {
errno = EINVAL;
return -1;
}
if (speed == 0)
termios_p->c_iflag |= IBAUD0;
else
{
termios_p->c_iflag &= ~IBAUD0;
termios_p->c_cflag &= ~(CBAUD | CBAUDEX);
termios_p->c_cflag |= speed;
}
return 0;
}
|
