/* misc.c - definitions of misc functions */ /* * GRUB -- GRand Unified Bootloader * Copyright (C) 1999,2000,2001,2002,2003,2004,2005,2006,2007,2008,2009,2010 Free Software Foundation, Inc. * * GRUB is free software: you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation, either version 3 of the License, or * (at your option) any later version. * * GRUB is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with GRUB. If not, see . */ #include #include #include #include #include #include #include static int grub_vsnprintf_real (char *str, grub_size_t n, const char *fmt, va_list args); static int grub_iswordseparator (int c) { return (grub_isspace (c) || c == ',' || c == ';' || c == '|' || c == '&'); } /* grub_gettext_dummy is not translating anything. */ static const char * grub_gettext_dummy (const char *s) { return s; } const char* (*grub_gettext) (const char *s) = grub_gettext_dummy; void * grub_memmove (void *dest, const void *src, grub_size_t n) { char *d = (char *) dest; const char *s = (const char *) src; if (d < s) while (n--) *d++ = *s++; else { d += n; s += n; while (n--) *--d = *--s; } return dest; } #ifndef __APPLE__ void *memmove (void *dest, const void *src, grub_size_t n) __attribute__ ((alias ("grub_memmove"))); /* GCC emits references to memcpy() for struct copies etc. */ void *memcpy (void *dest, const void *src, grub_size_t n) __attribute__ ((alias ("grub_memmove"))); #else void * GRUB_BUILTIN_ATTR memcpy (void *dest, const void *src, grub_size_t n) { return grub_memmove (dest, src, n); } void * GRUB_BUILTIN_ATTR memmove (void *dest, const void *src, grub_size_t n) { return grub_memmove (dest, src, n); } #endif char * grub_strcpy (char *dest, const char *src) { char *p = dest; while ((*p++ = *src++) != '\0') ; return dest; } int grub_printf (const char *fmt, ...) { va_list ap; int ret; va_start (ap, fmt); ret = grub_vprintf (fmt, ap); va_end (ap); return ret; } int grub_printf_ (const char *fmt, ...) { va_list ap; int ret; va_start (ap, fmt); ret = grub_vprintf (_(fmt), ap); va_end (ap); return ret; } int grub_puts_ (const char *s) { return grub_puts (_(s)); } #if defined (__APPLE__) && ! defined (GRUB_UTIL) int grub_err_printf (const char *fmt, ...) { va_list ap; int ret; va_start (ap, fmt); ret = grub_vprintf (fmt, ap); va_end (ap); return ret; } #endif #if ! defined (__APPLE__) && ! defined (GRUB_UTIL) int grub_err_printf (const char *fmt, ...) __attribute__ ((alias("grub_printf"))); #endif void grub_real_dprintf (const char *file, const int line, const char *condition, const char *fmt, ...) { va_list args; const char *debug = grub_env_get ("debug"); if (! debug) return; if (grub_strword (debug, "all") || grub_strword (debug, condition)) { grub_printf ("%s:%d: ", file, line); va_start (args, fmt); grub_vprintf (fmt, args); va_end (args); grub_refresh (); } } #define PREALLOC_SIZE 255 int grub_vprintf (const char *fmt, va_list args) { grub_size_t s; static char buf[PREALLOC_SIZE + 1]; char *curbuf = buf; va_list ap2; va_copy (ap2, args); s = grub_vsnprintf_real (buf, PREALLOC_SIZE, fmt, args); if (s > PREALLOC_SIZE) { curbuf = grub_malloc (s + 1); if (!curbuf) { grub_errno = GRUB_ERR_NONE; buf[PREALLOC_SIZE - 3] = '.'; buf[PREALLOC_SIZE - 2] = '.'; buf[PREALLOC_SIZE - 1] = '.'; buf[PREALLOC_SIZE] = 0; curbuf = buf; } else s = grub_vsnprintf_real (curbuf, s, fmt, ap2); } va_end (ap2); grub_xputs (curbuf); if (curbuf != buf) grub_free (curbuf); return s; } int grub_memcmp (const void *s1, const void *s2, grub_size_t n) { const grub_uint8_t *t1 = s1; const grub_uint8_t *t2 = s2; while (n--) { if (*t1 != *t2) return (int) *t1 - (int) *t2; t1++; t2++; } return 0; } #ifndef __APPLE__ int memcmp (const void *s1, const void *s2, grub_size_t n) __attribute__ ((alias ("grub_memcmp"))); #else int GRUB_BUILTIN_ATTR memcmp (const void *s1, const void *s2, grub_size_t n) { return grub_memcmp (s1, s2, n); } #endif int grub_strcmp (const char *s1, const char *s2) { while (*s1 && *s2) { if (*s1 != *s2) break; s1++; s2++; } return (int) (grub_uint8_t) *s1 - (int) (grub_uint8_t) *s2; } int grub_strncmp (const char *s1, const char *s2, grub_size_t n) { if (n == 0) return 0; while (*s1 && *s2 && --n) { if (*s1 != *s2) break; s1++; s2++; } return (int) (grub_uint8_t) *s1 - (int) (grub_uint8_t) *s2; } char * grub_strchr (const char *s, int c) { do { if (*s == c) return (char *) s; } while (*s++); return 0; } char * grub_strrchr (const char *s, int c) { char *p = NULL; do { if (*s == c) p = (char *) s; } while (*s++); return p; } int grub_strword (const char *haystack, const char *needle) { const char *n_pos = needle; while (grub_iswordseparator (*haystack)) haystack++; while (*haystack) { /* Crawl both the needle and the haystack word we're on. */ while(*haystack && !grub_iswordseparator (*haystack) && *haystack == *n_pos) { haystack++; n_pos++; } /* If we reached the end of both words at the same time, the word is found. If not, eat everything in the haystack that isn't the next word (or the end of string) and "reset" the needle. */ if ( (!*haystack || grub_iswordseparator (*haystack)) && (!*n_pos || grub_iswordseparator (*n_pos))) return 1; else { n_pos = needle; while (*haystack && !grub_iswordseparator (*haystack)) haystack++; while (grub_iswordseparator (*haystack)) haystack++; } } return 0; } int grub_isspace (int c) { return (c == '\n' || c == '\r' || c == ' ' || c == '\t'); } unsigned long grub_strtoul (const char *str, char **end, int base) { unsigned long long num; num = grub_strtoull (str, end, base); #if GRUB_CPU_SIZEOF_LONG != 8 if (num > ~0UL) { grub_error (GRUB_ERR_OUT_OF_RANGE, N_("overflow is detected")); return ~0UL; } #endif return (unsigned long) num; } unsigned long long grub_strtoull (const char *str, char **end, int base) { unsigned long long num = 0; int found = 0; /* Skip white spaces. */ /* grub_isspace checks that *str != '\0'. */ while (grub_isspace (*str)) str++; /* Guess the base, if not specified. The prefix `0x' means 16, and the prefix `0' means 8. */ if (str[0] == '0') { if (str[1] == 'x') { if (base == 0 || base == 16) { base = 16; str += 2; } } else if (base == 0 && str[1] >= '0' && str[1] <= '7') base = 8; } if (base == 0) base = 10; while (*str) { unsigned long digit; digit = grub_tolower (*str) - '0'; if (digit > 9) { digit += '0' - 'a' + 10; if (digit >= (unsigned long) base) break; } found = 1; /* NUM * BASE + DIGIT > ~0ULL */ if (num > grub_divmod64 (~0ULL - digit, base, 0)) { grub_error (GRUB_ERR_OUT_OF_RANGE, N_("overflow is detected")); return ~0ULL; } num = num * base + digit; str++; } if (! found) { grub_error (GRUB_ERR_BAD_NUMBER, N_("unrecognized number")); return 0; } if (end) *end = (char *) str; return num; } char * grub_strdup (const char *s) { grub_size_t len; char *p; len = grub_strlen (s) + 1; p = (char *) grub_malloc (len); if (! p) return 0; return grub_memcpy (p, s, len); } char * grub_strndup (const char *s, grub_size_t n) { grub_size_t len; char *p; len = grub_strlen (s); if (len > n) len = n; p = (char *) grub_malloc (len + 1); if (! p) return 0; grub_memcpy (p, s, len); p[len] = '\0'; return p; } /* clang detects that we're implementing here a memset so it decides to optimise and calls memset resulting in infinite recursion. With volatile we make it not optimise in this way. */ #ifdef __clang__ #define VOLATILE_CLANG volatile #else #define VOLATILE_CLANG #endif void * grub_memset (void *s, int c, grub_size_t len) { void *p = s; grub_uint8_t pattern8 = c; if (len >= 3 * sizeof (unsigned long)) { unsigned long patternl = 0; grub_size_t i; for (i = 0; i < sizeof (unsigned long); i++) patternl |= ((unsigned long) pattern8) << (8 * i); while (len > 0 && (((grub_addr_t) p) & (sizeof (unsigned long) - 1))) { *(VOLATILE_CLANG grub_uint8_t *) p = pattern8; p = (grub_uint8_t *) p + 1; len--; } while (len >= sizeof (unsigned long)) { *(VOLATILE_CLANG unsigned long *) p = patternl; p = (unsigned long *) p + 1; len -= sizeof (unsigned long); } } while (len > 0) { *(VOLATILE_CLANG grub_uint8_t *) p = pattern8; p = (grub_uint8_t *) p + 1; len--; } return s; } #ifndef __APPLE__ void *memset (void *s, int c, grub_size_t n) __attribute__ ((alias ("grub_memset"))); #else void * GRUB_BUILTIN_ATTR memset (void *s, int c, grub_size_t n) { return grub_memset (s, c, n); } void GRUB_BUILTIN_ATTR __bzero (void *s, grub_size_t n) { grub_memset (s, 0, n); } #endif grub_size_t grub_strlen (const char *s) { const char *p = s; while (*p) p++; return p - s; } static inline void grub_reverse (char *str) { char *p = str + grub_strlen (str) - 1; while (str < p) { char tmp; tmp = *str; *str = *p; *p = tmp; str++; p--; } } /* Divide N by D, return the quotient, and store the remainder in *R. */ grub_uint64_t grub_divmod64 (grub_uint64_t n, grub_uint64_t d, grub_uint64_t *r) { /* This algorithm is typically implemented by hardware. The idea is to get the highest bit in N, 64 times, by keeping upper(N * 2^i) = (Q * D + M), where upper represents the high 64 bits in 128-bits space. */ unsigned bits = 64; grub_uint64_t q = 0; grub_uint64_t m = 0; /* ARM and IA64 don't have a fast 32-bit division. Using that code would just make us use libgcc routines, calling them twice (once for modulo and once for quotient. */ #if !defined (__arm__) && !defined (__ia64__) /* Skip the slow computation if 32-bit arithmetic is possible. */ if (n < 0xffffffff && d < 0xffffffff) { if (r) *r = ((grub_uint32_t) n) % (grub_uint32_t) d; return ((grub_uint32_t) n) / (grub_uint32_t) d; } #endif while (bits--) { m <<= 1; if (n & (1ULL << 63)) m |= 1; q <<= 1; n <<= 1; if (m >= d) { q |= 1; m -= d; } } if (r) *r = m; return q; } #ifndef GRUB_UTIL #if defined (__arm__) grub_uint32_t __udivsi3 (grub_uint32_t a, grub_uint32_t b) { return grub_divmod64 (a, b, 0); } grub_uint32_t __umodsi3 (grub_uint32_t a, grub_uint32_t b) { grub_uint64_t ret; grub_divmod64 (a, b, &ret); return ret; } #endif #ifdef NEED_CTZDI2 unsigned __ctzdi2 (grub_uint64_t x) { unsigned ret = 0; if (!x) return 64; if (!(x & 0xffffffff)) { x >>= 32; ret |= 32; } if (!(x & 0xffff)) { x >>= 16; ret |= 16; } if (!(x & 0xff)) { x >>= 8; ret |= 8; } if (!(x & 0xf)) { x >>= 4; ret |= 4; } if (!(x & 0x3)) { x >>= 2; ret |= 2; } if (!(x & 0x1)) { x >>= 1; ret |= 1; } return ret; } #endif #ifdef NEED_CTZSI2 unsigned __ctzsi2 (grub_uint32_t x) { unsigned ret = 0; if (!x) return 32; if (!(x & 0xffff)) { x >>= 16; ret |= 16; } if (!(x & 0xff)) { x >>= 8; ret |= 8; } if (!(x & 0xf)) { x >>= 4; ret |= 4; } if (!(x & 0x3)) { x >>= 2; ret |= 2; } if (!(x & 0x1)) { x >>= 1; ret |= 1; } return ret; } #endif #ifdef __arm__ grub_uint32_t __aeabi_uidiv (grub_uint32_t a, grub_uint32_t b) __attribute__ ((alias ("__udivsi3"))); #endif #if defined (__ia64__) grub_uint64_t __udivdi3 (grub_uint64_t a, grub_uint64_t b) { return grub_divmod64 (a, b, 0); } grub_uint64_t __umoddi3 (grub_uint64_t a, grub_uint64_t b) { grub_uint64_t ret; grub_divmod64 (a, b, &ret); return ret; } #endif #endif /* GRUB_UTIL */ /* Convert a long long value to a string. This function avoids 64-bit modular arithmetic or divisions. */ static char * grub_lltoa (char *str, int c, unsigned long long n) { unsigned base = (c == 'x') ? 16 : 10; char *p; if ((long long) n < 0 && c == 'd') { n = (unsigned long long) (-((long long) n)); *str++ = '-'; } p = str; if (base == 16) do { unsigned d = (unsigned) (n & 0xf); *p++ = (d > 9) ? d + 'a' - 10 : d + '0'; } while (n >>= 4); else /* BASE == 10 */ do { grub_uint64_t m; n = grub_divmod64 (n, 10, &m); *p++ = m + '0'; } while (n); *p = 0; grub_reverse (str); return p; } static inline void write_char (char *str, grub_size_t *count, grub_size_t max_len, unsigned char ch) { if (*count < max_len) str[*count] = ch; (*count)++; } static inline void write_str (char *str, grub_size_t *count, grub_size_t max_len, const char *s) { while (*s) write_char (str, count, max_len, *s++); } static inline void write_fill (char *str, grub_size_t *count, grub_size_t max_len, const char ch, int count_fill) { int i; for (i = 0; i < count_fill; i++) write_char (str, count, max_len, ch); } static int grub_vsnprintf_real (char *str, grub_size_t max_len, const char *fmt0, va_list args_in) { char c; grub_size_t n = 0; grub_size_t count = 0; grub_size_t count_args = 0; const char *fmt; fmt = fmt0; while ((c = *fmt++) != 0) { if (c != '%') continue; if (*fmt =='-') fmt++; while (grub_isdigit (*fmt)) fmt++; if (*fmt == '$') fmt++; if (*fmt =='-') fmt++; while (grub_isdigit (*fmt)) fmt++; if (*fmt =='.') fmt++; while (grub_isdigit (*fmt)) fmt++; c = *fmt++; if (c == 'l') c = *fmt++; if (c == 'l') c = *fmt++; switch (c) { case 'p': case 'x': case 'u': case 'd': case 'c': case 'C': case 's': count_args++; break; } } enum { INT, LONG, LONGLONG, POINTER } types[count_args]; union { int i; long l; long long ll; void *p; } args[count_args]; COMPILE_TIME_ASSERT (sizeof (int) == sizeof (grub_uint32_t)); grub_memset (types, 0, sizeof (types)); fmt = fmt0; n = 0; while ((c = *fmt++) != 0) { int longfmt = 0; int longlongfmt = 0; grub_size_t curn; const char *p; if (c != '%') continue; curn = n++; if (*fmt =='-') fmt++; p = fmt; while (grub_isdigit (*fmt)) fmt++; if (*fmt == '$') { curn = grub_strtoull (p, 0, 10) - 1; fmt++; } if (*fmt =='-') fmt++; while (grub_isdigit (*fmt)) fmt++; if (*fmt =='.') fmt++; while (grub_isdigit (*fmt)) fmt++; c = *fmt++; if (c == 'l') { c = *fmt++; longfmt = 1; if (c == 'l') { c = *fmt++; longlongfmt = 1; } } if (curn >= count_args) continue; switch (c) { case 'x': case 'u': case 'd': if (longlongfmt) types[curn] = LONGLONG; else if (longfmt) types[curn] = LONG; else types[curn] = INT; break; case 'p': case 's': types[curn] = POINTER; break; case 'C': case 'c': types[curn] = INT; break; } } for (n = 0; n < count_args; n++) switch (types[n]) { case POINTER: args[n].p = va_arg (args_in, void *); break; case INT: args[n].i = va_arg (args_in, int); break; case LONG: args[n].l = va_arg (args_in, long); break; case LONGLONG: args[n].ll = va_arg (args_in, long long); break; } fmt = fmt0; n = 0; while ((c = *fmt++) != 0) { char tmp[32]; unsigned int format1 = 0; unsigned int format2 = ~ 0U; char zerofill = ' '; int rightfill = 0; int longfmt = 0; int longlongfmt = 0; int unsig = 0; grub_size_t curn; if (c != '%') { write_char (str, &count, max_len,c); continue; } curn = n++; rescan:; if (*fmt =='-') { rightfill = 1; fmt++; } /* Read formatting parameters. */ if (grub_isdigit (*fmt)) { if (fmt[0] == '0') zerofill = '0'; format1 = grub_strtoul (fmt, (char **) &fmt, 10); } if (*fmt == '.') fmt++; if (grub_isdigit (*fmt)) format2 = grub_strtoul (fmt, (char **) &fmt, 10); if (*fmt == '$') { curn = format1 - 1; fmt++; format1 = 0; format2 = ~ 0U; zerofill = ' '; rightfill = 0; goto rescan; } c = *fmt++; if (c == 'l') { longfmt = 1; c = *fmt++; if (c == 'l') { longlongfmt = 1; c = *fmt++; } } if (c == '%') { write_char (str, &count, max_len,c); continue; } if (curn >= count_args) continue; switch (c) { case 'p': write_str (str, &count, max_len, "0x"); c = 'x'; longlongfmt |= (sizeof (void *) == sizeof (long long)); /* Fall through. */ case 'x': case 'u': unsig = 1; /* Fall through. */ case 'd': if (longlongfmt) grub_lltoa (tmp, c, args[curn].ll); else if (longfmt && unsig) grub_lltoa (tmp, c, (unsigned long) args[curn].l); else if (longfmt) grub_lltoa (tmp, c, args[curn].l); else if (unsig) grub_lltoa (tmp, c, (unsigned) args[curn].i); else grub_lltoa (tmp, c, args[curn].i); if (! rightfill && grub_strlen (tmp) < format1) write_fill (str, &count, max_len, zerofill, format1 - grub_strlen (tmp)); write_str (str, &count, max_len, tmp); if (rightfill && grub_strlen (tmp) < format1) write_fill (str, &count, max_len, zerofill, format1 - grub_strlen (tmp)); break; case 'c': write_char (str, &count, max_len,args[curn].i & 0xff); break; case 'C': { grub_uint32_t code = args[curn].i; int shift; unsigned mask; if (code <= 0x7f) { shift = 0; mask = 0; } else if (code <= 0x7ff) { shift = 6; mask = 0xc0; } else if (code <= 0xffff) { shift = 12; mask = 0xe0; } else if (code <= 0x10ffff) { shift = 18; mask = 0xf0; } else { code = '?'; shift = 0; mask = 0; } write_char (str, &count, max_len,mask | (code >> shift)); for (shift -= 6; shift >= 0; shift -= 6) write_char (str, &count, max_len,0x80 | (0x3f & (code >> shift))); } break; case 's': { grub_size_t len = 0; const char *p = args[curn].p ? : "(null)"; while (len < format2 && p[len]) len++; if (!rightfill && len < format1) write_fill (str, &count, max_len, zerofill, format1 - len); grub_size_t i; for (i = 0; i < len; i++) write_char (str, &count, max_len,*p++); if (rightfill && len < format1) write_fill (str, &count, max_len, zerofill, format1 - len); } break; default: write_char (str, &count, max_len,c); break; } } if (count < max_len) str[count] = '\0'; else str[max_len] = '\0'; return count; } int grub_vsnprintf (char *str, grub_size_t n, const char *fmt, va_list ap) { grub_size_t ret; if (!n) return 0; n--; ret = grub_vsnprintf_real (str, n, fmt, ap); return ret < n ? ret : n; } int grub_snprintf (char *str, grub_size_t n, const char *fmt, ...) { va_list ap; int ret; va_start (ap, fmt); ret = grub_vsnprintf (str, n, fmt, ap); va_end (ap); return ret; } char * grub_xvasprintf (const char *fmt, va_list ap) { grub_size_t s, as = PREALLOC_SIZE; char *ret; while (1) { va_list ap2; ret = grub_malloc (as + 1); if (!ret) return NULL; va_copy (ap2, ap); s = grub_vsnprintf_real (ret, as, fmt, ap2); va_end (ap2); if (s <= as) return ret; grub_free (ret); as = s; } } char * grub_xasprintf (const char *fmt, ...) { va_list ap; char *ret; va_start (ap, fmt); ret = grub_xvasprintf (fmt, ap); va_end (ap); return ret; } /* Abort GRUB. This function does not return. */ static void __attribute__ ((noreturn)) grub_abort (void) { grub_printf ("\nAborted."); #ifndef GRUB_UTIL if (grub_term_inputs) #endif { grub_printf (" Press any key to exit."); grub_getkey (); } grub_exit (); } #if defined (__clang__) && !defined (GRUB_UTIL) /* clang emits references to abort(). */ void __attribute__ ((noreturn)) abort (void) { grub_abort (); } #endif void grub_fatal (const char *fmt, ...) { va_list ap; va_start (ap, fmt); grub_vprintf (_(fmt), ap); va_end (ap); grub_abort (); } #if NEED_REGISTER_FRAME_INFO && !defined(GRUB_UTIL) void __register_frame_info (void) { } void __deregister_frame_info (void) { } #endif #if BOOT_TIME_STATS #include struct grub_boot_time *grub_boot_time_head; static struct grub_boot_time **boot_time_last = &grub_boot_time_head; void grub_real_boot_time (const char *file, const int line, const char *fmt, ...) { struct grub_boot_time *n; va_list args; grub_error_push (); n = grub_malloc (sizeof (*n)); if (!n) { grub_errno = 0; grub_error_pop (); return; } n->file = file; n->line = line; n->tp = grub_get_time_ms (); n->next = 0; va_start (args, fmt); n->msg = grub_xvasprintf (fmt, args); va_end (args); *boot_time_last = n; boot_time_last = &n->next; grub_errno = 0; grub_error_pop (); } #endif