adtools/clib2

/*
 * $Id: termios_tcsetattr.c,v 1.5 2006-11-16 14:39:23 obarthel Exp $
 *
 * :ts=4
 *
 * Portable ISO 'C' (1994) runtime library for the Amiga computer
 * Copyright (c) 2002-2015 by Olaf Barthel <obarthel (at) gmx.net>
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 *   - Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *
 *   - Neither the name of Olaf Barthel nor the names of contributors
 *     may be used to endorse or promote products derived from this
 *     software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#ifndef    _TERMIOS_HEADERS_H
#include "termios_headers.h"
#endif /* _TERMIOS_HEADERS_H */

/****************************************************************************/

static int
set_console_termios(struct fd *fd,struct termios *new_tios)
{
    struct termios *old_tios;
    int result = ERROR;
    BPTR file;

    /* TODO: Check for some "impossible" combinations here? */

    old_tios = __get_termios(fd);
    if(old_tios == NULL)
        goto out;

    if(old_tios->type != TIOST_CONSOLE)
        goto out;

    file = __resolve_fd_file(fd);
    if(file == ZERO)
        goto out;

    if(FLAG_IS_CLEAR(new_tios->c_lflag,ICANON))
    {
        SetMode(file,DOSTRUE); /* Set Raw = Non-Canonical mode. */

        SET_FLAG(fd->fd_Flags,FDF_NON_BLOCKING);
    }
    else
    {
        SetMode(file,DOSFALSE); /* Set Cooked = Canonical mode. */

        CLEAR_FLAG(fd->fd_Flags,FDF_NON_BLOCKING);
    }

    /* Most of the processing (except raw/cooked mode switch) is handled in the hook. */
    memcpy(old_tios,new_tios,offsetof(struct termios,type));

    result = OK;

 out:

    return(result);
}

/****************************************************************************/

int
tcsetattr(int file_descriptor,int how,struct termios *tios)
{
    int result = ERROR;
    struct fd *fd = NULL;
    struct termios new_tios;
    int type;

    __stdio_lock();

    if(tios == NULL)
    {
        __set_errno(EFAULT);
        goto out;
    }

    fd = __get_file_descriptor(file_descriptor);
    if(fd == NULL)
    {
        SHOWMSG("tcsetattr() was not called with a file descriptor.\n");

        __set_errno(EBADF);
        goto out;
    }

    __fd_lock(fd);

    /* The following is in case the termios structure was manually constructed. (it should have been zero:ed in that case)  */
    if(tios->type == TIOST_INVALID)
    {
        if(tcgetattr(file_descriptor,&new_tios) != OK)
            goto out; /* Pass errno from tcgetattr() */

        type = new_tios.type;

        memcpy(&new_tios,tios,sizeof(struct termios));

        new_tios.c_ispeed = B9600;
        new_tios.c_ospeed = B9600;

        new_tios.type = type;

        tios = &new_tios;
    }

    if(tios->type == TIOST_SERIAL)
    {
        __set_errno(ENXIO);    /* Unimplemented (for now). */
        goto out;
    }
    else if (tios->type == TIOST_CONSOLE)
    {
        if(how == TCSADRAIN)
        {
            if(tcdrain(file_descriptor) != OK)
                goto out;
        }
        else if (how == TCSAFLUSH) 
        {
            if(tcflush(file_descriptor,TCIOFLUSH) != OK)
                goto out;
        }

        if(set_console_termios(fd,tios) != OK)
        {
            __set_errno(EIO);
            goto out;
        }
    }
    else
    {
        __set_errno(ENOTTY);
        goto out;
    }

    result = OK;

 out:

    __fd_unlock(fd);

    __stdio_unlock();

    return(result);
}