diff options
author | Daniel Hellstrom <daniel@gaisler.com> | 2012-04-19 13:34:28 -0400 |
---|---|---|
committer | Gedare Bloom <gedare@rtems.org> | 2012-04-19 13:34:28 -0400 |
commit | e621bde5744b2921c1a3d9694bbd89acce55d3a4 (patch) | |
tree | 357bc84462762d64c4c9013e6028ec3d29dc44fd /c/src/lib/libbsp/sparc/leon3/console/printk_support.c | |
parent | LEON3: added TX-wait-complete and CR on NL support for UART (diff) | |
download | rtems-e621bde5744b2921c1a3d9694bbd89acce55d3a4.tar.bz2 |
LEON3: rename console/debugputs.c to printk_support.c
Diffstat (limited to 'c/src/lib/libbsp/sparc/leon3/console/printk_support.c')
-rw-r--r-- | c/src/lib/libbsp/sparc/leon3/console/printk_support.c | 169 |
1 files changed, 169 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/sparc/leon3/console/printk_support.c b/c/src/lib/libbsp/sparc/leon3/console/printk_support.c new file mode 100644 index 0000000000..080d4fad69 --- /dev/null +++ b/c/src/lib/libbsp/sparc/leon3/console/printk_support.c @@ -0,0 +1,169 @@ +/* + * This file contains the TTY driver for the serial ports on the LEON. + * + * This driver uses the termios pseudo driver. + * + * COPYRIGHT (c) 1989-1999. + * On-Line Applications Research Corporation (OAR). + * + * Modified for LEON3 BSP. + * COPYRIGHT (c) 2011. + * Aeroflex Gaisler. + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.com/license/LICENSE. + */ + +#include <bsp.h> +#include <rtems/libio.h> +#include <stdlib.h> +#include <assert.h> +#include <stdio.h> + +/* Let user override which on-chip APBUART will be debug UART + * 0 = Default APBUART. On MP system CPU0=APBUART0, CPU1=APBUART1... + * 1 = APBUART[0] + * 2 = APBUART[1] + * 3 = APBUART[2] + * ... + */ +int debug_uart_index __attribute__((weak)) = 0; +ambapp_apb_uart *dbg_uart = NULL; + +/* Before UART driver has registered (or when no UART is available), calls to + * printk that gets to bsp_out_char() will be filling data into the + * pre_printk_dbgbuf[] buffer, hopefully the buffer can help debugging the + * early BSP boot.. At least the last printk() will be caught. + */ +char pre_printk_dbgbuf[32] = {0}; +int pre_printk_pos = 0; + +/* Initialize the BSP system debug console layer. It will scan AMBA Plu&Play + * for a debug APBUART and enable RX/TX for that UART. + */ +int bsp_debug_uart_init(void) +{ + int i; + struct ambapp_dev *adev; + struct ambapp_apb_info *apb; + + /* Update debug_uart_index to index used as debug console. + * Let user select Debug console by setting debug_uart_index. If the + * BSP is to provide the default UART (debug_uart_index==0): + * non-MP: APBUART[0] is debug console + * MP: LEON CPU index select UART + */ + if (debug_uart_index == 0) { +#if defined(RTEMS_MULTIPROCESSING) + debug_uart_index = LEON3_Cpu_Index; +#else + debug_uart_index = 0; +#endif + } else { + debug_uart_index = debug_uart_index - 1; /* User selected dbg-console */ + } + + /* Find APBUART core for System Debug Console */ + i = debug_uart_index; + adev = (void *)ambapp_for_each(&ambapp_plb, (OPTIONS_ALL|OPTIONS_APB_SLVS), + VENDOR_GAISLER, GAISLER_APBUART, + ambapp_find_by_idx, (void *)&i); + if (adev) { + /* Found a matching debug console, initialize debug uart if present + * for printk + */ + apb = (struct ambapp_apb_info *)adev->devinfo; + dbg_uart = (ambapp_apb_uart *)apb->start; + dbg_uart->ctrl |= LEON_REG_UART_CTRL_RE | LEON_REG_UART_CTRL_TE; + dbg_uart->status = 0; + return 1; + } else + return 0; +} + +/* + * apbuart_outbyte_polled + * + * This routine transmits a character using polling. + */ +void apbuart_outbyte_polled( + ambapp_apb_uart *regs, + unsigned char ch, + int do_cr_on_newline, + int wait_sent +) +{ +send: + while ( (regs->status & LEON_REG_UART_STATUS_THE) == 0 ) { + /* Lower bus utilization while waiting for UART */ + asm volatile ("nop"::); asm volatile ("nop"::); + asm volatile ("nop"::); asm volatile ("nop"::); + asm volatile ("nop"::); asm volatile ("nop"::); + asm volatile ("nop"::); asm volatile ("nop"::); + } + regs->data = (unsigned int) ch; + + if ((ch == '\n') && do_cr_on_newline) { + ch = '\r'; + goto send; + } + + /* Wait until the character has been sent? */ + if (wait_sent) { + while ((regs->status & LEON_REG_UART_STATUS_THE) == 0) + ; + } +} + +/* + * apbuart_inbyte_nonblocking + * + * This routine polls for a character. + */ +int apbuart_inbyte_nonblocking(ambapp_apb_uart *regs) +{ + /* Clear errors */ + if (regs->status & LEON_REG_UART_STATUS_ERR) + regs->status = ~LEON_REG_UART_STATUS_ERR; + + if ((regs->status & LEON_REG_UART_STATUS_DR) == 0) + return EOF; + else + return (int) regs->data; +} + +/* putchar/getchar for printk */ +static void bsp_out_char(char c) +{ + if (dbg_uart == NULL) { + /* Local debug buffer when UART driver has not registered */ + pre_printk_dbgbuf[pre_printk_pos++] = c; + pre_printk_pos = pre_printk_pos & (sizeof(pre_printk_dbgbuf)-1); + return; + } + + apbuart_outbyte_polled(dbg_uart, c, 1, 1); +} + +/* + * To support printk + */ + +#include <rtems/bspIo.h> + +BSP_output_char_function_type BSP_output_char = bsp_out_char; + +static int bsp_in_char(void) +{ + int tmp; + + if (dbg_uart == NULL) + return EOF; + + while ((tmp = apbuart_inbyte_nonblocking(dbg_uart)) < 0) + ; + return tmp; +} + +BSP_polling_getchar_function_type BSP_poll_char = bsp_in_char; |