[people/ms/u-boot.git] / lib_generic / vsprintf.c

/*
 *  linux/lib/vsprintf.c
 *
 *  Copyright (C) 1991, 1992  Linus Torvalds
 */

/* vsprintf.c -- Lars Wirzenius & Linus Torvalds. */
/*
 * Wirzenius wrote this portably, Torvalds fucked it up :-)
 */

#include <stdarg.h>
#include <linux/types.h>
#include <linux/string.h>
#include <linux/ctype.h>

#include <common.h>
#if !defined (CONFIG_PANIC_HANG)
#include <command.h>
/*cmd_boot.c*/
extern int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
#endif

unsigned long simple_strtoul(const char *cp,char **endp,unsigned int base)
{
	unsigned long result = 0,value;

	if (*cp == '0') {
		cp++;
		if ((*cp == 'x') && isxdigit(cp[1])) {
			base = 16;
			cp++;
		}
		if (!base) {
			base = 8;
		}
	}
	if (!base) {
		base = 10;
	}
	while (isxdigit(*cp) && (value = isdigit(*cp) ? *cp-'0' : (islower(*cp)
	    ? toupper(*cp) : *cp)-'A'+10) < base) {
		result = result*base + value;
		cp++;
	}
	if (endp)
		*endp = (char *)cp;
	return result;
}

long simple_strtol(const char *cp,char **endp,unsigned int base)
{
	if(*cp=='-')
		return -simple_strtoul(cp+1,endp,base);
	return simple_strtoul(cp,endp,base);
}

#ifdef CFG_64BIT_STRTOUL
unsigned long long simple_strtoull (const char *cp, char **endp, unsigned int base)
{
	unsigned long long result = 0, value;

	if (*cp == '0') {
		cp++;
		if ((*cp == 'x') && isxdigit (cp[1])) {
			base = 16;
			cp++;
		}
		if (!base) {
			base = 8;
		}
	}
	if (!base) {
		base = 10;
	}
	while (isxdigit (*cp) && (value = isdigit (*cp)
				? *cp - '0'
				: (islower (*cp) ? toupper (*cp) : *cp) - 'A' + 10) < base) {
		result = result * base + value;
		cp++;
	}
	if (endp)
		*endp = (char *) cp;
	return result;
}
#endif /* CFG_64BIT_STRTOUL */

/* we use this so that we can do without the ctype library */
#define is_digit(c)	((c) >= '0' && (c) <= '9')

static int skip_atoi(const char **s)
{
	int i=0;

	while (is_digit(**s))
		i = i*10 + *((*s)++) - '0';
	return i;
}

#define ZEROPAD	1		/* pad with zero */
#define SIGN	2		/* unsigned/signed long */
#define PLUS	4		/* show plus */
#define SPACE	8		/* space if plus */
#define LEFT	16		/* left justified */
#define SPECIAL	32		/* 0x */
#define LARGE	64		/* use 'ABCDEF' instead of 'abcdef' */

#define do_div(n,base) ({ \
	int __res; \
	__res = ((unsigned long) n) % (unsigned) base; \
	n = ((unsigned long) n) / (unsigned) base; \
	__res; \
})

#ifdef CFG_64BIT_VSPRINTF
static char * number(char * str, long long num, int base, int size, int precision ,int type)
#else
static char * number(char * str, long num, int base, int size, int precision ,int type)
#endif
{
	char c,sign,tmp[66];
	const char *digits="0123456789abcdefghijklmnopqrstuvwxyz";
	int i;

	if (type & LARGE)
		digits = "0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ";
	if (type & LEFT)
		type &= ~ZEROPAD;
	if (base < 2 || base > 36)
		return 0;
	c = (type & ZEROPAD) ? '0' : ' ';
	sign = 0;
	if (type & SIGN) {
		if (num < 0) {
			sign = '-';
			num = -num;
			size--;
		} else if (type & PLUS) {
			sign = '+';
			size--;
		} else if (type & SPACE) {
			sign = ' ';
			size--;
		}
	}
	if (type & SPECIAL) {
		if (base == 16)
			size -= 2;
		else if (base == 8)
			size--;
	}
	i = 0;
	if (num == 0)
		tmp[i++]='0';
	else while (num != 0)
		tmp[i++] = digits[do_div(num,base)];
	if (i > precision)
		precision = i;
	size -= precision;
	if (!(type&(ZEROPAD+LEFT)))
		while(size-->0)
			*str++ = ' ';
	if (sign)
		*str++ = sign;
	if (type & SPECIAL) {
		if (base==8)
			*str++ = '0';
		else if (base==16) {
			*str++ = '0';
			*str++ = digits[33];
		}
	}
	if (!(type & LEFT))
		while (size-- > 0)
			*str++ = c;
	while (i < precision--)
		*str++ = '0';
	while (i-- > 0)
		*str++ = tmp[i];
	while (size-- > 0)
		*str++ = ' ';
	return str;
}

