#include <sm/gen.h>
SM_IDSTR(id, "@(#)$Id: vfscanf.c,v 1.54 2006/10/12 22:03:52 ca Exp $")
#include <ctype.h>
#include <stdlib.h>
#include <errno.h>
#include <setjmp.h>
#include <sm/time.h>
#include <sm/varargs.h>
#include <sm/config.h>
#include <sm/io.h>
#include <sm/signal.h>
#include <sm/clock.h>
#include <sm/string.h>
#include "local.h"
#define BUF 513
#define LONG 0x01
#define SHORT 0x04
#define QUAD 0x08
#define SUPPRESS 0x10
#define POINTER 0x20
#define NOSKIP 0x40
#define SIGNOK 0x080
#define NDIGITS 0x100
#define DPTOK 0x200
#define EXPOK 0x400
#define PFXOK 0x200
#define NZDIGITS 0x400
#define CT_CHAR 0
#define CT_CCL 1
#define CT_STRING 2
#define CT_INT 3
#define CT_FLOAT 4
static void scanalrm __P((int));
static unsigned char *sm_sccl __P((char *, unsigned char *));
static jmp_buf ScanTimeOut;
static void
scanalrm(sig)
int sig;
{
longjmp(ScanTimeOut, 1);
}
int
sm_vfscanf(fp, timeout, fmt0, ap)
register SM_FILE_T *fp;
int SM_NONVOLATILE timeout;
char const *fmt0;
va_list SM_NONVOLATILE ap;
{
register unsigned char *SM_NONVOLATILE fmt = (unsigned char *) fmt0;
register int c;
register size_t width;
register char *p;
register int n;
register int flags;
register char *p0;
int nassigned;
int nread;
int base;
ULONGLONG_T (*ccfn) __P((const char *, char **, int));
char ccltab[256];
char buf[BUF];
SM_EVENT *evt = NULL;
static short basefix[17] =
{ 10, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16 };
if (timeout == SM_TIME_DEFAULT)
timeout = fp->f_timeout;
if (timeout == SM_TIME_IMMEDIATE)
{
errno = EAGAIN;
return SM_IO_EOF;
}
if (timeout != SM_TIME_FOREVER)
{
if (setjmp(ScanTimeOut) != 0)
{
errno = EAGAIN;
return SM_IO_EOF;
}
evt = sm_seteventm(timeout, scanalrm, 0);
}
nassigned = 0;
nread = 0;
base = 0;
ccfn = NULL;
for (;;)
{
c = *fmt++;
if (c == 0)
{
if (evt != NULL)
sm_clrevent(evt);
return nassigned;
}
if (isspace(c))
{
while ((fp->f_r > 0 || sm_refill(fp, SM_TIME_FOREVER)
== 0) &&
isspace(*fp->f_p))
nread++, fp->f_r--, fp->f_p++;
continue;
}
if (c != '%')
goto literal;
width = 0;
flags = 0;
again: c = *fmt++;
switch (c)
{
case '%':
literal:
if (fp->f_r <= 0 && sm_refill(fp, SM_TIME_FOREVER))
goto input_failure;
if (*fp->f_p != c)
goto match_failure;
fp->f_r--, fp->f_p++;
nread++;
continue;
case '*':
flags |= SUPPRESS;
goto again;
case 'h':
flags |= SHORT;
goto again;
case 'l':
if (*fmt == 'l')
{
fmt++;
flags |= QUAD;
}
else
{
flags |= LONG;
}
goto again;
case 'q':
flags |= QUAD;
goto again;
case '0': case '1': case '2': case '3': case '4':
case '5': case '6': case '7': case '8': case '9':
width = width * 10 + c - '0';
goto again;
case 'D':
flags |= LONG;
case 'd':
c = CT_INT;
ccfn = (ULONGLONG_T (*)())sm_strtoll;
base = 10;
break;
case 'i':
c = CT_INT;
ccfn = (ULONGLONG_T (*)())sm_strtoll;
base = 0;
break;
case 'O':
flags |= LONG;
case 'o':
c = CT_INT;
ccfn = sm_strtoull;
base = 8;
break;
case 'u':
c = CT_INT;
ccfn = sm_strtoull;
base = 10;
break;
case 'X':
case 'x':
flags |= PFXOK;
c = CT_INT;
ccfn = sm_strtoull;
base = 16;
break;
case 'E':
case 'G':
case 'e':
case 'f':
case 'g':
c = CT_FLOAT;
break;
case 's':
c = CT_STRING;
break;
case '[':
fmt = sm_sccl(ccltab, fmt);
flags |= NOSKIP;
c = CT_CCL;
break;
case 'c':
flags |= NOSKIP;
c = CT_CHAR;
break;
case 'p':
flags |= POINTER | PFXOK;
c = CT_INT;
ccfn = sm_strtoull;
base = 16;
break;
case 'n':
if (flags & SUPPRESS)
continue;
if (flags & SHORT)
*SM_VA_ARG(ap, short *) = nread;
else if (flags & LONG)
*SM_VA_ARG(ap, long *) = nread;
else
*SM_VA_ARG(ap, int *) = nread;
continue;
case '\0':
if (evt != NULL)
sm_clrevent(evt);
return SM_IO_EOF;
default:
if (isupper(c))
flags |= LONG;
c = CT_INT;
ccfn = (ULONGLONG_T (*)()) sm_strtoll;
base = 10;
break;
}
if (fp->f_r <= 0 && sm_refill(fp, SM_TIME_FOREVER))
goto input_failure;
if ((flags & NOSKIP) == 0)
{
while (isspace(*fp->f_p))
{
nread++;
if (--fp->f_r > 0)
fp->f_p++;
else if (sm_refill(fp, SM_TIME_FOREVER))
goto input_failure;
}
}
switch (c)
{
case CT_CHAR:
if (width == 0)
width = 1;
if (flags & SUPPRESS)
{
size_t sum = 0;
for (;;)
{
if ((size_t) (n = fp->f_r) < width)
{
sum += n;
width -= n;
fp->f_p += n;
if (sm_refill(fp,
SM_TIME_FOREVER))
{
if (sum == 0)
goto input_failure;
break;
}
}
else
{
sum += width;
fp->f_r -= width;
fp->f_p += width;
break;
}
}
nread += sum;
}
else
{
size_t r;
r = sm_io_read(fp, SM_TIME_FOREVER,
(void *) SM_VA_ARG(ap, char *),
width);
if (r == 0)
goto input_failure;
nread += r;
nassigned++;
}
break;
case CT_CCL:
if (width == 0)
width = (size_t)~0;
if (flags & SUPPRESS)
{
n = 0;
while (ccltab[*fp->f_p] != '\0')
{
n++, fp->f_r--, fp->f_p++;
if (--width == 0)
break;
if (fp->f_r <= 0 &&
sm_refill(fp, SM_TIME_FOREVER))
{
if (n == 0)
goto input_failure;
break;
}
}
if (n == 0)
goto match_failure;
}
else
{
p0 = p = SM_VA_ARG(ap, char *);
while (ccltab[*fp->f_p] != '\0')
{
fp->f_r--;
*p++ = *fp->f_p++;
if (--width == 0)
break;
if (fp->f_r <= 0 &&
sm_refill(fp, SM_TIME_FOREVER))
{
if (p == p0)
goto input_failure;
break;
}
}
n = p - p0;
if (n == 0)
goto match_failure;
*p = 0;
nassigned++;
}
nread += n;
break;
case CT_STRING:
if (width == 0)
width = (size_t)~0;
if (flags & SUPPRESS)
{
n = 0;
while (!isspace(*fp->f_p))
{
n++, fp->f_r--, fp->f_p++;
if (--width == 0)
break;
if (fp->f_r <= 0 &&
sm_refill(fp, SM_TIME_FOREVER))
break;
}
nread += n;
}
else
{
p0 = p = SM_VA_ARG(ap, char *);
while (!isspace(*fp->f_p))
{
fp->f_r--;
*p++ = *fp->f_p++;
if (--width == 0)
break;
if (fp->f_r <= 0 &&
sm_refill(fp, SM_TIME_FOREVER))
break;
}
*p = 0;
nread += p - p0;
nassigned++;
}
continue;
case CT_INT:
#if SM_CONF_BROKEN_SIZE_T
if (width == 0 || width > sizeof(buf) - 1)
width = sizeof(buf) - 1;
#else
if (--width > sizeof(buf) - 2)
width = sizeof(buf) - 2;
width++;
#endif
flags |= SIGNOK | NDIGITS | NZDIGITS;
for (p = buf; width > 0; width--)
{
c = *fp->f_p;
switch (c)
{
case '0':
if (base == 0)
{
base = 8;
flags |= PFXOK;
}
if (flags & NZDIGITS)
flags &= ~(SIGNOK|NZDIGITS|NDIGITS);
else
flags &= ~(SIGNOK|PFXOK|NDIGITS);
goto ok;
case '1': case '2': case '3':
case '4': case '5': case '6': case '7':
base = basefix[base];
flags &= ~(SIGNOK | PFXOK | NDIGITS);
goto ok;
case '8': case '9':
base = basefix[base];
if (base <= 8)
break;
flags &= ~(SIGNOK | PFXOK | NDIGITS);
goto ok;
case 'A': case 'B': case 'C':
case 'D': case 'E': case 'F':
case 'a': case 'b': case 'c':
case 'd': case 'e': case 'f':
if (base <= 10)
break;
flags &= ~(SIGNOK | PFXOK | NDIGITS);
goto ok;
case '+': case '-':
if (flags & SIGNOK)
{
flags &= ~SIGNOK;
goto ok;
}
break;
case 'x': case 'X':
if (flags & PFXOK && p == buf + 1)
{
base = 16;
flags &= ~PFXOK;
goto ok;
}
break;
}
break;
ok:
*p++ = c;
if (--fp->f_r > 0)
fp->f_p++;
else if (sm_refill(fp, SM_TIME_FOREVER))
break;
}
if (flags & NDIGITS)
{
if (p > buf)
(void) sm_io_ungetc(fp, SM_TIME_DEFAULT,
*(unsigned char *)--p);
goto match_failure;
}
c = ((unsigned char *)p)[-1];
if (c == 'x' || c == 'X')
{
--p;
(void) sm_io_ungetc(fp, SM_TIME_DEFAULT, c);
}
if ((flags & SUPPRESS) == 0)
{
ULONGLONG_T res;
*p = 0;
res = (*ccfn)(buf, (char **)NULL, base);
if (flags & POINTER)
*SM_VA_ARG(ap, void **) =
(void *)(long) res;
else if (flags & QUAD)
*SM_VA_ARG(ap, LONGLONG_T *) = res;
else if (flags & LONG)
*SM_VA_ARG(ap, long *) = res;
else if (flags & SHORT)
*SM_VA_ARG(ap, short *) = res;
else
*SM_VA_ARG(ap, int *) = res;
nassigned++;
}
nread += p - buf;
break;
case CT_FLOAT:
if (width == 0 || width > sizeof(buf) - 1)
width = sizeof(buf) - 1;
flags |= SIGNOK | NDIGITS | DPTOK | EXPOK;
for (p = buf; width; width--)
{
c = *fp->f_p;
switch (c)
{
case '0': case '1': case '2': case '3':
case '4': case '5': case '6': case '7':
case '8': case '9':
flags &= ~(SIGNOK | NDIGITS);
goto fok;
case '+': case '-':
if (flags & SIGNOK)
{
flags &= ~SIGNOK;
goto fok;
}
break;
case '.':
if (flags & DPTOK)
{
flags &= ~(SIGNOK | DPTOK);
goto fok;
}
break;
case 'e': case 'E':
if ((flags&(NDIGITS|EXPOK)) == EXPOK)
{
flags =
(flags & ~(EXPOK|DPTOK)) |
SIGNOK | NDIGITS;
goto fok;
}
break;
}
break;
fok:
*p++ = c;
if (--fp->f_r > 0)
fp->f_p++;
else if (sm_refill(fp, SM_TIME_FOREVER))
break;
}
if (flags & NDIGITS)
{
if (flags & EXPOK)
{
while (p > buf)
(void) sm_io_ungetc(fp,
SM_TIME_DEFAULT,
*(unsigned char *)--p);
goto match_failure;
}
c = *(unsigned char *) --p;
if (c != 'e' && c != 'E')
{
(void) sm_io_ungetc(fp, SM_TIME_DEFAULT,
c);
c = *(unsigned char *)--p;
}
(void) sm_io_ungetc(fp, SM_TIME_DEFAULT, c);
}
if ((flags & SUPPRESS) == 0)
{
double res;
*p = 0;
res = strtod(buf, (char **) NULL);
if (flags & LONG)
*SM_VA_ARG(ap, double *) = res;
else
*SM_VA_ARG(ap, float *) = res;
nassigned++;
}
nread += p - buf;
break;
}
}
input_failure:
if (evt != NULL)
sm_clrevent(evt);
return nassigned ? nassigned : -1;
match_failure:
if (evt != NULL)
sm_clrevent(evt);
return nassigned;
}
static unsigned char *
sm_sccl(tab, fmt)
register char *tab;
register unsigned char *fmt;
{
register int c, n, v;
c = *fmt++;
if (c == '^')
{
v = 1;
c = *fmt++;
}
else
v = 0;
for (n = 0; n < 256; n++)
tab[n] = v;
if (c == 0)
return fmt - 1;
v = 1 - v;
for (;;)
{
tab[c] = v;
doswitch:
n = *fmt++;
switch (n)
{
case 0:
return fmt - 1;
case '-':
n = *fmt;
if (n == ']' || n < c)
{
c = '-';
break;
}
fmt++;
do
{
tab[++c] = v;
} while (c < n);
#if 1
goto doswitch;
#else
c = *fmt++;
if (c == 0)
return fmt - 1;
if (c == ']')
return fmt;
break;
#endif
case ']':
return fmt;
default:
c = n;
break;
}
}
}