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