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