#include <sm/gen.h>
SM_IDSTR(id, "@(#)$Id: vfprintf.c,v 1.54 2005/05/16 03:52:00 ca Exp $")
#include <sys/types.h>
#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include <sm/config.h>
#include <sm/varargs.h>
#include <sm/io.h>
#include <sm/heap.h>
#include <sm/conf.h>
#include "local.h"
#include "fvwrite.h"
static int sm_bprintf __P((SM_FILE_T *, const char *, va_list));
static void sm_find_arguments __P((const char *, va_list , va_list **));
static void sm_grow_type_table_x __P((unsigned char **, int *));
static int sm_print __P((SM_FILE_T *, int, struct sm_uio *));
static int
sm_print(fp, timeout, uio)
SM_FILE_T *fp;
int timeout;
register struct sm_uio *uio;
{
register int err;
if (uio->uio_resid == 0)
{
uio->uio_iovcnt = 0;
return 0;
}
err = sm_fvwrite(fp, timeout, uio);
uio->uio_resid = 0;
uio->uio_iovcnt = 0;
return err;
}
static int
sm_bprintf(fp, fmt, ap)
SM_FILE_T *fp;
const char *fmt;
SM_VA_LOCAL_DECL
{
int ret;
SM_FILE_T fake;
unsigned char buf[SM_IO_BUFSIZ];
extern const char SmFileMagic[];
fake.sm_magic = SmFileMagic;
fake.f_timeout = SM_TIME_FOREVER;
fake.f_timeoutstate = SM_TIME_BLOCK;
fake.f_flags = fp->f_flags & ~SMNBF;
fake.f_file = fp->f_file;
fake.f_cookie = fp->f_cookie;
fake.f_write = fp->f_write;
fake.f_close = NULL;
fake.f_open = NULL;
fake.f_read = NULL;
fake.f_seek = NULL;
fake.f_setinfo = fake.f_getinfo = NULL;
fake.f_type = "sm_bprintf:fake";
fake.f_bf.smb_base = fake.f_p = buf;
fake.f_bf.smb_size = fake.f_w = sizeof(buf);
fake.f_lbfsize = 0;
ret = sm_io_vfprintf(&fake, SM_TIME_FOREVER, fmt, ap);
if (ret >= 0 && sm_io_flush(&fake, SM_TIME_FOREVER))
ret = SM_IO_EOF;
if (fake.f_flags & SMERR)
fp->f_flags |= SMERR;
return ret;
}
#define BUF 40
#define STATIC_ARG_TBL_SIZE 8
#define to_digit(c) ((c) - '0')
#define is_digit(c) ((unsigned) to_digit(c) <= 9)
#define to_char(n) ((char) (n) + '0')
#define ALT 0x001
#define HEXPREFIX 0x002
#define LADJUST 0x004
#define LONGINT 0x010
#define QUADINT 0x020
#define SHORTINT 0x040
#define ZEROPAD 0x080
#define FPT 0x100
int
sm_io_vfprintf(fp, timeout, fmt0, ap)
SM_FILE_T *fp;
int timeout;
const char *fmt0;
SM_VA_LOCAL_DECL
{
register char *fmt;
register int ch;
register int n, m, n2;
register char *cp;
register struct sm_iov *iovp;
register int flags;
int ret;
int width;
int prec;
char sign;
wchar_t wc;
ULONGLONG_T _uquad;
enum { OCT, DEC, HEX } base;
int dprec;
int realsz;
int size;
char *xdigs="0123456789abcdef";
#define NIOV 8
struct sm_uio uio;
struct sm_iov iov[NIOV];
char buf[BUF];
char ox[2];
va_list *argtable;
va_list statargtable[STATIC_ARG_TBL_SIZE];
int nextarg;
va_list orgap;
#define PADSIZE 16
static char blanks[PADSIZE] =
{' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' '};
static char zeroes[PADSIZE] =
{'0','0','0','0','0','0','0','0','0','0','0','0','0','0','0','0'};
#define PRINT(ptr, len) do { \
iovp->iov_base = (ptr); \
iovp->iov_len = (len); \
uio.uio_resid += (len); \
iovp++; \
if (++uio.uio_iovcnt >= NIOV) \
{ \
if (sm_print(fp, timeout, &uio)) \
goto error; \
iovp = iov; \
} \
} while (0)
#define PAD(howmany, with) do \
{ \
if ((n = (howmany)) > 0) \
{ \
while (n > PADSIZE) { \
PRINT(with, PADSIZE); \
n -= PADSIZE; \
} \
PRINT(with, n); \
} \
} while (0)
#define FLUSH() do \
{ \
if (uio.uio_resid && sm_print(fp, timeout, &uio)) \
goto error; \
uio.uio_iovcnt = 0; \
iovp = iov; \
} while (0)
#define SARG() \
(flags&QUADINT ? SM_VA_ARG(ap, LONGLONG_T) : \
flags&LONGINT ? GETARG(long) : \
flags&SHORTINT ? (long) (short) GETARG(int) : \
(long) GETARG(int))
#define UARG() \
(flags&QUADINT ? SM_VA_ARG(ap, ULONGLONG_T) : \
flags&LONGINT ? GETARG(unsigned long) : \
flags&SHORTINT ? (unsigned long) (unsigned short) GETARG(int) : \
(unsigned long) GETARG(unsigned int))
#define GETASTER(val) \
n2 = 0; \
cp = fmt; \
while (is_digit(*cp)) \
{ \
n2 = 10 * n2 + to_digit(*cp); \
cp++; \
} \
if (*cp == '$') \
{ \
int hold = nextarg; \
if (argtable == NULL) \
{ \
argtable = statargtable; \
sm_find_arguments(fmt0, orgap, &argtable); \
} \
nextarg = n2; \
val = GETARG(int); \
nextarg = hold; \
fmt = ++cp; \
} \
else \
{ \
val = GETARG(int); \
}
#if SM_VA_STD
# define GETARG(type) \
(((argtable != NULL) ? (void) (ap = argtable[nextarg]) : (void) 0), \
nextarg++, SM_VA_ARG(ap, type))
#else
# define GETARG(type) \
((argtable != NULL) ? (*((type*)(argtable[nextarg++]))) : \
(nextarg++, SM_VA_ARG(ap, type)))
#endif
if (cantwrite(fp))
{
errno = EBADF;
return SM_IO_EOF;
}
if ((fp->f_flags & (SMNBF|SMWR|SMRW)) == (SMNBF|SMWR) &&
fp->f_file >= 0)
return sm_bprintf(fp, fmt0, ap);
fmt = (char *) fmt0;
argtable = NULL;
nextarg = 1;
SM_VA_COPY(orgap, ap);
uio.uio_iov = iovp = iov;
uio.uio_resid = 0;
uio.uio_iovcnt = 0;
ret = 0;
for (;;)
{
cp = fmt;
n = 0;
while ((wc = *fmt) != '\0')
{
if (wc == '%')
{
n = 1;
break;
}
fmt++;
}
if ((m = fmt - cp) != 0)
{
PRINT(cp, m);
ret += m;
}
if (n <= 0)
goto done;
fmt++;
flags = 0;
dprec = 0;
width = 0;
prec = -1;
sign = '\0';
rflag: ch = *fmt++;
reswitch: switch (ch)
{
case ' ':
if (!sign)
sign = ' ';
goto rflag;
case '#':
flags |= ALT;
goto rflag;
case '*':
GETASTER(width);
if (width >= 0)
goto rflag;
width = -width;
case '-':
flags |= LADJUST;
goto rflag;
case '+':
sign = '+';
goto rflag;
case '.':
if ((ch = *fmt++) == '*')
{
GETASTER(n);
prec = n < 0 ? -1 : n;
goto rflag;
}
n = 0;
while (is_digit(ch))
{
n = 10 * n + to_digit(ch);
ch = *fmt++;
}
if (ch == '$')
{
nextarg = n;
if (argtable == NULL)
{
argtable = statargtable;
sm_find_arguments(fmt0, orgap,
&argtable);
}
goto rflag;
}
prec = n < 0 ? -1 : n;
goto reswitch;
case '0':
flags |= ZEROPAD;
goto rflag;
case '1': case '2': case '3': case '4':
case '5': case '6': case '7': case '8': case '9':
n = 0;
do
{
n = 10 * n + to_digit(ch);
ch = *fmt++;
} while (is_digit(ch));
if (ch == '$')
{
nextarg = n;
if (argtable == NULL)
{
argtable = statargtable;
sm_find_arguments(fmt0, orgap,
&argtable);
}
goto rflag;
}
width = n;
goto reswitch;
case 'h':
flags |= SHORTINT;
goto rflag;
case 'l':
if (*fmt == 'l')
{
fmt++;
flags |= QUADINT;
}
else
{
flags |= LONGINT;
}
goto rflag;
case 'q':
flags |= QUADINT;
goto rflag;
case 'c':
*(cp = buf) = GETARG(int);
size = 1;
sign = '\0';
break;
case 'D':
flags |= LONGINT;
case 'd':
case 'i':
_uquad = SARG();
if ((LONGLONG_T) _uquad < 0)
{
_uquad = -(LONGLONG_T) _uquad;
sign = '-';
}
base = DEC;
goto number;
case 'e':
case 'E':
case 'f':
case 'g':
case 'G':
{
double val;
char *p;
char fmt[16];
char out[150];
size_t len;
val = GETARG(double);
p = fmt;
*p++ = '%';
if (sign)
*p++ = sign;
if (flags & ALT)
*p++ = '#';
if (flags & LADJUST)
*p++ = '-';
if (flags & ZEROPAD)
*p++ = '0';
*p++ = '*';
if (prec >= 0)
{
*p++ = '.';
*p++ = '*';
}
*p++ = ch;
*p = '\0';
if (width > 120)
width = 120;
if (prec > 120)
prec = 120;
if (prec >= 0)
#if HASSNPRINTF
snprintf(out, sizeof(out), fmt, width,
prec, val);
#else
sprintf(out, fmt, width, prec, val);
#endif
else
#if HASSNPRINTF
snprintf(out, sizeof(out), fmt, width,
val);
#else
sprintf(out, fmt, width, val);
#endif
len = strlen(out);
PRINT(out, len);
FLUSH();
continue;
}
case 'n':
if (flags & QUADINT)
*GETARG(LONGLONG_T *) = ret;
else if (flags & LONGINT)
*GETARG(long *) = ret;
else if (flags & SHORTINT)
*GETARG(short *) = ret;
else
*GETARG(int *) = ret;
continue;
case 'O':
flags |= LONGINT;
case 'o':
_uquad = UARG();
base = OCT;
goto nosign;
case 'p':
{
union
{
void *p;
ULONGLONG_T ll;
unsigned long l;
unsigned i;
} u;
u.p = GETARG(void *);
if (sizeof(void *) == sizeof(ULONGLONG_T))
_uquad = u.ll;
else if (sizeof(void *) == sizeof(long))
_uquad = u.l;
else
_uquad = u.i;
}
base = HEX;
xdigs = "0123456789abcdef";
flags |= HEXPREFIX;
ch = 'x';
goto nosign;
case 's':
if ((cp = GETARG(char *)) == NULL)
cp = "(null)";
if (prec >= 0)
{
char *p = memchr(cp, 0, prec);
if (p != NULL)
{
size = p - cp;
if (size > prec)
size = prec;
}
else
size = prec;
}
else
size = strlen(cp);
sign = '\0';
break;
case 'U':
flags |= LONGINT;
case 'u':
_uquad = UARG();
base = DEC;
goto nosign;
case 'X':
xdigs = "0123456789ABCDEF";
goto hex;
case 'x':
xdigs = "0123456789abcdef";
hex: _uquad = UARG();
base = HEX;
if (flags & ALT && _uquad != 0)
flags |= HEXPREFIX;
nosign: sign = '\0';
number: if ((dprec = prec) >= 0)
flags &= ~ZEROPAD;
cp = buf + BUF;
if (_uquad != 0 || prec != 0)
{
switch (base)
{
case OCT:
do
{
*--cp = to_char(_uquad & 7);
_uquad >>= 3;
} while (_uquad);
if (flags & ALT && *cp != '0')
*--cp = '0';
break;
case DEC:
while (_uquad >= 10)
{
*--cp = to_char(_uquad % 10);
_uquad /= 10;
}
*--cp = to_char(_uquad);
break;
case HEX:
do
{
*--cp = xdigs[_uquad & 15];
_uquad >>= 4;
} while (_uquad);
break;
default:
cp = "bug in sm_io_vfprintf: bad base";
size = strlen(cp);
goto skipsize;
}
}
size = buf + BUF - cp;
skipsize:
break;
default:
if (ch == '\0')
goto done;
cp = buf;
*cp = ch;
size = 1;
sign = '\0';
break;
}
realsz = dprec > size ? dprec : size;
if (sign)
realsz++;
else if (flags & HEXPREFIX)
realsz+= 2;
if ((flags & (LADJUST|ZEROPAD)) == 0)
PAD(width - realsz, blanks);
if (sign)
{
PRINT(&sign, 1);
}
else if (flags & HEXPREFIX)
{
ox[0] = '0';
ox[1] = ch;
PRINT(ox, 2);
}
if ((flags & (LADJUST|ZEROPAD)) == ZEROPAD)
PAD(width - realsz, zeroes);
PAD(dprec - size, zeroes);
PRINT(cp, size);
if (flags & LADJUST)
PAD(width - realsz, blanks);
ret += width > realsz ? width : realsz;
FLUSH();
}
done:
FLUSH();
error:
if ((argtable != NULL) && (argtable != statargtable))
sm_free(argtable);
return sm_error(fp) ? SM_IO_EOF : ret;
}
#define T_UNUSED 0
#define T_SHORT 1
#define T_U_SHORT 2
#define TP_SHORT 3
#define T_INT 4
#define T_U_INT 5
#define TP_INT 6
#define T_LONG 7
#define T_U_LONG 8
#define TP_LONG 9
#define T_QUAD 10
#define T_U_QUAD 11
#define TP_QUAD 12
#define T_DOUBLE 13
#define TP_CHAR 15
#define TP_VOID 16
static void
sm_find_arguments(fmt0, ap, argtable)
const char *fmt0;
SM_VA_LOCAL_DECL
va_list **argtable;
{
register char *fmt;
register int ch;
register int n, n2;
register char *cp;
register int flags;
unsigned char *typetable;
unsigned char stattypetable[STATIC_ARG_TBL_SIZE];
int tablesize;
int tablemax;
int nextarg;
#define ADDTYPE(type) \
((nextarg >= tablesize) ? \
(sm_grow_type_table_x(&typetable, &tablesize), 0) : 0, \
typetable[nextarg++] = type, \
(nextarg > tablemax) ? tablemax = nextarg : 0)
#define ADDSARG() \
((flags & LONGINT) ? ADDTYPE(T_LONG) : \
((flags & SHORTINT) ? ADDTYPE(T_SHORT) : ADDTYPE(T_INT)))
#define ADDUARG() \
((flags & LONGINT) ? ADDTYPE(T_U_LONG) : \
((flags & SHORTINT) ? ADDTYPE(T_U_SHORT) : ADDTYPE(T_U_INT)))
#define ADDASTER() \
n2 = 0; \
cp = fmt; \
while (is_digit(*cp)) \
{ \
n2 = 10 * n2 + to_digit(*cp); \
cp++; \
} \
if (*cp == '$') \
{ \
int hold = nextarg; \
nextarg = n2; \
ADDTYPE (T_INT); \
nextarg = hold; \
fmt = ++cp; \
} \
else \
{ \
ADDTYPE (T_INT); \
}
fmt = (char *) fmt0;
typetable = stattypetable;
tablesize = STATIC_ARG_TBL_SIZE;
tablemax = 0;
nextarg = 1;
(void) memset(typetable, T_UNUSED, STATIC_ARG_TBL_SIZE);
for (;;)
{
for (cp = fmt; (ch = *fmt) != '\0' && ch != '%'; fmt++)
;
if (ch == '\0')
goto done;
fmt++;
flags = 0;
rflag: ch = *fmt++;
reswitch: switch (ch)
{
case ' ':
case '#':
goto rflag;
case '*':
ADDASTER();
goto rflag;
case '-':
case '+':
goto rflag;
case '.':
if ((ch = *fmt++) == '*')
{
ADDASTER();
goto rflag;
}
while (is_digit(ch))
{
ch = *fmt++;
}
goto reswitch;
case '0':
goto rflag;
case '1': case '2': case '3': case '4':
case '5': case '6': case '7': case '8': case '9':
n = 0;
do
{
n = 10 * n + to_digit(ch);
ch = *fmt++;
} while (is_digit(ch));
if (ch == '$')
{
nextarg = n;
goto rflag;
}
goto reswitch;
case 'h':
flags |= SHORTINT;
goto rflag;
case 'l':
flags |= LONGINT;
goto rflag;
case 'q':
flags |= QUADINT;
goto rflag;
case 'c':
ADDTYPE(T_INT);
break;
case 'D':
flags |= LONGINT;
case 'd':
case 'i':
if (flags & QUADINT)
{
ADDTYPE(T_QUAD);
}
else
{
ADDSARG();
}
break;
case 'e':
case 'E':
case 'f':
case 'g':
case 'G':
ADDTYPE(T_DOUBLE);
break;
case 'n':
if (flags & QUADINT)
ADDTYPE(TP_QUAD);
else if (flags & LONGINT)
ADDTYPE(TP_LONG);
else if (flags & SHORTINT)
ADDTYPE(TP_SHORT);
else
ADDTYPE(TP_INT);
continue;
case 'O':
flags |= LONGINT;
case 'o':
if (flags & QUADINT)
ADDTYPE(T_U_QUAD);
else
ADDUARG();
break;
case 'p':
ADDTYPE(TP_VOID);
break;
case 's':
ADDTYPE(TP_CHAR);
break;
case 'U':
flags |= LONGINT;
case 'u':
if (flags & QUADINT)
ADDTYPE(T_U_QUAD);
else
ADDUARG();
break;
case 'X':
case 'x':
if (flags & QUADINT)
ADDTYPE(T_U_QUAD);
else
ADDUARG();
break;
default:
if (ch == '\0')
goto done;
break;
}
}
done:
if (tablemax >= STATIC_ARG_TBL_SIZE)
{
*argtable = (va_list *)
sm_malloc(sizeof(va_list) * (tablemax + 1));
}
for (n = 1; n <= tablemax; n++)
{
SM_VA_COPY((*argtable)[n], ap);
switch (typetable [n])
{
case T_UNUSED:
(void) SM_VA_ARG(ap, int);
break;
case T_SHORT:
(void) SM_VA_ARG(ap, int);
break;
case T_U_SHORT:
(void) SM_VA_ARG(ap, int);
break;
case TP_SHORT:
(void) SM_VA_ARG(ap, short *);
break;
case T_INT:
(void) SM_VA_ARG(ap, int);
break;
case T_U_INT:
(void) SM_VA_ARG(ap, unsigned int);
break;
case TP_INT:
(void) SM_VA_ARG(ap, int *);
break;
case T_LONG:
(void) SM_VA_ARG(ap, long);
break;
case T_U_LONG:
(void) SM_VA_ARG(ap, unsigned long);
break;
case TP_LONG:
(void) SM_VA_ARG(ap, long *);
break;
case T_QUAD:
(void) SM_VA_ARG(ap, LONGLONG_T);
break;
case T_U_QUAD:
(void) SM_VA_ARG(ap, ULONGLONG_T);
break;
case TP_QUAD:
(void) SM_VA_ARG(ap, LONGLONG_T *);
break;
case T_DOUBLE:
(void) SM_VA_ARG(ap, double);
break;
case TP_CHAR:
(void) SM_VA_ARG(ap, char *);
break;
case TP_VOID:
(void) SM_VA_ARG(ap, void *);
break;
}
}
if ((typetable != NULL) && (typetable != stattypetable))
sm_free(typetable);
}
static void
sm_grow_type_table_x(typetable, tablesize)
unsigned char **typetable;
int *tablesize;
{
unsigned char *oldtable = *typetable;
int newsize = *tablesize * 2;
if (*tablesize == STATIC_ARG_TBL_SIZE)
{
*typetable = (unsigned char *) sm_malloc_x(sizeof(unsigned char)
* newsize);
(void) memmove(*typetable, oldtable, *tablesize);
}
else
{
*typetable = (unsigned char *) sm_realloc_x(typetable,
sizeof(unsigned char) * newsize);
}
(void) memset(&typetable [*tablesize], T_UNUSED,
(newsize - *tablesize));
*tablesize = newsize;
}