sprintf.c

Go to the documentation of this file.

#include <mware/formatwr.h>
#include <cpu/pgm.h>
#include <cfg/compiler.h>

#include <stdio.h>


static void __str_put_char(char c, void *ptr)
{
    /*
     * This Does not work on Code Warrior. Hmm...
     *  *(*((char **)ptr))++ = c;
     */

    **((char **)ptr) = c;
    (*((char **)ptr))++;
}

static void __null_put_char(UNUSED_ARG(char, c), UNUSED_ARG(void *, ptr))
{
    /* nop */
}


int PGM_FUNC(vsprintf)(char *str, const char * PGM_ATTR fmt, va_list ap)
{
    int result;

    if (str)
    {
        result = PGM_FUNC(_formatted_write)(fmt, __str_put_char, &str, ap);

        /* Terminate string */
        *str = '\0';
    }
    else
        result = PGM_FUNC(_formatted_write)(fmt, __null_put_char, 0, ap);


    return result;
}


int PGM_FUNC(sprintf)(char *str, const char * fmt, ...)
{
    int result;
    va_list ap;

    va_start(ap, fmt);
    result = PGM_FUNC(vsprintf)(str, fmt, ap);
    va_end(ap);

    return result;
}

struct __sn_state
{
    char *str;
    size_t len;
};

static void __sn_put_char(char c, void *ptr)
{
    struct __sn_state *state = (struct __sn_state *)ptr;

    if (state->len)
    {
        --state->len;
        *state->str++ = c;
    }
}


int PGM_FUNC(vsnprintf)(char *str, size_t size, const char * PGM_ATTR fmt, va_list ap)
{
    int result = 0;

    /* Make room for traling '\0'. */
    if (size--)
    {
        if (str)
        {
            struct __sn_state state;
            state.str = str;
            state.len = size;

            result = PGM_FUNC(_formatted_write)(fmt, __sn_put_char, &state, ap);

            /* Terminate string. */
            *state.str = '\0';
        }
        else
            result = PGM_FUNC(_formatted_write)(fmt, __null_put_char, 0, ap);
    }

    return result;
}


int PGM_FUNC(snprintf)(char *str, size_t size, const char * fmt, ...)
{
    int result;
    va_list ap;

    va_start(ap, fmt);
    result = PGM_FUNC(vsnprintf)(str, size, fmt, ap);
    va_end(ap);

    return result;
}