/* Forward decl. needed for IP address printing stuff... */
int sprintf(char * buf, const char *fmt, ...);

int vsprintf(char *buf, const char *fmt, va_list args)
{
	int len;
#ifdef CFG_64BIT_VSPRINTF
	unsigned long long num;
#else
	unsigned long num;
#endif
	int i, base;
	char * str;
	const char *s;

	int flags;		/* flags to number() */

	int field_width;	/* width of output field */
	int precision;		/* min. # of digits for integers; max
				   number of chars for from string */
	int qualifier;		/* 'h', 'l', or 'q' for integer fields */

	for (str=buf ; *fmt ; ++fmt) {
		if (*fmt != '%') {
			*str++ = *fmt;
			continue;
		}

		/* process flags */
		flags = 0;
		repeat:
			++fmt;		/* this also skips first '%' */
			switch (*fmt) {
				case '-': flags |= LEFT; goto repeat;
				case '+': flags |= PLUS; goto repeat;
				case ' ': flags |= SPACE; goto repeat;
				case '#': flags |= SPECIAL; goto repeat;
				case '0': flags |= ZEROPAD; goto repeat;
				}

		/* get field width */
		field_width = -1;
		if (is_digit(*fmt))
			field_width = skip_atoi(&fmt);
		else if (*fmt == '*') {
			++fmt;
			/* it's the next argument */
			field_width = va_arg(args, int);
			if (field_width < 0) {
				field_width = -field_width;
				flags |= LEFT;
			}
		}

		/* get the precision */
		precision = -1;
		if (*fmt == '.') {
			++fmt;
			if (is_digit(*fmt))
				precision = skip_atoi(&fmt);
			else if (*fmt == '*') {
				++fmt;
				/* it's the next argument */
				precision = va_arg(args, int);
			}
			if (precision < 0)
				precision = 0;
		}

		/* get the conversion qualifier */
		qualifier = -1;
		if (*fmt == 'h' || *fmt == 'l' || *fmt == 'q') {
			qualifier = *fmt;
			++fmt;
		}

		/* default base */
		base = 10;

		switch (*fmt) {
		case 'c':
			if (!(flags & LEFT))
				while (--field_width > 0)
					*str++ = ' ';
			*str++ = (unsigned char) va_arg(args, int);
			while (--field_width > 0)
				*str++ = ' ';
			continue;

		case 's':
			s = va_arg(args, char *);
			if (!s)
				s = "<NULL>";

			len = strnlen(s, precision);

			if (!(flags & LEFT))
				while (len < field_width--)
					*str++ = ' ';
			for (i = 0; i < len; ++i)
				*str++ = *s++;
			while (len < field_width--)
				*str++ = ' ';
			continue;

		case 'p':
			if (field_width == -1) {
				field_width = 2*sizeof(void *);
				flags |= ZEROPAD;
			}
			str = number(str,
				(unsigned long) va_arg(args, void *), 16,
				field_width, precision, flags);
			continue;


		case 'n':
			if (qualifier == 'l') {
				long * ip = va_arg(args, long *);
				*ip = (str - buf);
			} else {
				int * ip = va_arg(args, int *);
				*ip = (str - buf);
			}
			continue;

		case '%':
			*str++ = '%';
			continue;

		/* integer number formats - set up the flags and "break" */
		case 'o':
			base = 8;
			break;

		case 'X':
			flags |= LARGE;
		case 'x':
			base = 16;
			break;

		case 'd':
		case 'i':
			flags |= SIGN;
		case 'u':
			break;

		default:
			*str++ = '%';
			if (*fmt)
				*str++ = *fmt;
			else
				--fmt;
			continue;
		}
#ifdef CFG_64BIT_VSPRINTF
		if (qualifier == 'q')  /* "quad" for 64 bit variables */
			num = va_arg(args, unsigned long long);
		else
#endif
		if (qualifier == 'l')
			num = va_arg(args, unsigned long);
		else if (qualifier == 'h') {
			num = (unsigned short) va_arg(args, int);
			if (flags & SIGN)
				num = (short) num;
		} else if (flags & SIGN)
			num = va_arg(args, int);
		else
			num = va_arg(args, unsigned int);
		str = number(str, num, base, field_width, precision, flags);
	}
	*str = '\0';
	return str-buf;
}

