1 files changed, 149 insertions, 0 deletions
diff --git a/Userland/Libraries/LibC/termios.cpp b/Userland/Libraries/LibC/termios.cpp
new file mode 100644
index 0000000000..1037b0ab61
--- /dev/null
+++ b/Userland/Libraries/LibC/termios.cpp
@@ -0,0 +1,149 @@
+/*
+ * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright notice, this
+ *    list of conditions and the following disclaimer.
+ *
+ * 2. Redistributions in binary form must reproduce the above copyright notice,
+ *    this list of conditions and the following disclaimer in the documentation
+ *    and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <Kernel/API/Syscall.h>
+#include <assert.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;
+}
+
+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);
+}
+
+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);
+}
+}