Desktop/xinu_mips-1.0.2.tar/xinu_mips-1.0.2/lib/libxc/doprnt.c

Go to the documentation of this file.

/* Embedded XINU, Copyright (C) 2007.  All rights reserved. */

#include <vararg.h>

#define MAXSTR  80
#define local   static

local void _prtl10(long num, char *str);
local void _prtl8(long num, char *str);
local void _prtX16(long num, char *str);
local void _prtl16(long num, char *str);
local void _prtl2(long num, char *str);

void _doprnt(char *fmt, va_list ap, int (*func)(), int farg) 
{
        int     c;
        int     i;
        int     f;              /* The format character (comes after %) */
        char    *str;       /* Running pointer in string            */
        char    string[20];     /* The string str points to this output */
                        /*  from number conversion              */
        int     length;         /* Length of string "str"               */
        char    fill;       /* Fill character (' ' or '0')          */
        int     leftjust;       /* 0 = right-justified, else left-just  */
        int     fmax,fmin;      /* Field specifications % MIN . MAX s   */
        int     leading;        /* No. of leading/trailing fill chars   */
        char    sign;       /* Set to '-' for negative decimals     */
        char    digit1;     /* Offset to add to first numeric digit */
        long    larg;

        for(;;) 
        {
                /* Echo characters until '%' or end of fmt string */
                while( (c = *fmt++) != '%' ) 
                {
                        if( c == '\0' )
                        { return; }
                        (*func)(farg,c);
                }
                /* Echo "...%%..." as '%' */
                if( *fmt == '%' ) 
                {
                        (*func)(farg,*fmt++);
                        continue;
                }
                /* Check for "%-..." == Left-justified output */
                if ((leftjust = ((*fmt=='-')) ? 1 : 0) )
                { fmt++; }
                /* Allow for zero-filled numeric outputs ("%0...") */
                fill = (*fmt=='0') ? *fmt++ : ' ';
                /* Allow for minimum field width specifier for %d,u,x,o,c,s*/
                /* Also allow %* for variable width (%0* as well)       */
                fmin = 0;
                if( *fmt == '*' ) 
                {
                        fmin = va_arg (ap, int);
                        ++fmt;
                }
                else
                {
                        while( '0' <= *fmt && *fmt <= '9' ) 
                        { fmin = fmin * 10 + *fmt++ - '0';}
                }
                /* Allow for maximum string width for %s */
                fmax = 0;
                if( *fmt == '.' ) 
                {
                        if( *(++fmt) == '*' ) 
                        {
                                fmax = va_arg (ap, int);
                                ++fmt;
                        }
                        else 
                        {
                                while( '0' <= *fmt && *fmt <= '9' ) 
                                { fmax = fmax * 10 + *fmt++ - '0'; }
                        }
                }
                
                str = string;
                if( (f= *fmt++) == '\0' ) 
                {
                        (*func)(farg,'%');
                        return;
                }
                sign = '\0';    /* sign == '-' for negative decimal */

                switch( f ) 
                {
                    case 'c' :
                                string[0] = va_arg(ap, int);
                                string[1] = '\0';
                                fmax = 0;
                                fill = ' ';
                                break;

                    case 's' :
                                str = va_arg(ap, char *);
                                fill = ' ';
                                break;

                    case 'd' :
                        larg = va_arg(ap, long);
                                if (larg < 0) 
                                {
                                        sign = '-';
                                        larg = -larg;
                                }
                                _prtl10(larg, str);
                                break;

                    case 'u':
                        digit1 = '\0';
                                /* "negative" longs in unsigned format  */
                                /* can't be computed with long division */
                                /* convert *args to "positive", digit1  */
                                /* = how much to add back afterwards    */
                                larg = va_arg(ap, long);
                                while(larg < 0) 
                                {
                                        larg -= 1000000000L;
                                        ++digit1;
                                }
                                _prtl10(larg, str);
                                str[0] += digit1;
                                fmax = 0;
                                break;

                    case 'o' :
                        larg = va_arg(ap, long);
                                _prtl8(larg, str);
                                fmax = 0;
                                break;

                    case 'X' :
                        larg = va_arg(ap, long);
                        _prtX16(larg, str);
                                fmax = 0;
                                break;

                    case 'x' :
                        larg = va_arg(ap, long);
                        _prtl16(larg, str);
                                fmax = 0;
                                break;

                    case 'b' :
                        larg = va_arg(ap, long);
                                _prtl2(larg, str);
                                fmax = 0;
                                break;

                    default :
                                (*func)(farg,f);
                                break;
                }
                for(length = 0; str[length] != '\0'; length++)
                { ; }
                if ( fmin > MAXSTR || fmin < 0 )
                { fmin = 0; }
                if ( fmax > MAXSTR || fmax < 0 )
                { fmax = 0; }
                leading = 0;
                if ( fmax != 0 || fmin != 0 ) 
                {
                        if ( fmax != 0 )
                        {
                                if ( length > fmax )
                                { length = fmax; }
                        }
                        if ( fmin != 0 )
                        { leading = fmin - length; }
                        if ( sign == '-' )
                        { --leading; }
                }
                if( sign == '-' && fill == '0' )
                { (*func)(farg,sign); }
                if( leftjust == 0 )
                {
                        for( i = 0; i < leading; i++ )
                        { (*func)(farg,fill); }
                }
                if( sign == '-' && fill == ' ' )
                { (*func)(farg,sign); }
                for( i = 0 ; i < length ; i++ )
                { (*func)(farg,str[i]); }
                if ( leftjust != 0 )
                {
                        for( i = 0; i < leading; i++ )
                          (*func)(farg,fill);
                }
        }

}

