forked from Imagelibrary/rtems
144 lines
3.1 KiB
C
144 lines
3.1 KiB
C
/*
|
|
* This file contains the hardware independent portion of a polled
|
|
* console device driver. If a BSP chooses to use this, then it
|
|
* only has to provide a few board dependent routines.
|
|
*/
|
|
|
|
/*
|
|
* COPYRIGHT (c) 1989-1997.
|
|
* 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.
|
|
*/
|
|
|
|
#include <bsp.h>
|
|
#include <rtems/libio.h>
|
|
#include <stdlib.h>
|
|
#include <assert.h>
|
|
|
|
#include <bsp/console-polled.h>
|
|
#include <bsp/fatal.h>
|
|
#include <rtems/console.h>
|
|
|
|
/*
|
|
* Prototypes
|
|
*/
|
|
ssize_t console_write_support(int, const char *, size_t);
|
|
|
|
/*
|
|
* Console Termios Support Entry Points
|
|
*
|
|
*/
|
|
ssize_t console_write_support (
|
|
int minor,
|
|
const char *bufarg,
|
|
size_t len
|
|
)
|
|
{
|
|
int nwrite = 0;
|
|
const char *buf = bufarg;
|
|
|
|
while (nwrite < len) {
|
|
console_outbyte_polled( minor, *buf++ );
|
|
nwrite++;
|
|
}
|
|
return nwrite;
|
|
}
|
|
|
|
/*
|
|
* Console Device Driver Entry Points
|
|
*
|
|
*/
|
|
|
|
rtems_device_driver console_initialize(
|
|
rtems_device_major_number major,
|
|
rtems_device_minor_number minor,
|
|
void *arg
|
|
)
|
|
{
|
|
rtems_status_code status;
|
|
|
|
/*
|
|
* Ensure Termios is initialized
|
|
*/
|
|
rtems_termios_initialize();
|
|
|
|
/*
|
|
* Make sure the hardware is initialized.
|
|
*/
|
|
console_initialize_hardware();
|
|
|
|
/*
|
|
* Register Device Names
|
|
*/
|
|
status = rtems_io_register_name( "/dev/console", major, 0 );
|
|
if (status != RTEMS_SUCCESSFUL)
|
|
rtems_fatal_error_occurred(BSP_FATAL_CONSOLE_REGISTER_DEV_2);
|
|
|
|
return RTEMS_SUCCESSFUL;
|
|
}
|
|
|
|
rtems_device_driver console_open(
|
|
rtems_device_major_number major,
|
|
rtems_device_minor_number minor,
|
|
void * arg
|
|
)
|
|
{
|
|
static const rtems_termios_callbacks pollCallbacks = {
|
|
NULL, /* firstOpen */
|
|
NULL, /* lastClose */
|
|
console_inbyte_nonblocking, /* pollRead */
|
|
console_write_support, /* write */
|
|
NULL, /* setAttributes */
|
|
NULL, /* stopRemoteTx */
|
|
NULL, /* startRemoteTx */
|
|
0 /* outputUsesInterrupts */
|
|
};
|
|
|
|
assert( minor == 0 );
|
|
if ( minor != 0 )
|
|
return RTEMS_INVALID_NUMBER;
|
|
|
|
rtems_termios_open( major, minor, arg, &pollCallbacks );
|
|
|
|
return RTEMS_SUCCESSFUL;
|
|
}
|
|
|
|
rtems_device_driver console_close(
|
|
rtems_device_major_number major,
|
|
rtems_device_minor_number minor,
|
|
void * arg
|
|
)
|
|
{
|
|
return rtems_termios_close( arg );
|
|
}
|
|
|
|
rtems_device_driver console_read(
|
|
rtems_device_major_number major,
|
|
rtems_device_minor_number minor,
|
|
void * arg
|
|
)
|
|
{
|
|
return rtems_termios_read( arg );
|
|
}
|
|
|
|
rtems_device_driver console_write(
|
|
rtems_device_major_number major,
|
|
rtems_device_minor_number minor,
|
|
void * arg
|
|
)
|
|
{
|
|
return rtems_termios_write( arg );
|
|
}
|
|
|
|
rtems_device_driver console_control(
|
|
rtems_device_major_number major,
|
|
rtems_device_minor_number minor,
|
|
void * arg
|
|
)
|
|
{
|
|
return rtems_termios_ioctl( arg );
|
|
}
|