LXR 6.1/​bsps/​m68k/​mvme147/​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

 /* SPDX-License-Identifier: BSD-2-Clause */
 
 /*
  *  This file contains the MVME147 console IO package.
  */
 
 /*
  *  COPYRIGHT (c) 1989-1999.
  *  On-Line Applications Research Corporation (OAR).
  *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
  * are met:
  * 1. Redistributions of source code must retain the above copyright
  *    notice, this list of conditions and the following disclaimer.
  * 2. Redistributions in binary form must reproduce the above copyright
  *    notice, this list of conditions and the following disclaimer in the
  *    documentation and/or other materials provided with the distribution.
  *
  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  * POSSIBILITY OF SUCH DAMAGE.
  *
  *  MVME147 port for TNI - Telecom Bretagne
  *  by Dominique LE CAMPION (Dominique.LECAMPION@enst-bretagne.fr)
  *  May 1996
  *
  *  This file was taken from the DMV152 bsp
  */
 
 #define M147_INIT
 
 #include <rtems/console.h>
 #include <rtems/libio.h>
 #include <rtems/zilog/z8530.h>
 #include <rtems/iosupp.h>
 #include <bsp.h>
 
 /*  console_initialize
  *
  *  This routine initializes the console IO driver.
  */
 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;
 }
 
 /*  inbyte
  *
  *  This routine reads a character from the SCC.
  */
 static char inbyte( void )
 {
   uint8_t         rr_0;
   char ch;
 
   for ( ; ; ) {
     Z8x30_READ_CONTROL( CONSOLE_CONTROL, RR_0, rr_0 );
     if ( (rr_0 & RR_0_RX_DATA_AVAILABLE) != 0 )
       break;
   }
 
   Z8x30_READ_DATA( CONSOLE_DATA, ch );
   return ( ch );
 }
 
 /*  outbyte
  *
  *  This routine transmits a character out the SCC.  It supports
  *  XON/XOFF flow control.
  */
 static void outbyte(
   char ch
 )
 {
   uint8_t         rr_0;
   char            flow_control;
 
   for ( ; ; ) {
     Z8x30_READ_CONTROL( CONSOLE_CONTROL, RR_0, rr_0 );
     if ( (rr_0 & RR_0_TX_BUFFER_EMPTY) != 0 )
       break;
   }
 
   for ( ; ; ) {
     Z8x30_READ_CONTROL( CONSOLE_CONTROL, RR_0, rr_0 );
     if ( (rr_0 & RR_0_RX_DATA_AVAILABLE) == 0 )
       break;
 
     Z8x30_READ_DATA( CONSOLE_DATA, flow_control );
 
     if ( flow_control == XOFF )
       do {
         do {
           Z8x30_READ_CONTROL( CONSOLE_CONTROL, RR_0, rr_0 );
         } while ( (rr_0 & RR_0_RX_DATA_AVAILABLE) == 0 );
         Z8x30_READ_DATA( CONSOLE_DATA, flow_control );
       } while ( flow_control != XON );
   }
 
   Z8x30_WRITE_DATA( CONSOLE_DATA, 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;
 
   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;
 }

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