int sprintf(char * buf, const char *fmt, ...)
{
	va_list args;
	int i;

	va_start(args, fmt);
	i=vsprintf(buf,fmt,args);
	va_end(args);
	return i;
}

void panic(const char *fmt, ...)
{
	va_list	args;
	va_start(args, fmt);
	vprintf(fmt, args);
	putc('\n');
	va_end(args);
#if defined (CONFIG_PANIC_HANG)
	hang();
#else
	udelay (100000);	/* allow messages to go out */
	do_reset (NULL, 0, 0, NULL);
#endif
}
Commit	Line	Data
153d511e WD	1	/*
	2	* linux/lib/vsprintf.c
	3	*
	4	* Copyright (C) 1991, 1992 Linus Torvalds
	5	*/
	6
	7	/* vsprintf.c -- Lars Wirzenius & Linus Torvalds. */
	8	/*
	9	* Wirzenius wrote this portably, Torvalds fucked it up :-)
	10	*/
	11
	12	#include <stdarg.h>
	13	#include <linux/types.h>
	14	#include <linux/string.h>
	15	#include <linux/ctype.h>
	16
	17	#include <common.h>
	18	#if !defined (CONFIG_PANIC_HANG)
	19	#include <command.h>
8bde7f77 WD	20	/cmd_boot.c/
8bde7f77 WD	21	extern int do_reset (cmd_tbl_t cmdtp, int flag, int argc, char argv[]);
153d511e WD	22	#endif
	23
	24	unsigned long simple_strtoul(const char cp,char *endp,unsigned int base)
	25	{
	26	unsigned long result = 0,value;
	27
	28	if (*cp == '0') {
	29	cp++;
	30	if ((*cp == 'x') && isxdigit(cp[1])) {
	31	base = 16;
	32	cp++;
	33	}
	34	if (!base) {
	35	base = 8;
	36	}
	37	}
	38	if (!base) {
	39	base = 10;
	40	}
	41	while (isxdigit(cp) && (value = isdigit(cp) ? cp-'0' : (islower(cp)
	42	? toupper(cp) : cp)-'A'+10) < base) {
	43	result = result*base + value;
	44	cp++;
	45	}
	46	if (endp)
	47	endp = (char )cp;
	48	return result;
	49	}
	50
	51	long simple_strtol(const char cp,char *endp,unsigned int base)
	52	{
	53	if(*cp=='-')
	54	return -simple_strtoul(cp+1,endp,base);
	55	return simple_strtoul(cp,endp,base);
	56	}
	57
42dfe7a1	58	#ifdef CFG_64BIT_STRTOUL
c40b2956 WD	59	unsigned long long simple_strtoull (const char cp, char *endp, unsigned int base)
	60	{
	61	unsigned long long result = 0, value;
	62
	63	if (*cp == '0') {
	64	cp++;
	65	if ((*cp == 'x') && isxdigit (cp[1])) {
	66	base = 16;
	67	cp++;
	68	}
	69	if (!base) {
	70	base = 8;
	71	}
	72	}
	73	if (!base) {
	74	base = 10;
	75	}
	76	while (isxdigit (cp) && (value = isdigit (cp)
	77	? *cp - '0'
	78	: (islower (cp) ? toupper (cp) : *cp) - 'A' + 10) < base) {
	79	result = result * base + value;
	80	cp++;
	81	}
	82	if (endp)
	83	endp = (char ) cp;
	84	return result;
	85	}
	86	#endif /* CFG_64BIT_STRTOUL */
	87
153d511e WD	88	/* we use this so that we can do without the ctype library */
	89	#define is_digit(c) ((c) >= '0' && (c) <= '9')
	90
	91	static int skip_atoi(const char **s)
	92	{
	93	int i=0;
	94
	95	while (is_digit(**s))
	96	i = i10 + ((*s)++) - '0';
	97	return i;
	98	}
	99
	100	#define ZEROPAD 1 /* pad with zero */
	101	#define SIGN 2 /* unsigned/signed long */
	102	#define PLUS 4 /* show plus */
	103	#define SPACE 8 /* space if plus */
	104	#define LEFT 16 /* left justified */
	105	#define SPECIAL 32 /* 0x */
	106	#define LARGE 64 /* use 'ABCDEF' instead of 'abcdef' */
	107
	108	#define do_div(n,base) ({ \
