mirror of
https://github.com/RGBCube/serenity
synced 2025-07-25 04:07:44 +00:00
LibC: Implement cf{g,s}et{i,o}speed
This commit is contained in:
parent
9609539236
commit
29e00b637e
2 changed files with 80 additions and 0 deletions
|
@ -74,4 +74,79 @@ speed_t cfgetospeed(const struct termios* tp)
|
|||
{
|
||||
return tp->c_ospeed;
|
||||
}
|
||||
|
||||
static int baud_rate_from_speed(speed_t speed)
|
||||
{
|
||||
int rate = -EINVAL;
|
||||
switch (speed) {
|
||||
case B0:
|
||||
rate = 0;
|
||||
break;
|
||||
case B50:
|
||||
rate = 50;
|
||||
break;
|
||||
case B75:
|
||||
rate = 75;
|
||||
break;
|
||||
case B110:
|
||||
rate = 110;
|
||||
break;
|
||||
case B134:
|
||||
rate = 134;
|
||||
break;
|
||||
case B150:
|
||||
rate = 150;
|
||||
break;
|
||||
case B200:
|
||||
rate = 200;
|
||||
break;
|
||||
case B300:
|
||||
rate = 300;
|
||||
break;
|
||||
case B600:
|
||||
rate = 600;
|
||||
break;
|
||||
case B1200:
|
||||
rate = 1200;
|
||||
break;
|
||||
case B1800:
|
||||
rate = 1800;
|
||||
break;
|
||||
case B2400:
|
||||
rate = 2400;
|
||||
break;
|
||||
case B4800:
|
||||
rate = 4800;
|
||||
break;
|
||||
case B9600:
|
||||
rate = 9600;
|
||||
break;
|
||||
case B19200:
|
||||
rate = 19200;
|
||||
break;
|
||||
case B38400:
|
||||
rate = 38400;
|
||||
break;
|
||||
}
|
||||
|
||||
return rate;
|
||||
}
|
||||
|
||||
int cfsetispeed(struct termios* tp, speed_t speed)
|
||||
{
|
||||
auto ispeed = baud_rate_from_speed(speed);
|
||||
if (ispeed > 0) {
|
||||
tp->c_ispeed = ispeed;
|
||||
}
|
||||
__RETURN_WITH_ERRNO(ispeed, 0, -1);
|
||||
}
|
||||
|
||||
int cfsetospeed(struct termios* tp, speed_t speed)
|
||||
{
|
||||
auto ospeed = baud_rate_from_speed(speed);
|
||||
if (ospeed > 0) {
|
||||
tp->c_ispeed = ospeed;
|
||||
}
|
||||
__RETURN_WITH_ERRNO(ospeed, 0, -1);
|
||||
}
|
||||
}
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue