KoanLogic

embedded software engineering

• home
• products
• services
• docs
• news
• about

io.c

Go to the documentation of this file.

/*
 * Copyright (c) 2005, 2006 by KoanLogic s.r.l. <http://www.koanlogic.com>
 * All rights reserved.
 *
 * This file is part of KLone, and as such it is subject to the license stated
 * in the LICENSE file which you have received as part of this distribution.
 *
 * $Id: io.c,v 1.43 2008/10/03 16:03:04 tho Exp $
 */

#include "klone_conf.h"
#include <unistd.h>
#include <u/libu.h>
#include <klone/va.h>
#include <klone/io.h>
#include <klone/ioprv.h>
#include <klone/codec.h>

enum io_type_e io_type(io_t *io);

enum { 
    IO_RD_BUFSZ = 4096, 
    IO_WR_BUFSZ = 4096
};

#define IO_WBUF_AVAIL(io) (io->wbsz - io->wcount)
#define IO_WBUF_FULL(io) (io->wbsz == io->wcount)

static inline int io_transform_codec_buffer(io_t *, codec_t *, char *, 
        size_t *);

enum io_type_e io_type(io_t *io)
{
    return io->type;
}

ssize_t io_pipe(io_t *out, io_t *in)
{
    enum { BUFSZ = 4096 };
    char buf[BUFSZ];
    size_t count = 0;   /* # of bytes piped */
    ssize_t c;

    dbg_err_if (out == NULL);
    dbg_err_if (in == NULL);
    
    for(;;)
    {
        c = io_read(in, buf, BUFSZ);
        dbg_err_if(c < 0);
        if(c == 0)
            break; /* eof */

        /* write it out */
        dbg_err_if(io_write(out, buf, c) < 0);

        count += c;
    }

    return count;
err:
    return -1;
}

int io_dup(io_t *io, io_t **pio)
{
    dbg_return_if (io == NULL, ~0);
    dbg_return_if (pio == NULL, ~0);
    
    io->refcnt++;

    *pio = io;

    return 0;
}

ssize_t io_copy(io_t *out, io_t *in, size_t size)
{
    enum { BUFSZ = 4096 };
    char buf[BUFSZ];
    size_t rem = size;
    ssize_t c;

    dbg_err_if (in == NULL);
    dbg_err_if (out == NULL);

    while(rem)
    {
        c = io_read(in, buf, MIN(BUFSZ, rem));
        dbg_err_if(c < 0);
        if(c == 0)
            break; /* eof */

        /* write it out */
        dbg_err_if(io_write(out, buf, c) < 0);

        rem -= c;
    }

    return size - rem;
err:
    return -1;
}


ssize_t io_seek(io_t *io, size_t off)
{
    dbg_err_if (io == NULL);
    dbg_err_if (io_flush(io));

    if(io->seek)
        return io->seek(io, off);
err:
    return -1;
}

ssize_t io_tell(io_t *io)
{
    dbg_err_if (io == NULL);
    dbg_err_if (io_flush(io));

    if(io->tell)
        return io->tell(io);
err:
    return -1;
}

/* alloc the read buffer */
static int io_rbuf_alloc(io_t *io)
{
    dbg_err_if (io == NULL);
    
    io->rbsz = IO_RD_BUFSZ; /* set the buffer size */

    /* if a dup'd io_t already alloc'd a buffer then use it */
    io->rbuf = (char*)u_malloc(io->rbsz);
    dbg_err_if(io->rbuf == NULL);
    io->roff = 0;

    io->ubuf = (char*)u_malloc(io->rbsz);
    dbg_err_if(io->ubuf == NULL);

    return 0;
err:
    return ~0;
}

/* alloc the write buffer */
static int io_wbuf_alloc(io_t *io)
{
    dbg_err_if (io == NULL);

    io->wbsz = IO_WR_BUFSZ; /* set the buffer size */

    /* if a dup'd io_t already alloc'd a buffer then use it */
    io->wbuf = (char*)u_malloc(io->wbsz);
    dbg_err_if(io->wbuf == NULL);

    return 0;
err:
    return ~0;
}

static ssize_t io_transform(io_t *io, codec_t *codec, 
    char *dst, size_t *dcount, const char *src, size_t sz)
{
    ssize_t c;
    size_t cavail, sdcount = *dcount; /* saved dcount */

    dbg_err_if (io == NULL);
    dbg_err_if (codec == NULL);
    dbg_err_if (src == NULL);
    dbg_err_if (dst == NULL);
    dbg_err_if (dcount == NULL);

    if(codec == TAILQ_LAST(&io->codec_chain, codec_chain_s))
    {
        /* last codec in the chain */
        c = codec->transform(codec, dst, dcount, src, sz); 
        dbg_err_if(c == 0 && *dcount == 0);
        return c;
    } else {
        c = 0;
        do
        {
            *dcount = sdcount;
            if(codec->ccount)
                dbg_err_if(io_transform_codec_buffer(io, codec, dst, dcount));
            else
                *dcount = 0; /* no bytes written to 'dst' */

            c = 0; /* zero byte of 'src' consumed */
            cavail = CODEC_BUFSZ - codec->ccount - codec->coff;
            if(sz && cavail)
            {
                dbg_err_if((c = codec->transform(codec, 
                    codec->cbuf + codec->coff + codec->ccount, 
                    &cavail, src, sz)) < 0);

                codec->ccount += cavail;
                dbg_err_if(c == 0 && cavail == 0);
            }
        } while(c == 0 && *dcount == 0 && (codec->ccount || sz));

        return c;
    }

err:
    return -1;
}

static inline int io_transform_codec_buffer(io_t *io, codec_t *codec, 
    char *dst, size_t *dcount)
{
    ssize_t ct;

    dbg_err_if (io == NULL);
    dbg_err_if (codec == NULL);
    dbg_err_if (dst == NULL);
    dbg_err_if (dcount == NULL);

    if(codec->ccount)
    {
        dbg_err_if((ct = io_transform(io, TAILQ_NEXT(codec, np), 
            dst, dcount, codec->cbuf + codec->coff,codec->ccount)) < 0);

        codec->ccount -= ct;

        if(codec->ccount > 0)
            codec->coff += ct;
        else
            codec->coff = 0;
    }

    return 0;
err:
    return ~0;
}

static inline ssize_t io_transfer(io_t *io, char *dst, size_t *dcount, 
        const char *src, size_t sz)
{
    dbg_err_if (io == NULL);
    dbg_err_if (src == NULL);
    dbg_err_if (dst == NULL);
    dbg_err_if (dcount == NULL);

    if(!TAILQ_EMPTY(&io->codec_chain))
    {
        return io_transform(io, TAILQ_FIRST(&io->codec_chain), 
            dst, dcount, src, sz); 
    } else {
        ssize_t wr = MIN(sz, *dcount); 
        memcpy(dst, src, wr);
        *dcount = wr;
        return wr;
    }
err:
    return -1;
}

static int io_chain_flush_chunk(io_t *io, char *dst, size_t *dcount)
{
    int er;
    codec_t *codec;
    size_t sz, sdcount;

    dbg_err_if (io == NULL);
    dbg_err_if (dst == NULL);
    dbg_err_if (dcount == NULL);

    sdcount = *dcount;

    TAILQ_FOREACH(codec, &io->codec_chain, np)
    {
        *dcount = sdcount;
        if(codec == TAILQ_LAST(&io->codec_chain, codec_chain_s))
        {
            return codec->flush(codec, dst, dcount);
        } else {
            for(;;)
            {
                *dcount = sdcount;
                if(codec->ccount)
                {
                    int rc = io_transform_codec_buffer(io, codec, dst, dcount);
                    dbg_err_if (rc);

                    if(*dcount)
                        return CODEC_FLUSH_CHUNK; /* call flush again */
                } else
                    *dcount = 0; /* no bytes written to 'dst' */

                sz = CODEC_BUFSZ - codec->ccount - codec->coff;
                dbg_err_if((er = codec->flush(codec, 
                    codec->cbuf + codec->coff + codec->ccount, &sz)) < 0);

                codec->ccount += sz;

                if(er == CODEC_FLUSH_COMPLETE && codec->ccount == 0)
                    break; /* flush of this codec completed */
            } /* for */
        }
    }

    return CODEC_FLUSH_COMPLETE;
err:
    return -1;
}

