Commit 6a533ed7 authored by Andy Shevchenko's avatar Andy Shevchenko Committed by Greg Kroah-Hartman

serial: 8250_dw: Deduplicate LCR checks

All callers of dw8250_check_lcr() perform the same check.
Deduplicate it by moving them into respective call.
Signed-off-by: default avatarAndy Shevchenko <andriy.shevchenko@linux.intel.com>
Link: https://lore.kernel.org/r/20240412173931.187411-1-andriy.shevchenko@linux.intel.comSigned-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 5cb90c63
...@@ -100,14 +100,18 @@ static void dw8250_force_idle(struct uart_port *p) ...@@ -100,14 +100,18 @@ static void dw8250_force_idle(struct uart_port *p)
(void)p->serial_in(p, UART_RX); (void)p->serial_in(p, UART_RX);
} }
static void dw8250_check_lcr(struct uart_port *p, int value) static void dw8250_check_lcr(struct uart_port *p, int offset, int value)
{ {
void __iomem *offset = p->membase + (UART_LCR << p->regshift); struct dw8250_data *d = to_dw8250_data(p->private_data);
void __iomem *addr = p->membase + (offset << p->regshift);
int tries = 1000; int tries = 1000;
if (offset != UART_LCR || d->uart_16550_compatible)
return;
/* Make sure LCR write wasn't ignored */ /* Make sure LCR write wasn't ignored */
while (tries--) { while (tries--) {
unsigned int lcr = p->serial_in(p, UART_LCR); unsigned int lcr = p->serial_in(p, offset);
if ((value & ~UART_LCR_SPAR) == (lcr & ~UART_LCR_SPAR)) if ((value & ~UART_LCR_SPAR) == (lcr & ~UART_LCR_SPAR))
return; return;
...@@ -116,15 +120,15 @@ static void dw8250_check_lcr(struct uart_port *p, int value) ...@@ -116,15 +120,15 @@ static void dw8250_check_lcr(struct uart_port *p, int value)
#ifdef CONFIG_64BIT #ifdef CONFIG_64BIT
if (p->type == PORT_OCTEON) if (p->type == PORT_OCTEON)
__raw_writeq(value & 0xff, offset); __raw_writeq(value & 0xff, addr);
else else
#endif #endif
if (p->iotype == UPIO_MEM32) if (p->iotype == UPIO_MEM32)
writel(value, offset); writel(value, addr);
else if (p->iotype == UPIO_MEM32BE) else if (p->iotype == UPIO_MEM32BE)
iowrite32be(value, offset); iowrite32be(value, addr);
else else
writeb(value, offset); writeb(value, addr);
} }
/* /*
* FIXME: this deadlocks if port->lock is already held * FIXME: this deadlocks if port->lock is already held
...@@ -158,12 +162,8 @@ static void dw8250_tx_wait_empty(struct uart_port *p) ...@@ -158,12 +162,8 @@ static void dw8250_tx_wait_empty(struct uart_port *p)
static void dw8250_serial_out(struct uart_port *p, int offset, int value) static void dw8250_serial_out(struct uart_port *p, int offset, int value)
{ {
struct dw8250_data *d = to_dw8250_data(p->private_data);
writeb(value, p->membase + (offset << p->regshift)); writeb(value, p->membase + (offset << p->regshift));
dw8250_check_lcr(p, offset, value);
if (offset == UART_LCR && !d->uart_16550_compatible)
dw8250_check_lcr(p, value);
} }
static void dw8250_serial_out38x(struct uart_port *p, int offset, int value) static void dw8250_serial_out38x(struct uart_port *p, int offset, int value)
...@@ -194,26 +194,19 @@ static unsigned int dw8250_serial_inq(struct uart_port *p, int offset) ...@@ -194,26 +194,19 @@ static unsigned int dw8250_serial_inq(struct uart_port *p, int offset)
static void dw8250_serial_outq(struct uart_port *p, int offset, int value) static void dw8250_serial_outq(struct uart_port *p, int offset, int value)
{ {
struct dw8250_data *d = to_dw8250_data(p->private_data);
value &= 0xff; value &= 0xff;
__raw_writeq(value, p->membase + (offset << p->regshift)); __raw_writeq(value, p->membase + (offset << p->regshift));
/* Read back to ensure register write ordering. */ /* Read back to ensure register write ordering. */
__raw_readq(p->membase + (UART_LCR << p->regshift)); __raw_readq(p->membase + (UART_LCR << p->regshift));
if (offset == UART_LCR && !d->uart_16550_compatible) dw8250_check_lcr(p, offset, value);
dw8250_check_lcr(p, value);
} }
#endif /* CONFIG_64BIT */ #endif /* CONFIG_64BIT */
static void dw8250_serial_out32(struct uart_port *p, int offset, int value) static void dw8250_serial_out32(struct uart_port *p, int offset, int value)
{ {
struct dw8250_data *d = to_dw8250_data(p->private_data);
writel(value, p->membase + (offset << p->regshift)); writel(value, p->membase + (offset << p->regshift));
dw8250_check_lcr(p, offset, value);
if (offset == UART_LCR && !d->uart_16550_compatible)
dw8250_check_lcr(p, value);
} }
static unsigned int dw8250_serial_in32(struct uart_port *p, int offset) static unsigned int dw8250_serial_in32(struct uart_port *p, int offset)
...@@ -225,12 +218,8 @@ static unsigned int dw8250_serial_in32(struct uart_port *p, int offset) ...@@ -225,12 +218,8 @@ static unsigned int dw8250_serial_in32(struct uart_port *p, int offset)
static void dw8250_serial_out32be(struct uart_port *p, int offset, int value) static void dw8250_serial_out32be(struct uart_port *p, int offset, int value)
{ {
struct dw8250_data *d = to_dw8250_data(p->private_data);
iowrite32be(value, p->membase + (offset << p->regshift)); iowrite32be(value, p->membase + (offset << p->regshift));
dw8250_check_lcr(p, offset, value);
if (offset == UART_LCR && !d->uart_16550_compatible)
dw8250_check_lcr(p, value);
} }
static unsigned int dw8250_serial_in32be(struct uart_port *p, int offset) static unsigned int dw8250_serial_in32be(struct uart_port *p, int offset)
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment