serial: Test/disable MSIs if switching from N_PPS
Switching to the N_PPS line discipline may require enabling modem status interrupts; conversely switching from N_PPS may require disabling modem status interrupts. Affected drivers: 8250 amba-pl010 atmel Cc: Nicolas Ferre <nicolas.ferre@atmel.com> Cc: Russell King <linux@arm.linux.org.uk> Signed-off-by: Peter Hurley <peter@hurleysoftware.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
d41510ce2f
commit
cab68f8954
3 changed files with 42 additions and 2 deletions
|
@ -1402,6 +1402,19 @@ static void serial8250_stop_rx(struct uart_port *port)
|
||||||
serial8250_rpm_put(up);
|
serial8250_rpm_put(up);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void serial8250_disable_ms(struct uart_port *port)
|
||||||
|
{
|
||||||
|
struct uart_8250_port *up =
|
||||||
|
container_of(port, struct uart_8250_port, port);
|
||||||
|
|
||||||
|
/* no MSR capabilities */
|
||||||
|
if (up->bugs & UART_BUG_NOMSR)
|
||||||
|
return;
|
||||||
|
|
||||||
|
up->ier &= ~UART_IER_MSI;
|
||||||
|
serial_port_out(port, UART_IER, up->ier);
|
||||||
|
}
|
||||||
|
|
||||||
static void serial8250_enable_ms(struct uart_port *port)
|
static void serial8250_enable_ms(struct uart_port *port)
|
||||||
{
|
{
|
||||||
struct uart_8250_port *up = up_to_u8250p(port);
|
struct uart_8250_port *up = up_to_u8250p(port);
|
||||||
|
@ -2616,8 +2629,14 @@ serial8250_set_ldisc(struct uart_port *port, struct ktermios *termios)
|
||||||
spin_lock_irq(&port->lock);
|
spin_lock_irq(&port->lock);
|
||||||
serial8250_enable_ms(port);
|
serial8250_enable_ms(port);
|
||||||
spin_unlock_irq(&port->lock);
|
spin_unlock_irq(&port->lock);
|
||||||
} else
|
} else {
|
||||||
port->flags &= ~UPF_HARDPPS_CD;
|
port->flags &= ~UPF_HARDPPS_CD;
|
||||||
|
if (!UART_ENABLE_MS(port, termios->c_cflag)) {
|
||||||
|
spin_lock_irq(&port->lock);
|
||||||
|
serial8250_disable_ms(port);
|
||||||
|
spin_unlock_irq(&port->lock);
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
|
@ -106,6 +106,16 @@ static void pl010_stop_rx(struct uart_port *port)
|
||||||
writel(cr, uap->port.membase + UART010_CR);
|
writel(cr, uap->port.membase + UART010_CR);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void pl010_disable_ms(struct uart_port *port)
|
||||||
|
{
|
||||||
|
struct uart_amba_port *uap = (struct uart_amba_port *)port;
|
||||||
|
unsigned int cr;
|
||||||
|
|
||||||
|
cr = readb(uap->port.membase + UART010_CR);
|
||||||
|
cr &= ~UART010_CR_MSIE;
|
||||||
|
writel(cr, uap->port.membase + UART010_CR);
|
||||||
|
}
|
||||||
|
|
||||||
static void pl010_enable_ms(struct uart_port *port)
|
static void pl010_enable_ms(struct uart_port *port)
|
||||||
{
|
{
|
||||||
struct uart_amba_port *uap =
|
struct uart_amba_port *uap =
|
||||||
|
@ -486,8 +496,14 @@ static void pl010_set_ldisc(struct uart_port *port, struct ktermios *termios)
|
||||||
spin_lock_irq(&port->lock);
|
spin_lock_irq(&port->lock);
|
||||||
pl010_enable_ms(port);
|
pl010_enable_ms(port);
|
||||||
spin_unlock_irq(&port->lock);
|
spin_unlock_irq(&port->lock);
|
||||||
} else
|
} else {
|
||||||
port->flags &= ~UPF_HARDPPS_CD;
|
port->flags &= ~UPF_HARDPPS_CD;
|
||||||
|
if (!UART_ENABLE_MS(port, termios->c_cflag)) {
|
||||||
|
spin_lock_irq(&port->lock);
|
||||||
|
pl010_disable_ms(port);
|
||||||
|
spin_unlock_irq(&port->lock);
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static const char *pl010_type(struct uart_port *port)
|
static const char *pl010_type(struct uart_port *port)
|
||||||
|
|
|
@ -2065,6 +2065,11 @@ static void atmel_set_ldisc(struct uart_port *port, struct ktermios *termios)
|
||||||
spin_unlock_irq(&port->lock);
|
spin_unlock_irq(&port->lock);
|
||||||
} else {
|
} else {
|
||||||
port->flags &= ~UPF_HARDPPS_CD;
|
port->flags &= ~UPF_HARDPPS_CD;
|
||||||
|
if (!UART_ENABLE_MS(port, termios->c_cflag)) {
|
||||||
|
spin_lock_irq(&port->lock);
|
||||||
|
atmel_disable_ms(port);
|
||||||
|
spin_unlock_irq(&port->lock);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Add table
Reference in a new issue