local void _prtl10(long num, char *str)
{
        int     i;
        char    temp[11];

        temp[0] = '\0';
        for(i = 1; i <= 10; i++)  {
                temp[i] = num % 10 + '0';
                num /= 10;
        }
        for(i = 10; temp[i] == '0'; i--);
        if( i == 0 )
                i++;
        while( i >= 0 )
                *str++ = temp[i--];
}

local void _prtl8(long num, char *str)
{
        int     i;
        char    temp[12];

        temp[0] = '\0';
        for(i = 1; i <= 11; i++)  {
                temp[i] = (num & 07) + '0';
                num = num >> 3;
        }
        temp[11] &= '3';
        for(i = 11; temp[i] == '0'; i--);
        if( i == 0 )
                i++;
        while( i >= 0 )
                *str++ = temp[i--];
}

local void _prtl16(long num, char *str)
{
        int     i;
        char    temp[9];

        temp[0] = '\0';
        for(i = 1; i <= 8; i++)  {
                temp[i] = "0123456789abcdef"[num & 0x0F];
                num = num >> 4;
        }
        for(i = 8; temp[i] == '0'; i--);
        if( i == 0 )
                i++;
        while( i >= 0 )
                *str++ = temp[i--];
}

local void _prtX16(long num, char *str)
{
        int     i;
        char    temp[9];

        temp[0] = '\0';
        for(i = 1; i <= 8; i++)  {
                temp[i] = "0123456789ABCDEF"[num & 0x0F];
                num = num >> 4;
        }
        for(i = 8; temp[i] == '0'; i--);
        if( i == 0 )
                i++;
        while( i >= 0 )
                *str++ = temp[i--];
}

local void _prtl2(long num, char *str)
{
        int     i;
        char    temp[35];

        temp[0] = '\0';
        for(i = 1; i <= 32; i++)  {
                temp[i] = ((num%2) == 0) ? '0' : '1';
                num = num >> 1;
        }
        for(i = 32; temp[i] == '0'; i--);
        if( i == 0 )
                i++;
        while( i >= 0 )
                *str++ = temp[i--];
}

---