about summary refs log tree commit diff
path: root/sysdeps/unix/bsd/sun/sunos4/speed.c
blob: 1c09d55dabbd1687c8afd3e6ec42a8527f485903 (plain) (blame)
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
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
/* `struct termios' speed frobnication functions.  SunOS 4 version.
Copyright (C) 1991, 1992, 1993 Free Software Foundation, Inc.
This file is part of the GNU C Library.

The GNU C Library is free software; you can redistribute it and/or
modify it under the terms of the GNU Library General Public License as
published by the Free Software Foundation; either version 2 of the
License, or (at your option) any later version.

The GNU C Library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
Library General Public License for more details.

You should have received a copy of the GNU Library General Public
License along with the GNU C Library; see the file COPYING.LIB.  If
not, write to the Free Software Foundation, Inc., 675 Mass Ave,
Cambridge, MA 02139, USA.  */

#include <ansidecl.h>
#include <stddef.h>
#include <errno.h>
#include <termios.h>

static CONST speed_t speeds[] =
  {
    0,
    50,
    75,
    110,
    134,
    150,
    200,
    300,
    600,
    1200,
    1800,
    2400,
    4800,
    9600,
    19200,
    38400,
  };


/* Return the output baud rate stored in *TERMIOS_P.  */
speed_t
DEFUN(cfgetospeed, (termios_p), CONST struct termios *termios_p)
{
  return termios_p->c_cflag & CBAUD;
}

/* Return the input baud rate stored in *TERMIOS_P.  */
speed_t
DEFUN(cfgetispeed, (termios_p), CONST struct termios *termios_p)
{
  return (termios_p->c_cflag & CIBAUD) >> IBSHIFT;
}

/* Set the output baud rate stored in *TERMIOS_P to SPEED.  */
int
DEFUN(cfsetospeed, (termios_p, speed),
      struct termios *termios_p AND speed_t speed)
{
  register unsigned int i;

  if (termios_p == NULL)
    {
      errno = EINVAL;
      return -1;
    }

  /* This allows either B1200 or 1200 to work.	XXX
     Do we really want to try to support this, given that
     fetching the speed must return one or the other?  */

  for (i = 0; i < sizeof (speeds) / sizeof (speeds[0]); ++i)
    if (i == speed || speeds[i] == speed)
      {
	termios_p->c_cflag &= ~CBAUD;
	termios_p->c_cflag |= i;
	return 0;
      }

  errno = EINVAL;
  return -1;
}

/* Set the input baud rate stored in *TERMIOS_P to SPEED.  */
int
DEFUN(cfsetispeed, (termios_p, speed),
      struct termios *termios_p AND speed_t speed)
{
  register unsigned int i;

  if (termios_p == NULL)
    {
      errno = EINVAL;
      return -1;
    }

  /* See comment in cfsetospeed (above).  */
  for (i = 0; i < sizeof (speeds) / sizeof (speeds[0]); ++i)
    if (i == speed || speeds[i] == speed)
      {
	termios_p->c_cflag &= ~CIBAUD;
	termios_p->c_cflag |= i << IBSHIFT;
	return 0;
      }

  errno = EINVAL;
  return -1;
}