forked from Imagelibrary/rtems
84 lines
1.9 KiB
C
84 lines
1.9 KiB
C
/*
|
|
* 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;
|