[J-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);
}

int ustrtoul(const char *cp, char **endp, unsigned int base)
{
	unsigned long result = simple_strtoul(cp, endp, base);
	switch (**endp) {
	case 'G' :
		result *= 1024;
		/* fall through */
	case 'M':
		result *= 1024;
		/* fall through */
	case 'K':
	case 'k':
		result *= 1024;
		if ((*endp)[1] == 'i') {
			if ((*endp)[2] == 'B')
				(*endp) += 3;
			else
				(*endp) += 2;
		}
	}
	return result;
}

#ifdef CONFIG_SYS_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 /* CONFIG_SYS_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' */

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

#ifdef CONFIG_SYS_64BIT_VSPRINTF
static char * number(char * str, long long num, unsigned int base, int size, int precision ,int type)
#else
static char * number(char * str, long num, unsigned 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 CONFIG_SYS_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 == 'L' ||
		    *fmt == 'Z' || *fmt == 'z' || *fmt == 't' ||
		    *fmt == 'q' ) {
			qualifier = *fmt;
			if (qualifier == 'l' && *(fmt+1) == 'l') {
				qualifier = 'q';
				++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 CONFIG_SYS_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 == 'Z' || qualifier == 'z') {
			num = va_arg(args, size_t);
		} else if (qualifier == 't') {
			num = va_arg(args, ptrdiff_t);
		} 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
7e6ee7ad KP	58	int ustrtoul(const char cp, char *endp, unsigned int base)
	59	{
	60	unsigned long result = simple_strtoul(cp, endp, base);
	61	switch (**endp) {
	62	case 'G' :
	63	result *= 1024;
	64	/* fall through */
	65	case 'M':
	66	result *= 1024;
	67	/* fall through */
	68	case 'K':
	69	case 'k':
	70	result *= 1024;
	71	if ((*endp)[1] == 'i') {
	72	if ((*endp)[2] == 'B')
	73	(*endp) += 3;
	74	else
	75	(*endp) += 2;
	76	}
	77	}
	78	return result;
	79	}
	80
6d0f6bcf	81	#ifdef CONFIG_SYS_64BIT_STRTOUL
c40b2956 WD	82	unsigned long long simple_strtoull (const char cp, char *endp, unsigned int base)
	83	{
	84	unsigned long long result = 0, value;
	85
	86	if (*cp == '0') {
	87	cp++;
	88	if ((*cp == 'x') && isxdigit (cp[1])) {
	89	base = 16;
	90	cp++;
	91	}
	92	if (!base) {
	93	base = 8;
	94	}
	95	}
	96	if (!base) {
	97	base = 10;
	98	}
	99	while (isxdigit (cp) && (value = isdigit (cp)
	100	? *cp - '0'
	101	: (islower (cp) ? toupper (cp) : *cp) - 'A' + 10) < base) {
	102	result = result * base + value;
	103	cp++;
	104	}
	105	if (endp)
	106	endp = (char ) cp;
	107	return result;
	108	}
6d0f6bcf	109	#endif /* CONFIG_SYS_64BIT_STRTOUL */
c40b2956	110
153d511e WD	111	/* we use this so that we can do without the ctype library */
	112	#define is_digit(c) ((c) >= '0' && (c) <= '9')
	113
	114	static int skip_atoi(const char **s)
	115	{
	116	int i=0;
	117
	118	while (is_digit(**s))
	119	i = i10 + ((*s)++) - '0';
	120	return i;
	121	}
	122
	123	#define ZEROPAD 1 /* pad with zero */
	124	#define SIGN 2 /* unsigned/signed long */
	125	#define PLUS 4 /* show plus */
	126	#define SPACE 8 /* space if plus */
	127	#define LEFT 16 /* left justified */
	128	#define SPECIAL 32 /* 0x */
	129	#define LARGE 64 /* use 'ABCDEF' instead of 'abcdef' */
	130
6d0f6bcf	131	#ifdef CONFIG_SYS_64BIT_VSPRINTF
bf052939 JY	132	#define do_div(n,base) ({ \
	133	unsigned int __res; \
	134	__res = ((unsigned long long) n) % base; \
	135	n = ((unsigned long long) n) / base; \
	136	__res; \
	137	})
	138	#else
