sc16is7xx: implemented get_mctrl

Add support for manual getting the modem control lines.

Signed-off-by: Maarten Brock <m.brock@vanmierlo.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
Maarten Brock 2016-02-14 15:05:26 +01:00 committed by Greg Kroah-Hartman
parent b7dfdea859
commit a3f0b77f36
1 changed files with 10 additions and 4 deletions

View File

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