Mercurial > ecos-v2_0-branch
diff packages/io/serial/current/src/common/termiostty.c @ 115:6ed91473a1cd ecos-sw-2000-08-21
Merge from eCos master repository on 2000-08-21-22:40:54-BST
| author | jlarmour |
|---|---|
| date | Fri, 25 Aug 2000 17:32:38 +0000 |
| parents | |
| children | e0c0827131d1 |
line wrap: on
line diff
new file mode 100644 --- /dev/null +++ b/packages/io/serial/current/src/common/termiostty.c @@ -0,0 +1,896 @@ +//========================================================================== +// +// termiostty.c +// +// POSIX Termios compatible TTY I/O driver +// +//========================================================================== +//####COPYRIGHTBEGIN#### +// +// ------------------------------------------- +// The contents of this file are subject to the Red Hat eCos Public License +// Version 1.1 (the "License"); you may not use this file except in +// compliance with the License. You may obtain a copy of the License at +// http://www.redhat.com/ +// +// Software distributed under the License is distributed on an "AS IS" +// basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the +// License for the specific language governing rights and limitations under +// the License. +// +// The Original Code is eCos - Embedded Configurable Operating System, +// released September 30, 1998. +// +// The Initial Developer of the Original Code is Red Hat. +// Portions created by Red Hat are +// Copyright (C) 1998, 1999, 2000 Red Hat, Inc. +// All Rights Reserved. +// ------------------------------------------- +// +//####COPYRIGHTEND#### +//========================================================================== +//#####DESCRIPTIONBEGIN#### +// +// Author(s): jlarmour +// Contributors: gthomas +// Date: 2000-07-22 +// Purpose: Device driver for termios emulation tty I/O, layered on +// top of serial I/O +// Description: TODO: Add OPOST support for 80x25 (configurable) windows +// TODO: Support _POSIX_VDISABLE +// +//####DESCRIPTIONEND#### +// +//========================================================================== + +// CONFIGURATION + +#include <pkgconf/io_serial.h> + +#ifdef CYGPKG_IO_SERIAL_TERMIOS + +// INCLUDES + +#include <cyg/infra/cyg_type.h> // Common types +#include <cyg/infra/cyg_ass.h> // Assertion support +#include <cyg/infra/cyg_trac.h> // Tracing support +#include <cyg/io/io.h> +#include <cyg/io/devtab.h> +#include <cyg/io/serialio.h> // public serial API +#include <termios.h> // Termios header +#include <cyg/hal/drv_api.h> +#include <stdlib.h> // malloc +#include <string.h> +#ifdef CYGSEM_IO_SERIAL_TERMIOS_USE_SIGNALS +# include <signal.h> +#endif + +//========================================================================== +// FUNCTION PROTOTYPES + +static bool +termios_init(struct cyg_devtab_entry *tab); + +static Cyg_ErrNo +termios_lookup(struct cyg_devtab_entry **tab, + struct cyg_devtab_entry *sub_tab, + const char *name); +static Cyg_ErrNo +termios_write(cyg_io_handle_t handle, const void *buf, cyg_uint32 *len); +static Cyg_ErrNo +termios_read(cyg_io_handle_t handle, void *buf, cyg_uint32 *len); +static Cyg_ErrNo +termios_select(cyg_io_handle_t handle, cyg_uint32 which, CYG_ADDRWORD info); +static Cyg_ErrNo +termios_get_config(cyg_io_handle_t handle, cyg_uint32 key, void *buf, + cyg_uint32 *len); +static Cyg_ErrNo +termios_set_config(cyg_io_handle_t handle, cyg_uint32 key, const void *buf, + cyg_uint32 *len); + +//========================================================================== +// TYPE DEFINITIONS + +struct termios_private_info { + struct termios termios; + cyg_io_handle_t dev_handle; + cyg_drv_mutex_t lock; + cyg_bool init; + cyg_uint8 *errbuf; + cyg_uint8 *errbufpos; + cyg_uint32 errbufsize; +}; + +typedef struct { + struct termios *termios_p; + int optact; +} setattr_struct; + + +//========================================================================== +// STATIC OBJECTS + +static DEVIO_TABLE(termios_devio, + termios_write, + termios_read, + termios_select, + termios_get_config, + termios_set_config); + +#ifdef CYGPKG_IO_SERIAL_TERMIOS_TERMIOS0 +static struct termios_private_info termios_private_info0; +DEVTAB_ENTRY(termios_io0, + "/dev/termios0", + CYGDAT_IO_SERIAL_TERMIOS_TERMIOS0_DEV, + &termios_devio, + termios_init, + termios_lookup, + &termios_private_info0); +#endif + +#ifdef CYGPKG_IO_SERIAL_TERMIOS_TERMIOS1 +static struct termios_private_info termios_private_info1; +DEVTAB_ENTRY(termios_io1, + "/dev/termios1", + CYGDAT_IO_SERIAL_TERMIOS_TERMIOS1_DEV, + &termios_devio, + termios_init, + termios_lookup, + &termios_private_info1); +#endif + +#ifdef CYGPKG_IO_SERIAL_TERMIOS_TERMIOS2 +static struct termios_private_info termios_private_info2; +DEVTAB_ENTRY(termios_io2, + "/dev/termios2", + CYGDAT_IO_SERIAL_TERMIOS_TERMIOS2_DEV, + &termios_devio, + termios_init, + termios_lookup, + &termios_private_info2); +#endif + +static const cc_t c_cc_init[ NCCS ] = { + 0x04, /* EOF == ^D */ + 0, /* EOL */ + 0x08, /* ERASE = BS ; NB DEL=0x7f */ + 0x03, /* INTR = ^C */ + 0x15, /* KILL = ^U */ + 0, /* MIN = 0 */ + 0x1c, /* QUIT = ^\ */ + 0x1a, /* SUSP = ^Z ; NB ignored in this impl - no job control */ + 0, /* TIME = 0 */ +#ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_SOFTWARE + CYGDAT_IO_SERIAL_FLOW_CONTROL_XON_CHAR, + CYGDAT_IO_SERIAL_FLOW_CONTROL_XOFF_CHAR, +#else + 17, + 19, +#endif +}; + +// map eCos bitrates to POSIX bitrates. +static speed_t ecosbaud2posixbaud[] = { + 0, B50, B75, B110, B134, B150, B200, B300, B600, B1200, B2400, B3600, + B4800, B7200, B9600, B14400, B19200, B38400, B57600, B115200, B230400 }; + +// map POSIX bitrates to eCos bitrates. +static cyg_serial_baud_rate_t posixbaud2ecosbaud[] = { + 0, CYGNUM_SERIAL_BAUD_50, CYGNUM_SERIAL_BAUD_75, CYGNUM_SERIAL_BAUD_110, + CYGNUM_SERIAL_BAUD_134_5, CYGNUM_SERIAL_BAUD_150, CYGNUM_SERIAL_BAUD_200, + CYGNUM_SERIAL_BAUD_300, CYGNUM_SERIAL_BAUD_600, CYGNUM_SERIAL_BAUD_1200, + CYGNUM_SERIAL_BAUD_1800, CYGNUM_SERIAL_BAUD_2400, CYGNUM_SERIAL_BAUD_3600, + CYGNUM_SERIAL_BAUD_4800, CYGNUM_SERIAL_BAUD_7200, CYGNUM_SERIAL_BAUD_9600, + CYGNUM_SERIAL_BAUD_14400, CYGNUM_SERIAL_BAUD_19200, + CYGNUM_SERIAL_BAUD_38400, CYGNUM_SERIAL_BAUD_57600, + CYGNUM_SERIAL_BAUD_115200, CYGNUM_SERIAL_BAUD_230400 }; + + +//========================================================================== +// FUNCTIONS + +static __inline__ speed_t +map_ecosbaud_to_posixbaud( cyg_serial_baud_rate_t ebaud ) +{ + if ( ebaud > (sizeof(ecosbaud2posixbaud) / sizeof(speed_t)) ) + return 0; + return ecosbaud2posixbaud[ ebaud ]; +} + +static __inline__ cyg_serial_baud_rate_t +map_posixbaud_to_ecosbaud( speed_t pbaud ) +{ + if ( pbaud > (sizeof(posixbaud2ecosbaud)/sizeof(cyg_serial_baud_rate_t)) ) + return 0; + return posixbaud2ecosbaud[ pbaud ]; +} + +//========================================================================== +// real_termios_init is used to initialize the termios structure. This is +// called at lookup time, and not from termios_init() because it needs +// to query the serial device which may not be set up yet at that point +// in termios_init() + +#ifdef CYGSEM_IO_SERIAL_TERMIOS_USE_SIGNALS +# define C_IFLAG_INIT (ICRNL|IGNBRK|BRKINT) +#else +# define C_IFLAG_INIT (ICRNL|IGNBRK) +#endif +#define C_OFLAG_INIT (ONLCR) +#define C_CFLAG_INIT (CREAD) +#define C_LFLAG_INIT (ECHO|ECHOE|ECHOK|ICANON) + +static Cyg_ErrNo +real_termios_init( struct termios_private_info *priv ) +{ + Cyg_ErrNo res; + struct termios *t; + cyg_serial_info_t dev_conf; + cyg_serial_buf_info_t dev_buf_conf; + cyg_uint32 len = sizeof( dev_conf ); + + CYG_REPORT_FUNCTYPE("returning %d"); + CYG_REPORT_FUNCARG1XV( priv ); + CYG_CHECK_DATA_PTRC( priv ); + + t = &priv->termios; + + // Get info from driver + res = cyg_io_get_config( priv->dev_handle, CYG_IO_GET_CONFIG_SERIAL_INFO, + &dev_conf, &len ); + if ( ENOERR == res ) { + len = sizeof( dev_buf_conf ); + res = cyg_io_get_config( priv->dev_handle, + CYG_IO_GET_CONFIG_SERIAL_BUFFER_INFO, + &dev_buf_conf, &len ); + } + + priv->errbuf = (cyg_uint8 *)malloc( dev_buf_conf.rx_bufsize ); + if ( NULL == priv->errbuf ) + res = ENOMEM; // FIXME: Are we allowed to do this? + priv->errbufpos = priv->errbuf; + priv->errbufsize = dev_buf_conf.rx_bufsize; + + if ( ENOERR != res ) { + CYG_REPORT_RETVAL( res ); + return res; + } + + // we only support symmetric baud rates + t->c_ispeed = t->c_ospeed = map_ecosbaud_to_posixbaud( dev_conf.baud ); + t->c_iflag = C_IFLAG_INIT; + t->c_oflag = C_OFLAG_INIT; + t->c_cflag = C_CFLAG_INIT; + t->c_lflag = C_LFLAG_INIT; + memcpy( t->c_cc, c_cc_init, sizeof( t->c_cc ) ); + + switch ( dev_conf.parity ) { + case CYGNUM_SERIAL_PARITY_NONE: + t->c_iflag |= IGNPAR; + break; + case CYGNUM_SERIAL_PARITY_ODD: + t->c_cflag |= PARODD; + // DROPTHROUGH + case CYGNUM_SERIAL_PARITY_EVEN: + t->c_iflag |= PARENB; + break; + default: + CYG_FAIL( "Unsupported default parity" ); + break; + } + + switch( dev_conf.word_length ) { + case CYGNUM_SERIAL_WORD_LENGTH_5: + t->c_cflag |= CS5; + break; + case CYGNUM_SERIAL_WORD_LENGTH_6: + t->c_cflag |= CS6; + break; + case CYGNUM_SERIAL_WORD_LENGTH_7: + t->c_cflag |= CS7; + break; + case CYGNUM_SERIAL_WORD_LENGTH_8: + t->c_cflag |= CS8; + break; + default: + CYG_FAIL( "Unsupported word length" ); + break; + } + + switch ( dev_conf.stop ) { + case CYGNUM_SERIAL_STOP_1: + // Don't need to do anything + break; + case CYGNUM_SERIAL_STOP_2: + t->c_cflag |= CSTOPB; + break; + default: + CYG_FAIL( "Unsupported number of stop bits" ); + break; + } + + switch ( dev_conf.flags ) { + case CYGNUM_SERIAL_FLOW_RTSCTS_RX: + t->c_cflag |= CRTSCTS; + // drop through + case CYGNUM_SERIAL_FLOW_XONXOFF_RX: + t->c_iflag |= IXOFF; + break; + case CYGNUM_SERIAL_FLOW_RTSCTS_TX: + t->c_cflag |= CRTSCTS; + // drop through + case CYGNUM_SERIAL_FLOW_XONXOFF_TX: + t->c_iflag |= IXON; + break; + default: + // Ignore flags we don't grok + break; + } + + return ENOERR; +} // real_termios_init() + +//========================================================================== +// set_attr() actually enacts the termios config. We come in here with +// the mutex in priv locked +// +// Possible deviation from standard: POSIX says we should enact which ever +// bits we can and only return EINVAL when none of them can be performed +// Rather than tracking whether *none* of them worked, instead we just +// always claim success. At the very least, setting c_cc is never to +// fail so I'm not sure if this is really non-standard or not! + +static Cyg_ErrNo +set_attr( struct termios *t, struct termios_private_info *priv ) +{ + Cyg_ErrNo res = ENOERR; + cyg_serial_info_t dev_conf, new_dev_conf; + cyg_uint32 len = sizeof( dev_conf ); + cc_t *tempcc = &priv->termios.c_cc[0]; + struct termios *ptermios = &priv->termios; + + // Get info from driver + res = cyg_io_get_config( priv->dev_handle, CYG_IO_GET_CONFIG_SERIAL_INFO, + &dev_conf, &len ); + + if ( ENOERR != res ) + return res; + + // We need to set up each facet of config to change one by one because + // POSIX says we should try and change as much of the config as possible + // This is tedious and has to be done by steam :-( + + if ( t->c_ospeed != ptermios->c_ospeed ) { + new_dev_conf = dev_conf; + new_dev_conf.baud = map_posixbaud_to_ecosbaud( t->c_ospeed ); + if ( 0 != new_dev_conf.baud ) { + len = sizeof( new_dev_conf ); + res = cyg_io_set_config( priv->dev_handle, + CYG_IO_SET_CONFIG_SERIAL_INFO, + &new_dev_conf, &len ); + if ( ENOERR == res ) { + // It worked, so update dev_conf to reflect the new state + dev_conf.baud = new_dev_conf.baud; + // and termios + ptermios->c_ispeed = t->c_ospeed; + ptermios->c_ospeed = t->c_ospeed; + } + } + } + + if ( (t->c_cflag & CSTOPB) != (ptermios->c_cflag & CSTOPB) ) { + new_dev_conf = dev_conf; + if ( t->c_cflag & CSTOPB ) + new_dev_conf.stop = CYGNUM_SERIAL_STOP_2; + else + new_dev_conf.stop = CYGNUM_SERIAL_STOP_1; + + len = sizeof( new_dev_conf ); + res = cyg_io_set_config( priv->dev_handle, + CYG_IO_SET_CONFIG_SERIAL_INFO, + &new_dev_conf, &len ); + if ( ENOERR == res ) { + // It worked, so update dev_conf to reflect the new state + dev_conf.stop = new_dev_conf.stop; + // and termios + ptermios->c_cflag &= ~CSTOPB; + ptermios->c_cflag |= t->c_cflag & CSTOPB; + } + } + + if ( ((t->c_cflag & PARENB) != (ptermios->c_cflag & PARENB)) || + ((t->c_cflag & PARODD) != (ptermios->c_cflag & PARODD)) ) { + new_dev_conf = dev_conf; + if ( t->c_cflag & PARENB ) + if ( t->c_cflag & PARODD ) + new_dev_conf.parity = CYGNUM_SERIAL_PARITY_ODD; + else + new_dev_conf.parity = CYGNUM_SERIAL_PARITY_EVEN; + else + new_dev_conf.parity = CYGNUM_SERIAL_PARITY_NONE; + + len = sizeof( new_dev_conf ); + res = cyg_io_set_config( priv->dev_handle, + CYG_IO_SET_CONFIG_SERIAL_INFO, + &new_dev_conf, &len ); + if ( ENOERR == res ) { + // It worked, so update dev_conf to reflect the new state + dev_conf.parity = new_dev_conf.parity; + // and termios + ptermios->c_cflag &= ~(PARENB|PARODD); + ptermios->c_cflag |= t->c_cflag & (PARENB|PARODD); + } + } + + if ( (t->c_cflag & CSIZE) != (ptermios->c_cflag & CSIZE) ) { + new_dev_conf = dev_conf; + switch ( t->c_cflag & CSIZE ) { + case CS5: + new_dev_conf.word_length = CYGNUM_SERIAL_WORD_LENGTH_5; + break; + case CS6: + new_dev_conf.word_length = CYGNUM_SERIAL_WORD_LENGTH_6; + break; + case CS7: + new_dev_conf.word_length = CYGNUM_SERIAL_WORD_LENGTH_7; + break; + case CS8: + new_dev_conf.word_length = CYGNUM_SERIAL_WORD_LENGTH_8; + break; + } + + len = sizeof( new_dev_conf ); + res = cyg_io_set_config( priv->dev_handle, + CYG_IO_SET_CONFIG_SERIAL_INFO, + &new_dev_conf, &len ); + if ( ENOERR == res ) { + // It worked, so update dev_conf to reflect the new state + dev_conf.word_length = new_dev_conf.word_length; + // and termios + ptermios->c_cflag &= ~CSIZE; + ptermios->c_cflag |= t->c_cflag & CSIZE; + } + } + + if ( (t->c_cflag & IXOFF) != (ptermios->c_cflag & IXOFF) ) { + new_dev_conf = dev_conf; + new_dev_conf.flags &= + ~(CYGNUM_SERIAL_FLOW_XONXOFF_RX|CYGNUM_SERIAL_FLOW_RTSCTS_RX); + if ( t->c_cflag & IXOFF ) + if ( t->c_cflag & CRTSCTS) + new_dev_conf.flags |= CYGNUM_SERIAL_FLOW_RTSCTS_RX; + else + new_dev_conf.flags |= CYGNUM_SERIAL_FLOW_XONXOFF_RX; + else + new_dev_conf.flags |= CYGNUM_SERIAL_FLOW_NONE; + + len = sizeof( new_dev_conf ); + res = cyg_io_set_config( priv->dev_handle, + CYG_IO_SET_CONFIG_SERIAL_INFO, + &new_dev_conf, &len ); + if ( ENOERR == res ) { + // It worked, so update dev_conf to reflect the new state + dev_conf.flags = new_dev_conf.flags; + // and termios + ptermios->c_cflag &= ~(IXOFF|CRTSCTS); + ptermios->c_cflag |= t->c_cflag & (IXOFF|CRTSCTS); + } + } + + if ( (t->c_cflag & IXON) != (ptermios->c_cflag & IXON) ) { + new_dev_conf = dev_conf; + new_dev_conf.flags &= + ~(CYGNUM_SERIAL_FLOW_XONXOFF_TX|CYGNUM_SERIAL_FLOW_RTSCTS_TX); + if ( t->c_cflag & IXON ) + if ( t->c_cflag & CRTSCTS) + new_dev_conf.flags |= CYGNUM_SERIAL_FLOW_RTSCTS_TX; + else + new_dev_conf.flags |= CYGNUM_SERIAL_FLOW_XONXOFF_TX; + else + new_dev_conf.flags |= CYGNUM_SERIAL_FLOW_NONE; + + len = sizeof( new_dev_conf ); + res = cyg_io_set_config( priv->dev_handle, + CYG_IO_SET_CONFIG_SERIAL_INFO, + &new_dev_conf, &len ); + if ( ENOERR == res ) { + // It worked, so update dev_conf to reflect the new state + dev_conf.flags = new_dev_conf.flags; + // and termios + ptermios->c_cflag &= ~(IXON|CRTSCTS); + ptermios->c_cflag |= t->c_cflag & (IXON|CRTSCTS); + } + } + + // Input/Output processing flags can just be set as we grok them all + // with few exceptions (see lflags below) + ptermios->c_iflag &= ~(BRKINT|ICRNL|IGNBRK|IGNCR|IGNPAR|INLCR|INPCK| + ISTRIP|PARMRK); + ptermios->c_iflag |= t->c_iflag & ( +#ifdef CYGSEM_IO_SERIAL_TERMIOS_USE_SIGNALS + BRKINT| +#endif + ICRNL|IGNBRK|IGNCR|IGNPAR| + INLCR|INPCK|ISTRIP|PARMRK ); + + ptermios->c_oflag &= ~(OPOST|ONLCR); + ptermios->c_oflag |= t->c_oflag & ONLCR; +#ifdef NOTYET + ptermios->c_oflag |= t->c_oflag & OPOST; +#endif + + ptermios->c_cflag &= ~(CLOCAL|CREAD|HUPCL); + ptermios->c_cflag |= t->c_cflag & (CLOCAL|CREAD|HUPCL); + + ptermios->c_lflag &= ~(ECHO|ECHOE|ECHOK|ECHONL|ICANON| + IEXTEN|ISIG|NOFLSH|TOSTOP); + // Note we don't support IEXTEN nor TOSTOP so we don't set them + ptermios->c_lflag |= t->c_lflag & (ECHO|ECHOE|ECHOK|ECHONL|ICANON| +#ifdef CYGSEM_IO_SERIAL_TERMIOS_USE_SIGNALS + ISIG| +#endif + NOFLSH); + + // control characters. We don't support changing of VSTART, VSTOP, + // VTIME or VSUSP though + tempcc[VEOF] = t->c_cc[VEOF]; + tempcc[VEOL] = t->c_cc[VEOL]; + tempcc[VERASE] = t->c_cc[VERASE]; + tempcc[VINTR] = t->c_cc[VINTR]; + tempcc[VKILL] = t->c_cc[VKILL]; + tempcc[VMIN] = t->c_cc[VMIN]; + tempcc[VQUIT] = t->c_cc[VQUIT]; + + return res; +} + +//========================================================================== + +static bool +termios_init(struct cyg_devtab_entry *tab) +{ + // can't initialize the termios structure because we can't + // query the serial driver yet. Wait until lookup time. + + return true; +} // termios_init() + +//========================================================================== + +static Cyg_ErrNo +termios_lookup(struct cyg_devtab_entry **tab, + struct cyg_devtab_entry *sub_tab, + const char *name) +{ + cyg_io_handle_t chan = (cyg_io_handle_t)sub_tab; + struct termios_private_info *priv = + (struct termios_private_info *)(*tab)->priv; + Cyg_ErrNo err = ENOERR; + + if ( !priv->init ) { + cyg_drv_mutex_lock( &priv->lock ); + if ( !priv->init ) { // retest as we may have been pre-empted + priv->dev_handle = chan; + err = real_termios_init( priv ); + } + cyg_drv_mutex_unlock( &priv->lock ); + } + return err; +} + +//========================================================================== + +#define WRITE_BUFSIZE 100 // FIXME: ->CDL +// #define MAX_CANON 64 FIXME: relevance? + + +static Cyg_ErrNo +termios_write(cyg_io_handle_t handle, const void *_buf, cyg_uint32 *len) +{ + cyg_devtab_entry_t *t = (cyg_devtab_entry_t *)handle; + struct termios_private_info *priv = (struct termios_private_info *)t->priv; + cyg_io_handle_t chan = (cyg_io_handle_t)priv->dev_handle; + cyg_int32 size, bytes_successful, actually_written; + cyg_uint8 xbuf[WRITE_BUFSIZE]; + cyg_uint8 *buf = (cyg_uint8 *)_buf; + Cyg_ErrNo res; + + size = 0; + bytes_successful = 0; + actually_written = 0; + while (bytes_successful++ < *len) { + xbuf[size] = *buf++; + if ( (xbuf[size] == '\n') && (priv->termios.c_oflag & ONLCR) ) { + xbuf[size] = '\r'; + } + size++; + if ((size == (WRITE_BUFSIZE-1)) || + (bytes_successful == *len)) { + res = cyg_io_write(chan, xbuf, &size); + if (res != ENOERR) { + *len = actually_written; + return res; + } + actually_written += size; + size = 0; + } + } + *len = actually_written; + return ENOERR; +} + + +//========================================================================== + +static Cyg_ErrNo +termios_read(cyg_io_handle_t handle, void *_buf, cyg_uint32 *len) +{ + cyg_devtab_entry_t *dt = (cyg_devtab_entry_t *)handle; + struct termios_private_info *priv = (struct termios_private_info *)dt->priv; + cyg_io_handle_t chan = (cyg_io_handle_t)priv->dev_handle; + struct termios *t = &priv->termios; + cyg_uint32 clen; + cyg_uint32 size; + Cyg_ErrNo res; + cyg_uint8 c; + cyg_uint8 *buf = (cyg_uint8 *)_buf; + cyg_bool discardc; // should c be discarded (not read, not printed) + cyg_bool returnnow = false; // return back to user after this char + + // if receiver off + if (0 == (t->c_cflag & CREAD) ) { + *len = 0; + return -EINVAL; + } + + size = 0; + if ( 0 == (t->c_lflag & ICANON) ) { + // In non-canonical mode we return the min of *len and the + // number of bytes available + // So we query the driver for how many bytes are available - this + // guarantees we won't block + cyg_serial_buf_info_t dev_buf_conf; + cyg_uint32 dbc_len = sizeof( dev_buf_conf ); + res = cyg_io_get_config( chan, + CYG_IO_GET_CONFIG_SERIAL_BUFFER_INFO, + &dev_buf_conf, &dbc_len ); + CYG_ASSERT( res == ENOERR, "Query buffer status failed!" ); + *len = *len < dev_buf_conf.rx_count ? *len : dev_buf_conf.rx_count; + } // if + + while (!returnnow && size < *len) { + clen = 1; + discardc = false; + res = cyg_io_read(chan, &c, &clen); + if (res != ENOERR) { + *len = size; + return res; + } + + // lock to prevent termios getting corrupted while we read from it + cyg_drv_mutex_lock( &priv->lock ); + + if ( t->c_iflag & ISTRIP ) + c &= 0x7f; + + // canonical mode: erase, kill, and newline processing + if ( t->c_lflag & ICANON ) { + if ( t->c_cc[ VERASE ] == c ) { + discardc = true; + // erase on display? + if ( (t->c_lflag & ECHO) && (t->c_lflag & ECHOE) ) { + cyg_uint8 erasebuf[3]; + erasebuf[0] = erasebuf[2] = t->c_cc[ VERASE ]; + erasebuf[1] = ' '; + clen = sizeof(erasebuf); + // FIXME: what about error or non-blocking? + cyg_io_write(chan, erasebuf, &clen); + } + if ( size ) + size--; + } // if + else if ( t->c_cc[ VKILL ] == c ) { + // kill line on display? + if ( (t->c_lflag & ECHO) && (t->c_lflag & ECHOK) ) { + + // we could try and be more efficient here and + // output a stream of erases, and then a stream + // of spaces and then more erases. But this is poor + // because on a slow terminal the user will see characters + // delete from the middle forward in chunks! + // But at least we try and chunk up sets of writes + cyg_uint8 erasebuf[30]; + cyg_uint8 erasechunks; + cyg_uint8 i; + + erasechunks = size < (sizeof(erasebuf)/3) ? + size : (sizeof(erasebuf)/3); + + for (i=0; i<erasechunks; i++) { + erasebuf[i*3] = erasebuf[i*3+2] = t->c_cc[ VERASE ]; + erasebuf[i*3+1] = ' '; + } + + while( size ) { + cyg_uint8 j; + + j = size < (sizeof(erasebuf)/3) ? + size : (sizeof(erasebuf)/3); + clen = (j*3); + // FIXME: what about error or non-blocking? + cyg_io_write( chan, erasebuf, &clen ); + size -= j; + } + } else + size = 0; + discardc = true; + } // else if + // CR + else if ( '\r' == c ) { + if ( t->c_iflag & IGNCR ) + discardc = true; + else if ( t->c_iflag & ICRNL ) + c = '\n'; + } + // newlines or similar. + // Note: not an else if to catch CRNL conversion + if ( (t->c_cc[ VEOF ] == c) || (t->c_cc[ VEOL ] == c) || + ('\n' == c) ) { + if ( t->c_cc[ VEOF ] == c ) + discardc = true; + if ( t->c_lflag & ECHONL ) { // don't check ECHO in this case + clen = 1; + // FIXME: what about error or non-blocking? + // FIXME: what if INLCR is set? + cyg_io_write( chan, "\n", &clen ); + } + if ( t->c_iflag & INLCR ) + c = '\r'; + returnnow = true; // FIXME: true even for INLCR? + } // else if + } else { // non-canonical mode + if ( size+1 >= t->c_cc[ VMIN ] ) + returnnow = true; + } // else + +#ifdef CYGSEM_IO_SERIAL_TERMIOS_USE_SIGNALS + if ( (t->c_lflag & ISIG) && (t->c_cc[ VINTR ] == c) ) { + discardc = true; + if ( 0 == (t->c_lflag & NOFLSH) ) + size = 0; + // raise could be a non-local jump - we should unlock mutex + cyg_drv_mutex_unlock( &priv->lock ); + + // FIXME: what if raise returns != 0? + raise( SIGINT ); + cyg_drv_mutex_lock( &priv->lock ); + } + + if ( (t->c_lflag & ISIG) && (t->c_cc[ VQUIT ] == c) ) { + discardc = true; + if ( 0 == (t->c_lflag & NOFLSH) ) + size = 0; + // raise could be a non-local jump - we should unlock mutex + cyg_drv_mutex_unlock( &priv->lock ); + + // FIXME: what if raise returns != 0? + raise( SIGQUIT ); + cyg_drv_mutex_lock( &priv->lock ); + } +#endif + if (!discardc) { + buf[size++] = c; + if ( t->c_lflag & ECHO ) { + clen = 1; + // FIXME: what about error or non-blocking? + cyg_io_write( chan, &c, &clen ); + } + } + cyg_drv_mutex_unlock( &priv->lock ); + } // while + + *len = size; + return ENOERR; +} + + +//========================================================================== + +static cyg_bool +termios_select(cyg_io_handle_t handle, cyg_uint32 which, CYG_ADDRWORD info) +{ + cyg_devtab_entry_t *t = (cyg_devtab_entry_t *)handle; + struct termios_private_info *priv = (struct termios_private_info *)t->priv; + cyg_io_handle_t chan = (cyg_io_handle_t)priv->dev_handle; + + // Just pass it on to next driver level + return cyg_io_select( chan, which, info ); +} + + +//========================================================================== + +static Cyg_ErrNo +termios_get_config(cyg_io_handle_t handle, cyg_uint32 key, void *buf, + cyg_uint32 *len) +{ + cyg_devtab_entry_t *t = (cyg_devtab_entry_t *)handle; + struct termios_private_info *priv = (struct termios_private_info *)t->priv; + cyg_io_handle_t chan = (cyg_io_handle_t)priv->dev_handle; + Cyg_ErrNo res = ENOERR; + + switch (key) { + case CYG_IO_GET_CONFIG_TERMIOS: + { + if ( *len < sizeof(struct termios) ) { + return -EINVAL; + } + cyg_drv_mutex_lock( &priv->lock ); + *(struct termios *)buf = priv->termios; + cyg_drv_mutex_unlock( &priv->lock ); + *len = sizeof(struct termios); + } + break; + default: // Assume this is a 'serial' driver control + res = cyg_io_get_config(chan, key, buf, len); + } // switch + return res; +} + + +//========================================================================== + + +static Cyg_ErrNo +termios_set_config(cyg_io_handle_t handle, cyg_uint32 key, const void *buf, cyg_uint32 *len) +{ + cyg_devtab_entry_t *t = (cyg_devtab_entry_t *)handle; + struct termios_private_info *priv = (struct termios_private_info *)t->priv; + cyg_io_handle_t chan = (cyg_io_handle_t)priv->dev_handle; + Cyg_ErrNo res = ENOERR; + + switch (key) { + case CYG_IO_SET_CONFIG_TERMIOS: + { + setattr_struct *attr = (setattr_struct *)buf; + int optact = attr->optact; + + if ( *len != sizeof( *attr ) ) { + return -EINVAL; + } + + CYG_ASSERT( (optact == TCSAFLUSH) || (optact == TCSADRAIN) || + (optact == TCSANOW), "Invalid optact" ); + + cyg_drv_mutex_lock( &priv->lock ); + + if ( ( TCSAFLUSH == optact ) || + ( TCSADRAIN == optact ) ) { + res = cyg_io_get_config( chan, + CYG_IO_GET_CONFIG_SERIAL_OUTPUT_DRAIN, + NULL, NULL ); + CYG_ASSERT( ENOERR == res, "Drain request failed" ); + } + if ( TCSAFLUSH == optact ) { + res = cyg_io_get_config( chan, + CYG_IO_GET_CONFIG_SERIAL_INPUT_FLUSH, + NULL, NULL ); + CYG_ASSERT( ENOERR == res, "Flush request failed" ); + } + + res = set_attr( attr->termios_p, priv ); + cyg_drv_mutex_unlock( &priv->lock ); + return res; + } + default: // Pass on to serial driver + res = cyg_io_set_config(chan, key, buf, len); + } + return res; +} + + +//========================================================================== + +#endif // ifdef CYGPKG_IO_SERIAL_TERMIOS + +// EOF termiostty.c
