Linux Audio

Check our new training course

Loading...
v6.2
   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * Self tests for device tree subsystem
   4 */
   5
   6#define pr_fmt(fmt) "### dt-test ### " fmt
   7
   8#include <linux/memblock.h>
   9#include <linux/clk.h>
  10#include <linux/dma-direct.h> /* to test phys_to_dma/dma_to_phys */
  11#include <linux/err.h>
  12#include <linux/errno.h>
  13#include <linux/hashtable.h>
  14#include <linux/libfdt.h>
  15#include <linux/of.h>
  16#include <linux/of_address.h>
  17#include <linux/of_fdt.h>
  18#include <linux/of_irq.h>
  19#include <linux/of_platform.h>
  20#include <linux/list.h>
  21#include <linux/mutex.h>
  22#include <linux/slab.h>
  23#include <linux/device.h>
  24#include <linux/platform_device.h>
  25#include <linux/kernel.h>
  26
  27#include <linux/i2c.h>
  28#include <linux/i2c-mux.h>
  29#include <linux/gpio/driver.h>
  30
  31#include <linux/bitops.h>
  32
  33#include "of_private.h"
  34
  35static struct unittest_results {
  36	int passed;
  37	int failed;
  38} unittest_results;
  39
  40#define unittest(result, fmt, ...) ({ \
  41	bool failed = !(result); \
  42	if (failed) { \
  43		unittest_results.failed++; \
  44		pr_err("FAIL %s():%i " fmt, __func__, __LINE__, ##__VA_ARGS__); \
  45	} else { \
  46		unittest_results.passed++; \
  47		pr_info("pass %s():%i\n", __func__, __LINE__); \
  48	} \
  49	failed; \
  50})
  51
  52/*
  53 * Expected message may have a message level other than KERN_INFO.
  54 * Print the expected message only if the current loglevel will allow
  55 * the actual message to print.
  56 *
  57 * Do not use EXPECT_BEGIN() or EXPECT_END() for messages generated by
  58 * pr_debug().
  59 */
  60#define EXPECT_BEGIN(level, fmt, ...) \
  61	printk(level pr_fmt("EXPECT \\ : ") fmt, ##__VA_ARGS__)
  62
  63#define EXPECT_END(level, fmt, ...) \
  64	printk(level pr_fmt("EXPECT / : ") fmt, ##__VA_ARGS__)
  65
  66static void __init of_unittest_find_node_by_name(void)
  67{
  68	struct device_node *np;
  69	const char *options, *name;
  70
  71	np = of_find_node_by_path("/testcase-data");
  72	name = kasprintf(GFP_KERNEL, "%pOF", np);
  73	unittest(np && !strcmp("/testcase-data", name),
  74		"find /testcase-data failed\n");
  75	of_node_put(np);
  76	kfree(name);
  77
  78	/* Test if trailing '/' works */
  79	np = of_find_node_by_path("/testcase-data/");
  80	unittest(!np, "trailing '/' on /testcase-data/ should fail\n");
  81
  82	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a");
  83	name = kasprintf(GFP_KERNEL, "%pOF", np);
  84	unittest(np && !strcmp("/testcase-data/phandle-tests/consumer-a", name),
  85		"find /testcase-data/phandle-tests/consumer-a failed\n");
  86	of_node_put(np);
  87	kfree(name);
  88
  89	np = of_find_node_by_path("testcase-alias");
  90	name = kasprintf(GFP_KERNEL, "%pOF", np);
  91	unittest(np && !strcmp("/testcase-data", name),
  92		"find testcase-alias failed\n");
  93	of_node_put(np);
  94	kfree(name);
  95
  96	/* Test if trailing '/' works on aliases */
  97	np = of_find_node_by_path("testcase-alias/");
  98	unittest(!np, "trailing '/' on testcase-alias/ should fail\n");
  99
 100	np = of_find_node_by_path("testcase-alias/phandle-tests/consumer-a");
 101	name = kasprintf(GFP_KERNEL, "%pOF", np);
 102	unittest(np && !strcmp("/testcase-data/phandle-tests/consumer-a", name),
 103		"find testcase-alias/phandle-tests/consumer-a failed\n");
 104	of_node_put(np);
 105	kfree(name);
 106
 107	np = of_find_node_by_path("/testcase-data/missing-path");
 108	unittest(!np, "non-existent path returned node %pOF\n", np);
 109	of_node_put(np);
 110
 111	np = of_find_node_by_path("missing-alias");
 112	unittest(!np, "non-existent alias returned node %pOF\n", np);
 113	of_node_put(np);
 114
 115	np = of_find_node_by_path("testcase-alias/missing-path");
 116	unittest(!np, "non-existent alias with relative path returned node %pOF\n", np);
 117	of_node_put(np);
 118
 119	np = of_find_node_opts_by_path("/testcase-data:testoption", &options);
 120	unittest(np && !strcmp("testoption", options),
 121		 "option path test failed\n");
 122	of_node_put(np);
 123
 124	np = of_find_node_opts_by_path("/testcase-data:test/option", &options);
 125	unittest(np && !strcmp("test/option", options),
 126		 "option path test, subcase #1 failed\n");
 127	of_node_put(np);
 128
 129	np = of_find_node_opts_by_path("/testcase-data/testcase-device1:test/option", &options);
 130	unittest(np && !strcmp("test/option", options),
 131		 "option path test, subcase #2 failed\n");
 132	of_node_put(np);
 133
 134	np = of_find_node_opts_by_path("/testcase-data:testoption", NULL);
 135	unittest(np, "NULL option path test failed\n");
 136	of_node_put(np);
 137
 138	np = of_find_node_opts_by_path("testcase-alias:testaliasoption",
 139				       &options);
 140	unittest(np && !strcmp("testaliasoption", options),
 141		 "option alias path test failed\n");
 142	of_node_put(np);
 143
 144	np = of_find_node_opts_by_path("testcase-alias:test/alias/option",
 145				       &options);
 146	unittest(np && !strcmp("test/alias/option", options),
 147		 "option alias path test, subcase #1 failed\n");
 148	of_node_put(np);
 149
 150	np = of_find_node_opts_by_path("testcase-alias:testaliasoption", NULL);
 151	unittest(np, "NULL option alias path test failed\n");
 152	of_node_put(np);
 153
 154	options = "testoption";
 155	np = of_find_node_opts_by_path("testcase-alias", &options);
 156	unittest(np && !options, "option clearing test failed\n");
 157	of_node_put(np);
 158
 159	options = "testoption";
 160	np = of_find_node_opts_by_path("/", &options);
 161	unittest(np && !options, "option clearing root node test failed\n");
 162	of_node_put(np);
 163}
 164
 165static void __init of_unittest_dynamic(void)
 166{
 167	struct device_node *np;
 168	struct property *prop;
 169
 170	np = of_find_node_by_path("/testcase-data");
 171	if (!np) {
 172		pr_err("missing testcase data\n");
 173		return;
 174	}
 175
 176	/* Array of 4 properties for the purpose of testing */
 177	prop = kcalloc(4, sizeof(*prop), GFP_KERNEL);
 178	if (!prop) {
 179		unittest(0, "kzalloc() failed\n");
 180		return;
 181	}
 182
 183	/* Add a new property - should pass*/
 184	prop->name = "new-property";
 185	prop->value = "new-property-data";
 186	prop->length = strlen(prop->value) + 1;
 187	unittest(of_add_property(np, prop) == 0, "Adding a new property failed\n");
 188
 189	/* Try to add an existing property - should fail */
 190	prop++;
 191	prop->name = "new-property";
 192	prop->value = "new-property-data-should-fail";
 193	prop->length = strlen(prop->value) + 1;
 194	unittest(of_add_property(np, prop) != 0,
 195		 "Adding an existing property should have failed\n");
 196
 197	/* Try to modify an existing property - should pass */
 198	prop->value = "modify-property-data-should-pass";
 199	prop->length = strlen(prop->value) + 1;
 200	unittest(of_update_property(np, prop) == 0,
 201		 "Updating an existing property should have passed\n");
 202
 203	/* Try to modify non-existent property - should pass*/
 204	prop++;
 205	prop->name = "modify-property";
 206	prop->value = "modify-missing-property-data-should-pass";
 207	prop->length = strlen(prop->value) + 1;
 208	unittest(of_update_property(np, prop) == 0,
 209		 "Updating a missing property should have passed\n");
 210
 211	/* Remove property - should pass */
 212	unittest(of_remove_property(np, prop) == 0,
 213		 "Removing a property should have passed\n");
 214
 215	/* Adding very large property - should pass */
 216	prop++;
 217	prop->name = "large-property-PAGE_SIZEx8";
 218	prop->length = PAGE_SIZE * 8;
 219	prop->value = kzalloc(prop->length, GFP_KERNEL);
 220	unittest(prop->value != NULL, "Unable to allocate large buffer\n");
 221	if (prop->value)
 222		unittest(of_add_property(np, prop) == 0,
 223			 "Adding a large property should have passed\n");
 224}
 225
 226static int __init of_unittest_check_node_linkage(struct device_node *np)
 227{
 228	struct device_node *child;
 229	int count = 0, rc;
 230
 231	for_each_child_of_node(np, child) {
 232		if (child->parent != np) {
 233			pr_err("Child node %pOFn links to wrong parent %pOFn\n",
 234				 child, np);
 235			rc = -EINVAL;
 236			goto put_child;
 237		}
 238
 239		rc = of_unittest_check_node_linkage(child);
 240		if (rc < 0)
 241			goto put_child;
 242		count += rc;
 243	}
 244
 245	return count + 1;
 246put_child:
 247	of_node_put(child);
 248	return rc;
 249}
 250
 251static void __init of_unittest_check_tree_linkage(void)
 252{
 253	struct device_node *np;
 254	int allnode_count = 0, child_count;
 255
 256	if (!of_root)
 257		return;
 258
 259	for_each_of_allnodes(np)
 260		allnode_count++;
 261	child_count = of_unittest_check_node_linkage(of_root);
 262
 263	unittest(child_count > 0, "Device node data structure is corrupted\n");
 264	unittest(child_count == allnode_count,
 265		 "allnodes list size (%i) doesn't match sibling lists size (%i)\n",
 266		 allnode_count, child_count);
 267	pr_debug("allnodes list size (%i); sibling lists size (%i)\n", allnode_count, child_count);
 268}
 269
 270static void __init of_unittest_printf_one(struct device_node *np, const char *fmt,
 271					  const char *expected)
 272{
 273	unsigned char *buf;
 274	int buf_size;
 275	int size, i;
 276
 277	buf_size = strlen(expected) + 10;
 278	buf = kmalloc(buf_size, GFP_KERNEL);
 279	if (!buf)
 280		return;
 281
 282	/* Baseline; check conversion with a large size limit */
 283	memset(buf, 0xff, buf_size);
 284	size = snprintf(buf, buf_size - 2, fmt, np);
 285
 286	/* use strcmp() instead of strncmp() here to be absolutely sure strings match */
 287	unittest((strcmp(buf, expected) == 0) && (buf[size+1] == 0xff),
 288		"sprintf failed; fmt='%s' expected='%s' rslt='%s'\n",
 289		fmt, expected, buf);
 290
 291	/* Make sure length limits work */
 292	size++;
 293	for (i = 0; i < 2; i++, size--) {
 294		/* Clear the buffer, and make sure it works correctly still */
 295		memset(buf, 0xff, buf_size);
 296		snprintf(buf, size+1, fmt, np);
 297		unittest(strncmp(buf, expected, size) == 0 && (buf[size+1] == 0xff),
 298			"snprintf failed; size=%i fmt='%s' expected='%s' rslt='%s'\n",
 299			size, fmt, expected, buf);
 300	}
 301	kfree(buf);
 302}
 303
 304static void __init of_unittest_printf(void)
 305{
 306	struct device_node *np;
 307	const char *full_name = "/testcase-data/platform-tests/test-device@1/dev@100";
 308	char phandle_str[16] = "";
 309
 310	np = of_find_node_by_path(full_name);
 311	if (!np) {
 312		unittest(np, "testcase data missing\n");
 313		return;
 314	}
 315
 316	num_to_str(phandle_str, sizeof(phandle_str), np->phandle, 0);
 317
 318	of_unittest_printf_one(np, "%pOF",  full_name);
 319	of_unittest_printf_one(np, "%pOFf", full_name);
 320	of_unittest_printf_one(np, "%pOFn", "dev");
 321	of_unittest_printf_one(np, "%2pOFn", "dev");
 322	of_unittest_printf_one(np, "%5pOFn", "  dev");
 323	of_unittest_printf_one(np, "%pOFnc", "dev:test-sub-device");
 324	of_unittest_printf_one(np, "%pOFp", phandle_str);
 325	of_unittest_printf_one(np, "%pOFP", "dev@100");
 326	of_unittest_printf_one(np, "ABC %pOFP ABC", "ABC dev@100 ABC");
 327	of_unittest_printf_one(np, "%10pOFP", "   dev@100");
 328	of_unittest_printf_one(np, "%-10pOFP", "dev@100   ");
 329	of_unittest_printf_one(of_root, "%pOFP", "/");
 330	of_unittest_printf_one(np, "%pOFF", "----");
 331	of_unittest_printf_one(np, "%pOFPF", "dev@100:----");
 332	of_unittest_printf_one(np, "%pOFPFPc", "dev@100:----:dev@100:test-sub-device");
 333	of_unittest_printf_one(np, "%pOFc", "test-sub-device");
 334	of_unittest_printf_one(np, "%pOFC",
 335			"\"test-sub-device\",\"test-compat2\",\"test-compat3\"");
 336}
 337
 338struct node_hash {
 339	struct hlist_node node;
 340	struct device_node *np;
 341};
 342
 343static DEFINE_HASHTABLE(phandle_ht, 8);
 344static void __init of_unittest_check_phandles(void)
 345{
 346	struct device_node *np;
 347	struct node_hash *nh;
 348	struct hlist_node *tmp;
 349	int i, dup_count = 0, phandle_count = 0;
 350
 351	for_each_of_allnodes(np) {
 352		if (!np->phandle)
 353			continue;
 354
 355		hash_for_each_possible(phandle_ht, nh, node, np->phandle) {
 356			if (nh->np->phandle == np->phandle) {
 357				pr_info("Duplicate phandle! %i used by %pOF and %pOF\n",
 358					np->phandle, nh->np, np);
 359				dup_count++;
 360				break;
 361			}
 362		}
 363
 364		nh = kzalloc(sizeof(*nh), GFP_KERNEL);
 365		if (!nh)
 366			return;
 367
 368		nh->np = np;
 369		hash_add(phandle_ht, &nh->node, np->phandle);
 370		phandle_count++;
 371	}
 372	unittest(dup_count == 0, "Found %i duplicates in %i phandles\n",
 373		 dup_count, phandle_count);
 374
 375	/* Clean up */
 376	hash_for_each_safe(phandle_ht, i, tmp, nh, node) {
 377		hash_del(&nh->node);
 378		kfree(nh);
 379	}
 380}
 381
 382static void __init of_unittest_parse_phandle_with_args(void)
 383{
 384	struct device_node *np;
 385	struct of_phandle_args args;
 386	int i, rc;
 387
 388	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a");
 389	if (!np) {
 390		pr_err("missing testcase data\n");
 391		return;
 392	}
 393
 394	rc = of_count_phandle_with_args(np, "phandle-list", "#phandle-cells");
 395	unittest(rc == 7, "of_count_phandle_with_args() returned %i, expected 7\n", rc);
 396
 397	for (i = 0; i < 8; i++) {
 398		bool passed = true;
 399
 400		memset(&args, 0, sizeof(args));
 401		rc = of_parse_phandle_with_args(np, "phandle-list",
 402						"#phandle-cells", i, &args);
 403
 404		/* Test the values from tests-phandle.dtsi */
 405		switch (i) {
 406		case 0:
 407			passed &= !rc;
 408			passed &= (args.args_count == 1);
 409			passed &= (args.args[0] == (i + 1));
 410			break;
 411		case 1:
 412			passed &= !rc;
 413			passed &= (args.args_count == 2);
 414			passed &= (args.args[0] == (i + 1));
 415			passed &= (args.args[1] == 0);
 416			break;
 417		case 2:
 418			passed &= (rc == -ENOENT);
 419			break;
 420		case 3:
 421			passed &= !rc;
 422			passed &= (args.args_count == 3);
 423			passed &= (args.args[0] == (i + 1));
 424			passed &= (args.args[1] == 4);
 425			passed &= (args.args[2] == 3);
 426			break;
 427		case 4:
 428			passed &= !rc;
 429			passed &= (args.args_count == 2);
 430			passed &= (args.args[0] == (i + 1));
 431			passed &= (args.args[1] == 100);
 432			break;
 433		case 5:
 434			passed &= !rc;
 435			passed &= (args.args_count == 0);
 436			break;
 437		case 6:
 438			passed &= !rc;
 439			passed &= (args.args_count == 1);
 440			passed &= (args.args[0] == (i + 1));
 441			break;
 442		case 7:
 443			passed &= (rc == -ENOENT);
 444			break;
 445		default:
 446			passed = false;
 447		}
 448
 449		unittest(passed, "index %i - data error on node %pOF rc=%i\n",
 450			 i, args.np, rc);
 451	}
 452
 453	/* Check for missing list property */
 454	memset(&args, 0, sizeof(args));
 455	rc = of_parse_phandle_with_args(np, "phandle-list-missing",
 456					"#phandle-cells", 0, &args);
 457	unittest(rc == -ENOENT, "expected:%i got:%i\n", -ENOENT, rc);
 458	rc = of_count_phandle_with_args(np, "phandle-list-missing",
 459					"#phandle-cells");
 460	unittest(rc == -ENOENT, "expected:%i got:%i\n", -ENOENT, rc);
 461
 462	/* Check for missing cells property */
 463	memset(&args, 0, sizeof(args));
 464
 465	EXPECT_BEGIN(KERN_INFO,
 466		     "OF: /testcase-data/phandle-tests/consumer-a: could not get #phandle-cells-missing for /testcase-data/phandle-tests/provider1");
 467
 468	rc = of_parse_phandle_with_args(np, "phandle-list",
 469					"#phandle-cells-missing", 0, &args);
 470
 471	EXPECT_END(KERN_INFO,
 472		   "OF: /testcase-data/phandle-tests/consumer-a: could not get #phandle-cells-missing for /testcase-data/phandle-tests/provider1");
 473
 474	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 475
 476	EXPECT_BEGIN(KERN_INFO,
 477		     "OF: /testcase-data/phandle-tests/consumer-a: could not get #phandle-cells-missing for /testcase-data/phandle-tests/provider1");
 478
 479	rc = of_count_phandle_with_args(np, "phandle-list",
 480					"#phandle-cells-missing");
 481
 482	EXPECT_END(KERN_INFO,
 483		   "OF: /testcase-data/phandle-tests/consumer-a: could not get #phandle-cells-missing for /testcase-data/phandle-tests/provider1");
 484
 485	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 486
 487	/* Check for bad phandle in list */
 488	memset(&args, 0, sizeof(args));
 489
 490	EXPECT_BEGIN(KERN_INFO,
 491		     "OF: /testcase-data/phandle-tests/consumer-a: could not find phandle");
 492
 493	rc = of_parse_phandle_with_args(np, "phandle-list-bad-phandle",
 494					"#phandle-cells", 0, &args);
 495
 496	EXPECT_END(KERN_INFO,
 497		   "OF: /testcase-data/phandle-tests/consumer-a: could not find phandle");
 498
 499	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 500
 501	EXPECT_BEGIN(KERN_INFO,
 502		     "OF: /testcase-data/phandle-tests/consumer-a: could not find phandle");
 503
 504	rc = of_count_phandle_with_args(np, "phandle-list-bad-phandle",
 505					"#phandle-cells");
 506
 507	EXPECT_END(KERN_INFO,
 508		   "OF: /testcase-data/phandle-tests/consumer-a: could not find phandle");
 509
 510	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 511
 512	/* Check for incorrectly formed argument list */
 513	memset(&args, 0, sizeof(args));
 514
 515	EXPECT_BEGIN(KERN_INFO,
 516		     "OF: /testcase-data/phandle-tests/consumer-a: #phandle-cells = 3 found 1");
 517
 518	rc = of_parse_phandle_with_args(np, "phandle-list-bad-args",
 519					"#phandle-cells", 1, &args);
 520
 521	EXPECT_END(KERN_INFO,
 522		   "OF: /testcase-data/phandle-tests/consumer-a: #phandle-cells = 3 found 1");
 523
 524	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 525
 526	EXPECT_BEGIN(KERN_INFO,
 527		     "OF: /testcase-data/phandle-tests/consumer-a: #phandle-cells = 3 found 1");
 528
 529	rc = of_count_phandle_with_args(np, "phandle-list-bad-args",
 530					"#phandle-cells");
 531
 532	EXPECT_END(KERN_INFO,
 533		   "OF: /testcase-data/phandle-tests/consumer-a: #phandle-cells = 3 found 1");
 534
 535	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 536}
 537
 538static void __init of_unittest_parse_phandle_with_args_map(void)
 539{
 540	struct device_node *np, *p0, *p1, *p2, *p3;
 541	struct of_phandle_args args;
 542	int i, rc;
 543
 544	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-b");
 545	if (!np) {
 546		pr_err("missing testcase data\n");
 547		return;
 548	}
 549
 550	p0 = of_find_node_by_path("/testcase-data/phandle-tests/provider0");
 551	if (!p0) {
 552		pr_err("missing testcase data\n");
 553		return;
 554	}
 555
 556	p1 = of_find_node_by_path("/testcase-data/phandle-tests/provider1");
 557	if (!p1) {
 558		pr_err("missing testcase data\n");
 559		return;
 560	}
 561
 562	p2 = of_find_node_by_path("/testcase-data/phandle-tests/provider2");
 563	if (!p2) {
 564		pr_err("missing testcase data\n");
 565		return;
 566	}
 567
 568	p3 = of_find_node_by_path("/testcase-data/phandle-tests/provider3");
 569	if (!p3) {
 570		pr_err("missing testcase data\n");
 571		return;
 572	}
 573
 574	rc = of_count_phandle_with_args(np, "phandle-list", "#phandle-cells");
 575	unittest(rc == 7, "of_count_phandle_with_args() returned %i, expected 7\n", rc);
 576
 577	for (i = 0; i < 8; i++) {
 578		bool passed = true;
 579
 580		memset(&args, 0, sizeof(args));
 581		rc = of_parse_phandle_with_args_map(np, "phandle-list",
 582						    "phandle", i, &args);
 583
 584		/* Test the values from tests-phandle.dtsi */
 585		switch (i) {
 586		case 0:
 587			passed &= !rc;
 588			passed &= (args.np == p1);
 589			passed &= (args.args_count == 1);
 590			passed &= (args.args[0] == 1);
 591			break;
 592		case 1:
 593			passed &= !rc;
 594			passed &= (args.np == p3);
 595			passed &= (args.args_count == 3);
 596			passed &= (args.args[0] == 2);
 597			passed &= (args.args[1] == 5);
 598			passed &= (args.args[2] == 3);
 599			break;
 600		case 2:
 601			passed &= (rc == -ENOENT);
 602			break;
 603		case 3:
 604			passed &= !rc;
 605			passed &= (args.np == p0);
 606			passed &= (args.args_count == 0);
 607			break;
 608		case 4:
 609			passed &= !rc;
 610			passed &= (args.np == p1);
 611			passed &= (args.args_count == 1);
 612			passed &= (args.args[0] == 3);
 613			break;
 614		case 5:
 615			passed &= !rc;
 616			passed &= (args.np == p0);
 617			passed &= (args.args_count == 0);
 618			break;
 619		case 6:
 620			passed &= !rc;
 621			passed &= (args.np == p2);
 622			passed &= (args.args_count == 2);
 623			passed &= (args.args[0] == 15);
 624			passed &= (args.args[1] == 0x20);
 625			break;
 626		case 7:
 627			passed &= (rc == -ENOENT);
 628			break;
 629		default:
 630			passed = false;
 631		}
 632
 633		unittest(passed, "index %i - data error on node %s rc=%i\n",
 634			 i, args.np->full_name, rc);
 635	}
 636
 637	/* Check for missing list property */
 638	memset(&args, 0, sizeof(args));
 639	rc = of_parse_phandle_with_args_map(np, "phandle-list-missing",
 640					    "phandle", 0, &args);
 641	unittest(rc == -ENOENT, "expected:%i got:%i\n", -ENOENT, rc);
 642
 643	/* Check for missing cells,map,mask property */
 644	memset(&args, 0, sizeof(args));
 645
 646	EXPECT_BEGIN(KERN_INFO,
 647		     "OF: /testcase-data/phandle-tests/consumer-b: could not get #phandle-missing-cells for /testcase-data/phandle-tests/provider1");
 648
 649	rc = of_parse_phandle_with_args_map(np, "phandle-list",
 650					    "phandle-missing", 0, &args);
 651	EXPECT_END(KERN_INFO,
 652		   "OF: /testcase-data/phandle-tests/consumer-b: could not get #phandle-missing-cells for /testcase-data/phandle-tests/provider1");
 653
 654	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 655
 656	/* Check for bad phandle in list */
 657	memset(&args, 0, sizeof(args));
 658
 659	EXPECT_BEGIN(KERN_INFO,
 660		     "OF: /testcase-data/phandle-tests/consumer-b: could not find phandle");
 661
 662	rc = of_parse_phandle_with_args_map(np, "phandle-list-bad-phandle",
 663					    "phandle", 0, &args);
 664	EXPECT_END(KERN_INFO,
 665		   "OF: /testcase-data/phandle-tests/consumer-b: could not find phandle");
 666
 667	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 668
 669	/* Check for incorrectly formed argument list */
 670	memset(&args, 0, sizeof(args));
 671
 672	EXPECT_BEGIN(KERN_INFO,
 673		     "OF: /testcase-data/phandle-tests/consumer-b: #phandle-cells = 2 found 1");
 674
 675	rc = of_parse_phandle_with_args_map(np, "phandle-list-bad-args",
 676					    "phandle", 1, &args);
 677	EXPECT_END(KERN_INFO,
 678		   "OF: /testcase-data/phandle-tests/consumer-b: #phandle-cells = 2 found 1");
 679
 680	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 681}
 682
 683static void __init of_unittest_property_string(void)
 684{
 685	const char *strings[4];
 686	struct device_node *np;
 687	int rc;
 688
 689	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a");
 690	if (!np) {
 691		pr_err("No testcase data in device tree\n");
 692		return;
 693	}
 694
 695	rc = of_property_match_string(np, "phandle-list-names", "first");
 696	unittest(rc == 0, "first expected:0 got:%i\n", rc);
 697	rc = of_property_match_string(np, "phandle-list-names", "second");
 698	unittest(rc == 1, "second expected:1 got:%i\n", rc);
 699	rc = of_property_match_string(np, "phandle-list-names", "third");
 700	unittest(rc == 2, "third expected:2 got:%i\n", rc);
 701	rc = of_property_match_string(np, "phandle-list-names", "fourth");
 702	unittest(rc == -ENODATA, "unmatched string; rc=%i\n", rc);
 703	rc = of_property_match_string(np, "missing-property", "blah");
 704	unittest(rc == -EINVAL, "missing property; rc=%i\n", rc);
 705	rc = of_property_match_string(np, "empty-property", "blah");
 706	unittest(rc == -ENODATA, "empty property; rc=%i\n", rc);
 707	rc = of_property_match_string(np, "unterminated-string", "blah");
 708	unittest(rc == -EILSEQ, "unterminated string; rc=%i\n", rc);
 709
 710	/* of_property_count_strings() tests */
 711	rc = of_property_count_strings(np, "string-property");
 712	unittest(rc == 1, "Incorrect string count; rc=%i\n", rc);
 713	rc = of_property_count_strings(np, "phandle-list-names");
 714	unittest(rc == 3, "Incorrect string count; rc=%i\n", rc);
 715	rc = of_property_count_strings(np, "unterminated-string");
 716	unittest(rc == -EILSEQ, "unterminated string; rc=%i\n", rc);
 717	rc = of_property_count_strings(np, "unterminated-string-list");
 718	unittest(rc == -EILSEQ, "unterminated string array; rc=%i\n", rc);
 719
 720	/* of_property_read_string_index() tests */
 721	rc = of_property_read_string_index(np, "string-property", 0, strings);
 722	unittest(rc == 0 && !strcmp(strings[0], "foobar"), "of_property_read_string_index() failure; rc=%i\n", rc);
 723	strings[0] = NULL;
 724	rc = of_property_read_string_index(np, "string-property", 1, strings);
 725	unittest(rc == -ENODATA && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc);
 726	rc = of_property_read_string_index(np, "phandle-list-names", 0, strings);
 727	unittest(rc == 0 && !strcmp(strings[0], "first"), "of_property_read_string_index() failure; rc=%i\n", rc);
 728	rc = of_property_read_string_index(np, "phandle-list-names", 1, strings);
 729	unittest(rc == 0 && !strcmp(strings[0], "second"), "of_property_read_string_index() failure; rc=%i\n", rc);
 730	rc = of_property_read_string_index(np, "phandle-list-names", 2, strings);
 731	unittest(rc == 0 && !strcmp(strings[0], "third"), "of_property_read_string_index() failure; rc=%i\n", rc);
 732	strings[0] = NULL;
 733	rc = of_property_read_string_index(np, "phandle-list-names", 3, strings);
 734	unittest(rc == -ENODATA && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc);
 735	strings[0] = NULL;
 736	rc = of_property_read_string_index(np, "unterminated-string", 0, strings);
 737	unittest(rc == -EILSEQ && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc);
 738	rc = of_property_read_string_index(np, "unterminated-string-list", 0, strings);
 739	unittest(rc == 0 && !strcmp(strings[0], "first"), "of_property_read_string_index() failure; rc=%i\n", rc);
 740	strings[0] = NULL;
 741	rc = of_property_read_string_index(np, "unterminated-string-list", 2, strings); /* should fail */
 742	unittest(rc == -EILSEQ && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc);
 743	strings[1] = NULL;
 744
 745	/* of_property_read_string_array() tests */
 746	rc = of_property_read_string_array(np, "string-property", strings, 4);
 747	unittest(rc == 1, "Incorrect string count; rc=%i\n", rc);
 748	rc = of_property_read_string_array(np, "phandle-list-names", strings, 4);
 749	unittest(rc == 3, "Incorrect string count; rc=%i\n", rc);
 750	rc = of_property_read_string_array(np, "unterminated-string", strings, 4);
 751	unittest(rc == -EILSEQ, "unterminated string; rc=%i\n", rc);
 752	/* -- An incorrectly formed string should cause a failure */
 753	rc = of_property_read_string_array(np, "unterminated-string-list", strings, 4);
 754	unittest(rc == -EILSEQ, "unterminated string array; rc=%i\n", rc);
 755	/* -- parsing the correctly formed strings should still work: */
 756	strings[2] = NULL;
 757	rc = of_property_read_string_array(np, "unterminated-string-list", strings, 2);
 758	unittest(rc == 2 && strings[2] == NULL, "of_property_read_string_array() failure; rc=%i\n", rc);
 759	strings[1] = NULL;
 760	rc = of_property_read_string_array(np, "phandle-list-names", strings, 1);
 761	unittest(rc == 1 && strings[1] == NULL, "Overwrote end of string array; rc=%i, str='%s'\n", rc, strings[1]);
 762}
 763
 764#define propcmp(p1, p2) (((p1)->length == (p2)->length) && \
 765			(p1)->value && (p2)->value && \
 766			!memcmp((p1)->value, (p2)->value, (p1)->length) && \
 767			!strcmp((p1)->name, (p2)->name))
 768static void __init of_unittest_property_copy(void)
 769{
 770#ifdef CONFIG_OF_DYNAMIC
 771	struct property p1 = { .name = "p1", .length = 0, .value = "" };
 772	struct property p2 = { .name = "p2", .length = 5, .value = "abcd" };
 773	struct property *new;
 774
 775	new = __of_prop_dup(&p1, GFP_KERNEL);
 776	unittest(new && propcmp(&p1, new), "empty property didn't copy correctly\n");
 777	kfree(new->value);
 778	kfree(new->name);
 779	kfree(new);
 780
 781	new = __of_prop_dup(&p2, GFP_KERNEL);
 782	unittest(new && propcmp(&p2, new), "non-empty property didn't copy correctly\n");
 783	kfree(new->value);
 784	kfree(new->name);
 785	kfree(new);
 786#endif
 787}
 788
 789static void __init of_unittest_changeset(void)
 790{
 791#ifdef CONFIG_OF_DYNAMIC
 792	struct property *ppadd, padd = { .name = "prop-add", .length = 1, .value = "" };
 793	struct property *ppname_n1,  pname_n1  = { .name = "name", .length = 3, .value = "n1"  };
 794	struct property *ppname_n2,  pname_n2  = { .name = "name", .length = 3, .value = "n2"  };
 795	struct property *ppname_n21, pname_n21 = { .name = "name", .length = 3, .value = "n21" };
 796	struct property *ppupdate, pupdate = { .name = "prop-update", .length = 5, .value = "abcd" };
 797	struct property *ppremove;
 798	struct device_node *n1, *n2, *n21, *nchangeset, *nremove, *parent, *np;
 799	struct of_changeset chgset;
 800
 801	n1 = __of_node_dup(NULL, "n1");
 802	unittest(n1, "testcase setup failure\n");
 803
 804	n2 = __of_node_dup(NULL, "n2");
 805	unittest(n2, "testcase setup failure\n");
 806
 807	n21 = __of_node_dup(NULL, "n21");
 808	unittest(n21, "testcase setup failure %p\n", n21);
 809
 810	nchangeset = of_find_node_by_path("/testcase-data/changeset");
 811	nremove = of_get_child_by_name(nchangeset, "node-remove");
 812	unittest(nremove, "testcase setup failure\n");
 813
 814	ppadd = __of_prop_dup(&padd, GFP_KERNEL);
 815	unittest(ppadd, "testcase setup failure\n");
 816
 817	ppname_n1  = __of_prop_dup(&pname_n1, GFP_KERNEL);
 818	unittest(ppname_n1, "testcase setup failure\n");
 819
 820	ppname_n2  = __of_prop_dup(&pname_n2, GFP_KERNEL);
 821	unittest(ppname_n2, "testcase setup failure\n");
 822
 823	ppname_n21 = __of_prop_dup(&pname_n21, GFP_KERNEL);
 824	unittest(ppname_n21, "testcase setup failure\n");
 825
 826	ppupdate = __of_prop_dup(&pupdate, GFP_KERNEL);
 827	unittest(ppupdate, "testcase setup failure\n");
 828
 829	parent = nchangeset;
 830	n1->parent = parent;
 831	n2->parent = parent;
 832	n21->parent = n2;
 833
 834	ppremove = of_find_property(parent, "prop-remove", NULL);
 835	unittest(ppremove, "failed to find removal prop");
 836
 837	of_changeset_init(&chgset);
 838
 839	unittest(!of_changeset_attach_node(&chgset, n1), "fail attach n1\n");
 840	unittest(!of_changeset_add_property(&chgset, n1, ppname_n1), "fail add prop name\n");
 841
 842	unittest(!of_changeset_attach_node(&chgset, n2), "fail attach n2\n");
 843	unittest(!of_changeset_add_property(&chgset, n2, ppname_n2), "fail add prop name\n");
 844
 845	unittest(!of_changeset_detach_node(&chgset, nremove), "fail remove node\n");
 846	unittest(!of_changeset_add_property(&chgset, n21, ppname_n21), "fail add prop name\n");
 847
 848	unittest(!of_changeset_attach_node(&chgset, n21), "fail attach n21\n");
 849
 850	unittest(!of_changeset_add_property(&chgset, parent, ppadd), "fail add prop prop-add\n");
 851	unittest(!of_changeset_update_property(&chgset, parent, ppupdate), "fail update prop\n");
 852	unittest(!of_changeset_remove_property(&chgset, parent, ppremove), "fail remove prop\n");
 853
 854	unittest(!of_changeset_apply(&chgset), "apply failed\n");
 855
 856	of_node_put(nchangeset);
 857
 858	/* Make sure node names are constructed correctly */
 859	unittest((np = of_find_node_by_path("/testcase-data/changeset/n2/n21")),
 860		 "'%pOF' not added\n", n21);
 861	of_node_put(np);
 862
 863	unittest(!of_changeset_revert(&chgset), "revert failed\n");
 864
 865	of_changeset_destroy(&chgset);
 866
 867	of_node_put(n1);
 868	of_node_put(n2);
 869	of_node_put(n21);
 870#endif
 871}
 872
 873static void __init of_unittest_dma_get_max_cpu_address(void)
 874{
 875	struct device_node *np;
 876	phys_addr_t cpu_addr;
 877
 878	if (!IS_ENABLED(CONFIG_OF_ADDRESS))
 879		return;
 880
 881	np = of_find_node_by_path("/testcase-data/address-tests");
 882	if (!np) {
 883		pr_err("missing testcase data\n");
 884		return;
 885	}
 886
 887	cpu_addr = of_dma_get_max_cpu_address(np);
 888	unittest(cpu_addr == 0x4fffffff,
 889		 "of_dma_get_max_cpu_address: wrong CPU addr %pad (expecting %x)\n",
 890		 &cpu_addr, 0x4fffffff);
 891}
 892
 893static void __init of_unittest_dma_ranges_one(const char *path,
 894		u64 expect_dma_addr, u64 expect_paddr)
 895{
 896#ifdef CONFIG_HAS_DMA
 897	struct device_node *np;
 898	const struct bus_dma_region *map = NULL;
 899	int rc;
 900
 901	np = of_find_node_by_path(path);
 902	if (!np) {
 903		pr_err("missing testcase data\n");
 904		return;
 905	}
 906
 907	rc = of_dma_get_range(np, &map);
 908
 909	unittest(!rc, "of_dma_get_range failed on node %pOF rc=%i\n", np, rc);
 910
 911	if (!rc) {
 912		phys_addr_t	paddr;
 913		dma_addr_t	dma_addr;
 914		struct device	*dev_bogus;
 915
 916		dev_bogus = kzalloc(sizeof(struct device), GFP_KERNEL);
 917		if (!dev_bogus) {
 918			unittest(0, "kzalloc() failed\n");
 919			kfree(map);
 920			return;
 921		}
 922
 923		dev_bogus->dma_range_map = map;
 924		paddr = dma_to_phys(dev_bogus, expect_dma_addr);
 925		dma_addr = phys_to_dma(dev_bogus, expect_paddr);
 926
 927		unittest(paddr == expect_paddr,
 928			 "of_dma_get_range: wrong phys addr %pap (expecting %llx) on node %pOF\n",
 929			 &paddr, expect_paddr, np);
 930		unittest(dma_addr == expect_dma_addr,
 931			 "of_dma_get_range: wrong DMA addr %pad (expecting %llx) on node %pOF\n",
 932			 &dma_addr, expect_dma_addr, np);
 933
 934		kfree(map);
 935		kfree(dev_bogus);
 936	}
 937	of_node_put(np);
 938#endif
 939}
 940
 941static void __init of_unittest_parse_dma_ranges(void)
 942{
 943	of_unittest_dma_ranges_one("/testcase-data/address-tests/device@70000000",
 944		0x0, 0x20000000);
 945	if (IS_ENABLED(CONFIG_ARCH_DMA_ADDR_T_64BIT))
 946		of_unittest_dma_ranges_one("/testcase-data/address-tests/bus@80000000/device@1000",
 947			0x100000000, 0x20000000);
 948	of_unittest_dma_ranges_one("/testcase-data/address-tests/pci@90000000",
 949		0x80000000, 0x20000000);
 950}
 951
 952static void __init of_unittest_pci_dma_ranges(void)
 953{
 954	struct device_node *np;
 955	struct of_pci_range range;
 956	struct of_pci_range_parser parser;
 957	int i = 0;
 958
 959	if (!IS_ENABLED(CONFIG_PCI))
 960		return;
 961
 962	np = of_find_node_by_path("/testcase-data/address-tests/pci@90000000");
 963	if (!np) {
 964		pr_err("missing testcase data\n");
 965		return;
 966	}
 967
 968	if (of_pci_dma_range_parser_init(&parser, np)) {
 969		pr_err("missing dma-ranges property\n");
 970		return;
 971	}
 972
 973	/*
 974	 * Get the dma-ranges from the device tree
 975	 */
 976	for_each_of_pci_range(&parser, &range) {
 977		if (!i) {
 978			unittest(range.size == 0x10000000,
 979				 "for_each_of_pci_range wrong size on node %pOF size=%llx\n",
 980				 np, range.size);
 981			unittest(range.cpu_addr == 0x20000000,
 982				 "for_each_of_pci_range wrong CPU addr (%llx) on node %pOF",
 983				 range.cpu_addr, np);
 984			unittest(range.pci_addr == 0x80000000,
 985				 "for_each_of_pci_range wrong DMA addr (%llx) on node %pOF",
 986				 range.pci_addr, np);
 987		} else {
 988			unittest(range.size == 0x10000000,
 989				 "for_each_of_pci_range wrong size on node %pOF size=%llx\n",
 990				 np, range.size);
 991			unittest(range.cpu_addr == 0x40000000,
 992				 "for_each_of_pci_range wrong CPU addr (%llx) on node %pOF",
 993				 range.cpu_addr, np);
 994			unittest(range.pci_addr == 0xc0000000,
 995				 "for_each_of_pci_range wrong DMA addr (%llx) on node %pOF",
 996				 range.pci_addr, np);
 997		}
 998		i++;
 999	}
1000
1001	of_node_put(np);
1002}
1003
1004static void __init of_unittest_parse_interrupts(void)
1005{
1006	struct device_node *np;
1007	struct of_phandle_args args;
1008	int i, rc;
1009
1010	if (of_irq_workarounds & OF_IMAP_OLDWORLD_MAC)
1011		return;
1012
1013	np = of_find_node_by_path("/testcase-data/interrupts/interrupts0");
1014	if (!np) {
1015		pr_err("missing testcase data\n");
1016		return;
1017	}
1018
1019	for (i = 0; i < 4; i++) {
1020		bool passed = true;
1021
1022		memset(&args, 0, sizeof(args));
1023		rc = of_irq_parse_one(np, i, &args);
1024
1025		passed &= !rc;
1026		passed &= (args.args_count == 1);
1027		passed &= (args.args[0] == (i + 1));
1028
1029		unittest(passed, "index %i - data error on node %pOF rc=%i\n",
1030			 i, args.np, rc);
1031	}
1032	of_node_put(np);
1033
1034	np = of_find_node_by_path("/testcase-data/interrupts/interrupts1");
1035	if (!np) {
1036		pr_err("missing testcase data\n");
1037		return;
1038	}
1039
1040	for (i = 0; i < 4; i++) {
1041		bool passed = true;
1042
1043		memset(&args, 0, sizeof(args));
1044		rc = of_irq_parse_one(np, i, &args);
1045
1046		/* Test the values from tests-phandle.dtsi */
1047		switch (i) {
1048		case 0:
1049			passed &= !rc;
1050			passed &= (args.args_count == 1);
1051			passed &= (args.args[0] == 9);
1052			break;
1053		case 1:
1054			passed &= !rc;
1055			passed &= (args.args_count == 3);
1056			passed &= (args.args[0] == 10);
1057			passed &= (args.args[1] == 11);
1058			passed &= (args.args[2] == 12);
1059			break;
1060		case 2:
1061			passed &= !rc;
1062			passed &= (args.args_count == 2);
1063			passed &= (args.args[0] == 13);
1064			passed &= (args.args[1] == 14);
1065			break;
1066		case 3:
1067			passed &= !rc;
1068			passed &= (args.args_count == 2);
1069			passed &= (args.args[0] == 15);
1070			passed &= (args.args[1] == 16);
1071			break;
1072		default:
1073			passed = false;
1074		}
1075		unittest(passed, "index %i - data error on node %pOF rc=%i\n",
1076			 i, args.np, rc);
1077	}
1078	of_node_put(np);
1079}
1080
1081static void __init of_unittest_parse_interrupts_extended(void)
1082{
1083	struct device_node *np;
1084	struct of_phandle_args args;
1085	int i, rc;
1086
1087	if (of_irq_workarounds & OF_IMAP_OLDWORLD_MAC)
1088		return;
1089
1090	np = of_find_node_by_path("/testcase-data/interrupts/interrupts-extended0");
1091	if (!np) {
1092		pr_err("missing testcase data\n");
1093		return;
1094	}
1095
1096	for (i = 0; i < 7; i++) {
1097		bool passed = true;
1098
1099		memset(&args, 0, sizeof(args));
1100		rc = of_irq_parse_one(np, i, &args);
1101
1102		/* Test the values from tests-phandle.dtsi */
1103		switch (i) {
1104		case 0:
1105			passed &= !rc;
1106			passed &= (args.args_count == 1);
1107			passed &= (args.args[0] == 1);
1108			break;
1109		case 1:
1110			passed &= !rc;
1111			passed &= (args.args_count == 3);
1112			passed &= (args.args[0] == 2);
1113			passed &= (args.args[1] == 3);
1114			passed &= (args.args[2] == 4);
1115			break;
1116		case 2:
1117			passed &= !rc;
1118			passed &= (args.args_count == 2);
1119			passed &= (args.args[0] == 5);
1120			passed &= (args.args[1] == 6);
1121			break;
1122		case 3:
1123			passed &= !rc;
1124			passed &= (args.args_count == 1);
1125			passed &= (args.args[0] == 9);
1126			break;
1127		case 4:
1128			passed &= !rc;
1129			passed &= (args.args_count == 3);
1130			passed &= (args.args[0] == 10);
1131			passed &= (args.args[1] == 11);
1132			passed &= (args.args[2] == 12);
1133			break;
1134		case 5:
1135			passed &= !rc;
1136			passed &= (args.args_count == 2);
1137			passed &= (args.args[0] == 13);
1138			passed &= (args.args[1] == 14);
1139			break;
1140		case 6:
1141			/*
1142			 * Tests child node that is missing property
1143			 * #address-cells.  See the comments in
1144			 * drivers/of/unittest-data/tests-interrupts.dtsi
1145			 * nodes intmap1 and interrupts-extended0
1146			 */
1147			passed &= !rc;
1148			passed &= (args.args_count == 1);
1149			passed &= (args.args[0] == 15);
1150			break;
1151		default:
1152			passed = false;
1153		}
1154
1155		unittest(passed, "index %i - data error on node %pOF rc=%i\n",
1156			 i, args.np, rc);
1157	}
1158	of_node_put(np);
1159}
1160
1161static const struct of_device_id match_node_table[] = {
1162	{ .data = "A", .name = "name0", }, /* Name alone is lowest priority */
1163	{ .data = "B", .type = "type1", }, /* followed by type alone */
1164
1165	{ .data = "Ca", .name = "name2", .type = "type1", }, /* followed by both together */
1166	{ .data = "Cb", .name = "name2", }, /* Only match when type doesn't match */
1167	{ .data = "Cc", .name = "name2", .type = "type2", },
1168
1169	{ .data = "E", .compatible = "compat3" },
1170	{ .data = "G", .compatible = "compat2", },
1171	{ .data = "H", .compatible = "compat2", .name = "name5", },
1172	{ .data = "I", .compatible = "compat2", .type = "type1", },
1173	{ .data = "J", .compatible = "compat2", .type = "type1", .name = "name8", },
1174	{ .data = "K", .compatible = "compat2", .name = "name9", },
1175	{}
1176};
1177
1178static struct {
1179	const char *path;
1180	const char *data;
1181} match_node_tests[] = {
1182	{ .path = "/testcase-data/match-node/name0", .data = "A", },
1183	{ .path = "/testcase-data/match-node/name1", .data = "B", },
1184	{ .path = "/testcase-data/match-node/a/name2", .data = "Ca", },
1185	{ .path = "/testcase-data/match-node/b/name2", .data = "Cb", },
1186	{ .path = "/testcase-data/match-node/c/name2", .data = "Cc", },
1187	{ .path = "/testcase-data/match-node/name3", .data = "E", },
1188	{ .path = "/testcase-data/match-node/name4", .data = "G", },
1189	{ .path = "/testcase-data/match-node/name5", .data = "H", },
1190	{ .path = "/testcase-data/match-node/name6", .data = "G", },
1191	{ .path = "/testcase-data/match-node/name7", .data = "I", },
1192	{ .path = "/testcase-data/match-node/name8", .data = "J", },
1193	{ .path = "/testcase-data/match-node/name9", .data = "K", },
1194};
1195
1196static void __init of_unittest_match_node(void)
1197{
1198	struct device_node *np;
1199	const struct of_device_id *match;
1200	int i;
1201
1202	for (i = 0; i < ARRAY_SIZE(match_node_tests); i++) {
1203		np = of_find_node_by_path(match_node_tests[i].path);
1204		if (!np) {
1205			unittest(0, "missing testcase node %s\n",
1206				match_node_tests[i].path);
1207			continue;
1208		}
1209
1210		match = of_match_node(match_node_table, np);
1211		if (!match) {
1212			unittest(0, "%s didn't match anything\n",
1213				match_node_tests[i].path);
1214			continue;
1215		}
1216
1217		if (strcmp(match->data, match_node_tests[i].data) != 0) {
1218			unittest(0, "%s got wrong match. expected %s, got %s\n",
1219				match_node_tests[i].path, match_node_tests[i].data,
1220				(const char *)match->data);
1221			continue;
1222		}
1223		unittest(1, "passed");
1224	}
1225}
1226
1227static struct resource test_bus_res = DEFINE_RES_MEM(0xfffffff8, 2);
 
 
 
 
1228static const struct platform_device_info test_bus_info = {
1229	.name = "unittest-bus",
1230};
1231static void __init of_unittest_platform_populate(void)
1232{
1233	int irq, rc;
1234	struct device_node *np, *child, *grandchild;
1235	struct platform_device *pdev, *test_bus;
1236	const struct of_device_id match[] = {
1237		{ .compatible = "test-device", },
1238		{}
1239	};
1240
1241	np = of_find_node_by_path("/testcase-data");
1242	of_platform_default_populate(np, NULL, NULL);
1243
1244	/* Test that a missing irq domain returns -EPROBE_DEFER */
1245	np = of_find_node_by_path("/testcase-data/testcase-device1");
1246	pdev = of_find_device_by_node(np);
1247	unittest(pdev, "device 1 creation failed\n");
1248
1249	if (!(of_irq_workarounds & OF_IMAP_OLDWORLD_MAC)) {
1250		irq = platform_get_irq(pdev, 0);
1251		unittest(irq == -EPROBE_DEFER,
1252			 "device deferred probe failed - %d\n", irq);
1253
1254		/* Test that a parsing failure does not return -EPROBE_DEFER */
1255		np = of_find_node_by_path("/testcase-data/testcase-device2");
1256		pdev = of_find_device_by_node(np);
1257		unittest(pdev, "device 2 creation failed\n");
1258
1259		EXPECT_BEGIN(KERN_INFO,
1260			     "platform testcase-data:testcase-device2: error -ENXIO: IRQ index 0 not found");
1261
1262		irq = platform_get_irq(pdev, 0);
1263
1264		EXPECT_END(KERN_INFO,
1265			   "platform testcase-data:testcase-device2: error -ENXIO: IRQ index 0 not found");
1266
1267		unittest(irq < 0 && irq != -EPROBE_DEFER,
1268			 "device parsing error failed - %d\n", irq);
1269	}
1270
1271	np = of_find_node_by_path("/testcase-data/platform-tests");
1272	unittest(np, "No testcase data in device tree\n");
1273	if (!np)
1274		return;
1275
1276	test_bus = platform_device_register_full(&test_bus_info);
1277	rc = PTR_ERR_OR_ZERO(test_bus);
1278	unittest(!rc, "testbus registration failed; rc=%i\n", rc);
1279	if (rc) {
1280		of_node_put(np);
1281		return;
1282	}
1283	test_bus->dev.of_node = np;
1284
1285	/*
1286	 * Add a dummy resource to the test bus node after it is
1287	 * registered to catch problems with un-inserted resources. The
1288	 * DT code doesn't insert the resources, and it has caused the
1289	 * kernel to oops in the past. This makes sure the same bug
1290	 * doesn't crop up again.
1291	 */
1292	platform_device_add_resources(test_bus, &test_bus_res, 1);
1293
1294	of_platform_populate(np, match, NULL, &test_bus->dev);
1295	for_each_child_of_node(np, child) {
1296		for_each_child_of_node(child, grandchild) {
1297			pdev = of_find_device_by_node(grandchild);
1298			unittest(pdev,
1299				 "Could not create device for node '%pOFn'\n",
1300				 grandchild);
1301			platform_device_put(pdev);
1302		}
1303	}
1304
1305	of_platform_depopulate(&test_bus->dev);
1306	for_each_child_of_node(np, child) {
1307		for_each_child_of_node(child, grandchild)
1308			unittest(!of_find_device_by_node(grandchild),
1309				 "device didn't get destroyed '%pOFn'\n",
1310				 grandchild);
1311	}
1312
1313	platform_device_unregister(test_bus);
1314	of_node_put(np);
1315}
1316
1317/**
1318 *	update_node_properties - adds the properties
1319 *	of np into dup node (present in live tree) and
1320 *	updates parent of children of np to dup.
1321 *
1322 *	@np:	node whose properties are being added to the live tree
1323 *	@dup:	node present in live tree to be updated
1324 */
1325static void update_node_properties(struct device_node *np,
1326					struct device_node *dup)
1327{
1328	struct property *prop;
1329	struct property *save_next;
1330	struct device_node *child;
1331	int ret;
1332
1333	for_each_child_of_node(np, child)
1334		child->parent = dup;
1335
1336	/*
1337	 * "unittest internal error: unable to add testdata property"
1338	 *
1339	 *    If this message reports a property in node '/__symbols__' then
1340	 *    the respective unittest overlay contains a label that has the
1341	 *    same name as a label in the live devicetree.  The label will
1342	 *    be in the live devicetree only if the devicetree source was
1343	 *    compiled with the '-@' option.  If you encounter this error,
1344	 *    please consider renaming __all__ of the labels in the unittest
1345	 *    overlay dts files with an odd prefix that is unlikely to be
1346	 *    used in a real devicetree.
1347	 */
1348
1349	/*
1350	 * open code for_each_property_of_node() because of_add_property()
1351	 * sets prop->next to NULL
1352	 */
1353	for (prop = np->properties; prop != NULL; prop = save_next) {
1354		save_next = prop->next;
1355		ret = of_add_property(dup, prop);
1356		if (ret) {
1357			if (ret == -EEXIST && !strcmp(prop->name, "name"))
1358				continue;
1359			pr_err("unittest internal error: unable to add testdata property %pOF/%s",
1360			       np, prop->name);
1361		}
1362	}
1363}
1364
1365/**
1366 *	attach_node_and_children - attaches nodes
1367 *	and its children to live tree.
1368 *	CAUTION: misleading function name - if node @np already exists in
1369 *	the live tree then children of @np are *not* attached to the live
1370 *	tree.  This works for the current test devicetree nodes because such
1371 *	nodes do not have child nodes.
1372 *
1373 *	@np:	Node to attach to live tree
1374 */
1375static void attach_node_and_children(struct device_node *np)
1376{
1377	struct device_node *next, *dup, *child;
1378	unsigned long flags;
1379	const char *full_name;
1380
1381	full_name = kasprintf(GFP_KERNEL, "%pOF", np);
1382
1383	if (!strcmp(full_name, "/__local_fixups__") ||
1384	    !strcmp(full_name, "/__fixups__")) {
1385		kfree(full_name);
1386		return;
1387	}
1388
1389	dup = of_find_node_by_path(full_name);
1390	kfree(full_name);
1391	if (dup) {
1392		update_node_properties(np, dup);
1393		return;
1394	}
1395
1396	child = np->child;
1397	np->child = NULL;
1398
1399	mutex_lock(&of_mutex);
1400	raw_spin_lock_irqsave(&devtree_lock, flags);
1401	np->sibling = np->parent->child;
1402	np->parent->child = np;
1403	of_node_clear_flag(np, OF_DETACHED);
1404	raw_spin_unlock_irqrestore(&devtree_lock, flags);
1405
1406	__of_attach_node_sysfs(np);
1407	mutex_unlock(&of_mutex);
1408
1409	while (child) {
1410		next = child->sibling;
1411		attach_node_and_children(child);
1412		child = next;
1413	}
1414}
1415
1416/**
1417 *	unittest_data_add - Reads, copies data from
1418 *	linked tree and attaches it to the live tree
1419 */
1420static int __init unittest_data_add(void)
1421{
1422	void *unittest_data;
1423	void *unittest_data_align;
1424	struct device_node *unittest_data_node = NULL, *np;
1425	/*
1426	 * __dtbo_testcases_begin[] and __dtbo_testcases_end[] are magically
1427	 * created by cmd_dt_S_dtbo in scripts/Makefile.lib
1428	 */
1429	extern uint8_t __dtbo_testcases_begin[];
1430	extern uint8_t __dtbo_testcases_end[];
1431	const int size = __dtbo_testcases_end - __dtbo_testcases_begin;
1432	int rc;
1433	void *ret;
1434
1435	if (!size) {
1436		pr_warn("%s: testcases is empty\n", __func__);
 
1437		return -ENODATA;
1438	}
1439
1440	/* creating copy */
1441	unittest_data = kmalloc(size + FDT_ALIGN_SIZE, GFP_KERNEL);
1442	if (!unittest_data)
1443		return -ENOMEM;
1444
1445	unittest_data_align = PTR_ALIGN(unittest_data, FDT_ALIGN_SIZE);
1446	memcpy(unittest_data_align, __dtbo_testcases_begin, size);
1447
1448	ret = of_fdt_unflatten_tree(unittest_data_align, NULL, &unittest_data_node);
1449	if (!ret) {
1450		pr_warn("%s: unflatten testcases tree failed\n", __func__);
1451		kfree(unittest_data);
1452		return -ENODATA;
1453	}
1454	if (!unittest_data_node) {
1455		pr_warn("%s: testcases tree is empty\n", __func__);
1456		kfree(unittest_data);
1457		return -ENODATA;
1458	}
1459
1460	/*
1461	 * This lock normally encloses of_resolve_phandles()
1462	 */
1463	of_overlay_mutex_lock();
1464
1465	rc = of_resolve_phandles(unittest_data_node);
1466	if (rc) {
1467		pr_err("%s: Failed to resolve phandles (rc=%i)\n", __func__, rc);
1468		of_overlay_mutex_unlock();
1469		return -EINVAL;
1470	}
1471
1472	if (!of_root) {
1473		of_root = unittest_data_node;
1474		for_each_of_allnodes(np)
1475			__of_attach_node_sysfs(np);
1476		of_aliases = of_find_node_by_path("/aliases");
1477		of_chosen = of_find_node_by_path("/chosen");
1478		of_overlay_mutex_unlock();
1479		return 0;
1480	}
1481
1482	EXPECT_BEGIN(KERN_INFO,
1483		     "Duplicate name in testcase-data, renamed to \"duplicate-name#1\"");
1484
1485	/* attach the sub-tree to live tree */
1486	np = unittest_data_node->child;
1487	while (np) {
1488		struct device_node *next = np->sibling;
1489
1490		np->parent = of_root;
1491		attach_node_and_children(np);
1492		np = next;
1493	}
1494
1495	EXPECT_END(KERN_INFO,
1496		   "Duplicate name in testcase-data, renamed to \"duplicate-name#1\"");
1497
1498	of_overlay_mutex_unlock();
1499
1500	return 0;
1501}
1502
1503#ifdef CONFIG_OF_OVERLAY
1504static int __init overlay_data_apply(const char *overlay_name, int *ovcs_id);
1505
1506static int unittest_probe(struct platform_device *pdev)
1507{
1508	struct device *dev = &pdev->dev;
1509	struct device_node *np = dev->of_node;
1510
1511	if (np == NULL) {
1512		dev_err(dev, "No OF data for device\n");
1513		return -EINVAL;
1514
1515	}
1516
1517	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
1518
1519	of_platform_populate(np, NULL, NULL, &pdev->dev);
1520
1521	return 0;
1522}
1523
1524static int unittest_remove(struct platform_device *pdev)
1525{
1526	struct device *dev = &pdev->dev;
1527	struct device_node *np = dev->of_node;
1528
1529	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
1530	return 0;
1531}
1532
1533static const struct of_device_id unittest_match[] = {
1534	{ .compatible = "unittest", },
1535	{},
1536};
1537
1538static struct platform_driver unittest_driver = {
1539	.probe			= unittest_probe,
1540	.remove			= unittest_remove,
1541	.driver = {
1542		.name		= "unittest",
1543		.of_match_table	= of_match_ptr(unittest_match),
1544	},
1545};
1546
1547/* get the platform device instantiated at the path */
1548static struct platform_device *of_path_to_platform_device(const char *path)
1549{
1550	struct device_node *np;
1551	struct platform_device *pdev;
1552
1553	np = of_find_node_by_path(path);
1554	if (np == NULL)
1555		return NULL;
1556
1557	pdev = of_find_device_by_node(np);
1558	of_node_put(np);
1559
1560	return pdev;
1561}
1562
1563/* find out if a platform device exists at that path */
1564static int of_path_platform_device_exists(const char *path)
1565{
1566	struct platform_device *pdev;
1567
1568	pdev = of_path_to_platform_device(path);
1569	platform_device_put(pdev);
1570	return pdev != NULL;
1571}
1572
1573#ifdef CONFIG_OF_GPIO
1574
1575struct unittest_gpio_dev {
1576	struct gpio_chip chip;
1577};
1578
1579static int unittest_gpio_chip_request_count;
1580static int unittest_gpio_probe_count;
1581static int unittest_gpio_probe_pass_count;
1582
1583static int unittest_gpio_chip_request(struct gpio_chip *chip, unsigned int offset)
1584{
1585	unittest_gpio_chip_request_count++;
1586
1587	pr_debug("%s(): %s %d %d\n", __func__, chip->label, offset,
1588		 unittest_gpio_chip_request_count);
1589	return 0;
1590}
1591
1592static int unittest_gpio_probe(struct platform_device *pdev)
1593{
1594	struct unittest_gpio_dev *devptr;
1595	int ret;
1596
1597	unittest_gpio_probe_count++;
1598
1599	devptr = kzalloc(sizeof(*devptr), GFP_KERNEL);
1600	if (!devptr)
1601		return -ENOMEM;
1602
1603	platform_set_drvdata(pdev, devptr);
1604
1605	devptr->chip.fwnode = dev_fwnode(&pdev->dev);
1606	devptr->chip.label = "of-unittest-gpio";
1607	devptr->chip.base = -1; /* dynamic allocation */
1608	devptr->chip.ngpio = 5;
1609	devptr->chip.request = unittest_gpio_chip_request;
1610
1611	ret = gpiochip_add_data(&devptr->chip, NULL);
1612
1613	unittest(!ret,
1614		 "gpiochip_add_data() for node @%pfw failed, ret = %d\n", devptr->chip.fwnode, ret);
1615
1616	if (!ret)
1617		unittest_gpio_probe_pass_count++;
1618	return ret;
1619}
1620
1621static int unittest_gpio_remove(struct platform_device *pdev)
1622{
1623	struct unittest_gpio_dev *devptr = platform_get_drvdata(pdev);
1624	struct device *dev = &pdev->dev;
 
1625
1626	dev_dbg(dev, "%s for node @%pfw\n", __func__, devptr->chip.fwnode);
1627
1628	if (!devptr)
1629		return -EINVAL;
1630
1631	if (devptr->chip.base != -1)
1632		gpiochip_remove(&devptr->chip);
1633
1634	platform_set_drvdata(pdev, NULL);
1635	kfree(devptr);
1636
1637	return 0;
1638}
1639
1640static const struct of_device_id unittest_gpio_id[] = {
1641	{ .compatible = "unittest-gpio", },
1642	{}
1643};
1644
1645static struct platform_driver unittest_gpio_driver = {
1646	.probe	= unittest_gpio_probe,
1647	.remove	= unittest_gpio_remove,
1648	.driver	= {
1649		.name		= "unittest-gpio",
1650		.of_match_table	= of_match_ptr(unittest_gpio_id),
1651	},
1652};
1653
1654static void __init of_unittest_overlay_gpio(void)
1655{
1656	int chip_request_count;
1657	int probe_pass_count;
1658	int ret;
1659
1660	/*
1661	 * tests: apply overlays before registering driver
1662	 * Similar to installing a driver as a module, the
1663	 * driver is registered after applying the overlays.
1664	 *
1665	 * The overlays are applied by overlay_data_apply()
1666	 * instead of of_unittest_apply_overlay() so that they
1667	 * will not be tracked.  Thus they will not be removed
1668	 * by of_unittest_remove_tracked_overlays().
1669	 *
1670	 * - apply overlay_gpio_01
1671	 * - apply overlay_gpio_02a
1672	 * - apply overlay_gpio_02b
1673	 * - register driver
1674	 *
1675	 * register driver will result in
1676	 *   - probe and processing gpio hog for overlay_gpio_01
1677	 *   - probe for overlay_gpio_02a
1678	 *   - processing gpio for overlay_gpio_02b
1679	 */
1680
1681	probe_pass_count = unittest_gpio_probe_pass_count;
1682	chip_request_count = unittest_gpio_chip_request_count;
1683
1684	/*
1685	 * overlay_gpio_01 contains gpio node and child gpio hog node
1686	 * overlay_gpio_02a contains gpio node
1687	 * overlay_gpio_02b contains child gpio hog node
1688	 */
1689
1690	unittest(overlay_data_apply("overlay_gpio_01", NULL),
1691		 "Adding overlay 'overlay_gpio_01' failed\n");
1692
1693	unittest(overlay_data_apply("overlay_gpio_02a", NULL),
1694		 "Adding overlay 'overlay_gpio_02a' failed\n");
1695
1696	unittest(overlay_data_apply("overlay_gpio_02b", NULL),
1697		 "Adding overlay 'overlay_gpio_02b' failed\n");
1698
1699	/*
1700	 * messages are the result of the probes, after the
1701	 * driver is registered
1702	 */
1703
1704	EXPECT_BEGIN(KERN_INFO,
1705		     "gpio-<<int>> (line-B-input): hogged as input\n");
1706
1707	EXPECT_BEGIN(KERN_INFO,
1708		     "gpio-<<int>> (line-A-input): hogged as input\n");
1709
1710	ret = platform_driver_register(&unittest_gpio_driver);
1711	if (unittest(ret == 0, "could not register unittest gpio driver\n"))
1712		return;
1713
1714	EXPECT_END(KERN_INFO,
1715		   "gpio-<<int>> (line-A-input): hogged as input\n");
1716	EXPECT_END(KERN_INFO,
1717		   "gpio-<<int>> (line-B-input): hogged as input\n");
1718
1719	unittest(probe_pass_count + 2 == unittest_gpio_probe_pass_count,
1720		 "unittest_gpio_probe() failed or not called\n");
1721
1722	unittest(chip_request_count + 2 == unittest_gpio_chip_request_count,
1723		 "unittest_gpio_chip_request() called %d times (expected 1 time)\n",
1724		 unittest_gpio_chip_request_count - chip_request_count);
1725
1726	/*
1727	 * tests: apply overlays after registering driver
1728	 *
1729	 * Similar to a driver built-in to the kernel, the
1730	 * driver is registered before applying the overlays.
1731	 *
1732	 * overlay_gpio_03 contains gpio node and child gpio hog node
1733	 *
1734	 * - apply overlay_gpio_03
1735	 *
1736	 * apply overlay will result in
1737	 *   - probe and processing gpio hog.
1738	 */
1739
1740	probe_pass_count = unittest_gpio_probe_pass_count;
1741	chip_request_count = unittest_gpio_chip_request_count;
1742
1743	EXPECT_BEGIN(KERN_INFO,
1744		     "gpio-<<int>> (line-D-input): hogged as input\n");
1745
1746	/* overlay_gpio_03 contains gpio node and child gpio hog node */
1747
1748	unittest(overlay_data_apply("overlay_gpio_03", NULL),
1749		 "Adding overlay 'overlay_gpio_03' failed\n");
1750
1751	EXPECT_END(KERN_INFO,
1752		   "gpio-<<int>> (line-D-input): hogged as input\n");
1753
1754	unittest(probe_pass_count + 1 == unittest_gpio_probe_pass_count,
1755		 "unittest_gpio_probe() failed or not called\n");
1756
1757	unittest(chip_request_count + 1 == unittest_gpio_chip_request_count,
1758		 "unittest_gpio_chip_request() called %d times (expected 1 time)\n",
1759		 unittest_gpio_chip_request_count - chip_request_count);
1760
1761	/*
1762	 * overlay_gpio_04a contains gpio node
1763	 *
1764	 * - apply overlay_gpio_04a
1765	 *
1766	 * apply the overlay will result in
1767	 *   - probe for overlay_gpio_04a
1768	 */
1769
1770	probe_pass_count = unittest_gpio_probe_pass_count;
1771	chip_request_count = unittest_gpio_chip_request_count;
1772
1773	/* overlay_gpio_04a contains gpio node */
1774
1775	unittest(overlay_data_apply("overlay_gpio_04a", NULL),
1776		 "Adding overlay 'overlay_gpio_04a' failed\n");
1777
1778	unittest(probe_pass_count + 1 == unittest_gpio_probe_pass_count,
1779		 "unittest_gpio_probe() failed or not called\n");
1780
1781	/*
1782	 * overlay_gpio_04b contains child gpio hog node
1783	 *
1784	 * - apply overlay_gpio_04b
1785	 *
1786	 * apply the overlay will result in
1787	 *   - processing gpio for overlay_gpio_04b
1788	 */
1789
1790	EXPECT_BEGIN(KERN_INFO,
1791		     "gpio-<<int>> (line-C-input): hogged as input\n");
1792
1793	/* overlay_gpio_04b contains child gpio hog node */
1794
1795	unittest(overlay_data_apply("overlay_gpio_04b", NULL),
1796		 "Adding overlay 'overlay_gpio_04b' failed\n");
1797
1798	EXPECT_END(KERN_INFO,
1799		   "gpio-<<int>> (line-C-input): hogged as input\n");
1800
1801	unittest(chip_request_count + 1 == unittest_gpio_chip_request_count,
1802		 "unittest_gpio_chip_request() called %d times (expected 1 time)\n",
1803		 unittest_gpio_chip_request_count - chip_request_count);
1804}
1805
1806#else
1807
1808static void __init of_unittest_overlay_gpio(void)
1809{
1810	/* skip tests */
1811}
1812
1813#endif
1814
1815#if IS_BUILTIN(CONFIG_I2C)
1816
1817/* get the i2c client device instantiated at the path */
1818static struct i2c_client *of_path_to_i2c_client(const char *path)
1819{
1820	struct device_node *np;
1821	struct i2c_client *client;
1822
1823	np = of_find_node_by_path(path);
1824	if (np == NULL)
1825		return NULL;
1826
1827	client = of_find_i2c_device_by_node(np);
1828	of_node_put(np);
1829
1830	return client;
1831}
1832
1833/* find out if a i2c client device exists at that path */
1834static int of_path_i2c_client_exists(const char *path)
1835{
1836	struct i2c_client *client;
1837
1838	client = of_path_to_i2c_client(path);
1839	if (client)
1840		put_device(&client->dev);
1841	return client != NULL;
1842}
1843#else
1844static int of_path_i2c_client_exists(const char *path)
1845{
1846	return 0;
1847}
1848#endif
1849
1850enum overlay_type {
1851	PDEV_OVERLAY,
1852	I2C_OVERLAY
1853};
1854
1855static int of_path_device_type_exists(const char *path,
1856		enum overlay_type ovtype)
1857{
1858	switch (ovtype) {
1859	case PDEV_OVERLAY:
1860		return of_path_platform_device_exists(path);
1861	case I2C_OVERLAY:
1862		return of_path_i2c_client_exists(path);
1863	}
1864	return 0;
1865}
1866
1867static const char *unittest_path(int nr, enum overlay_type ovtype)
1868{
1869	const char *base;
1870	static char buf[256];
1871
1872	switch (ovtype) {
1873	case PDEV_OVERLAY:
1874		base = "/testcase-data/overlay-node/test-bus";
1875		break;
1876	case I2C_OVERLAY:
1877		base = "/testcase-data/overlay-node/test-bus/i2c-test-bus";
1878		break;
1879	default:
1880		buf[0] = '\0';
1881		return buf;
1882	}
1883	snprintf(buf, sizeof(buf) - 1, "%s/test-unittest%d", base, nr);
1884	buf[sizeof(buf) - 1] = '\0';
1885	return buf;
1886}
1887
1888static int of_unittest_device_exists(int unittest_nr, enum overlay_type ovtype)
1889{
1890	const char *path;
1891
1892	path = unittest_path(unittest_nr, ovtype);
1893
1894	switch (ovtype) {
1895	case PDEV_OVERLAY:
1896		return of_path_platform_device_exists(path);
1897	case I2C_OVERLAY:
1898		return of_path_i2c_client_exists(path);
1899	}
1900	return 0;
1901}
1902
1903static const char *overlay_name_from_nr(int nr)
1904{
1905	static char buf[256];
1906
1907	snprintf(buf, sizeof(buf) - 1,
1908		"overlay_%d", nr);
1909	buf[sizeof(buf) - 1] = '\0';
1910
1911	return buf;
1912}
1913
1914static const char *bus_path = "/testcase-data/overlay-node/test-bus";
1915
1916#define MAX_TRACK_OVCS_IDS 256
1917
1918static int track_ovcs_id[MAX_TRACK_OVCS_IDS];
1919static int track_ovcs_id_overlay_nr[MAX_TRACK_OVCS_IDS];
1920static int track_ovcs_id_cnt;
1921
1922static void of_unittest_track_overlay(int ovcs_id, int overlay_nr)
1923{
1924	if (WARN_ON(track_ovcs_id_cnt >= MAX_TRACK_OVCS_IDS))
1925		return;
1926
1927	track_ovcs_id[track_ovcs_id_cnt] = ovcs_id;
1928	track_ovcs_id_overlay_nr[track_ovcs_id_cnt] = overlay_nr;
1929	track_ovcs_id_cnt++;
1930}
1931
1932static void of_unittest_untrack_overlay(int ovcs_id)
1933{
1934	if (WARN_ON(track_ovcs_id_cnt < 1))
1935		return;
 
1936
1937	track_ovcs_id_cnt--;
 
 
 
1938
1939	/* If out of synch then test is broken.  Do not try to recover. */
1940	WARN_ON(track_ovcs_id[track_ovcs_id_cnt] != ovcs_id);
 
 
 
 
 
 
1941}
1942
1943static void of_unittest_remove_tracked_overlays(void)
1944{
1945	int ret, ovcs_id, overlay_nr, save_ovcs_id;
1946	const char *overlay_name;
1947
1948	while (track_ovcs_id_cnt > 0) {
 
1949
1950		ovcs_id = track_ovcs_id[track_ovcs_id_cnt - 1];
1951		overlay_nr = track_ovcs_id_overlay_nr[track_ovcs_id_cnt - 1];
1952		save_ovcs_id = ovcs_id;
1953		ret = of_overlay_remove(&ovcs_id);
1954		if (ret == -ENODEV) {
1955			overlay_name = overlay_name_from_nr(overlay_nr);
1956			pr_warn("%s: of_overlay_remove() for overlay \"%s\" failed, ret = %d\n",
1957				__func__, overlay_name, ret);
1958		}
1959		of_unittest_untrack_overlay(save_ovcs_id);
1960	}
1961
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1962}
1963
1964static int __init of_unittest_apply_overlay(int overlay_nr, int *ovcs_id)
1965{
1966	/*
1967	 * The overlay will be tracked, thus it will be removed
1968	 * by of_unittest_remove_tracked_overlays().
1969	 */
1970
1971	const char *overlay_name;
1972
1973	overlay_name = overlay_name_from_nr(overlay_nr);
1974
1975	if (!overlay_data_apply(overlay_name, ovcs_id)) {
1976		unittest(0, "could not apply overlay \"%s\"\n", overlay_name);
 
1977		return -EFAULT;
1978	}
1979	of_unittest_track_overlay(*ovcs_id, overlay_nr);
1980
1981	return 0;
1982}
1983
1984/* apply an overlay while checking before and after states */
1985static int __init of_unittest_apply_overlay_check(int overlay_nr,
1986		int unittest_nr, int before, int after,
1987		enum overlay_type ovtype)
1988{
1989	int ret, ovcs_id;
1990
1991	/* unittest device must not be in before state */
1992	if (of_unittest_device_exists(unittest_nr, ovtype) != before) {
1993		unittest(0, "%s with device @\"%s\" %s\n",
1994				overlay_name_from_nr(overlay_nr),
1995				unittest_path(unittest_nr, ovtype),
1996				!before ? "enabled" : "disabled");
1997		return -EINVAL;
1998	}
1999
2000	ovcs_id = 0;
2001	ret = of_unittest_apply_overlay(overlay_nr, &ovcs_id);
2002	if (ret != 0) {
2003		/* of_unittest_apply_overlay already called unittest() */
2004		return ret;
2005	}
2006
2007	/* unittest device must be to set to after state */
2008	if (of_unittest_device_exists(unittest_nr, ovtype) != after) {
2009		unittest(0, "%s failed to create @\"%s\" %s\n",
2010				overlay_name_from_nr(overlay_nr),
2011				unittest_path(unittest_nr, ovtype),
2012				!after ? "enabled" : "disabled");
2013		return -EINVAL;
2014	}
2015
2016	return 0;
2017}
2018
2019/* apply an overlay and then revert it while checking before, after states */
2020static int __init of_unittest_apply_revert_overlay_check(int overlay_nr,
2021		int unittest_nr, int before, int after,
2022		enum overlay_type ovtype)
2023{
2024	int ret, ovcs_id, save_ovcs_id;
2025
2026	/* unittest device must be in before state */
2027	if (of_unittest_device_exists(unittest_nr, ovtype) != before) {
2028		unittest(0, "%s with device @\"%s\" %s\n",
2029				overlay_name_from_nr(overlay_nr),
2030				unittest_path(unittest_nr, ovtype),
2031				!before ? "enabled" : "disabled");
2032		return -EINVAL;
2033	}
2034
2035	/* apply the overlay */
2036	ovcs_id = 0;
2037	ret = of_unittest_apply_overlay(overlay_nr, &ovcs_id);
2038	if (ret != 0) {
2039		/* of_unittest_apply_overlay already called unittest() */
2040		return ret;
2041	}
2042
2043	/* unittest device must be in after state */
2044	if (of_unittest_device_exists(unittest_nr, ovtype) != after) {
2045		unittest(0, "%s failed to create @\"%s\" %s\n",
2046				overlay_name_from_nr(overlay_nr),
2047				unittest_path(unittest_nr, ovtype),
2048				!after ? "enabled" : "disabled");
2049		return -EINVAL;
2050	}
2051
2052	save_ovcs_id = ovcs_id;
2053	ret = of_overlay_remove(&ovcs_id);
2054	if (ret != 0) {
2055		unittest(0, "%s failed to be destroyed @\"%s\"\n",
2056				overlay_name_from_nr(overlay_nr),
2057				unittest_path(unittest_nr, ovtype));
2058		return ret;
2059	}
2060	of_unittest_untrack_overlay(save_ovcs_id);
2061
2062	/* unittest device must be again in before state */
2063	if (of_unittest_device_exists(unittest_nr, PDEV_OVERLAY) != before) {
2064		unittest(0, "%s with device @\"%s\" %s\n",
2065				overlay_name_from_nr(overlay_nr),
2066				unittest_path(unittest_nr, ovtype),
2067				!before ? "enabled" : "disabled");
2068		return -EINVAL;
2069	}
2070
2071	return 0;
2072}
2073
2074/* test activation of device */
2075static void __init of_unittest_overlay_0(void)
2076{
2077	int ret;
2078
2079	EXPECT_BEGIN(KERN_INFO,
2080		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest0/status");
2081
2082	/* device should enable */
2083	ret = of_unittest_apply_overlay_check(0, 0, 0, 1, PDEV_OVERLAY);
2084
2085	EXPECT_END(KERN_INFO,
2086		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest0/status");
2087
2088	if (ret)
2089		return;
2090
2091	unittest(1, "overlay test %d passed\n", 0);
2092}
2093
2094/* test deactivation of device */
2095static void __init of_unittest_overlay_1(void)
2096{
2097	int ret;
2098
2099	EXPECT_BEGIN(KERN_INFO,
2100		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest1/status");
2101
2102	/* device should disable */
2103	ret = of_unittest_apply_overlay_check(1, 1, 1, 0, PDEV_OVERLAY);
2104
2105	EXPECT_END(KERN_INFO,
2106		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest1/status");
2107
2108	if (ret)
2109		return;
2110
2111	unittest(1, "overlay test %d passed\n", 1);
2112
2113}
2114
2115/* test activation of device */
2116static void __init of_unittest_overlay_2(void)
2117{
2118	int ret;
2119
2120	EXPECT_BEGIN(KERN_INFO,
2121		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest2/status");
2122
2123	/* device should enable */
2124	ret = of_unittest_apply_overlay_check(2, 2, 0, 1, PDEV_OVERLAY);
2125
2126	EXPECT_END(KERN_INFO,
2127		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest2/status");
2128
2129	if (ret)
2130		return;
2131	unittest(1, "overlay test %d passed\n", 2);
2132}
2133
2134/* test deactivation of device */
2135static void __init of_unittest_overlay_3(void)
2136{
2137	int ret;
2138
2139	EXPECT_BEGIN(KERN_INFO,
2140		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest3/status");
2141
2142	/* device should disable */
2143	ret = of_unittest_apply_overlay_check(3, 3, 1, 0, PDEV_OVERLAY);
2144
2145	EXPECT_END(KERN_INFO,
2146		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest3/status");
2147
2148	if (ret)
2149		return;
2150
2151	unittest(1, "overlay test %d passed\n", 3);
2152}
2153
2154/* test activation of a full device node */
2155static void __init of_unittest_overlay_4(void)
2156{
2157	/* device should disable */
2158	if (of_unittest_apply_overlay_check(4, 4, 0, 1, PDEV_OVERLAY))
2159		return;
2160
2161	unittest(1, "overlay test %d passed\n", 4);
2162}
2163
2164/* test overlay apply/revert sequence */
2165static void __init of_unittest_overlay_5(void)
2166{
2167	int ret;
2168
2169	EXPECT_BEGIN(KERN_INFO,
2170		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest5/status");
2171
2172	/* device should disable */
2173	ret = of_unittest_apply_revert_overlay_check(5, 5, 0, 1, PDEV_OVERLAY);
2174
2175	EXPECT_END(KERN_INFO,
2176		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest5/status");
2177
2178	if (ret)
2179		return;
2180
2181	unittest(1, "overlay test %d passed\n", 5);
2182}
2183
2184/* test overlay application in sequence */
2185static void __init of_unittest_overlay_6(void)
2186{
2187	int i, save_ovcs_id[2], ovcs_id;
2188	int overlay_nr = 6, unittest_nr = 6;
2189	int before = 0, after = 1;
2190	const char *overlay_name;
2191
2192	int ret;
2193
2194	/* unittest device must be in before state */
2195	for (i = 0; i < 2; i++) {
2196		if (of_unittest_device_exists(unittest_nr + i, PDEV_OVERLAY)
2197				!= before) {
2198			unittest(0, "%s with device @\"%s\" %s\n",
2199					overlay_name_from_nr(overlay_nr + i),
2200					unittest_path(unittest_nr + i,
2201						PDEV_OVERLAY),
2202					!before ? "enabled" : "disabled");
2203			return;
2204		}
2205	}
2206
2207	/* apply the overlays */
2208
2209	EXPECT_BEGIN(KERN_INFO,
2210		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest6/status");
2211
2212	overlay_name = overlay_name_from_nr(overlay_nr + 0);
2213
2214	ret = overlay_data_apply(overlay_name, &ovcs_id);
2215
2216	if (!ret) {
2217		unittest(0, "could not apply overlay \"%s\"\n", overlay_name);
2218			return;
2219	}
2220	save_ovcs_id[0] = ovcs_id;
2221	of_unittest_track_overlay(ovcs_id, overlay_nr + 0);
2222
2223	EXPECT_END(KERN_INFO,
2224		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest6/status");
2225
2226	EXPECT_BEGIN(KERN_INFO,
2227		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest7/status");
2228
2229	overlay_name = overlay_name_from_nr(overlay_nr + 1);
2230
2231	ret = overlay_data_apply(overlay_name, &ovcs_id);
2232
2233	if (!ret) {
2234		unittest(0, "could not apply overlay \"%s\"\n", overlay_name);
2235			return;
2236	}
2237	save_ovcs_id[1] = ovcs_id;
2238	of_unittest_track_overlay(ovcs_id, overlay_nr + 1);
2239
2240	EXPECT_END(KERN_INFO,
2241		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest7/status");
2242
2243
2244	for (i = 0; i < 2; i++) {
2245		/* unittest device must be in after state */
2246		if (of_unittest_device_exists(unittest_nr + i, PDEV_OVERLAY)
2247				!= after) {
2248			unittest(0, "overlay @\"%s\" failed @\"%s\" %s\n",
2249					overlay_name_from_nr(overlay_nr + i),
2250					unittest_path(unittest_nr + i,
2251						PDEV_OVERLAY),
2252					!after ? "enabled" : "disabled");
2253			return;
2254		}
2255	}
2256
2257	for (i = 1; i >= 0; i--) {
2258		ovcs_id = save_ovcs_id[i];
2259		if (of_overlay_remove(&ovcs_id)) {
2260			unittest(0, "%s failed destroy @\"%s\"\n",
2261					overlay_name_from_nr(overlay_nr + i),
2262					unittest_path(unittest_nr + i,
2263						PDEV_OVERLAY));
2264			return;
2265		}
2266		of_unittest_untrack_overlay(save_ovcs_id[i]);
2267	}
2268
2269	for (i = 0; i < 2; i++) {
2270		/* unittest device must be again in before state */
2271		if (of_unittest_device_exists(unittest_nr + i, PDEV_OVERLAY)
2272				!= before) {
2273			unittest(0, "%s with device @\"%s\" %s\n",
2274					overlay_name_from_nr(overlay_nr + i),
2275					unittest_path(unittest_nr + i,
2276						PDEV_OVERLAY),
2277					!before ? "enabled" : "disabled");
2278			return;
2279		}
2280	}
2281
2282	unittest(1, "overlay test %d passed\n", 6);
2283
2284}
2285
2286/* test overlay application in sequence */
2287static void __init of_unittest_overlay_8(void)
2288{
2289	int i, save_ovcs_id[2], ovcs_id;
2290	int overlay_nr = 8, unittest_nr = 8;
2291	const char *overlay_name;
2292	int ret;
2293
2294	/* we don't care about device state in this test */
2295
2296	EXPECT_BEGIN(KERN_INFO,
2297		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest8/status");
2298
2299	overlay_name = overlay_name_from_nr(overlay_nr + 0);
2300
2301	ret = overlay_data_apply(overlay_name, &ovcs_id);
2302	if (!ret)
2303		unittest(0, "could not apply overlay \"%s\"\n", overlay_name);
2304
2305	EXPECT_END(KERN_INFO,
2306		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest8/status");
2307
2308	if (!ret)
2309		return;
2310
2311	save_ovcs_id[0] = ovcs_id;
2312	of_unittest_track_overlay(ovcs_id, overlay_nr + 0);
2313
2314	overlay_name = overlay_name_from_nr(overlay_nr + 1);
2315
2316	EXPECT_BEGIN(KERN_INFO,
2317		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest8/property-foo");
2318
2319	/* apply the overlays */
2320	ret = overlay_data_apply(overlay_name, &ovcs_id);
2321
2322	EXPECT_END(KERN_INFO,
2323		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest8/property-foo");
2324
2325	if (!ret) {
2326		unittest(0, "could not apply overlay \"%s\"\n", overlay_name);
2327		return;
2328	}
2329
2330	save_ovcs_id[1] = ovcs_id;
2331	of_unittest_track_overlay(ovcs_id, overlay_nr + 1);
2332
2333	/* now try to remove first overlay (it should fail) */
2334	ovcs_id = save_ovcs_id[0];
2335
2336	EXPECT_BEGIN(KERN_INFO,
2337		     "OF: overlay: node_overlaps_later_cs: #6 overlaps with #7 @/testcase-data/overlay-node/test-bus/test-unittest8");
2338
2339	EXPECT_BEGIN(KERN_INFO,
2340		     "OF: overlay: overlay #6 is not topmost");
2341
2342	ret = of_overlay_remove(&ovcs_id);
2343
2344	EXPECT_END(KERN_INFO,
2345		   "OF: overlay: overlay #6 is not topmost");
2346
2347	EXPECT_END(KERN_INFO,
2348		   "OF: overlay: node_overlaps_later_cs: #6 overlaps with #7 @/testcase-data/overlay-node/test-bus/test-unittest8");
2349
2350	if (!ret) {
2351		/*
2352		 * Should never get here.  If we do, expect a lot of
2353		 * subsequent tracking and overlay removal related errors.
2354		 */
2355		unittest(0, "%s was destroyed @\"%s\"\n",
2356				overlay_name_from_nr(overlay_nr + 0),
2357				unittest_path(unittest_nr,
2358					PDEV_OVERLAY));
2359		return;
2360	}
2361
2362	/* removing them in order should work */
2363	for (i = 1; i >= 0; i--) {
2364		ovcs_id = save_ovcs_id[i];
2365		if (of_overlay_remove(&ovcs_id)) {
2366			unittest(0, "%s not destroyed @\"%s\"\n",
2367					overlay_name_from_nr(overlay_nr + i),
2368					unittest_path(unittest_nr,
2369						PDEV_OVERLAY));
2370			return;
2371		}
2372		of_unittest_untrack_overlay(save_ovcs_id[i]);
2373	}
2374
2375	unittest(1, "overlay test %d passed\n", 8);
2376}
2377
2378/* test insertion of a bus with parent devices */
2379static void __init of_unittest_overlay_10(void)
2380{
2381	int ret;
2382	char *child_path;
2383
2384	/* device should disable */
2385	ret = of_unittest_apply_overlay_check(10, 10, 0, 1, PDEV_OVERLAY);
2386
2387	if (unittest(ret == 0,
2388			"overlay test %d failed; overlay application\n", 10))
2389		return;
2390
2391	child_path = kasprintf(GFP_KERNEL, "%s/test-unittest101",
2392			unittest_path(10, PDEV_OVERLAY));
2393	if (unittest(child_path, "overlay test %d failed; kasprintf\n", 10))
2394		return;
2395
2396	ret = of_path_device_type_exists(child_path, PDEV_OVERLAY);
2397	kfree(child_path);
2398
2399	unittest(ret, "overlay test %d failed; no child device\n", 10);
2400}
2401
2402/* test insertion of a bus with parent devices (and revert) */
2403static void __init of_unittest_overlay_11(void)
2404{
2405	int ret;
2406
2407	/* device should disable */
2408	ret = of_unittest_apply_revert_overlay_check(11, 11, 0, 1,
2409			PDEV_OVERLAY);
2410
2411	unittest(ret == 0, "overlay test %d failed; overlay apply\n", 11);
2412}
2413
2414#if IS_BUILTIN(CONFIG_I2C) && IS_ENABLED(CONFIG_OF_OVERLAY)
2415
2416struct unittest_i2c_bus_data {
2417	struct platform_device	*pdev;
2418	struct i2c_adapter	adap;
2419};
2420
2421static int unittest_i2c_master_xfer(struct i2c_adapter *adap,
2422		struct i2c_msg *msgs, int num)
2423{
2424	struct unittest_i2c_bus_data *std = i2c_get_adapdata(adap);
2425
2426	(void)std;
2427
2428	return num;
2429}
2430
2431static u32 unittest_i2c_functionality(struct i2c_adapter *adap)
2432{
2433	return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
2434}
2435
2436static const struct i2c_algorithm unittest_i2c_algo = {
2437	.master_xfer	= unittest_i2c_master_xfer,
2438	.functionality	= unittest_i2c_functionality,
2439};
2440
2441static int unittest_i2c_bus_probe(struct platform_device *pdev)
2442{
2443	struct device *dev = &pdev->dev;
2444	struct device_node *np = dev->of_node;
2445	struct unittest_i2c_bus_data *std;
2446	struct i2c_adapter *adap;
2447	int ret;
2448
2449	if (np == NULL) {
2450		dev_err(dev, "No OF data for device\n");
2451		return -EINVAL;
2452
2453	}
2454
2455	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2456
2457	std = devm_kzalloc(dev, sizeof(*std), GFP_KERNEL);
2458	if (!std)
2459		return -ENOMEM;
2460
2461	/* link them together */
2462	std->pdev = pdev;
2463	platform_set_drvdata(pdev, std);
2464
2465	adap = &std->adap;
2466	i2c_set_adapdata(adap, std);
2467	adap->nr = -1;
2468	strscpy(adap->name, pdev->name, sizeof(adap->name));
2469	adap->class = I2C_CLASS_DEPRECATED;
2470	adap->algo = &unittest_i2c_algo;
2471	adap->dev.parent = dev;
2472	adap->dev.of_node = dev->of_node;
2473	adap->timeout = 5 * HZ;
2474	adap->retries = 3;
2475
2476	ret = i2c_add_numbered_adapter(adap);
2477	if (ret != 0) {
2478		dev_err(dev, "Failed to add I2C adapter\n");
2479		return ret;
2480	}
2481
2482	return 0;
2483}
2484
2485static int unittest_i2c_bus_remove(struct platform_device *pdev)
2486{
2487	struct device *dev = &pdev->dev;
2488	struct device_node *np = dev->of_node;
2489	struct unittest_i2c_bus_data *std = platform_get_drvdata(pdev);
2490
2491	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2492	i2c_del_adapter(&std->adap);
2493
2494	return 0;
2495}
2496
2497static const struct of_device_id unittest_i2c_bus_match[] = {
2498	{ .compatible = "unittest-i2c-bus", },
2499	{},
2500};
2501
2502static struct platform_driver unittest_i2c_bus_driver = {
2503	.probe			= unittest_i2c_bus_probe,
2504	.remove			= unittest_i2c_bus_remove,
2505	.driver = {
2506		.name		= "unittest-i2c-bus",
2507		.of_match_table	= of_match_ptr(unittest_i2c_bus_match),
2508	},
2509};
2510
2511static int unittest_i2c_dev_probe(struct i2c_client *client)
 
2512{
2513	struct device *dev = &client->dev;
2514	struct device_node *np = client->dev.of_node;
2515
2516	if (!np) {
2517		dev_err(dev, "No OF node\n");
2518		return -EINVAL;
2519	}
2520
2521	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2522
2523	return 0;
2524};
2525
2526static void unittest_i2c_dev_remove(struct i2c_client *client)
2527{
2528	struct device *dev = &client->dev;
2529	struct device_node *np = client->dev.of_node;
2530
2531	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
 
2532}
2533
2534static const struct i2c_device_id unittest_i2c_dev_id[] = {
2535	{ .name = "unittest-i2c-dev" },
2536	{ }
2537};
2538
2539static struct i2c_driver unittest_i2c_dev_driver = {
2540	.driver = {
2541		.name = "unittest-i2c-dev",
2542	},
2543	.probe_new = unittest_i2c_dev_probe,
2544	.remove = unittest_i2c_dev_remove,
2545	.id_table = unittest_i2c_dev_id,
2546};
2547
2548#if IS_BUILTIN(CONFIG_I2C_MUX)
2549
2550static int unittest_i2c_mux_select_chan(struct i2c_mux_core *muxc, u32 chan)
2551{
2552	return 0;
2553}
2554
2555static int unittest_i2c_mux_probe(struct i2c_client *client)
 
2556{
2557	int i, nchans;
2558	struct device *dev = &client->dev;
2559	struct i2c_adapter *adap = client->adapter;
2560	struct device_node *np = client->dev.of_node, *child;
2561	struct i2c_mux_core *muxc;
2562	u32 reg, max_reg;
2563
2564	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2565
2566	if (!np) {
2567		dev_err(dev, "No OF node\n");
2568		return -EINVAL;
2569	}
2570
2571	max_reg = (u32)-1;
2572	for_each_child_of_node(np, child) {
2573		if (of_property_read_u32(child, "reg", &reg))
2574			continue;
2575		if (max_reg == (u32)-1 || reg > max_reg)
2576			max_reg = reg;
2577	}
2578	nchans = max_reg == (u32)-1 ? 0 : max_reg + 1;
2579	if (nchans == 0) {
2580		dev_err(dev, "No channels\n");
2581		return -EINVAL;
2582	}
2583
2584	muxc = i2c_mux_alloc(adap, dev, nchans, 0, 0,
2585			     unittest_i2c_mux_select_chan, NULL);
2586	if (!muxc)
2587		return -ENOMEM;
2588	for (i = 0; i < nchans; i++) {
2589		if (i2c_mux_add_adapter(muxc, 0, i, 0)) {
2590			dev_err(dev, "Failed to register mux #%d\n", i);
2591			i2c_mux_del_adapters(muxc);
2592			return -ENODEV;
2593		}
2594	}
2595
2596	i2c_set_clientdata(client, muxc);
2597
2598	return 0;
2599};
2600
2601static void unittest_i2c_mux_remove(struct i2c_client *client)
2602{
2603	struct device *dev = &client->dev;
2604	struct device_node *np = client->dev.of_node;
2605	struct i2c_mux_core *muxc = i2c_get_clientdata(client);
2606
2607	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2608	i2c_mux_del_adapters(muxc);
 
2609}
2610
2611static const struct i2c_device_id unittest_i2c_mux_id[] = {
2612	{ .name = "unittest-i2c-mux" },
2613	{ }
2614};
2615
2616static struct i2c_driver unittest_i2c_mux_driver = {
2617	.driver = {
2618		.name = "unittest-i2c-mux",
2619	},
2620	.probe_new = unittest_i2c_mux_probe,
2621	.remove = unittest_i2c_mux_remove,
2622	.id_table = unittest_i2c_mux_id,
2623};
2624
2625#endif
2626
2627static int of_unittest_overlay_i2c_init(void)
2628{
2629	int ret;
2630
2631	ret = i2c_add_driver(&unittest_i2c_dev_driver);
2632	if (unittest(ret == 0,
2633			"could not register unittest i2c device driver\n"))
2634		return ret;
2635
2636	ret = platform_driver_register(&unittest_i2c_bus_driver);
2637
2638	if (unittest(ret == 0,
2639			"could not register unittest i2c bus driver\n"))
2640		return ret;
2641
2642#if IS_BUILTIN(CONFIG_I2C_MUX)
2643
2644	EXPECT_BEGIN(KERN_INFO,
2645		     "i2c i2c-1: Added multiplexed i2c bus 2");
2646
2647	ret = i2c_add_driver(&unittest_i2c_mux_driver);
2648
2649	EXPECT_END(KERN_INFO,
2650		   "i2c i2c-1: Added multiplexed i2c bus 2");
2651
2652	if (unittest(ret == 0,
2653			"could not register unittest i2c mux driver\n"))
2654		return ret;
2655#endif
2656
2657	return 0;
2658}
2659
2660static void of_unittest_overlay_i2c_cleanup(void)
2661{
2662#if IS_BUILTIN(CONFIG_I2C_MUX)
2663	i2c_del_driver(&unittest_i2c_mux_driver);
2664#endif
2665	platform_driver_unregister(&unittest_i2c_bus_driver);
2666	i2c_del_driver(&unittest_i2c_dev_driver);
2667}
2668
2669static void __init of_unittest_overlay_i2c_12(void)
2670{
2671	int ret;
2672
2673	/* device should enable */
2674	EXPECT_BEGIN(KERN_INFO,
2675		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/i2c-test-bus/test-unittest12/status");
2676
2677	ret = of_unittest_apply_overlay_check(12, 12, 0, 1, I2C_OVERLAY);
2678
2679	EXPECT_END(KERN_INFO,
2680		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/i2c-test-bus/test-unittest12/status");
2681
2682	if (ret)
2683		return;
2684
2685	unittest(1, "overlay test %d passed\n", 12);
2686}
2687
2688/* test deactivation of device */
2689static void __init of_unittest_overlay_i2c_13(void)
2690{
2691	int ret;
2692
2693	EXPECT_BEGIN(KERN_INFO,
2694		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/i2c-test-bus/test-unittest13/status");
2695
2696	/* device should disable */
2697	ret = of_unittest_apply_overlay_check(13, 13, 1, 0, I2C_OVERLAY);
2698
2699	EXPECT_END(KERN_INFO,
2700		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/i2c-test-bus/test-unittest13/status");
2701
2702	if (ret)
2703		return;
2704
2705	unittest(1, "overlay test %d passed\n", 13);
2706}
2707
2708/* just check for i2c mux existence */
2709static void of_unittest_overlay_i2c_14(void)
2710{
2711}
2712
2713static void __init of_unittest_overlay_i2c_15(void)
2714{
2715	int ret;
2716
2717	/* device should enable */
2718	EXPECT_BEGIN(KERN_INFO,
2719		     "i2c i2c-1: Added multiplexed i2c bus 3");
2720
2721	ret = of_unittest_apply_overlay_check(15, 15, 0, 1, I2C_OVERLAY);
2722
2723	EXPECT_END(KERN_INFO,
2724		   "i2c i2c-1: Added multiplexed i2c bus 3");
2725
2726	if (ret)
2727		return;
2728
2729	unittest(1, "overlay test %d passed\n", 15);
2730}
2731
2732#else
2733
2734static inline void of_unittest_overlay_i2c_14(void) { }
2735static inline void of_unittest_overlay_i2c_15(void) { }
2736
2737#endif
2738
2739static int of_notify(struct notifier_block *nb, unsigned long action,
2740		     void *arg)
2741{
2742	struct of_overlay_notify_data *nd = arg;
2743	struct device_node *found;
2744	int ret;
2745
2746	/*
2747	 * For overlay_16 .. overlay_19, check that returning an error
2748	 * works for each of the actions by setting an arbitrary return
2749	 * error number that matches the test number.  e.g. for unittest16,
2750	 * ret = -EBUSY which is -16.
2751	 *
2752	 * OVERLAY_INFO() for the overlays is declared to expect the same
2753	 * error number, so overlay_data_apply() will return no error.
2754	 *
2755	 * overlay_20 will return NOTIFY_DONE
2756	 */
2757
2758	ret = 0;
2759	of_node_get(nd->overlay);
2760
2761	switch (action) {
2762
2763	case OF_OVERLAY_PRE_APPLY:
2764		found = of_find_node_by_name(nd->overlay, "test-unittest16");
2765		if (found) {
2766			of_node_put(found);
2767			ret = -EBUSY;
2768		}
2769		break;
2770
2771	case OF_OVERLAY_POST_APPLY:
2772		found = of_find_node_by_name(nd->overlay, "test-unittest17");
2773		if (found) {
2774			of_node_put(found);
2775			ret = -EEXIST;
2776		}
2777		break;
2778
2779	case OF_OVERLAY_PRE_REMOVE:
2780		found = of_find_node_by_name(nd->overlay, "test-unittest18");
2781		if (found) {
2782			of_node_put(found);
2783			ret = -EXDEV;
2784		}
2785		break;
2786
2787	case OF_OVERLAY_POST_REMOVE:
2788		found = of_find_node_by_name(nd->overlay, "test-unittest19");
2789		if (found) {
2790			of_node_put(found);
2791			ret = -ENODEV;
2792		}
2793		break;
2794
2795	default:			/* should not happen */
2796		of_node_put(nd->overlay);
2797		ret = -EINVAL;
2798		break;
2799	}
2800
2801	if (ret)
2802		return notifier_from_errno(ret);
2803
2804	return NOTIFY_DONE;
2805}
2806
2807static struct notifier_block of_nb = {
2808	.notifier_call = of_notify,
2809};
2810
2811static void __init of_unittest_overlay_notify(void)
2812{
2813	int ovcs_id;
2814	int ret;
2815
2816	ret = of_overlay_notifier_register(&of_nb);
2817	unittest(!ret,
2818		 "of_overlay_notifier_register() failed, ret = %d\n", ret);
2819	if (ret)
2820		return;
2821
2822	/*
2823	 * The overlays are applied by overlay_data_apply()
2824	 * instead of of_unittest_apply_overlay() so that they
2825	 * will not be tracked.  Thus they will not be removed
2826	 * by of_unittest_remove_tracked_overlays().
2827	 *
2828	 * Applying overlays 16 - 19 will each trigger an error for a
2829	 * different action in of_notify().
2830	 *
2831	 * Applying overlay 20 will not trigger any error in of_notify().
2832	 */
2833
2834	/* ---  overlay 16  --- */
2835
2836	EXPECT_BEGIN(KERN_INFO, "OF: overlay: overlay changeset pre-apply notifier error -16, target: /testcase-data/overlay-node/test-bus");
2837
2838	unittest(overlay_data_apply("overlay_16", &ovcs_id),
2839		 "test OF_OVERLAY_PRE_APPLY notify injected error\n");
2840
2841	EXPECT_END(KERN_INFO, "OF: overlay: overlay changeset pre-apply notifier error -16, target: /testcase-data/overlay-node/test-bus");
2842
2843	unittest(ovcs_id, "ovcs_id not created for overlay_16\n");
2844
2845	/* ---  overlay 17  --- */
2846
2847	EXPECT_BEGIN(KERN_INFO, "OF: overlay: overlay changeset post-apply notifier error -17, target: /testcase-data/overlay-node/test-bus");
2848
2849	unittest(overlay_data_apply("overlay_17", &ovcs_id),
2850		 "test OF_OVERLAY_POST_APPLY notify injected error\n");
2851
2852	EXPECT_END(KERN_INFO, "OF: overlay: overlay changeset post-apply notifier error -17, target: /testcase-data/overlay-node/test-bus");
2853
2854	unittest(ovcs_id, "ovcs_id not created for overlay_17\n");
2855
2856	if (ovcs_id) {
2857		ret = of_overlay_remove(&ovcs_id);
2858		unittest(!ret,
2859			"overlay_17 of_overlay_remove(), ret = %d\n", ret);
2860	}
2861
2862	/* ---  overlay 18  --- */
2863
2864	unittest(overlay_data_apply("overlay_18", &ovcs_id),
2865		 "OF_OVERLAY_PRE_REMOVE notify injected error\n");
2866
2867	unittest(ovcs_id, "ovcs_id not created for overlay_18\n");
2868
2869	if (ovcs_id) {
2870		EXPECT_BEGIN(KERN_INFO, "OF: overlay: overlay changeset pre-remove notifier error -18, target: /testcase-data/overlay-node/test-bus");
2871
2872		ret = of_overlay_remove(&ovcs_id);
2873		EXPECT_END(KERN_INFO, "OF: overlay: overlay changeset pre-remove notifier error -18, target: /testcase-data/overlay-node/test-bus");
2874		if (ret == -EXDEV) {
2875			/*
2876			 * change set ovcs_id should still exist
2877			 */
2878			unittest(1, "overlay_18 of_overlay_remove() injected error for OF_OVERLAY_PRE_REMOVE\n");
2879		} else {
2880			unittest(0, "overlay_18 of_overlay_remove() injected error for OF_OVERLAY_PRE_REMOVE not returned\n");
2881		}
2882	} else {
2883		unittest(1, "ovcs_id not created for overlay_18\n");
2884	}
2885
2886	unittest(ovcs_id, "ovcs_id removed for overlay_18\n");
2887
2888	/* ---  overlay 19  --- */
2889
2890	unittest(overlay_data_apply("overlay_19", &ovcs_id),
2891		 "OF_OVERLAY_POST_REMOVE notify injected error\n");
2892
2893	unittest(ovcs_id, "ovcs_id not created for overlay_19\n");
2894
2895	if (ovcs_id) {
2896		EXPECT_BEGIN(KERN_INFO, "OF: overlay: overlay changeset post-remove notifier error -19, target: /testcase-data/overlay-node/test-bus");
2897		ret = of_overlay_remove(&ovcs_id);
2898		EXPECT_END(KERN_INFO, "OF: overlay: overlay changeset post-remove notifier error -19, target: /testcase-data/overlay-node/test-bus");
2899		if (ret == -ENODEV)
2900			unittest(1, "overlay_19 of_overlay_remove() injected error for OF_OVERLAY_POST_REMOVE\n");
2901		else
2902			unittest(0, "overlay_19 of_overlay_remove() injected error for OF_OVERLAY_POST_REMOVE not returned\n");
2903	} else {
2904		unittest(1, "ovcs_id removed for overlay_19\n");
2905	}
2906
2907	unittest(!ovcs_id, "changeset ovcs_id = %d not removed for overlay_19\n",
2908		 ovcs_id);
2909
2910	/* ---  overlay 20  --- */
2911
2912	unittest(overlay_data_apply("overlay_20", &ovcs_id),
2913		 "overlay notify no injected error\n");
2914
2915	if (ovcs_id) {
2916		ret = of_overlay_remove(&ovcs_id);
2917		if (ret)
2918			unittest(1, "overlay_20 failed to be destroyed, ret = %d\n",
2919				 ret);
2920	} else {
2921		unittest(1, "ovcs_id not created for overlay_20\n");
2922	}
2923
2924	unittest(!of_overlay_notifier_unregister(&of_nb),
2925		 "of_overlay_notifier_unregister() failed, ret = %d\n", ret);
2926}
2927
2928static void __init of_unittest_overlay(void)
2929{
2930	struct device_node *bus_np = NULL;
2931
2932	if (platform_driver_register(&unittest_driver)) {
2933		unittest(0, "could not register unittest driver\n");
2934		goto out;
2935	}
2936
2937	bus_np = of_find_node_by_path(bus_path);
2938	if (bus_np == NULL) {
2939		unittest(0, "could not find bus_path \"%s\"\n", bus_path);
2940		goto out;
2941	}
2942
2943	if (of_platform_default_populate(bus_np, NULL, NULL)) {
2944		unittest(0, "could not populate bus @ \"%s\"\n", bus_path);
2945		goto out;
2946	}
2947
2948	if (!of_unittest_device_exists(100, PDEV_OVERLAY)) {
2949		unittest(0, "could not find unittest0 @ \"%s\"\n",
2950				unittest_path(100, PDEV_OVERLAY));
2951		goto out;
2952	}
2953
2954	if (of_unittest_device_exists(101, PDEV_OVERLAY)) {
2955		unittest(0, "unittest1 @ \"%s\" should not exist\n",
2956				unittest_path(101, PDEV_OVERLAY));
2957		goto out;
2958	}
2959
2960	unittest(1, "basic infrastructure of overlays passed");
2961
2962	/* tests in sequence */
2963	of_unittest_overlay_0();
2964	of_unittest_overlay_1();
2965	of_unittest_overlay_2();
2966	of_unittest_overlay_3();
2967	of_unittest_overlay_4();
2968	of_unittest_overlay_5();
2969	of_unittest_overlay_6();
2970	of_unittest_overlay_8();
2971
2972	of_unittest_overlay_10();
2973	of_unittest_overlay_11();
2974
2975#if IS_BUILTIN(CONFIG_I2C)
2976	if (unittest(of_unittest_overlay_i2c_init() == 0, "i2c init failed\n"))
2977		goto out;
2978
2979	of_unittest_overlay_i2c_12();
2980	of_unittest_overlay_i2c_13();
2981	of_unittest_overlay_i2c_14();
2982	of_unittest_overlay_i2c_15();
2983
2984	of_unittest_overlay_i2c_cleanup();
2985#endif
2986
2987	of_unittest_overlay_gpio();
2988
2989	of_unittest_remove_tracked_overlays();
2990
2991	of_unittest_overlay_notify();
2992
2993out:
2994	of_node_put(bus_np);
2995}
2996
2997#else
2998static inline void __init of_unittest_overlay(void) { }
2999#endif
3000
3001#ifdef CONFIG_OF_OVERLAY
3002
3003/*
3004 * __dtbo_##overlay_name##_begin[] and __dtbo_##overlay_name##_end[] are
3005 * created by cmd_dt_S_dtbo in scripts/Makefile.lib
3006 */
3007
3008#define OVERLAY_INFO_EXTERN(overlay_name) \
3009	extern uint8_t __dtbo_##overlay_name##_begin[]; \
3010	extern uint8_t __dtbo_##overlay_name##_end[]
3011
3012#define OVERLAY_INFO(overlay_name, expected) \
3013{	.dtbo_begin       = __dtbo_##overlay_name##_begin, \
3014	.dtbo_end         = __dtbo_##overlay_name##_end, \
3015	.expected_result = expected, \
3016	.name            = #overlay_name, \
3017}
3018
3019struct overlay_info {
3020	uint8_t		*dtbo_begin;
3021	uint8_t		*dtbo_end;
3022	int		expected_result;
3023	int		ovcs_id;
3024	char		*name;
3025};
3026
3027OVERLAY_INFO_EXTERN(overlay_base);
3028OVERLAY_INFO_EXTERN(overlay);
3029OVERLAY_INFO_EXTERN(overlay_0);
3030OVERLAY_INFO_EXTERN(overlay_1);
3031OVERLAY_INFO_EXTERN(overlay_2);
3032OVERLAY_INFO_EXTERN(overlay_3);
3033OVERLAY_INFO_EXTERN(overlay_4);
3034OVERLAY_INFO_EXTERN(overlay_5);
3035OVERLAY_INFO_EXTERN(overlay_6);
3036OVERLAY_INFO_EXTERN(overlay_7);
3037OVERLAY_INFO_EXTERN(overlay_8);
3038OVERLAY_INFO_EXTERN(overlay_9);
3039OVERLAY_INFO_EXTERN(overlay_10);
3040OVERLAY_INFO_EXTERN(overlay_11);
3041OVERLAY_INFO_EXTERN(overlay_12);
3042OVERLAY_INFO_EXTERN(overlay_13);
3043OVERLAY_INFO_EXTERN(overlay_15);
3044OVERLAY_INFO_EXTERN(overlay_16);
3045OVERLAY_INFO_EXTERN(overlay_17);
3046OVERLAY_INFO_EXTERN(overlay_18);
3047OVERLAY_INFO_EXTERN(overlay_19);
3048OVERLAY_INFO_EXTERN(overlay_20);
3049OVERLAY_INFO_EXTERN(overlay_gpio_01);
3050OVERLAY_INFO_EXTERN(overlay_gpio_02a);
3051OVERLAY_INFO_EXTERN(overlay_gpio_02b);
3052OVERLAY_INFO_EXTERN(overlay_gpio_03);
3053OVERLAY_INFO_EXTERN(overlay_gpio_04a);
3054OVERLAY_INFO_EXTERN(overlay_gpio_04b);
3055OVERLAY_INFO_EXTERN(overlay_bad_add_dup_node);
3056OVERLAY_INFO_EXTERN(overlay_bad_add_dup_prop);
3057OVERLAY_INFO_EXTERN(overlay_bad_phandle);
3058OVERLAY_INFO_EXTERN(overlay_bad_symbol);
3059
3060/* entries found by name */
3061static struct overlay_info overlays[] = {
3062	OVERLAY_INFO(overlay_base, -9999),
3063	OVERLAY_INFO(overlay, 0),
3064	OVERLAY_INFO(overlay_0, 0),
3065	OVERLAY_INFO(overlay_1, 0),
3066	OVERLAY_INFO(overlay_2, 0),
3067	OVERLAY_INFO(overlay_3, 0),
3068	OVERLAY_INFO(overlay_4, 0),
3069	OVERLAY_INFO(overlay_5, 0),
3070	OVERLAY_INFO(overlay_6, 0),
3071	OVERLAY_INFO(overlay_7, 0),
3072	OVERLAY_INFO(overlay_8, 0),
3073	OVERLAY_INFO(overlay_9, 0),
3074	OVERLAY_INFO(overlay_10, 0),
3075	OVERLAY_INFO(overlay_11, 0),
3076	OVERLAY_INFO(overlay_12, 0),
3077	OVERLAY_INFO(overlay_13, 0),
3078	OVERLAY_INFO(overlay_15, 0),
3079	OVERLAY_INFO(overlay_16, -EBUSY),
3080	OVERLAY_INFO(overlay_17, -EEXIST),
3081	OVERLAY_INFO(overlay_18, 0),
3082	OVERLAY_INFO(overlay_19, 0),
3083	OVERLAY_INFO(overlay_20, 0),
3084	OVERLAY_INFO(overlay_gpio_01, 0),
3085	OVERLAY_INFO(overlay_gpio_02a, 0),
3086	OVERLAY_INFO(overlay_gpio_02b, 0),
3087	OVERLAY_INFO(overlay_gpio_03, 0),
3088	OVERLAY_INFO(overlay_gpio_04a, 0),
3089	OVERLAY_INFO(overlay_gpio_04b, 0),
3090	OVERLAY_INFO(overlay_bad_add_dup_node, -EINVAL),
3091	OVERLAY_INFO(overlay_bad_add_dup_prop, -EINVAL),
3092	OVERLAY_INFO(overlay_bad_phandle, -EINVAL),
3093	OVERLAY_INFO(overlay_bad_symbol, -EINVAL),
3094	/* end marker */
3095	{.dtbo_begin = NULL, .dtbo_end = NULL, .expected_result = 0, .name = NULL}
3096};
3097
3098static struct device_node *overlay_base_root;
3099
3100static void * __init dt_alloc_memory(u64 size, u64 align)
3101{
3102	void *ptr = memblock_alloc(size, align);
3103
3104	if (!ptr)
3105		panic("%s: Failed to allocate %llu bytes align=0x%llx\n",
3106		      __func__, size, align);
3107
3108	return ptr;
3109}
3110
3111/*
3112 * Create base device tree for the overlay unittest.
3113 *
3114 * This is called from very early boot code.
3115 *
3116 * Do as much as possible the same way as done in __unflatten_device_tree
3117 * and other early boot steps for the normal FDT so that the overlay base
3118 * unflattened tree will have the same characteristics as the real tree
3119 * (such as having memory allocated by the early allocator).  The goal
3120 * is to test "the real thing" as much as possible, and test "test setup
3121 * code" as little as possible.
3122 *
3123 * Have to stop before resolving phandles, because that uses kmalloc.
3124 */
3125void __init unittest_unflatten_overlay_base(void)
3126{
3127	struct overlay_info *info;
3128	u32 data_size;
3129	void *new_fdt;
3130	u32 size;
3131	int found = 0;
3132	const char *overlay_name = "overlay_base";
3133
3134	for (info = overlays; info && info->name; info++) {
3135		if (!strcmp(overlay_name, info->name)) {
3136			found = 1;
3137			break;
3138		}
3139	}
3140	if (!found) {
3141		pr_err("no overlay data for %s\n", overlay_name);
3142		return;
3143	}
3144
3145	info = &overlays[0];
3146
3147	if (info->expected_result != -9999) {
3148		pr_err("No dtb 'overlay_base' to attach\n");
3149		return;
3150	}
3151
3152	data_size = info->dtbo_end - info->dtbo_begin;
3153	if (!data_size) {
3154		pr_err("No dtb 'overlay_base' to attach\n");
3155		return;
3156	}
3157
3158	size = fdt_totalsize(info->dtbo_begin);
3159	if (size != data_size) {
3160		pr_err("dtb 'overlay_base' header totalsize != actual size");
3161		return;
3162	}
3163
3164	new_fdt = dt_alloc_memory(size, roundup_pow_of_two(FDT_V17_SIZE));
3165	if (!new_fdt) {
3166		pr_err("alloc for dtb 'overlay_base' failed");
3167		return;
3168	}
3169
3170	memcpy(new_fdt, info->dtbo_begin, size);
3171
3172	__unflatten_device_tree(new_fdt, NULL, &overlay_base_root,
3173				dt_alloc_memory, true);
3174}
3175
3176/*
3177 * The purpose of of_unittest_overlay_data_add is to add an
3178 * overlay in the normal fashion.  This is a test of the whole
3179 * picture, instead of testing individual elements.
3180 *
3181 * A secondary purpose is to be able to verify that the contents of
3182 * /proc/device-tree/ contains the updated structure and values from
3183 * the overlay.  That must be verified separately in user space.
3184 *
3185 * Return 0 on unexpected error.
3186 */
3187static int __init overlay_data_apply(const char *overlay_name, int *ovcs_id)
3188{
3189	struct overlay_info *info;
3190	int found = 0;
3191	int ret;
3192	u32 size;
3193
3194	for (info = overlays; info && info->name; info++) {
3195		if (!strcmp(overlay_name, info->name)) {
3196			found = 1;
3197			break;
3198		}
3199	}
3200	if (!found) {
3201		pr_err("no overlay data for %s\n", overlay_name);
3202		return 0;
3203	}
3204
3205	size = info->dtbo_end - info->dtbo_begin;
3206	if (!size)
3207		pr_err("no overlay data for %s\n", overlay_name);
3208
3209	ret = of_overlay_fdt_apply(info->dtbo_begin, size, &info->ovcs_id);
3210	if (ovcs_id)
3211		*ovcs_id = info->ovcs_id;
3212	if (ret < 0)
3213		goto out;
3214
3215	pr_debug("%s applied\n", overlay_name);
3216
3217out:
3218	if (ret != info->expected_result)
3219		pr_err("of_overlay_fdt_apply() expected %d, ret=%d, %s\n",
3220		       info->expected_result, ret, overlay_name);
3221
3222	return (ret == info->expected_result);
3223}
3224
3225/*
3226 * The purpose of of_unittest_overlay_high_level is to add an overlay
3227 * in the normal fashion.  This is a test of the whole picture,
3228 * instead of individual elements.
3229 *
3230 * The first part of the function is _not_ normal overlay usage; it is
3231 * finishing splicing the base overlay device tree into the live tree.
3232 */
3233static __init void of_unittest_overlay_high_level(void)
3234{
3235	struct device_node *last_sibling;
3236	struct device_node *np;
3237	struct device_node *of_symbols;
3238	struct device_node *overlay_base_symbols;
3239	struct device_node **pprev;
3240	struct property *prop;
3241	int ret;
3242
3243	if (!overlay_base_root) {
3244		unittest(0, "overlay_base_root not initialized\n");
3245		return;
3246	}
3247
3248	/*
3249	 * Could not fixup phandles in unittest_unflatten_overlay_base()
3250	 * because kmalloc() was not yet available.
3251	 */
3252	of_overlay_mutex_lock();
3253	of_resolve_phandles(overlay_base_root);
3254	of_overlay_mutex_unlock();
3255
3256
3257	/*
3258	 * do not allow overlay_base to duplicate any node already in
3259	 * tree, this greatly simplifies the code
3260	 */
3261
3262	/*
3263	 * remove overlay_base_root node "__local_fixups", after
3264	 * being used by of_resolve_phandles()
3265	 */
3266	pprev = &overlay_base_root->child;
3267	for (np = overlay_base_root->child; np; np = np->sibling) {
3268		if (of_node_name_eq(np, "__local_fixups__")) {
3269			*pprev = np->sibling;
3270			break;
3271		}
3272		pprev = &np->sibling;
3273	}
3274
3275	/* remove overlay_base_root node "__symbols__" if in live tree */
3276	of_symbols = of_get_child_by_name(of_root, "__symbols__");
3277	if (of_symbols) {
3278		/* will have to graft properties from node into live tree */
3279		pprev = &overlay_base_root->child;
3280		for (np = overlay_base_root->child; np; np = np->sibling) {
3281			if (of_node_name_eq(np, "__symbols__")) {
3282				overlay_base_symbols = np;
3283				*pprev = np->sibling;
3284				break;
3285			}
3286			pprev = &np->sibling;
3287		}
3288	}
3289
3290	for_each_child_of_node(overlay_base_root, np) {
3291		struct device_node *base_child;
3292		for_each_child_of_node(of_root, base_child) {
3293			if (!strcmp(np->full_name, base_child->full_name)) {
3294				unittest(0, "illegal node name in overlay_base %pOFn",
3295					 np);
3296				of_node_put(np);
3297				of_node_put(base_child);
3298				return;
3299			}
3300		}
3301	}
3302
3303	/*
3304	 * overlay 'overlay_base' is not allowed to have root
3305	 * properties, so only need to splice nodes into main device tree.
3306	 *
3307	 * root node of *overlay_base_root will not be freed, it is lost
3308	 * memory.
3309	 */
3310
3311	for (np = overlay_base_root->child; np; np = np->sibling)
3312		np->parent = of_root;
3313
3314	mutex_lock(&of_mutex);
3315
3316	for (last_sibling = np = of_root->child; np; np = np->sibling)
3317		last_sibling = np;
3318
3319	if (last_sibling)
3320		last_sibling->sibling = overlay_base_root->child;
3321	else
3322		of_root->child = overlay_base_root->child;
3323
3324	for_each_of_allnodes_from(overlay_base_root, np)
3325		__of_attach_node_sysfs(np);
3326
3327	if (of_symbols) {
3328		struct property *new_prop;
3329		for_each_property_of_node(overlay_base_symbols, prop) {
3330
3331			new_prop = __of_prop_dup(prop, GFP_KERNEL);
3332			if (!new_prop) {
3333				unittest(0, "__of_prop_dup() of '%s' from overlay_base node __symbols__",
3334					 prop->name);
3335				goto err_unlock;
3336			}
3337			if (__of_add_property(of_symbols, new_prop)) {
3338				kfree(new_prop->name);
3339				kfree(new_prop->value);
3340				kfree(new_prop);
3341				/* "name" auto-generated by unflatten */
3342				if (!strcmp(prop->name, "name"))
3343					continue;
3344				unittest(0, "duplicate property '%s' in overlay_base node __symbols__",
3345					 prop->name);
3346				goto err_unlock;
3347			}
3348			if (__of_add_property_sysfs(of_symbols, new_prop)) {
3349				unittest(0, "unable to add property '%s' in overlay_base node __symbols__ to sysfs",
3350					 prop->name);
3351				goto err_unlock;
3352			}
3353		}
3354	}
3355
3356	mutex_unlock(&of_mutex);
3357
3358
3359	/* now do the normal overlay usage test */
3360
3361	EXPECT_BEGIN(KERN_ERR,
3362		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/substation@100/status");
3363	EXPECT_BEGIN(KERN_ERR,
3364		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/status");
3365	EXPECT_BEGIN(KERN_ERR,
3366		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/ride@100/track@30/incline-up");
3367	EXPECT_BEGIN(KERN_ERR,
3368		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/ride@100/track@40/incline-up");
3369	EXPECT_BEGIN(KERN_ERR,
3370		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/status");
3371	EXPECT_BEGIN(KERN_ERR,
3372		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/color");
3373	EXPECT_BEGIN(KERN_ERR,
3374		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/rate");
3375	EXPECT_BEGIN(KERN_ERR,
3376		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/hvac_2");
3377	EXPECT_BEGIN(KERN_ERR,
3378		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200");
3379	EXPECT_BEGIN(KERN_ERR,
3380		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200_left");
3381	EXPECT_BEGIN(KERN_ERR,
3382		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200_right");
3383
3384	ret = overlay_data_apply("overlay", NULL);
3385
3386	EXPECT_END(KERN_ERR,
3387		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200_right");
3388	EXPECT_END(KERN_ERR,
3389		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200_left");
3390	EXPECT_END(KERN_ERR,
3391		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200");
3392	EXPECT_END(KERN_ERR,
3393		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/hvac_2");
3394	EXPECT_END(KERN_ERR,
3395		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/rate");
3396	EXPECT_END(KERN_ERR,
3397		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/color");
3398	EXPECT_END(KERN_ERR,
3399		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/status");
3400	EXPECT_END(KERN_ERR,
3401		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/ride@100/track@40/incline-up");
3402	EXPECT_END(KERN_ERR,
3403		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/ride@100/track@30/incline-up");
3404	EXPECT_END(KERN_ERR,
3405		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/status");
3406	EXPECT_END(KERN_ERR,
3407		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/substation@100/status");
3408
3409	unittest(ret, "Adding overlay 'overlay' failed\n");
3410
3411	EXPECT_BEGIN(KERN_ERR,
3412		     "OF: overlay: ERROR: multiple fragments add and/or delete node /testcase-data-2/substation@100/motor-1/controller");
3413	EXPECT_BEGIN(KERN_ERR,
3414		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/controller/name");
3415
3416	unittest(overlay_data_apply("overlay_bad_add_dup_node", NULL),
3417		 "Adding overlay 'overlay_bad_add_dup_node' failed\n");
3418
3419	EXPECT_END(KERN_ERR,
3420		   "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/controller/name");
3421	EXPECT_END(KERN_ERR,
3422		   "OF: overlay: ERROR: multiple fragments add and/or delete node /testcase-data-2/substation@100/motor-1/controller");
3423
3424	EXPECT_BEGIN(KERN_ERR,
3425		     "OF: overlay: ERROR: multiple fragments add and/or delete node /testcase-data-2/substation@100/motor-1/electric");
3426	EXPECT_BEGIN(KERN_ERR,
3427		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/electric/rpm_avail");
3428	EXPECT_BEGIN(KERN_ERR,
3429		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/electric/name");
3430
3431	unittest(overlay_data_apply("overlay_bad_add_dup_prop", NULL),
3432		 "Adding overlay 'overlay_bad_add_dup_prop' failed\n");
3433
3434	EXPECT_END(KERN_ERR,
3435		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/electric/name");
3436	EXPECT_END(KERN_ERR,
3437		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/electric/rpm_avail");
3438	EXPECT_END(KERN_ERR,
3439		     "OF: overlay: ERROR: multiple fragments add and/or delete node /testcase-data-2/substation@100/motor-1/electric");
3440
3441	unittest(overlay_data_apply("overlay_bad_phandle", NULL),
3442		 "Adding overlay 'overlay_bad_phandle' failed\n");
3443
3444	unittest(overlay_data_apply("overlay_bad_symbol", NULL),
3445		 "Adding overlay 'overlay_bad_symbol' failed\n");
3446
3447	return;
3448
3449err_unlock:
3450	mutex_unlock(&of_mutex);
3451}
3452
3453#else
3454
3455static inline __init void of_unittest_overlay_high_level(void) {}
3456
3457#endif
3458
3459static int __init of_unittest(void)
3460{
3461	struct device_node *np;
3462	int res;
3463
3464	pr_info("start of unittest - you will see error messages\n");
3465
3466	/* Taint the kernel so we know we've run tests. */
3467	add_taint(TAINT_TEST, LOCKDEP_STILL_OK);
3468
3469	/* adding data for unittest */
3470
3471	if (IS_ENABLED(CONFIG_UML))
3472		unittest_unflatten_overlay_base();
3473
3474	res = unittest_data_add();
3475	if (res)
3476		return res;
3477	if (!of_aliases)
3478		of_aliases = of_find_node_by_path("/aliases");
3479
3480	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a");
3481	if (!np) {
3482		pr_info("No testcase data in device tree; not running tests\n");
3483		return 0;
3484	}
3485	of_node_put(np);
3486
3487	of_unittest_check_tree_linkage();
3488	of_unittest_check_phandles();
3489	of_unittest_find_node_by_name();
3490	of_unittest_dynamic();
3491	of_unittest_parse_phandle_with_args();
3492	of_unittest_parse_phandle_with_args_map();
3493	of_unittest_printf();
3494	of_unittest_property_string();
3495	of_unittest_property_copy();
3496	of_unittest_changeset();
3497	of_unittest_parse_interrupts();
3498	of_unittest_parse_interrupts_extended();
3499	of_unittest_dma_get_max_cpu_address();
3500	of_unittest_parse_dma_ranges();
3501	of_unittest_pci_dma_ranges();
3502	of_unittest_match_node();
3503	of_unittest_platform_populate();
3504	of_unittest_overlay();
3505
3506	/* Double check linkage after removing testcase data */
3507	of_unittest_check_tree_linkage();
3508
3509	of_unittest_overlay_high_level();
3510
3511	pr_info("end of unittest - %i passed, %i failed\n",
3512		unittest_results.passed, unittest_results.failed);
3513
3514	return 0;
3515}
3516late_initcall(of_unittest);
v5.9
   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * Self tests for device tree subsystem
   4 */
   5
   6#define pr_fmt(fmt) "### dt-test ### " fmt
   7
   8#include <linux/memblock.h>
   9#include <linux/clk.h>
 
  10#include <linux/err.h>
  11#include <linux/errno.h>
  12#include <linux/hashtable.h>
  13#include <linux/libfdt.h>
  14#include <linux/of.h>
  15#include <linux/of_address.h>
  16#include <linux/of_fdt.h>
  17#include <linux/of_irq.h>
  18#include <linux/of_platform.h>
  19#include <linux/list.h>
  20#include <linux/mutex.h>
  21#include <linux/slab.h>
  22#include <linux/device.h>
  23#include <linux/platform_device.h>
 
  24
  25#include <linux/i2c.h>
  26#include <linux/i2c-mux.h>
  27#include <linux/gpio/driver.h>
  28
  29#include <linux/bitops.h>
  30
  31#include "of_private.h"
  32
  33static struct unittest_results {
  34	int passed;
  35	int failed;
  36} unittest_results;
  37
  38#define unittest(result, fmt, ...) ({ \
  39	bool failed = !(result); \
  40	if (failed) { \
  41		unittest_results.failed++; \
  42		pr_err("FAIL %s():%i " fmt, __func__, __LINE__, ##__VA_ARGS__); \
  43	} else { \
  44		unittest_results.passed++; \
  45		pr_debug("pass %s():%i\n", __func__, __LINE__); \
  46	} \
  47	failed; \
  48})
  49
  50/*
  51 * Expected message may have a message level other than KERN_INFO.
  52 * Print the expected message only if the current loglevel will allow
  53 * the actual message to print.
  54 *
  55 * Do not use EXPECT_BEGIN() or EXPECT_END() for messages generated by
  56 * pr_debug().
  57 */
  58#define EXPECT_BEGIN(level, fmt, ...) \
  59	printk(level pr_fmt("EXPECT \\ : ") fmt, ##__VA_ARGS__)
  60
  61#define EXPECT_END(level, fmt, ...) \
  62	printk(level pr_fmt("EXPECT / : ") fmt, ##__VA_ARGS__)
  63
  64static void __init of_unittest_find_node_by_name(void)
  65{
  66	struct device_node *np;
  67	const char *options, *name;
  68
  69	np = of_find_node_by_path("/testcase-data");
  70	name = kasprintf(GFP_KERNEL, "%pOF", np);
  71	unittest(np && !strcmp("/testcase-data", name),
  72		"find /testcase-data failed\n");
  73	of_node_put(np);
  74	kfree(name);
  75
  76	/* Test if trailing '/' works */
  77	np = of_find_node_by_path("/testcase-data/");
  78	unittest(!np, "trailing '/' on /testcase-data/ should fail\n");
  79
  80	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a");
  81	name = kasprintf(GFP_KERNEL, "%pOF", np);
  82	unittest(np && !strcmp("/testcase-data/phandle-tests/consumer-a", name),
  83		"find /testcase-data/phandle-tests/consumer-a failed\n");
  84	of_node_put(np);
  85	kfree(name);
  86
  87	np = of_find_node_by_path("testcase-alias");
  88	name = kasprintf(GFP_KERNEL, "%pOF", np);
  89	unittest(np && !strcmp("/testcase-data", name),
  90		"find testcase-alias failed\n");
  91	of_node_put(np);
  92	kfree(name);
  93
  94	/* Test if trailing '/' works on aliases */
  95	np = of_find_node_by_path("testcase-alias/");
  96	unittest(!np, "trailing '/' on testcase-alias/ should fail\n");
  97
  98	np = of_find_node_by_path("testcase-alias/phandle-tests/consumer-a");
  99	name = kasprintf(GFP_KERNEL, "%pOF", np);
 100	unittest(np && !strcmp("/testcase-data/phandle-tests/consumer-a", name),
 101		"find testcase-alias/phandle-tests/consumer-a failed\n");
 102	of_node_put(np);
 103	kfree(name);
 104
 105	np = of_find_node_by_path("/testcase-data/missing-path");
 106	unittest(!np, "non-existent path returned node %pOF\n", np);
 107	of_node_put(np);
 108
 109	np = of_find_node_by_path("missing-alias");
 110	unittest(!np, "non-existent alias returned node %pOF\n", np);
 111	of_node_put(np);
 112
 113	np = of_find_node_by_path("testcase-alias/missing-path");
 114	unittest(!np, "non-existent alias with relative path returned node %pOF\n", np);
 115	of_node_put(np);
 116
 117	np = of_find_node_opts_by_path("/testcase-data:testoption", &options);
 118	unittest(np && !strcmp("testoption", options),
 119		 "option path test failed\n");
 120	of_node_put(np);
 121
 122	np = of_find_node_opts_by_path("/testcase-data:test/option", &options);
 123	unittest(np && !strcmp("test/option", options),
 124		 "option path test, subcase #1 failed\n");
 125	of_node_put(np);
 126
 127	np = of_find_node_opts_by_path("/testcase-data/testcase-device1:test/option", &options);
 128	unittest(np && !strcmp("test/option", options),
 129		 "option path test, subcase #2 failed\n");
 130	of_node_put(np);
 131
 132	np = of_find_node_opts_by_path("/testcase-data:testoption", NULL);
 133	unittest(np, "NULL option path test failed\n");
 134	of_node_put(np);
 135
 136	np = of_find_node_opts_by_path("testcase-alias:testaliasoption",
 137				       &options);
 138	unittest(np && !strcmp("testaliasoption", options),
 139		 "option alias path test failed\n");
 140	of_node_put(np);
 141
 142	np = of_find_node_opts_by_path("testcase-alias:test/alias/option",
 143				       &options);
 144	unittest(np && !strcmp("test/alias/option", options),
 145		 "option alias path test, subcase #1 failed\n");
 146	of_node_put(np);
 147
 148	np = of_find_node_opts_by_path("testcase-alias:testaliasoption", NULL);
 149	unittest(np, "NULL option alias path test failed\n");
 150	of_node_put(np);
 151
 152	options = "testoption";
 153	np = of_find_node_opts_by_path("testcase-alias", &options);
 154	unittest(np && !options, "option clearing test failed\n");
 155	of_node_put(np);
 156
 157	options = "testoption";
 158	np = of_find_node_opts_by_path("/", &options);
 159	unittest(np && !options, "option clearing root node test failed\n");
 160	of_node_put(np);
 161}
 162
 163static void __init of_unittest_dynamic(void)
 164{
 165	struct device_node *np;
 166	struct property *prop;
 167
 168	np = of_find_node_by_path("/testcase-data");
 169	if (!np) {
 170		pr_err("missing testcase data\n");
 171		return;
 172	}
 173
 174	/* Array of 4 properties for the purpose of testing */
 175	prop = kcalloc(4, sizeof(*prop), GFP_KERNEL);
 176	if (!prop) {
 177		unittest(0, "kzalloc() failed\n");
 178		return;
 179	}
 180
 181	/* Add a new property - should pass*/
 182	prop->name = "new-property";
 183	prop->value = "new-property-data";
 184	prop->length = strlen(prop->value) + 1;
 185	unittest(of_add_property(np, prop) == 0, "Adding a new property failed\n");
 186
 187	/* Try to add an existing property - should fail */
 188	prop++;
 189	prop->name = "new-property";
 190	prop->value = "new-property-data-should-fail";
 191	prop->length = strlen(prop->value) + 1;
 192	unittest(of_add_property(np, prop) != 0,
 193		 "Adding an existing property should have failed\n");
 194
 195	/* Try to modify an existing property - should pass */
 196	prop->value = "modify-property-data-should-pass";
 197	prop->length = strlen(prop->value) + 1;
 198	unittest(of_update_property(np, prop) == 0,
 199		 "Updating an existing property should have passed\n");
 200
 201	/* Try to modify non-existent property - should pass*/
 202	prop++;
 203	prop->name = "modify-property";
 204	prop->value = "modify-missing-property-data-should-pass";
 205	prop->length = strlen(prop->value) + 1;
 206	unittest(of_update_property(np, prop) == 0,
 207		 "Updating a missing property should have passed\n");
 208
 209	/* Remove property - should pass */
 210	unittest(of_remove_property(np, prop) == 0,
 211		 "Removing a property should have passed\n");
 212
 213	/* Adding very large property - should pass */
 214	prop++;
 215	prop->name = "large-property-PAGE_SIZEx8";
 216	prop->length = PAGE_SIZE * 8;
 217	prop->value = kzalloc(prop->length, GFP_KERNEL);
 218	unittest(prop->value != NULL, "Unable to allocate large buffer\n");
 219	if (prop->value)
 220		unittest(of_add_property(np, prop) == 0,
 221			 "Adding a large property should have passed\n");
 222}
 223
 224static int __init of_unittest_check_node_linkage(struct device_node *np)
 225{
 226	struct device_node *child;
 227	int count = 0, rc;
 228
 229	for_each_child_of_node(np, child) {
 230		if (child->parent != np) {
 231			pr_err("Child node %pOFn links to wrong parent %pOFn\n",
 232				 child, np);
 233			rc = -EINVAL;
 234			goto put_child;
 235		}
 236
 237		rc = of_unittest_check_node_linkage(child);
 238		if (rc < 0)
 239			goto put_child;
 240		count += rc;
 241	}
 242
 243	return count + 1;
 244put_child:
 245	of_node_put(child);
 246	return rc;
 247}
 248
 249static void __init of_unittest_check_tree_linkage(void)
 250{
 251	struct device_node *np;
 252	int allnode_count = 0, child_count;
 253
 254	if (!of_root)
 255		return;
 256
 257	for_each_of_allnodes(np)
 258		allnode_count++;
 259	child_count = of_unittest_check_node_linkage(of_root);
 260
 261	unittest(child_count > 0, "Device node data structure is corrupted\n");
 262	unittest(child_count == allnode_count,
 263		 "allnodes list size (%i) doesn't match sibling lists size (%i)\n",
 264		 allnode_count, child_count);
 265	pr_debug("allnodes list size (%i); sibling lists size (%i)\n", allnode_count, child_count);
 266}
 267
 268static void __init of_unittest_printf_one(struct device_node *np, const char *fmt,
 269					  const char *expected)
 270{
 271	unsigned char *buf;
 272	int buf_size;
 273	int size, i;
 274
 275	buf_size = strlen(expected) + 10;
 276	buf = kmalloc(buf_size, GFP_KERNEL);
 277	if (!buf)
 278		return;
 279
 280	/* Baseline; check conversion with a large size limit */
 281	memset(buf, 0xff, buf_size);
 282	size = snprintf(buf, buf_size - 2, fmt, np);
 283
 284	/* use strcmp() instead of strncmp() here to be absolutely sure strings match */
 285	unittest((strcmp(buf, expected) == 0) && (buf[size+1] == 0xff),
 286		"sprintf failed; fmt='%s' expected='%s' rslt='%s'\n",
 287		fmt, expected, buf);
 288
 289	/* Make sure length limits work */
 290	size++;
 291	for (i = 0; i < 2; i++, size--) {
 292		/* Clear the buffer, and make sure it works correctly still */
 293		memset(buf, 0xff, buf_size);
 294		snprintf(buf, size+1, fmt, np);
 295		unittest(strncmp(buf, expected, size) == 0 && (buf[size+1] == 0xff),
 296			"snprintf failed; size=%i fmt='%s' expected='%s' rslt='%s'\n",
 297			size, fmt, expected, buf);
 298	}
 299	kfree(buf);
 300}
 301
 302static void __init of_unittest_printf(void)
 303{
 304	struct device_node *np;
 305	const char *full_name = "/testcase-data/platform-tests/test-device@1/dev@100";
 306	char phandle_str[16] = "";
 307
 308	np = of_find_node_by_path(full_name);
 309	if (!np) {
 310		unittest(np, "testcase data missing\n");
 311		return;
 312	}
 313
 314	num_to_str(phandle_str, sizeof(phandle_str), np->phandle, 0);
 315
 316	of_unittest_printf_one(np, "%pOF",  full_name);
 317	of_unittest_printf_one(np, "%pOFf", full_name);
 318	of_unittest_printf_one(np, "%pOFn", "dev");
 319	of_unittest_printf_one(np, "%2pOFn", "dev");
 320	of_unittest_printf_one(np, "%5pOFn", "  dev");
 321	of_unittest_printf_one(np, "%pOFnc", "dev:test-sub-device");
 322	of_unittest_printf_one(np, "%pOFp", phandle_str);
 323	of_unittest_printf_one(np, "%pOFP", "dev@100");
 324	of_unittest_printf_one(np, "ABC %pOFP ABC", "ABC dev@100 ABC");
 325	of_unittest_printf_one(np, "%10pOFP", "   dev@100");
 326	of_unittest_printf_one(np, "%-10pOFP", "dev@100   ");
 327	of_unittest_printf_one(of_root, "%pOFP", "/");
 328	of_unittest_printf_one(np, "%pOFF", "----");
 329	of_unittest_printf_one(np, "%pOFPF", "dev@100:----");
 330	of_unittest_printf_one(np, "%pOFPFPc", "dev@100:----:dev@100:test-sub-device");
 331	of_unittest_printf_one(np, "%pOFc", "test-sub-device");
 332	of_unittest_printf_one(np, "%pOFC",
 333			"\"test-sub-device\",\"test-compat2\",\"test-compat3\"");
 334}
 335
 336struct node_hash {
 337	struct hlist_node node;
 338	struct device_node *np;
 339};
 340
 341static DEFINE_HASHTABLE(phandle_ht, 8);
 342static void __init of_unittest_check_phandles(void)
 343{
 344	struct device_node *np;
 345	struct node_hash *nh;
 346	struct hlist_node *tmp;
 347	int i, dup_count = 0, phandle_count = 0;
 348
 349	for_each_of_allnodes(np) {
 350		if (!np->phandle)
 351			continue;
 352
 353		hash_for_each_possible(phandle_ht, nh, node, np->phandle) {
 354			if (nh->np->phandle == np->phandle) {
 355				pr_info("Duplicate phandle! %i used by %pOF and %pOF\n",
 356					np->phandle, nh->np, np);
 357				dup_count++;
 358				break;
 359			}
 360		}
 361
 362		nh = kzalloc(sizeof(*nh), GFP_KERNEL);
 363		if (!nh)
 364			return;
 365
 366		nh->np = np;
 367		hash_add(phandle_ht, &nh->node, np->phandle);
 368		phandle_count++;
 369	}
 370	unittest(dup_count == 0, "Found %i duplicates in %i phandles\n",
 371		 dup_count, phandle_count);
 372
 373	/* Clean up */
 374	hash_for_each_safe(phandle_ht, i, tmp, nh, node) {
 375		hash_del(&nh->node);
 376		kfree(nh);
 377	}
 378}
 379
 380static void __init of_unittest_parse_phandle_with_args(void)
 381{
 382	struct device_node *np;
 383	struct of_phandle_args args;
 384	int i, rc;
 385
 386	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a");
 387	if (!np) {
 388		pr_err("missing testcase data\n");
 389		return;
 390	}
 391
 392	rc = of_count_phandle_with_args(np, "phandle-list", "#phandle-cells");
 393	unittest(rc == 7, "of_count_phandle_with_args() returned %i, expected 7\n", rc);
 394
 395	for (i = 0; i < 8; i++) {
 396		bool passed = true;
 397
 398		memset(&args, 0, sizeof(args));
 399		rc = of_parse_phandle_with_args(np, "phandle-list",
 400						"#phandle-cells", i, &args);
 401
 402		/* Test the values from tests-phandle.dtsi */
 403		switch (i) {
 404		case 0:
 405			passed &= !rc;
 406			passed &= (args.args_count == 1);
 407			passed &= (args.args[0] == (i + 1));
 408			break;
 409		case 1:
 410			passed &= !rc;
 411			passed &= (args.args_count == 2);
 412			passed &= (args.args[0] == (i + 1));
 413			passed &= (args.args[1] == 0);
 414			break;
 415		case 2:
 416			passed &= (rc == -ENOENT);
 417			break;
 418		case 3:
 419			passed &= !rc;
 420			passed &= (args.args_count == 3);
 421			passed &= (args.args[0] == (i + 1));
 422			passed &= (args.args[1] == 4);
 423			passed &= (args.args[2] == 3);
 424			break;
 425		case 4:
 426			passed &= !rc;
 427			passed &= (args.args_count == 2);
 428			passed &= (args.args[0] == (i + 1));
 429			passed &= (args.args[1] == 100);
 430			break;
 431		case 5:
 432			passed &= !rc;
 433			passed &= (args.args_count == 0);
 434			break;
 435		case 6:
 436			passed &= !rc;
 437			passed &= (args.args_count == 1);
 438			passed &= (args.args[0] == (i + 1));
 439			break;
 440		case 7:
 441			passed &= (rc == -ENOENT);
 442			break;
 443		default:
 444			passed = false;
 445		}
 446
 447		unittest(passed, "index %i - data error on node %pOF rc=%i\n",
 448			 i, args.np, rc);
 449	}
 450
 451	/* Check for missing list property */
 452	memset(&args, 0, sizeof(args));
 453	rc = of_parse_phandle_with_args(np, "phandle-list-missing",
 454					"#phandle-cells", 0, &args);
 455	unittest(rc == -ENOENT, "expected:%i got:%i\n", -ENOENT, rc);
 456	rc = of_count_phandle_with_args(np, "phandle-list-missing",
 457					"#phandle-cells");
 458	unittest(rc == -ENOENT, "expected:%i got:%i\n", -ENOENT, rc);
 459
 460	/* Check for missing cells property */
 461	memset(&args, 0, sizeof(args));
 462
 463	EXPECT_BEGIN(KERN_INFO,
 464		     "OF: /testcase-data/phandle-tests/consumer-a: could not get #phandle-cells-missing for /testcase-data/phandle-tests/provider1");
 465
 466	rc = of_parse_phandle_with_args(np, "phandle-list",
 467					"#phandle-cells-missing", 0, &args);
 468
 469	EXPECT_END(KERN_INFO,
 470		   "OF: /testcase-data/phandle-tests/consumer-a: could not get #phandle-cells-missing for /testcase-data/phandle-tests/provider1");
 471
 472	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 473
 474	EXPECT_BEGIN(KERN_INFO,
 475		     "OF: /testcase-data/phandle-tests/consumer-a: could not get #phandle-cells-missing for /testcase-data/phandle-tests/provider1");
 476
 477	rc = of_count_phandle_with_args(np, "phandle-list",
 478					"#phandle-cells-missing");
 479
 480	EXPECT_END(KERN_INFO,
 481		   "OF: /testcase-data/phandle-tests/consumer-a: could not get #phandle-cells-missing for /testcase-data/phandle-tests/provider1");
 482
 483	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 484
 485	/* Check for bad phandle in list */
 486	memset(&args, 0, sizeof(args));
 487
 488	EXPECT_BEGIN(KERN_INFO,
 489		     "OF: /testcase-data/phandle-tests/consumer-a: could not find phandle");
 490
 491	rc = of_parse_phandle_with_args(np, "phandle-list-bad-phandle",
 492					"#phandle-cells", 0, &args);
 493
 494	EXPECT_END(KERN_INFO,
 495		   "OF: /testcase-data/phandle-tests/consumer-a: could not find phandle");
 496
 497	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 498
 499	EXPECT_BEGIN(KERN_INFO,
 500		     "OF: /testcase-data/phandle-tests/consumer-a: could not find phandle");
 501
 502	rc = of_count_phandle_with_args(np, "phandle-list-bad-phandle",
 503					"#phandle-cells");
 504
 505	EXPECT_END(KERN_INFO,
 506		   "OF: /testcase-data/phandle-tests/consumer-a: could not find phandle");
 507
 508	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 509
 510	/* Check for incorrectly formed argument list */
 511	memset(&args, 0, sizeof(args));
 512
 513	EXPECT_BEGIN(KERN_INFO,
 514		     "OF: /testcase-data/phandle-tests/consumer-a: #phandle-cells = 3 found -1");
 515
 516	rc = of_parse_phandle_with_args(np, "phandle-list-bad-args",
 517					"#phandle-cells", 1, &args);
 518
 519	EXPECT_END(KERN_INFO,
 520		   "OF: /testcase-data/phandle-tests/consumer-a: #phandle-cells = 3 found -1");
 521
 522	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 523
 524	EXPECT_BEGIN(KERN_INFO,
 525		     "OF: /testcase-data/phandle-tests/consumer-a: #phandle-cells = 3 found -1");
 526
 527	rc = of_count_phandle_with_args(np, "phandle-list-bad-args",
 528					"#phandle-cells");
 529
 530	EXPECT_END(KERN_INFO,
 531		   "OF: /testcase-data/phandle-tests/consumer-a: #phandle-cells = 3 found -1");
 532
 533	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 534}
 535
 536static void __init of_unittest_parse_phandle_with_args_map(void)
 537{
 538	struct device_node *np, *p0, *p1, *p2, *p3;
 539	struct of_phandle_args args;
 540	int i, rc;
 541
 542	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-b");
 543	if (!np) {
 544		pr_err("missing testcase data\n");
 545		return;
 546	}
 547
 548	p0 = of_find_node_by_path("/testcase-data/phandle-tests/provider0");
 549	if (!p0) {
 550		pr_err("missing testcase data\n");
 551		return;
 552	}
 553
 554	p1 = of_find_node_by_path("/testcase-data/phandle-tests/provider1");
 555	if (!p1) {
 556		pr_err("missing testcase data\n");
 557		return;
 558	}
 559
 560	p2 = of_find_node_by_path("/testcase-data/phandle-tests/provider2");
 561	if (!p2) {
 562		pr_err("missing testcase data\n");
 563		return;
 564	}
 565
 566	p3 = of_find_node_by_path("/testcase-data/phandle-tests/provider3");
 567	if (!p3) {
 568		pr_err("missing testcase data\n");
 569		return;
 570	}
 571
 572	rc = of_count_phandle_with_args(np, "phandle-list", "#phandle-cells");
 573	unittest(rc == 7, "of_count_phandle_with_args() returned %i, expected 7\n", rc);
 574
 575	for (i = 0; i < 8; i++) {
 576		bool passed = true;
 577
 578		memset(&args, 0, sizeof(args));
 579		rc = of_parse_phandle_with_args_map(np, "phandle-list",
 580						    "phandle", i, &args);
 581
 582		/* Test the values from tests-phandle.dtsi */
 583		switch (i) {
 584		case 0:
 585			passed &= !rc;
 586			passed &= (args.np == p1);
 587			passed &= (args.args_count == 1);
 588			passed &= (args.args[0] == 1);
 589			break;
 590		case 1:
 591			passed &= !rc;
 592			passed &= (args.np == p3);
 593			passed &= (args.args_count == 3);
 594			passed &= (args.args[0] == 2);
 595			passed &= (args.args[1] == 5);
 596			passed &= (args.args[2] == 3);
 597			break;
 598		case 2:
 599			passed &= (rc == -ENOENT);
 600			break;
 601		case 3:
 602			passed &= !rc;
 603			passed &= (args.np == p0);
 604			passed &= (args.args_count == 0);
 605			break;
 606		case 4:
 607			passed &= !rc;
 608			passed &= (args.np == p1);
 609			passed &= (args.args_count == 1);
 610			passed &= (args.args[0] == 3);
 611			break;
 612		case 5:
 613			passed &= !rc;
 614			passed &= (args.np == p0);
 615			passed &= (args.args_count == 0);
 616			break;
 617		case 6:
 618			passed &= !rc;
 619			passed &= (args.np == p2);
 620			passed &= (args.args_count == 2);
 621			passed &= (args.args[0] == 15);
 622			passed &= (args.args[1] == 0x20);
 623			break;
 624		case 7:
 625			passed &= (rc == -ENOENT);
 626			break;
 627		default:
 628			passed = false;
 629		}
 630
 631		unittest(passed, "index %i - data error on node %s rc=%i\n",
 632			 i, args.np->full_name, rc);
 633	}
 634
 635	/* Check for missing list property */
 636	memset(&args, 0, sizeof(args));
 637	rc = of_parse_phandle_with_args_map(np, "phandle-list-missing",
 638					    "phandle", 0, &args);
 639	unittest(rc == -ENOENT, "expected:%i got:%i\n", -ENOENT, rc);
 640
 641	/* Check for missing cells,map,mask property */
 642	memset(&args, 0, sizeof(args));
 643
 644	EXPECT_BEGIN(KERN_INFO,
 645		     "OF: /testcase-data/phandle-tests/consumer-b: could not get #phandle-missing-cells for /testcase-data/phandle-tests/provider1");
 646
 647	rc = of_parse_phandle_with_args_map(np, "phandle-list",
 648					    "phandle-missing", 0, &args);
 649	EXPECT_END(KERN_INFO,
 650		   "OF: /testcase-data/phandle-tests/consumer-b: could not get #phandle-missing-cells for /testcase-data/phandle-tests/provider1");
 651
 652	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 653
 654	/* Check for bad phandle in list */
 655	memset(&args, 0, sizeof(args));
 656
 657	EXPECT_BEGIN(KERN_INFO,
 658		     "OF: /testcase-data/phandle-tests/consumer-b: could not find phandle");
 659
 660	rc = of_parse_phandle_with_args_map(np, "phandle-list-bad-phandle",
 661					    "phandle", 0, &args);
 662	EXPECT_END(KERN_INFO,
 663		   "OF: /testcase-data/phandle-tests/consumer-b: could not find phandle");
 664
 665	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 666
 667	/* Check for incorrectly formed argument list */
 668	memset(&args, 0, sizeof(args));
 669
 670	EXPECT_BEGIN(KERN_INFO,
 671		     "OF: /testcase-data/phandle-tests/consumer-b: #phandle-cells = 2 found -1");
 672
 673	rc = of_parse_phandle_with_args_map(np, "phandle-list-bad-args",
 674					    "phandle", 1, &args);
 675	EXPECT_END(KERN_INFO,
 676		   "OF: /testcase-data/phandle-tests/consumer-b: #phandle-cells = 2 found -1");
 677
 678	unittest(rc == -EINVAL, "expected:%i got:%i\n", -EINVAL, rc);
 679}
 680
 681static void __init of_unittest_property_string(void)
 682{
 683	const char *strings[4];
 684	struct device_node *np;
 685	int rc;
 686
 687	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a");
 688	if (!np) {
 689		pr_err("No testcase data in device tree\n");
 690		return;
 691	}
 692
 693	rc = of_property_match_string(np, "phandle-list-names", "first");
 694	unittest(rc == 0, "first expected:0 got:%i\n", rc);
 695	rc = of_property_match_string(np, "phandle-list-names", "second");
 696	unittest(rc == 1, "second expected:1 got:%i\n", rc);
 697	rc = of_property_match_string(np, "phandle-list-names", "third");
 698	unittest(rc == 2, "third expected:2 got:%i\n", rc);
 699	rc = of_property_match_string(np, "phandle-list-names", "fourth");
 700	unittest(rc == -ENODATA, "unmatched string; rc=%i\n", rc);
 701	rc = of_property_match_string(np, "missing-property", "blah");
 702	unittest(rc == -EINVAL, "missing property; rc=%i\n", rc);
 703	rc = of_property_match_string(np, "empty-property", "blah");
 704	unittest(rc == -ENODATA, "empty property; rc=%i\n", rc);
 705	rc = of_property_match_string(np, "unterminated-string", "blah");
 706	unittest(rc == -EILSEQ, "unterminated string; rc=%i\n", rc);
 707
 708	/* of_property_count_strings() tests */
 709	rc = of_property_count_strings(np, "string-property");
 710	unittest(rc == 1, "Incorrect string count; rc=%i\n", rc);
 711	rc = of_property_count_strings(np, "phandle-list-names");
 712	unittest(rc == 3, "Incorrect string count; rc=%i\n", rc);
 713	rc = of_property_count_strings(np, "unterminated-string");
 714	unittest(rc == -EILSEQ, "unterminated string; rc=%i\n", rc);
 715	rc = of_property_count_strings(np, "unterminated-string-list");
 716	unittest(rc == -EILSEQ, "unterminated string array; rc=%i\n", rc);
 717
 718	/* of_property_read_string_index() tests */
 719	rc = of_property_read_string_index(np, "string-property", 0, strings);
 720	unittest(rc == 0 && !strcmp(strings[0], "foobar"), "of_property_read_string_index() failure; rc=%i\n", rc);
 721	strings[0] = NULL;
 722	rc = of_property_read_string_index(np, "string-property", 1, strings);
 723	unittest(rc == -ENODATA && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc);
 724	rc = of_property_read_string_index(np, "phandle-list-names", 0, strings);
 725	unittest(rc == 0 && !strcmp(strings[0], "first"), "of_property_read_string_index() failure; rc=%i\n", rc);
 726	rc = of_property_read_string_index(np, "phandle-list-names", 1, strings);
 727	unittest(rc == 0 && !strcmp(strings[0], "second"), "of_property_read_string_index() failure; rc=%i\n", rc);
 728	rc = of_property_read_string_index(np, "phandle-list-names", 2, strings);
 729	unittest(rc == 0 && !strcmp(strings[0], "third"), "of_property_read_string_index() failure; rc=%i\n", rc);
 730	strings[0] = NULL;
 731	rc = of_property_read_string_index(np, "phandle-list-names", 3, strings);
 732	unittest(rc == -ENODATA && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc);
 733	strings[0] = NULL;
 734	rc = of_property_read_string_index(np, "unterminated-string", 0, strings);
 735	unittest(rc == -EILSEQ && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc);
 736	rc = of_property_read_string_index(np, "unterminated-string-list", 0, strings);
 737	unittest(rc == 0 && !strcmp(strings[0], "first"), "of_property_read_string_index() failure; rc=%i\n", rc);
 738	strings[0] = NULL;
 739	rc = of_property_read_string_index(np, "unterminated-string-list", 2, strings); /* should fail */
 740	unittest(rc == -EILSEQ && strings[0] == NULL, "of_property_read_string_index() failure; rc=%i\n", rc);
 741	strings[1] = NULL;
 742
 743	/* of_property_read_string_array() tests */
 744	rc = of_property_read_string_array(np, "string-property", strings, 4);
 745	unittest(rc == 1, "Incorrect string count; rc=%i\n", rc);
 746	rc = of_property_read_string_array(np, "phandle-list-names", strings, 4);
 747	unittest(rc == 3, "Incorrect string count; rc=%i\n", rc);
 748	rc = of_property_read_string_array(np, "unterminated-string", strings, 4);
 749	unittest(rc == -EILSEQ, "unterminated string; rc=%i\n", rc);
 750	/* -- An incorrectly formed string should cause a failure */
 751	rc = of_property_read_string_array(np, "unterminated-string-list", strings, 4);
 752	unittest(rc == -EILSEQ, "unterminated string array; rc=%i\n", rc);
 753	/* -- parsing the correctly formed strings should still work: */
 754	strings[2] = NULL;
 755	rc = of_property_read_string_array(np, "unterminated-string-list", strings, 2);
 756	unittest(rc == 2 && strings[2] == NULL, "of_property_read_string_array() failure; rc=%i\n", rc);
 757	strings[1] = NULL;
 758	rc = of_property_read_string_array(np, "phandle-list-names", strings, 1);
 759	unittest(rc == 1 && strings[1] == NULL, "Overwrote end of string array; rc=%i, str='%s'\n", rc, strings[1]);
 760}
 761
 762#define propcmp(p1, p2) (((p1)->length == (p2)->length) && \
 763			(p1)->value && (p2)->value && \
 764			!memcmp((p1)->value, (p2)->value, (p1)->length) && \
 765			!strcmp((p1)->name, (p2)->name))
 766static void __init of_unittest_property_copy(void)
 767{
 768#ifdef CONFIG_OF_DYNAMIC
 769	struct property p1 = { .name = "p1", .length = 0, .value = "" };
 770	struct property p2 = { .name = "p2", .length = 5, .value = "abcd" };
 771	struct property *new;
 772
 773	new = __of_prop_dup(&p1, GFP_KERNEL);
 774	unittest(new && propcmp(&p1, new), "empty property didn't copy correctly\n");
 775	kfree(new->value);
 776	kfree(new->name);
 777	kfree(new);
 778
 779	new = __of_prop_dup(&p2, GFP_KERNEL);
 780	unittest(new && propcmp(&p2, new), "non-empty property didn't copy correctly\n");
 781	kfree(new->value);
 782	kfree(new->name);
 783	kfree(new);
 784#endif
 785}
 786
 787static void __init of_unittest_changeset(void)
 788{
 789#ifdef CONFIG_OF_DYNAMIC
 790	struct property *ppadd, padd = { .name = "prop-add", .length = 1, .value = "" };
 791	struct property *ppname_n1,  pname_n1  = { .name = "name", .length = 3, .value = "n1"  };
 792	struct property *ppname_n2,  pname_n2  = { .name = "name", .length = 3, .value = "n2"  };
 793	struct property *ppname_n21, pname_n21 = { .name = "name", .length = 3, .value = "n21" };
 794	struct property *ppupdate, pupdate = { .name = "prop-update", .length = 5, .value = "abcd" };
 795	struct property *ppremove;
 796	struct device_node *n1, *n2, *n21, *nchangeset, *nremove, *parent, *np;
 797	struct of_changeset chgset;
 798
 799	n1 = __of_node_dup(NULL, "n1");
 800	unittest(n1, "testcase setup failure\n");
 801
 802	n2 = __of_node_dup(NULL, "n2");
 803	unittest(n2, "testcase setup failure\n");
 804
 805	n21 = __of_node_dup(NULL, "n21");
 806	unittest(n21, "testcase setup failure %p\n", n21);
 807
 808	nchangeset = of_find_node_by_path("/testcase-data/changeset");
 809	nremove = of_get_child_by_name(nchangeset, "node-remove");
 810	unittest(nremove, "testcase setup failure\n");
 811
 812	ppadd = __of_prop_dup(&padd, GFP_KERNEL);
 813	unittest(ppadd, "testcase setup failure\n");
 814
 815	ppname_n1  = __of_prop_dup(&pname_n1, GFP_KERNEL);
 816	unittest(ppname_n1, "testcase setup failure\n");
 817
 818	ppname_n2  = __of_prop_dup(&pname_n2, GFP_KERNEL);
 819	unittest(ppname_n2, "testcase setup failure\n");
 820
 821	ppname_n21 = __of_prop_dup(&pname_n21, GFP_KERNEL);
 822	unittest(ppname_n21, "testcase setup failure\n");
 823
 824	ppupdate = __of_prop_dup(&pupdate, GFP_KERNEL);
 825	unittest(ppupdate, "testcase setup failure\n");
 826
 827	parent = nchangeset;
 828	n1->parent = parent;
 829	n2->parent = parent;
 830	n21->parent = n2;
 831
 832	ppremove = of_find_property(parent, "prop-remove", NULL);
 833	unittest(ppremove, "failed to find removal prop");
 834
 835	of_changeset_init(&chgset);
 836
 837	unittest(!of_changeset_attach_node(&chgset, n1), "fail attach n1\n");
 838	unittest(!of_changeset_add_property(&chgset, n1, ppname_n1), "fail add prop name\n");
 839
 840	unittest(!of_changeset_attach_node(&chgset, n2), "fail attach n2\n");
 841	unittest(!of_changeset_add_property(&chgset, n2, ppname_n2), "fail add prop name\n");
 842
 843	unittest(!of_changeset_detach_node(&chgset, nremove), "fail remove node\n");
 844	unittest(!of_changeset_add_property(&chgset, n21, ppname_n21), "fail add prop name\n");
 845
 846	unittest(!of_changeset_attach_node(&chgset, n21), "fail attach n21\n");
 847
 848	unittest(!of_changeset_add_property(&chgset, parent, ppadd), "fail add prop prop-add\n");
 849	unittest(!of_changeset_update_property(&chgset, parent, ppupdate), "fail update prop\n");
 850	unittest(!of_changeset_remove_property(&chgset, parent, ppremove), "fail remove prop\n");
 851
 852	unittest(!of_changeset_apply(&chgset), "apply failed\n");
 853
 854	of_node_put(nchangeset);
 855
 856	/* Make sure node names are constructed correctly */
 857	unittest((np = of_find_node_by_path("/testcase-data/changeset/n2/n21")),
 858		 "'%pOF' not added\n", n21);
 859	of_node_put(np);
 860
 861	unittest(!of_changeset_revert(&chgset), "revert failed\n");
 862
 863	of_changeset_destroy(&chgset);
 864
 865	of_node_put(n1);
 866	of_node_put(n2);
 867	of_node_put(n21);
 868#endif
 869}
 870
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 871static void __init of_unittest_dma_ranges_one(const char *path,
 872		u64 expect_dma_addr, u64 expect_paddr, u64 expect_size)
 873{
 
 874	struct device_node *np;
 875	u64 dma_addr, paddr, size;
 876	int rc;
 877
 878	np = of_find_node_by_path(path);
 879	if (!np) {
 880		pr_err("missing testcase data\n");
 881		return;
 882	}
 883
 884	rc = of_dma_get_range(np, &dma_addr, &paddr, &size);
 885
 886	unittest(!rc, "of_dma_get_range failed on node %pOF rc=%i\n", np, rc);
 
 887	if (!rc) {
 888		unittest(size == expect_size,
 889			 "of_dma_get_range wrong size on node %pOF size=%llx\n", np, size);
 
 
 
 
 
 
 
 
 
 
 
 
 
 890		unittest(paddr == expect_paddr,
 891			 "of_dma_get_range wrong phys addr (%llx) on node %pOF", paddr, np);
 
 892		unittest(dma_addr == expect_dma_addr,
 893			 "of_dma_get_range wrong DMA addr (%llx) on node %pOF", dma_addr, np);
 
 
 
 
 894	}
 895	of_node_put(np);
 
 896}
 897
 898static void __init of_unittest_parse_dma_ranges(void)
 899{
 900	of_unittest_dma_ranges_one("/testcase-data/address-tests/device@70000000",
 901		0x0, 0x20000000, 0x40000000);
 902	of_unittest_dma_ranges_one("/testcase-data/address-tests/bus@80000000/device@1000",
 903		0x100000000, 0x20000000, 0x2000000000);
 
 904	of_unittest_dma_ranges_one("/testcase-data/address-tests/pci@90000000",
 905		0x80000000, 0x20000000, 0x10000000);
 906}
 907
 908static void __init of_unittest_pci_dma_ranges(void)
 909{
 910	struct device_node *np;
 911	struct of_pci_range range;
 912	struct of_pci_range_parser parser;
 913	int i = 0;
 914
 915	if (!IS_ENABLED(CONFIG_PCI))
 916		return;
 917
 918	np = of_find_node_by_path("/testcase-data/address-tests/pci@90000000");
 919	if (!np) {
 920		pr_err("missing testcase data\n");
 921		return;
 922	}
 923
 924	if (of_pci_dma_range_parser_init(&parser, np)) {
 925		pr_err("missing dma-ranges property\n");
 926		return;
 927	}
 928
 929	/*
 930	 * Get the dma-ranges from the device tree
 931	 */
 932	for_each_of_pci_range(&parser, &range) {
 933		if (!i) {
 934			unittest(range.size == 0x10000000,
 935				 "for_each_of_pci_range wrong size on node %pOF size=%llx\n",
 936				 np, range.size);
 937			unittest(range.cpu_addr == 0x20000000,
 938				 "for_each_of_pci_range wrong CPU addr (%llx) on node %pOF",
 939				 range.cpu_addr, np);
 940			unittest(range.pci_addr == 0x80000000,
 941				 "for_each_of_pci_range wrong DMA addr (%llx) on node %pOF",
 942				 range.pci_addr, np);
 943		} else {
 944			unittest(range.size == 0x10000000,
 945				 "for_each_of_pci_range wrong size on node %pOF size=%llx\n",
 946				 np, range.size);
 947			unittest(range.cpu_addr == 0x40000000,
 948				 "for_each_of_pci_range wrong CPU addr (%llx) on node %pOF",
 949				 range.cpu_addr, np);
 950			unittest(range.pci_addr == 0xc0000000,
 951				 "for_each_of_pci_range wrong DMA addr (%llx) on node %pOF",
 952				 range.pci_addr, np);
 953		}
 954		i++;
 955	}
 956
 957	of_node_put(np);
 958}
 959
 960static void __init of_unittest_parse_interrupts(void)
 961{
 962	struct device_node *np;
 963	struct of_phandle_args args;
 964	int i, rc;
 965
 966	if (of_irq_workarounds & OF_IMAP_OLDWORLD_MAC)
 967		return;
 968
 969	np = of_find_node_by_path("/testcase-data/interrupts/interrupts0");
 970	if (!np) {
 971		pr_err("missing testcase data\n");
 972		return;
 973	}
 974
 975	for (i = 0; i < 4; i++) {
 976		bool passed = true;
 977
 978		memset(&args, 0, sizeof(args));
 979		rc = of_irq_parse_one(np, i, &args);
 980
 981		passed &= !rc;
 982		passed &= (args.args_count == 1);
 983		passed &= (args.args[0] == (i + 1));
 984
 985		unittest(passed, "index %i - data error on node %pOF rc=%i\n",
 986			 i, args.np, rc);
 987	}
 988	of_node_put(np);
 989
 990	np = of_find_node_by_path("/testcase-data/interrupts/interrupts1");
 991	if (!np) {
 992		pr_err("missing testcase data\n");
 993		return;
 994	}
 995
 996	for (i = 0; i < 4; i++) {
 997		bool passed = true;
 998
 999		memset(&args, 0, sizeof(args));
1000		rc = of_irq_parse_one(np, i, &args);
1001
1002		/* Test the values from tests-phandle.dtsi */
1003		switch (i) {
1004		case 0:
1005			passed &= !rc;
1006			passed &= (args.args_count == 1);
1007			passed &= (args.args[0] == 9);
1008			break;
1009		case 1:
1010			passed &= !rc;
1011			passed &= (args.args_count == 3);
1012			passed &= (args.args[0] == 10);
1013			passed &= (args.args[1] == 11);
1014			passed &= (args.args[2] == 12);
1015			break;
1016		case 2:
1017			passed &= !rc;
1018			passed &= (args.args_count == 2);
1019			passed &= (args.args[0] == 13);
1020			passed &= (args.args[1] == 14);
1021			break;
1022		case 3:
1023			passed &= !rc;
1024			passed &= (args.args_count == 2);
1025			passed &= (args.args[0] == 15);
1026			passed &= (args.args[1] == 16);
1027			break;
1028		default:
1029			passed = false;
1030		}
1031		unittest(passed, "index %i - data error on node %pOF rc=%i\n",
1032			 i, args.np, rc);
1033	}
1034	of_node_put(np);
1035}
1036
1037static void __init of_unittest_parse_interrupts_extended(void)
1038{
1039	struct device_node *np;
1040	struct of_phandle_args args;
1041	int i, rc;
1042
1043	if (of_irq_workarounds & OF_IMAP_OLDWORLD_MAC)
1044		return;
1045
1046	np = of_find_node_by_path("/testcase-data/interrupts/interrupts-extended0");
1047	if (!np) {
1048		pr_err("missing testcase data\n");
1049		return;
1050	}
1051
1052	for (i = 0; i < 7; i++) {
1053		bool passed = true;
1054
1055		memset(&args, 0, sizeof(args));
1056		rc = of_irq_parse_one(np, i, &args);
1057
1058		/* Test the values from tests-phandle.dtsi */
1059		switch (i) {
1060		case 0:
1061			passed &= !rc;
1062			passed &= (args.args_count == 1);
1063			passed &= (args.args[0] == 1);
1064			break;
1065		case 1:
1066			passed &= !rc;
1067			passed &= (args.args_count == 3);
1068			passed &= (args.args[0] == 2);
1069			passed &= (args.args[1] == 3);
1070			passed &= (args.args[2] == 4);
1071			break;
1072		case 2:
1073			passed &= !rc;
1074			passed &= (args.args_count == 2);
1075			passed &= (args.args[0] == 5);
1076			passed &= (args.args[1] == 6);
1077			break;
1078		case 3:
1079			passed &= !rc;
1080			passed &= (args.args_count == 1);
1081			passed &= (args.args[0] == 9);
1082			break;
1083		case 4:
1084			passed &= !rc;
1085			passed &= (args.args_count == 3);
1086			passed &= (args.args[0] == 10);
1087			passed &= (args.args[1] == 11);
1088			passed &= (args.args[2] == 12);
1089			break;
1090		case 5:
1091			passed &= !rc;
1092			passed &= (args.args_count == 2);
1093			passed &= (args.args[0] == 13);
1094			passed &= (args.args[1] == 14);
1095			break;
1096		case 6:
 
 
 
 
 
 
1097			passed &= !rc;
1098			passed &= (args.args_count == 1);
1099			passed &= (args.args[0] == 15);
1100			break;
1101		default:
1102			passed = false;
1103		}
1104
1105		unittest(passed, "index %i - data error on node %pOF rc=%i\n",
1106			 i, args.np, rc);
1107	}
1108	of_node_put(np);
1109}
1110
1111static const struct of_device_id match_node_table[] = {
1112	{ .data = "A", .name = "name0", }, /* Name alone is lowest priority */
1113	{ .data = "B", .type = "type1", }, /* followed by type alone */
1114
1115	{ .data = "Ca", .name = "name2", .type = "type1", }, /* followed by both together */
1116	{ .data = "Cb", .name = "name2", }, /* Only match when type doesn't match */
1117	{ .data = "Cc", .name = "name2", .type = "type2", },
1118
1119	{ .data = "E", .compatible = "compat3" },
1120	{ .data = "G", .compatible = "compat2", },
1121	{ .data = "H", .compatible = "compat2", .name = "name5", },
1122	{ .data = "I", .compatible = "compat2", .type = "type1", },
1123	{ .data = "J", .compatible = "compat2", .type = "type1", .name = "name8", },
1124	{ .data = "K", .compatible = "compat2", .name = "name9", },
1125	{}
1126};
1127
1128static struct {
1129	const char *path;
1130	const char *data;
1131} match_node_tests[] = {
1132	{ .path = "/testcase-data/match-node/name0", .data = "A", },
1133	{ .path = "/testcase-data/match-node/name1", .data = "B", },
1134	{ .path = "/testcase-data/match-node/a/name2", .data = "Ca", },
1135	{ .path = "/testcase-data/match-node/b/name2", .data = "Cb", },
1136	{ .path = "/testcase-data/match-node/c/name2", .data = "Cc", },
1137	{ .path = "/testcase-data/match-node/name3", .data = "E", },
1138	{ .path = "/testcase-data/match-node/name4", .data = "G", },
1139	{ .path = "/testcase-data/match-node/name5", .data = "H", },
1140	{ .path = "/testcase-data/match-node/name6", .data = "G", },
1141	{ .path = "/testcase-data/match-node/name7", .data = "I", },
1142	{ .path = "/testcase-data/match-node/name8", .data = "J", },
1143	{ .path = "/testcase-data/match-node/name9", .data = "K", },
1144};
1145
1146static void __init of_unittest_match_node(void)
1147{
1148	struct device_node *np;
1149	const struct of_device_id *match;
1150	int i;
1151
1152	for (i = 0; i < ARRAY_SIZE(match_node_tests); i++) {
1153		np = of_find_node_by_path(match_node_tests[i].path);
1154		if (!np) {
1155			unittest(0, "missing testcase node %s\n",
1156				match_node_tests[i].path);
1157			continue;
1158		}
1159
1160		match = of_match_node(match_node_table, np);
1161		if (!match) {
1162			unittest(0, "%s didn't match anything\n",
1163				match_node_tests[i].path);
1164			continue;
1165		}
1166
1167		if (strcmp(match->data, match_node_tests[i].data) != 0) {
1168			unittest(0, "%s got wrong match. expected %s, got %s\n",
1169				match_node_tests[i].path, match_node_tests[i].data,
1170				(const char *)match->data);
1171			continue;
1172		}
1173		unittest(1, "passed");
1174	}
1175}
1176
1177static struct resource test_bus_res = {
1178	.start = 0xfffffff8,
1179	.end = 0xfffffff9,
1180	.flags = IORESOURCE_MEM,
1181};
1182static const struct platform_device_info test_bus_info = {
1183	.name = "unittest-bus",
1184};
1185static void __init of_unittest_platform_populate(void)
1186{
1187	int irq, rc;
1188	struct device_node *np, *child, *grandchild;
1189	struct platform_device *pdev, *test_bus;
1190	const struct of_device_id match[] = {
1191		{ .compatible = "test-device", },
1192		{}
1193	};
1194
1195	np = of_find_node_by_path("/testcase-data");
1196	of_platform_default_populate(np, NULL, NULL);
1197
1198	/* Test that a missing irq domain returns -EPROBE_DEFER */
1199	np = of_find_node_by_path("/testcase-data/testcase-device1");
1200	pdev = of_find_device_by_node(np);
1201	unittest(pdev, "device 1 creation failed\n");
1202
1203	if (!(of_irq_workarounds & OF_IMAP_OLDWORLD_MAC)) {
1204		irq = platform_get_irq(pdev, 0);
1205		unittest(irq == -EPROBE_DEFER,
1206			 "device deferred probe failed - %d\n", irq);
1207
1208		/* Test that a parsing failure does not return -EPROBE_DEFER */
1209		np = of_find_node_by_path("/testcase-data/testcase-device2");
1210		pdev = of_find_device_by_node(np);
1211		unittest(pdev, "device 2 creation failed\n");
1212
1213		EXPECT_BEGIN(KERN_INFO,
1214			     "platform testcase-data:testcase-device2: IRQ index 0 not found");
1215
1216		irq = platform_get_irq(pdev, 0);
1217
1218		EXPECT_END(KERN_INFO,
1219			   "platform testcase-data:testcase-device2: IRQ index 0 not found");
1220
1221		unittest(irq < 0 && irq != -EPROBE_DEFER,
1222			 "device parsing error failed - %d\n", irq);
1223	}
1224
1225	np = of_find_node_by_path("/testcase-data/platform-tests");
1226	unittest(np, "No testcase data in device tree\n");
1227	if (!np)
1228		return;
1229
1230	test_bus = platform_device_register_full(&test_bus_info);
1231	rc = PTR_ERR_OR_ZERO(test_bus);
1232	unittest(!rc, "testbus registration failed; rc=%i\n", rc);
1233	if (rc) {
1234		of_node_put(np);
1235		return;
1236	}
1237	test_bus->dev.of_node = np;
1238
1239	/*
1240	 * Add a dummy resource to the test bus node after it is
1241	 * registered to catch problems with un-inserted resources. The
1242	 * DT code doesn't insert the resources, and it has caused the
1243	 * kernel to oops in the past. This makes sure the same bug
1244	 * doesn't crop up again.
1245	 */
1246	platform_device_add_resources(test_bus, &test_bus_res, 1);
1247
1248	of_platform_populate(np, match, NULL, &test_bus->dev);
1249	for_each_child_of_node(np, child) {
1250		for_each_child_of_node(child, grandchild) {
1251			pdev = of_find_device_by_node(grandchild);
1252			unittest(pdev,
1253				 "Could not create device for node '%pOFn'\n",
1254				 grandchild);
1255			of_dev_put(pdev);
1256		}
1257	}
1258
1259	of_platform_depopulate(&test_bus->dev);
1260	for_each_child_of_node(np, child) {
1261		for_each_child_of_node(child, grandchild)
1262			unittest(!of_find_device_by_node(grandchild),
1263				 "device didn't get destroyed '%pOFn'\n",
1264				 grandchild);
1265	}
1266
1267	platform_device_unregister(test_bus);
1268	of_node_put(np);
1269}
1270
1271/**
1272 *	update_node_properties - adds the properties
1273 *	of np into dup node (present in live tree) and
1274 *	updates parent of children of np to dup.
1275 *
1276 *	@np:	node whose properties are being added to the live tree
1277 *	@dup:	node present in live tree to be updated
1278 */
1279static void update_node_properties(struct device_node *np,
1280					struct device_node *dup)
1281{
1282	struct property *prop;
1283	struct property *save_next;
1284	struct device_node *child;
1285	int ret;
1286
1287	for_each_child_of_node(np, child)
1288		child->parent = dup;
1289
1290	/*
1291	 * "unittest internal error: unable to add testdata property"
1292	 *
1293	 *    If this message reports a property in node '/__symbols__' then
1294	 *    the respective unittest overlay contains a label that has the
1295	 *    same name as a label in the live devicetree.  The label will
1296	 *    be in the live devicetree only if the devicetree source was
1297	 *    compiled with the '-@' option.  If you encounter this error,
1298	 *    please consider renaming __all__ of the labels in the unittest
1299	 *    overlay dts files with an odd prefix that is unlikely to be
1300	 *    used in a real devicetree.
1301	 */
1302
1303	/*
1304	 * open code for_each_property_of_node() because of_add_property()
1305	 * sets prop->next to NULL
1306	 */
1307	for (prop = np->properties; prop != NULL; prop = save_next) {
1308		save_next = prop->next;
1309		ret = of_add_property(dup, prop);
1310		if (ret) {
1311			if (ret == -EEXIST && !strcmp(prop->name, "name"))
1312				continue;
1313			pr_err("unittest internal error: unable to add testdata property %pOF/%s",
1314			       np, prop->name);
1315		}
1316	}
1317}
1318
1319/**
1320 *	attach_node_and_children - attaches nodes
1321 *	and its children to live tree.
1322 *	CAUTION: misleading function name - if node @np already exists in
1323 *	the live tree then children of @np are *not* attached to the live
1324 *	tree.  This works for the current test devicetree nodes because such
1325 *	nodes do not have child nodes.
1326 *
1327 *	@np:	Node to attach to live tree
1328 */
1329static void attach_node_and_children(struct device_node *np)
1330{
1331	struct device_node *next, *dup, *child;
1332	unsigned long flags;
1333	const char *full_name;
1334
1335	full_name = kasprintf(GFP_KERNEL, "%pOF", np);
1336
1337	if (!strcmp(full_name, "/__local_fixups__") ||
1338	    !strcmp(full_name, "/__fixups__")) {
1339		kfree(full_name);
1340		return;
1341	}
1342
1343	dup = of_find_node_by_path(full_name);
1344	kfree(full_name);
1345	if (dup) {
1346		update_node_properties(np, dup);
1347		return;
1348	}
1349
1350	child = np->child;
1351	np->child = NULL;
1352
1353	mutex_lock(&of_mutex);
1354	raw_spin_lock_irqsave(&devtree_lock, flags);
1355	np->sibling = np->parent->child;
1356	np->parent->child = np;
1357	of_node_clear_flag(np, OF_DETACHED);
1358	raw_spin_unlock_irqrestore(&devtree_lock, flags);
1359
1360	__of_attach_node_sysfs(np);
1361	mutex_unlock(&of_mutex);
1362
1363	while (child) {
1364		next = child->sibling;
1365		attach_node_and_children(child);
1366		child = next;
1367	}
1368}
1369
1370/**
1371 *	unittest_data_add - Reads, copies data from
1372 *	linked tree and attaches it to the live tree
1373 */
1374static int __init unittest_data_add(void)
1375{
1376	void *unittest_data;
1377	struct device_node *unittest_data_node, *np;
 
1378	/*
1379	 * __dtb_testcases_begin[] and __dtb_testcases_end[] are magically
1380	 * created by cmd_dt_S_dtb in scripts/Makefile.lib
1381	 */
1382	extern uint8_t __dtb_testcases_begin[];
1383	extern uint8_t __dtb_testcases_end[];
1384	const int size = __dtb_testcases_end - __dtb_testcases_begin;
1385	int rc;
 
1386
1387	if (!size) {
1388		pr_warn("%s: No testcase data to attach; not running tests\n",
1389			__func__);
1390		return -ENODATA;
1391	}
1392
1393	/* creating copy */
1394	unittest_data = kmemdup(__dtb_testcases_begin, size, GFP_KERNEL);
1395	if (!unittest_data)
1396		return -ENOMEM;
1397
1398	of_fdt_unflatten_tree(unittest_data, NULL, &unittest_data_node);
 
 
 
 
 
 
 
 
1399	if (!unittest_data_node) {
1400		pr_warn("%s: No tree to attach; not running tests\n", __func__);
1401		kfree(unittest_data);
1402		return -ENODATA;
1403	}
1404
1405	/*
1406	 * This lock normally encloses of_resolve_phandles()
1407	 */
1408	of_overlay_mutex_lock();
1409
1410	rc = of_resolve_phandles(unittest_data_node);
1411	if (rc) {
1412		pr_err("%s: Failed to resolve phandles (rc=%i)\n", __func__, rc);
1413		of_overlay_mutex_unlock();
1414		return -EINVAL;
1415	}
1416
1417	if (!of_root) {
1418		of_root = unittest_data_node;
1419		for_each_of_allnodes(np)
1420			__of_attach_node_sysfs(np);
1421		of_aliases = of_find_node_by_path("/aliases");
1422		of_chosen = of_find_node_by_path("/chosen");
1423		of_overlay_mutex_unlock();
1424		return 0;
1425	}
1426
1427	EXPECT_BEGIN(KERN_INFO,
1428		     "Duplicate name in testcase-data, renamed to \"duplicate-name#1\"");
1429
1430	/* attach the sub-tree to live tree */
1431	np = unittest_data_node->child;
1432	while (np) {
1433		struct device_node *next = np->sibling;
1434
1435		np->parent = of_root;
1436		attach_node_and_children(np);
1437		np = next;
1438	}
1439
1440	EXPECT_END(KERN_INFO,
1441		   "Duplicate name in testcase-data, renamed to \"duplicate-name#1\"");
1442
1443	of_overlay_mutex_unlock();
1444
1445	return 0;
1446}
1447
1448#ifdef CONFIG_OF_OVERLAY
1449static int __init overlay_data_apply(const char *overlay_name, int *overlay_id);
1450
1451static int unittest_probe(struct platform_device *pdev)
1452{
1453	struct device *dev = &pdev->dev;
1454	struct device_node *np = dev->of_node;
1455
1456	if (np == NULL) {
1457		dev_err(dev, "No OF data for device\n");
1458		return -EINVAL;
1459
1460	}
1461
1462	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
1463
1464	of_platform_populate(np, NULL, NULL, &pdev->dev);
1465
1466	return 0;
1467}
1468
1469static int unittest_remove(struct platform_device *pdev)
1470{
1471	struct device *dev = &pdev->dev;
1472	struct device_node *np = dev->of_node;
1473
1474	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
1475	return 0;
1476}
1477
1478static const struct of_device_id unittest_match[] = {
1479	{ .compatible = "unittest", },
1480	{},
1481};
1482
1483static struct platform_driver unittest_driver = {
1484	.probe			= unittest_probe,
1485	.remove			= unittest_remove,
1486	.driver = {
1487		.name		= "unittest",
1488		.of_match_table	= of_match_ptr(unittest_match),
1489	},
1490};
1491
1492/* get the platform device instantiated at the path */
1493static struct platform_device *of_path_to_platform_device(const char *path)
1494{
1495	struct device_node *np;
1496	struct platform_device *pdev;
1497
1498	np = of_find_node_by_path(path);
1499	if (np == NULL)
1500		return NULL;
1501
1502	pdev = of_find_device_by_node(np);
1503	of_node_put(np);
1504
1505	return pdev;
1506}
1507
1508/* find out if a platform device exists at that path */
1509static int of_path_platform_device_exists(const char *path)
1510{
1511	struct platform_device *pdev;
1512
1513	pdev = of_path_to_platform_device(path);
1514	platform_device_put(pdev);
1515	return pdev != NULL;
1516}
1517
1518#ifdef CONFIG_OF_GPIO
1519
1520struct unittest_gpio_dev {
1521	struct gpio_chip chip;
1522};
1523
1524static int unittest_gpio_chip_request_count;
1525static int unittest_gpio_probe_count;
1526static int unittest_gpio_probe_pass_count;
1527
1528static int unittest_gpio_chip_request(struct gpio_chip *chip, unsigned int offset)
1529{
1530	unittest_gpio_chip_request_count++;
1531
1532	pr_debug("%s(): %s %d %d\n", __func__, chip->label, offset,
1533		 unittest_gpio_chip_request_count);
1534	return 0;
1535}
1536
1537static int unittest_gpio_probe(struct platform_device *pdev)
1538{
1539	struct unittest_gpio_dev *devptr;
1540	int ret;
1541
1542	unittest_gpio_probe_count++;
1543
1544	devptr = kzalloc(sizeof(*devptr), GFP_KERNEL);
1545	if (!devptr)
1546		return -ENOMEM;
1547
1548	platform_set_drvdata(pdev, devptr);
1549
1550	devptr->chip.of_node = pdev->dev.of_node;
1551	devptr->chip.label = "of-unittest-gpio";
1552	devptr->chip.base = -1; /* dynamic allocation */
1553	devptr->chip.ngpio = 5;
1554	devptr->chip.request = unittest_gpio_chip_request;
1555
1556	ret = gpiochip_add_data(&devptr->chip, NULL);
1557
1558	unittest(!ret,
1559		 "gpiochip_add_data() for node @%pOF failed, ret = %d\n", devptr->chip.of_node, ret);
1560
1561	if (!ret)
1562		unittest_gpio_probe_pass_count++;
1563	return ret;
1564}
1565
1566static int unittest_gpio_remove(struct platform_device *pdev)
1567{
1568	struct unittest_gpio_dev *gdev = platform_get_drvdata(pdev);
1569	struct device *dev = &pdev->dev;
1570	struct device_node *np = pdev->dev.of_node;
1571
1572	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
1573
1574	if (!gdev)
1575		return -EINVAL;
1576
1577	if (gdev->chip.base != -1)
1578		gpiochip_remove(&gdev->chip);
1579
1580	platform_set_drvdata(pdev, NULL);
1581	kfree(gdev);
1582
1583	return 0;
1584}
1585
1586static const struct of_device_id unittest_gpio_id[] = {
1587	{ .compatible = "unittest-gpio", },
1588	{}
1589};
1590
1591static struct platform_driver unittest_gpio_driver = {
1592	.probe	= unittest_gpio_probe,
1593	.remove	= unittest_gpio_remove,
1594	.driver	= {
1595		.name		= "unittest-gpio",
1596		.of_match_table	= of_match_ptr(unittest_gpio_id),
1597	},
1598};
1599
1600static void __init of_unittest_overlay_gpio(void)
1601{
1602	int chip_request_count;
1603	int probe_pass_count;
1604	int ret;
1605
1606	/*
1607	 * tests: apply overlays before registering driver
1608	 * Similar to installing a driver as a module, the
1609	 * driver is registered after applying the overlays.
1610	 *
1611	 * The overlays are applied by overlay_data_apply()
1612	 * instead of of_unittest_apply_overlay() so that they
1613	 * will not be tracked.  Thus they will not be removed
1614	 * by of_unittest_destroy_tracked_overlays().
1615	 *
1616	 * - apply overlay_gpio_01
1617	 * - apply overlay_gpio_02a
1618	 * - apply overlay_gpio_02b
1619	 * - register driver
1620	 *
1621	 * register driver will result in
1622	 *   - probe and processing gpio hog for overlay_gpio_01
1623	 *   - probe for overlay_gpio_02a
1624	 *   - processing gpio for overlay_gpio_02b
1625	 */
1626
1627	probe_pass_count = unittest_gpio_probe_pass_count;
1628	chip_request_count = unittest_gpio_chip_request_count;
1629
1630	/*
1631	 * overlay_gpio_01 contains gpio node and child gpio hog node
1632	 * overlay_gpio_02a contains gpio node
1633	 * overlay_gpio_02b contains child gpio hog node
1634	 */
1635
1636	unittest(overlay_data_apply("overlay_gpio_01", NULL),
1637		 "Adding overlay 'overlay_gpio_01' failed\n");
1638
1639	unittest(overlay_data_apply("overlay_gpio_02a", NULL),
1640		 "Adding overlay 'overlay_gpio_02a' failed\n");
1641
1642	unittest(overlay_data_apply("overlay_gpio_02b", NULL),
1643		 "Adding overlay 'overlay_gpio_02b' failed\n");
1644
1645	/*
1646	 * messages are the result of the probes, after the
1647	 * driver is registered
1648	 */
1649
1650	EXPECT_BEGIN(KERN_INFO,
1651		     "GPIO line <<int>> (line-B-input) hogged as input\n");
1652
1653	EXPECT_BEGIN(KERN_INFO,
1654		     "GPIO line <<int>> (line-A-input) hogged as input\n");
1655
1656	ret = platform_driver_register(&unittest_gpio_driver);
1657	if (unittest(ret == 0, "could not register unittest gpio driver\n"))
1658		return;
1659
1660	EXPECT_END(KERN_INFO,
1661		   "GPIO line <<int>> (line-A-input) hogged as input\n");
1662	EXPECT_END(KERN_INFO,
1663		   "GPIO line <<int>> (line-B-input) hogged as input\n");
1664
1665	unittest(probe_pass_count + 2 == unittest_gpio_probe_pass_count,
1666		 "unittest_gpio_probe() failed or not called\n");
1667
1668	unittest(chip_request_count + 2 == unittest_gpio_chip_request_count,
1669		 "unittest_gpio_chip_request() called %d times (expected 1 time)\n",
1670		 unittest_gpio_chip_request_count - chip_request_count);
1671
1672	/*
1673	 * tests: apply overlays after registering driver
1674	 *
1675	 * Similar to a driver built-in to the kernel, the
1676	 * driver is registered before applying the overlays.
1677	 *
1678	 * overlay_gpio_03 contains gpio node and child gpio hog node
1679	 *
1680	 * - apply overlay_gpio_03
1681	 *
1682	 * apply overlay will result in
1683	 *   - probe and processing gpio hog.
1684	 */
1685
1686	probe_pass_count = unittest_gpio_probe_pass_count;
1687	chip_request_count = unittest_gpio_chip_request_count;
1688
1689	EXPECT_BEGIN(KERN_INFO,
1690		     "GPIO line <<int>> (line-D-input) hogged as input\n");
1691
1692	/* overlay_gpio_03 contains gpio node and child gpio hog node */
1693
1694	unittest(overlay_data_apply("overlay_gpio_03", NULL),
1695		 "Adding overlay 'overlay_gpio_03' failed\n");
1696
1697	EXPECT_END(KERN_INFO,
1698		   "GPIO line <<int>> (line-D-input) hogged as input\n");
1699
1700	unittest(probe_pass_count + 1 == unittest_gpio_probe_pass_count,
1701		 "unittest_gpio_probe() failed or not called\n");
1702
1703	unittest(chip_request_count + 1 == unittest_gpio_chip_request_count,
1704		 "unittest_gpio_chip_request() called %d times (expected 1 time)\n",
1705		 unittest_gpio_chip_request_count - chip_request_count);
1706
1707	/*
1708	 * overlay_gpio_04a contains gpio node
1709	 *
1710	 * - apply overlay_gpio_04a
1711	 *
1712	 * apply the overlay will result in
1713	 *   - probe for overlay_gpio_04a
1714	 */
1715
1716	probe_pass_count = unittest_gpio_probe_pass_count;
1717	chip_request_count = unittest_gpio_chip_request_count;
1718
1719	/* overlay_gpio_04a contains gpio node */
1720
1721	unittest(overlay_data_apply("overlay_gpio_04a", NULL),
1722		 "Adding overlay 'overlay_gpio_04a' failed\n");
1723
1724	unittest(probe_pass_count + 1 == unittest_gpio_probe_pass_count,
1725		 "unittest_gpio_probe() failed or not called\n");
1726
1727	/*
1728	 * overlay_gpio_04b contains child gpio hog node
1729	 *
1730	 * - apply overlay_gpio_04b
1731	 *
1732	 * apply the overlay will result in
1733	 *   - processing gpio for overlay_gpio_04b
1734	 */
1735
1736	EXPECT_BEGIN(KERN_INFO,
1737		     "GPIO line <<int>> (line-C-input) hogged as input\n");
1738
1739	/* overlay_gpio_04b contains child gpio hog node */
1740
1741	unittest(overlay_data_apply("overlay_gpio_04b", NULL),
1742		 "Adding overlay 'overlay_gpio_04b' failed\n");
1743
1744	EXPECT_END(KERN_INFO,
1745		   "GPIO line <<int>> (line-C-input) hogged as input\n");
1746
1747	unittest(chip_request_count + 1 == unittest_gpio_chip_request_count,
1748		 "unittest_gpio_chip_request() called %d times (expected 1 time)\n",
1749		 unittest_gpio_chip_request_count - chip_request_count);
1750}
1751
1752#else
1753
1754static void __init of_unittest_overlay_gpio(void)
1755{
1756	/* skip tests */
1757}
1758
1759#endif
1760
1761#if IS_BUILTIN(CONFIG_I2C)
1762
1763/* get the i2c client device instantiated at the path */
1764static struct i2c_client *of_path_to_i2c_client(const char *path)
1765{
1766	struct device_node *np;
1767	struct i2c_client *client;
1768
1769	np = of_find_node_by_path(path);
1770	if (np == NULL)
1771		return NULL;
1772
1773	client = of_find_i2c_device_by_node(np);
1774	of_node_put(np);
1775
1776	return client;
1777}
1778
1779/* find out if a i2c client device exists at that path */
1780static int of_path_i2c_client_exists(const char *path)
1781{
1782	struct i2c_client *client;
1783
1784	client = of_path_to_i2c_client(path);
1785	if (client)
1786		put_device(&client->dev);
1787	return client != NULL;
1788}
1789#else
1790static int of_path_i2c_client_exists(const char *path)
1791{
1792	return 0;
1793}
1794#endif
1795
1796enum overlay_type {
1797	PDEV_OVERLAY,
1798	I2C_OVERLAY
1799};
1800
1801static int of_path_device_type_exists(const char *path,
1802		enum overlay_type ovtype)
1803{
1804	switch (ovtype) {
1805	case PDEV_OVERLAY:
1806		return of_path_platform_device_exists(path);
1807	case I2C_OVERLAY:
1808		return of_path_i2c_client_exists(path);
1809	}
1810	return 0;
1811}
1812
1813static const char *unittest_path(int nr, enum overlay_type ovtype)
1814{
1815	const char *base;
1816	static char buf[256];
1817
1818	switch (ovtype) {
1819	case PDEV_OVERLAY:
1820		base = "/testcase-data/overlay-node/test-bus";
1821		break;
1822	case I2C_OVERLAY:
1823		base = "/testcase-data/overlay-node/test-bus/i2c-test-bus";
1824		break;
1825	default:
1826		buf[0] = '\0';
1827		return buf;
1828	}
1829	snprintf(buf, sizeof(buf) - 1, "%s/test-unittest%d", base, nr);
1830	buf[sizeof(buf) - 1] = '\0';
1831	return buf;
1832}
1833
1834static int of_unittest_device_exists(int unittest_nr, enum overlay_type ovtype)
1835{
1836	const char *path;
1837
1838	path = unittest_path(unittest_nr, ovtype);
1839
1840	switch (ovtype) {
1841	case PDEV_OVERLAY:
1842		return of_path_platform_device_exists(path);
1843	case I2C_OVERLAY:
1844		return of_path_i2c_client_exists(path);
1845	}
1846	return 0;
1847}
1848
1849static const char *overlay_name_from_nr(int nr)
1850{
1851	static char buf[256];
1852
1853	snprintf(buf, sizeof(buf) - 1,
1854		"overlay_%d", nr);
1855	buf[sizeof(buf) - 1] = '\0';
1856
1857	return buf;
1858}
1859
1860static const char *bus_path = "/testcase-data/overlay-node/test-bus";
1861
1862/* FIXME: it is NOT guaranteed that overlay ids are assigned in sequence */
1863
1864#define MAX_UNITTEST_OVERLAYS	256
1865static unsigned long overlay_id_bits[BITS_TO_LONGS(MAX_UNITTEST_OVERLAYS)];
1866static int overlay_first_id = -1;
1867
1868static long of_unittest_overlay_tracked(int id)
1869{
1870	if (WARN_ON(id >= MAX_UNITTEST_OVERLAYS))
1871		return 0;
1872	return overlay_id_bits[BIT_WORD(id)] & BIT_MASK(id);
 
 
 
1873}
1874
1875static void of_unittest_track_overlay(int id)
1876{
1877	if (overlay_first_id < 0)
1878		overlay_first_id = id;
1879	id -= overlay_first_id;
1880
1881	if (WARN_ON(id >= MAX_UNITTEST_OVERLAYS))
1882		return;
1883	overlay_id_bits[BIT_WORD(id)] |= BIT_MASK(id);
1884}
1885
1886static void of_unittest_untrack_overlay(int id)
1887{
1888	if (overlay_first_id < 0)
1889		return;
1890	id -= overlay_first_id;
1891	if (WARN_ON(id >= MAX_UNITTEST_OVERLAYS))
1892		return;
1893	overlay_id_bits[BIT_WORD(id)] &= ~BIT_MASK(id);
1894}
1895
1896static void of_unittest_destroy_tracked_overlays(void)
1897{
1898	int id, ret, defers, ovcs_id;
 
1899
1900	if (overlay_first_id < 0)
1901		return;
1902
1903	/* try until no defers */
1904	do {
1905		defers = 0;
1906		/* remove in reverse order */
1907		for (id = MAX_UNITTEST_OVERLAYS - 1; id >= 0; id--) {
1908			if (!of_unittest_overlay_tracked(id))
1909				continue;
 
 
 
 
1910
1911			ovcs_id = id + overlay_first_id;
1912			ret = of_overlay_remove(&ovcs_id);
1913			if (ret == -ENODEV) {
1914				pr_warn("%s: no overlay to destroy for #%d\n",
1915					__func__, id + overlay_first_id);
1916				continue;
1917			}
1918			if (ret != 0) {
1919				defers++;
1920				pr_warn("%s: overlay destroy failed for #%d\n",
1921					__func__, id + overlay_first_id);
1922				continue;
1923			}
1924
1925			of_unittest_untrack_overlay(id);
1926		}
1927	} while (defers > 0);
1928}
1929
1930static int __init of_unittest_apply_overlay(int overlay_nr, int *overlay_id)
1931{
 
 
 
 
 
1932	const char *overlay_name;
1933
1934	overlay_name = overlay_name_from_nr(overlay_nr);
1935
1936	if (!overlay_data_apply(overlay_name, overlay_id)) {
1937		unittest(0, "could not apply overlay \"%s\"\n",
1938				overlay_name);
1939		return -EFAULT;
1940	}
1941	of_unittest_track_overlay(*overlay_id);
1942
1943	return 0;
1944}
1945
1946/* apply an overlay while checking before and after states */
1947static int __init of_unittest_apply_overlay_check(int overlay_nr,
1948		int unittest_nr, int before, int after,
1949		enum overlay_type ovtype)
1950{
1951	int ret, ovcs_id;
1952
1953	/* unittest device must not be in before state */
1954	if (of_unittest_device_exists(unittest_nr, ovtype) != before) {
1955		unittest(0, "%s with device @\"%s\" %s\n",
1956				overlay_name_from_nr(overlay_nr),
1957				unittest_path(unittest_nr, ovtype),
1958				!before ? "enabled" : "disabled");
1959		return -EINVAL;
1960	}
1961
1962	ovcs_id = 0;
1963	ret = of_unittest_apply_overlay(overlay_nr, &ovcs_id);
1964	if (ret != 0) {
1965		/* of_unittest_apply_overlay already called unittest() */
1966		return ret;
1967	}
1968
1969	/* unittest device must be to set to after state */
1970	if (of_unittest_device_exists(unittest_nr, ovtype) != after) {
1971		unittest(0, "%s failed to create @\"%s\" %s\n",
1972				overlay_name_from_nr(overlay_nr),
1973				unittest_path(unittest_nr, ovtype),
1974				!after ? "enabled" : "disabled");
1975		return -EINVAL;
1976	}
1977
1978	return 0;
1979}
1980
1981/* apply an overlay and then revert it while checking before, after states */
1982static int __init of_unittest_apply_revert_overlay_check(int overlay_nr,
1983		int unittest_nr, int before, int after,
1984		enum overlay_type ovtype)
1985{
1986	int ret, ovcs_id, save_id;
1987
1988	/* unittest device must be in before state */
1989	if (of_unittest_device_exists(unittest_nr, ovtype) != before) {
1990		unittest(0, "%s with device @\"%s\" %s\n",
1991				overlay_name_from_nr(overlay_nr),
1992				unittest_path(unittest_nr, ovtype),
1993				!before ? "enabled" : "disabled");
1994		return -EINVAL;
1995	}
1996
1997	/* apply the overlay */
1998	ovcs_id = 0;
1999	ret = of_unittest_apply_overlay(overlay_nr, &ovcs_id);
2000	if (ret != 0) {
2001		/* of_unittest_apply_overlay already called unittest() */
2002		return ret;
2003	}
2004
2005	/* unittest device must be in after state */
2006	if (of_unittest_device_exists(unittest_nr, ovtype) != after) {
2007		unittest(0, "%s failed to create @\"%s\" %s\n",
2008				overlay_name_from_nr(overlay_nr),
2009				unittest_path(unittest_nr, ovtype),
2010				!after ? "enabled" : "disabled");
2011		return -EINVAL;
2012	}
2013
2014	save_id = ovcs_id;
2015	ret = of_overlay_remove(&ovcs_id);
2016	if (ret != 0) {
2017		unittest(0, "%s failed to be destroyed @\"%s\"\n",
2018				overlay_name_from_nr(overlay_nr),
2019				unittest_path(unittest_nr, ovtype));
2020		return ret;
2021	}
2022	of_unittest_untrack_overlay(save_id);
2023
2024	/* unittest device must be again in before state */
2025	if (of_unittest_device_exists(unittest_nr, PDEV_OVERLAY) != before) {
2026		unittest(0, "%s with device @\"%s\" %s\n",
2027				overlay_name_from_nr(overlay_nr),
2028				unittest_path(unittest_nr, ovtype),
2029				!before ? "enabled" : "disabled");
2030		return -EINVAL;
2031	}
2032
2033	return 0;
2034}
2035
2036/* test activation of device */
2037static void __init of_unittest_overlay_0(void)
2038{
2039	int ret;
2040
2041	EXPECT_BEGIN(KERN_INFO,
2042		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest0/status");
2043
2044	/* device should enable */
2045	ret = of_unittest_apply_overlay_check(0, 0, 0, 1, PDEV_OVERLAY);
2046
2047	EXPECT_END(KERN_INFO,
2048		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest0/status");
2049
2050	if (ret)
2051		return;
2052
2053	unittest(1, "overlay test %d passed\n", 0);
2054}
2055
2056/* test deactivation of device */
2057static void __init of_unittest_overlay_1(void)
2058{
2059	int ret;
2060
2061	EXPECT_BEGIN(KERN_INFO,
2062		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest1/status");
2063
2064	/* device should disable */
2065	ret = of_unittest_apply_overlay_check(1, 1, 1, 0, PDEV_OVERLAY);
2066
2067	EXPECT_END(KERN_INFO,
2068		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest1/status");
2069
2070	if (ret)
2071		return;
2072
2073	unittest(1, "overlay test %d passed\n", 1);
2074
2075}
2076
2077/* test activation of device */
2078static void __init of_unittest_overlay_2(void)
2079{
2080	int ret;
2081
2082	EXPECT_BEGIN(KERN_INFO,
2083		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest2/status");
2084
2085	/* device should enable */
2086	ret = of_unittest_apply_overlay_check(2, 2, 0, 1, PDEV_OVERLAY);
2087
2088	EXPECT_END(KERN_INFO,
2089		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest2/status");
2090
2091	if (ret)
2092		return;
2093	unittest(1, "overlay test %d passed\n", 2);
2094}
2095
2096/* test deactivation of device */
2097static void __init of_unittest_overlay_3(void)
2098{
2099	int ret;
2100
2101	EXPECT_BEGIN(KERN_INFO,
2102		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest3/status");
2103
2104	/* device should disable */
2105	ret = of_unittest_apply_overlay_check(3, 3, 1, 0, PDEV_OVERLAY);
2106
2107	EXPECT_END(KERN_INFO,
2108		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest3/status");
2109
2110	if (ret)
2111		return;
2112
2113	unittest(1, "overlay test %d passed\n", 3);
2114}
2115
2116/* test activation of a full device node */
2117static void __init of_unittest_overlay_4(void)
2118{
2119	/* device should disable */
2120	if (of_unittest_apply_overlay_check(4, 4, 0, 1, PDEV_OVERLAY))
2121		return;
2122
2123	unittest(1, "overlay test %d passed\n", 4);
2124}
2125
2126/* test overlay apply/revert sequence */
2127static void __init of_unittest_overlay_5(void)
2128{
2129	int ret;
2130
2131	EXPECT_BEGIN(KERN_INFO,
2132		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest5/status");
2133
2134	/* device should disable */
2135	ret = of_unittest_apply_revert_overlay_check(5, 5, 0, 1, PDEV_OVERLAY);
2136
2137	EXPECT_END(KERN_INFO,
2138		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest5/status");
2139
2140	if (ret)
2141		return;
2142
2143	unittest(1, "overlay test %d passed\n", 5);
2144}
2145
2146/* test overlay application in sequence */
2147static void __init of_unittest_overlay_6(void)
2148{
2149	int i, ov_id[2], ovcs_id;
2150	int overlay_nr = 6, unittest_nr = 6;
2151	int before = 0, after = 1;
2152	const char *overlay_name;
2153
2154	int ret;
2155
2156	/* unittest device must be in before state */
2157	for (i = 0; i < 2; i++) {
2158		if (of_unittest_device_exists(unittest_nr + i, PDEV_OVERLAY)
2159				!= before) {
2160			unittest(0, "%s with device @\"%s\" %s\n",
2161					overlay_name_from_nr(overlay_nr + i),
2162					unittest_path(unittest_nr + i,
2163						PDEV_OVERLAY),
2164					!before ? "enabled" : "disabled");
2165			return;
2166		}
2167	}
2168
2169	/* apply the overlays */
2170
2171	EXPECT_BEGIN(KERN_INFO,
2172		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest6/status");
2173
2174	overlay_name = overlay_name_from_nr(overlay_nr + 0);
2175
2176	ret = overlay_data_apply(overlay_name, &ovcs_id);
2177
2178	if (!ret) {
2179		unittest(0, "could not apply overlay \"%s\"\n", overlay_name);
2180			return;
2181	}
2182	ov_id[0] = ovcs_id;
2183	of_unittest_track_overlay(ov_id[0]);
2184
2185	EXPECT_END(KERN_INFO,
2186		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest6/status");
2187
2188	EXPECT_BEGIN(KERN_INFO,
2189		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest7/status");
2190
2191	overlay_name = overlay_name_from_nr(overlay_nr + 1);
2192
2193	ret = overlay_data_apply(overlay_name, &ovcs_id);
2194
2195	if (!ret) {
2196		unittest(0, "could not apply overlay \"%s\"\n", overlay_name);
2197			return;
2198	}
2199	ov_id[1] = ovcs_id;
2200	of_unittest_track_overlay(ov_id[1]);
2201
2202	EXPECT_END(KERN_INFO,
2203		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest7/status");
2204
2205
2206	for (i = 0; i < 2; i++) {
2207		/* unittest device must be in after state */
2208		if (of_unittest_device_exists(unittest_nr + i, PDEV_OVERLAY)
2209				!= after) {
2210			unittest(0, "overlay @\"%s\" failed @\"%s\" %s\n",
2211					overlay_name_from_nr(overlay_nr + i),
2212					unittest_path(unittest_nr + i,
2213						PDEV_OVERLAY),
2214					!after ? "enabled" : "disabled");
2215			return;
2216		}
2217	}
2218
2219	for (i = 1; i >= 0; i--) {
2220		ovcs_id = ov_id[i];
2221		if (of_overlay_remove(&ovcs_id)) {
2222			unittest(0, "%s failed destroy @\"%s\"\n",
2223					overlay_name_from_nr(overlay_nr + i),
2224					unittest_path(unittest_nr + i,
2225						PDEV_OVERLAY));
2226			return;
2227		}
2228		of_unittest_untrack_overlay(ov_id[i]);
2229	}
2230
2231	for (i = 0; i < 2; i++) {
2232		/* unittest device must be again in before state */
2233		if (of_unittest_device_exists(unittest_nr + i, PDEV_OVERLAY)
2234				!= before) {
2235			unittest(0, "%s with device @\"%s\" %s\n",
2236					overlay_name_from_nr(overlay_nr + i),
2237					unittest_path(unittest_nr + i,
2238						PDEV_OVERLAY),
2239					!before ? "enabled" : "disabled");
2240			return;
2241		}
2242	}
2243
2244	unittest(1, "overlay test %d passed\n", 6);
2245
2246}
2247
2248/* test overlay application in sequence */
2249static void __init of_unittest_overlay_8(void)
2250{
2251	int i, ov_id[2], ovcs_id;
2252	int overlay_nr = 8, unittest_nr = 8;
2253	const char *overlay_name;
2254	int ret;
2255
2256	/* we don't care about device state in this test */
2257
2258	EXPECT_BEGIN(KERN_INFO,
2259		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest8/status");
2260
2261	overlay_name = overlay_name_from_nr(overlay_nr + 0);
2262
2263	ret = overlay_data_apply(overlay_name, &ovcs_id);
2264	if (!ret)
2265		unittest(0, "could not apply overlay \"%s\"\n", overlay_name);
2266
2267	EXPECT_END(KERN_INFO,
2268		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest8/status");
2269
2270	if (!ret)
2271		return;
2272
2273	ov_id[0] = ovcs_id;
2274	of_unittest_track_overlay(ov_id[0]);
2275
2276	overlay_name = overlay_name_from_nr(overlay_nr + 1);
2277
2278	EXPECT_BEGIN(KERN_INFO,
2279		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest8/property-foo");
2280
2281	/* apply the overlays */
2282	ret = overlay_data_apply(overlay_name, &ovcs_id);
2283
2284	EXPECT_END(KERN_INFO,
2285		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/test-unittest8/property-foo");
2286
2287	if (!ret) {
2288		unittest(0, "could not apply overlay \"%s\"\n", overlay_name);
2289		return;
2290	}
2291
2292	ov_id[1] = ovcs_id;
2293	of_unittest_track_overlay(ov_id[1]);
2294
2295	/* now try to remove first overlay (it should fail) */
2296	ovcs_id = ov_id[0];
2297
2298	EXPECT_BEGIN(KERN_INFO,
2299		     "OF: overlay: node_overlaps_later_cs: #6 overlaps with #7 @/testcase-data/overlay-node/test-bus/test-unittest8");
2300
2301	EXPECT_BEGIN(KERN_INFO,
2302		     "OF: overlay: overlay #6 is not topmost");
2303
2304	ret = of_overlay_remove(&ovcs_id);
2305
2306	EXPECT_END(KERN_INFO,
2307		   "OF: overlay: overlay #6 is not topmost");
2308
2309	EXPECT_END(KERN_INFO,
2310		   "OF: overlay: node_overlaps_later_cs: #6 overlaps with #7 @/testcase-data/overlay-node/test-bus/test-unittest8");
2311
2312	if (!ret) {
 
 
 
 
2313		unittest(0, "%s was destroyed @\"%s\"\n",
2314				overlay_name_from_nr(overlay_nr + 0),
2315				unittest_path(unittest_nr,
2316					PDEV_OVERLAY));
2317		return;
2318	}
2319
2320	/* removing them in order should work */
2321	for (i = 1; i >= 0; i--) {
2322		ovcs_id = ov_id[i];
2323		if (of_overlay_remove(&ovcs_id)) {
2324			unittest(0, "%s not destroyed @\"%s\"\n",
2325					overlay_name_from_nr(overlay_nr + i),
2326					unittest_path(unittest_nr,
2327						PDEV_OVERLAY));
2328			return;
2329		}
2330		of_unittest_untrack_overlay(ov_id[i]);
2331	}
2332
2333	unittest(1, "overlay test %d passed\n", 8);
2334}
2335
2336/* test insertion of a bus with parent devices */
2337static void __init of_unittest_overlay_10(void)
2338{
2339	int ret;
2340	char *child_path;
2341
2342	/* device should disable */
2343	ret = of_unittest_apply_overlay_check(10, 10, 0, 1, PDEV_OVERLAY);
2344
2345	if (unittest(ret == 0,
2346			"overlay test %d failed; overlay application\n", 10))
2347		return;
2348
2349	child_path = kasprintf(GFP_KERNEL, "%s/test-unittest101",
2350			unittest_path(10, PDEV_OVERLAY));
2351	if (unittest(child_path, "overlay test %d failed; kasprintf\n", 10))
2352		return;
2353
2354	ret = of_path_device_type_exists(child_path, PDEV_OVERLAY);
2355	kfree(child_path);
2356
2357	unittest(ret, "overlay test %d failed; no child device\n", 10);
2358}
2359
2360/* test insertion of a bus with parent devices (and revert) */
2361static void __init of_unittest_overlay_11(void)
2362{
2363	int ret;
2364
2365	/* device should disable */
2366	ret = of_unittest_apply_revert_overlay_check(11, 11, 0, 1,
2367			PDEV_OVERLAY);
2368
2369	unittest(ret == 0, "overlay test %d failed; overlay apply\n", 11);
2370}
2371
2372#if IS_BUILTIN(CONFIG_I2C) && IS_ENABLED(CONFIG_OF_OVERLAY)
2373
2374struct unittest_i2c_bus_data {
2375	struct platform_device	*pdev;
2376	struct i2c_adapter	adap;
2377};
2378
2379static int unittest_i2c_master_xfer(struct i2c_adapter *adap,
2380		struct i2c_msg *msgs, int num)
2381{
2382	struct unittest_i2c_bus_data *std = i2c_get_adapdata(adap);
2383
2384	(void)std;
2385
2386	return num;
2387}
2388
2389static u32 unittest_i2c_functionality(struct i2c_adapter *adap)
2390{
2391	return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
2392}
2393
2394static const struct i2c_algorithm unittest_i2c_algo = {
2395	.master_xfer	= unittest_i2c_master_xfer,
2396	.functionality	= unittest_i2c_functionality,
2397};
2398
2399static int unittest_i2c_bus_probe(struct platform_device *pdev)
2400{
2401	struct device *dev = &pdev->dev;
2402	struct device_node *np = dev->of_node;
2403	struct unittest_i2c_bus_data *std;
2404	struct i2c_adapter *adap;
2405	int ret;
2406
2407	if (np == NULL) {
2408		dev_err(dev, "No OF data for device\n");
2409		return -EINVAL;
2410
2411	}
2412
2413	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2414
2415	std = devm_kzalloc(dev, sizeof(*std), GFP_KERNEL);
2416	if (!std)
2417		return -ENOMEM;
2418
2419	/* link them together */
2420	std->pdev = pdev;
2421	platform_set_drvdata(pdev, std);
2422
2423	adap = &std->adap;
2424	i2c_set_adapdata(adap, std);
2425	adap->nr = -1;
2426	strlcpy(adap->name, pdev->name, sizeof(adap->name));
2427	adap->class = I2C_CLASS_DEPRECATED;
2428	adap->algo = &unittest_i2c_algo;
2429	adap->dev.parent = dev;
2430	adap->dev.of_node = dev->of_node;
2431	adap->timeout = 5 * HZ;
2432	adap->retries = 3;
2433
2434	ret = i2c_add_numbered_adapter(adap);
2435	if (ret != 0) {
2436		dev_err(dev, "Failed to add I2C adapter\n");
2437		return ret;
2438	}
2439
2440	return 0;
2441}
2442
2443static int unittest_i2c_bus_remove(struct platform_device *pdev)
2444{
2445	struct device *dev = &pdev->dev;
2446	struct device_node *np = dev->of_node;
2447	struct unittest_i2c_bus_data *std = platform_get_drvdata(pdev);
2448
2449	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2450	i2c_del_adapter(&std->adap);
2451
2452	return 0;
2453}
2454
2455static const struct of_device_id unittest_i2c_bus_match[] = {
2456	{ .compatible = "unittest-i2c-bus", },
2457	{},
2458};
2459
2460static struct platform_driver unittest_i2c_bus_driver = {
2461	.probe			= unittest_i2c_bus_probe,
2462	.remove			= unittest_i2c_bus_remove,
2463	.driver = {
2464		.name		= "unittest-i2c-bus",
2465		.of_match_table	= of_match_ptr(unittest_i2c_bus_match),
2466	},
2467};
2468
2469static int unittest_i2c_dev_probe(struct i2c_client *client,
2470		const struct i2c_device_id *id)
2471{
2472	struct device *dev = &client->dev;
2473	struct device_node *np = client->dev.of_node;
2474
2475	if (!np) {
2476		dev_err(dev, "No OF node\n");
2477		return -EINVAL;
2478	}
2479
2480	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2481
2482	return 0;
2483};
2484
2485static int unittest_i2c_dev_remove(struct i2c_client *client)
2486{
2487	struct device *dev = &client->dev;
2488	struct device_node *np = client->dev.of_node;
2489
2490	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2491	return 0;
2492}
2493
2494static const struct i2c_device_id unittest_i2c_dev_id[] = {
2495	{ .name = "unittest-i2c-dev" },
2496	{ }
2497};
2498
2499static struct i2c_driver unittest_i2c_dev_driver = {
2500	.driver = {
2501		.name = "unittest-i2c-dev",
2502	},
2503	.probe = unittest_i2c_dev_probe,
2504	.remove = unittest_i2c_dev_remove,
2505	.id_table = unittest_i2c_dev_id,
2506};
2507
2508#if IS_BUILTIN(CONFIG_I2C_MUX)
2509
2510static int unittest_i2c_mux_select_chan(struct i2c_mux_core *muxc, u32 chan)
2511{
2512	return 0;
2513}
2514
2515static int unittest_i2c_mux_probe(struct i2c_client *client,
2516		const struct i2c_device_id *id)
2517{
2518	int i, nchans;
2519	struct device *dev = &client->dev;
2520	struct i2c_adapter *adap = client->adapter;
2521	struct device_node *np = client->dev.of_node, *child;
2522	struct i2c_mux_core *muxc;
2523	u32 reg, max_reg;
2524
2525	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2526
2527	if (!np) {
2528		dev_err(dev, "No OF node\n");
2529		return -EINVAL;
2530	}
2531
2532	max_reg = (u32)-1;
2533	for_each_child_of_node(np, child) {
2534		if (of_property_read_u32(child, "reg", &reg))
2535			continue;
2536		if (max_reg == (u32)-1 || reg > max_reg)
2537			max_reg = reg;
2538	}
2539	nchans = max_reg == (u32)-1 ? 0 : max_reg + 1;
2540	if (nchans == 0) {
2541		dev_err(dev, "No channels\n");
2542		return -EINVAL;
2543	}
2544
2545	muxc = i2c_mux_alloc(adap, dev, nchans, 0, 0,
2546			     unittest_i2c_mux_select_chan, NULL);
2547	if (!muxc)
2548		return -ENOMEM;
2549	for (i = 0; i < nchans; i++) {
2550		if (i2c_mux_add_adapter(muxc, 0, i, 0)) {
2551			dev_err(dev, "Failed to register mux #%d\n", i);
2552			i2c_mux_del_adapters(muxc);
2553			return -ENODEV;
2554		}
2555	}
2556
2557	i2c_set_clientdata(client, muxc);
2558
2559	return 0;
2560};
2561
2562static int unittest_i2c_mux_remove(struct i2c_client *client)
2563{
2564	struct device *dev = &client->dev;
2565	struct device_node *np = client->dev.of_node;
2566	struct i2c_mux_core *muxc = i2c_get_clientdata(client);
2567
2568	dev_dbg(dev, "%s for node @%pOF\n", __func__, np);
2569	i2c_mux_del_adapters(muxc);
2570	return 0;
2571}
2572
2573static const struct i2c_device_id unittest_i2c_mux_id[] = {
2574	{ .name = "unittest-i2c-mux" },
2575	{ }
2576};
2577
2578static struct i2c_driver unittest_i2c_mux_driver = {
2579	.driver = {
2580		.name = "unittest-i2c-mux",
2581	},
2582	.probe = unittest_i2c_mux_probe,
2583	.remove = unittest_i2c_mux_remove,
2584	.id_table = unittest_i2c_mux_id,
2585};
2586
2587#endif
2588
2589static int of_unittest_overlay_i2c_init(void)
2590{
2591	int ret;
2592
2593	ret = i2c_add_driver(&unittest_i2c_dev_driver);
2594	if (unittest(ret == 0,
2595			"could not register unittest i2c device driver\n"))
2596		return ret;
2597
2598	ret = platform_driver_register(&unittest_i2c_bus_driver);
2599
2600	if (unittest(ret == 0,
2601			"could not register unittest i2c bus driver\n"))
2602		return ret;
2603
2604#if IS_BUILTIN(CONFIG_I2C_MUX)
2605
2606	EXPECT_BEGIN(KERN_INFO,
2607		     "i2c i2c-1: Added multiplexed i2c bus 2");
2608
2609	ret = i2c_add_driver(&unittest_i2c_mux_driver);
2610
2611	EXPECT_END(KERN_INFO,
2612		   "i2c i2c-1: Added multiplexed i2c bus 2");
2613
2614	if (unittest(ret == 0,
2615			"could not register unittest i2c mux driver\n"))
2616		return ret;
2617#endif
2618
2619	return 0;
2620}
2621
2622static void of_unittest_overlay_i2c_cleanup(void)
2623{
2624#if IS_BUILTIN(CONFIG_I2C_MUX)
2625	i2c_del_driver(&unittest_i2c_mux_driver);
2626#endif
2627	platform_driver_unregister(&unittest_i2c_bus_driver);
2628	i2c_del_driver(&unittest_i2c_dev_driver);
2629}
2630
2631static void __init of_unittest_overlay_i2c_12(void)
2632{
2633	int ret;
2634
2635	/* device should enable */
2636	EXPECT_BEGIN(KERN_INFO,
2637		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/i2c-test-bus/test-unittest12/status");
2638
2639	ret = of_unittest_apply_overlay_check(12, 12, 0, 1, I2C_OVERLAY);
2640
2641	EXPECT_END(KERN_INFO,
2642		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/i2c-test-bus/test-unittest12/status");
2643
2644	if (ret)
2645		return;
2646
2647	unittest(1, "overlay test %d passed\n", 12);
2648}
2649
2650/* test deactivation of device */
2651static void __init of_unittest_overlay_i2c_13(void)
2652{
2653	int ret;
2654
2655	EXPECT_BEGIN(KERN_INFO,
2656		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/i2c-test-bus/test-unittest13/status");
2657
2658	/* device should disable */
2659	ret = of_unittest_apply_overlay_check(13, 13, 1, 0, I2C_OVERLAY);
2660
2661	EXPECT_END(KERN_INFO,
2662		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data/overlay-node/test-bus/i2c-test-bus/test-unittest13/status");
2663
2664	if (ret)
2665		return;
2666
2667	unittest(1, "overlay test %d passed\n", 13);
2668}
2669
2670/* just check for i2c mux existence */
2671static void of_unittest_overlay_i2c_14(void)
2672{
2673}
2674
2675static void __init of_unittest_overlay_i2c_15(void)
2676{
2677	int ret;
2678
2679	/* device should enable */
2680	EXPECT_BEGIN(KERN_INFO,
2681		     "i2c i2c-1: Added multiplexed i2c bus 3");
2682
2683	ret = of_unittest_apply_overlay_check(15, 15, 0, 1, I2C_OVERLAY);
2684
2685	EXPECT_END(KERN_INFO,
2686		   "i2c i2c-1: Added multiplexed i2c bus 3");
2687
2688	if (ret)
2689		return;
2690
2691	unittest(1, "overlay test %d passed\n", 15);
2692}
2693
2694#else
2695
2696static inline void of_unittest_overlay_i2c_14(void) { }
2697static inline void of_unittest_overlay_i2c_15(void) { }
2698
2699#endif
2700
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2701static void __init of_unittest_overlay(void)
2702{
2703	struct device_node *bus_np = NULL;
2704
2705	if (platform_driver_register(&unittest_driver)) {
2706		unittest(0, "could not register unittest driver\n");
2707		goto out;
2708	}
2709
2710	bus_np = of_find_node_by_path(bus_path);
2711	if (bus_np == NULL) {
2712		unittest(0, "could not find bus_path \"%s\"\n", bus_path);
2713		goto out;
2714	}
2715
2716	if (of_platform_default_populate(bus_np, NULL, NULL)) {
2717		unittest(0, "could not populate bus @ \"%s\"\n", bus_path);
2718		goto out;
2719	}
2720
2721	if (!of_unittest_device_exists(100, PDEV_OVERLAY)) {
2722		unittest(0, "could not find unittest0 @ \"%s\"\n",
2723				unittest_path(100, PDEV_OVERLAY));
2724		goto out;
2725	}
2726
2727	if (of_unittest_device_exists(101, PDEV_OVERLAY)) {
2728		unittest(0, "unittest1 @ \"%s\" should not exist\n",
2729				unittest_path(101, PDEV_OVERLAY));
2730		goto out;
2731	}
2732
2733	unittest(1, "basic infrastructure of overlays passed");
2734
2735	/* tests in sequence */
2736	of_unittest_overlay_0();
2737	of_unittest_overlay_1();
2738	of_unittest_overlay_2();
2739	of_unittest_overlay_3();
2740	of_unittest_overlay_4();
2741	of_unittest_overlay_5();
2742	of_unittest_overlay_6();
2743	of_unittest_overlay_8();
2744
2745	of_unittest_overlay_10();
2746	of_unittest_overlay_11();
2747
2748#if IS_BUILTIN(CONFIG_I2C)
2749	if (unittest(of_unittest_overlay_i2c_init() == 0, "i2c init failed\n"))
2750		goto out;
2751
2752	of_unittest_overlay_i2c_12();
2753	of_unittest_overlay_i2c_13();
2754	of_unittest_overlay_i2c_14();
2755	of_unittest_overlay_i2c_15();
2756
2757	of_unittest_overlay_i2c_cleanup();
2758#endif
2759
2760	of_unittest_overlay_gpio();
2761
2762	of_unittest_destroy_tracked_overlays();
 
 
2763
2764out:
2765	of_node_put(bus_np);
2766}
2767
2768#else
2769static inline void __init of_unittest_overlay(void) { }
2770#endif
2771
2772#ifdef CONFIG_OF_OVERLAY
2773
2774/*
2775 * __dtb_ot_begin[] and __dtb_ot_end[] are created by cmd_dt_S_dtb
2776 * in scripts/Makefile.lib
2777 */
2778
2779#define OVERLAY_INFO_EXTERN(name) \
2780	extern uint8_t __dtb_##name##_begin[]; \
2781	extern uint8_t __dtb_##name##_end[]
2782
2783#define OVERLAY_INFO(overlay_name, expected)             \
2784{	.dtb_begin       = __dtb_##overlay_name##_begin, \
2785	.dtb_end         = __dtb_##overlay_name##_end,   \
2786	.expected_result = expected,                     \
2787	.name            = #overlay_name,                \
2788}
2789
2790struct overlay_info {
2791	uint8_t		*dtb_begin;
2792	uint8_t		*dtb_end;
2793	int		expected_result;
2794	int		overlay_id;
2795	char		*name;
2796};
2797
2798OVERLAY_INFO_EXTERN(overlay_base);
2799OVERLAY_INFO_EXTERN(overlay);
2800OVERLAY_INFO_EXTERN(overlay_0);
2801OVERLAY_INFO_EXTERN(overlay_1);
2802OVERLAY_INFO_EXTERN(overlay_2);
2803OVERLAY_INFO_EXTERN(overlay_3);
2804OVERLAY_INFO_EXTERN(overlay_4);
2805OVERLAY_INFO_EXTERN(overlay_5);
2806OVERLAY_INFO_EXTERN(overlay_6);
2807OVERLAY_INFO_EXTERN(overlay_7);
2808OVERLAY_INFO_EXTERN(overlay_8);
2809OVERLAY_INFO_EXTERN(overlay_9);
2810OVERLAY_INFO_EXTERN(overlay_10);
2811OVERLAY_INFO_EXTERN(overlay_11);
2812OVERLAY_INFO_EXTERN(overlay_12);
2813OVERLAY_INFO_EXTERN(overlay_13);
2814OVERLAY_INFO_EXTERN(overlay_15);
 
 
 
 
 
2815OVERLAY_INFO_EXTERN(overlay_gpio_01);
2816OVERLAY_INFO_EXTERN(overlay_gpio_02a);
2817OVERLAY_INFO_EXTERN(overlay_gpio_02b);
2818OVERLAY_INFO_EXTERN(overlay_gpio_03);
2819OVERLAY_INFO_EXTERN(overlay_gpio_04a);
2820OVERLAY_INFO_EXTERN(overlay_gpio_04b);
2821OVERLAY_INFO_EXTERN(overlay_bad_add_dup_node);
2822OVERLAY_INFO_EXTERN(overlay_bad_add_dup_prop);
2823OVERLAY_INFO_EXTERN(overlay_bad_phandle);
2824OVERLAY_INFO_EXTERN(overlay_bad_symbol);
2825
2826/* entries found by name */
2827static struct overlay_info overlays[] = {
2828	OVERLAY_INFO(overlay_base, -9999),
2829	OVERLAY_INFO(overlay, 0),
2830	OVERLAY_INFO(overlay_0, 0),
2831	OVERLAY_INFO(overlay_1, 0),
2832	OVERLAY_INFO(overlay_2, 0),
2833	OVERLAY_INFO(overlay_3, 0),
2834	OVERLAY_INFO(overlay_4, 0),
2835	OVERLAY_INFO(overlay_5, 0),
2836	OVERLAY_INFO(overlay_6, 0),
2837	OVERLAY_INFO(overlay_7, 0),
2838	OVERLAY_INFO(overlay_8, 0),
2839	OVERLAY_INFO(overlay_9, 0),
2840	OVERLAY_INFO(overlay_10, 0),
2841	OVERLAY_INFO(overlay_11, 0),
2842	OVERLAY_INFO(overlay_12, 0),
2843	OVERLAY_INFO(overlay_13, 0),
2844	OVERLAY_INFO(overlay_15, 0),
 
 
 
 
 
2845	OVERLAY_INFO(overlay_gpio_01, 0),
2846	OVERLAY_INFO(overlay_gpio_02a, 0),
2847	OVERLAY_INFO(overlay_gpio_02b, 0),
2848	OVERLAY_INFO(overlay_gpio_03, 0),
2849	OVERLAY_INFO(overlay_gpio_04a, 0),
2850	OVERLAY_INFO(overlay_gpio_04b, 0),
2851	OVERLAY_INFO(overlay_bad_add_dup_node, -EINVAL),
2852	OVERLAY_INFO(overlay_bad_add_dup_prop, -EINVAL),
2853	OVERLAY_INFO(overlay_bad_phandle, -EINVAL),
2854	OVERLAY_INFO(overlay_bad_symbol, -EINVAL),
2855	/* end marker */
2856	{.dtb_begin = NULL, .dtb_end = NULL, .expected_result = 0, .name = NULL}
2857};
2858
2859static struct device_node *overlay_base_root;
2860
2861static void * __init dt_alloc_memory(u64 size, u64 align)
2862{
2863	void *ptr = memblock_alloc(size, align);
2864
2865	if (!ptr)
2866		panic("%s: Failed to allocate %llu bytes align=0x%llx\n",
2867		      __func__, size, align);
2868
2869	return ptr;
2870}
2871
2872/*
2873 * Create base device tree for the overlay unittest.
2874 *
2875 * This is called from very early boot code.
2876 *
2877 * Do as much as possible the same way as done in __unflatten_device_tree
2878 * and other early boot steps for the normal FDT so that the overlay base
2879 * unflattened tree will have the same characteristics as the real tree
2880 * (such as having memory allocated by the early allocator).  The goal
2881 * is to test "the real thing" as much as possible, and test "test setup
2882 * code" as little as possible.
2883 *
2884 * Have to stop before resolving phandles, because that uses kmalloc.
2885 */
2886void __init unittest_unflatten_overlay_base(void)
2887{
2888	struct overlay_info *info;
2889	u32 data_size;
2890	void *new_fdt;
2891	u32 size;
2892	int found = 0;
2893	const char *overlay_name = "overlay_base";
2894
2895	for (info = overlays; info && info->name; info++) {
2896		if (!strcmp(overlay_name, info->name)) {
2897			found = 1;
2898			break;
2899		}
2900	}
2901	if (!found) {
2902		pr_err("no overlay data for %s\n", overlay_name);
2903		return;
2904	}
2905
2906	info = &overlays[0];
2907
2908	if (info->expected_result != -9999) {
2909		pr_err("No dtb 'overlay_base' to attach\n");
2910		return;
2911	}
2912
2913	data_size = info->dtb_end - info->dtb_begin;
2914	if (!data_size) {
2915		pr_err("No dtb 'overlay_base' to attach\n");
2916		return;
2917	}
2918
2919	size = fdt_totalsize(info->dtb_begin);
2920	if (size != data_size) {
2921		pr_err("dtb 'overlay_base' header totalsize != actual size");
2922		return;
2923	}
2924
2925	new_fdt = dt_alloc_memory(size, roundup_pow_of_two(FDT_V17_SIZE));
2926	if (!new_fdt) {
2927		pr_err("alloc for dtb 'overlay_base' failed");
2928		return;
2929	}
2930
2931	memcpy(new_fdt, info->dtb_begin, size);
2932
2933	__unflatten_device_tree(new_fdt, NULL, &overlay_base_root,
2934				dt_alloc_memory, true);
2935}
2936
2937/*
2938 * The purpose of of_unittest_overlay_data_add is to add an
2939 * overlay in the normal fashion.  This is a test of the whole
2940 * picture, instead of testing individual elements.
2941 *
2942 * A secondary purpose is to be able to verify that the contents of
2943 * /proc/device-tree/ contains the updated structure and values from
2944 * the overlay.  That must be verified separately in user space.
2945 *
2946 * Return 0 on unexpected error.
2947 */
2948static int __init overlay_data_apply(const char *overlay_name, int *overlay_id)
2949{
2950	struct overlay_info *info;
2951	int found = 0;
2952	int ret;
2953	u32 size;
2954
2955	for (info = overlays; info && info->name; info++) {
2956		if (!strcmp(overlay_name, info->name)) {
2957			found = 1;
2958			break;
2959		}
2960	}
2961	if (!found) {
2962		pr_err("no overlay data for %s\n", overlay_name);
2963		return 0;
2964	}
2965
2966	size = info->dtb_end - info->dtb_begin;
2967	if (!size)
2968		pr_err("no overlay data for %s\n", overlay_name);
2969
2970	ret = of_overlay_fdt_apply(info->dtb_begin, size, &info->overlay_id);
2971	if (overlay_id)
2972		*overlay_id = info->overlay_id;
2973	if (ret < 0)
2974		goto out;
2975
2976	pr_debug("%s applied\n", overlay_name);
2977
2978out:
2979	if (ret != info->expected_result)
2980		pr_err("of_overlay_fdt_apply() expected %d, ret=%d, %s\n",
2981		       info->expected_result, ret, overlay_name);
2982
2983	return (ret == info->expected_result);
2984}
2985
2986/*
2987 * The purpose of of_unittest_overlay_high_level is to add an overlay
2988 * in the normal fashion.  This is a test of the whole picture,
2989 * instead of individual elements.
2990 *
2991 * The first part of the function is _not_ normal overlay usage; it is
2992 * finishing splicing the base overlay device tree into the live tree.
2993 */
2994static __init void of_unittest_overlay_high_level(void)
2995{
2996	struct device_node *last_sibling;
2997	struct device_node *np;
2998	struct device_node *of_symbols;
2999	struct device_node *overlay_base_symbols;
3000	struct device_node **pprev;
3001	struct property *prop;
3002	int ret;
3003
3004	if (!overlay_base_root) {
3005		unittest(0, "overlay_base_root not initialized\n");
3006		return;
3007	}
3008
3009	/*
3010	 * Could not fixup phandles in unittest_unflatten_overlay_base()
3011	 * because kmalloc() was not yet available.
3012	 */
3013	of_overlay_mutex_lock();
3014	of_resolve_phandles(overlay_base_root);
3015	of_overlay_mutex_unlock();
3016
3017
3018	/*
3019	 * do not allow overlay_base to duplicate any node already in
3020	 * tree, this greatly simplifies the code
3021	 */
3022
3023	/*
3024	 * remove overlay_base_root node "__local_fixups", after
3025	 * being used by of_resolve_phandles()
3026	 */
3027	pprev = &overlay_base_root->child;
3028	for (np = overlay_base_root->child; np; np = np->sibling) {
3029		if (of_node_name_eq(np, "__local_fixups__")) {
3030			*pprev = np->sibling;
3031			break;
3032		}
3033		pprev = &np->sibling;
3034	}
3035
3036	/* remove overlay_base_root node "__symbols__" if in live tree */
3037	of_symbols = of_get_child_by_name(of_root, "__symbols__");
3038	if (of_symbols) {
3039		/* will have to graft properties from node into live tree */
3040		pprev = &overlay_base_root->child;
3041		for (np = overlay_base_root->child; np; np = np->sibling) {
3042			if (of_node_name_eq(np, "__symbols__")) {
3043				overlay_base_symbols = np;
3044				*pprev = np->sibling;
3045				break;
3046			}
3047			pprev = &np->sibling;
3048		}
3049	}
3050
3051	for_each_child_of_node(overlay_base_root, np) {
3052		struct device_node *base_child;
3053		for_each_child_of_node(of_root, base_child) {
3054			if (!strcmp(np->full_name, base_child->full_name)) {
3055				unittest(0, "illegal node name in overlay_base %pOFn",
3056					 np);
 
 
3057				return;
3058			}
3059		}
3060	}
3061
3062	/*
3063	 * overlay 'overlay_base' is not allowed to have root
3064	 * properties, so only need to splice nodes into main device tree.
3065	 *
3066	 * root node of *overlay_base_root will not be freed, it is lost
3067	 * memory.
3068	 */
3069
3070	for (np = overlay_base_root->child; np; np = np->sibling)
3071		np->parent = of_root;
3072
3073	mutex_lock(&of_mutex);
3074
3075	for (last_sibling = np = of_root->child; np; np = np->sibling)
3076		last_sibling = np;
3077
3078	if (last_sibling)
3079		last_sibling->sibling = overlay_base_root->child;
3080	else
3081		of_root->child = overlay_base_root->child;
3082
3083	for_each_of_allnodes_from(overlay_base_root, np)
3084		__of_attach_node_sysfs(np);
3085
3086	if (of_symbols) {
3087		struct property *new_prop;
3088		for_each_property_of_node(overlay_base_symbols, prop) {
3089
3090			new_prop = __of_prop_dup(prop, GFP_KERNEL);
3091			if (!new_prop) {
3092				unittest(0, "__of_prop_dup() of '%s' from overlay_base node __symbols__",
3093					 prop->name);
3094				goto err_unlock;
3095			}
3096			if (__of_add_property(of_symbols, new_prop)) {
3097				kfree(new_prop->name);
3098				kfree(new_prop->value);
3099				kfree(new_prop);
3100				/* "name" auto-generated by unflatten */
3101				if (!strcmp(prop->name, "name"))
3102					continue;
3103				unittest(0, "duplicate property '%s' in overlay_base node __symbols__",
3104					 prop->name);
3105				goto err_unlock;
3106			}
3107			if (__of_add_property_sysfs(of_symbols, new_prop)) {
3108				unittest(0, "unable to add property '%s' in overlay_base node __symbols__ to sysfs",
3109					 prop->name);
3110				goto err_unlock;
3111			}
3112		}
3113	}
3114
3115	mutex_unlock(&of_mutex);
3116
3117
3118	/* now do the normal overlay usage test */
3119
3120	EXPECT_BEGIN(KERN_ERR,
3121		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/substation@100/status");
3122	EXPECT_BEGIN(KERN_ERR,
3123		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/status");
3124	EXPECT_BEGIN(KERN_ERR,
3125		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/ride@100/track@30/incline-up");
3126	EXPECT_BEGIN(KERN_ERR,
3127		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/ride@100/track@40/incline-up");
3128	EXPECT_BEGIN(KERN_ERR,
3129		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/status");
3130	EXPECT_BEGIN(KERN_ERR,
3131		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/color");
3132	EXPECT_BEGIN(KERN_ERR,
3133		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/rate");
3134	EXPECT_BEGIN(KERN_ERR,
3135		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/hvac_2");
3136	EXPECT_BEGIN(KERN_ERR,
3137		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200");
3138	EXPECT_BEGIN(KERN_ERR,
3139		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200_left");
3140	EXPECT_BEGIN(KERN_ERR,
3141		     "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200_right");
3142
3143	ret = overlay_data_apply("overlay", NULL);
3144
3145	EXPECT_END(KERN_ERR,
3146		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200_right");
3147	EXPECT_END(KERN_ERR,
3148		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200_left");
3149	EXPECT_END(KERN_ERR,
3150		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/ride_200");
3151	EXPECT_END(KERN_ERR,
3152		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /__symbols__/hvac_2");
3153	EXPECT_END(KERN_ERR,
3154		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/rate");
3155	EXPECT_END(KERN_ERR,
3156		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/color");
3157	EXPECT_END(KERN_ERR,
3158		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/lights@40000/status");
3159	EXPECT_END(KERN_ERR,
3160		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/ride@100/track@40/incline-up");
3161	EXPECT_END(KERN_ERR,
3162		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/ride@100/track@30/incline-up");
3163	EXPECT_END(KERN_ERR,
3164		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/fairway-1/status");
3165	EXPECT_END(KERN_ERR,
3166		   "OF: overlay: WARNING: memory leak will occur if overlay removed, property: /testcase-data-2/substation@100/status");
3167
3168	unittest(ret, "Adding overlay 'overlay' failed\n");
3169
3170	EXPECT_BEGIN(KERN_ERR,
3171		     "OF: overlay: ERROR: multiple fragments add and/or delete node /testcase-data-2/substation@100/motor-1/controller");
3172	EXPECT_BEGIN(KERN_ERR,
3173		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/controller/name");
3174
3175	unittest(overlay_data_apply("overlay_bad_add_dup_node", NULL),
3176		 "Adding overlay 'overlay_bad_add_dup_node' failed\n");
3177
3178	EXPECT_END(KERN_ERR,
3179		   "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/controller/name");
3180	EXPECT_END(KERN_ERR,
3181		   "OF: overlay: ERROR: multiple fragments add and/or delete node /testcase-data-2/substation@100/motor-1/controller");
3182
3183	EXPECT_BEGIN(KERN_ERR,
3184		     "OF: overlay: ERROR: multiple fragments add and/or delete node /testcase-data-2/substation@100/motor-1/electric");
3185	EXPECT_BEGIN(KERN_ERR,
3186		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/electric/rpm_avail");
3187	EXPECT_BEGIN(KERN_ERR,
3188		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/electric/name");
3189
3190	unittest(overlay_data_apply("overlay_bad_add_dup_prop", NULL),
3191		 "Adding overlay 'overlay_bad_add_dup_prop' failed\n");
3192
3193	EXPECT_END(KERN_ERR,
3194		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/electric/name");
3195	EXPECT_END(KERN_ERR,
3196		     "OF: overlay: ERROR: multiple fragments add, update, and/or delete property /testcase-data-2/substation@100/motor-1/electric/rpm_avail");
3197	EXPECT_END(KERN_ERR,
3198		     "OF: overlay: ERROR: multiple fragments add and/or delete node /testcase-data-2/substation@100/motor-1/electric");
3199
3200	unittest(overlay_data_apply("overlay_bad_phandle", NULL),
3201		 "Adding overlay 'overlay_bad_phandle' failed\n");
3202
3203	unittest(overlay_data_apply("overlay_bad_symbol", NULL),
3204		 "Adding overlay 'overlay_bad_symbol' failed\n");
3205
3206	return;
3207
3208err_unlock:
3209	mutex_unlock(&of_mutex);
3210}
3211
3212#else
3213
3214static inline __init void of_unittest_overlay_high_level(void) {}
3215
3216#endif
3217
3218static int __init of_unittest(void)
3219{
3220	struct device_node *np;
3221	int res;
3222
3223	pr_info("start of unittest - you will see error messages\n");
3224
 
 
 
3225	/* adding data for unittest */
3226
3227	if (IS_ENABLED(CONFIG_UML))
3228		unittest_unflatten_overlay_base();
3229
3230	res = unittest_data_add();
3231	if (res)
3232		return res;
3233	if (!of_aliases)
3234		of_aliases = of_find_node_by_path("/aliases");
3235
3236	np = of_find_node_by_path("/testcase-data/phandle-tests/consumer-a");
3237	if (!np) {
3238		pr_info("No testcase data in device tree; not running tests\n");
3239		return 0;
3240	}
3241	of_node_put(np);
3242
3243	of_unittest_check_tree_linkage();
3244	of_unittest_check_phandles();
3245	of_unittest_find_node_by_name();
3246	of_unittest_dynamic();
3247	of_unittest_parse_phandle_with_args();
3248	of_unittest_parse_phandle_with_args_map();
3249	of_unittest_printf();
3250	of_unittest_property_string();
3251	of_unittest_property_copy();
3252	of_unittest_changeset();
3253	of_unittest_parse_interrupts();
3254	of_unittest_parse_interrupts_extended();
 
3255	of_unittest_parse_dma_ranges();
3256	of_unittest_pci_dma_ranges();
3257	of_unittest_match_node();
3258	of_unittest_platform_populate();
3259	of_unittest_overlay();
3260
3261	/* Double check linkage after removing testcase data */
3262	of_unittest_check_tree_linkage();
3263
3264	of_unittest_overlay_high_level();
3265
3266	pr_info("end of unittest - %i passed, %i failed\n",
3267		unittest_results.passed, unittest_results.failed);
3268
3269	return 0;
3270}
3271late_initcall(of_unittest);