1 | /* Copyright (C) 1992-2023 Free Software Foundation, Inc. |
2 | This file is part of the GNU C Library. |
3 | |
4 | The GNU C Library is free software; you can redistribute it and/or |
5 | modify it under the terms of the GNU Lesser General Public |
6 | License as published by the Free Software Foundation; either |
7 | version 2.1 of the License, or (at your option) any later version. |
8 | |
9 | The GNU C Library is distributed in the hope that it will be useful, |
10 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
11 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
12 | Lesser General Public License for more details. |
13 | |
14 | You should have received a copy of the GNU Lesser General Public |
15 | License along with the GNU C Library; if not, see |
16 | <https://www.gnu.org/licenses/>. */ |
17 | |
18 | #include <termios.h> |
19 | #include <errno.h> |
20 | #include <stddef.h> |
21 | |
22 | struct speed_struct |
23 | { |
24 | speed_t value; |
25 | speed_t internal; |
26 | }; |
27 | |
28 | static const struct speed_struct speeds[] = |
29 | { |
30 | #ifdef B0 |
31 | { 0, B0 }, |
32 | #endif |
33 | #ifdef B50 |
34 | { 50, B50 }, |
35 | #endif |
36 | #ifdef B75 |
37 | { 75, B75 }, |
38 | #endif |
39 | #ifdef B110 |
40 | { 110, B110 }, |
41 | #endif |
42 | #ifdef B134 |
43 | { 134, B134 }, |
44 | #endif |
45 | #ifdef B150 |
46 | { 150, B150 }, |
47 | #endif |
48 | #ifdef B200 |
49 | { 200, B200 }, |
50 | #endif |
51 | #ifdef B300 |
52 | { 300, B300 }, |
53 | #endif |
54 | #ifdef B600 |
55 | { 600, B600 }, |
56 | #endif |
57 | #ifdef B1200 |
58 | { 1200, B1200 }, |
59 | #endif |
60 | #ifdef B1200 |
61 | { 1200, B1200 }, |
62 | #endif |
63 | #ifdef B1800 |
64 | { 1800, B1800 }, |
65 | #endif |
66 | #ifdef B2400 |
67 | { 2400, B2400 }, |
68 | #endif |
69 | #ifdef B4800 |
70 | { 4800, B4800 }, |
71 | #endif |
72 | #ifdef B9600 |
73 | { 9600, B9600 }, |
74 | #endif |
75 | #ifdef B19200 |
76 | { 19200, B19200 }, |
77 | #endif |
78 | #ifdef B38400 |
79 | { 38400, B38400 }, |
80 | #endif |
81 | #ifdef B57600 |
82 | { 57600, B57600 }, |
83 | #endif |
84 | #ifdef B76800 |
85 | { 76800, B76800 }, |
86 | #endif |
87 | #ifdef B115200 |
88 | { 115200, B115200 }, |
89 | #endif |
90 | #ifdef B153600 |
91 | { 153600, B153600 }, |
92 | #endif |
93 | #ifdef B230400 |
94 | { 230400, B230400 }, |
95 | #endif |
96 | #ifdef B307200 |
97 | { 307200, B307200 }, |
98 | #endif |
99 | #ifdef B460800 |
100 | { 460800, B460800 }, |
101 | #endif |
102 | #ifdef B500000 |
103 | { 500000, B500000 }, |
104 | #endif |
105 | #ifdef B576000 |
106 | { 576000, B576000 }, |
107 | #endif |
108 | #ifdef B921600 |
109 | { 921600, B921600 }, |
110 | #endif |
111 | #ifdef B1000000 |
112 | { 1000000, B1000000 }, |
113 | #endif |
114 | #ifdef B1152000 |
115 | { 1152000, B1152000 }, |
116 | #endif |
117 | #ifdef B1500000 |
118 | { 1500000, B1500000 }, |
119 | #endif |
120 | #ifdef B2000000 |
121 | { 2000000, B2000000 }, |
122 | #endif |
123 | #ifdef B2500000 |
124 | { 2500000, B2500000 }, |
125 | #endif |
126 | #ifdef B3000000 |
127 | { 3000000, B3000000 }, |
128 | #endif |
129 | #ifdef B3500000 |
130 | { 3500000, B3500000 }, |
131 | #endif |
132 | #ifdef B4000000 |
133 | { 4000000, B4000000 }, |
134 | #endif |
135 | }; |
136 | |
137 | |
138 | /* Set both the input and output baud rates stored in *TERMIOS_P to SPEED. */ |
139 | int |
140 | cfsetspeed (struct termios *termios_p, speed_t speed) |
141 | { |
142 | size_t cnt; |
143 | |
144 | for (cnt = 0; cnt < sizeof (speeds) / sizeof (speeds[0]); ++cnt) |
145 | if (speed == speeds[cnt].internal) |
146 | { |
147 | cfsetispeed (termios_p, speed); |
148 | cfsetospeed (termios_p, speed); |
149 | return 0; |
150 | } |
151 | else if (speed == speeds[cnt].value) |
152 | { |
153 | cfsetispeed (termios_p, speeds[cnt].internal); |
154 | cfsetospeed (termios_p, speeds[cnt].internal); |
155 | return 0; |
156 | } |
157 | |
158 | __set_errno (EINVAL); |
159 | |
160 | return -1; |
161 | } |
162 | |