static int io_chain_flush(io_t *io)
{
    enum { BUFSZ = 4096 };
    int er;
    size_t sz, count;
    char buf[BUFSZ], *ptr;

    dbg_err_if (io == NULL);

    for(;;)
    {
        /* note: we cannot write straight to the wbuf otherwise codec 
         * transform & flush functions cannot call io_write safely; so we use 
         * a temp buffer and memcpy it to the wbuf after flushing */
        count = BUFSZ;
        if((er = io_chain_flush_chunk(io, buf, &count)) == CODEC_FLUSH_COMPLETE)
            break; /* flush complete */
        
        dbg_err_if(er < 0);

        for(ptr = buf; count; )
        {
            if(IO_WBUF_FULL(io))
                dbg_err_if(io_flush(io));

            sz = MIN(count, IO_WBUF_AVAIL(io));
            memcpy(io->wbuf + io->wcount, ptr, sz);

            count -= sz;
            io->wcount += sz;
            ptr += sz;
        }
    } 

    return 0;
err:
    return ~0;
}

int io_close(io_t *io)
{
    dbg_err_if (io == NULL);

    if(io->close)
        dbg_err_if(io->close(io));

    return 0;
err:
    return ~0;
}

int io_free(io_t *io)
{
    dbg_err_if (io == NULL);
    dbg_err_if (io->refcnt == 0);

    /* skip if this io_t has been dup'd and there are still one or more 
       references in use */
    if(--io->refcnt)
        return 0;

    /* flush, remove and free all codecs */
    dbg_if(io_codecs_remove(io));

    dbg_if(io_flush(io));

    /* flush and close the stream (but don't free it) */
    dbg_if(io_close(io));

    /* free per-type alloc'ed data */
    if(io->free)
        dbg_if(io->free(io));

    U_FREE(io->rbuf);
    U_FREE(io->ubuf);
    U_FREE(io->wbuf);
    U_FREE(io->name);
    U_FREE(io);

    return 0;
err:
    return ~0;
}

/* refill the read buffer */
static ssize_t io_underflow(io_t *io)
{
    ssize_t c;
    size_t sz;

    dbg_err_if (io == NULL);

    if(io->rbuf == NULL)
        dbg_err_if(io_rbuf_alloc(io)); /* alloc the read buffer */

    while(io->rcount == 0)
    {
        if(io->ucount == 0)
        {   /* fetch some bytes from the device and fill the rbuffer */
            dbg_err_if((c = io->read(io, io->ubuf, io->rbsz)) < 0);
            if(c == 0)
            {   /* eof, try to get some buffered (already transformed) bytes 
                   from the codec */
                if(!TAILQ_EMPTY(&io->codec_chain))
                {
                    sz = io->rbsz;
                    c = io_chain_flush_chunk(io, io->rbuf, &sz);
                    dbg_err_if(c < 0);
                    io->rcount += sz;
                    io->roff = 0;
                    if(c == 0)
                        io->eof++;
                }
                break;
            }
            io->ucount += c;
        }

        /* transform all data in the buffer */
        sz = io->rbsz - io->rcount;
        dbg_err_if((c = io_transfer(io, io->rbuf, &sz, 
            io->ubuf + io->uoff, io->ucount)) < 0);
        dbg_err_if(c < 0);
        dbg_err_if(c == 0 && sz == 0);
        io->ucount -= c;
        if(io->ucount == 0)
            io->uoff = 0;
        else
            io->uoff += c;

        io->rcount = sz;
        io->roff = 0;
    }

    return io->rcount;
err:
    return -1;
}

ssize_t io_read(io_t *io, char *buf, size_t size)
{
    char *out = buf;
    size_t wr;
    ssize_t c;

    dbg_err_if (io == NULL);
    dbg_err_if (buf == NULL);
    
    if(io->eof)
        return 0;

    while(size)
    {
        if(io->rcount == 0)
        {
            dbg_err_if((c = io_underflow(io)) < 0);
            if(c == 0)
                break;
        }
        /* copy out data */
        wr = MIN(io->rcount, size); 
        memcpy(out, io->rbuf + io->roff, wr);
        io->rcount -= wr;
        io->roff += wr;
        out += wr;
        size -= wr;
    }

    return out - buf;
err:
    return -1;
}

