From: Maarten Brock Date: Sun, 14 Feb 2016 14:05:26 +0000 (+0100) Subject: sc16is7xx: implemented get_mctrl X-Git-Url: https://git.stricted.de/?a=commitdiff_plain;h=a3f0b77f36ca5c5871fb8daf7e66fa409abe1ed5;p=GitHub%2Fmoto-9609%2Fandroid_kernel_motorola_exynos9610.git sc16is7xx: implemented get_mctrl Add support for manual getting the modem control lines. Signed-off-by: Maarten Brock Signed-off-by: Greg Kroah-Hartman --- diff --git a/drivers/tty/serial/sc16is7xx.c b/drivers/tty/serial/sc16is7xx.c index 025a4264430e..e78fa99475c0 100644 --- a/drivers/tty/serial/sc16is7xx.c +++ b/drivers/tty/serial/sc16is7xx.c @@ -822,10 +822,16 @@ static unsigned int sc16is7xx_tx_empty(struct uart_port *port) static unsigned int sc16is7xx_get_mctrl(struct uart_port *port) { - /* DCD and DSR are not wired and CTS/RTS is handled automatically - * so just indicate DSR and CAR asserted - */ - return TIOCM_DSR | TIOCM_CAR; + unsigned int msr; + unsigned int ret = 0; + + msr = sc16is7xx_port_read(port, SC16IS7XX_MSR_REG); + + ret |= (msr & SC16IS7XX_MSR_CTS_BIT) ? TIOCM_CTS : 0; + ret |= (msr & SC16IS7XX_MSR_DSR_BIT) ? TIOCM_DSR : 0; + ret |= (msr & SC16IS7XX_MSR_RI_BIT) ? TIOCM_RNG : 0; + ret |= (msr & SC16IS7XX_MSR_CD_BIT) ? TIOCM_CAR : 0; + return ret; } static void sc16is7xx_set_mctrl(struct uart_port *port, unsigned int mctrl)