855 lines
24 KiB
C
855 lines
24 KiB
C
|
/************************************************************
|
||
|
|
* lib_libvsprintf.c
|
||
|
|
*
|
||
|
|
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||
|
|
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||
|
|
*
|
||
|
|
* 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 Gregory Nutt 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.
|
||
|
|
*
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Compilation Switches
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Included Files
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
#include <sys/types.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <string.h>
|
||
|
|
|
||
|
|
#include "lib_internal.h"
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Definitions
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
enum
|
||
|
|
{
|
||
|
|
FMT_RJUST = 0, /* Default */
|
||
|
|
FMT_LJUST,
|
||
|
|
FMT_RJUST0,
|
||
|
|
FMT_CENTER
|
||
|
|
};
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Private Type Declarations
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Private Function Prototypes
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
static void utodec(char **pp, unsigned int n);
|
||
|
|
static void _utodec(char **pp, unsigned int n);
|
||
|
|
static void utohex(char **pp, unsigned int n);
|
||
|
|
static void _utohex(char **pp, unsigned int n);
|
||
|
|
static void utooct(char **pp, unsigned int n);
|
||
|
|
static void _utooct(char **pp, unsigned int n);
|
||
|
|
static void utobin(char **pp, unsigned int n);
|
||
|
|
static void _utobin(char **pp, unsigned int n);
|
||
|
|
|
||
|
|
#ifdef CONFIG_HAVE_LONG_LONG
|
||
|
|
static void llutodec(char **pp, unsigned long long n);
|
||
|
|
static void _llutodec(char **pp, unsigned long long n);
|
||
|
|
static void llutohex(char **pp, unsigned long long n);
|
||
|
|
static void _llutohex(char **pp, unsigned long long n);
|
||
|
|
static void llutooct(char **pp, unsigned long long n);
|
||
|
|
static void _llutooct(char **pp, unsigned long long n);
|
||
|
|
static void llutobin(char **pp, unsigned long long n);
|
||
|
|
static void _llutobin(char **pp, unsigned long long n);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Global Constant Data
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Global Variables
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Private Constant Data
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
static const char g_nullstring[] = "(null)";
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Private Variables
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Private Functions
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
static void utodec(char **pp, unsigned int n)
|
||
|
|
{
|
||
|
|
_utodec(pp, n);
|
||
|
|
**pp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void _utodec(char **pp, unsigned int n)
|
||
|
|
{
|
||
|
|
unsigned int remainder = n % 10;
|
||
|
|
unsigned int dividend = n / 10;
|
||
|
|
|
||
|
|
if (dividend)
|
||
|
|
{
|
||
|
|
_utodec(pp, dividend);
|
||
|
|
}
|
||
|
|
|
||
|
|
**pp = (char)(remainder + (unsigned int)'0');
|
||
|
|
(*pp)++;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void utohex(char **pp, unsigned int n)
|
||
|
|
{
|
||
|
|
_utohex(pp, n);
|
||
|
|
**pp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void _utohex(char **pp, unsigned int n)
|
||
|
|
{
|
||
|
|
unsigned int remainder = n & 0xf;
|
||
|
|
unsigned int dividend = n >> 4;
|
||
|
|
|
||
|
|
if (dividend)
|
||
|
|
{
|
||
|
|
_utohex(pp, dividend);
|
||
|
|
}
|
||
|
|
|
||
|
|
if (remainder < 10)
|
||
|
|
{
|
||
|
|
**pp = (char)(remainder + (unsigned int)'0');
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
**pp = (char)(remainder + ((unsigned int)'a' - 10));
|
||
|
|
}
|
||
|
|
(*pp)++;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void utooct(char **pp, unsigned int n)
|
||
|
|
{
|
||
|
|
_utooct(pp, n);
|
||
|
|
**pp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void _utooct(char **pp, unsigned int n)
|
||
|
|
{
|
||
|
|
unsigned int remainder = n & 0x7;
|
||
|
|
unsigned int dividend = n >> 3;
|
||
|
|
|
||
|
|
if (dividend)
|
||
|
|
{
|
||
|
|
_utooct(pp, dividend);
|
||
|
|
}
|
||
|
|
|
||
|
|
**pp = (char)(remainder + (unsigned int)'0');
|
||
|
|
(*pp)++;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void utobin(char **pp, unsigned int n)
|
||
|
|
{
|
||
|
|
_utobin(pp, n);
|
||
|
|
**pp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void _utobin(char **pp, unsigned int n)
|
||
|
|
{
|
||
|
|
unsigned int remainder = n & 1;
|
||
|
|
unsigned int dividend = n >> 1;
|
||
|
|
|
||
|
|
if (dividend)
|
||
|
|
{
|
||
|
|
_utobin(pp, dividend);
|
||
|
|
}
|
||
|
|
|
||
|
|
**pp = (char)(remainder + (unsigned int)'0');
|
||
|
|
(*pp)++;
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef CONFIG_HAVE_LONG_LONG
|
||
|
|
static void llutodec(char **pp, unsigned long long n)
|
||
|
|
{
|
||
|
|
_llutodec(pp, n);
|
||
|
|
**pp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void _llutodec(char **pp, unsigned long long n)
|
||
|
|
{
|
||
|
|
unsigned int remainder = n % 10;
|
||
|
|
unsigned long long dividend = n / 10;
|
||
|
|
|
||
|
|
if (dividend)
|
||
|
|
{
|
||
|
|
_llutodec(pp, dividend);
|
||
|
|
}
|
||
|
|
|
||
|
|
**pp = (char)(remainder + (unsigned int)'0');
|
||
|
|
(*pp)++;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void llutohex(char **pp, unsigned long long n)
|
||
|
|
{
|
||
|
|
_llutohex(pp, n);
|
||
|
|
**pp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void _llutohex(char **pp, unsigned long long n)
|
||
|
|
{
|
||
|
|
unsigned int remainder = n & 0xf;
|
||
|
|
unsigned long long dividend = n >> 4;
|
||
|
|
if (dividend)
|
||
|
|
{
|
||
|
|
_llutohex(pp, dividend);
|
||
|
|
}
|
||
|
|
|
||
|
|
if (remainder < 10)
|
||
|
|
{
|
||
|
|
**pp = (char)(remainder + (unsigned int)'0');
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
**pp = (char)(remainder + ((unsigned int)'a' - 10));
|
||
|
|
}
|
||
|
|
(*pp)++;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void llutooct(char **pp, unsigned long long n)
|
||
|
|
{
|
||
|
|
_llutooct(pp, n);
|
||
|
|
**pp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void _llutooct(char **pp, unsigned long long n)
|
||
|
|
{
|
||
|
|
unsigned int remainder = n & 0x7;
|
||
|
|
unsigned long long dividend = n >> 3;
|
||
|
|
|
||
|
|
if (dividend)
|
||
|
|
{
|
||
|
|
_llutooct(pp, dividend);
|
||
|
|
}
|
||
|
|
|
||
|
|
**pp = (char)(remainder + (unsigned int)'0');
|
||
|
|
(*pp)++;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void llutobin(char **pp, unsigned long long n)
|
||
|
|
{
|
||
|
|
_llutobin(pp, n);
|
||
|
|
**pp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void _llutobin(char **pp, unsigned long long n)
|
||
|
|
{
|
||
|
|
unsigned int remainder = n & 1;
|
||
|
|
unsigned long long dividend = n >> 1;
|
||
|
|
|
||
|
|
if (dividend)
|
||
|
|
{
|
||
|
|
_llutobin(pp, dividend);
|
||
|
|
}
|
||
|
|
|
||
|
|
**pp = (char)(remainder + (unsigned int)'0');
|
||
|
|
(*pp)++;
|
||
|
|
}
|
||
|
|
#endif /* CONFIG_HAVE_LONG_LONG */
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* Public Functions
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
/************************************************************
|
||
|
|
* lib_vsprintf
|
||
|
|
************************************************************/
|
||
|
|
|
||
|
|
int lib_vsprintf(struct lib_stream_s *obj, const char *src, va_list ap)
|
||
|
|
{
|
||
|
|
char *ptmp;
|
||
|
|
char tmp[40];
|
||
|
|
const char *pfmt;
|
||
|
|
unsigned int n;
|
||
|
|
int fmt, width, trunc, tmpwidth;
|
||
|
|
int showplus, altform, longlong;
|
||
|
|
int hasdot, hasasteriskwidth, hasasterisktrunc;
|
||
|
|
|
||
|
|
for (; *src; src++)
|
||
|
|
{
|
||
|
|
/* Just copy regular characters */
|
||
|
|
|
||
|
|
if (*src != '%')
|
||
|
|
{
|
||
|
|
obj->put(obj, *src);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
/* We have found a format specifier. Move past it. */
|
||
|
|
|
||
|
|
pfmt = src;
|
||
|
|
src++;
|
||
|
|
|
||
|
|
fmt = FMT_RJUST; /* Assume right justification. */
|
||
|
|
width = trunc = 0;
|
||
|
|
showplus = altform = longlong = 0;
|
||
|
|
hasdot = hasasteriskwidth = hasasterisktrunc = 0;
|
||
|
|
|
||
|
|
/* Process each format qualifier. */
|
||
|
|
|
||
|
|
for (; *src; src++)
|
||
|
|
{
|
||
|
|
/* Break out of the loop when the format is known. */
|
||
|
|
|
||
|
|
if (strchr("diuxXpobeEfgGlLsc%", *src))
|
||
|
|
{
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Check for left justification. */
|
||
|
|
|
||
|
|
else if (*src == '-')
|
||
|
|
{
|
||
|
|
fmt = FMT_LJUST;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Check for leading zero fill right justification. */
|
||
|
|
|
||
|
|
else if (*src == '0')
|
||
|
|
{
|
||
|
|
fmt = FMT_RJUST0;
|
||
|
|
}
|
||
|
|
#if 0
|
||
|
|
/* Center justification. */
|
||
|
|
|
||
|
|
else if (*src == '~')
|
||
|
|
{
|
||
|
|
fmt = FMT_CENTER;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
else if (*src == '*')
|
||
|
|
{
|
||
|
|
int value = va_arg(ap, int);
|
||
|
|
if (hasdot)
|
||
|
|
{
|
||
|
|
trunc = value;
|
||
|
|
hasasterisktrunc = 1;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
width = value;
|
||
|
|
hasasteriskwidth = 1;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Check for field width */
|
||
|
|
|
||
|
|
else if (((*src) >= '1') && ((*src) <= '9'))
|
||
|
|
{
|
||
|
|
/* Accumulate the field width integer. */
|
||
|
|
|
||
|
|
n = ((int)(*src)) - (int)'0';
|
||
|
|
for (src++; (((*src) >= '0') && ((*src) <= '9')); src++)
|
||
|
|
{
|
||
|
|
n = 10*n + (((int)(*src)) - (int)'0');
|
||
|
|
}
|
||
|
|
|
||
|
|
if (hasdot) trunc = n;
|
||
|
|
else width = n;
|
||
|
|
|
||
|
|
/* Back up to the last digit. */
|
||
|
|
|
||
|
|
src--;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Check for a decimal point. */
|
||
|
|
|
||
|
|
else if (*src == '.')
|
||
|
|
{
|
||
|
|
hasdot = 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Check for leading plus sign. */
|
||
|
|
|
||
|
|
else if (*src == '+')
|
||
|
|
{
|
||
|
|
showplus = 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Check for alternate form. */
|
||
|
|
|
||
|
|
else if (*src == '#')
|
||
|
|
{
|
||
|
|
altform = 1;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* "%%" means that a literal '%' was intended (instead of a format
|
||
|
|
* specification).
|
||
|
|
*/
|
||
|
|
|
||
|
|
if (*src == '%')
|
||
|
|
{
|
||
|
|
obj->put(obj, '%');
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Check for the string format. */
|
||
|
|
|
||
|
|
else if (*src == 's')
|
||
|
|
{
|
||
|
|
/* Just concatenate the string into the output */
|
||
|
|
|
||
|
|
ptmp = va_arg(ap, char *);
|
||
|
|
if (!ptmp) ptmp = (char*)g_nullstring;
|
||
|
|
|
||
|
|
while(*ptmp)
|
||
|
|
{
|
||
|
|
obj->put(obj, *ptmp);
|
||
|
|
ptmp++;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Check for the character output */
|
||
|
|
|
||
|
|
else if (*src == 'c')
|
||
|
|
{
|
||
|
|
/* Just copy the character into the output. */
|
||
|
|
|
||
|
|
n = va_arg(ap, int);
|
||
|
|
obj->put(obj, n);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
/* Check for the long long prefix. */
|
||
|
|
|
||
|
|
if (*src == 'L')
|
||
|
|
{
|
||
|
|
longlong = 1;
|
||
|
|
++src;
|
||
|
|
}
|
||
|
|
else if (*src == 'l')
|
||
|
|
{
|
||
|
|
if (*++src == 'l')
|
||
|
|
{
|
||
|
|
longlong = 1;
|
||
|
|
++src;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Get the ascii format into the tmp[] buffer. */
|
||
|
|
|
||
|
|
ptmp = tmp;
|
||
|
|
|
||
|
|
/* Handle integer conversions */
|
||
|
|
|
||
|
|
if (strchr("diuxXpob", *src))
|
||
|
|
{
|
||
|
|
#ifdef CONFIG_HAVE_LONG_LONG
|
||
|
|
if ((longlong) && (*src != 'p'))
|
||
|
|
{
|
||
|
|
/* Extract the long long value. */
|
||
|
|
|
||
|
|
long long lln = va_arg(ap, long long);
|
||
|
|
|
||
|
|
/* Perform the integer conversion according to the
|
||
|
|
* format specifier
|
||
|
|
*/
|
||
|
|
|
||
|
|
switch (*src)
|
||
|
|
{
|
||
|
|
case 'd':
|
||
|
|
case 'i':
|
||
|
|
/* Signed base 10 */
|
||
|
|
{
|
||
|
|
/* Check for leading +/- */
|
||
|
|
|
||
|
|
if (lln < 0)
|
||
|
|
{
|
||
|
|
*ptmp++ = '-';
|
||
|
|
*ptmp = 0;
|
||
|
|
lln = -lln;
|
||
|
|
}
|
||
|
|
else if (showplus)
|
||
|
|
{
|
||
|
|
*ptmp++ = '+';
|
||
|
|
*ptmp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
llutodec(&ptmp, (unsigned long long)lln);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 'u':
|
||
|
|
/* Unigned base 10 */
|
||
|
|
{
|
||
|
|
/* Check for leading + */
|
||
|
|
|
||
|
|
if (showplus)
|
||
|
|
{
|
||
|
|
*ptmp++ = '+';
|
||
|
|
*ptmp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
llutodec(&ptmp, (unsigned long long)lln);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 'p':
|
||
|
|
case 'x':
|
||
|
|
case 'X':
|
||
|
|
/* Hexadecimal */
|
||
|
|
{
|
||
|
|
/* Check for alternate form */
|
||
|
|
|
||
|
|
if (altform)
|
||
|
|
{
|
||
|
|
/* Prefix the number with "0x" */
|
||
|
|
|
||
|
|
*ptmp++ = '0';
|
||
|
|
*ptmp++ = 'x';
|
||
|
|
*ptmp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
llutohex(&ptmp, (unsigned long long)lln);
|
||
|
|
|
||
|
|
/* Check for upper case conversion. */
|
||
|
|
|
||
|
|
if ((*src) == 'X')
|
||
|
|
{
|
||
|
|
for (ptmp = tmp; *ptmp; ptmp++)
|
||
|
|
{
|
||
|
|
if (((*ptmp) >= 'a') && ((*ptmp) <= 'z'))
|
||
|
|
{
|
||
|
|
/* Convert to upper case. */
|
||
|
|
|
||
|
|
*ptmp += (char)((int)'A' - (int)'a');
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 'o':
|
||
|
|
/* Octal */
|
||
|
|
{
|
||
|
|
/* Check for alternate form */
|
||
|
|
|
||
|
|
if (altform)
|
||
|
|
{
|
||
|
|
/* Prefix the number with '0' */
|
||
|
|
|
||
|
|
*ptmp++ = '0';
|
||
|
|
*ptmp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
llutooct(&ptmp, (unsigned long long)lln);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 'b':
|
||
|
|
/* Binary */
|
||
|
|
{
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
llutobin(&ptmp, (unsigned long long)lln);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
#endif /* CONFIG_HAVE_LONG_LONG */
|
||
|
|
/* Extract the integer value */
|
||
|
|
|
||
|
|
n = va_arg(ap, int);
|
||
|
|
|
||
|
|
/* Perform the integer conversion according to the
|
||
|
|
* format specifier
|
||
|
|
*/
|
||
|
|
|
||
|
|
switch (*src)
|
||
|
|
{
|
||
|
|
case 'd':
|
||
|
|
case 'i':
|
||
|
|
/* Signed base 10 */
|
||
|
|
{
|
||
|
|
/* Check for leading +/- */
|
||
|
|
|
||
|
|
if ((int)n < 0)
|
||
|
|
{
|
||
|
|
*ptmp++ = '-';
|
||
|
|
*ptmp = 0;
|
||
|
|
n = -n;
|
||
|
|
}
|
||
|
|
else if (showplus)
|
||
|
|
{
|
||
|
|
*ptmp++ = '+';
|
||
|
|
*ptmp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
utodec(&ptmp, (unsigned int)n);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 'u':
|
||
|
|
/* Unigned base 10 */
|
||
|
|
{
|
||
|
|
/* Check for leading + */
|
||
|
|
|
||
|
|
if (showplus)
|
||
|
|
{
|
||
|
|
*ptmp++ = '+';
|
||
|
|
*ptmp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
utodec(&ptmp, (unsigned int)n);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 'x':
|
||
|
|
case 'X':
|
||
|
|
case 'p':
|
||
|
|
/* Hexadecimal */
|
||
|
|
{
|
||
|
|
/* Check for alternate form */
|
||
|
|
|
||
|
|
if (altform)
|
||
|
|
{
|
||
|
|
/* Prefix the number with "0x" */
|
||
|
|
|
||
|
|
*ptmp++ = '0';
|
||
|
|
*ptmp++ = 'x';
|
||
|
|
*ptmp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
utohex(&ptmp, (unsigned int)n);
|
||
|
|
|
||
|
|
/* Check for upper case conversion. */
|
||
|
|
|
||
|
|
if ((*src) == 'X')
|
||
|
|
{
|
||
|
|
for (ptmp = tmp; *ptmp; ptmp++)
|
||
|
|
{
|
||
|
|
if (((*ptmp) >= 'a') && ((*ptmp) <= 'z'))
|
||
|
|
{
|
||
|
|
/* Convert to upper case. */
|
||
|
|
|
||
|
|
*ptmp += (char)((int)'A' - (int)'a');
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else if ((*src) == 'p')
|
||
|
|
{
|
||
|
|
if ((!width) && (fmt == FMT_RJUST))
|
||
|
|
{
|
||
|
|
if (altform) width = 10;
|
||
|
|
else width = 8;
|
||
|
|
|
||
|
|
fmt = FMT_RJUST0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 'o':
|
||
|
|
/* Octal */
|
||
|
|
{
|
||
|
|
/* Check for alternate form */
|
||
|
|
|
||
|
|
if (altform)
|
||
|
|
{
|
||
|
|
/* Prefix the number with '0' */
|
||
|
|
|
||
|
|
*ptmp++ = '0';
|
||
|
|
*ptmp = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
utooct(&ptmp, (unsigned int)n);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 'b':
|
||
|
|
/* Binary */
|
||
|
|
{
|
||
|
|
/* Convert the unsigned value to a string. */
|
||
|
|
|
||
|
|
utobin(&ptmp, (unsigned int)n);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
#ifdef CONFIG_HAVE_LONG_LONG
|
||
|
|
}
|
||
|
|
#endif /* CONFIG_HAVE_LONG_LONG */
|
||
|
|
|
||
|
|
/* Now, get the "real" field width of the integer value*/
|
||
|
|
|
||
|
|
tmpwidth = strlen(tmp);
|
||
|
|
if (width <= tmpwidth)
|
||
|
|
{
|
||
|
|
/* Just copy the string. */
|
||
|
|
|
||
|
|
for (ptmp = tmp; *ptmp; )
|
||
|
|
{
|
||
|
|
obj->put(obj, *ptmp);
|
||
|
|
ptmp++;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
/* Apply field justification to the integer value. */
|
||
|
|
|
||
|
|
switch (fmt)
|
||
|
|
{
|
||
|
|
default:
|
||
|
|
case FMT_RJUST:
|
||
|
|
for (n = width - tmpwidth; n; n--)
|
||
|
|
{
|
||
|
|
obj->put(obj, ' ');
|
||
|
|
}
|
||
|
|
|
||
|
|
for (ptmp = tmp; *ptmp; )
|
||
|
|
{
|
||
|
|
obj->put(obj, *ptmp);
|
||
|
|
ptmp++;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FMT_RJUST0:
|
||
|
|
ptmp = tmp;
|
||
|
|
if (((*ptmp) == '-') || ((*ptmp) == '+'))
|
||
|
|
{
|
||
|
|
obj->put(obj, *ptmp);
|
||
|
|
ptmp++;
|
||
|
|
}
|
||
|
|
|
||
|
|
for (n = width - tmpwidth; n; n--)
|
||
|
|
{
|
||
|
|
obj->put(obj, '0');
|
||
|
|
}
|
||
|
|
|
||
|
|
while (*ptmp)
|
||
|
|
{
|
||
|
|
obj->put(obj, *ptmp);
|
||
|
|
ptmp++;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FMT_LJUST:
|
||
|
|
for (ptmp = tmp; *ptmp; )
|
||
|
|
{
|
||
|
|
obj->put(obj, *ptmp);
|
||
|
|
ptmp++;
|
||
|
|
}
|
||
|
|
|
||
|
|
for (n = width - tmpwidth; n; n--)
|
||
|
|
{
|
||
|
|
obj->put(obj, ' ');
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Handle floating point conversions */
|
||
|
|
|
||
|
|
else if (strchr("eEfgG", *src))
|
||
|
|
{
|
||
|
|
char tmpfmt[40];
|
||
|
|
const char *psrc;
|
||
|
|
char *pdst;
|
||
|
|
double dbl;
|
||
|
|
|
||
|
|
/* Reconstruct the floating point format. */
|
||
|
|
|
||
|
|
psrc = pfmt;
|
||
|
|
pdst = tmpfmt;
|
||
|
|
while (psrc <= src) *pdst++ = *psrc++;
|
||
|
|
*pdst = 0;
|
||
|
|
|
||
|
|
/* Extract the floating point number. */
|
||
|
|
|
||
|
|
dbl = va_arg(ap, double);
|
||
|
|
|
||
|
|
/* Then let the lib_sprintf do the work. */
|
||
|
|
|
||
|
|
if (hasasteriskwidth)
|
||
|
|
{
|
||
|
|
if (hasasterisktrunc)
|
||
|
|
{
|
||
|
|
lib_sprintf(obj, tmpfmt, width, trunc, dbl);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
lib_sprintf(obj, tmpfmt, width, dbl);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
if (hasasterisktrunc)
|
||
|
|
{
|
||
|
|
lib_sprintf(obj, tmpfmt, trunc, dbl);
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
lib_sprintf(obj, tmpfmt, dbl);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return obj->nput;
|
||
|
|
}
|
||
|
|
|