diff options
Diffstat (limited to 'bsps/sparc/erc32/console/debugputs.c')
-rw-r--r-- | bsps/sparc/erc32/console/debugputs.c | 83 |
1 files changed, 83 insertions, 0 deletions
diff --git a/bsps/sparc/erc32/console/debugputs.c b/bsps/sparc/erc32/console/debugputs.c new file mode 100644 index 0000000000..57c00048a5 --- /dev/null +++ b/bsps/sparc/erc32/console/debugputs.c @@ -0,0 +1,83 @@ +/* + * COPYRIGHT (c) 1989-1999. + * On-Line Applications Research Corporation (OAR). + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#include <bsp.h> +#include <rtems/libio.h> +#include <stdlib.h> + +/* + * console_outbyte_polled + * + * This routine transmits a character using polling. + */ +void console_outbyte_polled( + int port, + unsigned char ch +) +{ + if ( port == 0 ) { + while ( (ERC32_MEC.UART_Status & ERC32_MEC_UART_STATUS_THEA) == 0 ); + ERC32_MEC.UART_Channel_A = (unsigned int) ch; + return; + } + + while ( (ERC32_MEC.UART_Status & ERC32_MEC_UART_STATUS_THEB) == 0 ); + ERC32_MEC.UART_Channel_B = (unsigned int) ch; +} + +/* + * console_inbyte_nonblocking + * + * This routine polls for a character. + */ +int console_inbyte_nonblocking( int port ) +{ + int UStat; + + UStat = ERC32_MEC.UART_Status; + + switch (port) { + + case 0: + if (UStat & ERC32_MEC_UART_STATUS_ERRA) { + ERC32_MEC.UART_Status = ERC32_MEC_UART_STATUS_CLRA; + ERC32_MEC.Control = ERC32_MEC.Control; + } + + if ((UStat & ERC32_MEC_UART_STATUS_DRA) == 0) + return -1; + return (int) ERC32_MEC.UART_Channel_A; + + case 1: + if (UStat & ERC32_MEC_UART_STATUS_ERRB) { + ERC32_MEC.UART_Status = ERC32_MEC_UART_STATUS_CLRB; + ERC32_MEC.Control = ERC32_MEC.Control; + } + + if ((UStat & ERC32_MEC_UART_STATUS_DRB) == 0) + return -1; + return (int) ERC32_MEC.UART_Channel_B; + + default: + rtems_fatal_error_occurred( 'D' << 8 | (port & 0xffffff) ); + } + + return -1; +} + +/* + * To support printk + */ + +#include <rtems/bspIo.h> + +static void BSP_output_char_f(char c) { console_outbyte_polled( 0, c ); } + +BSP_output_char_function_type BSP_output_char = BSP_output_char_f; +BSP_polling_getchar_function_type BSP_poll_char = NULL; |