1 files changed, 10 insertions, 22 deletions

diff --git a/drivers/tty/serial/clps711x.c b/drivers/tty/serial/clps711x.c
index f5b4c3d7e38f..acfe31773643 100644
--- a/drivers/tty/serial/clps711x.c
+++ b/drivers/tty/serial/clps711x.c
@@ -33,6 +33,8 @@
 #include <linux/mfd/syscon.h>
 #include <linux/mfd/syscon/clps711x.h>
 
+#include "serial_mctrl_gpio.h"
+
 #define UART_CLPS711X_DEVNAME   "ttyCL"
 #define UART_CLPS711X_NR        2
 #define UART_CLPS711X_MAJOR     204
@@ -62,7 +64,7 @@ struct clps711x_port {
         unsigned int            tx_enabled;
         int                     rx_irq;
         struct regmap           *syscon;
-        bool                    use_ms;
+        struct mctrl_gpios      *gpios;
 };
 
 static struct uart_driver clps711x_uart = {
@@ -198,28 +200,17 @@ static unsigned int uart_clps711x_tx_empty(struct uart_port *port)
 
 static unsigned int uart_clps711x_get_mctrl(struct uart_port *port)
 {
+        unsigned int result = TIOCM_DSR | TIOCM_CTS | TIOCM_CAR;
         struct clps711x_port *s = dev_get_drvdata(port->dev);
-        unsigned int result = 0;
-
-        if (s->use_ms) {
-                u32 sysflg = 0;
-
-                regmap_read(s->syscon, SYSFLG_OFFSET, &sysflg);
-                if (sysflg & SYSFLG1_DCD)
-                        result |= TIOCM_CAR;
-                if (sysflg & SYSFLG1_DSR)
-                        result |= TIOCM_DSR;
-                if (sysflg & SYSFLG1_CTS)
-                        result |= TIOCM_CTS;
-        } else
-                result = TIOCM_DSR | TIOCM_CTS | TIOCM_CAR;
 
-        return result;
+        return mctrl_gpio_get(s->gpios, &result);
 }
 
 static void uart_clps711x_set_mctrl(struct uart_port *port, unsigned int mctrl)
 {
-        /* Do nothing */
+        struct clps711x_port *s = dev_get_drvdata(port->dev);
+
+        mctrl_gpio_set(s->gpios, mctrl);
 }
 
 static void uart_clps711x_break_ctl(struct uart_port *port, int break_state)
@@ -490,15 +481,10 @@ static int uart_clps711x_probe(struct platform_device *pdev)
                 s->syscon = syscon_regmap_lookup_by_pdevname(syscon_name);
                 if (IS_ERR(s->syscon))
                         return PTR_ERR(s->syscon);
-
-                s->use_ms = !index;
         } else {
                 s->syscon = syscon_regmap_lookup_by_phandle(np, "syscon");
                 if (IS_ERR(s->syscon))
                         return PTR_ERR(s->syscon);
-
-                if (!index)
-                        s->use_ms = of_property_read_bool(np, "uart-use-ms");
         }
 
         s->port.line            = index;
@@ -513,6 +499,8 @@ static int uart_clps711x_probe(struct platform_device *pdev)
 
         platform_set_drvdata(pdev, s);
 
+        s->gpios = mctrl_gpio_init(&pdev->dev, 0);
+
         ret = uart_add_one_port(&clps711x_uart, &s->port);
         if (ret)
                 return ret;