Commit | Line | Data |
---|---|---|
53a42093 GL |
1 | /* |
2 | * Self tests for device tree subsystem | |
3 | */ | |
4 | ||
cabb7d5b | 5 | #define pr_fmt(fmt) "### dt-test ### " fmt |
53a42093 GL |
6 | |
7 | #include <linux/clk.h> | |
8 | #include <linux/err.h> | |
9 | #include <linux/errno.h> | |
841ec213 | 10 | #include <linux/hashtable.h> |
81d0848f | 11 | #include <linux/libfdt.h> |
53a42093 | 12 | #include <linux/of.h> |
ae9304c9 | 13 | #include <linux/of_fdt.h> |
a9f10ca7 | 14 | #include <linux/of_irq.h> |
82c0f589 | 15 | #include <linux/of_platform.h> |
53a42093 GL |
16 | #include <linux/list.h> |
17 | #include <linux/mutex.h> | |
18 | #include <linux/slab.h> | |
19 | #include <linux/device.h> | |
177d271c | 20 | #include <linux/platform_device.h> |
53a42093 | 21 | |
d5e75500 PA |
22 | #include <linux/i2c.h> |
23 | #include <linux/i2c-mux.h> | |
24 | ||
492a22ac PA |
25 | #include <linux/bitops.h> |
26 | ||
69843396 PA |
27 | #include "of_private.h" |
28 | ||
9697a559 | 29 | static struct unittest_results { |
a9f10ca7 GL |
30 | int passed; |
31 | int failed; | |
9697a559 | 32 | } unittest_results; |
a9f10ca7 | 33 | |
9697a559 | 34 | #define unittest(result, fmt, ...) ({ \ |
851da976 GL |
35 | bool failed = !(result); \ |
36 | if (failed) { \ | |
9697a559 | 37 | unittest_results.failed++; \ |
a9f10ca7 | 38 | pr_err("FAIL %s():%i " fmt, __func__, __LINE__, ##__VA_ARGS__); \ |
cabb7d5b | 39 | } else { \ |
9697a559 | 40 | unittest_results.passed++; \ |
a9f10ca7 | 41 | pr_debug("pass %s():%i\n", __func__, __LINE__); \ |
cabb7d5b | 42 | } \ |
851da976 GL |
43 | failed; \ |
44 | }) | |
53a42093 | 45 | |
9697a559 | 46 | static void __init of_unittest_find_node_by_name(void) |
ae91ff72 GL |
47 | { |
48 | struct device_node *np; | |
0d638a07 | 49 | const char *options, *name; |
ae91ff72 GL |
50 | |
51 | np = of_find_node_by_path("/testcase-data"); | |
0d638a07 RH |
52 | name = kasprintf(GFP_KERNEL, "%pOF", np); |
53 | unittest(np && !strcmp("/testcase-data", name), | |
ae91ff72 GL |
54 | "find /testcase-data failed\n"); |
55 | of_node_put(np); | |
0d638a07 | 56 | kfree(name); |
ae91ff72 GL |
57 | |
58 | /* Test if trailing '/' works */ | |
59 | np = of_find_node_by_path("/testcase-data/"); | |
9697a559 | 60 | unittest(!np, "trailing '/' on /testcase-data/ should fail\n"); |
ae91ff72 GL |
61 | |
62 | np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a"); | |
0d638a07 RH |
63 | name = kasprintf(GFP_KERNEL, "%pOF", np); |
64 | unittest(np && !strcmp("/testcase-data/phandle-tests/consumer-a", name), | |
ae91ff72 GL |
65 | "find /testcase-data/phandle-tests/consumer-a failed\n"); |
66 | of_node_put(np); | |
0d638a07 | 67 | kfree(name); |
ae91ff72 GL |
68 | |
69 | np = of_find_node_by_path("testcase-alias"); | |
0d638a07 RH |
70 | name = kasprintf(GFP_KERNEL, "%pOF", np); |
71 | unittest(np && !strcmp("/testcase-data", name), | |
ae91ff72 GL |
72 | "find testcase-alias failed\n"); |
73 | of_node_put(np); | |
0d638a07 | 74 | kfree(name); |
ae91ff72 GL |
75 | |
76 | /* Test if trailing '/' works on aliases */ | |
77 | np = of_find_node_by_path("testcase-alias/"); | |
9697a559 | 78 | unittest(!np, "trailing '/' on testcase-alias/ should fail\n"); |
ae91ff72 GL |
79 | |
80 | np = of_find_node_by_path("testcase-alias/phandle-tests/consumer-a"); | |
0d638a07 RH |
81 | name = kasprintf(GFP_KERNEL, "%pOF", np); |
82 | unittest(np && !strcmp("/testcase-data/phandle-tests/consumer-a", name), | |
ae91ff72 GL |
83 | "find testcase-alias/phandle-tests/consumer-a failed\n"); |
84 | of_node_put(np); | |
0d638a07 | 85 | kfree(name); |
ae91ff72 GL |
86 | |
87 | np = of_find_node_by_path("/testcase-data/missing-path"); | |
0d638a07 | 88 | unittest(!np, "non-existent path returned node %pOF\n", np); |
ae91ff72 GL |
89 | of_node_put(np); |
90 | ||
91 | np = of_find_node_by_path("missing-alias"); | |
0d638a07 | 92 | unittest(!np, "non-existent alias returned node %pOF\n", np); |
ae91ff72 GL |
93 | of_node_put(np); |
94 | ||
95 | np = of_find_node_by_path("testcase-alias/missing-path"); | |
0d638a07 | 96 | unittest(!np, "non-existent alias with relative path returned node %pOF\n", np); |
ae91ff72 | 97 | of_node_put(np); |
75c28c09 LL |
98 | |
99 | np = of_find_node_opts_by_path("/testcase-data:testoption", &options); | |
9697a559 | 100 | unittest(np && !strcmp("testoption", options), |
75c28c09 LL |
101 | "option path test failed\n"); |
102 | of_node_put(np); | |
103 | ||
8cbba1ab | 104 | np = of_find_node_opts_by_path("/testcase-data:test/option", &options); |
9697a559 | 105 | unittest(np && !strcmp("test/option", options), |
8cbba1ab PH |
106 | "option path test, subcase #1 failed\n"); |
107 | of_node_put(np); | |
108 | ||
5ca1b0dd | 109 | np = of_find_node_opts_by_path("/testcase-data/testcase-device1:test/option", &options); |
9697a559 | 110 | unittest(np && !strcmp("test/option", options), |
5ca1b0dd BN |
111 | "option path test, subcase #2 failed\n"); |
112 | of_node_put(np); | |
113 | ||
75c28c09 | 114 | np = of_find_node_opts_by_path("/testcase-data:testoption", NULL); |
9697a559 | 115 | unittest(np, "NULL option path test failed\n"); |
75c28c09 LL |
116 | of_node_put(np); |
117 | ||
118 | np = of_find_node_opts_by_path("testcase-alias:testaliasoption", | |
119 | &options); | |
9697a559 | 120 | unittest(np && !strcmp("testaliasoption", options), |
75c28c09 LL |
121 | "option alias path test failed\n"); |
122 | of_node_put(np); | |
123 | ||
8cbba1ab PH |
124 | np = of_find_node_opts_by_path("testcase-alias:test/alias/option", |
125 | &options); | |
9697a559 | 126 | unittest(np && !strcmp("test/alias/option", options), |
8cbba1ab PH |
127 | "option alias path test, subcase #1 failed\n"); |
128 | of_node_put(np); | |
129 | ||
75c28c09 | 130 | np = of_find_node_opts_by_path("testcase-alias:testaliasoption", NULL); |
9697a559 | 131 | unittest(np, "NULL option alias path test failed\n"); |
75c28c09 LL |
132 | of_node_put(np); |
133 | ||
134 | options = "testoption"; | |
135 | np = of_find_node_opts_by_path("testcase-alias", &options); | |
9697a559 | 136 | unittest(np && !options, "option clearing test failed\n"); |
75c28c09 LL |
137 | of_node_put(np); |
138 | ||
139 | options = "testoption"; | |
140 | np = of_find_node_opts_by_path("/", &options); | |
9697a559 | 141 | unittest(np && !options, "option clearing root node test failed\n"); |
75c28c09 | 142 | of_node_put(np); |
ae91ff72 GL |
143 | } |
144 | ||
9697a559 | 145 | static void __init of_unittest_dynamic(void) |
7e66c5c7 GL |
146 | { |
147 | struct device_node *np; | |
148 | struct property *prop; | |
149 | ||
150 | np = of_find_node_by_path("/testcase-data"); | |
151 | if (!np) { | |
152 | pr_err("missing testcase data\n"); | |
153 | return; | |
154 | } | |
155 | ||
156 | /* Array of 4 properties for the purpose of testing */ | |
157 | prop = kzalloc(sizeof(*prop) * 4, GFP_KERNEL); | |
158 | if (!prop) { | |
9697a559 | 159 | unittest(0, "kzalloc() failed\n"); |
7e66c5c7 GL |
160 | return; |
161 | } | |
162 | ||
163 | /* Add a new property - should pass*/ | |
164 | prop->name = "new-property"; | |
165 | prop->value = "new-property-data"; | |
166 | prop->length = strlen(prop->value); | |
9697a559 | 167 | unittest(of_add_property(np, prop) == 0, "Adding a new property failed\n"); |
7e66c5c7 GL |
168 | |
169 | /* Try to add an existing property - should fail */ | |
170 | prop++; | |
171 | prop->name = "new-property"; | |
172 | prop->value = "new-property-data-should-fail"; | |
173 | prop->length = strlen(prop->value); | |
9697a559 | 174 | unittest(of_add_property(np, prop) != 0, |
7e66c5c7 GL |
175 | "Adding an existing property should have failed\n"); |
176 | ||
177 | /* Try to modify an existing property - should pass */ | |
178 | prop->value = "modify-property-data-should-pass"; | |
179 | prop->length = strlen(prop->value); | |
9697a559 | 180 | unittest(of_update_property(np, prop) == 0, |
7e66c5c7 GL |
181 | "Updating an existing property should have passed\n"); |
182 | ||
183 | /* Try to modify non-existent property - should pass*/ | |
184 | prop++; | |
185 | prop->name = "modify-property"; | |
186 | prop->value = "modify-missing-property-data-should-pass"; | |
187 | prop->length = strlen(prop->value); | |
9697a559 | 188 | unittest(of_update_property(np, prop) == 0, |
7e66c5c7 GL |
189 | "Updating a missing property should have passed\n"); |
190 | ||
191 | /* Remove property - should pass */ | |
9697a559 | 192 | unittest(of_remove_property(np, prop) == 0, |
7e66c5c7 GL |
193 | "Removing a property should have passed\n"); |
194 | ||
195 | /* Adding very large property - should pass */ | |
196 | prop++; | |
197 | prop->name = "large-property-PAGE_SIZEx8"; | |
198 | prop->length = PAGE_SIZE * 8; | |
199 | prop->value = kzalloc(prop->length, GFP_KERNEL); | |
9697a559 | 200 | unittest(prop->value != NULL, "Unable to allocate large buffer\n"); |
7e66c5c7 | 201 | if (prop->value) |
9697a559 | 202 | unittest(of_add_property(np, prop) == 0, |
7e66c5c7 GL |
203 | "Adding a large property should have passed\n"); |
204 | } | |
205 | ||
9697a559 | 206 | static int __init of_unittest_check_node_linkage(struct device_node *np) |
f2051d6a | 207 | { |
5063e25a | 208 | struct device_node *child; |
f2051d6a GL |
209 | int count = 0, rc; |
210 | ||
211 | for_each_child_of_node(np, child) { | |
212 | if (child->parent != np) { | |
213 | pr_err("Child node %s links to wrong parent %s\n", | |
214 | child->name, np->name); | |
855ff287 JL |
215 | rc = -EINVAL; |
216 | goto put_child; | |
f2051d6a GL |
217 | } |
218 | ||
9697a559 | 219 | rc = of_unittest_check_node_linkage(child); |
f2051d6a | 220 | if (rc < 0) |
855ff287 | 221 | goto put_child; |
f2051d6a GL |
222 | count += rc; |
223 | } | |
224 | ||
225 | return count + 1; | |
855ff287 JL |
226 | put_child: |
227 | of_node_put(child); | |
228 | return rc; | |
f2051d6a GL |
229 | } |
230 | ||
9697a559 | 231 | static void __init of_unittest_check_tree_linkage(void) |
f2051d6a GL |
232 | { |
233 | struct device_node *np; | |
234 | int allnode_count = 0, child_count; | |
235 | ||
5063e25a | 236 | if (!of_root) |
f2051d6a GL |
237 | return; |
238 | ||
239 | for_each_of_allnodes(np) | |
240 | allnode_count++; | |
9697a559 | 241 | child_count = of_unittest_check_node_linkage(of_root); |
f2051d6a | 242 | |
9697a559 | 243 | unittest(child_count > 0, "Device node data structure is corrupted\n"); |
a2166ca5 | 244 | unittest(child_count == allnode_count, |
a6bb121e FR |
245 | "allnodes list size (%i) doesn't match sibling lists size (%i)\n", |
246 | allnode_count, child_count); | |
f2051d6a GL |
247 | pr_debug("allnodes list size (%i); sibling lists size (%i)\n", allnode_count, child_count); |
248 | } | |
249 | ||
ce4fecf1 PA |
250 | static void __init of_unittest_printf_one(struct device_node *np, const char *fmt, |
251 | const char *expected) | |
252 | { | |
253 | unsigned char buf[strlen(expected)+10]; | |
254 | int size, i; | |
255 | ||
256 | /* Baseline; check conversion with a large size limit */ | |
257 | memset(buf, 0xff, sizeof(buf)); | |
258 | size = snprintf(buf, sizeof(buf) - 2, fmt, np); | |
259 | ||
260 | /* use strcmp() instead of strncmp() here to be absolutely sure strings match */ | |
261 | unittest((strcmp(buf, expected) == 0) && (buf[size+1] == 0xff), | |
262 | "sprintf failed; fmt='%s' expected='%s' rslt='%s'\n", | |
263 | fmt, expected, buf); | |
264 | ||
265 | /* Make sure length limits work */ | |
266 | size++; | |
267 | for (i = 0; i < 2; i++, size--) { | |
268 | /* Clear the buffer, and make sure it works correctly still */ | |
269 | memset(buf, 0xff, sizeof(buf)); | |
270 | snprintf(buf, size+1, fmt, np); | |
271 | unittest(strncmp(buf, expected, size) == 0 && (buf[size+1] == 0xff), | |
272 | "snprintf failed; size=%i fmt='%s' expected='%s' rslt='%s'\n", | |
273 | size, fmt, expected, buf); | |
274 | } | |
275 | } | |
276 | ||
277 | static void __init of_unittest_printf(void) | |
278 | { | |
279 | struct device_node *np; | |
280 | const char *full_name = "/testcase-data/platform-tests/test-device@1/dev@100"; | |
281 | char phandle_str[16] = ""; | |
282 | ||
283 | np = of_find_node_by_path(full_name); | |
284 | if (!np) { | |
285 | unittest(np, "testcase data missing\n"); | |
286 | return; | |
287 | } | |
288 | ||
289 | num_to_str(phandle_str, sizeof(phandle_str), np->phandle); | |
290 | ||
291 | of_unittest_printf_one(np, "%pOF", full_name); | |
292 | of_unittest_printf_one(np, "%pOFf", full_name); | |
293 | of_unittest_printf_one(np, "%pOFp", phandle_str); | |
294 | of_unittest_printf_one(np, "%pOFP", "dev@100"); | |
295 | of_unittest_printf_one(np, "ABC %pOFP ABC", "ABC dev@100 ABC"); | |
296 | of_unittest_printf_one(np, "%10pOFP", " dev@100"); | |
297 | of_unittest_printf_one(np, "%-10pOFP", "dev@100 "); | |
298 | of_unittest_printf_one(of_root, "%pOFP", "/"); | |
299 | of_unittest_printf_one(np, "%pOFF", "----"); | |
300 | of_unittest_printf_one(np, "%pOFPF", "dev@100:----"); | |
301 | of_unittest_printf_one(np, "%pOFPFPc", "dev@100:----:dev@100:test-sub-device"); | |
302 | of_unittest_printf_one(np, "%pOFc", "test-sub-device"); | |
303 | of_unittest_printf_one(np, "%pOFC", | |
304 | "\"test-sub-device\",\"test-compat2\",\"test-compat3\""); | |
305 | } | |
306 | ||
841ec213 GL |
307 | struct node_hash { |
308 | struct hlist_node node; | |
309 | struct device_node *np; | |
310 | }; | |
311 | ||
2118f4b8 | 312 | static DEFINE_HASHTABLE(phandle_ht, 8); |
9697a559 | 313 | static void __init of_unittest_check_phandles(void) |
841ec213 GL |
314 | { |
315 | struct device_node *np; | |
316 | struct node_hash *nh; | |
317 | struct hlist_node *tmp; | |
318 | int i, dup_count = 0, phandle_count = 0; | |
841ec213 | 319 | |
841ec213 GL |
320 | for_each_of_allnodes(np) { |
321 | if (!np->phandle) | |
322 | continue; | |
323 | ||
2118f4b8 | 324 | hash_for_each_possible(phandle_ht, nh, node, np->phandle) { |
841ec213 | 325 | if (nh->np->phandle == np->phandle) { |
0d638a07 RH |
326 | pr_info("Duplicate phandle! %i used by %pOF and %pOF\n", |
327 | np->phandle, nh->np, np); | |
841ec213 GL |
328 | dup_count++; |
329 | break; | |
330 | } | |
331 | } | |
332 | ||
333 | nh = kzalloc(sizeof(*nh), GFP_KERNEL); | |
334 | if (WARN_ON(!nh)) | |
335 | return; | |
336 | ||
337 | nh->np = np; | |
2118f4b8 | 338 | hash_add(phandle_ht, &nh->node, np->phandle); |
841ec213 GL |
339 | phandle_count++; |
340 | } | |
9697a559 | 341 | unittest(dup_count == 0, "Found %i duplicates in %i phandles\n", |
841ec213 GL |
342 | dup_count, phandle_count); |
343 | ||
344 | /* Clean up */ | |
2118f4b8 | 345 | hash_for_each_safe(phandle_ht, i, tmp, nh, node) { |
841ec213 GL |
346 | hash_del(&nh->node); |
347 | kfree(nh); | |
348 | } | |
349 | } | |
350 | ||
9697a559 | 351 | static void __init of_unittest_parse_phandle_with_args(void) |
53a42093 GL |
352 | { |
353 | struct device_node *np; | |
354 | struct of_phandle_args args; | |
cabb7d5b | 355 | int i, rc; |
53a42093 | 356 | |
53a42093 GL |
357 | np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a"); |
358 | if (!np) { | |
359 | pr_err("missing testcase data\n"); | |
360 | return; | |
361 | } | |
362 | ||
bd69f73f | 363 | rc = of_count_phandle_with_args(np, "phandle-list", "#phandle-cells"); |
9697a559 | 364 | unittest(rc == 7, "of_count_phandle_with_args() returned %i, expected 7\n", rc); |
bd69f73f | 365 | |
f7f951c2 | 366 | for (i = 0; i < 8; i++) { |
53a42093 | 367 | bool passed = true; |
3db316d0 | 368 | |
53a42093 GL |
369 | rc = of_parse_phandle_with_args(np, "phandle-list", |
370 | "#phandle-cells", i, &args); | |
371 | ||
372 | /* Test the values from tests-phandle.dtsi */ | |
373 | switch (i) { | |
374 | case 0: | |
375 | passed &= !rc; | |
376 | passed &= (args.args_count == 1); | |
377 | passed &= (args.args[0] == (i + 1)); | |
378 | break; | |
379 | case 1: | |
380 | passed &= !rc; | |
381 | passed &= (args.args_count == 2); | |
382 | passed &= (args.args[0] == (i + 1)); | |
383 | passed &= (args.args[1] == 0); | |
384 | break; | |
385 | case 2: | |
386 | passed &= (rc == -ENOENT); | |
387 | break; | |
388 | case 3: | |
389 | passed &= !rc; | |
390 | passed &= (args.args_count == 3); | |
391 | passed &= (args.args[0] == (i + 1)); | |
392 | passed &= (args.args[1] == 4); | |
393 | passed &= (args.args[2] == 3); | |
394 | break; | |
395 | case 4: | |
396 | passed &= !rc; | |
397 | passed &= (args.args_count == 2); | |
398 | passed &= (args.args[0] == (i + 1)); | |
399 | passed &= (args.args[1] == 100); | |
400 | break; | |
401 | case 5: | |
402 | passed &= !rc; | |
403 | passed &= (args.args_count == 0); | |
404 | break; | |
405 | case 6: | |
406 | passed &= !rc; | |
407 | passed &= (args.args_count == 1); | |
408 | passed &= (args.args[0] == (i + 1)); | |
409 | break; | |
410 | case 7: | |
cabb7d5b | 411 | passed &= (rc == -ENOENT); |
53a42093 GL |
412 | break; |
413 | default: | |
414 | passed = false; | |
415 | } | |
416 | ||
0d638a07 RH |
417 | unittest(passed, "index %i - data error on node %pOF rc=%i\n", |
418 | i, args.np, rc); | |
53a42093 GL |
419 | } |
420 | ||
421 | /* Check for missing list property */ | |
422 | rc = of_parse_phandle_with_args(np, "phandle-list-missing", | |
423 | "#phandle-cells", 0, &args); | |
9697a559 | 424 | unittest(rc == -ENOENT, "expected:%i got:%i\n", -ENOENT, rc); |
bd69f73f GL |
425 | rc = of_count_phandle_with_args(np, "phandle-list-missing", |
426 | "#phandle-cells"); | |
9697a559 | 427 | unittest(rc == -ENOENT, "expected:%i got:%i\n", -ENOENT, rc); |
53a42093 GL |
428 | |
429 | /* Check for missing cells property */ | |
430 | rc = of_parse_phandle_with_args(np, "phandle-list", | |
431 | "#phandle-cells-missing", 0, &args); | |
9697a559 | 432 | unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc); |
bd69f73f GL |
433 | rc = of_count_phandle_with_args(np, "phandle-list", |
434 | "#phandle-cells-missing"); | |
9697a559 | 435 | unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc); |
53a42093 GL |
436 | |
437 | /* Check for bad phandle in list */ | |
438 | rc = of_parse_phandle_with_args(np, "phandle-list-bad-phandle", | |
439 | "#phandle-cells", 0, &args); | |
9697a559 | 440 | unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc); |
bd69f73f GL |
441 | rc = of_count_phandle_with_args(np, "phandle-list-bad-phandle", |
442 | "#phandle-cells"); | |
9697a559 | 443 | unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc); |
53a42093 GL |
444 | |
445 | /* Check for incorrectly formed argument list */ | |
446 | rc = of_parse_phandle_with_args(np, "phandle-list-bad-args", | |
447 | "#phandle-cells", 1, &args); | |
9697a559 | 448 | unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc); |
bd69f73f GL |
449 | rc = of_count_phandle_with_args(np, "phandle-list-bad-args", |
450 | "#phandle-cells"); | |
9697a559 | 451 | unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc); |
53a42093 GL |
452 | } |
453 | ||
9697a559 | 454 | static void __init of_unittest_property_string(void) |
7aff0fe3 | 455 | { |
a87fa1d8 | 456 | const char *strings[4]; |
7aff0fe3 GL |
457 | struct device_node *np; |
458 | int rc; | |
459 | ||
7aff0fe3 GL |
460 | np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a"); |
461 | if (!np) { | |
462 | pr_err("No testcase data in device tree\n"); | |
463 | return; | |
464 | } | |
465 | ||
466 | rc = of_property_match_string(np, "phandle-list-names", "first"); | |
9697a559 | 467 | unittest(rc == 0, "first expected:0 got:%i\n", rc); |
7aff0fe3 | 468 | rc = of_property_match_string(np, "phandle-list-names", "second"); |
9697a559 | 469 | unittest(rc == 1, "second expected:1 got:%i\n", rc); |
7aff0fe3 | 470 | rc = of_property_match_string(np, "phandle-list-names", "third"); |
9697a559 | 471 | unittest(rc == 2, "third expected:2 got:%i\n", rc); |
7aff0fe3 | 472 | rc = of_property_match_string(np, "phandle-list-names", "fourth"); |
9697a559 | 473 | unittest(rc == -ENODATA, "unmatched string; rc=%i\n", rc); |
7aff0fe3 | 474 | rc = of_property_match_string(np, "missing-property", "blah"); |
9697a559 | 475 | unittest(rc == -EINVAL, "missing property; rc=%i\n", rc); |
7aff0fe3 | 476 | rc = of_property_match_string(np, "empty-property", "blah"); |
9697a559 | 477 | unittest(rc == -ENODATA, "empty property; rc=%i\n", rc); |
7aff0fe3 | 478 | rc = of_property_match_string(np, "unterminated-string", "blah"); |
9697a559 | 479 | unittest(rc == -EILSEQ, "unterminated string; rc=%i\n", rc); |
a87fa1d8 GL |
480 | |
481 | /* of_property_count_strings() tests */ | |
482 | rc = of_property_count_strings(np, "string-property"); | |
9697a559 | 483 | unittest(rc == 1, "Incorrect string count; rc=%i\n", rc); |
a87fa1d8 | 484 | rc = of_property_count_strings(np, "phandle-list-names"); |
9697a559 | 485 | unittest(rc == 3, "Incorrect string count; rc=%i\n", rc); |
a87fa1d8 | 486 | rc = of_property_count_strings(np, "unterminated-string"); |
9697a559 | 487 | unittest(rc == -EILSEQ, "unterminated string; rc=%i\n", rc); |
a87fa1d8 | 488 | rc = of_property_count_strings(np, "unterminated-string-list"); |
9697a559 | 489 | unittest(rc == -EILSEQ, "unterminated string array; rc=%i\n", rc); |
a87fa1d8 GL |
490 | |
491 | /* of_property_read_string_index() tests */ | |
492 | rc = of_property_read_string_index(np, "string-property", 0, strings); | |
9697a559 | 493 | unittest(rc == 0 && !strcmp(strings[0], "foobar"), "of_property_read_string_index() failure; rc=%i\n", rc); |
a87fa1d8 GL |
494 | strings[0] = NULL; |
495 | rc = of_property_read_string_index(np, "string-property", 1, strings); | |
9697a559 | 496 | unittest(rc == -ENODATA && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc); |
a87fa1d8 | 497 | rc = of_property_read_string_index(np, "phandle-list-names", 0, strings); |
9697a559 | 498 | unittest(rc == 0 && !strcmp(strings[0], "first"), "of_property_read_string_index() failure; rc=%i\n", rc); |
a87fa1d8 | 499 | rc = of_property_read_string_index(np, "phandle-list-names", 1, strings); |
9697a559 | 500 | unittest(rc == 0 && !strcmp(strings[0], "second"), "of_property_read_string_index() failure; rc=%i\n", rc); |
a87fa1d8 | 501 | rc = of_property_read_string_index(np, "phandle-list-names", 2, strings); |
9697a559 | 502 | unittest(rc == 0 && !strcmp(strings[0], "third"), "of_property_read_string_index() failure; rc=%i\n", rc); |
a87fa1d8 GL |
503 | strings[0] = NULL; |
504 | rc = of_property_read_string_index(np, "phandle-list-names", 3, strings); | |
9697a559 | 505 | unittest(rc == -ENODATA && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc); |
a87fa1d8 GL |
506 | strings[0] = NULL; |
507 | rc = of_property_read_string_index(np, "unterminated-string", 0, strings); | |
9697a559 | 508 | unittest(rc == -EILSEQ && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc); |
a87fa1d8 | 509 | rc = of_property_read_string_index(np, "unterminated-string-list", 0, strings); |
9697a559 | 510 | unittest(rc == 0 && !strcmp(strings[0], "first"), "of_property_read_string_index() failure; rc=%i\n", rc); |
a87fa1d8 GL |
511 | strings[0] = NULL; |
512 | rc = of_property_read_string_index(np, "unterminated-string-list", 2, strings); /* should fail */ | |
9697a559 | 513 | unittest(rc == -EILSEQ && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc); |
a87fa1d8 GL |
514 | strings[1] = NULL; |
515 | ||
516 | /* of_property_read_string_array() tests */ | |
517 | rc = of_property_read_string_array(np, "string-property", strings, 4); | |
9697a559 | 518 | unittest(rc == 1, "Incorrect string count; rc=%i\n", rc); |
a87fa1d8 | 519 | rc = of_property_read_string_array(np, "phandle-list-names", strings, 4); |
9697a559 | 520 | unittest(rc == 3, "Incorrect string count; rc=%i\n", rc); |
a87fa1d8 | 521 | rc = of_property_read_string_array(np, "unterminated-string", strings, 4); |
9697a559 | 522 | unittest(rc == -EILSEQ, "unterminated string; rc=%i\n", rc); |
a87fa1d8 GL |
523 | /* -- An incorrectly formed string should cause a failure */ |
524 | rc = of_property_read_string_array(np, "unterminated-string-list", strings, 4); | |
9697a559 | 525 | unittest(rc == -EILSEQ, "unterminated string array; rc=%i\n", rc); |
a87fa1d8 GL |
526 | /* -- parsing the correctly formed strings should still work: */ |
527 | strings[2] = NULL; | |
528 | rc = of_property_read_string_array(np, "unterminated-string-list", strings, 2); | |
9697a559 | 529 | unittest(rc == 2 && strings[2] == NULL, "of_property_read_string_array() failure; rc=%i\n", rc); |
a87fa1d8 GL |
530 | strings[1] = NULL; |
531 | rc = of_property_read_string_array(np, "phandle-list-names", strings, 1); | |
9697a559 | 532 | unittest(rc == 1 && strings[1] == NULL, "Overwrote end of string array; rc=%i, str='%s'\n", rc, strings[1]); |
7aff0fe3 GL |
533 | } |
534 | ||
69843396 PA |
535 | #define propcmp(p1, p2) (((p1)->length == (p2)->length) && \ |
536 | (p1)->value && (p2)->value && \ | |
537 | !memcmp((p1)->value, (p2)->value, (p1)->length) && \ | |
538 | !strcmp((p1)->name, (p2)->name)) | |
9697a559 | 539 | static void __init of_unittest_property_copy(void) |
69843396 PA |
540 | { |
541 | #ifdef CONFIG_OF_DYNAMIC | |
542 | struct property p1 = { .name = "p1", .length = 0, .value = "" }; | |
543 | struct property p2 = { .name = "p2", .length = 5, .value = "abcd" }; | |
544 | struct property *new; | |
545 | ||
546 | new = __of_prop_dup(&p1, GFP_KERNEL); | |
9697a559 | 547 | unittest(new && propcmp(&p1, new), "empty property didn't copy correctly\n"); |
69843396 PA |
548 | kfree(new->value); |
549 | kfree(new->name); | |
550 | kfree(new); | |
551 | ||
552 | new = __of_prop_dup(&p2, GFP_KERNEL); | |
9697a559 | 553 | unittest(new && propcmp(&p2, new), "non-empty property didn't copy correctly\n"); |
69843396 PA |
554 | kfree(new->value); |
555 | kfree(new->name); | |
556 | kfree(new); | |
557 | #endif | |
558 | } | |
559 | ||
9697a559 | 560 | static void __init of_unittest_changeset(void) |
201c910b PA |
561 | { |
562 | #ifdef CONFIG_OF_DYNAMIC | |
563 | struct property *ppadd, padd = { .name = "prop-add", .length = 0, .value = "" }; | |
564 | struct property *ppupdate, pupdate = { .name = "prop-update", .length = 5, .value = "abcd" }; | |
565 | struct property *ppremove; | |
e5179581 | 566 | struct device_node *n1, *n2, *n21, *nremove, *parent, *np; |
201c910b PA |
567 | struct of_changeset chgset; |
568 | ||
e5179581 | 569 | n1 = __of_node_dup(NULL, "/testcase-data/changeset/n1"); |
9697a559 | 570 | unittest(n1, "testcase setup failure\n"); |
e5179581 | 571 | n2 = __of_node_dup(NULL, "/testcase-data/changeset/n2"); |
9697a559 | 572 | unittest(n2, "testcase setup failure\n"); |
e5179581 | 573 | n21 = __of_node_dup(NULL, "%s/%s", "/testcase-data/changeset/n2", "n21"); |
9697a559 | 574 | unittest(n21, "testcase setup failure %p\n", n21); |
201c910b | 575 | nremove = of_find_node_by_path("/testcase-data/changeset/node-remove"); |
9697a559 | 576 | unittest(nremove, "testcase setup failure\n"); |
201c910b | 577 | ppadd = __of_prop_dup(&padd, GFP_KERNEL); |
9697a559 | 578 | unittest(ppadd, "testcase setup failure\n"); |
201c910b | 579 | ppupdate = __of_prop_dup(&pupdate, GFP_KERNEL); |
9697a559 | 580 | unittest(ppupdate, "testcase setup failure\n"); |
201c910b PA |
581 | parent = nremove->parent; |
582 | n1->parent = parent; | |
583 | n2->parent = parent; | |
584 | n21->parent = n2; | |
585 | n2->child = n21; | |
586 | ppremove = of_find_property(parent, "prop-remove", NULL); | |
9697a559 | 587 | unittest(ppremove, "failed to find removal prop"); |
201c910b PA |
588 | |
589 | of_changeset_init(&chgset); | |
9697a559 WL |
590 | unittest(!of_changeset_attach_node(&chgset, n1), "fail attach n1\n"); |
591 | unittest(!of_changeset_attach_node(&chgset, n2), "fail attach n2\n"); | |
592 | unittest(!of_changeset_detach_node(&chgset, nremove), "fail remove node\n"); | |
593 | unittest(!of_changeset_attach_node(&chgset, n21), "fail attach n21\n"); | |
594 | unittest(!of_changeset_add_property(&chgset, parent, ppadd), "fail add prop\n"); | |
595 | unittest(!of_changeset_update_property(&chgset, parent, ppupdate), "fail update prop\n"); | |
596 | unittest(!of_changeset_remove_property(&chgset, parent, ppremove), "fail remove prop\n"); | |
9697a559 | 597 | unittest(!of_changeset_apply(&chgset), "apply failed\n"); |
201c910b | 598 | |
e5179581 | 599 | /* Make sure node names are constructed correctly */ |
9697a559 | 600 | unittest((np = of_find_node_by_path("/testcase-data/changeset/n2/n21")), |
0d638a07 | 601 | "'%pOF' not added\n", n21); |
c46ca3c8 | 602 | of_node_put(np); |
e5179581 | 603 | |
9697a559 | 604 | unittest(!of_changeset_revert(&chgset), "revert failed\n"); |
201c910b PA |
605 | |
606 | of_changeset_destroy(&chgset); | |
607 | #endif | |
608 | } | |
609 | ||
9697a559 | 610 | static void __init of_unittest_parse_interrupts(void) |
a9f10ca7 GL |
611 | { |
612 | struct device_node *np; | |
613 | struct of_phandle_args args; | |
614 | int i, rc; | |
615 | ||
616 | np = of_find_node_by_path("/testcase-data/interrupts/interrupts0"); | |
617 | if (!np) { | |
618 | pr_err("missing testcase data\n"); | |
619 | return; | |
620 | } | |
621 | ||
622 | for (i = 0; i < 4; i++) { | |
623 | bool passed = true; | |
3db316d0 | 624 | |
a9f10ca7 GL |
625 | args.args_count = 0; |
626 | rc = of_irq_parse_one(np, i, &args); | |
627 | ||
628 | passed &= !rc; | |
629 | passed &= (args.args_count == 1); | |
630 | passed &= (args.args[0] == (i + 1)); | |
631 | ||
0d638a07 RH |
632 | unittest(passed, "index %i - data error on node %pOF rc=%i\n", |
633 | i, args.np, rc); | |
a9f10ca7 GL |
634 | } |
635 | of_node_put(np); | |
636 | ||
637 | np = of_find_node_by_path("/testcase-data/interrupts/interrupts1"); | |
638 | if (!np) { | |
639 | pr_err("missing testcase data\n"); | |
640 | return; | |
641 | } | |
642 | ||
643 | for (i = 0; i < 4; i++) { | |
644 | bool passed = true; | |
3db316d0 | 645 | |
a9f10ca7 GL |
646 | args.args_count = 0; |
647 | rc = of_irq_parse_one(np, i, &args); | |
648 | ||
649 | /* Test the values from tests-phandle.dtsi */ | |
650 | switch (i) { | |
651 | case 0: | |
652 | passed &= !rc; | |
653 | passed &= (args.args_count == 1); | |
654 | passed &= (args.args[0] == 9); | |
655 | break; | |
656 | case 1: | |
657 | passed &= !rc; | |
658 | passed &= (args.args_count == 3); | |
659 | passed &= (args.args[0] == 10); | |
660 | passed &= (args.args[1] == 11); | |
661 | passed &= (args.args[2] == 12); | |
662 | break; | |
663 | case 2: | |
664 | passed &= !rc; | |
665 | passed &= (args.args_count == 2); | |
666 | passed &= (args.args[0] == 13); | |
667 | passed &= (args.args[1] == 14); | |
668 | break; | |
669 | case 3: | |
670 | passed &= !rc; | |
671 | passed &= (args.args_count == 2); | |
672 | passed &= (args.args[0] == 15); | |
673 | passed &= (args.args[1] == 16); | |
674 | break; | |
675 | default: | |
676 | passed = false; | |
677 | } | |
0d638a07 RH |
678 | unittest(passed, "index %i - data error on node %pOF rc=%i\n", |
679 | i, args.np, rc); | |
a9f10ca7 GL |
680 | } |
681 | of_node_put(np); | |
682 | } | |
683 | ||
9697a559 | 684 | static void __init of_unittest_parse_interrupts_extended(void) |
79d97015 GL |
685 | { |
686 | struct device_node *np; | |
687 | struct of_phandle_args args; | |
688 | int i, rc; | |
689 | ||
690 | np = of_find_node_by_path("/testcase-data/interrupts/interrupts-extended0"); | |
691 | if (!np) { | |
692 | pr_err("missing testcase data\n"); | |
693 | return; | |
694 | } | |
695 | ||
696 | for (i = 0; i < 7; i++) { | |
697 | bool passed = true; | |
3db316d0 | 698 | |
79d97015 GL |
699 | rc = of_irq_parse_one(np, i, &args); |
700 | ||
701 | /* Test the values from tests-phandle.dtsi */ | |
702 | switch (i) { | |
703 | case 0: | |
704 | passed &= !rc; | |
705 | passed &= (args.args_count == 1); | |
706 | passed &= (args.args[0] == 1); | |
707 | break; | |
708 | case 1: | |
709 | passed &= !rc; | |
710 | passed &= (args.args_count == 3); | |
711 | passed &= (args.args[0] == 2); | |
712 | passed &= (args.args[1] == 3); | |
713 | passed &= (args.args[2] == 4); | |
714 | break; | |
715 | case 2: | |
716 | passed &= !rc; | |
717 | passed &= (args.args_count == 2); | |
718 | passed &= (args.args[0] == 5); | |
719 | passed &= (args.args[1] == 6); | |
720 | break; | |
721 | case 3: | |
722 | passed &= !rc; | |
723 | passed &= (args.args_count == 1); | |
724 | passed &= (args.args[0] == 9); | |
725 | break; | |
726 | case 4: | |
727 | passed &= !rc; | |
728 | passed &= (args.args_count == 3); | |
729 | passed &= (args.args[0] == 10); | |
730 | passed &= (args.args[1] == 11); | |
731 | passed &= (args.args[2] == 12); | |
732 | break; | |
733 | case 5: | |
734 | passed &= !rc; | |
735 | passed &= (args.args_count == 2); | |
736 | passed &= (args.args[0] == 13); | |
737 | passed &= (args.args[1] == 14); | |
738 | break; | |
739 | case 6: | |
740 | passed &= !rc; | |
741 | passed &= (args.args_count == 1); | |
742 | passed &= (args.args[0] == 15); | |
743 | break; | |
744 | default: | |
745 | passed = false; | |
746 | } | |
747 | ||
0d638a07 RH |
748 | unittest(passed, "index %i - data error on node %pOF rc=%i\n", |
749 | i, args.np, rc); | |
79d97015 GL |
750 | } |
751 | of_node_put(np); | |
752 | } | |
753 | ||
afaed7a9 | 754 | static const struct of_device_id match_node_table[] = { |
1f42e5dd GL |
755 | { .data = "A", .name = "name0", }, /* Name alone is lowest priority */ |
756 | { .data = "B", .type = "type1", }, /* followed by type alone */ | |
757 | ||
758 | { .data = "Ca", .name = "name2", .type = "type1", }, /* followed by both together */ | |
759 | { .data = "Cb", .name = "name2", }, /* Only match when type doesn't match */ | |
760 | { .data = "Cc", .name = "name2", .type = "type2", }, | |
761 | ||
762 | { .data = "E", .compatible = "compat3" }, | |
763 | { .data = "G", .compatible = "compat2", }, | |
764 | { .data = "H", .compatible = "compat2", .name = "name5", }, | |
765 | { .data = "I", .compatible = "compat2", .type = "type1", }, | |
766 | { .data = "J", .compatible = "compat2", .type = "type1", .name = "name8", }, | |
767 | { .data = "K", .compatible = "compat2", .name = "name9", }, | |
768 | {} | |
769 | }; | |
770 | ||
771 | static struct { | |
772 | const char *path; | |
773 | const char *data; | |
774 | } match_node_tests[] = { | |
775 | { .path = "/testcase-data/match-node/name0", .data = "A", }, | |
776 | { .path = "/testcase-data/match-node/name1", .data = "B", }, | |
777 | { .path = "/testcase-data/match-node/a/name2", .data = "Ca", }, | |
778 | { .path = "/testcase-data/match-node/b/name2", .data = "Cb", }, | |
779 | { .path = "/testcase-data/match-node/c/name2", .data = "Cc", }, | |
780 | { .path = "/testcase-data/match-node/name3", .data = "E", }, | |
781 | { .path = "/testcase-data/match-node/name4", .data = "G", }, | |
782 | { .path = "/testcase-data/match-node/name5", .data = "H", }, | |
783 | { .path = "/testcase-data/match-node/name6", .data = "G", }, | |
784 | { .path = "/testcase-data/match-node/name7", .data = "I", }, | |
785 | { .path = "/testcase-data/match-node/name8", .data = "J", }, | |
786 | { .path = "/testcase-data/match-node/name9", .data = "K", }, | |
787 | }; | |
788 | ||
9697a559 | 789 | static void __init of_unittest_match_node(void) |
1f42e5dd GL |
790 | { |
791 | struct device_node *np; | |
792 | const struct of_device_id *match; | |
793 | int i; | |
794 | ||
795 | for (i = 0; i < ARRAY_SIZE(match_node_tests); i++) { | |
796 | np = of_find_node_by_path(match_node_tests[i].path); | |
797 | if (!np) { | |
9697a559 | 798 | unittest(0, "missing testcase node %s\n", |
1f42e5dd GL |
799 | match_node_tests[i].path); |
800 | continue; | |
801 | } | |
802 | ||
803 | match = of_match_node(match_node_table, np); | |
804 | if (!match) { | |
9697a559 | 805 | unittest(0, "%s didn't match anything\n", |
1f42e5dd GL |
806 | match_node_tests[i].path); |
807 | continue; | |
808 | } | |
809 | ||
810 | if (strcmp(match->data, match_node_tests[i].data) != 0) { | |
9697a559 | 811 | unittest(0, "%s got wrong match. expected %s, got %s\n", |
1f42e5dd GL |
812 | match_node_tests[i].path, match_node_tests[i].data, |
813 | (const char *)match->data); | |
814 | continue; | |
815 | } | |
9697a559 | 816 | unittest(1, "passed"); |
1f42e5dd GL |
817 | } |
818 | } | |
819 | ||
d2329fb5 GL |
820 | static struct resource test_bus_res = { |
821 | .start = 0xfffffff8, | |
822 | .end = 0xfffffff9, | |
823 | .flags = IORESOURCE_MEM, | |
824 | }; | |
37791b6f GL |
825 | static const struct platform_device_info test_bus_info = { |
826 | .name = "unittest-bus", | |
851da976 | 827 | }; |
9697a559 | 828 | static void __init of_unittest_platform_populate(void) |
82c0f589 | 829 | { |
851da976 GL |
830 | int irq, rc; |
831 | struct device_node *np, *child, *grandchild; | |
37791b6f | 832 | struct platform_device *pdev, *test_bus; |
afaed7a9 | 833 | const struct of_device_id match[] = { |
fb2caa50 RH |
834 | { .compatible = "test-device", }, |
835 | {} | |
836 | }; | |
82c0f589 RH |
837 | |
838 | np = of_find_node_by_path("/testcase-data"); | |
146dedbc | 839 | of_platform_default_populate(np, NULL, NULL); |
82c0f589 RH |
840 | |
841 | /* Test that a missing irq domain returns -EPROBE_DEFER */ | |
842 | np = of_find_node_by_path("/testcase-data/testcase-device1"); | |
843 | pdev = of_find_device_by_node(np); | |
9697a559 | 844 | unittest(pdev, "device 1 creation failed\n"); |
7d1cdc89 | 845 | |
82c0f589 | 846 | irq = platform_get_irq(pdev, 0); |
9697a559 | 847 | unittest(irq == -EPROBE_DEFER, "device deferred probe failed - %d\n", irq); |
82c0f589 RH |
848 | |
849 | /* Test that a parsing failure does not return -EPROBE_DEFER */ | |
850 | np = of_find_node_by_path("/testcase-data/testcase-device2"); | |
851 | pdev = of_find_device_by_node(np); | |
9697a559 | 852 | unittest(pdev, "device 2 creation failed\n"); |
82c0f589 | 853 | irq = platform_get_irq(pdev, 0); |
9697a559 | 854 | unittest(irq < 0 && irq != -EPROBE_DEFER, "device parsing error failed - %d\n", irq); |
82c0f589 | 855 | |
716e1d49 | 856 | np = of_find_node_by_path("/testcase-data/platform-tests"); |
a2166ca5 | 857 | unittest(np, "No testcase data in device tree\n"); |
716e1d49 | 858 | if (!np) |
851da976 GL |
859 | return; |
860 | ||
37791b6f GL |
861 | test_bus = platform_device_register_full(&test_bus_info); |
862 | rc = PTR_ERR_OR_ZERO(test_bus); | |
a2166ca5 | 863 | unittest(!rc, "testbus registration failed; rc=%i\n", rc); |
716e1d49 | 864 | if (rc) |
fb2caa50 | 865 | return; |
37791b6f | 866 | test_bus->dev.of_node = np; |
fb2caa50 | 867 | |
d2329fb5 GL |
868 | /* |
869 | * Add a dummy resource to the test bus node after it is | |
870 | * registered to catch problems with un-inserted resources. The | |
871 | * DT code doesn't insert the resources, and it has caused the | |
872 | * kernel to oops in the past. This makes sure the same bug | |
873 | * doesn't crop up again. | |
874 | */ | |
875 | platform_device_add_resources(test_bus, &test_bus_res, 1); | |
876 | ||
37791b6f | 877 | of_platform_populate(np, match, NULL, &test_bus->dev); |
fb2caa50 | 878 | for_each_child_of_node(np, child) { |
fb2caa50 | 879 | for_each_child_of_node(child, grandchild) |
9697a559 | 880 | unittest(of_find_device_by_node(grandchild), |
fb2caa50 RH |
881 | "Could not create device for node '%s'\n", |
882 | grandchild->name); | |
883 | } | |
851da976 | 884 | |
37791b6f | 885 | of_platform_depopulate(&test_bus->dev); |
851da976 GL |
886 | for_each_child_of_node(np, child) { |
887 | for_each_child_of_node(child, grandchild) | |
9697a559 | 888 | unittest(!of_find_device_by_node(grandchild), |
851da976 GL |
889 | "device didn't get destroyed '%s'\n", |
890 | grandchild->name); | |
891 | } | |
892 | ||
37791b6f | 893 | platform_device_unregister(test_bus); |
851da976 | 894 | of_node_put(np); |
82c0f589 RH |
895 | } |
896 | ||
ae9304c9 GM |
897 | /** |
898 | * update_node_properties - adds the properties | |
899 | * of np into dup node (present in live tree) and | |
900 | * updates parent of children of np to dup. | |
901 | * | |
902 | * @np: node already present in live tree | |
903 | * @dup: node present in live tree to be updated | |
904 | */ | |
905 | static void update_node_properties(struct device_node *np, | |
906 | struct device_node *dup) | |
907 | { | |
908 | struct property *prop; | |
909 | struct device_node *child; | |
910 | ||
911 | for_each_property_of_node(np, prop) | |
912 | of_add_property(dup, prop); | |
913 | ||
914 | for_each_child_of_node(np, child) | |
915 | child->parent = dup; | |
916 | } | |
917 | ||
918 | /** | |
919 | * attach_node_and_children - attaches nodes | |
920 | * and its children to live tree | |
921 | * | |
922 | * @np: Node to attach to live tree | |
923 | */ | |
924 | static int attach_node_and_children(struct device_node *np) | |
925 | { | |
5063e25a | 926 | struct device_node *next, *dup, *child; |
3ce04b4a | 927 | unsigned long flags; |
0d638a07 | 928 | const char *full_name; |
ae9304c9 | 929 | |
0d638a07 RH |
930 | full_name = kasprintf(GFP_KERNEL, "%pOF", np); |
931 | dup = of_find_node_by_path(full_name); | |
932 | kfree(full_name); | |
5063e25a GL |
933 | if (dup) { |
934 | update_node_properties(np, dup); | |
935 | return 0; | |
936 | } | |
ae9304c9 | 937 | |
5063e25a GL |
938 | child = np->child; |
939 | np->child = NULL; | |
3ce04b4a GM |
940 | |
941 | mutex_lock(&of_mutex); | |
942 | raw_spin_lock_irqsave(&devtree_lock, flags); | |
943 | np->sibling = np->parent->child; | |
944 | np->parent->child = np; | |
945 | of_node_clear_flag(np, OF_DETACHED); | |
946 | raw_spin_unlock_irqrestore(&devtree_lock, flags); | |
947 | ||
948 | __of_attach_node_sysfs(np); | |
949 | mutex_unlock(&of_mutex); | |
950 | ||
5063e25a GL |
951 | while (child) { |
952 | next = child->sibling; | |
953 | attach_node_and_children(child); | |
954 | child = next; | |
ae9304c9 GM |
955 | } |
956 | ||
957 | return 0; | |
958 | } | |
959 | ||
960 | /** | |
9697a559 | 961 | * unittest_data_add - Reads, copies data from |
ae9304c9 GM |
962 | * linked tree and attaches it to the live tree |
963 | */ | |
9697a559 | 964 | static int __init unittest_data_add(void) |
ae9304c9 | 965 | { |
9697a559 WL |
966 | void *unittest_data; |
967 | struct device_node *unittest_data_node, *np; | |
c8547119 FR |
968 | /* |
969 | * __dtb_testcases_begin[] and __dtb_testcases_end[] are magically | |
970 | * created by cmd_dt_S_dtb in scripts/Makefile.lib | |
971 | */ | |
ae9304c9 GM |
972 | extern uint8_t __dtb_testcases_begin[]; |
973 | extern uint8_t __dtb_testcases_end[]; | |
974 | const int size = __dtb_testcases_end - __dtb_testcases_begin; | |
2eb46da2 | 975 | int rc; |
ae9304c9 | 976 | |
b951f9dc | 977 | if (!size) { |
ae9304c9 GM |
978 | pr_warn("%s: No testcase data to attach; not running tests\n", |
979 | __func__); | |
980 | return -ENODATA; | |
981 | } | |
982 | ||
983 | /* creating copy */ | |
9697a559 | 984 | unittest_data = kmemdup(__dtb_testcases_begin, size, GFP_KERNEL); |
ae9304c9 | 985 | |
9697a559 WL |
986 | if (!unittest_data) { |
987 | pr_warn("%s: Failed to allocate memory for unittest_data; " | |
ae9304c9 GM |
988 | "not running tests\n", __func__); |
989 | return -ENOMEM; | |
990 | } | |
c4263233 | 991 | of_fdt_unflatten_tree(unittest_data, NULL, &unittest_data_node); |
9697a559 | 992 | if (!unittest_data_node) { |
b951f9dc GM |
993 | pr_warn("%s: No tree to attach; not running tests\n", __func__); |
994 | return -ENODATA; | |
995 | } | |
9697a559 WL |
996 | of_node_set_flag(unittest_data_node, OF_DETACHED); |
997 | rc = of_resolve_phandles(unittest_data_node); | |
2eb46da2 GL |
998 | if (rc) { |
999 | pr_err("%s: Failed to resolve phandles (rc=%i)\n", __func__, rc); | |
1000 | return -EINVAL; | |
1001 | } | |
b951f9dc | 1002 | |
5063e25a | 1003 | if (!of_root) { |
9697a559 | 1004 | of_root = unittest_data_node; |
b951f9dc GM |
1005 | for_each_of_allnodes(np) |
1006 | __of_attach_node_sysfs(np); | |
1007 | of_aliases = of_find_node_by_path("/aliases"); | |
1008 | of_chosen = of_find_node_by_path("/chosen"); | |
1009 | return 0; | |
1010 | } | |
ae9304c9 GM |
1011 | |
1012 | /* attach the sub-tree to live tree */ | |
9697a559 | 1013 | np = unittest_data_node->child; |
5063e25a GL |
1014 | while (np) { |
1015 | struct device_node *next = np->sibling; | |
3db316d0 | 1016 | |
5063e25a GL |
1017 | np->parent = of_root; |
1018 | attach_node_and_children(np); | |
1019 | np = next; | |
1020 | } | |
1021 | return 0; | |
ae9304c9 GM |
1022 | } |
1023 | ||
177d271c PA |
1024 | #ifdef CONFIG_OF_OVERLAY |
1025 | ||
9697a559 | 1026 | static int unittest_probe(struct platform_device *pdev) |
177d271c PA |
1027 | { |
1028 | struct device *dev = &pdev->dev; | |
1029 | struct device_node *np = dev->of_node; | |
1030 | ||
1031 | if (np == NULL) { | |
1032 | dev_err(dev, "No OF data for device\n"); | |
1033 | return -EINVAL; | |
1034 | ||
1035 | } | |
1036 | ||
0d638a07 | 1037 | dev_dbg(dev, "%s for node @%pOF\n", __func__, np); |
6b1271de PA |
1038 | |
1039 | of_platform_populate(np, NULL, NULL, &pdev->dev); | |
1040 | ||
177d271c PA |
1041 | return 0; |
1042 | } | |
1043 | ||
9697a559 | 1044 | static int unittest_remove(struct platform_device *pdev) |
177d271c PA |
1045 | { |
1046 | struct device *dev = &pdev->dev; | |
1047 | struct device_node *np = dev->of_node; | |
1048 | ||
0d638a07 | 1049 | dev_dbg(dev, "%s for node @%pOF\n", __func__, np); |
177d271c PA |
1050 | return 0; |
1051 | } | |
1052 | ||
a2166ca5 | 1053 | static const struct of_device_id unittest_match[] = { |
9697a559 | 1054 | { .compatible = "unittest", }, |
177d271c PA |
1055 | {}, |
1056 | }; | |
177d271c | 1057 | |
9697a559 WL |
1058 | static struct platform_driver unittest_driver = { |
1059 | .probe = unittest_probe, | |
1060 | .remove = unittest_remove, | |
177d271c | 1061 | .driver = { |
9697a559 | 1062 | .name = "unittest", |
9697a559 | 1063 | .of_match_table = of_match_ptr(unittest_match), |
177d271c PA |
1064 | }, |
1065 | }; | |
1066 | ||
1067 | /* get the platform device instantiated at the path */ | |
1068 | static struct platform_device *of_path_to_platform_device(const char *path) | |
1069 | { | |
1070 | struct device_node *np; | |
1071 | struct platform_device *pdev; | |
1072 | ||
1073 | np = of_find_node_by_path(path); | |
1074 | if (np == NULL) | |
1075 | return NULL; | |
1076 | ||
1077 | pdev = of_find_device_by_node(np); | |
1078 | of_node_put(np); | |
1079 | ||
1080 | return pdev; | |
1081 | } | |
1082 | ||
1083 | /* find out if a platform device exists at that path */ | |
1084 | static int of_path_platform_device_exists(const char *path) | |
1085 | { | |
1086 | struct platform_device *pdev; | |
1087 | ||
1088 | pdev = of_path_to_platform_device(path); | |
1089 | platform_device_put(pdev); | |
1090 | return pdev != NULL; | |
1091 | } | |
1092 | ||
4252de39 | 1093 | #if IS_BUILTIN(CONFIG_I2C) |
d5e75500 PA |
1094 | |
1095 | /* get the i2c client device instantiated at the path */ | |
1096 | static struct i2c_client *of_path_to_i2c_client(const char *path) | |
1097 | { | |
1098 | struct device_node *np; | |
1099 | struct i2c_client *client; | |
1100 | ||
1101 | np = of_find_node_by_path(path); | |
1102 | if (np == NULL) | |
1103 | return NULL; | |
1104 | ||
1105 | client = of_find_i2c_device_by_node(np); | |
1106 | of_node_put(np); | |
1107 | ||
1108 | return client; | |
1109 | } | |
1110 | ||
1111 | /* find out if a i2c client device exists at that path */ | |
1112 | static int of_path_i2c_client_exists(const char *path) | |
1113 | { | |
1114 | struct i2c_client *client; | |
1115 | ||
1116 | client = of_path_to_i2c_client(path); | |
1117 | if (client) | |
1118 | put_device(&client->dev); | |
1119 | return client != NULL; | |
1120 | } | |
1121 | #else | |
1122 | static int of_path_i2c_client_exists(const char *path) | |
1123 | { | |
1124 | return 0; | |
1125 | } | |
1126 | #endif | |
1127 | ||
1128 | enum overlay_type { | |
1129 | PDEV_OVERLAY, | |
1130 | I2C_OVERLAY | |
1131 | }; | |
1132 | ||
1133 | static int of_path_device_type_exists(const char *path, | |
1134 | enum overlay_type ovtype) | |
177d271c | 1135 | { |
d5e75500 PA |
1136 | switch (ovtype) { |
1137 | case PDEV_OVERLAY: | |
1138 | return of_path_platform_device_exists(path); | |
1139 | case I2C_OVERLAY: | |
1140 | return of_path_i2c_client_exists(path); | |
1141 | } | |
1142 | return 0; | |
1143 | } | |
1144 | ||
9697a559 | 1145 | static const char *unittest_path(int nr, enum overlay_type ovtype) |
d5e75500 PA |
1146 | { |
1147 | const char *base; | |
177d271c PA |
1148 | static char buf[256]; |
1149 | ||
d5e75500 PA |
1150 | switch (ovtype) { |
1151 | case PDEV_OVERLAY: | |
1152 | base = "/testcase-data/overlay-node/test-bus"; | |
1153 | break; | |
1154 | case I2C_OVERLAY: | |
1155 | base = "/testcase-data/overlay-node/test-bus/i2c-test-bus"; | |
1156 | break; | |
1157 | default: | |
1158 | buf[0] = '\0'; | |
1159 | return buf; | |
1160 | } | |
9697a559 | 1161 | snprintf(buf, sizeof(buf) - 1, "%s/test-unittest%d", base, nr); |
177d271c | 1162 | buf[sizeof(buf) - 1] = '\0'; |
177d271c PA |
1163 | return buf; |
1164 | } | |
1165 | ||
9697a559 | 1166 | static int of_unittest_device_exists(int unittest_nr, enum overlay_type ovtype) |
d5e75500 PA |
1167 | { |
1168 | const char *path; | |
1169 | ||
9697a559 | 1170 | path = unittest_path(unittest_nr, ovtype); |
d5e75500 PA |
1171 | |
1172 | switch (ovtype) { | |
1173 | case PDEV_OVERLAY: | |
1174 | return of_path_platform_device_exists(path); | |
1175 | case I2C_OVERLAY: | |
1176 | return of_path_i2c_client_exists(path); | |
1177 | } | |
1178 | return 0; | |
1179 | } | |
1180 | ||
177d271c PA |
1181 | static const char *overlay_path(int nr) |
1182 | { | |
1183 | static char buf[256]; | |
1184 | ||
1185 | snprintf(buf, sizeof(buf) - 1, | |
1186 | "/testcase-data/overlay%d", nr); | |
1187 | buf[sizeof(buf) - 1] = '\0'; | |
1188 | ||
1189 | return buf; | |
1190 | } | |
1191 | ||
1192 | static const char *bus_path = "/testcase-data/overlay-node/test-bus"; | |
1193 | ||
492a22ac PA |
1194 | /* it is guaranteed that overlay ids are assigned in sequence */ |
1195 | #define MAX_UNITTEST_OVERLAYS 256 | |
1196 | static unsigned long overlay_id_bits[BITS_TO_LONGS(MAX_UNITTEST_OVERLAYS)]; | |
1197 | static int overlay_first_id = -1; | |
1198 | ||
1199 | static void of_unittest_track_overlay(int id) | |
1200 | { | |
1201 | if (overlay_first_id < 0) | |
1202 | overlay_first_id = id; | |
1203 | id -= overlay_first_id; | |
1204 | ||
1205 | /* we shouldn't need that many */ | |
1206 | BUG_ON(id >= MAX_UNITTEST_OVERLAYS); | |
1207 | overlay_id_bits[BIT_WORD(id)] |= BIT_MASK(id); | |
1208 | } | |
1209 | ||
1210 | static void of_unittest_untrack_overlay(int id) | |
1211 | { | |
1212 | if (overlay_first_id < 0) | |
1213 | return; | |
1214 | id -= overlay_first_id; | |
1215 | BUG_ON(id >= MAX_UNITTEST_OVERLAYS); | |
1216 | overlay_id_bits[BIT_WORD(id)] &= ~BIT_MASK(id); | |
1217 | } | |
1218 | ||
1219 | static void of_unittest_destroy_tracked_overlays(void) | |
1220 | { | |
1221 | int id, ret, defers; | |
1222 | ||
1223 | if (overlay_first_id < 0) | |
1224 | return; | |
1225 | ||
1226 | /* try until no defers */ | |
1227 | do { | |
1228 | defers = 0; | |
1229 | /* remove in reverse order */ | |
1230 | for (id = MAX_UNITTEST_OVERLAYS - 1; id >= 0; id--) { | |
1231 | if (!(overlay_id_bits[BIT_WORD(id)] & BIT_MASK(id))) | |
1232 | continue; | |
1233 | ||
1234 | ret = of_overlay_destroy(id + overlay_first_id); | |
815d74b3 SS |
1235 | if (ret == -ENODEV) { |
1236 | pr_warn("%s: no overlay to destroy for #%d\n", | |
1237 | __func__, id + overlay_first_id); | |
1238 | continue; | |
1239 | } | |
492a22ac PA |
1240 | if (ret != 0) { |
1241 | defers++; | |
1242 | pr_warn("%s: overlay destroy failed for #%d\n", | |
1243 | __func__, id + overlay_first_id); | |
1244 | continue; | |
1245 | } | |
1246 | ||
1247 | overlay_id_bits[BIT_WORD(id)] &= ~BIT_MASK(id); | |
1248 | } | |
1249 | } while (defers > 0); | |
1250 | } | |
1251 | ||
ca7b8964 | 1252 | static int of_unittest_apply_overlay(int overlay_nr, int unittest_nr, |
177d271c PA |
1253 | int *overlay_id) |
1254 | { | |
1255 | struct device_node *np = NULL; | |
1256 | int ret, id = -1; | |
1257 | ||
1258 | np = of_find_node_by_path(overlay_path(overlay_nr)); | |
1259 | if (np == NULL) { | |
9697a559 | 1260 | unittest(0, "could not find overlay node @\"%s\"\n", |
177d271c PA |
1261 | overlay_path(overlay_nr)); |
1262 | ret = -EINVAL; | |
1263 | goto out; | |
1264 | } | |
1265 | ||
1266 | ret = of_overlay_create(np); | |
1267 | if (ret < 0) { | |
9697a559 | 1268 | unittest(0, "could not create overlay from \"%s\"\n", |
177d271c PA |
1269 | overlay_path(overlay_nr)); |
1270 | goto out; | |
1271 | } | |
1272 | id = ret; | |
492a22ac | 1273 | of_unittest_track_overlay(id); |
177d271c PA |
1274 | |
1275 | ret = 0; | |
1276 | ||
1277 | out: | |
1278 | of_node_put(np); | |
1279 | ||
1280 | if (overlay_id) | |
1281 | *overlay_id = id; | |
1282 | ||
1283 | return ret; | |
1284 | } | |
1285 | ||
1286 | /* apply an overlay while checking before and after states */ | |
9697a559 | 1287 | static int of_unittest_apply_overlay_check(int overlay_nr, int unittest_nr, |
d5e75500 | 1288 | int before, int after, enum overlay_type ovtype) |
177d271c PA |
1289 | { |
1290 | int ret; | |
1291 | ||
9697a559 WL |
1292 | /* unittest device must not be in before state */ |
1293 | if (of_unittest_device_exists(unittest_nr, ovtype) != before) { | |
1294 | unittest(0, "overlay @\"%s\" with device @\"%s\" %s\n", | |
177d271c | 1295 | overlay_path(overlay_nr), |
9697a559 | 1296 | unittest_path(unittest_nr, ovtype), |
177d271c PA |
1297 | !before ? "enabled" : "disabled"); |
1298 | return -EINVAL; | |
1299 | } | |
1300 | ||
9697a559 | 1301 | ret = of_unittest_apply_overlay(overlay_nr, unittest_nr, NULL); |
177d271c | 1302 | if (ret != 0) { |
9697a559 | 1303 | /* of_unittest_apply_overlay already called unittest() */ |
177d271c PA |
1304 | return ret; |
1305 | } | |
1306 | ||
9697a559 WL |
1307 | /* unittest device must be to set to after state */ |
1308 | if (of_unittest_device_exists(unittest_nr, ovtype) != after) { | |
1309 | unittest(0, "overlay @\"%s\" failed to create @\"%s\" %s\n", | |
177d271c | 1310 | overlay_path(overlay_nr), |
9697a559 | 1311 | unittest_path(unittest_nr, ovtype), |
177d271c PA |
1312 | !after ? "enabled" : "disabled"); |
1313 | return -EINVAL; | |
1314 | } | |
1315 | ||
1316 | return 0; | |
1317 | } | |
1318 | ||
1319 | /* apply an overlay and then revert it while checking before, after states */ | |
9697a559 WL |
1320 | static int of_unittest_apply_revert_overlay_check(int overlay_nr, |
1321 | int unittest_nr, int before, int after, | |
d5e75500 | 1322 | enum overlay_type ovtype) |
177d271c PA |
1323 | { |
1324 | int ret, ov_id; | |
1325 | ||
9697a559 WL |
1326 | /* unittest device must be in before state */ |
1327 | if (of_unittest_device_exists(unittest_nr, ovtype) != before) { | |
1328 | unittest(0, "overlay @\"%s\" with device @\"%s\" %s\n", | |
177d271c | 1329 | overlay_path(overlay_nr), |
9697a559 | 1330 | unittest_path(unittest_nr, ovtype), |
177d271c PA |
1331 | !before ? "enabled" : "disabled"); |
1332 | return -EINVAL; | |
1333 | } | |
1334 | ||
1335 | /* apply the overlay */ | |
9697a559 | 1336 | ret = of_unittest_apply_overlay(overlay_nr, unittest_nr, &ov_id); |
177d271c | 1337 | if (ret != 0) { |
9697a559 | 1338 | /* of_unittest_apply_overlay already called unittest() */ |
177d271c PA |
1339 | return ret; |
1340 | } | |
1341 | ||
9697a559 WL |
1342 | /* unittest device must be in after state */ |
1343 | if (of_unittest_device_exists(unittest_nr, ovtype) != after) { | |
1344 | unittest(0, "overlay @\"%s\" failed to create @\"%s\" %s\n", | |
177d271c | 1345 | overlay_path(overlay_nr), |
9697a559 | 1346 | unittest_path(unittest_nr, ovtype), |
177d271c PA |
1347 | !after ? "enabled" : "disabled"); |
1348 | return -EINVAL; | |
1349 | } | |
1350 | ||
1351 | ret = of_overlay_destroy(ov_id); | |
1352 | if (ret != 0) { | |
9697a559 | 1353 | unittest(0, "overlay @\"%s\" failed to be destroyed @\"%s\"\n", |
177d271c | 1354 | overlay_path(overlay_nr), |
9697a559 | 1355 | unittest_path(unittest_nr, ovtype)); |
177d271c PA |
1356 | return ret; |
1357 | } | |
1358 | ||
9697a559 WL |
1359 | /* unittest device must be again in before state */ |
1360 | if (of_unittest_device_exists(unittest_nr, PDEV_OVERLAY) != before) { | |
1361 | unittest(0, "overlay @\"%s\" with device @\"%s\" %s\n", | |
177d271c | 1362 | overlay_path(overlay_nr), |
9697a559 | 1363 | unittest_path(unittest_nr, ovtype), |
177d271c PA |
1364 | !before ? "enabled" : "disabled"); |
1365 | return -EINVAL; | |
1366 | } | |
1367 | ||
1368 | return 0; | |
1369 | } | |
1370 | ||
1371 | /* test activation of device */ | |
9697a559 | 1372 | static void of_unittest_overlay_0(void) |
177d271c PA |
1373 | { |
1374 | int ret; | |
1375 | ||
1376 | /* device should enable */ | |
9697a559 | 1377 | ret = of_unittest_apply_overlay_check(0, 0, 0, 1, PDEV_OVERLAY); |
177d271c PA |
1378 | if (ret != 0) |
1379 | return; | |
1380 | ||
9697a559 | 1381 | unittest(1, "overlay test %d passed\n", 0); |
177d271c PA |
1382 | } |
1383 | ||
1384 | /* test deactivation of device */ | |
9697a559 | 1385 | static void of_unittest_overlay_1(void) |
177d271c PA |
1386 | { |
1387 | int ret; | |
1388 | ||
1389 | /* device should disable */ | |
9697a559 | 1390 | ret = of_unittest_apply_overlay_check(1, 1, 1, 0, PDEV_OVERLAY); |
177d271c PA |
1391 | if (ret != 0) |
1392 | return; | |
1393 | ||
9697a559 | 1394 | unittest(1, "overlay test %d passed\n", 1); |
177d271c PA |
1395 | } |
1396 | ||
1397 | /* test activation of device */ | |
9697a559 | 1398 | static void of_unittest_overlay_2(void) |
177d271c PA |
1399 | { |
1400 | int ret; | |
1401 | ||
1402 | /* device should enable */ | |
9697a559 | 1403 | ret = of_unittest_apply_overlay_check(2, 2, 0, 1, PDEV_OVERLAY); |
177d271c PA |
1404 | if (ret != 0) |
1405 | return; | |
1406 | ||
9697a559 | 1407 | unittest(1, "overlay test %d passed\n", 2); |
177d271c PA |
1408 | } |
1409 | ||
1410 | /* test deactivation of device */ | |
9697a559 | 1411 | static void of_unittest_overlay_3(void) |
177d271c PA |
1412 | { |
1413 | int ret; | |
1414 | ||
1415 | /* device should disable */ | |
9697a559 | 1416 | ret = of_unittest_apply_overlay_check(3, 3, 1, 0, PDEV_OVERLAY); |
177d271c PA |
1417 | if (ret != 0) |
1418 | return; | |
1419 | ||
9697a559 | 1420 | unittest(1, "overlay test %d passed\n", 3); |
177d271c PA |
1421 | } |
1422 | ||
1423 | /* test activation of a full device node */ | |
9697a559 | 1424 | static void of_unittest_overlay_4(void) |
177d271c PA |
1425 | { |
1426 | int ret; | |
1427 | ||
1428 | /* device should disable */ | |
9697a559 | 1429 | ret = of_unittest_apply_overlay_check(4, 4, 0, 1, PDEV_OVERLAY); |
177d271c PA |
1430 | if (ret != 0) |
1431 | return; | |
1432 | ||
9697a559 | 1433 | unittest(1, "overlay test %d passed\n", 4); |
177d271c PA |
1434 | } |
1435 | ||
1436 | /* test overlay apply/revert sequence */ | |
9697a559 | 1437 | static void of_unittest_overlay_5(void) |
177d271c PA |
1438 | { |
1439 | int ret; | |
1440 | ||
1441 | /* device should disable */ | |
9697a559 | 1442 | ret = of_unittest_apply_revert_overlay_check(5, 5, 0, 1, PDEV_OVERLAY); |
177d271c PA |
1443 | if (ret != 0) |
1444 | return; | |
1445 | ||
9697a559 | 1446 | unittest(1, "overlay test %d passed\n", 5); |
177d271c PA |
1447 | } |
1448 | ||
1449 | /* test overlay application in sequence */ | |
9697a559 | 1450 | static void of_unittest_overlay_6(void) |
177d271c PA |
1451 | { |
1452 | struct device_node *np; | |
1453 | int ret, i, ov_id[2]; | |
9697a559 | 1454 | int overlay_nr = 6, unittest_nr = 6; |
177d271c PA |
1455 | int before = 0, after = 1; |
1456 | ||
9697a559 | 1457 | /* unittest device must be in before state */ |
177d271c | 1458 | for (i = 0; i < 2; i++) { |
9697a559 | 1459 | if (of_unittest_device_exists(unittest_nr + i, PDEV_OVERLAY) |
177d271c | 1460 | != before) { |
9697a559 | 1461 | unittest(0, "overlay @\"%s\" with device @\"%s\" %s\n", |
177d271c | 1462 | overlay_path(overlay_nr + i), |
9697a559 | 1463 | unittest_path(unittest_nr + i, |
d5e75500 | 1464 | PDEV_OVERLAY), |
177d271c PA |
1465 | !before ? "enabled" : "disabled"); |
1466 | return; | |
1467 | } | |
1468 | } | |
1469 | ||
1470 | /* apply the overlays */ | |
1471 | for (i = 0; i < 2; i++) { | |
1472 | ||
1473 | np = of_find_node_by_path(overlay_path(overlay_nr + i)); | |
1474 | if (np == NULL) { | |
9697a559 | 1475 | unittest(0, "could not find overlay node @\"%s\"\n", |
177d271c PA |
1476 | overlay_path(overlay_nr + i)); |
1477 | return; | |
1478 | } | |
1479 | ||
1480 | ret = of_overlay_create(np); | |
1481 | if (ret < 0) { | |
9697a559 | 1482 | unittest(0, "could not create overlay from \"%s\"\n", |
177d271c PA |
1483 | overlay_path(overlay_nr + i)); |
1484 | return; | |
1485 | } | |
1486 | ov_id[i] = ret; | |
492a22ac | 1487 | of_unittest_track_overlay(ov_id[i]); |
177d271c PA |
1488 | } |
1489 | ||
1490 | for (i = 0; i < 2; i++) { | |
9697a559 WL |
1491 | /* unittest device must be in after state */ |
1492 | if (of_unittest_device_exists(unittest_nr + i, PDEV_OVERLAY) | |
177d271c | 1493 | != after) { |
9697a559 | 1494 | unittest(0, "overlay @\"%s\" failed @\"%s\" %s\n", |
177d271c | 1495 | overlay_path(overlay_nr + i), |
9697a559 | 1496 | unittest_path(unittest_nr + i, |
d5e75500 | 1497 | PDEV_OVERLAY), |
177d271c PA |
1498 | !after ? "enabled" : "disabled"); |
1499 | return; | |
1500 | } | |
1501 | } | |
1502 | ||
1503 | for (i = 1; i >= 0; i--) { | |
1504 | ret = of_overlay_destroy(ov_id[i]); | |
1505 | if (ret != 0) { | |
9697a559 | 1506 | unittest(0, "overlay @\"%s\" failed destroy @\"%s\"\n", |
177d271c | 1507 | overlay_path(overlay_nr + i), |
9697a559 | 1508 | unittest_path(unittest_nr + i, |
d5e75500 | 1509 | PDEV_OVERLAY)); |
177d271c PA |
1510 | return; |
1511 | } | |
492a22ac | 1512 | of_unittest_untrack_overlay(ov_id[i]); |
177d271c PA |
1513 | } |
1514 | ||
1515 | for (i = 0; i < 2; i++) { | |
9697a559 WL |
1516 | /* unittest device must be again in before state */ |
1517 | if (of_unittest_device_exists(unittest_nr + i, PDEV_OVERLAY) | |
177d271c | 1518 | != before) { |
9697a559 | 1519 | unittest(0, "overlay @\"%s\" with device @\"%s\" %s\n", |
177d271c | 1520 | overlay_path(overlay_nr + i), |
9697a559 | 1521 | unittest_path(unittest_nr + i, |
d5e75500 | 1522 | PDEV_OVERLAY), |
177d271c PA |
1523 | !before ? "enabled" : "disabled"); |
1524 | return; | |
1525 | } | |
1526 | } | |
1527 | ||
9697a559 | 1528 | unittest(1, "overlay test %d passed\n", 6); |
177d271c PA |
1529 | } |
1530 | ||
1531 | /* test overlay application in sequence */ | |
9697a559 | 1532 | static void of_unittest_overlay_8(void) |
177d271c PA |
1533 | { |
1534 | struct device_node *np; | |
1535 | int ret, i, ov_id[2]; | |
9697a559 | 1536 | int overlay_nr = 8, unittest_nr = 8; |
177d271c PA |
1537 | |
1538 | /* we don't care about device state in this test */ | |
1539 | ||
1540 | /* apply the overlays */ | |
1541 | for (i = 0; i < 2; i++) { | |
1542 | ||
1543 | np = of_find_node_by_path(overlay_path(overlay_nr + i)); | |
1544 | if (np == NULL) { | |
9697a559 | 1545 | unittest(0, "could not find overlay node @\"%s\"\n", |
177d271c PA |
1546 | overlay_path(overlay_nr + i)); |
1547 | return; | |
1548 | } | |
1549 | ||
1550 | ret = of_overlay_create(np); | |
1551 | if (ret < 0) { | |
9697a559 | 1552 | unittest(0, "could not create overlay from \"%s\"\n", |
177d271c PA |
1553 | overlay_path(overlay_nr + i)); |
1554 | return; | |
1555 | } | |
1556 | ov_id[i] = ret; | |
492a22ac | 1557 | of_unittest_track_overlay(ov_id[i]); |
177d271c PA |
1558 | } |
1559 | ||
1560 | /* now try to remove first overlay (it should fail) */ | |
1561 | ret = of_overlay_destroy(ov_id[0]); | |
1562 | if (ret == 0) { | |
9697a559 | 1563 | unittest(0, "overlay @\"%s\" was destroyed @\"%s\"\n", |
177d271c | 1564 | overlay_path(overlay_nr + 0), |
9697a559 | 1565 | unittest_path(unittest_nr, |
d5e75500 | 1566 | PDEV_OVERLAY)); |
177d271c PA |
1567 | return; |
1568 | } | |
1569 | ||
1570 | /* removing them in order should work */ | |
1571 | for (i = 1; i >= 0; i--) { | |
1572 | ret = of_overlay_destroy(ov_id[i]); | |
1573 | if (ret != 0) { | |
9697a559 | 1574 | unittest(0, "overlay @\"%s\" not destroyed @\"%s\"\n", |
177d271c | 1575 | overlay_path(overlay_nr + i), |
9697a559 | 1576 | unittest_path(unittest_nr, |
d5e75500 | 1577 | PDEV_OVERLAY)); |
177d271c PA |
1578 | return; |
1579 | } | |
492a22ac | 1580 | of_unittest_untrack_overlay(ov_id[i]); |
177d271c PA |
1581 | } |
1582 | ||
9697a559 | 1583 | unittest(1, "overlay test %d passed\n", 8); |
177d271c PA |
1584 | } |
1585 | ||
6b1271de | 1586 | /* test insertion of a bus with parent devices */ |
9697a559 | 1587 | static void of_unittest_overlay_10(void) |
6b1271de PA |
1588 | { |
1589 | int ret; | |
1590 | char *child_path; | |
1591 | ||
1592 | /* device should disable */ | |
9697a559 WL |
1593 | ret = of_unittest_apply_overlay_check(10, 10, 0, 1, PDEV_OVERLAY); |
1594 | if (unittest(ret == 0, | |
d5e75500 | 1595 | "overlay test %d failed; overlay application\n", 10)) |
6b1271de PA |
1596 | return; |
1597 | ||
9697a559 WL |
1598 | child_path = kasprintf(GFP_KERNEL, "%s/test-unittest101", |
1599 | unittest_path(10, PDEV_OVERLAY)); | |
1600 | if (unittest(child_path, "overlay test %d failed; kasprintf\n", 10)) | |
6b1271de PA |
1601 | return; |
1602 | ||
d5e75500 | 1603 | ret = of_path_device_type_exists(child_path, PDEV_OVERLAY); |
6b1271de | 1604 | kfree(child_path); |
9697a559 | 1605 | if (unittest(ret, "overlay test %d failed; no child device\n", 10)) |
6b1271de PA |
1606 | return; |
1607 | } | |
1608 | ||
1609 | /* test insertion of a bus with parent devices (and revert) */ | |
9697a559 | 1610 | static void of_unittest_overlay_11(void) |
6b1271de PA |
1611 | { |
1612 | int ret; | |
1613 | ||
1614 | /* device should disable */ | |
9697a559 | 1615 | ret = of_unittest_apply_revert_overlay_check(11, 11, 0, 1, |
d5e75500 | 1616 | PDEV_OVERLAY); |
9697a559 | 1617 | if (unittest(ret == 0, |
d5e75500 PA |
1618 | "overlay test %d failed; overlay application\n", 11)) |
1619 | return; | |
1620 | } | |
1621 | ||
4252de39 | 1622 | #if IS_BUILTIN(CONFIG_I2C) && IS_ENABLED(CONFIG_OF_OVERLAY) |
d5e75500 | 1623 | |
9697a559 | 1624 | struct unittest_i2c_bus_data { |
d5e75500 PA |
1625 | struct platform_device *pdev; |
1626 | struct i2c_adapter adap; | |
1627 | }; | |
1628 | ||
9697a559 | 1629 | static int unittest_i2c_master_xfer(struct i2c_adapter *adap, |
d5e75500 PA |
1630 | struct i2c_msg *msgs, int num) |
1631 | { | |
9697a559 | 1632 | struct unittest_i2c_bus_data *std = i2c_get_adapdata(adap); |
d5e75500 PA |
1633 | |
1634 | (void)std; | |
1635 | ||
1636 | return num; | |
1637 | } | |
1638 | ||
9697a559 | 1639 | static u32 unittest_i2c_functionality(struct i2c_adapter *adap) |
d5e75500 PA |
1640 | { |
1641 | return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; | |
1642 | } | |
1643 | ||
9697a559 WL |
1644 | static const struct i2c_algorithm unittest_i2c_algo = { |
1645 | .master_xfer = unittest_i2c_master_xfer, | |
1646 | .functionality = unittest_i2c_functionality, | |
d5e75500 PA |
1647 | }; |
1648 | ||
9697a559 | 1649 | static int unittest_i2c_bus_probe(struct platform_device *pdev) |
d5e75500 PA |
1650 | { |
1651 | struct device *dev = &pdev->dev; | |
1652 | struct device_node *np = dev->of_node; | |
9697a559 | 1653 | struct unittest_i2c_bus_data *std; |
d5e75500 PA |
1654 | struct i2c_adapter *adap; |
1655 | int ret; | |
1656 | ||
1657 | if (np == NULL) { | |
1658 | dev_err(dev, "No OF data for device\n"); | |
1659 | return -EINVAL; | |
1660 | ||
1661 | } | |
1662 | ||
0d638a07 | 1663 | dev_dbg(dev, "%s for node @%pOF\n", __func__, np); |
d5e75500 PA |
1664 | |
1665 | std = devm_kzalloc(dev, sizeof(*std), GFP_KERNEL); | |
1666 | if (!std) { | |
9697a559 | 1667 | dev_err(dev, "Failed to allocate unittest i2c data\n"); |
d5e75500 PA |
1668 | return -ENOMEM; |
1669 | } | |
1670 | ||
1671 | /* link them together */ | |
1672 | std->pdev = pdev; | |
1673 | platform_set_drvdata(pdev, std); | |
1674 | ||
1675 | adap = &std->adap; | |
1676 | i2c_set_adapdata(adap, std); | |
1677 | adap->nr = -1; | |
1678 | strlcpy(adap->name, pdev->name, sizeof(adap->name)); | |
1679 | adap->class = I2C_CLASS_DEPRECATED; | |
9697a559 | 1680 | adap->algo = &unittest_i2c_algo; |
d5e75500 PA |
1681 | adap->dev.parent = dev; |
1682 | adap->dev.of_node = dev->of_node; | |
1683 | adap->timeout = 5 * HZ; | |
1684 | adap->retries = 3; | |
1685 | ||
1686 | ret = i2c_add_numbered_adapter(adap); | |
1687 | if (ret != 0) { | |
1688 | dev_err(dev, "Failed to add I2C adapter\n"); | |
1689 | return ret; | |
1690 | } | |
1691 | ||
1692 | return 0; | |
1693 | } | |
1694 | ||
9697a559 | 1695 | static int unittest_i2c_bus_remove(struct platform_device *pdev) |
d5e75500 PA |
1696 | { |
1697 | struct device *dev = &pdev->dev; | |
1698 | struct device_node *np = dev->of_node; | |
9697a559 | 1699 | struct unittest_i2c_bus_data *std = platform_get_drvdata(pdev); |
d5e75500 | 1700 | |
0d638a07 | 1701 | dev_dbg(dev, "%s for node @%pOF\n", __func__, np); |
d5e75500 PA |
1702 | i2c_del_adapter(&std->adap); |
1703 | ||
1704 | return 0; | |
1705 | } | |
1706 | ||
a2166ca5 | 1707 | static const struct of_device_id unittest_i2c_bus_match[] = { |
9697a559 | 1708 | { .compatible = "unittest-i2c-bus", }, |
d5e75500 PA |
1709 | {}, |
1710 | }; | |
1711 | ||
9697a559 WL |
1712 | static struct platform_driver unittest_i2c_bus_driver = { |
1713 | .probe = unittest_i2c_bus_probe, | |
1714 | .remove = unittest_i2c_bus_remove, | |
d5e75500 | 1715 | .driver = { |
9697a559 WL |
1716 | .name = "unittest-i2c-bus", |
1717 | .of_match_table = of_match_ptr(unittest_i2c_bus_match), | |
d5e75500 PA |
1718 | }, |
1719 | }; | |
1720 | ||
9697a559 | 1721 | static int unittest_i2c_dev_probe(struct i2c_client *client, |
d5e75500 PA |
1722 | const struct i2c_device_id *id) |
1723 | { | |
1724 | struct device *dev = &client->dev; | |
1725 | struct device_node *np = client->dev.of_node; | |
1726 | ||
1727 | if (!np) { | |
1728 | dev_err(dev, "No OF node\n"); | |
1729 | return -EINVAL; | |
1730 | } | |
1731 | ||
0d638a07 | 1732 | dev_dbg(dev, "%s for node @%pOF\n", __func__, np); |
d5e75500 PA |
1733 | |
1734 | return 0; | |
1735 | }; | |
1736 | ||
9697a559 | 1737 | static int unittest_i2c_dev_remove(struct i2c_client *client) |
d5e75500 PA |
1738 | { |
1739 | struct device *dev = &client->dev; | |
1740 | struct device_node *np = client->dev.of_node; | |
1741 | ||
0d638a07 | 1742 | dev_dbg(dev, "%s for node @%pOF\n", __func__, np); |
d5e75500 PA |
1743 | return 0; |
1744 | } | |
1745 | ||
9697a559 WL |
1746 | static const struct i2c_device_id unittest_i2c_dev_id[] = { |
1747 | { .name = "unittest-i2c-dev" }, | |
d5e75500 PA |
1748 | { } |
1749 | }; | |
1750 | ||
9697a559 | 1751 | static struct i2c_driver unittest_i2c_dev_driver = { |
d5e75500 | 1752 | .driver = { |
9697a559 | 1753 | .name = "unittest-i2c-dev", |
d5e75500 | 1754 | }, |
9697a559 WL |
1755 | .probe = unittest_i2c_dev_probe, |
1756 | .remove = unittest_i2c_dev_remove, | |
1757 | .id_table = unittest_i2c_dev_id, | |
d5e75500 PA |
1758 | }; |
1759 | ||
4252de39 | 1760 | #if IS_BUILTIN(CONFIG_I2C_MUX) |
d5e75500 | 1761 | |
b6e3b717 | 1762 | static int unittest_i2c_mux_select_chan(struct i2c_mux_core *muxc, u32 chan) |
d5e75500 PA |
1763 | { |
1764 | return 0; | |
1765 | } | |
1766 | ||
9697a559 | 1767 | static int unittest_i2c_mux_probe(struct i2c_client *client, |
d5e75500 PA |
1768 | const struct i2c_device_id *id) |
1769 | { | |
b6e3b717 | 1770 | int ret, i, nchans; |
d5e75500 PA |
1771 | struct device *dev = &client->dev; |
1772 | struct i2c_adapter *adap = to_i2c_adapter(dev->parent); | |
1773 | struct device_node *np = client->dev.of_node, *child; | |
b6e3b717 | 1774 | struct i2c_mux_core *muxc; |
d5e75500 PA |
1775 | u32 reg, max_reg; |
1776 | ||
0d638a07 | 1777 | dev_dbg(dev, "%s for node @%pOF\n", __func__, np); |
d5e75500 PA |
1778 | |
1779 | if (!np) { | |
1780 | dev_err(dev, "No OF node\n"); | |
1781 | return -EINVAL; | |
1782 | } | |
1783 | ||
1784 | max_reg = (u32)-1; | |
1785 | for_each_child_of_node(np, child) { | |
1786 | ret = of_property_read_u32(child, "reg", ®); | |
1787 | if (ret) | |
1788 | continue; | |
1789 | if (max_reg == (u32)-1 || reg > max_reg) | |
1790 | max_reg = reg; | |
1791 | } | |
1792 | nchans = max_reg == (u32)-1 ? 0 : max_reg + 1; | |
1793 | if (nchans == 0) { | |
1794 | dev_err(dev, "No channels\n"); | |
1795 | return -EINVAL; | |
1796 | } | |
1797 | ||
b6e3b717 PR |
1798 | muxc = i2c_mux_alloc(adap, dev, nchans, 0, 0, |
1799 | unittest_i2c_mux_select_chan, NULL); | |
1800 | if (!muxc) | |
d5e75500 | 1801 | return -ENOMEM; |
d5e75500 | 1802 | for (i = 0; i < nchans; i++) { |
b6e3b717 PR |
1803 | ret = i2c_mux_add_adapter(muxc, 0, i, 0); |
1804 | if (ret) { | |
d5e75500 | 1805 | dev_err(dev, "Failed to register mux #%d\n", i); |
b6e3b717 | 1806 | i2c_mux_del_adapters(muxc); |
d5e75500 PA |
1807 | return -ENODEV; |
1808 | } | |
1809 | } | |
1810 | ||
b6e3b717 | 1811 | i2c_set_clientdata(client, muxc); |
d5e75500 PA |
1812 | |
1813 | return 0; | |
1814 | }; | |
1815 | ||
9697a559 | 1816 | static int unittest_i2c_mux_remove(struct i2c_client *client) |
d5e75500 PA |
1817 | { |
1818 | struct device *dev = &client->dev; | |
1819 | struct device_node *np = client->dev.of_node; | |
b6e3b717 | 1820 | struct i2c_mux_core *muxc = i2c_get_clientdata(client); |
d5e75500 | 1821 | |
0d638a07 | 1822 | dev_dbg(dev, "%s for node @%pOF\n", __func__, np); |
b6e3b717 | 1823 | i2c_mux_del_adapters(muxc); |
d5e75500 PA |
1824 | return 0; |
1825 | } | |
1826 | ||
9697a559 WL |
1827 | static const struct i2c_device_id unittest_i2c_mux_id[] = { |
1828 | { .name = "unittest-i2c-mux" }, | |
d5e75500 PA |
1829 | { } |
1830 | }; | |
1831 | ||
9697a559 | 1832 | static struct i2c_driver unittest_i2c_mux_driver = { |
d5e75500 | 1833 | .driver = { |
9697a559 | 1834 | .name = "unittest-i2c-mux", |
d5e75500 | 1835 | }, |
9697a559 WL |
1836 | .probe = unittest_i2c_mux_probe, |
1837 | .remove = unittest_i2c_mux_remove, | |
1838 | .id_table = unittest_i2c_mux_id, | |
d5e75500 PA |
1839 | }; |
1840 | ||
1841 | #endif | |
1842 | ||
9697a559 | 1843 | static int of_unittest_overlay_i2c_init(void) |
d5e75500 PA |
1844 | { |
1845 | int ret; | |
1846 | ||
9697a559 WL |
1847 | ret = i2c_add_driver(&unittest_i2c_dev_driver); |
1848 | if (unittest(ret == 0, | |
1849 | "could not register unittest i2c device driver\n")) | |
d5e75500 PA |
1850 | return ret; |
1851 | ||
9697a559 WL |
1852 | ret = platform_driver_register(&unittest_i2c_bus_driver); |
1853 | if (unittest(ret == 0, | |
1854 | "could not register unittest i2c bus driver\n")) | |
d5e75500 PA |
1855 | return ret; |
1856 | ||
4252de39 | 1857 | #if IS_BUILTIN(CONFIG_I2C_MUX) |
9697a559 WL |
1858 | ret = i2c_add_driver(&unittest_i2c_mux_driver); |
1859 | if (unittest(ret == 0, | |
1860 | "could not register unittest i2c mux driver\n")) | |
d5e75500 PA |
1861 | return ret; |
1862 | #endif | |
1863 | ||
1864 | return 0; | |
1865 | } | |
1866 | ||
9697a559 | 1867 | static void of_unittest_overlay_i2c_cleanup(void) |
d5e75500 | 1868 | { |
4252de39 | 1869 | #if IS_BUILTIN(CONFIG_I2C_MUX) |
9697a559 | 1870 | i2c_del_driver(&unittest_i2c_mux_driver); |
d5e75500 | 1871 | #endif |
9697a559 WL |
1872 | platform_driver_unregister(&unittest_i2c_bus_driver); |
1873 | i2c_del_driver(&unittest_i2c_dev_driver); | |
d5e75500 PA |
1874 | } |
1875 | ||
9697a559 | 1876 | static void of_unittest_overlay_i2c_12(void) |
d5e75500 PA |
1877 | { |
1878 | int ret; | |
1879 | ||
1880 | /* device should enable */ | |
9697a559 | 1881 | ret = of_unittest_apply_overlay_check(12, 12, 0, 1, I2C_OVERLAY); |
d5e75500 PA |
1882 | if (ret != 0) |
1883 | return; | |
1884 | ||
9697a559 | 1885 | unittest(1, "overlay test %d passed\n", 12); |
d5e75500 PA |
1886 | } |
1887 | ||
1888 | /* test deactivation of device */ | |
9697a559 | 1889 | static void of_unittest_overlay_i2c_13(void) |
d5e75500 PA |
1890 | { |
1891 | int ret; | |
1892 | ||
1893 | /* device should disable */ | |
9697a559 | 1894 | ret = of_unittest_apply_overlay_check(13, 13, 1, 0, I2C_OVERLAY); |
d5e75500 | 1895 | if (ret != 0) |
6b1271de | 1896 | return; |
d5e75500 | 1897 | |
9697a559 | 1898 | unittest(1, "overlay test %d passed\n", 13); |
d5e75500 PA |
1899 | } |
1900 | ||
1901 | /* just check for i2c mux existence */ | |
9697a559 | 1902 | static void of_unittest_overlay_i2c_14(void) |
d5e75500 | 1903 | { |
6b1271de PA |
1904 | } |
1905 | ||
9697a559 | 1906 | static void of_unittest_overlay_i2c_15(void) |
d5e75500 PA |
1907 | { |
1908 | int ret; | |
1909 | ||
1910 | /* device should enable */ | |
ca7b8964 | 1911 | ret = of_unittest_apply_overlay_check(15, 15, 0, 1, I2C_OVERLAY); |
d5e75500 PA |
1912 | if (ret != 0) |
1913 | return; | |
1914 | ||
9697a559 | 1915 | unittest(1, "overlay test %d passed\n", 15); |
d5e75500 PA |
1916 | } |
1917 | ||
1918 | #else | |
1919 | ||
9697a559 WL |
1920 | static inline void of_unittest_overlay_i2c_14(void) { } |
1921 | static inline void of_unittest_overlay_i2c_15(void) { } | |
d5e75500 PA |
1922 | |
1923 | #endif | |
1924 | ||
9697a559 | 1925 | static void __init of_unittest_overlay(void) |
177d271c PA |
1926 | { |
1927 | struct device_node *bus_np = NULL; | |
1928 | int ret; | |
1929 | ||
9697a559 | 1930 | ret = platform_driver_register(&unittest_driver); |
177d271c | 1931 | if (ret != 0) { |
9697a559 | 1932 | unittest(0, "could not register unittest driver\n"); |
177d271c PA |
1933 | goto out; |
1934 | } | |
1935 | ||
1936 | bus_np = of_find_node_by_path(bus_path); | |
1937 | if (bus_np == NULL) { | |
9697a559 | 1938 | unittest(0, "could not find bus_path \"%s\"\n", bus_path); |
177d271c PA |
1939 | goto out; |
1940 | } | |
1941 | ||
146dedbc | 1942 | ret = of_platform_default_populate(bus_np, NULL, NULL); |
177d271c | 1943 | if (ret != 0) { |
9697a559 | 1944 | unittest(0, "could not populate bus @ \"%s\"\n", bus_path); |
177d271c PA |
1945 | goto out; |
1946 | } | |
1947 | ||
9697a559 WL |
1948 | if (!of_unittest_device_exists(100, PDEV_OVERLAY)) { |
1949 | unittest(0, "could not find unittest0 @ \"%s\"\n", | |
1950 | unittest_path(100, PDEV_OVERLAY)); | |
177d271c PA |
1951 | goto out; |
1952 | } | |
1953 | ||
9697a559 WL |
1954 | if (of_unittest_device_exists(101, PDEV_OVERLAY)) { |
1955 | unittest(0, "unittest1 @ \"%s\" should not exist\n", | |
1956 | unittest_path(101, PDEV_OVERLAY)); | |
177d271c PA |
1957 | goto out; |
1958 | } | |
1959 | ||
9697a559 | 1960 | unittest(1, "basic infrastructure of overlays passed"); |
177d271c PA |
1961 | |
1962 | /* tests in sequence */ | |
9697a559 WL |
1963 | of_unittest_overlay_0(); |
1964 | of_unittest_overlay_1(); | |
1965 | of_unittest_overlay_2(); | |
1966 | of_unittest_overlay_3(); | |
1967 | of_unittest_overlay_4(); | |
1968 | of_unittest_overlay_5(); | |
1969 | of_unittest_overlay_6(); | |
1970 | of_unittest_overlay_8(); | |
1971 | ||
1972 | of_unittest_overlay_10(); | |
1973 | of_unittest_overlay_11(); | |
6b1271de | 1974 | |
4252de39 | 1975 | #if IS_BUILTIN(CONFIG_I2C) |
9697a559 | 1976 | if (unittest(of_unittest_overlay_i2c_init() == 0, "i2c init failed\n")) |
d5e75500 PA |
1977 | goto out; |
1978 | ||
9697a559 WL |
1979 | of_unittest_overlay_i2c_12(); |
1980 | of_unittest_overlay_i2c_13(); | |
1981 | of_unittest_overlay_i2c_14(); | |
1982 | of_unittest_overlay_i2c_15(); | |
d5e75500 | 1983 | |
9697a559 | 1984 | of_unittest_overlay_i2c_cleanup(); |
d5e75500 PA |
1985 | #endif |
1986 | ||
492a22ac PA |
1987 | of_unittest_destroy_tracked_overlays(); |
1988 | ||
177d271c PA |
1989 | out: |
1990 | of_node_put(bus_np); | |
1991 | } | |
1992 | ||
1993 | #else | |
9697a559 | 1994 | static inline void __init of_unittest_overlay(void) { } |
177d271c PA |
1995 | #endif |
1996 | ||
60a0004c FR |
1997 | #ifdef CONFIG_OF_OVERLAY |
1998 | ||
81d0848f FR |
1999 | /* |
2000 | * __dtb_ot_begin[] and __dtb_ot_end[] are created by cmd_dt_S_dtb | |
2001 | * in scripts/Makefile.lib | |
2002 | */ | |
2003 | ||
2004 | #define OVERLAY_INFO_EXTERN(name) \ | |
2005 | extern uint8_t __dtb_##name##_begin[]; \ | |
2006 | extern uint8_t __dtb_##name##_end[] | |
2007 | ||
2008 | #define OVERLAY_INFO(name, expected) \ | |
2009 | { .dtb_begin = __dtb_##name##_begin, \ | |
2010 | .dtb_end = __dtb_##name##_end, \ | |
2011 | .expected_result = expected, \ | |
2012 | } | |
2013 | ||
2014 | struct overlay_info { | |
2015 | uint8_t *dtb_begin; | |
2016 | uint8_t *dtb_end; | |
2017 | void *data; | |
2018 | struct device_node *np_overlay; | |
2019 | int expected_result; | |
2020 | int overlay_id; | |
2021 | }; | |
2022 | ||
2023 | OVERLAY_INFO_EXTERN(overlay_base); | |
2024 | OVERLAY_INFO_EXTERN(overlay); | |
2025 | OVERLAY_INFO_EXTERN(overlay_bad_phandle); | |
60a0004c | 2026 | OVERLAY_INFO_EXTERN(overlay_bad_symbol); |
81d0848f FR |
2027 | |
2028 | /* order of entries is hard-coded into users of overlays[] */ | |
2029 | static struct overlay_info overlays[] = { | |
2030 | OVERLAY_INFO(overlay_base, -9999), | |
2031 | OVERLAY_INFO(overlay, 0), | |
2032 | OVERLAY_INFO(overlay_bad_phandle, -EINVAL), | |
60a0004c | 2033 | OVERLAY_INFO(overlay_bad_symbol, -EINVAL), |
81d0848f FR |
2034 | {} |
2035 | }; | |
2036 | ||
2037 | static struct device_node *overlay_base_root; | |
2038 | ||
2039 | /* | |
2040 | * Create base device tree for the overlay unittest. | |
2041 | * | |
2042 | * This is called from very early boot code. | |
2043 | * | |
2044 | * Do as much as possible the same way as done in __unflatten_device_tree | |
2045 | * and other early boot steps for the normal FDT so that the overlay base | |
2046 | * unflattened tree will have the same characteristics as the real tree | |
2047 | * (such as having memory allocated by the early allocator). The goal | |
2048 | * is to test "the real thing" as much as possible, and test "test setup | |
2049 | * code" as little as possible. | |
2050 | * | |
2051 | * Have to stop before resolving phandles, because that uses kmalloc. | |
2052 | */ | |
2053 | void __init unittest_unflatten_overlay_base(void) | |
2054 | { | |
2055 | struct overlay_info *info; | |
2056 | u32 data_size; | |
2057 | u32 size; | |
2058 | ||
2059 | info = &overlays[0]; | |
2060 | ||
2061 | if (info->expected_result != -9999) { | |
2062 | pr_err("No dtb 'overlay_base' to attach\n"); | |
2063 | return; | |
2064 | } | |
2065 | ||
2066 | data_size = info->dtb_end - info->dtb_begin; | |
2067 | if (!data_size) { | |
2068 | pr_err("No dtb 'overlay_base' to attach\n"); | |
2069 | return; | |
2070 | } | |
2071 | ||
2072 | size = fdt_totalsize(info->dtb_begin); | |
2073 | if (size != data_size) { | |
2074 | pr_err("dtb 'overlay_base' header totalsize != actual size"); | |
2075 | return; | |
2076 | } | |
2077 | ||
2078 | info->data = early_init_dt_alloc_memory_arch(size, | |
2079 | roundup_pow_of_two(FDT_V17_SIZE)); | |
2080 | if (!info->data) { | |
2081 | pr_err("alloc for dtb 'overlay_base' failed"); | |
2082 | return; | |
2083 | } | |
2084 | ||
2085 | memcpy(info->data, info->dtb_begin, size); | |
2086 | ||
2087 | __unflatten_device_tree(info->data, NULL, &info->np_overlay, | |
2088 | early_init_dt_alloc_memory_arch, true); | |
2089 | overlay_base_root = info->np_overlay; | |
2090 | } | |
2091 | ||
2092 | /* | |
2093 | * The purpose of of_unittest_overlay_data_add is to add an | |
2094 | * overlay in the normal fashion. This is a test of the whole | |
2095 | * picture, instead of testing individual elements. | |
2096 | * | |
2097 | * A secondary purpose is to be able to verify that the contents of | |
2098 | * /proc/device-tree/ contains the updated structure and values from | |
2099 | * the overlay. That must be verified separately in user space. | |
2100 | * | |
2101 | * Return 0 on unexpected error. | |
2102 | */ | |
2103 | static int __init overlay_data_add(int onum) | |
2104 | { | |
2105 | struct overlay_info *info; | |
2106 | int k; | |
2107 | int ret; | |
2108 | u32 size; | |
2109 | u32 size_from_header; | |
2110 | ||
2111 | for (k = 0, info = overlays; info; info++, k++) { | |
2112 | if (k == onum) | |
2113 | break; | |
2114 | } | |
2115 | if (onum > k) | |
2116 | return 0; | |
2117 | ||
2118 | size = info->dtb_end - info->dtb_begin; | |
2119 | if (!size) { | |
2120 | pr_err("no overlay to attach, %d\n", onum); | |
2121 | ret = 0; | |
2122 | } | |
2123 | ||
2124 | size_from_header = fdt_totalsize(info->dtb_begin); | |
2125 | if (size_from_header != size) { | |
2126 | pr_err("overlay header totalsize != actual size, %d", onum); | |
2127 | return 0; | |
2128 | } | |
2129 | ||
2130 | /* | |
2131 | * Must create permanent copy of FDT because of_fdt_unflatten_tree() | |
2132 | * will create pointers to the passed in FDT in the EDT. | |
2133 | */ | |
2134 | info->data = kmemdup(info->dtb_begin, size, GFP_KERNEL); | |
2135 | if (!info->data) { | |
2136 | pr_err("unable to allocate memory for data, %d\n", onum); | |
2137 | return 0; | |
2138 | } | |
2139 | ||
2140 | of_fdt_unflatten_tree(info->data, NULL, &info->np_overlay); | |
2141 | if (!info->np_overlay) { | |
2142 | pr_err("unable to unflatten overlay, %d\n", onum); | |
2143 | ret = 0; | |
2144 | goto out_free_data; | |
2145 | } | |
2146 | of_node_set_flag(info->np_overlay, OF_DETACHED); | |
2147 | ||
2148 | ret = of_resolve_phandles(info->np_overlay); | |
2149 | if (ret) { | |
2150 | pr_err("resolve ot phandles (ret=%d), %d\n", ret, onum); | |
2151 | goto out_free_np_overlay; | |
2152 | } | |
2153 | ||
2154 | ret = of_overlay_create(info->np_overlay); | |
2155 | if (ret < 0) { | |
2156 | pr_err("of_overlay_create() (ret=%d), %d\n", ret, onum); | |
2157 | goto out_free_np_overlay; | |
2158 | } else { | |
2159 | info->overlay_id = ret; | |
2160 | ret = 0; | |
2161 | } | |
2162 | ||
2163 | pr_debug("__dtb_overlay_begin applied, overlay id %d\n", ret); | |
2164 | ||
2165 | goto out; | |
2166 | ||
2167 | out_free_np_overlay: | |
2168 | /* | |
2169 | * info->np_overlay is the unflattened device tree | |
2170 | * It has not been spliced into the live tree. | |
2171 | */ | |
2172 | ||
2173 | /* todo: function to free unflattened device tree */ | |
2174 | ||
2175 | out_free_data: | |
2176 | kfree(info->data); | |
2177 | ||
2178 | out: | |
2179 | return (ret == info->expected_result); | |
2180 | } | |
2181 | ||
2182 | /* | |
2183 | * The purpose of of_unittest_overlay_high_level is to add an overlay | |
2184 | * in the normal fashion. This is a test of the whole picture, | |
2185 | * instead of individual elements. | |
2186 | * | |
2187 | * The first part of the function is _not_ normal overlay usage; it is | |
2188 | * finishing splicing the base overlay device tree into the live tree. | |
2189 | */ | |
2190 | static __init void of_unittest_overlay_high_level(void) | |
2191 | { | |
2192 | struct device_node *last_sibling; | |
2193 | struct device_node *np; | |
2194 | struct device_node *of_symbols; | |
2195 | struct device_node *overlay_base_symbols; | |
2196 | struct device_node **pprev; | |
2197 | struct property *prop; | |
2198 | int ret; | |
2199 | ||
2200 | if (!overlay_base_root) { | |
2201 | unittest(0, "overlay_base_root not initialized\n"); | |
2202 | return; | |
2203 | } | |
2204 | ||
2205 | /* | |
2206 | * Could not fixup phandles in unittest_unflatten_overlay_base() | |
2207 | * because kmalloc() was not yet available. | |
2208 | */ | |
2209 | of_resolve_phandles(overlay_base_root); | |
2210 | ||
2211 | /* | |
2212 | * do not allow overlay_base to duplicate any node already in | |
2213 | * tree, this greatly simplifies the code | |
2214 | */ | |
2215 | ||
2216 | /* | |
2217 | * remove overlay_base_root node "__local_fixups", after | |
2218 | * being used by of_resolve_phandles() | |
2219 | */ | |
2220 | pprev = &overlay_base_root->child; | |
2221 | for (np = overlay_base_root->child; np; np = np->sibling) { | |
2222 | if (!of_node_cmp(np->name, "__local_fixups__")) { | |
2223 | *pprev = np->sibling; | |
2224 | break; | |
2225 | } | |
2226 | pprev = &np->sibling; | |
2227 | } | |
2228 | ||
2229 | /* remove overlay_base_root node "__symbols__" if in live tree */ | |
2230 | of_symbols = of_get_child_by_name(of_root, "__symbols__"); | |
2231 | if (of_symbols) { | |
2232 | /* will have to graft properties from node into live tree */ | |
2233 | pprev = &overlay_base_root->child; | |
2234 | for (np = overlay_base_root->child; np; np = np->sibling) { | |
2235 | if (!of_node_cmp(np->name, "__symbols__")) { | |
2236 | overlay_base_symbols = np; | |
2237 | *pprev = np->sibling; | |
2238 | break; | |
2239 | } | |
2240 | pprev = &np->sibling; | |
2241 | } | |
2242 | } | |
2243 | ||
2244 | for (np = overlay_base_root->child; np; np = np->sibling) { | |
2245 | if (of_get_child_by_name(of_root, np->name)) { | |
2246 | unittest(0, "illegal node name in overlay_base %s", | |
2247 | np->name); | |
2248 | return; | |
2249 | } | |
2250 | } | |
2251 | ||
2252 | /* | |
2253 | * overlay 'overlay_base' is not allowed to have root | |
2254 | * properties, so only need to splice nodes into main device tree. | |
2255 | * | |
2256 | * root node of *overlay_base_root will not be freed, it is lost | |
2257 | * memory. | |
2258 | */ | |
2259 | ||
2260 | for (np = overlay_base_root->child; np; np = np->sibling) | |
2261 | np->parent = of_root; | |
2262 | ||
2263 | mutex_lock(&of_mutex); | |
2264 | ||
ee320b33 | 2265 | for (last_sibling = np = of_root->child; np; np = np->sibling) |
81d0848f FR |
2266 | last_sibling = np; |
2267 | ||
2268 | if (last_sibling) | |
2269 | last_sibling->sibling = overlay_base_root->child; | |
2270 | else | |
2271 | of_root->child = overlay_base_root->child; | |
2272 | ||
2273 | for_each_of_allnodes_from(overlay_base_root, np) | |
2274 | __of_attach_node_sysfs(np); | |
2275 | ||
2276 | if (of_symbols) { | |
2277 | for_each_property_of_node(overlay_base_symbols, prop) { | |
2278 | ret = __of_add_property(of_symbols, prop); | |
2279 | if (ret) { | |
2280 | unittest(0, | |
2281 | "duplicate property '%s' in overlay_base node __symbols__", | |
2282 | prop->name); | |
8756cd1d | 2283 | goto err_unlock; |
81d0848f FR |
2284 | } |
2285 | ret = __of_add_property_sysfs(of_symbols, prop); | |
2286 | if (ret) { | |
2287 | unittest(0, | |
2288 | "unable to add property '%s' in overlay_base node __symbols__ to sysfs", | |
2289 | prop->name); | |
8756cd1d | 2290 | goto err_unlock; |
81d0848f FR |
2291 | } |
2292 | } | |
2293 | } | |
2294 | ||
2295 | mutex_unlock(&of_mutex); | |
2296 | ||
2297 | ||
2298 | /* now do the normal overlay usage test */ | |
2299 | ||
2300 | unittest(overlay_data_add(1), | |
2301 | "Adding overlay 'overlay' failed\n"); | |
2302 | ||
2303 | unittest(overlay_data_add(2), | |
2304 | "Adding overlay 'overlay_bad_phandle' failed\n"); | |
60a0004c FR |
2305 | |
2306 | unittest(overlay_data_add(3), | |
2307 | "Adding overlay 'overlay_bad_symbol' failed\n"); | |
2308 | ||
8756cd1d DC |
2309 | return; |
2310 | ||
2311 | err_unlock: | |
2312 | mutex_unlock(&of_mutex); | |
81d0848f FR |
2313 | } |
2314 | ||
2315 | #else | |
2316 | ||
2317 | static inline __init void of_unittest_overlay_high_level(void) {} | |
2318 | ||
2319 | #endif | |
2320 | ||
9697a559 | 2321 | static int __init of_unittest(void) |
53a42093 GL |
2322 | { |
2323 | struct device_node *np; | |
ae9304c9 GM |
2324 | int res; |
2325 | ||
9697a559 WL |
2326 | /* adding data for unittest */ |
2327 | res = unittest_data_add(); | |
ae9304c9 GM |
2328 | if (res) |
2329 | return res; | |
788ec2fc GL |
2330 | if (!of_aliases) |
2331 | of_aliases = of_find_node_by_path("/aliases"); | |
53a42093 GL |
2332 | |
2333 | np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a"); | |
2334 | if (!np) { | |
2335 | pr_info("No testcase data in device tree; not running tests\n"); | |
2336 | return 0; | |
2337 | } | |
2338 | of_node_put(np); | |
2339 | ||
9697a559 WL |
2340 | pr_info("start of unittest - you will see error messages\n"); |
2341 | of_unittest_check_tree_linkage(); | |
2342 | of_unittest_check_phandles(); | |
2343 | of_unittest_find_node_by_name(); | |
2344 | of_unittest_dynamic(); | |
2345 | of_unittest_parse_phandle_with_args(); | |
ce4fecf1 | 2346 | of_unittest_printf(); |
9697a559 WL |
2347 | of_unittest_property_string(); |
2348 | of_unittest_property_copy(); | |
2349 | of_unittest_changeset(); | |
2350 | of_unittest_parse_interrupts(); | |
2351 | of_unittest_parse_interrupts_extended(); | |
2352 | of_unittest_match_node(); | |
2353 | of_unittest_platform_populate(); | |
2354 | of_unittest_overlay(); | |
ae9304c9 | 2355 | |
f2051d6a | 2356 | /* Double check linkage after removing testcase data */ |
9697a559 | 2357 | of_unittest_check_tree_linkage(); |
f2051d6a | 2358 | |
81d0848f FR |
2359 | of_unittest_overlay_high_level(); |
2360 | ||
9697a559 WL |
2361 | pr_info("end of unittest - %i passed, %i failed\n", |
2362 | unittest_results.passed, unittest_results.failed); | |
f2051d6a | 2363 | |
53a42093 GL |
2364 | return 0; |
2365 | } | |
9697a559 | 2366 | late_initcall(of_unittest); |