diff --git a/drivers/serial/Kconfig b/drivers/serial/Kconfig index 02bc8bfdb..32b033fbe 100644 --- a/drivers/serial/Kconfig +++ b/drivers/serial/Kconfig @@ -105,4 +105,11 @@ config DRIVER_SERIAL_PXA bool "PXA serial driver" depends on ARCH_PXA +config DRIVER_SERIAL_OMAP4_USBBOOT + bool "serial driver over omap4 usb" + default n + depends on OMAP4_USBBOOT + help + Enable this to get console support over the usb bus used to boot an OMAP4 + endmenu diff --git a/drivers/serial/Makefile b/drivers/serial/Makefile index e6f1e2261..893e282c6 100644 --- a/drivers/serial/Makefile +++ b/drivers/serial/Makefile @@ -20,3 +20,4 @@ obj-$(CONFIG_DRIVER_SERIAL_S3C) += serial_s3c.o obj-$(CONFIG_DRIVER_SERIAL_ALTERA) += serial_altera.o obj-$(CONFIG_DRIVER_SERIAL_ALTERA_JTAG) += serial_altera_jtag.o obj-$(CONFIG_DRIVER_SERIAL_PXA) += serial_pxa.o +obj-$(CONFIG_DRIVER_SERIAL_OMAP4_USBBOOT) += serial_omap4_usbboot.o diff --git a/drivers/serial/serial_omap4_usbboot.c b/drivers/serial/serial_omap4_usbboot.c new file mode 100644 index 000000000..f0a2fd164 --- /dev/null +++ b/drivers/serial/serial_omap4_usbboot.c @@ -0,0 +1,83 @@ +/* + * 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. + */ + +#include +#include +#include +#include +#include + +struct serial_omap4_usbboot_priv { + struct console_device cdev; + u32 val; +}; + +static void serial_omap4_usbboot_putc(struct console_device *cdev, char c) +{ + unsigned b = c; + omap4_usbboot_write(&b, 4); +} + +static int serial_omap4_usbboot_tstc(struct console_device *cdev) +{ + struct serial_omap4_usbboot_priv *priv = + container_of(cdev, struct serial_omap4_usbboot_priv, cdev); + if (omap4_usbboot_is_read_waiting()) + return 0; + else if (omap4_usbboot_is_read_ok()) + return 1; + omap4_usbboot_queue_read(&priv->val, 4); + udelay(100); + if (omap4_usbboot_is_read_waiting()) + return 0; + else if (omap4_usbboot_is_read_ok()) + return 1; + return 0; +} + +static int serial_omap4_usbboot_getc(struct console_device *cdev) +{ + struct serial_omap4_usbboot_priv *priv = + container_of(cdev, struct serial_omap4_usbboot_priv, cdev); + if (omap4_usbboot_is_read_waiting() || omap4_usbboot_is_read_ok()) { + omap4_usbboot_wait_read(); + return priv->val; + } + omap4_usbboot_read(&priv->val, 4); + return priv->val; +} + +static int serial_omap4_usbboot_probe(struct device_d *dev) +{ + struct serial_omap4_usbboot_priv *priv; + priv = xzalloc(sizeof(*priv)); + + priv->cdev.dev = dev; + priv->cdev.f_caps = CONSOLE_STDIN | CONSOLE_STDOUT | CONSOLE_STDERR; + priv->cdev.tstc = serial_omap4_usbboot_tstc; + priv->cdev.putc = serial_omap4_usbboot_putc; + priv->cdev.getc = serial_omap4_usbboot_getc; + priv->cdev.setbrg = NULL; + + return console_register(&priv->cdev); +} + +static struct driver_d serial_omap4_usbboot_driver = { + .name = "serial_omap4_usbboot", + .probe = serial_omap4_usbboot_probe, +}; + +static int serial_omap4_usbboot_init(void) +{ + return platform_driver_register(&serial_omap4_usbboot_driver); +} +console_initcall(serial_omap4_usbboot_init);