Messages in this thread Patch in this message | | | From | Bryan Wu <> | Subject | [PATCH 15/18] Blackfin Serial Driver: merge the upstream adeos/xenomai | Date | Fri, 6 Mar 2009 14:42:57 +0800 |
| |
From: Philippe Gerum <rpm@xenomai.org>
add ipipe serial debug function for adeos
Signed-off-by: Philippe Gerum <rpm@xenomai.org> Signed-off-by: Bryan Wu <cooloney@kernel.org> --- drivers/serial/bfin_5xx.c | 45 +++++++++++++++++++++++++++++++++++++++++++++ 1 files changed, 45 insertions(+), 0 deletions(-)
diff --git a/drivers/serial/bfin_5xx.c b/drivers/serial/bfin_5xx.c index 71a9e6b..8aa0e37 100644 --- a/drivers/serial/bfin_5xx.c +++ b/drivers/serial/bfin_5xx.c @@ -1145,6 +1145,51 @@ static void bfin_serial_console_putchar(struct uart_port *port, int ch) SSYNC(); } +#ifdef CONFIG_IPIPE + +#include <stdarg.h> + +void __ipipe_serial_debug(const char *fmt, ...) +{ + struct bfin_serial_port *uart = &bfin_serial_ports[0]; + unsigned short status, tmp; + int flags, i, count; + char buf[128]; + va_list ap; + + va_start(ap, fmt); + vsprintf(buf, fmt, ap); + va_end(ap); + count = strlen(buf); + + local_irq_save_hw(flags); + + for (i = 0; i < count; i++) { + do { + status = UART_GET_LSR(uart); + } while (!(status & THRE)); + +#ifndef CONFIG_BF54x + tmp = UART_GET_LCR(uart); + tmp &= ~DLAB; + UART_PUT_LCR(uart, tmp); +#endif + + UART_PUT_CHAR(uart, buf[i]); + if (buf[i] == '\n') { + do { + status = UART_GET_LSR(uart); + } while (!(status & THRE)); + UART_PUT_CHAR(uart, '\r'); + } + } + + local_irq_restore_hw(flags); +} +EXPORT_SYMBOL(__ipipe_serial_debug); + +#endif /* CONFIG_IPIPE */ + /* * Interrupts are disabled on entering */ -- 1.5.6.3
| |