mirror of https://gitee.com/openkylin/linux.git
tty: serial: lpuart: add little endian 32 bit register support
Use standard port->iotype to distinguish endian difference. Note as we read/write register by checking iotype dynamically, we need to initialize the iotype correctly for earlycon as well to avoid a break. Cc: Greg Kroah-Hartman <gregkh@linuxfoundation.org> Cc: Jiri Slaby <jslaby@suse.com> (supporter:TTY LAYER) Cc: Stefan Agner <stefan@agner.ch> Cc: Mingkai Hu <Mingkai.Hu@nxp.com> Cc: Yangbo Lu <yangbo.lu@nxp.com> Cc: Fugang Duan <fugang.duan@nxp.com> Cc: Andy Shevchenko <andy.shevchenko@gmail.com> Cc: Nikita Yushchenko <nikita.yoush@cogentembedded.com> Signed-off-by: Dong Aisheng <aisheng.dong@nxp.com> ChangeLog: v3->v4: * Removed unneeded semicolon catched by 0day Robot. v2->v3: * Instead of using global var, use standard port->iotype to distinguish endian difference. v1->v2: * No changes Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
a0204f25e1
commit
f98e1fcd96
|
@ -279,15 +279,29 @@ MODULE_DEVICE_TABLE(of, lpuart_dt_ids);
|
|||
/* Forward declare this for the dma callbacks*/
|
||||
static void lpuart_dma_tx_complete(void *arg);
|
||||
|
||||
static inline u32 lpuart32_read(struct uart_port *port, u32 reg_off)
|
||||
static inline u32 lpuart32_read(struct uart_port *port, u32 off)
|
||||
{
|
||||
return ioread32be(port->membase + reg_off);
|
||||
switch (port->iotype) {
|
||||
case UPIO_MEM32:
|
||||
return readl(port->membase + off);
|
||||
case UPIO_MEM32BE:
|
||||
return ioread32be(port->membase + off);
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
static inline void lpuart32_write(struct uart_port *port, u32 val,
|
||||
u32 reg_off)
|
||||
u32 off)
|
||||
{
|
||||
iowrite32be(val, port->membase + reg_off);
|
||||
switch (port->iotype) {
|
||||
case UPIO_MEM32:
|
||||
writel(val, port->membase + off);
|
||||
break;
|
||||
case UPIO_MEM32BE:
|
||||
iowrite32be(val, port->membase + off);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static void lpuart_stop_tx(struct uart_port *port)
|
||||
|
@ -601,7 +615,7 @@ static irqreturn_t lpuart_txint(int irq, void *dev_id)
|
|||
|
||||
spin_lock_irqsave(&sport->port.lock, flags);
|
||||
if (sport->port.x_char) {
|
||||
if (sport->port.iotype & UPIO_MEM32BE)
|
||||
if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
|
||||
lpuart32_write(&sport->port, sport->port.x_char, UARTDATA);
|
||||
else
|
||||
writeb(sport->port.x_char, sport->port.membase + UARTDR);
|
||||
|
@ -609,14 +623,14 @@ static irqreturn_t lpuart_txint(int irq, void *dev_id)
|
|||
}
|
||||
|
||||
if (uart_circ_empty(xmit) || uart_tx_stopped(&sport->port)) {
|
||||
if (sport->port.iotype & UPIO_MEM32BE)
|
||||
if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
|
||||
lpuart32_stop_tx(&sport->port);
|
||||
else
|
||||
lpuart_stop_tx(&sport->port);
|
||||
goto out;
|
||||
}
|
||||
|
||||
if (sport->port.iotype & UPIO_MEM32BE)
|
||||
if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
|
||||
lpuart32_transmit_buffer(sport);
|
||||
else
|
||||
lpuart_transmit_buffer(sport);
|
||||
|
@ -1889,12 +1903,12 @@ static int __init lpuart_console_setup(struct console *co, char *options)
|
|||
if (options)
|
||||
uart_parse_options(options, &baud, &parity, &bits, &flow);
|
||||
else
|
||||
if (sport->port.iotype & UPIO_MEM32BE)
|
||||
if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
|
||||
lpuart32_console_get_options(sport, &baud, &parity, &bits);
|
||||
else
|
||||
lpuart_console_get_options(sport, &baud, &parity, &bits);
|
||||
|
||||
if (sport->port.iotype & UPIO_MEM32BE)
|
||||
if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
|
||||
lpuart32_setup_watermark(sport);
|
||||
else
|
||||
lpuart_setup_watermark(sport);
|
||||
|
@ -1953,6 +1967,7 @@ static int __init lpuart32_early_console_setup(struct earlycon_device *device,
|
|||
if (!device->port.membase)
|
||||
return -ENODEV;
|
||||
|
||||
device->port.iotype = UPIO_MEM32BE;
|
||||
device->con->write = lpuart32_early_write;
|
||||
return 0;
|
||||
}
|
||||
|
@ -2014,7 +2029,7 @@ static int lpuart_probe(struct platform_device *pdev)
|
|||
}
|
||||
sport->port.irq = ret;
|
||||
sport->port.iotype = sdata->iotype;
|
||||
if (sport->port.iotype & UPIO_MEM32BE)
|
||||
if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
|
||||
sport->port.ops = &lpuart32_pops;
|
||||
else
|
||||
sport->port.ops = &lpuart_pops;
|
||||
|
@ -2041,7 +2056,7 @@ static int lpuart_probe(struct platform_device *pdev)
|
|||
|
||||
platform_set_drvdata(pdev, &sport->port);
|
||||
|
||||
if (sport->port.iotype & UPIO_MEM32BE)
|
||||
if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
|
||||
lpuart_reg.cons = LPUART32_CONSOLE;
|
||||
else
|
||||
lpuart_reg.cons = LPUART_CONSOLE;
|
||||
|
@ -2094,7 +2109,7 @@ static int lpuart_suspend(struct device *dev)
|
|||
struct lpuart_port *sport = dev_get_drvdata(dev);
|
||||
unsigned long temp;
|
||||
|
||||
if (sport->port.iotype & UPIO_MEM32BE) {
|
||||
if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE)) {
|
||||
/* disable Rx/Tx and interrupts */
|
||||
temp = lpuart32_read(&sport->port, UARTCTRL);
|
||||
temp &= ~(UARTCTRL_TE | UARTCTRL_TIE | UARTCTRL_TCIE);
|
||||
|
@ -2145,7 +2160,7 @@ static int lpuart_resume(struct device *dev)
|
|||
if (sport->port.suspended && !sport->port.irq_wake)
|
||||
clk_prepare_enable(sport->clk);
|
||||
|
||||
if (sport->port.iotype & UPIO_MEM32BE) {
|
||||
if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE)) {
|
||||
lpuart32_setup_watermark(sport);
|
||||
temp = lpuart32_read(&sport->port, UARTCTRL);
|
||||
temp |= (UARTCTRL_RIE | UARTCTRL_TIE | UARTCTRL_RE |
|
||||
|
|
Loading…
Reference in New Issue