mdk-stage1/dietlibc/lib/cfsetispeed.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22

#include <termios.h>
#include <errno.h>
#include "dietfeatures.h"

#define IBAUD0  020000000000

int cfsetispeed(struct termios *termios_p, speed_t speed)
{
  if ((speed & (speed_t)~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;
}