/*
* This file contains the efi332 console IO package.
*
* 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.OARcorp.com/rtems/license.html.
*
* $Id$
*/
#include <stdlib.h>
#include <bsp.h>
#include <rtems/libio.h>
/* BUFFER_LENGTH must be 2^n for n=1, 2, 3, .... */
#define BUFFER_LENGTH 256
#define RTS_STOP_SIZE BUFFER_LENGTH-64
#define RTS_START_SIZE 16
char xmt_buf[BUFFER_LENGTH];
char rcv_buf[BUFFER_LENGTH];
/* in: last entry into the buffer; always on a valid character */
/* out: points to the next character to be pull from the buffer */
/* in+1=out => buffer empty */
/* in+2=out => buffer full */
struct UART_buf {
char *offset;
char *in;
char *out;
};
static volatile struct UART_buf xmt = { xmt_buf, (char *)0, (char *)1};
static volatile struct UART_buf rcv = { rcv_buf, (char *)0, (char *)1};
static volatile char _debug_flag = 0;
#define SET_RTS(a) {*PORTF0 = (*PORTF0 & ~0x4) | ( (a)? 0 : 0x4); }
#define GET_CTS (!(*PORTF0 & 0x2))
/* _catchSCIint, _catchCTSint, and _catchSPURIOUSint are the
interrupt front-ends */
extern void _catchSCIint();
asm(" .text
.align 2
.globl _catchSCIint
_catchSCIint:
moveml %d0-%d7/%a0-%a6,%sp@- /* save registers */
jbsr uart_interrupt
moveml %sp@+,%d0-%d7/%a0-%a6
rte
");
extern void _catchCTSint();
asm(" .text
.align 2
.globl _catchCTSint
_catchCTSint:
moveml %d0-%d7/%a0-%a6,%sp@- /* save registers */
jbsr cts_interrupt
moveml %sp@+,%d0-%d7/%a0-%a6
rte
");
extern void _catchSPURIOUSint();
asm(" .text
.align 2
.globl _catchSPURIOUSint
_catchSPURIOUSint:
moveml %d0-%d7/%a0-%a6,%sp@- /* save registers */
jbsr spurious_interrupt
moveml %sp@+,%d0-%d7/%a0-%a6
rte
");
int _spurious_int_counter=0;
/* note: cts uses int1. If it "bounces", a spurious interrupt is generated */
void spurious_interrupt(void) {
_spurious_int_counter++; /* there should never be alot of these */
}
/* _fake_trap_1 will continue the UART interrupt (%sr *still*
UART_ISR_LEVEL) as a trap #1 to enter the debugger */
/* *****fix me; this is for 68000 w/jsr ram exception table ******* */
asm(" .text
.align 2
_fake_trap_1:
unlk %a6 /* clear interrupt frame */
lea %sp@(4),%sp /* remove jbsr instruction */
moveml %sp@+,%d0-%d7/%a0-%a6 /* pop registers */
jmp (33*6-12) /* jump exception 1 */
");
/* dispatch UART interrupt */
void xmit_interrupt(void);
void rcvr_interrupt(void);
void _fake_trap_1(void);
void uart_interrupt(void) {
/* receiver status bits are cleared by a SCSR read followed
by a SCDR read. transmitter status bits are cleared by
a SCSR read followed by a SCDR write. */
if ((*SCSR) & (TDRE | TC))
xmit_interrupt();
if ((*SCSR) & (RDRF))
rcvr_interrupt();
if (_debug_flag) {
_debug_flag = 0; /* reset the flag */
_fake_trap_1(); /* fake a trap #1 */
}
}
/* transfer received character to the buffer */
void rcvr_interrupt(void) {
register char *a, c;
register int length;
while((*SCSR) & (RDRF)) {
if ((c=*SCDR) == 0x1a) /* use ctl-z to reboot */
reboot();
/* else if (c == 0x03) { */ /* use ctl-c to enter debugger */
/* _debug_flag = 1; */
/* continue; */
/* } */
*(char *)((int)rcv.offset +(int)
(a=(char *)(((int)rcv.in+1) & ((int)BUFFER_LENGTH-1)))) = c;
if ((char *)(((int)rcv.in+2) & ((int)BUFFER_LENGTH-1)) != rcv.out)
rcv.in=a;
};
length = (BUFFER_LENGTH -1) & (
( ((int)rcv.out <= (int)rcv.in) ? 0 : BUFFER_LENGTH) - (int)rcv.out
+ (int)rcv.in + 1);
if (length >= RTS_STOP_SIZE)
SET_RTS(0);
}
/* tranfer buffered characters to the UART */
void xmit_interrupt(void) {
register short int oldsr;
_CPU_ISR_Disable( oldsr ); /* for when outbyte or flush calls */
while ((*SCSR) & (TDRE)) {
if ((char *)(((int)xmt.in+1) & ((int)BUFFER_LENGTH-1)) != xmt.out)
/* xmit buffer not empty */
if (GET_CTS) {
/* send next char */
*SCDR=*(char *)((int)xmt.offset+(int)xmt.out);
xmt.out= (char *)(((int)xmt.out+1) & ((int)BUFFER_LENGTH-1));
*SCCR1 = (*SCCR1 & ~(TIE | TCIE)) | (TIE);
}
else {
/* configue CTS interrupt and shutdown xmit interrupts */
*SCCR1 &= ~(TIE | TCIE);
*PFPAR |= 0x2;
break;
}
else {
/* xmit buffer empty; shutdown interrupts */
*SCCR1 &= ~(TIE | TCIE);
break;
}
}
_CPU_ISR_Enable( oldsr );
}
void cts_interrupt(void) {
register short int oldsr;
_CPU_ISR_Disable( oldsr ); /* for when outbyte calls */
*PFPAR &= ~0x2;
*SCCR1 = (*SCCR1 & ~(TIE | TCIE)) | (TIE);
_CPU_ISR_Enable( oldsr );
}
/* transfer character from the buffer */
char inbyte(void) {
register char a;
register int length;
while ((char *)(((int)rcv.in+1) & ((int)BUFFER_LENGTH-1))== rcv.out);
a=*(char *)((int)rcv.offset+(int)rcv.out);
rcv.out= (char *)(((int)rcv.out+1) & ((int)BUFFER_LENGTH-1));
length = (BUFFER_LENGTH -1) & (
( ((int)rcv.out <= (int)rcv.in) ? 0 : BUFFER_LENGTH) - (int)rcv.out
+ (int)rcv.in + 1);
if (length < RTS_START_SIZE)
SET_RTS(1);
return (a);
}
/* once room is avaliable in the buffer, transfer
the character into the buffer and enable
the xmtr interrupt */
void outbyte(char c) {
register char *a;
while ((char *)(((int)xmt.in+2) & ((int)BUFFER_LENGTH-1)) == xmt.out);
*(char *)((int)xmt.offset+(int)
(a=(char *)(((int)xmt.in+1) & ((int)BUFFER_LENGTH-1))))=c;
xmt.in=a;
if (!(*SCCR1 & (TIE | TCIE)) && (!(*PFPAR & 0x2)) )
/* if neither interrupts are running, */
xmit_interrupt(); /* we need to restart the xmiter */
}
void _UART_flush(void) {
/* loop till xmt buffer empty. Works with interrupts disabled */
while ((char *)(((int)xmt.in+1) & ((int)BUFFER_LENGTH-1)) != xmt.out)
xmit_interrupt();
/* loop till UART buffer empty */
while ( (*SCSR & TC) == 0 );
}
/* console_initialize
*
* This routine initializes the console IO driver.
*
* Input parameters: NONE
*
* Output parameters: NONE
*
* Return values:
*/
void console_init()
{
*QSMCR = ( SAM(QSM_IARB,0,IARB) );
*QILR = ( SAM(ISRL_QSPI,4,ILQSPI) | SAM(ISRL_SCI,0,ILSCI) );
*QIVR = ( SAM(EFI_QIVR,0,INTV) );
*SCCR0 = ( (int)( SYS_CLOCK/SCI_BAUD/32.0+0.5 ) & 0x1fff );
*SCCR1 = ( RIE | TE | RE );
set_vector(_catchSPURIOUSint, EFI_SPINT, 0);
set_vector(_catchSCIint, EFI_QIVR, 0);
set_vector(_catchCTSint, EFI_INT1, 0);
}
rtems_device_driver console_initialize(
rtems_device_major_number major,
rtems_device_minor_number minor,
void *arg
)
{
rtems_status_code status;
status = rtems_io_register_name(
"/dev/console",
major,
(rtems_device_minor_number) 0
);
if (status != RTEMS_SUCCESSFUL)
rtems_fatal_error_occurred(status);
return RTEMS_SUCCESSFUL;
}
/* is_character_ready
*
* This routine returns TRUE if a character is available.
*
* Input parameters: NONE
*
* Output parameters: NONE
*
* Return values:
*/
rtems_boolean is_character_ready(
char *ch
)
{
if ((char *)(((int)rcv.in+1) & ((int)BUFFER_LENGTH-1))== rcv.out)
return(FALSE);
else
return(TRUE);
}
/*
* Open entry point
*/
rtems_device_driver console_open(
rtems_device_major_number major,
rtems_device_minor_number minor,
void * arg
)
{
return RTEMS_SUCCESSFUL;
}
/*
* Close entry point
*/
rtems_device_driver console_close(
rtems_device_major_number major,
rtems_device_minor_number minor,
void * arg
)
{
return RTEMS_SUCCESSFUL;
}
/*
* read bytes from the serial port. We only have stdin.
*/
rtems_device_driver console_read(
rtems_device_major_number major,
rtems_device_minor_number minor,
void * arg
)
{
rtems_libio_rw_args_t *rw_args;
char *buffer;
int maximum;
int count;
rw_args = (rtems_libio_rw_args_t *) arg;
buffer = rw_args->buffer;
maximum = rw_args->count;
for (count = 0; count < maximum; count++) {
buffer[ count ] = inbyte();
if (buffer[ count ] == '\n' || buffer[ count ] == '\r') {
buffer[ count++ ] = '\n';
break;
}
}
rw_args->bytes_moved = count;
return (count >= 0) ? RTEMS_SUCCESSFUL : RTEMS_UNSATISFIED;
}
/*
* write bytes to the serial port. Stdout and stderr are the same.
*/
rtems_device_driver console_write(
rtems_device_major_number major,
rtems_device_minor_number minor,
void * arg
)
{
int count;
int maximum;
rtems_libio_rw_args_t *rw_args;
char *buffer;
rw_args = (rtems_libio_rw_args_t *) arg;
buffer = rw_args->buffer;
maximum = rw_args->count;
for (count = 0; count < maximum; count++) {
if ( buffer[ count ] == '\n') {
outbyte('\r');
}
outbyte( buffer[ count ] );
}
rw_args->bytes_moved = maximum;
return 0;
}
/*
* IO Control entry point
*/
rtems_device_driver console_control(
rtems_device_major_number major,
rtems_device_minor_number minor,
void * arg
)
{
return RTEMS_SUCCESSFUL;
}
