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