xref: /rk3399_rockchip-uboot/lib/vsprintf.c (revision 046a37bd53f479915bcd5041e0834dad576371a2)
178acc472SPeter Tyser /*
278acc472SPeter Tyser  *  linux/lib/vsprintf.c
378acc472SPeter Tyser  *
478acc472SPeter Tyser  *  Copyright (C) 1991, 1992  Linus Torvalds
578acc472SPeter Tyser  */
678acc472SPeter Tyser 
778acc472SPeter Tyser /* vsprintf.c -- Lars Wirzenius & Linus Torvalds. */
878acc472SPeter Tyser /*
978acc472SPeter Tyser  * Wirzenius wrote this portably, Torvalds fucked it up :-)
103cce8a54SSimon Glass  *
113cce8a54SSimon Glass  * from hush: simple_itoa() was lifted from boa-0.93.15
1278acc472SPeter Tyser  */
1378acc472SPeter Tyser 
1478acc472SPeter Tyser #include <stdarg.h>
1578acc472SPeter Tyser #include <linux/types.h>
1678acc472SPeter Tyser #include <linux/string.h>
1778acc472SPeter Tyser #include <linux/ctype.h>
18a7fd0d9fSHeiko Schocher #include <errno.h>
1978acc472SPeter Tyser 
2078acc472SPeter Tyser #include <common.h>
2178acc472SPeter Tyser #if !defined (CONFIG_PANIC_HANG)
2278acc472SPeter Tyser #include <command.h>
2378acc472SPeter Tyser #endif
2478acc472SPeter Tyser 
2578acc472SPeter Tyser #include <div64.h>
2678acc472SPeter Tyser # define NUM_TYPE long long
2778acc472SPeter Tyser #define noinline __attribute__((noinline))
2878acc472SPeter Tyser 
29*046a37bdSSonny Rao /* some reluctance to put this into a new limits.h, so it is here */
30*046a37bdSSonny Rao #define INT_MAX		((int)(~0U>>1))
31*046a37bdSSonny Rao 
3278acc472SPeter Tyser const char hex_asc[] = "0123456789abcdef";
3378acc472SPeter Tyser #define hex_asc_lo(x)   hex_asc[((x) & 0x0f)]
3478acc472SPeter Tyser #define hex_asc_hi(x)   hex_asc[((x) & 0xf0) >> 4]
3578acc472SPeter Tyser 
3678acc472SPeter Tyser static inline char *pack_hex_byte(char *buf, u8 byte)
3778acc472SPeter Tyser {
3878acc472SPeter Tyser 	*buf++ = hex_asc_hi(byte);
3978acc472SPeter Tyser 	*buf++ = hex_asc_lo(byte);
4078acc472SPeter Tyser 	return buf;
4178acc472SPeter Tyser }
4278acc472SPeter Tyser 
4378acc472SPeter Tyser unsigned long simple_strtoul(const char *cp,char **endp,unsigned int base)
4478acc472SPeter Tyser {
4578acc472SPeter Tyser 	unsigned long result = 0,value;
4678acc472SPeter Tyser 
4778acc472SPeter Tyser 	if (*cp == '0') {
4878acc472SPeter Tyser 		cp++;
4978acc472SPeter Tyser 		if ((*cp == 'x') && isxdigit(cp[1])) {
5078acc472SPeter Tyser 			base = 16;
5178acc472SPeter Tyser 			cp++;
5278acc472SPeter Tyser 		}
5378acc472SPeter Tyser 		if (!base) {
5478acc472SPeter Tyser 			base = 8;
5578acc472SPeter Tyser 		}
5678acc472SPeter Tyser 	}
5778acc472SPeter Tyser 	if (!base) {
5878acc472SPeter Tyser 		base = 10;
5978acc472SPeter Tyser 	}
6078acc472SPeter Tyser 	while (isxdigit(*cp) && (value = isdigit(*cp) ? *cp-'0' : (islower(*cp)
6178acc472SPeter Tyser 	    ? toupper(*cp) : *cp)-'A'+10) < base) {
6278acc472SPeter Tyser 		result = result*base + value;
6378acc472SPeter Tyser 		cp++;
6478acc472SPeter Tyser 	}
6578acc472SPeter Tyser 	if (endp)
6678acc472SPeter Tyser 		*endp = (char *)cp;
6778acc472SPeter Tyser 	return result;
6878acc472SPeter Tyser }
6978acc472SPeter Tyser 
70a7fd0d9fSHeiko Schocher /**
71a7fd0d9fSHeiko Schocher  * strict_strtoul - convert a string to an unsigned long strictly
72a7fd0d9fSHeiko Schocher  * @cp: The string to be converted
73a7fd0d9fSHeiko Schocher  * @base: The number base to use
74a7fd0d9fSHeiko Schocher  * @res: The converted result value
75a7fd0d9fSHeiko Schocher  *
76a7fd0d9fSHeiko Schocher  * strict_strtoul converts a string to an unsigned long only if the
77a7fd0d9fSHeiko Schocher  * string is really an unsigned long string, any string containing
78a7fd0d9fSHeiko Schocher  * any invalid char at the tail will be rejected and -EINVAL is returned,
79a7fd0d9fSHeiko Schocher  * only a newline char at the tail is acceptible because people generally
80a7fd0d9fSHeiko Schocher  * change a module parameter in the following way:
81a7fd0d9fSHeiko Schocher  *
82a7fd0d9fSHeiko Schocher  *      echo 1024 > /sys/module/e1000/parameters/copybreak
83a7fd0d9fSHeiko Schocher  *
84a7fd0d9fSHeiko Schocher  * echo will append a newline to the tail.
85a7fd0d9fSHeiko Schocher  *
86a7fd0d9fSHeiko Schocher  * It returns 0 if conversion is successful and *res is set to the converted
87a7fd0d9fSHeiko Schocher  * value, otherwise it returns -EINVAL and *res is set to 0.
88a7fd0d9fSHeiko Schocher  *
89a7fd0d9fSHeiko Schocher  * simple_strtoul just ignores the successive invalid characters and
90a7fd0d9fSHeiko Schocher  * return the converted value of prefix part of the string.
91a7fd0d9fSHeiko Schocher  *
92a7fd0d9fSHeiko Schocher  * Copied this function from Linux 2.6.38 commit ID:
93a7fd0d9fSHeiko Schocher  * 521cb40b0c44418a4fd36dc633f575813d59a43d
94a7fd0d9fSHeiko Schocher  *
95a7fd0d9fSHeiko Schocher  */
96a7fd0d9fSHeiko Schocher int strict_strtoul(const char *cp, unsigned int base, unsigned long *res)
97a7fd0d9fSHeiko Schocher {
98a7fd0d9fSHeiko Schocher 	char *tail;
99a7fd0d9fSHeiko Schocher 	unsigned long val;
100a7fd0d9fSHeiko Schocher 	size_t len;
101a7fd0d9fSHeiko Schocher 
102a7fd0d9fSHeiko Schocher 	*res = 0;
103a7fd0d9fSHeiko Schocher 	len = strlen(cp);
104a7fd0d9fSHeiko Schocher 	if (len == 0)
105a7fd0d9fSHeiko Schocher 		return -EINVAL;
106a7fd0d9fSHeiko Schocher 
107a7fd0d9fSHeiko Schocher 	val = simple_strtoul(cp, &tail, base);
108a7fd0d9fSHeiko Schocher 	if (tail == cp)
109a7fd0d9fSHeiko Schocher 		return -EINVAL;
110a7fd0d9fSHeiko Schocher 
111a7fd0d9fSHeiko Schocher 	if ((*tail == '\0') ||
112a7fd0d9fSHeiko Schocher 		((len == (size_t)(tail - cp) + 1) && (*tail == '\n'))) {
113a7fd0d9fSHeiko Schocher 		*res = val;
114a7fd0d9fSHeiko Schocher 		return 0;
115a7fd0d9fSHeiko Schocher 	}
116a7fd0d9fSHeiko Schocher 
117a7fd0d9fSHeiko Schocher 	return -EINVAL;
118a7fd0d9fSHeiko Schocher }
119a7fd0d9fSHeiko Schocher 
12078acc472SPeter Tyser long simple_strtol(const char *cp,char **endp,unsigned int base)
12178acc472SPeter Tyser {
12278acc472SPeter Tyser 	if(*cp=='-')
12378acc472SPeter Tyser 		return -simple_strtoul(cp+1,endp,base);
12478acc472SPeter Tyser 	return simple_strtoul(cp,endp,base);
12578acc472SPeter Tyser }
12678acc472SPeter Tyser 
12778acc472SPeter Tyser int ustrtoul(const char *cp, char **endp, unsigned int base)
12878acc472SPeter Tyser {
12978acc472SPeter Tyser 	unsigned long result = simple_strtoul(cp, endp, base);
13078acc472SPeter Tyser 	switch (**endp) {
13178acc472SPeter Tyser 	case 'G' :
13278acc472SPeter Tyser 		result *= 1024;
13378acc472SPeter Tyser 		/* fall through */
13478acc472SPeter Tyser 	case 'M':
13578acc472SPeter Tyser 		result *= 1024;
13678acc472SPeter Tyser 		/* fall through */
13778acc472SPeter Tyser 	case 'K':
13878acc472SPeter Tyser 	case 'k':
13978acc472SPeter Tyser 		result *= 1024;
14078acc472SPeter Tyser 		if ((*endp)[1] == 'i') {
14178acc472SPeter Tyser 			if ((*endp)[2] == 'B')
14278acc472SPeter Tyser 				(*endp) += 3;
14378acc472SPeter Tyser 			else
14478acc472SPeter Tyser 				(*endp) += 2;
14578acc472SPeter Tyser 		}
14678acc472SPeter Tyser 	}
14778acc472SPeter Tyser 	return result;
14878acc472SPeter Tyser }
14978acc472SPeter Tyser 
15078acc472SPeter Tyser unsigned long long simple_strtoull (const char *cp, char **endp, unsigned int base)
15178acc472SPeter Tyser {
15278acc472SPeter Tyser 	unsigned long long result = 0, value;
15378acc472SPeter Tyser 
15478acc472SPeter Tyser 	if (*cp == '0') {
15578acc472SPeter Tyser 		cp++;
15678acc472SPeter Tyser 		if ((*cp == 'x') && isxdigit (cp[1])) {
15778acc472SPeter Tyser 			base = 16;
15878acc472SPeter Tyser 			cp++;
15978acc472SPeter Tyser 		}
16078acc472SPeter Tyser 		if (!base) {
16178acc472SPeter Tyser 			base = 8;
16278acc472SPeter Tyser 		}
16378acc472SPeter Tyser 	}
16478acc472SPeter Tyser 	if (!base) {
16578acc472SPeter Tyser 		base = 10;
16678acc472SPeter Tyser 	}
16778acc472SPeter Tyser 	while (isxdigit (*cp) && (value = isdigit (*cp)
16878acc472SPeter Tyser 				? *cp - '0'
16978acc472SPeter Tyser 				: (islower (*cp) ? toupper (*cp) : *cp) - 'A' + 10) < base) {
17078acc472SPeter Tyser 		result = result * base + value;
17178acc472SPeter Tyser 		cp++;
17278acc472SPeter Tyser 	}
17378acc472SPeter Tyser 	if (endp)
17478acc472SPeter Tyser 		*endp = (char *) cp;
17578acc472SPeter Tyser 	return result;
17678acc472SPeter Tyser }
17778acc472SPeter Tyser 
17878acc472SPeter Tyser /* we use this so that we can do without the ctype library */
17978acc472SPeter Tyser #define is_digit(c)	((c) >= '0' && (c) <= '9')
18078acc472SPeter Tyser 
18178acc472SPeter Tyser static int skip_atoi(const char **s)
18278acc472SPeter Tyser {
18378acc472SPeter Tyser 	int i=0;
18478acc472SPeter Tyser 
18578acc472SPeter Tyser 	while (is_digit(**s))
18678acc472SPeter Tyser 		i = i*10 + *((*s)++) - '0';
18778acc472SPeter Tyser 	return i;
18878acc472SPeter Tyser }
18978acc472SPeter Tyser 
19078acc472SPeter Tyser /* Decimal conversion is by far the most typical, and is used
19178acc472SPeter Tyser  * for /proc and /sys data. This directly impacts e.g. top performance
19278acc472SPeter Tyser  * with many processes running. We optimize it for speed
19378acc472SPeter Tyser  * using code from
19478acc472SPeter Tyser  * http://www.cs.uiowa.edu/~jones/bcd/decimal.html
19578acc472SPeter Tyser  * (with permission from the author, Douglas W. Jones). */
19678acc472SPeter Tyser 
19778acc472SPeter Tyser /* Formats correctly any integer in [0,99999].
19878acc472SPeter Tyser  * Outputs from one to five digits depending on input.
19978acc472SPeter Tyser  * On i386 gcc 4.1.2 -O2: ~250 bytes of code. */
20078acc472SPeter Tyser static char* put_dec_trunc(char *buf, unsigned q)
20178acc472SPeter Tyser {
20278acc472SPeter Tyser 	unsigned d3, d2, d1, d0;
20378acc472SPeter Tyser 	d1 = (q>>4) & 0xf;
20478acc472SPeter Tyser 	d2 = (q>>8) & 0xf;
20578acc472SPeter Tyser 	d3 = (q>>12);
20678acc472SPeter Tyser 
20778acc472SPeter Tyser 	d0 = 6*(d3 + d2 + d1) + (q & 0xf);
20878acc472SPeter Tyser 	q = (d0 * 0xcd) >> 11;
20978acc472SPeter Tyser 	d0 = d0 - 10*q;
21078acc472SPeter Tyser 	*buf++ = d0 + '0'; /* least significant digit */
21178acc472SPeter Tyser 	d1 = q + 9*d3 + 5*d2 + d1;
21278acc472SPeter Tyser 	if (d1 != 0) {
21378acc472SPeter Tyser 		q = (d1 * 0xcd) >> 11;
21478acc472SPeter Tyser 		d1 = d1 - 10*q;
21578acc472SPeter Tyser 		*buf++ = d1 + '0'; /* next digit */
21678acc472SPeter Tyser 
21778acc472SPeter Tyser 		d2 = q + 2*d2;
21878acc472SPeter Tyser 		if ((d2 != 0) || (d3 != 0)) {
21978acc472SPeter Tyser 			q = (d2 * 0xd) >> 7;
22078acc472SPeter Tyser 			d2 = d2 - 10*q;
22178acc472SPeter Tyser 			*buf++ = d2 + '0'; /* next digit */
22278acc472SPeter Tyser 
22378acc472SPeter Tyser 			d3 = q + 4*d3;
22478acc472SPeter Tyser 			if (d3 != 0) {
22578acc472SPeter Tyser 				q = (d3 * 0xcd) >> 11;
22678acc472SPeter Tyser 				d3 = d3 - 10*q;
22778acc472SPeter Tyser 				*buf++ = d3 + '0';  /* next digit */
22878acc472SPeter Tyser 				if (q != 0)
22978acc472SPeter Tyser 					*buf++ = q + '0';  /* most sign. digit */
23078acc472SPeter Tyser 			}
23178acc472SPeter Tyser 		}
23278acc472SPeter Tyser 	}
23378acc472SPeter Tyser 	return buf;
23478acc472SPeter Tyser }
23578acc472SPeter Tyser /* Same with if's removed. Always emits five digits */
23678acc472SPeter Tyser static char* put_dec_full(char *buf, unsigned q)
23778acc472SPeter Tyser {
23878acc472SPeter Tyser 	/* BTW, if q is in [0,9999], 8-bit ints will be enough, */
23978acc472SPeter Tyser 	/* but anyway, gcc produces better code with full-sized ints */
24078acc472SPeter Tyser 	unsigned d3, d2, d1, d0;
24178acc472SPeter Tyser 	d1 = (q>>4) & 0xf;
24278acc472SPeter Tyser 	d2 = (q>>8) & 0xf;
24378acc472SPeter Tyser 	d3 = (q>>12);
24478acc472SPeter Tyser 
24578acc472SPeter Tyser 	/*
24678acc472SPeter Tyser 	 * Possible ways to approx. divide by 10
24778acc472SPeter Tyser 	 * gcc -O2 replaces multiply with shifts and adds
24878acc472SPeter Tyser 	 * (x * 0xcd) >> 11: 11001101 - shorter code than * 0x67 (on i386)
24978acc472SPeter Tyser 	 * (x * 0x67) >> 10:  1100111
25078acc472SPeter Tyser 	 * (x * 0x34) >> 9:    110100 - same
25178acc472SPeter Tyser 	 * (x * 0x1a) >> 8:     11010 - same
25278acc472SPeter Tyser 	 * (x * 0x0d) >> 7:      1101 - same, shortest code (on i386)
25378acc472SPeter Tyser 	 */
25478acc472SPeter Tyser 
25578acc472SPeter Tyser 	d0 = 6*(d3 + d2 + d1) + (q & 0xf);
25678acc472SPeter Tyser 	q = (d0 * 0xcd) >> 11;
25778acc472SPeter Tyser 	d0 = d0 - 10*q;
25878acc472SPeter Tyser 	*buf++ = d0 + '0';
25978acc472SPeter Tyser 	d1 = q + 9*d3 + 5*d2 + d1;
26078acc472SPeter Tyser 		q = (d1 * 0xcd) >> 11;
26178acc472SPeter Tyser 		d1 = d1 - 10*q;
26278acc472SPeter Tyser 		*buf++ = d1 + '0';
26378acc472SPeter Tyser 
26478acc472SPeter Tyser 		d2 = q + 2*d2;
26578acc472SPeter Tyser 			q = (d2 * 0xd) >> 7;
26678acc472SPeter Tyser 			d2 = d2 - 10*q;
26778acc472SPeter Tyser 			*buf++ = d2 + '0';
26878acc472SPeter Tyser 
26978acc472SPeter Tyser 			d3 = q + 4*d3;
27078acc472SPeter Tyser 				q = (d3 * 0xcd) >> 11; /* - shorter code */
27178acc472SPeter Tyser 				/* q = (d3 * 0x67) >> 10; - would also work */
27278acc472SPeter Tyser 				d3 = d3 - 10*q;
27378acc472SPeter Tyser 				*buf++ = d3 + '0';
27478acc472SPeter Tyser 					*buf++ = q + '0';
27578acc472SPeter Tyser 	return buf;
27678acc472SPeter Tyser }
27778acc472SPeter Tyser /* No inlining helps gcc to use registers better */
27878acc472SPeter Tyser static noinline char* put_dec(char *buf, unsigned NUM_TYPE num)
27978acc472SPeter Tyser {
28078acc472SPeter Tyser 	while (1) {
28178acc472SPeter Tyser 		unsigned rem;
28278acc472SPeter Tyser 		if (num < 100000)
28378acc472SPeter Tyser 			return put_dec_trunc(buf, num);
28478acc472SPeter Tyser 		rem = do_div(num, 100000);
28578acc472SPeter Tyser 		buf = put_dec_full(buf, rem);
28678acc472SPeter Tyser 	}
28778acc472SPeter Tyser }
28878acc472SPeter Tyser 
28978acc472SPeter Tyser #define ZEROPAD	1		/* pad with zero */
29078acc472SPeter Tyser #define SIGN	2		/* unsigned/signed long */
29178acc472SPeter Tyser #define PLUS	4		/* show plus */
29278acc472SPeter Tyser #define SPACE	8		/* space if plus */
29378acc472SPeter Tyser #define LEFT	16		/* left justified */
29478acc472SPeter Tyser #define SMALL	32		/* Must be 32 == 0x20 */
29578acc472SPeter Tyser #define SPECIAL	64		/* 0x */
29678acc472SPeter Tyser 
297*046a37bdSSonny Rao #ifdef CONFIG_SYS_VSNPRINTF
298*046a37bdSSonny Rao /*
299*046a37bdSSonny Rao  * Macro to add a new character to our output string, but only if it will
300*046a37bdSSonny Rao  * fit. The macro moves to the next character position in the output string.
301*046a37bdSSonny Rao  */
302*046a37bdSSonny Rao #define ADDCH(str, ch) do { \
303*046a37bdSSonny Rao 	if ((str) < end) \
304*046a37bdSSonny Rao 		*(str) = (ch); \
305*046a37bdSSonny Rao 	++str; \
306*046a37bdSSonny Rao 	} while (0)
307*046a37bdSSonny Rao #else
308*046a37bdSSonny Rao #define ADDCH(str, ch)	(*(str)++ = (ch))
309*046a37bdSSonny Rao #endif
310*046a37bdSSonny Rao 
311*046a37bdSSonny Rao static char *number(char *buf, char *end, unsigned NUM_TYPE num,
312*046a37bdSSonny Rao 		int base, int size, int precision, int type)
31378acc472SPeter Tyser {
31478acc472SPeter Tyser 	/* we are called with base 8, 10 or 16, only, thus don't need "G..."  */
31578acc472SPeter Tyser 	static const char digits[16] = "0123456789ABCDEF"; /* "GHIJKLMNOPQRSTUVWXYZ"; */
31678acc472SPeter Tyser 
31778acc472SPeter Tyser 	char tmp[66];
31878acc472SPeter Tyser 	char sign;
31978acc472SPeter Tyser 	char locase;
32078acc472SPeter Tyser 	int need_pfx = ((type & SPECIAL) && base != 10);
32178acc472SPeter Tyser 	int i;
32278acc472SPeter Tyser 
32378acc472SPeter Tyser 	/* locase = 0 or 0x20. ORing digits or letters with 'locase'
32478acc472SPeter Tyser 	 * produces same digits or (maybe lowercased) letters */
32578acc472SPeter Tyser 	locase = (type & SMALL);
32678acc472SPeter Tyser 	if (type & LEFT)
32778acc472SPeter Tyser 		type &= ~ZEROPAD;
32878acc472SPeter Tyser 	sign = 0;
32978acc472SPeter Tyser 	if (type & SIGN) {
33078acc472SPeter Tyser 		if ((signed NUM_TYPE) num < 0) {
33178acc472SPeter Tyser 			sign = '-';
33278acc472SPeter Tyser 			num = - (signed NUM_TYPE) num;
33378acc472SPeter Tyser 			size--;
33478acc472SPeter Tyser 		} else if (type & PLUS) {
33578acc472SPeter Tyser 			sign = '+';
33678acc472SPeter Tyser 			size--;
33778acc472SPeter Tyser 		} else if (type & SPACE) {
33878acc472SPeter Tyser 			sign = ' ';
33978acc472SPeter Tyser 			size--;
34078acc472SPeter Tyser 		}
34178acc472SPeter Tyser 	}
34278acc472SPeter Tyser 	if (need_pfx) {
34378acc472SPeter Tyser 		size--;
34478acc472SPeter Tyser 		if (base == 16)
34578acc472SPeter Tyser 			size--;
34678acc472SPeter Tyser 	}
34778acc472SPeter Tyser 
34878acc472SPeter Tyser 	/* generate full string in tmp[], in reverse order */
34978acc472SPeter Tyser 	i = 0;
35078acc472SPeter Tyser 	if (num == 0)
35178acc472SPeter Tyser 		tmp[i++] = '0';
35278acc472SPeter Tyser 	/* Generic code, for any base:
35378acc472SPeter Tyser 	else do {
35478acc472SPeter Tyser 		tmp[i++] = (digits[do_div(num,base)] | locase);
35578acc472SPeter Tyser 	} while (num != 0);
35678acc472SPeter Tyser 	*/
35778acc472SPeter Tyser 	else if (base != 10) { /* 8 or 16 */
35878acc472SPeter Tyser 		int mask = base - 1;
35978acc472SPeter Tyser 		int shift = 3;
36078acc472SPeter Tyser 		if (base == 16) shift = 4;
36178acc472SPeter Tyser 		do {
36278acc472SPeter Tyser 			tmp[i++] = (digits[((unsigned char)num) & mask] | locase);
36378acc472SPeter Tyser 			num >>= shift;
36478acc472SPeter Tyser 		} while (num);
36578acc472SPeter Tyser 	} else { /* base 10 */
36678acc472SPeter Tyser 		i = put_dec(tmp, num) - tmp;
36778acc472SPeter Tyser 	}
36878acc472SPeter Tyser 
36978acc472SPeter Tyser 	/* printing 100 using %2d gives "100", not "00" */
37078acc472SPeter Tyser 	if (i > precision)
37178acc472SPeter Tyser 		precision = i;
37278acc472SPeter Tyser 	/* leading space padding */
37378acc472SPeter Tyser 	size -= precision;
374*046a37bdSSonny Rao 	if (!(type & (ZEROPAD + LEFT))) {
37578acc472SPeter Tyser 		while (--size >= 0)
376*046a37bdSSonny Rao 			ADDCH(buf, ' ');
377*046a37bdSSonny Rao 	}
37878acc472SPeter Tyser 	/* sign */
37978acc472SPeter Tyser 	if (sign)
380*046a37bdSSonny Rao 		ADDCH(buf, sign);
38178acc472SPeter Tyser 	/* "0x" / "0" prefix */
38278acc472SPeter Tyser 	if (need_pfx) {
383*046a37bdSSonny Rao 		ADDCH(buf, '0');
38478acc472SPeter Tyser 		if (base == 16)
385*046a37bdSSonny Rao 			ADDCH(buf, 'X' | locase);
38678acc472SPeter Tyser 	}
38778acc472SPeter Tyser 	/* zero or space padding */
38878acc472SPeter Tyser 	if (!(type & LEFT)) {
38978acc472SPeter Tyser 		char c = (type & ZEROPAD) ? '0' : ' ';
390*046a37bdSSonny Rao 
39178acc472SPeter Tyser 		while (--size >= 0)
392*046a37bdSSonny Rao 			ADDCH(buf, c);
39378acc472SPeter Tyser 	}
39478acc472SPeter Tyser 	/* hmm even more zero padding? */
39578acc472SPeter Tyser 	while (i <= --precision)
396*046a37bdSSonny Rao 		ADDCH(buf, '0');
39778acc472SPeter Tyser 	/* actual digits of result */
39878acc472SPeter Tyser 	while (--i >= 0)
399*046a37bdSSonny Rao 		ADDCH(buf, tmp[i]);
40078acc472SPeter Tyser 	/* trailing space padding */
40178acc472SPeter Tyser 	while (--size >= 0)
402*046a37bdSSonny Rao 		ADDCH(buf, ' ');
40378acc472SPeter Tyser 	return buf;
40478acc472SPeter Tyser }
40578acc472SPeter Tyser 
406*046a37bdSSonny Rao static char *string(char *buf, char *end, char *s, int field_width,
407*046a37bdSSonny Rao 		int precision, int flags)
40878acc472SPeter Tyser {
40978acc472SPeter Tyser 	int len, i;
41078acc472SPeter Tyser 
41178acc472SPeter Tyser 	if (s == 0)
41278acc472SPeter Tyser 		s = "<NULL>";
41378acc472SPeter Tyser 
41478acc472SPeter Tyser 	len = strnlen(s, precision);
41578acc472SPeter Tyser 
41678acc472SPeter Tyser 	if (!(flags & LEFT))
41778acc472SPeter Tyser 		while (len < field_width--)
418*046a37bdSSonny Rao 			ADDCH(buf, ' ');
41978acc472SPeter Tyser 	for (i = 0; i < len; ++i)
420*046a37bdSSonny Rao 		ADDCH(buf, *s++);
42178acc472SPeter Tyser 	while (len < field_width--)
422*046a37bdSSonny Rao 		ADDCH(buf, ' ');
42378acc472SPeter Tyser 	return buf;
42478acc472SPeter Tyser }
42578acc472SPeter Tyser 
42678acc472SPeter Tyser #ifdef CONFIG_CMD_NET
427*046a37bdSSonny Rao static char *mac_address_string(char *buf, char *end, u8 *addr, int field_width,
42878acc472SPeter Tyser 				int precision, int flags)
42978acc472SPeter Tyser {
43078acc472SPeter Tyser 	char mac_addr[6 * 3]; /* (6 * 2 hex digits), 5 colons and trailing zero */
43178acc472SPeter Tyser 	char *p = mac_addr;
43278acc472SPeter Tyser 	int i;
43378acc472SPeter Tyser 
43478acc472SPeter Tyser 	for (i = 0; i < 6; i++) {
43578acc472SPeter Tyser 		p = pack_hex_byte(p, addr[i]);
43678acc472SPeter Tyser 		if (!(flags & SPECIAL) && i != 5)
43778acc472SPeter Tyser 			*p++ = ':';
43878acc472SPeter Tyser 	}
43978acc472SPeter Tyser 	*p = '\0';
44078acc472SPeter Tyser 
441*046a37bdSSonny Rao 	return string(buf, end, mac_addr, field_width, precision,
442*046a37bdSSonny Rao 		      flags & ~SPECIAL);
44378acc472SPeter Tyser }
44478acc472SPeter Tyser 
445*046a37bdSSonny Rao static char *ip6_addr_string(char *buf, char *end, u8 *addr, int field_width,
44678acc472SPeter Tyser 			 int precision, int flags)
44778acc472SPeter Tyser {
44878acc472SPeter Tyser 	char ip6_addr[8 * 5]; /* (8 * 4 hex digits), 7 colons and trailing zero */
44978acc472SPeter Tyser 	char *p = ip6_addr;
45078acc472SPeter Tyser 	int i;
45178acc472SPeter Tyser 
45278acc472SPeter Tyser 	for (i = 0; i < 8; i++) {
45378acc472SPeter Tyser 		p = pack_hex_byte(p, addr[2 * i]);
45478acc472SPeter Tyser 		p = pack_hex_byte(p, addr[2 * i + 1]);
45578acc472SPeter Tyser 		if (!(flags & SPECIAL) && i != 7)
45678acc472SPeter Tyser 			*p++ = ':';
45778acc472SPeter Tyser 	}
45878acc472SPeter Tyser 	*p = '\0';
45978acc472SPeter Tyser 
460*046a37bdSSonny Rao 	return string(buf, end, ip6_addr, field_width, precision,
461*046a37bdSSonny Rao 		      flags & ~SPECIAL);
46278acc472SPeter Tyser }
46378acc472SPeter Tyser 
464*046a37bdSSonny Rao static char *ip4_addr_string(char *buf, char *end, u8 *addr, int field_width,
46578acc472SPeter Tyser 			 int precision, int flags)
46678acc472SPeter Tyser {
46778acc472SPeter Tyser 	char ip4_addr[4 * 4]; /* (4 * 3 decimal digits), 3 dots and trailing zero */
46878acc472SPeter Tyser 	char temp[3];	/* hold each IP quad in reverse order */
46978acc472SPeter Tyser 	char *p = ip4_addr;
47078acc472SPeter Tyser 	int i, digits;
47178acc472SPeter Tyser 
47278acc472SPeter Tyser 	for (i = 0; i < 4; i++) {
47378acc472SPeter Tyser 		digits = put_dec_trunc(temp, addr[i]) - temp;
47478acc472SPeter Tyser 		/* reverse the digits in the quad */
47578acc472SPeter Tyser 		while (digits--)
47678acc472SPeter Tyser 			*p++ = temp[digits];
47778acc472SPeter Tyser 		if (i != 3)
47878acc472SPeter Tyser 			*p++ = '.';
47978acc472SPeter Tyser 	}
48078acc472SPeter Tyser 	*p = '\0';
48178acc472SPeter Tyser 
482*046a37bdSSonny Rao 	return string(buf, end, ip4_addr, field_width, precision,
483*046a37bdSSonny Rao 		      flags & ~SPECIAL);
48478acc472SPeter Tyser }
48578acc472SPeter Tyser #endif
48678acc472SPeter Tyser 
48778acc472SPeter Tyser /*
48878acc472SPeter Tyser  * Show a '%p' thing.  A kernel extension is that the '%p' is followed
48978acc472SPeter Tyser  * by an extra set of alphanumeric characters that are extended format
49078acc472SPeter Tyser  * specifiers.
49178acc472SPeter Tyser  *
49278acc472SPeter Tyser  * Right now we handle:
49378acc472SPeter Tyser  *
49478acc472SPeter Tyser  * - 'M' For a 6-byte MAC address, it prints the address in the
49578acc472SPeter Tyser  *       usual colon-separated hex notation
49678acc472SPeter Tyser  * - 'I' [46] for IPv4/IPv6 addresses printed in the usual way (dot-separated
49778acc472SPeter Tyser  *       decimal for v4 and colon separated network-order 16 bit hex for v6)
49878acc472SPeter Tyser  * - 'i' [46] for 'raw' IPv4/IPv6 addresses, IPv6 omits the colons, IPv4 is
49978acc472SPeter Tyser  *       currently the same
50078acc472SPeter Tyser  *
50178acc472SPeter Tyser  * Note: The difference between 'S' and 'F' is that on ia64 and ppc64
50278acc472SPeter Tyser  * function pointers are really function descriptors, which contain a
50378acc472SPeter Tyser  * pointer to the real address.
50478acc472SPeter Tyser  */
505*046a37bdSSonny Rao static char *pointer(const char *fmt, char *buf, char *end, void *ptr,
506*046a37bdSSonny Rao 		int field_width, int precision, int flags)
50778acc472SPeter Tyser {
50878acc472SPeter Tyser 	if (!ptr)
509*046a37bdSSonny Rao 		return string(buf, end, "(null)", field_width, precision,
510*046a37bdSSonny Rao 			      flags);
51178acc472SPeter Tyser 
51278acc472SPeter Tyser #ifdef CONFIG_CMD_NET
51378acc472SPeter Tyser 	switch (*fmt) {
51478acc472SPeter Tyser 	case 'm':
51578acc472SPeter Tyser 		flags |= SPECIAL;
51678acc472SPeter Tyser 		/* Fallthrough */
51778acc472SPeter Tyser 	case 'M':
518*046a37bdSSonny Rao 		return mac_address_string(buf, end, ptr, field_width,
519*046a37bdSSonny Rao 					  precision, flags);
52078acc472SPeter Tyser 	case 'i':
52178acc472SPeter Tyser 		flags |= SPECIAL;
52278acc472SPeter Tyser 		/* Fallthrough */
52378acc472SPeter Tyser 	case 'I':
52478acc472SPeter Tyser 		if (fmt[1] == '6')
525*046a37bdSSonny Rao 			return ip6_addr_string(buf, end, ptr, field_width,
526*046a37bdSSonny Rao 					       precision, flags);
52778acc472SPeter Tyser 		if (fmt[1] == '4')
528*046a37bdSSonny Rao 			return ip4_addr_string(buf, end, ptr, field_width,
529*046a37bdSSonny Rao 					       precision, flags);
53078acc472SPeter Tyser 		flags &= ~SPECIAL;
53178acc472SPeter Tyser 		break;
53278acc472SPeter Tyser 	}
53378acc472SPeter Tyser #endif
53478acc472SPeter Tyser 	flags |= SMALL;
53578acc472SPeter Tyser 	if (field_width == -1) {
53678acc472SPeter Tyser 		field_width = 2*sizeof(void *);
53778acc472SPeter Tyser 		flags |= ZEROPAD;
53878acc472SPeter Tyser 	}
539*046a37bdSSonny Rao 	return number(buf, end, (unsigned long)ptr, 16, field_width,
540*046a37bdSSonny Rao 		      precision, flags);
54178acc472SPeter Tyser }
54278acc472SPeter Tyser 
54378acc472SPeter Tyser /**
544*046a37bdSSonny Rao  * Format a string and place it in a buffer (base function)
54578acc472SPeter Tyser  *
546*046a37bdSSonny Rao  * @param buf	The buffer to place the result into
547*046a37bdSSonny Rao  * @param size	The size of the buffer, including the trailing null space
548*046a37bdSSonny Rao  * @param fmt	The format string to use
549*046a37bdSSonny Rao  * @param args	Arguments for the format string
550*046a37bdSSonny Rao  * @return The number characters which would be generated for the given
551*046a37bdSSonny Rao  * input, excluding the trailing '\0', as per ISO C99. Note that fewer
552*046a37bdSSonny Rao  * characters may be written if this number of characters is >= size.
553*046a37bdSSonny Rao  *
554*046a37bdSSonny Rao  * This function follows C99 vsnprintf, but has some extensions:
55578acc472SPeter Tyser  * %pS output the name of a text symbol
55678acc472SPeter Tyser  * %pF output the name of a function pointer
55778acc472SPeter Tyser  * %pR output the address range in a struct resource
55878acc472SPeter Tyser  *
55978acc472SPeter Tyser  * Call this function if you are already dealing with a va_list.
560*046a37bdSSonny Rao  * You probably want snprintf() instead.
56178acc472SPeter Tyser  */
562*046a37bdSSonny Rao static int vsnprintf_internal(char *buf, size_t size, const char *fmt,
563*046a37bdSSonny Rao 			      va_list args)
56478acc472SPeter Tyser {
56578acc472SPeter Tyser 	unsigned NUM_TYPE num;
56678acc472SPeter Tyser 	int base;
56778acc472SPeter Tyser 	char *str;
56878acc472SPeter Tyser 
56978acc472SPeter Tyser 	int flags;		/* flags to number() */
57078acc472SPeter Tyser 
57178acc472SPeter Tyser 	int field_width;	/* width of output field */
57278acc472SPeter Tyser 	int precision;		/* min. # of digits for integers; max
57378acc472SPeter Tyser 				   number of chars for from string */
57478acc472SPeter Tyser 	int qualifier;		/* 'h', 'l', or 'L' for integer fields */
57578acc472SPeter Tyser 				/* 'z' support added 23/7/1999 S.H.    */
57678acc472SPeter Tyser 				/* 'z' changed to 'Z' --davidm 1/25/99 */
57778acc472SPeter Tyser 				/* 't' added for ptrdiff_t */
578*046a37bdSSonny Rao 	char *end = buf + size;
57978acc472SPeter Tyser 
580*046a37bdSSonny Rao #ifdef CONFIG_SYS_VSNPRINTF
581*046a37bdSSonny Rao 	/* Make sure end is always >= buf - do we want this in U-Boot? */
582*046a37bdSSonny Rao 	if (end < buf) {
583*046a37bdSSonny Rao 		end = ((void *)-1);
584*046a37bdSSonny Rao 		size = end - buf;
585*046a37bdSSonny Rao 	}
586*046a37bdSSonny Rao #endif
58778acc472SPeter Tyser 	str = buf;
58878acc472SPeter Tyser 
58978acc472SPeter Tyser 	for (; *fmt ; ++fmt) {
59078acc472SPeter Tyser 		if (*fmt != '%') {
591*046a37bdSSonny Rao 			ADDCH(str, *fmt);
59278acc472SPeter Tyser 			continue;
59378acc472SPeter Tyser 		}
59478acc472SPeter Tyser 
59578acc472SPeter Tyser 		/* process flags */
59678acc472SPeter Tyser 		flags = 0;
59778acc472SPeter Tyser 		repeat:
59878acc472SPeter Tyser 			++fmt;		/* this also skips first '%' */
59978acc472SPeter Tyser 			switch (*fmt) {
60078acc472SPeter Tyser 				case '-': flags |= LEFT; goto repeat;
60178acc472SPeter Tyser 				case '+': flags |= PLUS; goto repeat;
60278acc472SPeter Tyser 				case ' ': flags |= SPACE; goto repeat;
60378acc472SPeter Tyser 				case '#': flags |= SPECIAL; goto repeat;
60478acc472SPeter Tyser 				case '0': flags |= ZEROPAD; goto repeat;
60578acc472SPeter Tyser 			}
60678acc472SPeter Tyser 
60778acc472SPeter Tyser 		/* get field width */
60878acc472SPeter Tyser 		field_width = -1;
60978acc472SPeter Tyser 		if (is_digit(*fmt))
61078acc472SPeter Tyser 			field_width = skip_atoi(&fmt);
61178acc472SPeter Tyser 		else if (*fmt == '*') {
61278acc472SPeter Tyser 			++fmt;
61378acc472SPeter Tyser 			/* it's the next argument */
61478acc472SPeter Tyser 			field_width = va_arg(args, int);
61578acc472SPeter Tyser 			if (field_width < 0) {
61678acc472SPeter Tyser 				field_width = -field_width;
61778acc472SPeter Tyser 				flags |= LEFT;
61878acc472SPeter Tyser 			}
61978acc472SPeter Tyser 		}
62078acc472SPeter Tyser 
62178acc472SPeter Tyser 		/* get the precision */
62278acc472SPeter Tyser 		precision = -1;
62378acc472SPeter Tyser 		if (*fmt == '.') {
62478acc472SPeter Tyser 			++fmt;
62578acc472SPeter Tyser 			if (is_digit(*fmt))
62678acc472SPeter Tyser 				precision = skip_atoi(&fmt);
62778acc472SPeter Tyser 			else if (*fmt == '*') {
62878acc472SPeter Tyser 				++fmt;
62978acc472SPeter Tyser 				/* it's the next argument */
63078acc472SPeter Tyser 				precision = va_arg(args, int);
63178acc472SPeter Tyser 			}
63278acc472SPeter Tyser 			if (precision < 0)
63378acc472SPeter Tyser 				precision = 0;
63478acc472SPeter Tyser 		}
63578acc472SPeter Tyser 
63678acc472SPeter Tyser 		/* get the conversion qualifier */
63778acc472SPeter Tyser 		qualifier = -1;
63878acc472SPeter Tyser 		if (*fmt == 'h' || *fmt == 'l' || *fmt == 'L' ||
63978acc472SPeter Tyser 		    *fmt == 'Z' || *fmt == 'z' || *fmt == 't') {
64078acc472SPeter Tyser 			qualifier = *fmt;
64178acc472SPeter Tyser 			++fmt;
64278acc472SPeter Tyser 			if (qualifier == 'l' && *fmt == 'l') {
64378acc472SPeter Tyser 				qualifier = 'L';
64478acc472SPeter Tyser 				++fmt;
64578acc472SPeter Tyser 			}
64678acc472SPeter Tyser 		}
64778acc472SPeter Tyser 
64878acc472SPeter Tyser 		/* default base */
64978acc472SPeter Tyser 		base = 10;
65078acc472SPeter Tyser 
65178acc472SPeter Tyser 		switch (*fmt) {
65278acc472SPeter Tyser 		case 'c':
653*046a37bdSSonny Rao 			if (!(flags & LEFT)) {
65478acc472SPeter Tyser 				while (--field_width > 0)
655*046a37bdSSonny Rao 					ADDCH(str, ' ');
656*046a37bdSSonny Rao 			}
657*046a37bdSSonny Rao 			ADDCH(str, (unsigned char) va_arg(args, int));
65878acc472SPeter Tyser 			while (--field_width > 0)
659*046a37bdSSonny Rao 				ADDCH(str, ' ');
66078acc472SPeter Tyser 			continue;
66178acc472SPeter Tyser 
66278acc472SPeter Tyser 		case 's':
663*046a37bdSSonny Rao 			str = string(str, end, va_arg(args, char *),
664*046a37bdSSonny Rao 				     field_width, precision, flags);
66578acc472SPeter Tyser 			continue;
66678acc472SPeter Tyser 
66778acc472SPeter Tyser 		case 'p':
668*046a37bdSSonny Rao 			str = pointer(fmt+1, str, end,
66978acc472SPeter Tyser 					va_arg(args, void *),
67078acc472SPeter Tyser 					field_width, precision, flags);
67178acc472SPeter Tyser 			/* Skip all alphanumeric pointer suffixes */
67278acc472SPeter Tyser 			while (isalnum(fmt[1]))
67378acc472SPeter Tyser 				fmt++;
67478acc472SPeter Tyser 			continue;
67578acc472SPeter Tyser 
67678acc472SPeter Tyser 		case 'n':
67778acc472SPeter Tyser 			if (qualifier == 'l') {
67878acc472SPeter Tyser 				long * ip = va_arg(args, long *);
67978acc472SPeter Tyser 				*ip = (str - buf);
68078acc472SPeter Tyser 			} else {
68178acc472SPeter Tyser 				int * ip = va_arg(args, int *);
68278acc472SPeter Tyser 				*ip = (str - buf);
68378acc472SPeter Tyser 			}
68478acc472SPeter Tyser 			continue;
68578acc472SPeter Tyser 
68678acc472SPeter Tyser 		case '%':
687*046a37bdSSonny Rao 			ADDCH(str, '%');
68878acc472SPeter Tyser 			continue;
68978acc472SPeter Tyser 
69078acc472SPeter Tyser 		/* integer number formats - set up the flags and "break" */
69178acc472SPeter Tyser 		case 'o':
69278acc472SPeter Tyser 			base = 8;
69378acc472SPeter Tyser 			break;
69478acc472SPeter Tyser 
69578acc472SPeter Tyser 		case 'x':
69678acc472SPeter Tyser 			flags |= SMALL;
69778acc472SPeter Tyser 		case 'X':
69878acc472SPeter Tyser 			base = 16;
69978acc472SPeter Tyser 			break;
70078acc472SPeter Tyser 
70178acc472SPeter Tyser 		case 'd':
70278acc472SPeter Tyser 		case 'i':
70378acc472SPeter Tyser 			flags |= SIGN;
70478acc472SPeter Tyser 		case 'u':
70578acc472SPeter Tyser 			break;
70678acc472SPeter Tyser 
70778acc472SPeter Tyser 		default:
708*046a37bdSSonny Rao 			ADDCH(str, '%');
70978acc472SPeter Tyser 			if (*fmt)
710*046a37bdSSonny Rao 				ADDCH(str, *fmt);
71178acc472SPeter Tyser 			else
71278acc472SPeter Tyser 				--fmt;
71378acc472SPeter Tyser 			continue;
71478acc472SPeter Tyser 		}
71578acc472SPeter Tyser 		if (qualifier == 'L')  /* "quad" for 64 bit variables */
71678acc472SPeter Tyser 			num = va_arg(args, unsigned long long);
71778acc472SPeter Tyser 		else if (qualifier == 'l') {
71878acc472SPeter Tyser 			num = va_arg(args, unsigned long);
71978acc472SPeter Tyser 			if (flags & SIGN)
72078acc472SPeter Tyser 				num = (signed long) num;
72178acc472SPeter Tyser 		} else if (qualifier == 'Z' || qualifier == 'z') {
72278acc472SPeter Tyser 			num = va_arg(args, size_t);
72378acc472SPeter Tyser 		} else if (qualifier == 't') {
72478acc472SPeter Tyser 			num = va_arg(args, ptrdiff_t);
72578acc472SPeter Tyser 		} else if (qualifier == 'h') {
72678acc472SPeter Tyser 			num = (unsigned short) va_arg(args, int);
72778acc472SPeter Tyser 			if (flags & SIGN)
72878acc472SPeter Tyser 				num = (signed short) num;
72978acc472SPeter Tyser 		} else {
73078acc472SPeter Tyser 			num = va_arg(args, unsigned int);
73178acc472SPeter Tyser 			if (flags & SIGN)
73278acc472SPeter Tyser 				num = (signed int) num;
73378acc472SPeter Tyser 		}
734*046a37bdSSonny Rao 		str = number(str, end, num, base, field_width, precision,
735*046a37bdSSonny Rao 			     flags);
73678acc472SPeter Tyser 	}
737*046a37bdSSonny Rao 
738*046a37bdSSonny Rao #ifdef CONFIG_SYS_VSNPRINTF
739*046a37bdSSonny Rao 	if (size > 0) {
740*046a37bdSSonny Rao 		ADDCH(str, '\0');
741*046a37bdSSonny Rao 		if (str > end)
742*046a37bdSSonny Rao 			end[-1] = '\0';
743*046a37bdSSonny Rao 	}
744*046a37bdSSonny Rao #else
74578acc472SPeter Tyser 	*str = '\0';
746*046a37bdSSonny Rao #endif
747*046a37bdSSonny Rao 	/* the trailing null byte doesn't count towards the total */
74878acc472SPeter Tyser 	return str-buf;
74978acc472SPeter Tyser }
75078acc472SPeter Tyser 
751*046a37bdSSonny Rao #ifdef CONFIG_SYS_VSNPRINTF
752*046a37bdSSonny Rao int vsnprintf(char *buf, size_t size, const char *fmt,
753*046a37bdSSonny Rao 			      va_list args)
754*046a37bdSSonny Rao {
755*046a37bdSSonny Rao 	return vsnprintf_internal(buf, size, fmt, args);
756*046a37bdSSonny Rao }
757*046a37bdSSonny Rao 
75878acc472SPeter Tyser /**
759*046a37bdSSonny Rao  * Format a string and place it in a buffer (va_list version)
760*046a37bdSSonny Rao  *
761*046a37bdSSonny Rao  * @param buf	The buffer to place the result into
762*046a37bdSSonny Rao  * @param size	The size of the buffer, including the trailing null space
763*046a37bdSSonny Rao  * @param fmt	The format string to use
764*046a37bdSSonny Rao  * @param args	Arguments for the format string
765*046a37bdSSonny Rao  * @return the number of characters which have been written into
766*046a37bdSSonny Rao  * the @buf not including the trailing '\0'. If @size is == 0 the function
767*046a37bdSSonny Rao  * returns 0.
768*046a37bdSSonny Rao  *
769*046a37bdSSonny Rao  * If you're not already dealing with a va_list consider using scnprintf().
770*046a37bdSSonny Rao  *
771*046a37bdSSonny Rao  * See the vsprintf() documentation for format string extensions over C99.
772*046a37bdSSonny Rao  */
773*046a37bdSSonny Rao int vscnprintf(char *buf, size_t size, const char *fmt, va_list args)
774*046a37bdSSonny Rao {
775*046a37bdSSonny Rao 	int i;
776*046a37bdSSonny Rao 
777*046a37bdSSonny Rao 	i = vsnprintf(buf, size, fmt, args);
778*046a37bdSSonny Rao 
779*046a37bdSSonny Rao 	if (likely(i < size))
780*046a37bdSSonny Rao 		return i;
781*046a37bdSSonny Rao 	if (size != 0)
782*046a37bdSSonny Rao 		return size - 1;
783*046a37bdSSonny Rao 	return 0;
784*046a37bdSSonny Rao }
785*046a37bdSSonny Rao 
786*046a37bdSSonny Rao /**
787*046a37bdSSonny Rao  * Format a string and place it in a buffer
788*046a37bdSSonny Rao  *
789*046a37bdSSonny Rao  * @param buf	The buffer to place the result into
790*046a37bdSSonny Rao  * @param size	The size of the buffer, including the trailing null space
791*046a37bdSSonny Rao  * @param fmt	The format string to use
792*046a37bdSSonny Rao  * @param ...	Arguments for the format string
793*046a37bdSSonny Rao  * @return the number of characters which would be
794*046a37bdSSonny Rao  * generated for the given input, excluding the trailing null,
795*046a37bdSSonny Rao  * as per ISO C99.  If the return is greater than or equal to
796*046a37bdSSonny Rao  * @size, the resulting string is truncated.
797*046a37bdSSonny Rao  *
798*046a37bdSSonny Rao  * See the vsprintf() documentation for format string extensions over C99.
799*046a37bdSSonny Rao  */
800*046a37bdSSonny Rao int snprintf(char *buf, size_t size, const char *fmt, ...)
801*046a37bdSSonny Rao {
802*046a37bdSSonny Rao 	va_list args;
803*046a37bdSSonny Rao 	int i;
804*046a37bdSSonny Rao 
805*046a37bdSSonny Rao 	va_start(args, fmt);
806*046a37bdSSonny Rao 	i = vsnprintf(buf, size, fmt, args);
807*046a37bdSSonny Rao 	va_end(args);
808*046a37bdSSonny Rao 
809*046a37bdSSonny Rao 	return i;
810*046a37bdSSonny Rao }
811*046a37bdSSonny Rao 
812*046a37bdSSonny Rao /**
813*046a37bdSSonny Rao  * Format a string and place it in a buffer
814*046a37bdSSonny Rao  *
815*046a37bdSSonny Rao  * @param buf	The buffer to place the result into
816*046a37bdSSonny Rao  * @param size	The size of the buffer, including the trailing null space
817*046a37bdSSonny Rao  * @param fmt	The format string to use
818*046a37bdSSonny Rao  * @param ...	Arguments for the format string
819*046a37bdSSonny Rao  *
820*046a37bdSSonny Rao  * The return value is the number of characters written into @buf not including
821*046a37bdSSonny Rao  * the trailing '\0'. If @size is == 0 the function returns 0.
822*046a37bdSSonny Rao  *
823*046a37bdSSonny Rao  * See the vsprintf() documentation for format string extensions over C99.
824*046a37bdSSonny Rao  */
825*046a37bdSSonny Rao 
826*046a37bdSSonny Rao int scnprintf(char *buf, size_t size, const char *fmt, ...)
827*046a37bdSSonny Rao {
828*046a37bdSSonny Rao 	va_list args;
829*046a37bdSSonny Rao 	int i;
830*046a37bdSSonny Rao 
831*046a37bdSSonny Rao 	va_start(args, fmt);
832*046a37bdSSonny Rao 	i = vscnprintf(buf, size, fmt, args);
833*046a37bdSSonny Rao 	va_end(args);
834*046a37bdSSonny Rao 
835*046a37bdSSonny Rao 	return i;
836*046a37bdSSonny Rao }
837*046a37bdSSonny Rao #endif /* CONFIG_SYS_VSNPRINT */
838*046a37bdSSonny Rao 
839*046a37bdSSonny Rao /**
840*046a37bdSSonny Rao  * Format a string and place it in a buffer (va_list version)
841*046a37bdSSonny Rao  *
842*046a37bdSSonny Rao  * @param buf	The buffer to place the result into
843*046a37bdSSonny Rao  * @param fmt	The format string to use
844*046a37bdSSonny Rao  * @param args	Arguments for the format string
845*046a37bdSSonny Rao  *
846*046a37bdSSonny Rao  * The function returns the number of characters written
847*046a37bdSSonny Rao  * into @buf. Use vsnprintf() or vscnprintf() in order to avoid
848*046a37bdSSonny Rao  * buffer overflows.
849*046a37bdSSonny Rao  *
850*046a37bdSSonny Rao  * If you're not already dealing with a va_list consider using sprintf().
851*046a37bdSSonny Rao  */
852*046a37bdSSonny Rao int vsprintf(char *buf, const char *fmt, va_list args)
853*046a37bdSSonny Rao {
854*046a37bdSSonny Rao 	return vsnprintf_internal(buf, INT_MAX, fmt, args);
855*046a37bdSSonny Rao }
856*046a37bdSSonny Rao 
857*046a37bdSSonny Rao /**
858*046a37bdSSonny Rao  * Format a string and place it in a buffer
859*046a37bdSSonny Rao  *
860*046a37bdSSonny Rao  * @param buf	The buffer to place the result into
861*046a37bdSSonny Rao  * @param fmt	The format string to use
862*046a37bdSSonny Rao  * @param ...	Arguments for the format string
86378acc472SPeter Tyser  *
86478acc472SPeter Tyser  * The function returns the number of characters written
86578acc472SPeter Tyser  * into @buf.
86678acc472SPeter Tyser  *
86778acc472SPeter Tyser  * See the vsprintf() documentation for format string extensions over C99.
86878acc472SPeter Tyser  */
86978acc472SPeter Tyser int sprintf(char * buf, const char *fmt, ...)
87078acc472SPeter Tyser {
87178acc472SPeter Tyser 	va_list args;
87278acc472SPeter Tyser 	int i;
87378acc472SPeter Tyser 
87478acc472SPeter Tyser 	va_start(args, fmt);
87578acc472SPeter Tyser 	i=vsprintf(buf,fmt,args);
87678acc472SPeter Tyser 	va_end(args);
87778acc472SPeter Tyser 	return i;
87878acc472SPeter Tyser }
87978acc472SPeter Tyser 
88078acc472SPeter Tyser void panic(const char *fmt, ...)
88178acc472SPeter Tyser {
88278acc472SPeter Tyser 	va_list	args;
88378acc472SPeter Tyser 	va_start(args, fmt);
88478acc472SPeter Tyser 	vprintf(fmt, args);
88578acc472SPeter Tyser 	putc('\n');
88678acc472SPeter Tyser 	va_end(args);
88778acc472SPeter Tyser #if defined (CONFIG_PANIC_HANG)
88878acc472SPeter Tyser 	hang();
88978acc472SPeter Tyser #else
89078acc472SPeter Tyser 	udelay (100000);	/* allow messages to go out */
89178acc472SPeter Tyser 	do_reset (NULL, 0, 0, NULL);
89278acc472SPeter Tyser #endif
89340e01881SHeiko Schocher 	while (1)
89440e01881SHeiko Schocher 		;
89578acc472SPeter Tyser }
89621726a7aSSimon Glass 
89721726a7aSSimon Glass void __assert_fail(const char *assertion, const char *file, unsigned line,
89821726a7aSSimon Glass 		   const char *function)
89921726a7aSSimon Glass {
90021726a7aSSimon Glass 	/* This will not return */
90121726a7aSSimon Glass 	panic("%s:%u: %s: Assertion `%s' failed.", file, line, function,
90221726a7aSSimon Glass 	      assertion);
90321726a7aSSimon Glass }
9043cce8a54SSimon Glass 
9053cce8a54SSimon Glass char *simple_itoa(ulong i)
9063cce8a54SSimon Glass {
9073cce8a54SSimon Glass 	/* 21 digits plus null terminator, good for 64-bit or smaller ints */
9083cce8a54SSimon Glass 	static char local[22];
9093cce8a54SSimon Glass 	char *p = &local[21];
9103cce8a54SSimon Glass 
9113cce8a54SSimon Glass 	*p-- = '\0';
9123cce8a54SSimon Glass 	do {
9133cce8a54SSimon Glass 		*p-- = '0' + i % 10;
9143cce8a54SSimon Glass 		i /= 10;
9153cce8a54SSimon Glass 	} while (i > 0);
9163cce8a54SSimon Glass 	return p + 1;
9173cce8a54SSimon Glass }
918