From fa08e69ccabc4945f5109b8b0e4f6d1b6d8ec66b Mon Sep 17 00:00:00 2001
From: anchao <anchao@pinecone.net>
Date: Sun, 26 Aug 2018 11:30:51 -0600
Subject: [PATCH] drivers/serial/uart_16550.c:  Add serial termios handling

---
 drivers/serial/uart_16550.c | 94 +++++++++++++++++++++++++++++++++++++
 1 file changed, 94 insertions(+)

diff --git a/drivers/serial/uart_16550.c b/drivers/serial/uart_16550.c
index b793bde831..4126048d22 100644
--- a/drivers/serial/uart_16550.c
+++ b/drivers/serial/uart_16550.c
@@ -916,6 +916,100 @@ static int u16550_ioctl(struct file *filep, int cmd, unsigned long arg)
       }
       break;
 
+#if defined(CONFIG_SERIAL_TERMIOS) && !defined(CONFIG_16550_SUPRESS_CONFIG)
+    case TCGETS:
+      {
+        FAR struct termios *termiosp = (FAR struct termios *)arg;
+        irqstate_t flags;
+
+        if (!termiosp)
+          {
+            ret = -EINVAL;
+            break;
+          }
+
+        flags = enter_critical_section();
+
+        cfsetispeed(termiosp, priv->baud);
+        termiosp->c_cflag = ((priv->parity != 0) ? PARENB : 0) |
+                            ((priv->parity == 1) ? PARODD : 0);
+        termiosp->c_cflag |= (priv->stopbits2) ? CSTOPB : 0;
+
+        switch (priv->bits)
+          {
+          case 5:
+            termiosp->c_cflag |= CS5;
+            break;
+
+          case 6:
+            termiosp->c_cflag |= CS6;
+            break;
+
+          case 7:
+            termiosp->c_cflag |= CS7;
+            break;
+
+          case 8:
+          default:
+            termiosp->c_cflag |= CS8;
+            break;
+          }
+
+        leave_critical_section(flags);
+      }
+      break;
+
+    case TCSETS:
+      {
+        FAR struct termios *termiosp = (FAR struct termios *)arg;
+        irqstate_t flags;
+
+        if (!termiosp)
+          {
+            ret = -EINVAL;
+            break;
+          }
+
+        flags = enter_critical_section();
+
+        switch (termiosp->c_cflag & CSIZE)
+          {
+          case CS5:
+            priv->bits = 5;
+            break;
+
+          case CS6:
+            priv->bits = 6;
+            break;
+
+          case CS7:
+            priv->bits = 7;
+            break;
+
+          case CS8:
+          default:
+            priv->bits = 8;
+            break;
+          }
+
+        if ((termiosp->c_cflag & PARENB) != 0)
+          {
+            priv->parity = (termiosp->c_cflag & PARODD) ? 1 : 2;
+          }
+        else
+          {
+            priv->parity = 0;
+          }
+
+        priv->baud      = cfgetispeed(termiosp);
+        priv->stopbits2 = (termiosp->c_cflag & CSTOPB) != 0;
+
+        u16550_setup(dev);
+        leave_critical_section(flags);
+      }
+      break;
+#endif
+
     default:
       ret = -ENOTTY;
       break;