[SERIAL] Fix Bug 4900: S3 resume oops with irattach - Thinkpad A21m
If we fail to re-startup a serial port on resume, shut it down immediately and mark it as an error condition. Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
This commit is contained in:
parent
270c7a7215
commit
ee31b33785
1 changed files with 53 additions and 39 deletions
|
@ -209,33 +209,45 @@ static void uart_shutdown(struct uart_state *state)
|
||||||
struct uart_info *info = state->info;
|
struct uart_info *info = state->info;
|
||||||
struct uart_port *port = state->port;
|
struct uart_port *port = state->port;
|
||||||
|
|
||||||
if (!(info->flags & UIF_INITIALIZED))
|
/*
|
||||||
return;
|
* Set the TTY IO error marker
|
||||||
|
*/
|
||||||
|
if (info->tty)
|
||||||
|
set_bit(TTY_IO_ERROR, &info->tty->flags);
|
||||||
|
|
||||||
|
if (info->flags & UIF_INITIALIZED) {
|
||||||
|
info->flags &= ~UIF_INITIALIZED;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Turn off DTR and RTS early.
|
||||||
|
*/
|
||||||
|
if (!info->tty || (info->tty->termios->c_cflag & HUPCL))
|
||||||
|
uart_clear_mctrl(port, TIOCM_DTR | TIOCM_RTS);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* clear delta_msr_wait queue to avoid mem leaks: we may free
|
||||||
|
* the irq here so the queue might never be woken up. Note
|
||||||
|
* that we won't end up waiting on delta_msr_wait again since
|
||||||
|
* any outstanding file descriptors should be pointing at
|
||||||
|
* hung_up_tty_fops now.
|
||||||
|
*/
|
||||||
|
wake_up_interruptible(&info->delta_msr_wait);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Free the IRQ and disable the port.
|
||||||
|
*/
|
||||||
|
port->ops->shutdown(port);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Ensure that the IRQ handler isn't running on another CPU.
|
||||||
|
*/
|
||||||
|
synchronize_irq(port->irq);
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Turn off DTR and RTS early.
|
* kill off our tasklet
|
||||||
*/
|
*/
|
||||||
if (!info->tty || (info->tty->termios->c_cflag & HUPCL))
|
tasklet_kill(&info->tlet);
|
||||||
uart_clear_mctrl(port, TIOCM_DTR | TIOCM_RTS);
|
|
||||||
|
|
||||||
/*
|
|
||||||
* clear delta_msr_wait queue to avoid mem leaks: we may free
|
|
||||||
* the irq here so the queue might never be woken up. Note
|
|
||||||
* that we won't end up waiting on delta_msr_wait again since
|
|
||||||
* any outstanding file descriptors should be pointing at
|
|
||||||
* hung_up_tty_fops now.
|
|
||||||
*/
|
|
||||||
wake_up_interruptible(&info->delta_msr_wait);
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Free the IRQ and disable the port.
|
|
||||||
*/
|
|
||||||
port->ops->shutdown(port);
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Ensure that the IRQ handler isn't running on another CPU.
|
|
||||||
*/
|
|
||||||
synchronize_irq(port->irq);
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Free the transmit buffer page.
|
* Free the transmit buffer page.
|
||||||
|
@ -244,15 +256,6 @@ static void uart_shutdown(struct uart_state *state)
|
||||||
free_page((unsigned long)info->xmit.buf);
|
free_page((unsigned long)info->xmit.buf);
|
||||||
info->xmit.buf = NULL;
|
info->xmit.buf = NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
|
||||||
* kill off our tasklet
|
|
||||||
*/
|
|
||||||
tasklet_kill(&info->tlet);
|
|
||||||
if (info->tty)
|
|
||||||
set_bit(TTY_IO_ERROR, &info->tty->flags);
|
|
||||||
|
|
||||||
info->flags &= ~UIF_INITIALIZED;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -1928,14 +1931,25 @@ int uart_resume_port(struct uart_driver *drv, struct uart_port *port)
|
||||||
|
|
||||||
if (state->info && state->info->flags & UIF_INITIALIZED) {
|
if (state->info && state->info->flags & UIF_INITIALIZED) {
|
||||||
struct uart_ops *ops = port->ops;
|
struct uart_ops *ops = port->ops;
|
||||||
|
int ret;
|
||||||
|
|
||||||
ops->set_mctrl(port, 0);
|
ops->set_mctrl(port, 0);
|
||||||
ops->startup(port);
|
ret = ops->startup(port);
|
||||||
uart_change_speed(state, NULL);
|
if (ret == 0) {
|
||||||
spin_lock_irq(&port->lock);
|
uart_change_speed(state, NULL);
|
||||||
ops->set_mctrl(port, port->mctrl);
|
spin_lock_irq(&port->lock);
|
||||||
ops->start_tx(port);
|
ops->set_mctrl(port, port->mctrl);
|
||||||
spin_unlock_irq(&port->lock);
|
ops->start_tx(port);
|
||||||
|
spin_unlock_irq(&port->lock);
|
||||||
|
} else {
|
||||||
|
/*
|
||||||
|
* Failed to resume - maybe hardware went away?
|
||||||
|
* Clear the "initialized" flag so we won't try
|
||||||
|
* to call the low level drivers shutdown method.
|
||||||
|
*/
|
||||||
|
state->info->flags &= ~UIF_INITIALIZED;
|
||||||
|
uart_shutdown(state);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
up(&state->sem);
|
up(&state->sem);
|
||||||
|
|
Loading…
Add table
Reference in a new issue