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
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
|
/* SPDX-License-Identifier: GPL-3.0-or-later */
/* Copyright 2021 - 2022, Kim Kuparinen < kimi.h.kuparinen@gmail.com > */
/**
* @file fdt_dbg.c
* Dump fdt info to serial.
*/
#include <apos/debug.h>
#include <libfdt.h>
#if defined(DEBUG)
/**
* Print single character \c depth number of times.
*
* @param c Character to print.
* @param depth Number of times to print character.
*/
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);
}
/**
* Check if ASCII character is in printable range.
*
* In this case, printable is anything that isn't a control character, line
* feed, bell, etc.
*
* @param c Character to check.
* @return \ref true if in printable range, \ref false otherwise.
*/
static int __printable(char c)
{
return (c >= 32) && (c <= 126);
}
/**
* Check if \c data and \c len bytes from it form a reasonable string.
*
* @param data Pointer to some binary data to check.
* @param len Assumed length of string.
* @return \c true if data is likely some string, \c false otherwise.
*/
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;
}
/**
* Print value of FDT property.
*
* @param data Pointer to FDT property.
* @param len Length of property.
*/
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", (unsigned int)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", (unsigned int)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 = 0;
const char *name = 0;
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
|