ssize_t io_vprintf(io_t *io, const char *fmt, va_list ap)
{
    enum { BUFSZ = 2048 };
    char *bbuf = NULL; 
    int sz;
    char buf[BUFSZ];
    va_list apcpy;

    dbg_err_if (io == NULL);
    dbg_err_if (fmt == NULL);

#ifdef VA_COPY_UNAVAIL
    u_unused_args(apcpy);
#elif defined(VA_LIST_BY_VALUE)
    /* we're sure about vnsprintf not consuming its 'ap' argument, so just do
     * simple aliasing here: remember not to va_end() the alias */
    apcpy = ap;
#else
    /* vnsprintf modifies the va_list so make a copy before using it */
    kl_va_copy(apcpy, ap);
#endif

    /* build the message to print */
    sz = vsnprintf(buf, BUFSZ, fmt, ap);

    if(sz >= BUFSZ)
    {   
#ifndef VA_COPY_UNAVAIL
        /* stack buffer too small, alloc a bigger one on the heap */
        bbuf = (char*)u_malloc(++sz);
        dbg_err_if(bbuf == NULL);

        /* use apcpy in case ap has been consumed by previous vsnprintf */
        if((sz = vsnprintf(bbuf, sz, fmt, apcpy)) > 0)
            dbg_err_if(io_write(io, bbuf, sz) < 0);

        U_FREE(bbuf);
#else
        /* push out all we can (sz-BUFSZ+1 bytes will be lost) */
        warn("last %d byte(s) could not be written out", sz - BUFSZ + 1);
        dbg_err_if(io_write(io, buf, BUFSZ) < 0);
#endif
    } else if(sz > 0) {
        dbg_err_if(io_write(io, buf, sz) < 0);
    }

#if !defined(VA_LIST_BY_VALUE) && !defined(VA_COPY_UNAVAIL)
    va_end(apcpy);
#endif
    return 0;
err:
#if !defined(VA_LIST_BY_VALUE) && !defined(VA_COPY_UNAVAIL)
    va_end(apcpy);
#endif
    return -1;
}

ssize_t io_printf(io_t *io, const char *fmt, ...)
{
    va_list ap;
    ssize_t ret;

    dbg_err_if (io == NULL);
    dbg_err_if (fmt == NULL);

    /* build the message to print */
    va_start(ap, fmt); /* init variable list arguments */

    ret = io_vprintf(io, fmt, ap);

    va_end(ap);

    return ret;
err:
    return -1;
}

ssize_t io_flush(io_t *io)
{
    ssize_t c;
    size_t off = 0;

    dbg_err_if (io == NULL);
 
    while(io->wcount)
    {
        c = io->write(io, io->wbuf + off, io->wcount);
        dbg_err_if(c < 0);
        if(c == 0)
            break;
    
        io->wcount -= c;
        off += c;
    }

    return 0;
err:
    return -1;
}

ssize_t io_write(io_t *io, const char *buf, size_t size)
{
    size_t sz = 0, rem = size;
    ssize_t c = 0;

    dbg_err_if (io == NULL);
    dbg_err_if (buf == NULL);
    
    if(io->wbuf == NULL)
        dbg_err_if(io_wbuf_alloc(io)); /* alloc the write buffer */

    while(rem)
    {
        if(IO_WBUF_FULL(io)) /* if there's no more free space */
            dbg_err_if(io_flush(io));

        sz = IO_WBUF_AVAIL(io);
        c = io_transfer(io, io->wbuf + io->wcount, &sz, buf, rem);
        dbg_err_if(c < 0);
        dbg_err_if(c == 0 && sz == 0); /* some bytes MUST be read or written */

        io->wcount += sz;
        buf += c;
        rem -= c;
    }

    return size;
err:
    return -1;
}

inline ssize_t io_putc(io_t *io, char c)
{
    return io_write(io, &c, 1);
}

inline ssize_t io_getc(io_t *io, char *pc)
{
    return io_read(io, pc, 1);
}

static inline char *io_strnchr(char *buf, size_t sz, char c)
{
    register char *p;

    dbg_goto_if (buf == NULL, end);

    p = buf;

    while(sz--)
    {
        if(*p == c)
            return p;
        ++p;
    }
end:
    return NULL;
}