c40b2956 WD	109	int __res; \
	110	__res = ((unsigned long) n) % (unsigned) base; \
	111	n = ((unsigned long) n) / (unsigned) base; \
	112	__res; \
	113	})
	114
42dfe7a1	115	#ifdef CFG_64BIT_VSPRINTF
c40b2956 WD	116	static char * number(char * str, long long num, int base, int size, int precision ,int type)
	117	#else
	118	static char * number(char * str, long num, int base, int size, int precision ,int type)
	119	#endif
153d511e WD	120	{
	121	char c,sign,tmp[66];
	122	const char *digits="0123456789abcdefghijklmnopqrstuvwxyz";
	123	int i;
	124
	125	if (type & LARGE)
	126	digits = "0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ";
	127	if (type & LEFT)
	128	type &= ~ZEROPAD;
	129	if (base < 2 \|\| base > 36)
	130	return 0;
	131	c = (type & ZEROPAD) ? '0' : ' ';
	132	sign = 0;
	133	if (type & SIGN) {
	134	if (num < 0) {
	135	sign = '-';
	136	num = -num;
	137	size--;
	138	} else if (type & PLUS) {
	139	sign = '+';
	140	size--;
	141	} else if (type & SPACE) {
	142	sign = ' ';
	143	size--;
	144	}
	145	}
	146	if (type & SPECIAL) {
	147	if (base == 16)
	148	size -= 2;
	149	else if (base == 8)
	150	size--;
	151	}
	152	i = 0;
	153	if (num == 0)
	154	tmp[i++]='0';
	155	else while (num != 0)
	156	tmp[i++] = digits[do_div(num,base)];
	157	if (i > precision)
	158	precision = i;
	159	size -= precision;
	160	if (!(type&(ZEROPAD+LEFT)))
	161	while(size-->0)
	162	*str++ = ' ';
	163	if (sign)
	164	*str++ = sign;
	165	if (type & SPECIAL) {
	166	if (base==8)
	167	*str++ = '0';
	168	else if (base==16) {
	169	*str++ = '0';
	170	*str++ = digits[33];
	171	}
	172	}
	173	if (!(type & LEFT))
	174	while (size-- > 0)
	175	*str++ = c;
	176	while (i < precision--)
	177	*str++ = '0';
	178	while (i-- > 0)
	179	*str++ = tmp[i];
	180	while (size-- > 0)
	181	*str++ = ' ';
	182	return str;
	183	}
