From mboxrd@z Thu Jan 1 00:00:00 1970 From: Bryan Wu Subject: [PATCH 2/9] Blackfin Serial Driver: Add a debug function to serial driver. Date: Fri, 17 Oct 2008 01:44:00 +0800 Message-ID: <1224179047-13073-3-git-send-email-cooloney@kernel.org> References: <1224179047-13073-1-git-send-email-cooloney@kernel.org> Return-path: Received: from ti-out-0910.google.com ([209.85.142.190]:20082 "EHLO ti-out-0910.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1757343AbYJPRoH (ORCPT ); Thu, 16 Oct 2008 13:44:07 -0400 Received: by ti-out-0910.google.com with SMTP id b6so49514tic.23 for ; Thu, 16 Oct 2008 10:44:06 -0700 (PDT) In-Reply-To: <1224179047-13073-1-git-send-email-cooloney@kernel.org> Sender: linux-serial-owner@vger.kernel.org List-Id: linux-serial@vger.kernel.org To: alan@redhat.com Cc: linux-kernel@vger.kernel.org, linux-serial@vger.kernel.org, Graf Yang , Bryan Wu From: Graf Yang Signed-off-by: Graf Yang Signed-off-by: Bryan Wu --- drivers/serial/bfin_5xx.c | 44 ++++++++++++++++++++++++++++++++++++++++++++ 1 files changed, 44 insertions(+), 0 deletions(-) diff --git a/drivers/serial/bfin_5xx.c b/drivers/serial/bfin_5xx.c index d63fad7..16b891e 100644 --- a/drivers/serial/bfin_5xx.c +++ b/drivers/serial/bfin_5xx.c @@ -21,6 +21,7 @@ #include #include #include +#include #if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \ defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE) @@ -1155,6 +1156,49 @@ struct console __init *bfin_earlyserial_init(unsigned int port, #endif /* CONFIG_SERIAL_BFIN_CONSOLE */ +#ifdef CONFIG_DEBUG_KERNEL +void bfin_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; + + if (bfin_serial_console.index < 0) + return; /* Too early. */ + + va_start(ap, fmt); + vsprintf(buf, fmt, ap); + va_end(ap); + count = strlen(buf); + + spin_lock_irqsave(&uart->port.lock, 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'); + } + } + + spin_unlock_irqrestore(&uart->port.lock, flags); +} +EXPORT_SYMBOL(bfin_serial_debug); +#endif + static struct uart_driver bfin_serial_reg = { .owner = THIS_MODULE, .driver_name = "bfin-uart", -- 1.5.6