/**************************************************************************** * lib/stdio/lib_sscanf.c * * Copyright (C) 2007, 2008, 2011-2012 Gregory Nutt. All rights reserved. * Author: Gregory Nutt * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in * the documentation and/or other materials provided with the * distribution. * 3. Neither the name NuttX nor the names of its contributors may be * used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. * ****************************************************************************/ /**************************************************************************** * Included Files ****************************************************************************/ #include #include #include #include #include #include #include /**************************************************************************** * Definitions ****************************************************************************/ #define MAXLN 128 /**************************************************************************** * Private Type Declarations ****************************************************************************/ /**************************************************************************** * Private Function Prototypes ****************************************************************************/ /**************************************************************************** * Global Function Prototypes ****************************************************************************/ int vsscanf(char *buf, const char *fmt, va_list ap); /************************************************************************** * Global Constant Data **************************************************************************/ /**************************************************************************** * Global Variables ****************************************************************************/ /************************************************************************** * Private Constant Data **************************************************************************/ static const char spaces[] = " \t\n\r\f\v"; /**************************************************************************** * Private Variables ****************************************************************************/ /**************************************************************************** * Function: sscanf * * Description: * ANSI standard sscanf implementation. * ****************************************************************************/ int sscanf(FAR const char *buf, FAR const char *fmt, ...) { va_list ap; int count; va_start(ap, fmt); count = vsscanf((FAR char*)buf, fmt, ap); va_end(ap); return count; } /**************************************************************************** * Function: vsscanf * * Description: * ANSI standard vsscanf implementation. * ****************************************************************************/ int vsscanf(FAR char *buf, FAR const char *fmt, va_list ap) { FAR char *bufstart; FAR char *tv; FAR const char *tc; int count; int noassign; int width; int base = 10; int lflag; char tmp[MAXLN]; lvdbg("vsscanf: buf=\"%s\" fmt=\"%s\"\n", buf, fmt); /* Remember the start of the input buffer. We will need this for %n * calculations. */ bufstart = buf; /* Parse the format, extracting values from the input buffer as needed */ count = 0; noassign = 0; width = 0; lflag = 0; while (*fmt && *buf) { /* Skip over white space */ while (isspace(*fmt)) { fmt++; } /* Check for a conversion specifier */ if (*fmt == '%') { lvdbg("vsscanf: Specifier found\n"); /* Check for qualifiers on the conversion specifier */ fmt++; for (; *fmt; fmt++) { lvdbg("vsscanf: Processing %c\n", *fmt); if (strchr("dibouxcsefgn%", *fmt)) { break; } if (*fmt == '*') { noassign = 1; } else if (*fmt == 'l' || *fmt == 'L') { lflag = 1; } else if (*fmt >= '1' && *fmt <= '9') { for (tc = fmt; isdigit(*fmt); fmt++); strncpy(tmp, tc, fmt - tc); tmp[fmt - tc] = '\0'; width = atoi(tmp); fmt--; } } /* Process %s: String conversion */ if (*fmt == 's') { lvdbg("vsscanf: Performing string conversion\n"); while (isspace(*buf)) { buf++; } /* Was a fieldwidth specified? */ if (!width) { /* No... is there a space after the format? */ #if 0 /* Needs more thought */ if (isspace(*(s + 1)) || *(s + 1) == 0) #endif { /* Use the input up until the first white space is * encountered. NOTE: This means that values on the * input line must be separated by whitespace or they * will get combined! This is a bug. We have no good * way of determining the width of the data if there * is no field with and no space separating the input. */ width = strcspn(buf, spaces); } } if (!noassign) { tv = va_arg(ap, char*); strncpy(tv, buf, width); tv[width] = '\0'; } buf += width; } /* Process %c: Character conversion */ else if (*fmt == 'c') { lvdbg("vsscanf: Performing character conversion\n"); /* Was a fieldwidth specified? */ if (!width) { /* No, then width is this one single character */ width = 1; } if (!noassign) { tv = va_arg(ap, char*); strncpy(tv, buf, width); tv[width] = '\0'; } buf += width; } /* Process %d, %o, %b, %x, %u: Various integer conversions */ else if (strchr("dobxu", *fmt)) { lvdbg("vsscanf: Performing integer conversion\n"); /* Skip over any white space before the integer string */ while (isspace(*buf)) { buf++; } /* The base of the integer conversion depends on the specific * conversion specification. */ if (*fmt == 'd' || *fmt == 'u') { base = 10; } else if (*fmt == 'x') { base = 16; } else if (*fmt == 'o') { base = 8; } else if (*fmt == 'b') { base = 2; } /* Was a fieldwidth specified? */ if (!width) { /* No... is there a space after the format? */ #if 0 /* Needs more thought */ if (isspace(*(s + 1)) || *(s + 1) == 0) #endif { /* Use the input up until the first white space is * encountered. NOTE: This means that values on the * input line must be separated by whitespace or they * will get combined! This is a bug. We have no good * way of determining the width of the data if there * is no field with and no space separating the input. */ width = strcspn(buf, spaces); } } /* Copy the numeric string into a temporary working buffer. */ strncpy(tmp, buf, width); tmp[width] = '\0'; lvdbg("vsscanf: tmp[]=\"%s\"\n", tmp); /* Perform the integer conversion */ buf += width; if (!noassign) { int *pint = va_arg(ap, int*); #ifdef SDCC char *endptr; int tmpint = strtol(tmp, &endptr, base); #else int tmpint = strtol(tmp, NULL, base); #endif lvdbg("vsscanf: Return %d to 0x%p\n", tmpint, pint); *pint = tmpint; } } /* Process %f: Floating point conversion */ else if (*fmt == 'f') { #ifndef CONFIG_LIBC_FLOATINGPOINT /* No floating point conversions */ void *pv = va_arg(ap, void*); lvdbg("vsscanf: Return 0.0 to %p\n", pv); *((double_t*)pv) = 0.0; #else lvdbg("vsscanf: Performing floating point conversion\n"); /* Skip over any white space before the real string */ while (isspace(*buf)) { buf++; } /* Was a fieldwidth specified? */ if (!width) { /* No... is there a space after the format? */ #if 0 /* Needs more thought */ if (isspace(*(s + 1)) || *(s + 1) == 0) #endif { /* Use the input up until the first white space is * encountered. NOTE: This means that values on the * input line must be separated by whitespace or they * will get combined! This is a bug. We have no good * way of determining the width of the data if there * is no field with and no space separating the input. */ width = strcspn(buf, spaces); } } /* Copy the real string into a temporary working buffer. */ strncpy(tmp, buf, width); tmp[width] = '\0'; buf += width; lvdbg("vsscanf: tmp[]=\"%s\"\n", tmp); /* Perform the floating point conversion */ if (!noassign) { /* strtod always returns a double */ #ifdef SDCC char *endptr; double_t dvalue = strtod(tmp,&endptr); #else double_t dvalue = strtod(tmp, NULL); #endif void *pv = va_arg(ap, void*); lvdbg("vsscanf: Return %f to %p\n", dvalue, pv); /* But we have to check whether we need to return a * float or a double. */ #ifdef CONFIG_HAVE_DOUBLE if (lflag) { *((double_t*)pv) = dvalue; } else #endif { *((float*)pv) = (float)dvalue; } } #endif } /* Process %n: Character count */ else if (*fmt == 'n') { lvdbg("vsscanf: Performing character count\n"); if (!noassign) { int *pint = va_arg(ap, int*); *pint = (int)(buf - bufstart); } } /* Note %n does not count as a conversion */ if (!noassign && *fmt != 'n') { count++; } width = noassign = lflag = 0; fmt++; } /* Its is not a conversion specifier */ else { while (isspace(*buf)) { buf++; } if (*fmt != *buf) { break; } else { fmt++; buf++; } } } return count; }