153d511e	139	#define do_div(n,base) ({ \
c40b2956	140	int __res; \
bf052939 JY	141	__res = ((unsigned long) n) % base; \
bf052939 JY	142	n = ((unsigned long) n) / base; \
c40b2956 WD	143	__res; \
c40b2956 WD	144	})
bf052939	145	#endif
c40b2956	146
6d0f6bcf	147	#ifdef CONFIG_SYS_64BIT_VSPRINTF
bf052939	148	static char * number(char * str, long long num, unsigned int base, int size, int precision ,int type)
c40b2956	149	#else
bf052939	150	static char * number(char * str, long num, unsigned int base, int size, int precision ,int type)
c40b2956	151	#endif
153d511e WD	152	{
	153	char c,sign,tmp[66];
	154	const char *digits="0123456789abcdefghijklmnopqrstuvwxyz";
	155	int i;
	156
	157	if (type & LARGE)
	158	digits = "0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ";
	159	if (type & LEFT)
	160	type &= ~ZEROPAD;
	161	if (base < 2 \|\| base > 36)
	162	return 0;
	163	c = (type & ZEROPAD) ? '0' : ' ';
	164	sign = 0;
	165	if (type & SIGN) {
	166	if (num < 0) {
	167	sign = '-';
	168	num = -num;
	169	size--;
	170	} else if (type & PLUS) {
	171	sign = '+';
	172	size--;
	173	} else if (type & SPACE) {
	174	sign = ' ';
	175	size--;
	176	}
	177	}
	178	if (type & SPECIAL) {
	179	if (base == 16)
	180	size -= 2;
	181	else if (base == 8)
	182	size--;
	183	}
	184	i = 0;
	185	if (num == 0)
	186	tmp[i++]='0';
	187	else while (num != 0)
	188	tmp[i++] = digits[do_div(num,base)];
	189	if (i > precision)
	190	precision = i;
	191	size -= precision;
	192	if (!(type&(ZEROPAD+LEFT)))
	193	while(size-->0)
	194	*str++ = ' ';
	195	if (sign)
	196	*str++ = sign;
	197	if (type & SPECIAL) {
	198	if (base==8)
	199	*str++ = '0';
	200	else if (base==16) {
	201	*str++ = '0';
	202	*str++ = digits[33];
	203	}
	204	}
	205	if (!(type & LEFT))
	206	while (size-- > 0)
	207	*str++ = c;
	208	while (i < precision--)
	209	*str++ = '0';
	210	while (i-- > 0)
	211	*str++ = tmp[i];
	212	while (size-- > 0)
	213	*str++ = ' ';
	214	return str;
	215	}
