File: [local] / prex / sys / lib / vsprintf.c (download)
Revision 1.1.1.1 (vendor branch), Tue Aug 19 12:46:56 2008 UTC (15 years, 10 months ago) by nbrk
Branch: MAIN, KOHSUKE
CVS Tags: PREX_0_8_BASE, HEAD Changes since 1.1: +0 -0 lines
Initial import of Prex, Portable Real-time Embedded POSIX microkernel system.
I have totally new directions in my development (more focused on real hardware, not virtual one).
Old hacks are available in prex-old module. They will be carefully re-designed and merged soon.
|
/*-
* Copyright (c) 2005, Kohsuke Ohtani
* All rights reserved.
*
* 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 of the author nor the names of any co-contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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.
*/
/*
* vsprintf.c - Format and output data to buffer
*/
#include <kernel.h>
#include <sys/types.h>
#define isdigit(c) ((unsigned)((c) - '0') < 10)
static u_long
divide(long *n, int base)
{
u_long res;
res = ((u_long)*n) % base;
*n = ((u_long)*n) / base;
return res;
}
static int
atoi(const char **s)
{
int i = 0;
while (isdigit((int)**s))
i = i * 10 + *((*s)++) - '0';
return i;
}
/*
* Print formatted output - scaled down version
*
* Identifiers:
* %d - Decimal signed int
* %x - Hex integer
* %u - Unsigned integer
* %c - Character
* %s - String
*
* Flags:
* 0 - Zero pad
*/
int
vsprintf(char *buf, const char *fmt, va_list args)
{
char *p, *str;
const char *digits = "0123456789abcdef";
char pad, tmp[16];
int width, base, sign, i;
long num;
for (p = buf; *fmt; fmt++) {
if (*fmt != '%') {
*p++ = *fmt;
continue;
}
/* get flags */
++fmt;
pad = ' ';
if (*fmt == '0') {
pad = '0';
fmt++;
}
/* get width */
width = -1;
if (isdigit(*fmt)) {
width = atoi(&fmt);
}
base = 10;
sign = 0;
switch (*fmt) {
case 'c':
*p++ = (char)va_arg(args, int);
continue;
case 's':
str = va_arg(args, char *);
if (str == NULL)
str = "<NULL>";
for (; *str && width != 0; str++, width--) {
*p++ = *str;
}
while (width-- > 0)
*p++ = pad;
continue;
case 'X':
case 'x':
base = 16;
break;
case 'd':
sign = 1;
break;
case 'u':
break;
default:
continue;
}
num = va_arg(args, long);
if (sign && num < 0) {
num = -num;
*p++ = '-';
width--;
}
i = 0;
if (num == 0)
tmp[i++] = '0';
else
while (num != 0)
tmp[i++] = digits[divide(&num, base)];
width -= i;
while (width-- > 0)
*p++ = pad;
while (i-- > 0)
*p++ = tmp[i];
}
*p = '\0';
return 0;
}