On 2/6/19 09:30, Antony Pavlov wrote: > Signed-off-by: Antony Pavlov <antonynpavlov@xxxxxxxxx> > --- > drivers/serial/Makefile | 1 + > drivers/serial/serial_litex.c | 99 +++++++++++++++++++++++++++++++++++ > 2 files changed, 100 insertions(+) > > diff --git a/drivers/serial/Makefile b/drivers/serial/Makefile > index 4174cc1ffb..fa86aa8c05 100644 > --- a/drivers/serial/Makefile > +++ b/drivers/serial/Makefile > @@ -23,3 +23,4 @@ obj-$(CONFIG_DRIVER_SERIAL_CADENCE) += serial_cadence.o > obj-$(CONFIG_DRIVER_SERIAL_EFI_STDIO) += efi-stdio.o > obj-$(CONFIG_DRIVER_SERIAL_DIGIC) += serial_digic.o > obj-$(CONFIG_DRIVER_SERIAL_LPUART) += serial_lpuart.o > +obj-$(CONFIG_MACH_LITEX) += serial_litex.o > diff --git a/drivers/serial/serial_litex.c b/drivers/serial/serial_litex.c > new file mode 100644 > index 0000000000..4a23921ac7 > --- /dev/null > +++ b/drivers/serial/serial_litex.c > @@ -0,0 +1,99 @@ > +// SPDX-License-Identifier: GPL-2. Rest of the line is missing is here. > +/* > + * Copyright (C) 2019 Antony Pavlov <antonynpavlov@xxxxxxxxx> > + * > + * This file is part of barebox. > + * See file CREDITS for list of people who contributed to this project. > + * > + */ > + > +#include <common.h> > +#include <init.h> > +#include <malloc.h> > +#include <io.h> > + > +#include <mach/debug_ll.h> left-over header? > + > +static inline uint32_t litex_serial_readb(struct console_device *cdev, > + uint32_t offset) Not a problem here, but I find it strange to have a readb that returns uint32_t. > +{ > + void __iomem *base = cdev->dev->priv; > + > + return readb(base + offset); > +} > + > +static inline void litex_serial_writeb(struct console_device *cdev, > + uint32_t value, uint32_t offset) > +{ > + void __iomem *base = cdev->dev->priv; > + > + writeb(value, base + offset); > +} > + > +static void litex_serial_putc(struct console_device *cdev, char c) > +{ > + while (litex_serial_readb(cdev, UART_TXFULL)) > + ; > + > + litex_serial_writeb(cdev, c, UART_RXTX); > +} > + > +static int litex_serial_getc(struct console_device *cdev) > +{ > + int c; > + > + while (litex_serial_readb(cdev, UART_RXEMPTY)) > + ; > + > + c = litex_serial_readb(cdev, UART_RXTX); > + > + /* refresh UART_RXEMPTY by writing UART_EV_RX to UART_EV_PENDING */ > + litex_serial_writeb(cdev, UART_EV_RX, UART_EV_PENDING); > + > + return c; > +} > + > +static int litex_serial_tstc(struct console_device *cdev) > +{ > + if (litex_serial_readb(cdev, UART_RXEMPTY)) { > + return 0; > + } > + > + return 1; return !litex_serial_readb(cdev, UART_RXEMPTY)); ? > +} > + > +static int litex_serial_probe(struct device_d *dev) > +{ > + struct resource *iores; > + struct console_device *cdev; > + > + cdev = xzalloc(sizeof(struct console_device)); > + iores = dev_request_mem_resource(dev, 0); > + if (IS_ERR(iores)) > + return PTR_ERR(iores); > + dev->priv = IOMEM(iores->start); > + cdev->dev = dev; > + cdev->tstc = &litex_serial_tstc; > + cdev->putc = &litex_serial_putc; > + cdev->getc = &litex_serial_getc; > + cdev->setbrg = NULL; > + > + console_register(cdev); > + > + return 0; > +} > + > +static __maybe_unused struct of_device_id litex_serial_dt_ids[] = { > + { > + .compatible = "litex,uart", > + }, { > + /* sentinel */ > + } > +}; > + > +static struct driver_d litex_serial_driver = { > + .name = "litex-uart", > + .probe = litex_serial_probe, > + .of_compatible = DRV_OF_COMPAT(litex_serial_dt_ids), > +}; > +console_platform_driver(litex_serial_driver); > -- Pengutronix e.K. | | Industrial Linux Solutions | http://www.pengutronix.de/ | Peiner Str. 6-8, 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 | _______________________________________________ barebox mailing list barebox@xxxxxxxxxxxxxxxxxxx http://lists.infradead.org/mailman/listinfo/barebox