forked from Imagelibrary/rtems
New file. This is a simple termios console driver which is sufficient
to do polled IO on a single port with VERY little support code.
This commit is contained in:
148
c/src/lib/libbsp/shared/console-polled.c
Normal file
148
c/src/lib/libbsp/shared/console-polled.c
Normal file
@@ -0,0 +1,148 @@
|
|||||||
|
/*
|
||||||
|
* This file contains the hardware specific portions of the TTY driver
|
||||||
|
* for the serial ports on the erc32.
|
||||||
|
*
|
||||||
|
* COPYRIGHT (c) 1989-1997.
|
||||||
|
* On-Line Applications Research Corporation (OAR).
|
||||||
|
* Copyright assigned to U.S. Government, 1994.
|
||||||
|
*
|
||||||
|
* The license and distribution terms for this file may be
|
||||||
|
* found in the file LICENSE in this distribution or at
|
||||||
|
* http://www.OARcorp.com/rtems/license.html.
|
||||||
|
*
|
||||||
|
* $Id$
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <bsp.h>
|
||||||
|
#include <rtems/libio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <assert.h>
|
||||||
|
|
||||||
|
/* external prototypes for monitor interface routines */
|
||||||
|
|
||||||
|
void console_outbyte_polled(
|
||||||
|
int port,
|
||||||
|
char ch
|
||||||
|
);
|
||||||
|
|
||||||
|
int console_inbyte_nonblocking(
|
||||||
|
int port
|
||||||
|
);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Console Termios Support Entry Points
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
int console_write_support (
|
||||||
|
int minor,
|
||||||
|
const char *bufarg,
|
||||||
|
int 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;
|
||||||
|
|
||||||
|
rtems_termios_initialize();
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Register Device Names
|
||||||
|
*/
|
||||||
|
|
||||||
|
status = rtems_io_register_name( "/dev/console", major, 0 );
|
||||||
|
if (status != RTEMS_SUCCESSFUL)
|
||||||
|
rtems_fatal_error_occurred(status);
|
||||||
|
|
||||||
|
return RTEMS_SUCCESSFUL;
|
||||||
|
}
|
||||||
|
|
||||||
|
rtems_device_driver console_open(
|
||||||
|
rtems_device_major_number major,
|
||||||
|
rtems_device_minor_number minor,
|
||||||
|
void * arg
|
||||||
|
)
|
||||||
|
{
|
||||||
|
rtems_status_code sc;
|
||||||
|
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 <= 1 );
|
||||||
|
if ( minor > 2 )
|
||||||
|
return RTEMS_INVALID_NUMBER;
|
||||||
|
|
||||||
|
sc = 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);
|
||||||
|
}
|
||||||
|
|
||||||
|
void console_reserve_resources(
|
||||||
|
rtems_configuration_table *configuration
|
||||||
|
)
|
||||||
|
{
|
||||||
|
rtems_termios_reserve_resources( configuration, 1 );
|
||||||
|
}
|
||||||
Reference in New Issue
Block a user