hexdump.h

   1 #ifndef STATIC_HEXDUMP_H
   2 #define STATIC_HEXDUMP_H
   3
   4 static int
   5 __attribute__((__unused__))
   6 isprint(char c)
   7 {
   8         if (c < 0x20)
   9                 return 0;
  10         if (c > 0x7e)
  11                 return 0;
  12         return 1;
  13 }
  14
  15 static UINTN
  16 __attribute__((__unused__))
  17 format_hex(UINT8 *data, UINTN size, CHAR16 *buf)
  18 {
  19         UINTN sz = (UINTN)data % 16;
  20         CHAR16 hexchars[] = L"0123456789abcdef";
  21         int offset = 0;
  22         UINTN i;
  23         UINTN j;
  24
  25         for (i = 0; i < sz; i++) {
  26                 buf[offset++] = L' ';
  27                 buf[offset++] = L' ';
  28                 buf[offset++] = L' ';
  29                 if (i == 7)
  30                         buf[offset++] = L' ';
  31         }
  32         for (j = sz; j < 16 && j < size; j++) {
  33                 UINT8 d = data[j-sz];
  34                 buf[offset++] = hexchars[(d & 0xf0) >> 4];
  35                 buf[offset++] = hexchars[(d & 0x0f)];
  36                 if (j != 15)
  37                         buf[offset++] = L' ';
  38                 if (j == 7)
  39                         buf[offset++] = L' ';
  40         }
  41         for (i = j; i < 16; i++) {
  42                 buf[offset++] = L' ';
  43                 buf[offset++] = L' ';
  44                 if (i != 15)
  45                         buf[offset++] = L' ';
  46                 if (i == 7)
  47                         buf[offset++] = L' ';
  48         }
  49         buf[offset] = L'\0';
  50         return j - sz;
  51 }
  52
  53 static void
  54 __attribute__((__unused__))
  55 format_text(UINT8 *data, UINTN size, CHAR16 *buf)
  56 {
  57         UINTN sz = (UINTN)data % 16;
  58         int offset = 0;
  59         UINTN i;
  60         UINTN j;
  61
  62         for (i = 0; i < sz; i++)
  63                 buf[offset++] = L' ';
  64         buf[offset++] = L'|';
  65         for (j = sz; j < 16 && j < size; j++) {
  66                 if (isprint(data[j-sz]))
  67                         buf[offset++] = data[j-sz];
  68                 else
  69                         buf[offset++] = L'.';
  70         }
  71         buf[offset++] = L'|';
  72         for (i = j; i < 16; i++)
  73                 buf[offset++] = L' ';
  74         buf[offset] = L'\0';
  75 }
  76
  77 static void
  78 __attribute__((__unused__))
  79 hexdump(UINT8 *data, UINTN size)
  80 {
  81         UINTN display_offset = (UINTN)data & 0xffffffff;
  82         UINTN offset = 0;
  83         //Print(L"hexdump: data=0x%016x size=0x%x\n", data, size);
  84
  85         while (offset < size) {
  86                 CHAR16 hexbuf[49];
  87                 CHAR16 txtbuf[19];
  88                 UINTN sz;
  89
  90                 sz = format_hex(data+offset, size-offset, hexbuf);
  91                 if (sz == 0)
  92                         return;
  93                 uefi_call_wrapper(BS->Stall, 1, 200000);
  94
  95                 format_text(data+offset, size-offset, txtbuf);
  96                 Print(L"%08x  %s  %s\n", display_offset, hexbuf, txtbuf);
  97                 uefi_call_wrapper(BS->Stall, 1, 200000);
  98
  99                 display_offset += sz;
 100                 offset += sz;
 101         }
 102 }
 103
 104 #endif