LXR 6.1/​bsps/​m68k/​mvme162/​console/​console.c	Source navigation Diff markup Identifier search General search
	Version: 6.1 Revert   Change

File indexing completed on 2025-05-11 08:23:48

 /*
  *  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 <rtems/bspIo.h>
 #include <rtems/console.h>
 #include <rtems/libio.h>
 #include <rtems/ringbuf.h>
 #include <bsp.h>
 
 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;

This page was automatically generated by the 2.3.7 LXR engine. The LXR team