lib/display_options.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2000-2002
   4  * Wolfgang Denk, DENX Software Engineering, [email protected].
   5  */
   6
   7 #include <common.h>
   8 #include <compiler.h>
   9 #include <console.h>
  10 #include <div64.h>
  11 #include <version.h>
  12 #include <linux/ctype.h>
  13 #include <asm/io.h>
  14
  15 char *display_options_get_banner_priv(bool newlines, const char *build_tag,
  16                                       char *buf, int size)
  17 {
  18         int len;
  19
  20         len = snprintf(buf, size, "%s%s", newlines ? "\n\n" : "",
  21                        version_string);
  22         if (build_tag && len < size)
  23                 len += snprintf(buf + len, size - len, ", Build: %s",
  24                                 build_tag);
  25         if (len > size - 3)
  26                 len = size - 3;
  27         if (len < 0)
  28                 len = 0;
  29         snprintf(buf + len, size - len, "\n\n");
  30
  31         return buf;
  32 }
  33
  34 #ifndef BUILD_TAG
  35 #define BUILD_TAG NULL
  36 #endif
  37
  38 char *display_options_get_banner(bool newlines, char *buf, int size)
  39 {
  40         return display_options_get_banner_priv(newlines, BUILD_TAG, buf, size);
  41 }
  42
  43 int display_options(void)
  44 {
  45         char buf[DISPLAY_OPTIONS_BANNER_LENGTH];
  46
  47         display_options_get_banner(true, buf, sizeof(buf));
  48         printf("%s", buf);
  49
  50         return 0;
  51 }
  52
  53 void print_freq(uint64_t freq, const char *s)
  54 {
  55         unsigned long m = 0;
  56         uint32_t f;
  57         static const char names[] = {'G', 'M', 'k'};
  58         unsigned long d = 1e9;
  59         char c = 0;
  60         unsigned int i;
  61
  62         for (i = 0; i < ARRAY_SIZE(names); i++, d /= 1000) {
  63                 if (freq >= d) {
  64                         c = names[i];
  65                         break;
  66                 }
  67         }
  68
  69         if (!c) {
  70                 printf("%llu Hz%s", freq, s);
  71                 return;
  72         }
  73
  74         f = do_div(freq, d);
  75
  76         /* If there's a remainder, show the first few digits */
  77         if (f) {
  78                 m = f;
  79                 while (m > 1000)
  80                         m /= 10;
  81                 while (m && !(m % 10))
  82                         m /= 10;
  83                 if (m >= 100)
  84                         m = (m / 10) + (m % 100 >= 50);
  85         }
  86
  87         printf("%lu", (unsigned long) freq);
  88         if (m)
  89                 printf(".%ld", m);
  90         printf(" %cHz%s", c, s);
  91 }
  92
  93 void print_size(uint64_t size, const char *s)
  94 {
  95         unsigned long m = 0, n;
  96         uint64_t f;
  97         static const char names[] = {'E', 'P', 'T', 'G', 'M', 'K'};
  98         unsigned long d = 10 * ARRAY_SIZE(names);
  99         char c = 0;
 100         unsigned int i;
 101
 102         for (i = 0; i < ARRAY_SIZE(names); i++, d -= 10) {
 103                 if (size >> d) {
 104                         c = names[i];
 105                         break;
 106                 }
 107         }
 108
 109         if (!c) {
 110                 printf("%llu Bytes%s", size, s);
 111                 return;
 112         }
 113
 114         n = size >> d;
 115         f = size & ((1ULL << d) - 1);
 116
 117         /* If there's a remainder, deal with it */
 118         if (f) {
 119                 m = (10ULL * f + (1ULL << (d - 1))) >> d;
 120
 121                 if (m >= 10) {
 122                         m -= 10;
 123                         n += 1;
 124                 }
 125         }
 126
 127         printf ("%lu", n);
 128         if (m) {
 129                 printf (".%ld", m);
 130         }
 131         printf (" %ciB%s", c, s);
 132 }
 133
 134 #define MAX_LINE_LENGTH_BYTES           64
 135 #define DEFAULT_LINE_LENGTH_BYTES       16
 136
 137 int hexdump_line(ulong addr, const void *data, uint width, uint count,
 138                  uint linelen, char *out, int size)
 139 {
 140         /* linebuf as a union causes proper alignment */
 141         union linebuf {
 142                 uint64_t uq[MAX_LINE_LENGTH_BYTES/sizeof(uint64_t) + 1];
 143                 uint32_t ui[MAX_LINE_LENGTH_BYTES/sizeof(uint32_t) + 1];
 144                 uint16_t us[MAX_LINE_LENGTH_BYTES/sizeof(uint16_t) + 1];
 145                 uint8_t  uc[MAX_LINE_LENGTH_BYTES/sizeof(uint8_t) + 1];
 146         } lb;
 147         uint thislinelen;
 148         int i;
 149         ulong x;
 150
 151         if (linelen * width > MAX_LINE_LENGTH_BYTES)
 152                 linelen = MAX_LINE_LENGTH_BYTES / width;
 153         if (linelen < 1)
 154                 linelen = DEFAULT_LINE_LENGTH_BYTES / width;
 155
 156         /*
 157          * Check the size here so that we don't need to use snprintf(). This
 158          * helps to reduce code size
 159          */
 160         if (size < HEXDUMP_MAX_BUF_LENGTH(linelen * width))
 161                 return -ENOSPC;
 162
 163         thislinelen = linelen;
 164         out += sprintf(out, "%08lx:", addr);
 165
 166         /* check for overflow condition */
 167         if (count < thislinelen)
 168                 thislinelen = count;
 169
 170         /* Copy from memory into linebuf and print hex values */
 171         for (i = 0; i < thislinelen; i++) {
 172                 if (width == 4)
 173                         x = lb.ui[i] = *(volatile uint32_t *)data;
 174                 else if (MEM_SUPPORT_64BIT_DATA && width == 8)
 175                         x = lb.uq[i] = *(volatile ulong *)data;
 176                 else if (width == 2)
 177                         x = lb.us[i] = *(volatile uint16_t *)data;
 178                 else
 179                         x = lb.uc[i] = *(volatile uint8_t *)data;
 180                 if (CONFIG_IS_ENABLED(USE_TINY_PRINTF))
 181                         out += sprintf(out, " %x", (uint)x);
 182                 else
 183                         out += sprintf(out, " %0*lx", width * 2, x);
 184                 data += width;
 185         }
 186
 187         /* fill line with whitespace for nice ASCII print */
 188         for (i = 0; i < (linelen - thislinelen) * (width * 2 + 1); i++)
 189                 *out++ = ' ';
 190
 191         /* Print data in ASCII characters */
 192         for (i = 0; i < thislinelen * width; i++) {
 193                 if (!isprint(lb.uc[i]) || lb.uc[i] >= 0x80)
 194                         lb.uc[i] = '.';
 195         }
 196         lb.uc[i] = '\0';
 197         out += sprintf(out, "  %s", lb.uc);
 198
 199         return thislinelen;
 200 }
 201
 202 int print_buffer(ulong addr, const void *data, uint width, uint count,
 203                  uint linelen)
 204 {
 205         if (linelen*width > MAX_LINE_LENGTH_BYTES)
 206                 linelen = MAX_LINE_LENGTH_BYTES / width;
 207         if (linelen < 1)
 208                 linelen = DEFAULT_LINE_LENGTH_BYTES / width;
 209
 210         while (count) {
 211                 uint thislinelen;
 212                 char buf[HEXDUMP_MAX_BUF_LENGTH(width * linelen)];
 213
 214                 thislinelen = hexdump_line(addr, data, width, count, linelen,
 215                                            buf, sizeof(buf));
 216                 assert(thislinelen >= 0);
 217                 puts(buf);
 218                 putc('\n');
 219
 220                 /* update references */
 221                 data += thislinelen * width;
 222                 addr += thislinelen * width;
 223                 count -= thislinelen;
 224
 225                 if (!IS_ENABLED(CONFIG_SPL_BUILD) && ctrlc())
 226                         return -EINTR;
 227         }
 228
 229         return 0;
 230 }