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
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
|
#include <apos/debug.h>
#include <libfdt.h>
#if defined(DEBUG)
static void __print_char(char c, int depth)
{
/* lol, ugly but good enough for now */
for (int i = 0; i < depth; ++i)
dbg("%c", c);
}
static int __printable(char c)
{
return (c >= 32) && (c <= 126);
}
static int __is_string(const void *data, int len)
{
const char *s = data;
/* zero length is not */
if (len == 0)
return 0;
/* must terminate with zero or '\n' */
if (s[len - 1] != '\0' && s[len - 1] != '\n')
return 0;
/* printable or a null byte (concatenated strings) */
while (((*s == '\0') || __printable(*s)) && (len > 0)) {
/*
* If we see a null, there are three possibilities:
* 1) If len == 1, it is the end of the string, printable
* 2) Next character also a null, not printable.
* 3) Next character not a null, continue to check.
*/
if (s[0] == '\0') {
if (len == 1)
return 1;
if (s[1] == '\0')
return 0;
}
s++;
len--;
}
/* Not the null termination, or not done yet: not printable */
if (*s != '\0' || (len != 0))
return 0;
return 1;
}
static void __print_prop_value(const void *data, int len)
{
if (len == 0)
return;
dbg(" = ");
/* heavily inspired by u-boot's fdt print */
if (__is_string(data, len)) {
dbg("\"");
int i = 0;
while (i < len) {
if (i > 0)
dbg("\", \"");
dbg("%s", (const char *)data);
i += strlen(data) + 1;
data += strlen(data) + 1;
}
dbg("\"");
} else if ((len % 4) == 0) {
const int32_t *p = (const int32_t *)data;
dbg("<");
for (int i = 0; i < len / 4; ++i)
dbg("%#08x%s", fdt32_to_cpu(p[i]),
i < (len / 4 - 1) ? " " : "");
dbg(">");
} else {
const int32_t *p = (const int32_t *)data;
dbg("[");
for (int i = 0; i < len / 4; ++i)
dbg("%#02x%s", fdt32_to_cpu(p[i]),
i < (len / 4 - 1) ? " " : "");
dbg("]");
}
}
void __dbg_fdt(const void *fdt, int node_offset, int depth)
{
int node = 0;
fdt_for_each_subnode(node, fdt, node_offset)
{
__print_char('\t', depth);
dbg("%s: {\n", fdt_get_name(fdt, node, 0));
int property = 0;
fdt_for_each_property_offset(property, fdt, node)
{
int len;
const char *name;
const void *data = fdt_getprop_by_offset(fdt, property,
&name, &len);
__print_char('\t', depth + 1);
dbg("%s", name);
__print_prop_value(data, len);
dbg(";\n");
}
__dbg_fdt(fdt, node, depth + 1);
__print_char('\t', depth);
dbg("};\n\n");
}
}
#endif
|
