/*
|
/*
|
* This file contains the template for a console IO package.
|
* This file contains the template for a console IO package.
|
*
|
*
|
* COPYRIGHT (c) 1989-1997.
|
* COPYRIGHT (c) 1989-1997.
|
* On-Line Applications Research Corporation (OAR).
|
* On-Line Applications Research Corporation (OAR).
|
* Copyright assigned to U.S. Government, 1994.
|
* Copyright assigned to U.S. Government, 1994.
|
*
|
*
|
* The license and distribution terms for this file may in
|
* The license and distribution terms for this file may in
|
* the file LICENSE in this distribution or at
|
* the file LICENSE in this distribution or at
|
* http://www.OARcorp.com/rtems/license.html.
|
* http://www.OARcorp.com/rtems/license.html.
|
*
|
*
|
* $Id: console.c,v 1.2 2001-09-27 11:59:58 chris Exp $
|
* $Id: console.c,v 1.2 2001-09-27 11:59:58 chris Exp $
|
*/
|
*/
|
|
|
#define NO_BSP_INIT
|
#define NO_BSP_INIT
|
|
|
|
|
/* only one of the following can be defined */
|
/* only one of the following can be defined */
|
#define SERIAL_INPUT /* use serial input */
|
#define SERIAL_INPUT /* use serial input */
|
|
|
#include <bsp.h>
|
#include <bsp.h>
|
#include <rtems/libio.h>
|
#include <rtems/libio.h>
|
#include "concntl.h"
|
#include "concntl.h"
|
/* #include "pcimsgreg.h" XXX JRS */
|
/* #include "pcimsgreg.h" XXX JRS */
|
|
|
#ifndef lint
|
#ifndef lint
|
static char _sccsid[] = "@(#)console.c 09/12/96 1.13\n";
|
static char _sccsid[] = "@(#)console.c 09/12/96 1.13\n";
|
#endif
|
#endif
|
|
|
/* console_initialize
|
/* console_initialize
|
*
|
*
|
* This routine initializes the console IO driver.
|
* This routine initializes the console IO driver.
|
*
|
*
|
* Input parameters: NONE
|
* Input parameters: NONE
|
*
|
*
|
* Output parameters: NONE
|
* Output parameters: NONE
|
*
|
*
|
* Return values:
|
* Return values:
|
*/
|
*/
|
|
|
rtems_device_driver console_initialize(
|
rtems_device_driver console_initialize(
|
rtems_device_major_number major,
|
rtems_device_major_number major,
|
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
void *arg
|
void *arg
|
)
|
)
|
{
|
{
|
rtems_status_code status;
|
rtems_status_code status;
|
|
|
if ( console_pmr_init(*(unsigned32*)arg) )
|
if ( console_pmr_init(*(unsigned32*)arg) )
|
return RTEMS_INVALID_NUMBER;
|
return RTEMS_INVALID_NUMBER;
|
|
|
|
|
status = rtems_io_register_name(
|
status = rtems_io_register_name(
|
"/dev/console",
|
"/dev/console",
|
major,
|
major,
|
(rtems_device_minor_number) 0
|
(rtems_device_minor_number) 0
|
);
|
);
|
|
|
if (status != RTEMS_SUCCESSFUL)
|
if (status != RTEMS_SUCCESSFUL)
|
rtems_fatal_error_occurred(status);
|
rtems_fatal_error_occurred(status);
|
|
|
return RTEMS_SUCCESSFUL;
|
return RTEMS_SUCCESSFUL;
|
}
|
}
|
|
|
|
|
/* is_character_ready
|
/* is_character_ready
|
*
|
*
|
* This routine returns TRUE if a character is available.
|
* This routine returns TRUE if a character is available.
|
*
|
*
|
* Input parameters: NONE
|
* Input parameters: NONE
|
*
|
*
|
* Output parameters: NONE
|
* Output parameters: NONE
|
*
|
*
|
* Return values:
|
* Return values:
|
*/
|
*/
|
|
|
rtems_boolean is_character_ready(
|
rtems_boolean is_character_ready(
|
char *ch
|
char *ch
|
)
|
)
|
{
|
{
|
*ch = '\0'; /* return NULL for no particular reason */
|
*ch = '\0'; /* return NULL for no particular reason */
|
return(console_pmr_kbhit());
|
return(console_pmr_kbhit());
|
}
|
}
|
|
|
/* inbyte
|
/* inbyte
|
*
|
*
|
* This routine reads a character from the SOURCE.
|
* This routine reads a character from the SOURCE.
|
*
|
*
|
* Input parameters: NONE
|
* Input parameters: NONE
|
*
|
*
|
* Output parameters: NONE
|
* Output parameters: NONE
|
*
|
*
|
* Return values:
|
* Return values:
|
* character read from SOURCE
|
* character read from SOURCE
|
*/
|
*/
|
|
|
char inbyte( unsigned int minor )
|
char inbyte( unsigned int minor )
|
{
|
{
|
/*
|
/*
|
* If polling, wait until a character is available.
|
* If polling, wait until a character is available.
|
*/
|
*/
|
return console_pmr_getc();
|
return console_pmr_getc();
|
}
|
}
|
|
|
/* outbyte
|
/* outbyte
|
*
|
*
|
* This routine transmits a character out the SOURCE. It may support
|
* This routine transmits a character out the SOURCE. It may support
|
* XON/XOFF flow control.
|
* XON/XOFF flow control.
|
*
|
*
|
* Input parameters:
|
* Input parameters:
|
* ch - character to be transmitted
|
* ch - character to be transmitted
|
*
|
*
|
* Output parameters: NONE
|
* Output parameters: NONE
|
*/
|
*/
|
|
|
void outbyte( unsigned int minor,
|
void outbyte( unsigned int minor,
|
char ch
|
char ch
|
)
|
)
|
{
|
{
|
console_pmr_putc( ch );
|
console_pmr_putc( ch );
|
|
|
/*
|
/*
|
* Carriage Return/New line translation.
|
* Carriage Return/New line translation.
|
*/
|
*/
|
|
|
if ( ch == '\n' )
|
if ( ch == '\n' )
|
outbyte( minor, '\r' );
|
outbyte( minor, '\r' );
|
}
|
}
|
|
|
|
|
/*
|
/*
|
* Open entry point
|
* Open entry point
|
*/
|
*/
|
|
|
rtems_device_driver console_open(
|
rtems_device_driver console_open(
|
rtems_device_major_number major,
|
rtems_device_major_number major,
|
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
void * arg
|
void * arg
|
)
|
)
|
{
|
{
|
return RTEMS_SUCCESSFUL;
|
return RTEMS_SUCCESSFUL;
|
}
|
}
|
|
|
/*
|
/*
|
* Close entry point
|
* Close entry point
|
*/
|
*/
|
|
|
rtems_device_driver console_close(
|
rtems_device_driver console_close(
|
rtems_device_major_number major,
|
rtems_device_major_number major,
|
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
void * arg
|
void * arg
|
)
|
)
|
{
|
{
|
return RTEMS_SUCCESSFUL;
|
return RTEMS_SUCCESSFUL;
|
}
|
}
|
|
|
/*
|
/*
|
* read bytes from the serial port. We only have stdin.
|
* read bytes from the serial port. We only have stdin.
|
*/
|
*/
|
|
|
rtems_device_driver console_read(
|
rtems_device_driver console_read(
|
rtems_device_major_number major,
|
rtems_device_major_number major,
|
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
void * arg
|
void * arg
|
)
|
)
|
{
|
{
|
rtems_libio_rw_args_t *rw_args;
|
rtems_libio_rw_args_t *rw_args;
|
unsigned8 *buffer;
|
unsigned8 *buffer;
|
unsigned32 maximum;
|
unsigned32 maximum;
|
unsigned32 count = 0;
|
unsigned32 count = 0;
|
|
|
rw_args = (rtems_libio_rw_args_t *) arg;
|
rw_args = (rtems_libio_rw_args_t *) arg;
|
|
|
buffer = rw_args->buffer;
|
buffer = rw_args->buffer;
|
maximum = rw_args->count;
|
maximum = rw_args->count;
|
|
|
for (count = 0; count < maximum; count++) {
|
for (count = 0; count < maximum; count++) {
|
buffer[ count ] = inbyte(minor);
|
buffer[ count ] = inbyte(minor);
|
if (buffer[ count ] == '\n' || buffer[ count ] == '\r') {
|
if (buffer[ count ] == '\n' || buffer[ count ] == '\r') {
|
buffer[ count++ ] = '\n';
|
buffer[ count++ ] = '\n';
|
buffer[ count ] = 0;
|
buffer[ count ] = 0;
|
outbyte( minor, '\n' ); /* newline */
|
outbyte( minor, '\n' ); /* newline */
|
break;
|
break;
|
}
|
}
|
else if (buffer[ count ] == '\b' && count > 0 )
|
else if (buffer[ count ] == '\b' && count > 0 )
|
{
|
{
|
outbyte( minor, '\b' ); /* move back one space */
|
outbyte( minor, '\b' ); /* move back one space */
|
outbyte( minor, ' ' ); /* erase the character */
|
outbyte( minor, ' ' ); /* erase the character */
|
outbyte( minor, '\b' ); /* move back one space */
|
outbyte( minor, '\b' ); /* move back one space */
|
count-=2;
|
count-=2;
|
}
|
}
|
else
|
else
|
outbyte( minor, buffer[ count ] ); /* echo the character */
|
outbyte( minor, buffer[ count ] ); /* echo the character */
|
}
|
}
|
|
|
rw_args->bytes_moved = count;
|
rw_args->bytes_moved = count;
|
return (count > 0) ? RTEMS_SUCCESSFUL : RTEMS_UNSATISFIED;
|
return (count > 0) ? RTEMS_SUCCESSFUL : RTEMS_UNSATISFIED;
|
}
|
}
|
|
|
/*
|
/*
|
* write bytes to the serial port. Stdout and stderr are the same.
|
* write bytes to the serial port. Stdout and stderr are the same.
|
*/
|
*/
|
|
|
rtems_device_driver console_write(
|
rtems_device_driver console_write(
|
rtems_device_major_number major,
|
rtems_device_major_number major,
|
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
void * arg
|
void * arg
|
)
|
)
|
{
|
{
|
int count;
|
int count;
|
int maximum;
|
int maximum;
|
rtems_libio_rw_args_t *rw_args;
|
rtems_libio_rw_args_t *rw_args;
|
unsigned8 *buffer;
|
unsigned8 *buffer;
|
|
|
rw_args = (rtems_libio_rw_args_t *) arg;
|
rw_args = (rtems_libio_rw_args_t *) arg;
|
|
|
buffer = rw_args->buffer;
|
buffer = rw_args->buffer;
|
maximum = rw_args->count;
|
maximum = rw_args->count;
|
|
|
for (count = 0; count < maximum; count++) {
|
for (count = 0; count < maximum; count++) {
|
if ( buffer[ count ] == '\n') {
|
if ( buffer[ count ] == '\n') {
|
outbyte(minor,'\r');
|
outbyte(minor,'\r');
|
}
|
}
|
outbyte( minor,buffer[ count ] );
|
outbyte( minor,buffer[ count ] );
|
}
|
}
|
|
|
rw_args->bytes_moved = maximum;
|
rw_args->bytes_moved = maximum;
|
return 0;
|
return 0;
|
}
|
}
|
|
|
/*
|
/*
|
* IO Control entry point
|
* IO Control entry point
|
*/
|
*/
|
|
|
rtems_device_driver console_control(
|
rtems_device_driver console_control(
|
rtems_device_major_number major,
|
rtems_device_major_number major,
|
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
void * arg
|
void * arg
|
)
|
)
|
{
|
{
|
if (!arg)
|
if (!arg)
|
return RTEMS_INVALID_ADDRESS;
|
return RTEMS_INVALID_ADDRESS;
|
|
|
switch( ((console_ioctl_request_t *)arg)->ioctl_type )
|
switch( ((console_ioctl_request_t *)arg)->ioctl_type )
|
{
|
{
|
case CON_KBHIT:
|
case CON_KBHIT:
|
/* check if keyboard was hit */
|
/* check if keyboard was hit */
|
((console_ioctl_request_t *)arg)->param = console_pmr_kbhit();
|
((console_ioctl_request_t *)arg)->param = console_pmr_kbhit();
|
break;
|
break;
|
|
|
case CON_GET_RAW_BYTE:
|
case CON_GET_RAW_BYTE:
|
((console_ioctl_request_t *)arg)->param = inbyte(minor);
|
((console_ioctl_request_t *)arg)->param = inbyte(minor);
|
break;
|
break;
|
|
|
case CON_SEND_RAW_BYTE:
|
case CON_SEND_RAW_BYTE:
|
outbyte(minor, ((console_ioctl_request_t *)arg)->param);
|
outbyte(minor, ((console_ioctl_request_t *)arg)->param);
|
break;
|
break;
|
|
|
default:
|
default:
|
break;
|
break;
|
}
|
}
|
|
|
return RTEMS_SUCCESSFUL;
|
return RTEMS_SUCCESSFUL;
|
}
|
}
|
|
|