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