123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157 |
- /*
- * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
- *
- * SPDX-License-Identifier: BSD-2-Clause
- */
- #include <assert.h>
- #include <bits/pthread_cancel.h>
- #include <errno.h>
- #include <sys/ioctl.h>
- #include <termios.h>
- extern "C" {
- int tcgetattr(int fd, struct termios* t)
- {
- return ioctl(fd, TCGETS, t);
- }
- int tcsetattr(int fd, int optional_actions, const struct termios* t)
- {
- switch (optional_actions) {
- case TCSANOW:
- return ioctl(fd, TCSETS, t);
- case TCSADRAIN:
- return ioctl(fd, TCSETSW, t);
- case TCSAFLUSH:
- return ioctl(fd, TCSETSF, t);
- }
- errno = EINVAL;
- return -1;
- }
- // https://pubs.opengroup.org/onlinepubs/009695399/functions/tcsendbreak.html
- int tcsendbreak([[maybe_unused]] int fd, [[maybe_unused]] int duration)
- {
- // FIXME: Implement this for real.
- return 0;
- }
- int tcflow([[maybe_unused]] int fd, [[maybe_unused]] int action)
- {
- errno = EINVAL;
- return -1;
- }
- int tcflush(int fd, int queue_selector)
- {
- return ioctl(fd, TCFLSH, queue_selector);
- }
- // https://pubs.opengroup.org/onlinepubs/009695399/functions/tcdrain.html
- int tcdrain([[maybe_unused]] int fd)
- {
- __pthread_maybe_cancel();
- // FIXME: Implement this for real.
- return 0;
- }
- speed_t cfgetispeed(const struct termios* tp)
- {
- return tp->c_ispeed;
- }
- 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);
- }
- void cfmakeraw(struct termios* tp)
- {
- if (!tp)
- return;
- auto& termios = *tp;
- termios.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP | INLCR | IGNCR | ICRNL | IXON);
- termios.c_lflag &= ~OPOST;
- termios.c_cflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
- termios.c_cflag |= CS8;
- }
- }
|