216
217	/* Forward decl. needed for IP address printing stuff... */
218	int sprintf(char * buf, const char *fmt, ...);
219
220	int vsprintf(char buf, const char fmt, va_list args)
221	{
222	int len;
6d0f6bcf	223	#ifdef CONFIG_SYS_64BIT_VSPRINTF
c40b2956 WD	224	unsigned long long num;
c40b2956 WD	225	#else
153d511e	226	unsigned long num;
c40b2956	227	#endif
153d511e WD	228	int i, base;
	229	char * str;
	230	const char *s;
	231
	232	int flags; /* flags to number() */
	233
	234	int field_width; /* width of output field */
	235	int precision; /* min. # of digits for integers; max
	236	number of chars for from string */
c40b2956	237	int qualifier; /* 'h', 'l', or 'q' for integer fields */
153d511e WD	238
	239	for (str=buf ; *fmt ; ++fmt) {
	240	if (*fmt != '%') {
	241	str++ = fmt;
	242	continue;
	243	}
	244
	245	/* process flags */
	246	flags = 0;
	247	repeat:
	248	++fmt; /* this also skips first '%' */
	249	switch (*fmt) {
	250	case '-': flags \|= LEFT; goto repeat;
	251	case '+': flags \|= PLUS; goto repeat;
	252	case ' ': flags \|= SPACE; goto repeat;
	253	case '#': flags \|= SPECIAL; goto repeat;
	254	case '0': flags \|= ZEROPAD; goto repeat;
	255	}
	256
	257	/* get field width */
	258	field_width = -1;
	259	if (is_digit(*fmt))
	260	field_width = skip_atoi(&fmt);
	261	else if (fmt == '') {
	262	++fmt;
	263	/* it's the next argument */
	264	field_width = va_arg(args, int);
	265	if (field_width < 0) {
	266	field_width = -field_width;
	267	flags \|= LEFT;
	268	}
	269	}
	270
	271	/* get the precision */
	272	precision = -1;
	273	if (*fmt == '.') {
	274	++fmt;
	275	if (is_digit(*fmt))
	276	precision = skip_atoi(&fmt);
	277	else if (fmt == '') {
	278	++fmt;
	279	/* it's the next argument */
	280	precision = va_arg(args, int);
	281	}
	282	if (precision < 0)
	283	precision = 0;
	284	}
	285
	286	/* get the conversion qualifier */
	287	qualifier = -1;
f354b73e JCPV	288	if (fmt == 'h' \|\| fmt == 'l' \|\| *fmt == 'L' \|\|
	289	fmt == 'Z' \|\| fmt == 'z' \|\| *fmt == 't' \|\|
	290	*fmt == 'q' ) {
153d511e	291	qualifier = *fmt;
bf052939 JY	292	if (qualifier == 'l' && *(fmt+1) == 'l') {
	293	qualifier = 'q';
	294	++fmt;
	295	}
153d511e WD	296	++fmt;
	297	}
	298
	299	/* default base */
	300	base = 10;
	301
	302	switch (*fmt) {
	303	case 'c':
	304	if (!(flags & LEFT))
	305	while (--field_width > 0)
	306	*str++ = ' ';
	307	*str++ = (unsigned char) va_arg(args, int);
	308	while (--field_width > 0)
	309	*str++ = ' ';
	310	continue;
	311
	312	case 's':
	313	s = va_arg(args, char *);
	314	if (!s)
	315	s = "<NULL>";
	316
	317	len = strnlen(s, precision);
	318
	319	if (!(flags & LEFT))
	320	while (len < field_width--)
	321	*str++ = ' ';
	322	for (i = 0; i < len; ++i)
	323	str++ = s++;
	324	while (len < field_width--)
	325	*str++ = ' ';
	326	continue;
	327
	328	case 'p':
	329	if (field_width == -1) {
	330	field_width = 2sizeof(void );
	331	flags \|= ZEROPAD;
	332	}
	333	str = number(str,
	334	(unsigned long) va_arg(args, void *), 16,
	335	field_width, precision, flags);
	336	continue;
	337
	338
	339	case 'n':
	340	if (qualifier == 'l') {
	341	long * ip = va_arg(args, long *);
	342	*ip = (str - buf);
	343	} else {
	344	int * ip = va_arg(args, int *);
	345	*ip = (str - buf);
	346	}
	347	continue;
	348
	349	case '%':
	350	*str++ = '%';
	351	continue;
	352
	353	/* integer number formats - set up the flags and "break" */
	354	case 'o':
	355	base = 8;
	356	break;
	357
	358	case 'X':
	359	flags \|= LARGE;
360	case 'x':
361	base = 16;
362	break;
363
364	case 'd':
365	case 'i':
366	flags \|= SIGN;
367	case 'u':
368	break;
369
370	default:
371	*str++ = '%';
372	if (*fmt)
373	str++ = fmt;
374	else
375	--fmt;
376	continue;
377	}
6d0f6bcf	378	#ifdef CONFIG_SYS_64BIT_VSPRINTF
c40b2956 WD	379	if (qualifier == 'q') /* "quad" for 64 bit variables */
	380	num = va_arg(args, unsigned long long);
	381	else
	382	#endif
f354b73e	383	if (qualifier == 'l') {
153d511e	384	num = va_arg(args, unsigned long);
f354b73e JCPV	385	} else if (qualifier == 'Z' \|\| qualifier == 'z') {
	386	num = va_arg(args, size_t);
	387	} else if (qualifier == 't') {
	388	num = va_arg(args, ptrdiff_t);
	389	} else if (qualifier == 'h') {
153d511e WD	390	num = (unsigned short) va_arg(args, int);
	391	if (flags & SIGN)
	392	num = (short) num;
	393	} else if (flags & SIGN)
	394	num = va_arg(args, int);
	395	else
	396	num = va_arg(args, unsigned int);
	397	str = number(str, num, base, field_width, precision, flags);
	398	}
	399	*str = '\0';
	400	return str-buf;
	401	}
	402
	403	int sprintf(char * buf, const char *fmt, ...)
	404	{
	405	va_list args;
	406	int i;
	407
	408	va_start(args, fmt);
	409	i=vsprintf(buf,fmt,args);
	410	va_end(args);
	411	return i;
	412	}
	413
	414	void panic(const char *fmt, ...)
	415	{
	416	va_list args;
	417	va_start(args, fmt);
6dd652fa	418	vprintf(fmt, args);
153d511e WD	419	putc('\n');
	420	va_end(args);
	421	#if defined (CONFIG_PANIC_HANG)
	422	hang();
	423	#else
	424	udelay (100000); /* allow messages to go out */
	425	do_reset (NULL, 0, 0, NULL);
	426	#endif
	427	}