On 04/03/2011 11:07 PM, franck.jullien@gmail.com wrote: > From: Franck JULLIEN > > This patch adds Altera UART driver. Kconfig and Makefile are > updated to include this new driver. I cannot test the driver as I don't have the hardware, but it code looks good. > > Signed-off-by: Franck JULLIEN Acked-by: Marc Kleine-Budde Marc > --- > drivers/serial/Kconfig | 5 ++ > drivers/serial/Makefile | 3 +- > drivers/serial/serial_altera.c | 95 ++++++++++++++++++++++++++++++++++++++++ > 3 files changed, 102 insertions(+), 1 deletions(-) > create mode 100644 drivers/serial/serial_altera.c > > diff --git a/drivers/serial/Kconfig b/drivers/serial/Kconfig > index ffd877a..9e05f4b 100644 > --- a/drivers/serial/Kconfig > +++ b/drivers/serial/Kconfig > @@ -43,6 +43,11 @@ config DRIVER_SERIAL_BLACKFIN > default y > bool "Blackfin serial driver" > > +config DRIVER_SERIAL_ALTERA > + depends on NIOS2 > + default y > + bool "Altera serial driver" > + > config DRIVER_SERIAL_NS16550 > default n > bool "NS16550 serial driver" > diff --git a/drivers/serial/Makefile b/drivers/serial/Makefile > index 9f0e12b..df9e705 100644 > --- a/drivers/serial/Makefile > +++ b/drivers/serial/Makefile > @@ -5,7 +5,7 @@ > # serial_pl010.o > # serial_xuartlite.o > obj-$(CONFIG_DRIVER_SERIAL_ARM_DCC) += arm_dcc.o > -obj-$(CONFIG_SERIAL_AMBA_PL011) += amba-pl011.o > +obj-$(CONFIG_SERIAL_AMBA_PL011) += amba-pl011.o > obj-$(CONFIG_DRIVER_SERIAL_IMX) += serial_imx.o > obj-$(CONFIG_DRIVER_SERIAL_STM378X) += stm-serial.o > obj-$(CONFIG_DRIVER_SERIAL_ATMEL) += atmel.o > @@ -16,3 +16,4 @@ obj-$(CONFIG_DRIVER_SERIAL_BLACKFIN) += serial_blackfin.o > obj-$(CONFIG_DRIVER_SERIAL_NS16550) += serial_ns16550.o > obj-$(CONFIG_DRIVER_SERIAL_PL010) += serial_pl010.o > obj-$(CONFIG_DRIVER_SERIAL_S3C24X0) += serial_s3c24x0.o > +obj-$(CONFIG_DRIVER_SERIAL_ALTERA) += serial_altera.o > diff --git a/drivers/serial/serial_altera.c b/drivers/serial/serial_altera.c > new file mode 100644 > index 0000000..54c7178 > --- /dev/null > +++ b/drivers/serial/serial_altera.c > @@ -0,0 +1,95 @@ > +/* > + * (C) Copyright 2011, Franck JULLIEN, > + * > + * See file CREDITS for list of people who contributed to this > + * project. > + * > + * This program is free software; you can redistribute it and/or > + * modify it under the terms of the GNU General Public License as > + * published by the Free Software Foundation; either version 2 of > + * the License, or (at your option) any later version. > + * > + * This program is distributed in the hope that it will be useful, > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > + * GNU General Public License for more details. > + * > + * You should have received a copy of the GNU General Public License > + * along with this program; if not, write to the Free Software > + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, > + * MA 02111-1307 USA > + */ > + > +#include > +#include > +#include > +#include > +#include > +#include > + > +static int altera_serial_setbaudrate(struct console_device *cdev, int baudrate) > +{ > + struct nios_uart *uart = (struct nios_uart *)cdev->dev->map_base; > + uint16_t div; > + > + div = (CPU_FREQ / baudrate) - 1; > + writew(div, &uart->divisor); > + > + return 0; > +} > + > +static void altera_serial_putc(struct console_device *cdev, char c) > +{ > + struct nios_uart *uart = (struct nios_uart *)cdev->dev->map_base; > + > + while ((readw(&uart->status) & NIOS_UART_TRDY) == 0); > + > + writew(c, &uart->txdata); > +} > + > +static int altera_serial_tstc(struct console_device *cdev) > +{ > + struct nios_uart *uart = (struct nios_uart *)cdev->dev->map_base; > + > + return readw(&uart->status) & NIOS_UART_RRDY; > +} > + > +static int altera_serial_getc(struct console_device *cdev) > +{ > + struct nios_uart *uart = (struct nios_uart *)cdev->dev->map_base; > + > + while (altera_serial_tstc(cdev) == 0); > + > + return readw(&uart->rxdata) & 0x000000FF; > +} > + > +static int altera_serial_probe(struct device_d *dev) > +{ > + struct console_device *cdev; > + > + cdev = xmalloc(sizeof(struct console_device)); > + dev->type_data = cdev; > + cdev->dev = dev; > + cdev->f_caps = CONSOLE_STDIN | CONSOLE_STDOUT | CONSOLE_STDERR; > + cdev->tstc = altera_serial_tstc; > + cdev->putc = altera_serial_putc; > + cdev->getc = altera_serial_getc; > + cdev->setbrg = altera_serial_setbaudrate; > + > + console_register(cdev); > + > + return 0; > +} > + > +static struct driver_d altera_serial_driver = { > + .name = "altera_serial", > + .probe = altera_serial_probe, > +}; > + > +static int altera_serial_init(void) > +{ > + return register_driver(&altera_serial_driver); > +} > + > +console_initcall(altera_serial_init); > + -- Pengutronix e.K. | Marc Kleine-Budde | Industrial Linux Solutions | Phone: +49-231-2826-924 | Vertretung West/Dortmund | Fax: +49-5121-206917-5555 | Amtsgericht Hildesheim, HRA 2686 | http://www.pengutronix.de |