From d7d66d7d4523b904c8ccc6aea3709dc0d5aa5bdc Mon Sep 17 00:00:00 2001 From: Sebastian Huber Date: Thu, 19 Apr 2018 06:28:01 +0200 Subject: bsps: Move console drivers to bsps This patch is a part of the BSP source reorganization. Update #3285. --- c/src/lib/libbsp/m68k/mvme162/console/console.c | 277 ------------------------ 1 file changed, 277 deletions(-) delete mode 100644 c/src/lib/libbsp/m68k/mvme162/console/console.c (limited to 'c/src/lib/libbsp/m68k/mvme162/console') diff --git a/c/src/lib/libbsp/m68k/mvme162/console/console.c b/c/src/lib/libbsp/m68k/mvme162/console/console.c deleted file mode 100644 index 985254d483..0000000000 --- a/c/src/lib/libbsp/m68k/mvme162/console/console.c +++ /dev/null @@ -1,277 +0,0 @@ -/* - * This file contains the MVME162 console IO package. - */ - -/* - * COPYRIGHT (c) 1989-2013. - * 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. - * - * Modifications of respective RTEMS file: COPYRIGHT (c) 1994. - * EISCAT Scientific Association. M.Savitski - * - * This material is a part of the MVME162 Board Support Package - * for the RTEMS executive. Its licensing policies are those of the - * RTEMS above. - */ - -#define M162_INIT - -#include -#include -#include -#include -#include - -Ring_buffer_t Console_Buffer[2]; - -/* - * Interrupt handler for receiver interrupts - */ -static rtems_isr C_Receive_ISR(rtems_vector_number vector) -{ - register int ipend, port; - - ZWRITE0(1, 0x38); /* reset highest IUS */ - - ipend = ZREAD(1, 3); /* read int pending from A side */ - - if (ipend == 0x04) port = 0; /* channel B intr pending */ - else if (ipend == 0x20) port = 1; /* channel A intr pending */ - else return; - - Ring_buffer_Add_character(&Console_Buffer[port], ZREADD(port)); - - if (ZREAD(port, 1) & 0x70) { /* check error stat */ - ZWRITE0(port, 0x30); /* reset error */ - } -} - -rtems_device_driver console_initialize( - rtems_device_major_number major, - rtems_device_minor_number minor, - void *arg -) -{ - int i; - rtems_status_code status; - - /* - * Initialise receiver interrupts on both ports - */ - for (i = 0; i <= 1; i++) { - Ring_buffer_Initialize( &Console_Buffer[i] ); - ZWRITE(i, 2, SCC_VECTOR); - ZWRITE(i, 10, 0); - ZWRITE(i, 1, 0x10); /* int on all Rx chars or special condition */ - ZWRITE(i, 9, 8); /* master interrupt enable */ - } - - set_vector(C_Receive_ISR, SCC_VECTOR, 1); /* install ISR for ports A and B */ - - mcchip->vector_base = 0; - mcchip->gen_control = 2; /* MIEN */ - mcchip->SCC_int_ctl = 0x13; /* SCC IEN, IPL3 */ - - status = rtems_io_register_name( - "/dev/console", - major, - (rtems_device_minor_number) 1 - ); - - if (status != RTEMS_SUCCESSFUL) - rtems_fatal_error_occurred(status); - - status = rtems_io_register_name( - "/dev/tty00", - major, - (rtems_device_minor_number) 0 - ); - - if (status != RTEMS_SUCCESSFUL) - rtems_fatal_error_occurred(status); - - status = rtems_io_register_name( - "/dev/tty01", - major, - (rtems_device_minor_number) 1 - ); - - if (status != RTEMS_SUCCESSFUL) - rtems_fatal_error_occurred(status); - - return RTEMS_SUCCESSFUL; -} - -/* - * Non-blocking char input - */ -bool char_ready(int port, char *ch) -{ - if ( Ring_buffer_Is_empty( &Console_Buffer[port] ) ) - return false; - - Ring_buffer_Remove_character( &Console_Buffer[port], *ch ); - - return true; -} - -/* - * Block on char input - */ -static char inbyte(int port) -{ - char tmp_char; - - while ( !char_ready(port, &tmp_char) ); - return tmp_char; -} - -/* - * This routine transmits a character out the SCC. It no longer supports - * XON/XOFF flow control. - */ -static void outbyte(char ch, int port) -{ - while (1) { - if (ZREAD0(port) & TX_BUFFER_EMPTY) break; - } - ZWRITED(port, ch); -} - -/* - * 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 = 0; - - rw_args = (rtems_libio_rw_args_t *) arg; - - buffer = rw_args->buffer; - maximum = rw_args->count; - - if ( minor > 1 ) - return RTEMS_INVALID_NUMBER; - - for (count = 0; count < maximum; count++) { - buffer[ count ] = inbyte( minor ); - 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; - - if ( minor > 1 ) - return RTEMS_INVALID_NUMBER; - - for (count = 0; count < maximum; count++) { - if ( buffer[ count ] == '\n') { - outbyte('\r', minor ); - } - outbyte( buffer[ count ], minor ); - } - - 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; -} - -/* - * _162Bug_output_char - * - * Output a single character using the 162Bug functions. The character - * will be written to the default output port. - */ -static void _162Bug_output_char( char c ) -{ - asm volatile( "moveb %0, -(%%sp)\n\t" /* char to output */ - "trap #15\n\t" /* Trap to 162Bug */ - ".short 0x20" /* Code for .OUTCHR */ - :: "d" (c) ); -} - -/* - * _BSP_output_char - * - * printk() function prototyped in bspIo.h. Does not use termios. - * - * If we have initialized the console device then use it, otherwise - * use the 162Bug routines to send it to the default output port. - */ -static void _BSP_output_char(char c) -{ - _162Bug_output_char(c); -} - -/* Printk function */ -BSP_output_char_function_type BSP_output_char = _BSP_output_char; -BSP_polling_getchar_function_type BSP_poll_char = NULL; -- cgit v1.2.3