|
|
|
@ -18,7 +18,7 @@ |
|
|
|
|
#include <errno.h> |
|
|
|
|
|
|
|
|
|
#include <common.h> |
|
|
|
|
#if !defined (CONFIG_PANIC_HANG) |
|
|
|
|
#if !defined(CONFIG_PANIC_HANG) |
|
|
|
|
#include <command.h> |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
@ -40,9 +40,11 @@ static inline char *pack_hex_byte(char *buf, u8 byte) |
|
|
|
|
return buf; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
unsigned long simple_strtoul(const char *cp,char **endp,unsigned int base) |
|
|
|
|
unsigned long simple_strtoul(const char *cp, char **endp, |
|
|
|
|
unsigned int base) |
|
|
|
|
{ |
|
|
|
|
unsigned long result = 0,value; |
|
|
|
|
unsigned long result = 0; |
|
|
|
|
unsigned long value; |
|
|
|
|
|
|
|
|
|
if (*cp == '0') { |
|
|
|
|
cp++; |
|
|
|
@ -50,20 +52,23 @@ unsigned long simple_strtoul(const char *cp,char **endp,unsigned int base) |
|
|
|
|
base = 16; |
|
|
|
|
cp++; |
|
|
|
|
} |
|
|
|
|
if (!base) { |
|
|
|
|
|
|
|
|
|
if (!base) |
|
|
|
|
base = 8; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
if (!base) { |
|
|
|
|
|
|
|
|
|
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; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -91,18 +96,19 @@ int strict_strtoul(const char *cp, unsigned int base, unsigned long *res) |
|
|
|
|
return -EINVAL; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
long simple_strtol(const char *cp,char **endp,unsigned int base) |
|
|
|
|
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); |
|
|
|
|
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' : |
|
|
|
|
case 'G': |
|
|
|
|
result *= 1024; |
|
|
|
|
/* fall through */ |
|
|
|
|
case 'M': |
|
|
|
@ -121,31 +127,34 @@ int ustrtoul(const char *cp, char **endp, unsigned int base) |
|
|
|
|
return result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
unsigned long long simple_strtoull (const char *cp, char **endp, unsigned int base) |
|
|
|
|
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])) { |
|
|
|
|
if ((*cp == 'x') && isxdigit(cp[1])) { |
|
|
|
|
base = 16; |
|
|
|
|
cp++; |
|
|
|
|
} |
|
|
|
|
if (!base) { |
|
|
|
|
|
|
|
|
|
if (!base) |
|
|
|
|
base = 8; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
if (!base) { |
|
|
|
|
|
|
|
|
|
if (!base) |
|
|
|
|
base = 10; |
|
|
|
|
} |
|
|
|
|
while (isxdigit (*cp) && (value = isdigit (*cp) |
|
|
|
|
? *cp - '0' |
|
|
|
|
: (islower (*cp) ? toupper (*cp) : *cp) - 'A' + 10) < base) { |
|
|
|
|
|
|
|
|
|
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; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -154,10 +163,11 @@ unsigned long long simple_strtoull (const char *cp, char **endp, unsigned int ba |
|
|
|
|
|
|
|
|
|
static int skip_atoi(const char **s) |
|
|
|
|
{ |
|
|
|
|
int i=0; |
|
|
|
|
int i = 0; |
|
|
|
|
|
|
|
|
|
while (is_digit(**s)) |
|
|
|
|
i = i*10 + *((*s)++) - '0'; |
|
|
|
|
i = i * 10 + *((*s)++) - '0'; |
|
|
|
|
|
|
|
|
|
return i; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -171,7 +181,7 @@ static int skip_atoi(const char **s) |
|
|
|
|
/* Formats correctly any integer in [0,99999].
|
|
|
|
|
* Outputs from one to five digits depending on input. |
|
|
|
|
* On i386 gcc 4.1.2 -O2: ~250 bytes of code. */ |
|
|
|
|
static char* put_dec_trunc(char *buf, unsigned q) |
|
|
|
|
static char *put_dec_trunc(char *buf, unsigned q) |
|
|
|
|
{ |
|
|
|
|
unsigned d3, d2, d1, d0; |
|
|
|
|
d1 = (q>>4) & 0xf; |
|
|
|
@ -200,14 +210,14 @@ static char* put_dec_trunc(char *buf, unsigned q) |
|
|
|
|
d3 = d3 - 10*q; |
|
|
|
|
*buf++ = d3 + '0'; /* next digit */ |
|
|
|
|
if (q != 0) |
|
|
|
|
*buf++ = q + '0'; /* most sign. digit */ |
|
|
|
|
*buf++ = q + '0'; /* most sign. digit */ |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
return buf; |
|
|
|
|
} |
|
|
|
|
/* Same with if's removed. Always emits five digits */ |
|
|
|
|
static char* put_dec_full(char *buf, unsigned q) |
|
|
|
|
static char *put_dec_full(char *buf, unsigned q) |
|
|
|
|
{ |
|
|
|
|
/* BTW, if q is in [0,9999], 8-bit ints will be enough, */ |
|
|
|
|
/* but anyway, gcc produces better code with full-sized ints */ |
|
|
|
@ -249,7 +259,7 @@ static char* put_dec_full(char *buf, unsigned q) |
|
|
|
|
return buf; |
|
|
|
|
} |
|
|
|
|
/* No inlining helps gcc to use registers better */ |
|
|
|
|
static noinline char* put_dec(char *buf, unsigned NUM_TYPE num) |
|
|
|
|
static noinline char *put_dec(char *buf, unsigned NUM_TYPE num) |
|
|
|
|
{ |
|
|
|
|
while (1) { |
|
|
|
|
unsigned rem; |
|
|
|
@ -286,7 +296,7 @@ static char *number(char *buf, char *end, unsigned NUM_TYPE num, |
|
|
|
|
int base, int size, int precision, int type) |
|
|
|
|
{ |
|
|
|
|
/* we are called with base 8, 10 or 16, only, thus don't need "G..." */ |
|
|
|
|
static const char digits[16] = "0123456789ABCDEF"; /* "GHIJKLMNOPQRSTUVWXYZ"; */ |
|
|
|
|
static const char digits[16] = "0123456789ABCDEF"; |
|
|
|
|
|
|
|
|
|
char tmp[66]; |
|
|
|
|
char sign; |
|
|
|
@ -303,7 +313,7 @@ static char *number(char *buf, char *end, unsigned NUM_TYPE num, |
|
|
|
|
if (type & SIGN) { |
|
|
|
|
if ((signed NUM_TYPE) num < 0) { |
|
|
|
|
sign = '-'; |
|
|
|
|
num = - (signed NUM_TYPE) num; |
|
|
|
|
num = -(signed NUM_TYPE) num; |
|
|
|
|
size--; |
|
|
|
|
} else if (type & PLUS) { |
|
|
|
|
sign = '+'; |
|
|
|
@ -331,9 +341,13 @@ static char *number(char *buf, char *end, unsigned NUM_TYPE num, |
|
|
|
|
else if (base != 10) { /* 8 or 16 */ |
|
|
|
|
int mask = base - 1; |
|
|
|
|
int shift = 3; |
|
|
|
|
if (base == 16) shift = 4; |
|
|
|
|
|
|
|
|
|
if (base == 16) |
|
|
|
|
shift = 4; |
|
|
|
|
|
|
|
|
|
do { |
|
|
|
|
tmp[i++] = (digits[((unsigned char)num) & mask] | locase); |
|
|
|
|
tmp[i++] = (digits[((unsigned char)num) & mask] |
|
|
|
|
| locase); |
|
|
|
|
num >>= shift; |
|
|
|
|
} while (num); |
|
|
|
|
} else { /* base 10 */ |
|
|
|
@ -401,7 +415,8 @@ static char *string(char *buf, char *end, char *s, int field_width, |
|
|
|
|
static char *mac_address_string(char *buf, char *end, u8 *addr, int field_width, |
|
|
|
|
int precision, int flags) |
|
|
|
|
{ |
|
|
|
|
char mac_addr[6 * 3]; /* (6 * 2 hex digits), 5 colons and trailing zero */ |
|
|
|
|
/* (6 * 2 hex digits), 5 colons and trailing zero */ |
|
|
|
|
char mac_addr[6 * 3]; |
|
|
|
|
char *p = mac_addr; |
|
|
|
|
int i; |
|
|
|
|
|
|
|
|
@ -419,7 +434,8 @@ static char *mac_address_string(char *buf, char *end, u8 *addr, int field_width, |
|
|
|
|
static char *ip6_addr_string(char *buf, char *end, u8 *addr, int field_width, |
|
|
|
|
int precision, int flags) |
|
|
|
|
{ |
|
|
|
|
char ip6_addr[8 * 5]; /* (8 * 4 hex digits), 7 colons and trailing zero */ |
|
|
|
|
/* (8 * 4 hex digits), 7 colons and trailing zero */ |
|
|
|
|
char ip6_addr[8 * 5]; |
|
|
|
|
char *p = ip6_addr; |
|
|
|
|
int i; |
|
|
|
|
|
|
|
|
@ -438,7 +454,8 @@ static char *ip6_addr_string(char *buf, char *end, u8 *addr, int field_width, |
|
|
|
|
static char *ip4_addr_string(char *buf, char *end, u8 *addr, int field_width, |
|
|
|
|
int precision, int flags) |
|
|
|
|
{ |
|
|
|
|
char ip4_addr[4 * 4]; /* (4 * 3 decimal digits), 3 dots and trailing zero */ |
|
|
|
|
/* (4 * 3 decimal digits), 3 dots and trailing zero */ |
|
|
|
|
char ip4_addr[4 * 4]; |
|
|
|
|
char temp[3]; /* hold each IP quad in reverse order */ |
|
|
|
|
char *p = ip4_addr; |
|
|
|
|
int i, digits; |
|
|
|
@ -549,14 +566,24 @@ static int vsnprintf_internal(char *buf, size_t size, const char *fmt, |
|
|
|
|
|
|
|
|
|
/* process flags */ |
|
|
|
|
flags = 0; |
|
|
|
|
repeat: |
|
|
|
|
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; |
|
|
|
|
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 */ |
|
|
|
@ -620,7 +647,7 @@ static int vsnprintf_internal(char *buf, size_t size, const char *fmt, |
|
|
|
|
continue; |
|
|
|
|
|
|
|
|
|
case 'p': |
|
|
|
|
str = pointer(fmt+1, str, end, |
|
|
|
|
str = pointer(fmt + 1, str, end, |
|
|
|
|
va_arg(args, void *), |
|
|
|
|
field_width, precision, flags); |
|
|
|
|
/* Skip all alphanumeric pointer suffixes */ |
|
|
|
@ -630,10 +657,10 @@ static int vsnprintf_internal(char *buf, size_t size, const char *fmt, |
|
|
|
|
|
|
|
|
|
case 'n': |
|
|
|
|
if (qualifier == 'l') { |
|
|
|
|
long * ip = va_arg(args, long *); |
|
|
|
|
long *ip = va_arg(args, long *); |
|
|
|
|
*ip = (str - buf); |
|
|
|
|
} else { |
|
|
|
|
int * ip = va_arg(args, int *); |
|
|
|
|
int *ip = va_arg(args, int *); |
|
|
|
|
*ip = (str - buf); |
|
|
|
|
} |
|
|
|
|
continue; |
|
|
|
@ -700,7 +727,7 @@ static int vsnprintf_internal(char *buf, size_t size, const char *fmt, |
|
|
|
|
*str = '\0'; |
|
|
|
|
#endif |
|
|
|
|
/* the trailing null byte doesn't count towards the total */ |
|
|
|
|
return str-buf; |
|
|
|
|
return str - buf; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
#ifdef CONFIG_SYS_VSNPRINTF |
|
|
|
@ -766,29 +793,29 @@ int vsprintf(char *buf, const char *fmt, va_list args) |
|
|
|
|
return vsnprintf_internal(buf, INT_MAX, fmt, args); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
int sprintf(char * buf, const char *fmt, ...) |
|
|
|
|
int sprintf(char *buf, const char *fmt, ...) |
|
|
|
|
{ |
|
|
|
|
va_list args; |
|
|
|
|
int i; |
|
|
|
|
|
|
|
|
|
va_start(args, fmt); |
|
|
|
|
i=vsprintf(buf,fmt,args); |
|
|
|
|
i = vsprintf(buf, fmt, args); |
|
|
|
|
va_end(args); |
|
|
|
|
return i; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void panic(const char *fmt, ...) |
|
|
|
|
{ |
|
|
|
|
va_list args; |
|
|
|
|
va_list args; |
|
|
|
|
va_start(args, fmt); |
|
|
|
|
vprintf(fmt, args); |
|
|
|
|
putc('\n'); |
|
|
|
|
va_end(args); |
|
|
|
|
#if defined (CONFIG_PANIC_HANG) |
|
|
|
|
#if defined(CONFIG_PANIC_HANG) |
|
|
|
|
hang(); |
|
|
|
|
#else |
|
|
|
|
udelay (100000); /* allow messages to go out */ |
|
|
|
|
do_reset (NULL, 0, 0, NULL); |
|
|
|
|
udelay(100000); /* allow messages to go out */ |
|
|
|
|
do_reset(NULL, 0, 0, NULL); |
|
|
|
|
#endif |
|
|
|
|
while (1) |
|
|
|
|
; |
|
|
|
|