]>
Commit | Line | Data |
---|---|---|
83d290c5 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
dc254f38 SG |
2 | /* |
3 | * Some very basic tests for fdtdec, accessed through test_fdtdec command. | |
4 | * They are easiest to use with sandbox. | |
5 | * | |
6 | * Copyright (c) 2011 The Chromium OS Authors. | |
dc254f38 SG |
7 | */ |
8 | ||
9 | #include <common.h> | |
10 | #include <fdtdec.h> | |
b08c8c48 | 11 | #include <linux/libfdt.h> |
dc254f38 SG |
12 | #include <malloc.h> |
13 | #include <os.h> | |
14 | ||
15 | /* The size of our test fdt blob */ | |
16 | #define FDT_SIZE (16 * 1024) | |
17 | ||
a95460a4 TR |
18 | #define CHECK(op) ({ \ |
19 | int err = op; \ | |
20 | if (err < 0) { \ | |
21 | printf("%s: %s: %s\n", __func__, #op, \ | |
22 | fdt_strerror(err)); \ | |
23 | return err; \ | |
24 | } \ | |
25 | \ | |
26 | err; \ | |
27 | }) | |
28 | ||
29 | #define CHECKVAL(op, expected) ({ \ | |
30 | int err = op; \ | |
31 | if (err != expected) { \ | |
32 | printf("%s: %s: expected %d, but returned %d\n",\ | |
33 | __func__, #op, expected, err); \ | |
34 | return err; \ | |
35 | } \ | |
36 | \ | |
37 | err; \ | |
38 | }) | |
dc254f38 | 39 | |
dc254f38 SG |
40 | #define CHECKOK(op) CHECKVAL(op, 0) |
41 | ||
42 | /* maximum number of nodes / aliases to generate */ | |
43 | #define MAX_NODES 20 | |
44 | ||
45 | /* | |
46 | * Make a test fdt | |
47 | * | |
48 | * @param fdt Device tree pointer | |
49 | * @param size Size of device tree blob | |
50 | * @param aliases Specifies alias assignments. Format is a list of items | |
51 | * separated by space. Items are #a where | |
52 | * # is the alias number | |
53 | * a is the node to point to | |
54 | * @param nodes Specifies nodes to generate (a=0, b=1), upper case | |
55 | * means to create a disabled node | |
56 | */ | |
57 | static int make_fdt(void *fdt, int size, const char *aliases, | |
58 | const char *nodes) | |
59 | { | |
60 | char name[20], value[20]; | |
61 | const char *s; | |
3db600c3 | 62 | #if defined(DEBUG) && defined(CONFIG_SANDBOX) |
dc254f38 | 63 | int fd; |
3db600c3 | 64 | #endif |
dc254f38 SG |
65 | |
66 | CHECK(fdt_create(fdt, size)); | |
67 | CHECK(fdt_finish_reservemap(fdt)); | |
68 | CHECK(fdt_begin_node(fdt, "")); | |
69 | ||
70 | CHECK(fdt_begin_node(fdt, "aliases")); | |
71 | for (s = aliases; *s;) { | |
72 | sprintf(name, "i2c%c", *s); | |
73 | sprintf(value, "/i2c%d@0", s[1] - 'a'); | |
74 | CHECK(fdt_property_string(fdt, name, value)); | |
75 | s += 2 + (s[2] != '\0'); | |
76 | } | |
77 | CHECK(fdt_end_node(fdt)); | |
78 | ||
79 | for (s = nodes; *s; s++) { | |
80 | sprintf(value, "i2c%d@0", (*s & 0xdf) - 'A'); | |
81 | CHECK(fdt_begin_node(fdt, value)); | |
82 | CHECK(fdt_property_string(fdt, "compatible", | |
83 | fdtdec_get_compatible(COMPAT_UNKNOWN))); | |
84 | if (*s <= 'Z') | |
85 | CHECK(fdt_property_string(fdt, "status", "disabled")); | |
86 | CHECK(fdt_end_node(fdt)); | |
87 | } | |
88 | ||
89 | CHECK(fdt_end_node(fdt)); | |
90 | CHECK(fdt_finish(fdt)); | |
91 | CHECK(fdt_pack(fdt)); | |
92 | #if defined(DEBUG) && defined(CONFIG_SANDBOX) | |
93 | fd = os_open("/tmp/fdtdec-text.dtb", OS_O_CREAT | OS_O_WRONLY); | |
94 | if (fd == -1) { | |
95 | printf("Could not open .dtb file to write\n"); | |
96 | return -1; | |
97 | } | |
98 | os_write(fd, fdt, size); | |
99 | os_close(fd); | |
100 | #endif | |
101 | return 0; | |
102 | } | |
103 | ||
104 | static int run_test(const char *aliases, const char *nodes, const char *expect) | |
105 | { | |
106 | int list[MAX_NODES]; | |
107 | const char *s; | |
108 | void *blob; | |
109 | int i; | |
110 | ||
111 | blob = malloc(FDT_SIZE); | |
112 | if (!blob) { | |
113 | printf("%s: out of memory\n", __func__); | |
114 | return 1; | |
115 | } | |
116 | ||
117 | printf("aliases=%s, nodes=%s, expect=%s: ", aliases, nodes, expect); | |
118 | CHECKVAL(make_fdt(blob, FDT_SIZE, aliases, nodes), 0); | |
119 | CHECKVAL(fdtdec_find_aliases_for_id(blob, "i2c", | |
120 | COMPAT_UNKNOWN, | |
a95460a4 | 121 | list, ARRAY_SIZE(list)), (int)strlen(expect)); |
dc254f38 SG |
122 | |
123 | /* Check we got the right ones */ | |
124 | for (i = 0, s = expect; *s; s++, i++) { | |
125 | int want = *s; | |
126 | const char *name; | |
127 | int got = ' '; | |
128 | ||
129 | name = list[i] ? fdt_get_name(blob, list[i], NULL) : NULL; | |
130 | if (name) | |
131 | got = name[3] + 'a' - '0'; | |
132 | ||
133 | if (got != want) { | |
134 | printf("Position %d: Expected '%c', got '%c' ('%s')\n", | |
135 | i, want, got, name); | |
136 | return 1; | |
137 | } | |
138 | } | |
139 | ||
140 | printf("pass\n"); | |
848e94d0 | 141 | free(blob); |
dc254f38 SG |
142 | return 0; |
143 | } | |
144 | ||
4e4bde30 TR |
145 | static int make_fdt_carveout_device(void *fdt, uint32_t na, uint32_t ns) |
146 | { | |
147 | const char *basename = "/display"; | |
148 | struct fdt_memory carveout = { | |
149 | #ifdef CONFIG_PHYS_64BIT | |
150 | .start = 0x180000000, | |
151 | .end = 0x18fffffff, | |
152 | #else | |
153 | .start = 0x80000000, | |
154 | .end = 0x8fffffff, | |
155 | #endif | |
156 | }; | |
157 | fdt32_t cells[4], *ptr = cells; | |
158 | uint32_t upper, lower; | |
3bf2f153 | 159 | fdt_size_t size; |
4e4bde30 TR |
160 | char name[32]; |
161 | int offset; | |
162 | ||
163 | /* store one or two address cells */ | |
3bf2f153 TR |
164 | upper = upper_32_bits(carveout.start); |
165 | lower = lower_32_bits(carveout.start); | |
4e4bde30 TR |
166 | |
167 | if (na > 1 && upper > 0) | |
168 | snprintf(name, sizeof(name), "%s@%x,%x", basename, upper, | |
169 | lower); | |
170 | else | |
171 | snprintf(name, sizeof(name), "%s@%x", basename, lower); | |
172 | ||
173 | if (na > 1) | |
174 | *ptr++ = cpu_to_fdt32(upper); | |
175 | ||
176 | *ptr++ = cpu_to_fdt32(lower); | |
177 | ||
178 | /* store one or two size cells */ | |
3bf2f153 TR |
179 | size = carveout.end - carveout.start + 1; |
180 | upper = upper_32_bits(size); | |
181 | lower = lower_32_bits(size); | |
4e4bde30 TR |
182 | |
183 | if (ns > 1) | |
184 | *ptr++ = cpu_to_fdt32(upper); | |
185 | ||
186 | *ptr++ = cpu_to_fdt32(lower); | |
187 | ||
188 | offset = CHECK(fdt_add_subnode(fdt, 0, name + 1)); | |
189 | CHECK(fdt_setprop(fdt, offset, "reg", cells, (na + ns) * sizeof(*cells))); | |
190 | ||
191 | return fdtdec_set_carveout(fdt, name, "memory-region", 0, | |
192 | "framebuffer", &carveout); | |
193 | } | |
194 | ||
195 | static int check_fdt_carveout(void *fdt, uint32_t address_cells, | |
196 | uint32_t size_cells) | |
197 | { | |
198 | #ifdef CONFIG_PHYS_64BIT | |
199 | const char *name = "/display@1,80000000"; | |
200 | const struct fdt_memory expected = { | |
201 | .start = 0x180000000, | |
202 | .end = 0x18fffffff, | |
203 | }; | |
204 | #else | |
205 | const char *name = "/display@80000000"; | |
206 | const struct fdt_memory expected = { | |
207 | .start = 0x80000000, | |
208 | .end = 0x8fffffff, | |
209 | }; | |
210 | #endif | |
211 | struct fdt_memory carveout; | |
212 | ||
213 | printf("carveout: %pap-%pap na=%u ns=%u: ", &expected.start, | |
214 | &expected.end, address_cells, size_cells); | |
215 | ||
216 | CHECK(fdtdec_get_carveout(fdt, name, "memory-region", 0, &carveout)); | |
217 | ||
218 | if ((carveout.start != expected.start) || | |
219 | (carveout.end != expected.end)) { | |
220 | printf("carveout: %pap-%pap, expected %pap-%pap\n", | |
221 | &carveout.start, &carveout.end, | |
222 | &expected.start, &expected.end); | |
223 | return 1; | |
224 | } | |
225 | ||
226 | printf("pass\n"); | |
227 | return 0; | |
228 | } | |
229 | ||
230 | static int make_fdt_carveout(void *fdt, int size, uint32_t address_cells, | |
231 | uint32_t size_cells) | |
232 | { | |
233 | fdt32_t na = cpu_to_fdt32(address_cells); | |
234 | fdt32_t ns = cpu_to_fdt32(size_cells); | |
235 | #if defined(DEBUG) && defined(CONFIG_SANDBOX) | |
236 | char filename[512]; | |
237 | int fd; | |
238 | #endif | |
239 | int err; | |
240 | ||
241 | CHECK(fdt_create(fdt, size)); | |
242 | CHECK(fdt_finish_reservemap(fdt)); | |
243 | CHECK(fdt_begin_node(fdt, "")); | |
244 | CHECK(fdt_property(fdt, "#address-cells", &na, sizeof(na))); | |
245 | CHECK(fdt_property(fdt, "#size-cells", &ns, sizeof(ns))); | |
246 | CHECK(fdt_end_node(fdt)); | |
247 | CHECK(fdt_finish(fdt)); | |
248 | CHECK(fdt_pack(fdt)); | |
249 | ||
250 | CHECK(fdt_open_into(fdt, fdt, FDT_SIZE)); | |
251 | ||
252 | err = make_fdt_carveout_device(fdt, address_cells, size_cells); | |
253 | ||
254 | #if defined(DEBUG) && defined(CONFIG_SANDBOX) | |
255 | snprintf(filename, sizeof(filename), "/tmp/fdtdec-carveout-%u-%u.dtb", | |
256 | address_cells, size_cells); | |
257 | ||
258 | fd = os_open(filename, OS_O_CREAT | OS_O_WRONLY); | |
259 | if (fd < 0) { | |
260 | printf("could not open .dtb file to write\n"); | |
261 | goto out; | |
262 | } | |
263 | ||
264 | os_write(fd, fdt, size); | |
265 | os_close(fd); | |
266 | ||
267 | out: | |
268 | #endif | |
269 | return err; | |
270 | } | |
271 | ||
272 | static int check_carveout(void) | |
273 | { | |
274 | void *fdt; | |
275 | ||
276 | fdt = malloc(FDT_SIZE); | |
277 | if (!fdt) { | |
278 | printf("%s: out of memory\n", __func__); | |
279 | return 1; | |
280 | } | |
281 | ||
282 | #ifndef CONFIG_PHYS_64BIT | |
283 | CHECKVAL(make_fdt_carveout(fdt, FDT_SIZE, 1, 1), 0); | |
284 | CHECKOK(check_fdt_carveout(fdt, 1, 1)); | |
285 | CHECKVAL(make_fdt_carveout(fdt, FDT_SIZE, 1, 2), 0); | |
286 | CHECKOK(check_fdt_carveout(fdt, 1, 2)); | |
287 | #else | |
288 | CHECKVAL(make_fdt_carveout(fdt, FDT_SIZE, 1, 1), -FDT_ERR_BADVALUE); | |
289 | CHECKVAL(make_fdt_carveout(fdt, FDT_SIZE, 1, 2), -FDT_ERR_BADVALUE); | |
290 | #endif | |
291 | CHECKVAL(make_fdt_carveout(fdt, FDT_SIZE, 2, 1), 0); | |
292 | CHECKOK(check_fdt_carveout(fdt, 2, 1)); | |
293 | CHECKVAL(make_fdt_carveout(fdt, FDT_SIZE, 2, 2), 0); | |
294 | CHECKOK(check_fdt_carveout(fdt, 2, 2)); | |
295 | ||
848e94d0 | 296 | free(fdt); |
4e4bde30 TR |
297 | return 0; |
298 | } | |
299 | ||
dc254f38 SG |
300 | static int do_test_fdtdec(cmd_tbl_t *cmdtp, int flag, int argc, |
301 | char * const argv[]) | |
302 | { | |
303 | /* basic tests */ | |
304 | CHECKOK(run_test("", "", "")); | |
305 | CHECKOK(run_test("1e 3d", "", "")); | |
306 | ||
307 | /* | |
308 | * 'a' represents 0, 'b' represents 1, etc. | |
309 | * The first character is the alias number, the second is the node | |
310 | * number. So the params mean: | |
311 | * 0a 1b : point alias 0 to node 0 (a), alias 1 to node 1(b) | |
312 | * ab : to create nodes 0 and 1 (a and b) | |
313 | * ab : we expect the function to return two nodes, in | |
314 | * the order 0, 1 | |
315 | */ | |
316 | CHECKOK(run_test("0a 1b", "ab", "ab")); | |
317 | ||
318 | CHECKOK(run_test("0a 1c", "ab", "ab")); | |
319 | CHECKOK(run_test("1c", "ab", "ab")); | |
320 | CHECKOK(run_test("1b", "ab", "ab")); | |
321 | CHECKOK(run_test("0b", "ab", "ba")); | |
322 | CHECKOK(run_test("0b 2d", "dbc", "bcd")); | |
323 | CHECKOK(run_test("0d 3a 1c 2b", "dbac", "dcba")); | |
324 | ||
325 | /* things with holes */ | |
326 | CHECKOK(run_test("1b 3d", "dbc", "cb d")); | |
327 | CHECKOK(run_test("1e 3d", "dbc", "bc d")); | |
328 | ||
329 | /* no aliases */ | |
330 | CHECKOK(run_test("", "dbac", "dbac")); | |
331 | ||
332 | /* disabled nodes */ | |
333 | CHECKOK(run_test("0d 3a 1c 2b", "dBac", "dc a")); | |
334 | CHECKOK(run_test("0b 2d", "DBc", "c")); | |
335 | CHECKOK(run_test("0b 4d 2c", "DBc", " c")); | |
336 | ||
337 | /* conflicting aliases - first one gets it */ | |
338 | CHECKOK(run_test("2a 1a 0a", "a", " a")); | |
339 | CHECKOK(run_test("0a 1a 2a", "a", "a")); | |
340 | ||
4e4bde30 TR |
341 | CHECKOK(check_carveout()); |
342 | ||
dc254f38 SG |
343 | printf("Test passed\n"); |
344 | return 0; | |
345 | } | |
346 | ||
347 | U_BOOT_CMD( | |
348 | test_fdtdec, 3, 1, do_test_fdtdec, | |
349 | "test_fdtdec", | |
350 | "Run tests for fdtdec library"); |