ssize_t io_get_until(io_t *io, char stop_at, char *buf, size_t size)
{
    ssize_t wr, c, len = 0;
    char *p, *base = buf;

    dbg_err_if (io == NULL);
    dbg_err_if (buf == NULL);

    if(size < 2)
        return -1; /* buf too small */

    --size; /* save a char for \0 */

    if(io->rcount == 0)
        dbg_err_if(io_underflow(io) < 0);

    if(io->rcount == 0)
        return 0;

    for(;;)
    {
        if((p = io_strnchr(io->rbuf + io->roff, io->rcount, stop_at)) != NULL)
        {
            p++; /* jump over 'stop_at' char*/
            wr = MIN(p - (io->rbuf + io->roff), size);
            memcpy(buf, io->rbuf + io->roff, wr);
            buf[wr] = 0;
            io->rcount -= wr;
            io->roff += wr;
            len += wr;
            break;
        } else {
            if(size >= io->rcount)
            {
                memcpy(buf, io->rbuf + io->roff, io->rcount);
                len += io->rcount;
                buf += io->rcount;
                size -= io->rcount;
                io->rcount = 0;
                io->roff = 0;
                dbg_err_if((c = io_underflow(io)) < 0);
                if(c == 0)
                    break;
            } else {
                /* buffer too small, return a partial line */
                memcpy(buf, io->rbuf + io->roff, size);
                len += size;
                io->rcount -= size;
                io->roff += size;
                break;
            }
        }
    }

    base[len] = 0;
    return len; /* return the # of chars in the line (strlen(line)) */
err:
    return -1;
}

ssize_t io_gets(io_t *io, char *buf, size_t size)
{
    return io_get_until(io, '\n', buf, size);
}

int io_codec_add_head(io_t *io, codec_t* c)
{
    dbg_return_if (io == NULL, ~0);
    dbg_return_if (c == NULL, ~0);

    /* insert the codec at the head of the chain */
    TAILQ_INSERT_HEAD(&io->codec_chain, c, np);

    return 0;
}

int io_codec_add_tail(io_t *io, codec_t* c)
{
    dbg_return_if (io == NULL, ~0);
    dbg_return_if (c == NULL, ~0);

    /* insert the codec at the end of the chain */
    TAILQ_INSERT_TAIL(&io->codec_chain, c, np);

    return 0;
}

int io_codecs_remove(io_t *io)
{
    codec_t *codec;
    int rc = 0;

    dbg_return_if (io == NULL, ~0);

    if(!TAILQ_EMPTY(&io->codec_chain))
    {
        if(io->wbuf)
            dbg_ifb(io_chain_flush(io))
                rc++;

        while((codec = TAILQ_FIRST(&io->codec_chain)) != NULL)
        {
            TAILQ_REMOVE(&io->codec_chain, codec, np);
            codec_free(codec);
        }
    }

    return rc;
}

int io_name_set(io_t *io, const char *name)
{
    char *n;

    dbg_err_if (io == NULL);
    dbg_err_if (name == NULL);
    
    n = u_strdup(name);
    dbg_err_if(n == NULL);

    U_FREE(io->name);

    io->name = n;

    return 0;
err:
    return ~0;
}

int io_name_get(io_t *io, char *name, size_t sz)
{
    size_t min = 0;

    dbg_err_if (io == NULL);
    dbg_err_if (io->name == NULL);
    dbg_err_if (name == NULL);
    dbg_err_if (sz < 2);

    min = MIN(sz-1, strlen(io->name));

    memcpy(name, io->name, min);
    name[min] = 0;
    
    return 0;
err:
    return ~0;
}

/*
 * \ingroup basic
 * \brief   Return the secure state of the IO object
 *  
 *  Return 0 if the connection is not secure (i.e. not encrypted) or not zero
 *  otherwise
 *
 * \param io    io object
 *
 * \return \c 0 for not secure connections, non-zero otherwise
 */
int io_is_secure(io_t *io)
{
    dbg_err_if(io == NULL);

    return io->is_secure;
err:
    return 0;
}


/* used by io devices init functions: alloc (used dev_sz block size) 
   and initialize an io_t */
int io_prv_create(size_t dev_sz, io_t **pio)
{
    io_t *io = NULL;

    dbg_err_if (pio == NULL);

    io = u_zalloc(dev_sz);
    dbg_err_if(io == NULL);

    TAILQ_INIT(&io->codec_chain);

    /* set refcnt to 1 */
    io->refcnt++;

    /* size of the io device struct (that's also a 'castable' io_t) */
    io->size = dev_sz;

    *pio = io;

    return 0;
err:
    U_FREE(io);
    return -1;
}

Copyright © 2005-2007 - KoanLogic S.r.l. - All rights reserved | Valid CSS & XHTML | powered by KLone