|
@@ -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;
|