184
185	/* Forward decl. needed for IP address printing stuff... */
186	int sprintf(char * buf, const char *fmt, ...);
187
188	int vsprintf(char buf, const char fmt, va_list args)
189	{
190	int len;
42dfe7a1	191	#ifdef CFG_64BIT_VSPRINTF
c40b2956 WD	192	unsigned long long num;
c40b2956 WD	193	#else
153d511e	194	unsigned long num;
c40b2956	195	#endif
153d511e WD	196	int i, base;
	197	char * str;
	198	const char *s;
	199
	200	int flags; /* flags to number() */
	201
	202	int field_width; /* width of output field */
	203	int precision; /* min. # of digits for integers; max
	204	number of chars for from string */
c40b2956	205	int qualifier; /* 'h', 'l', or 'q' for integer fields */
153d511e WD	206
	207	for (str=buf ; *fmt ; ++fmt) {
	208	if (*fmt != '%') {
	209	str++ = fmt;
	210	continue;
	211	}
	212
	213	/* process flags */
	214	flags = 0;
	215	repeat:
	216	++fmt; /* this also skips first '%' */
	217	switch (*fmt) {
	218	case '-': flags \|= LEFT; goto repeat;
	219	case '+': flags \|= PLUS; goto repeat;
	220	case ' ': flags \|= SPACE; goto repeat;
	221	case '#': flags \|= SPECIAL; goto repeat;
	222	case '0': flags \|= ZEROPAD; goto repeat;
	223	}
	224
	225	/* get field width */
	226	field_width = -1;
	227	if (is_digit(*fmt))
	228	field_width = skip_atoi(&fmt);
	229	else if (fmt == '') {
	230	++fmt;
	231	/* it's the next argument */
	232	field_width = va_arg(args, int);
	233	if (field_width < 0) {
	234	field_width = -field_width;
	235	flags \|= LEFT;
	236	}
	237	}
	238
	239	/* get the precision */
	240	precision = -1;
	241	if (*fmt == '.') {
	242	++fmt;
	243	if (is_digit(*fmt))
	244	precision = skip_atoi(&fmt);
	245	else if (fmt == '') {
	246	++fmt;
	247	/* it's the next argument */
	248	precision = va_arg(args, int);
	249	}
	250	if (precision < 0)
	251	precision = 0;
	252	}
	253
	254	/* get the conversion qualifier */
	255	qualifier = -1;
c40b2956	256	if (fmt == 'h' \|\| fmt == 'l' \|\| *fmt == 'q') {
153d511e WD	257	qualifier = *fmt;
	258	++fmt;
	259	}
	260
	261	/* default base */
	262	base = 10;
	263
	264	switch (*fmt) {
	265	case 'c':
	266	if (!(flags & LEFT))
	267	while (--field_width > 0)
	268	*str++ = ' ';
	269	*str++ = (unsigned char) va_arg(args, int);
	270	while (--field_width > 0)
	271	*str++ = ' ';
	272	continue;
	273
	274	case 's':
	275	s = va_arg(args, char *);
	276	if (!s)
	277	s = "<NULL>";
	278
	279	len = strnlen(s, precision);
	280
	281	if (!(flags & LEFT))
	282	while (len < field_width--)
	283	*str++ = ' ';
	284	for (i = 0; i < len; ++i)
	285	str++ = s++;
	286	while (len < field_width--)
	287	*str++ = ' ';
	288	continue;
	289
	290	case 'p':
	291	if (field_width == -1) {
	292	field_width = 2sizeof(void );
	293	flags \|= ZEROPAD;
	294	}
	295	str = number(str,
	296	(unsigned long) va_arg(args, void *), 16,
	297	field_width, precision, flags);
	298	continue;
	299
	300
	301	case 'n':
	302	if (qualifier == 'l') {
	303	long * ip = va_arg(args, long *);
	304	*ip = (str - buf);
	305	} else {
	306	int * ip = va_arg(args, int *);
	307	*ip = (str - buf);
	308	}
	309	continue;
	310
	311	case '%':
	312	*str++ = '%';
	313	continue;
	314
	315	/* integer number formats - set up the flags and "break" */
	316	case 'o':
	317	base = 8;
	318	break;
	319
	320	case 'X':
321	flags \|= LARGE;
322	case 'x':
323	base = 16;
324	break;
325
326	case 'd':
327	case 'i':
328	flags \|= SIGN;
329	case 'u':
330	break;
331
332	default:
333	*str++ = '%';
334	if (*fmt)
335	str++ = fmt;
336	else
337	--fmt;
338	continue;
339	}
42dfe7a1	340	#ifdef CFG_64BIT_VSPRINTF
c40b2956 WD	341	if (qualifier == 'q') /* "quad" for 64 bit variables */
	342	num = va_arg(args, unsigned long long);
	343	else
	344	#endif
153d511e WD	345	if (qualifier == 'l')
	346	num = va_arg(args, unsigned long);
	347	else if (qualifier == 'h') {
	348	num = (unsigned short) va_arg(args, int);
	349	if (flags & SIGN)
	350	num = (short) num;
	351	} else if (flags & SIGN)
	352	num = va_arg(args, int);
	353	else
	354	num = va_arg(args, unsigned int);
	355	str = number(str, num, base, field_width, precision, flags);
	356	}
	357	*str = '\0';
	358	return str-buf;
	359	}
	360
	361	int sprintf(char * buf, const char *fmt, ...)
	362	{
	363	va_list args;
	364	int i;
	365
	366	va_start(args, fmt);
	367	i=vsprintf(buf,fmt,args);
	368	va_end(args);
	369	return i;
	370	}
	371
	372	void panic(const char *fmt, ...)
	373	{
	374	va_list args;
	375	va_start(args, fmt);
6dd652fa	376	vprintf(fmt, args);
153d511e WD	377	putc('\n');
	378	va_end(args);
	379	#if defined (CONFIG_PANIC_HANG)
	380	hang();
	381	#else
	382	udelay (100000); /* allow messages to go out */
	383	do_reset (NULL, 0, 0, NULL);
	384	#endif
	385	}