Back to home page

LXR

 
 

    


File indexing completed on 2025-05-11 08:22:49

0001 /* SPDX-License-Identifier: BSD-2-Clause */
0002 
0003 /*
0004  * Copyright (C) 2020 embedded brains GmbH & Co. KG
0005  *
0006  * Redistribution and use in source and binary forms, with or without
0007  * modification, are permitted provided that the following conditions
0008  * are met:
0009  * 1. Redistributions of source code must retain the above copyright
0010  *    notice, this list of conditions and the following disclaimer.
0011  * 2. Redistributions in binary form must reproduce the above copyright
0012  *    notice, this list of conditions and the following disclaimer in the
0013  *    documentation and/or other materials provided with the distribution.
0014  *
0015  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
0016  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
0017  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
0018  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
0019  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
0020  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
0021  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
0022  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
0023  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
0024  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
0025  * POSSIBILITY OF SUCH DAMAGE.
0026  */
0027 
0028 #ifdef HAVE_CONFIG_H
0029 #include "config.h"
0030 #endif
0031 
0032 #include <bsp/semihosting.h>
0033 
0034 #include <rtems/console.h>
0035 #include <rtems/termiostypes.h>
0036 
0037 static rtems_termios_device_context arm_fvp_console_instance;
0038 
0039 static void arm_fvp_console_write(
0040   rtems_termios_device_context *ctx,
0041   const char                   *buf,
0042   size_t                        len
0043 )
0044 {
0045   size_t i;
0046 
0047   (void) ctx;
0048 
0049   for ( i = 0; i < len; ++i ) {
0050     arm_fvp_console_output( buf[ i ] );
0051   }
0052 }
0053 
0054 static int arm_fvp_console_read( rtems_termios_device_context *ctx )
0055 {
0056   (void) ctx;
0057 
0058   return arm_fvp_console_input();
0059 }
0060 
0061 static const rtems_termios_device_handler arm_fvp_console_handler = {
0062   .write = arm_fvp_console_write,
0063   .poll_read = arm_fvp_console_read,
0064   .mode = TERMIOS_POLLED
0065 };
0066 
0067 rtems_status_code console_initialize(
0068   rtems_device_major_number major,
0069   rtems_device_minor_number minor,
0070   void *arg
0071 )
0072 {
0073   rtems_termios_initialize();
0074 
0075   (void) rtems_termios_device_install(
0076     CONSOLE_DEVICE_NAME,
0077     &arm_fvp_console_handler,
0078     NULL,
0079     &arm_fvp_console_instance
0080   );
0081 
0082   return RTEMS_SUCCESSFUL;
0083 }