base.c 44.6 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0+
2 3 4 5 6 7 8 9 10 11 12
/*
 * Procedures for creating, accessing and interpreting the device tree.
 *
 * Paul Mackerras	August 1996.
 * Copyright (C) 1996-2005 Paul Mackerras.
 *
 *  Adapted for 64bit PowerPC by Dave Engebretsen and Peter Bergner.
 *    {engebret|bergner}@us.ibm.com
 *
 *  Adapted for sparc and sparc64 by David S. Miller davem@davemloft.net
 *
13 14
 *  Reconsolidated from arch/x/kernel/prom.c by Stephen Rothwell and
 *  Grant Likely.
15
 */
16 17 18

#define pr_fmt(fmt)	"OF: " fmt

19
#include <linux/console.h>
20
#include <linux/ctype.h>
21
#include <linux/cpu.h>
22 23
#include <linux/module.h>
#include <linux/of.h>
24
#include <linux/of_device.h>
25
#include <linux/of_graph.h>
S
Stephen Rothwell 已提交
26
#include <linux/spinlock.h>
27
#include <linux/slab.h>
28
#include <linux/string.h>
J
Jeremy Kerr 已提交
29
#include <linux/proc_fs.h>
S
Stephen Rothwell 已提交
30

31
#include "of_private.h"
32

33
LIST_HEAD(aliases_lookup);
34

G
Grant Likely 已提交
35 36
struct device_node *of_root;
EXPORT_SYMBOL(of_root);
37
struct device_node *of_chosen;
38
struct device_node *of_aliases;
39
struct device_node *of_stdout;
40
static const char *of_stdout_options;
41

42
struct kset *of_kset;
43 44

/*
45 46 47 48
 * Used to protect the of_aliases, to hold off addition of nodes to sysfs.
 * This mutex must be held whenever modifications are being made to the
 * device tree. The of_{attach,detach}_node() and
 * of_{add,remove,update}_property() helpers make sure this happens.
49
 */
50
DEFINE_MUTEX(of_mutex);
51

G
Grant Likely 已提交
52
/* use when traversing tree through the child, sibling,
S
Stephen Rothwell 已提交
53 54
 * or parent members of struct device_node.
 */
55
DEFINE_RAW_SPINLOCK(devtree_lock);
56 57 58

int of_n_addr_cells(struct device_node *np)
{
59
	u32 cells;
60 61 62 63

	do {
		if (np->parent)
			np = np->parent;
64 65
		if (!of_property_read_u32(np, "#address-cells", &cells))
			return cells;
66 67 68 69 70 71 72 73
	} while (np->parent);
	/* No #address-cells property for the root node */
	return OF_ROOT_NODE_ADDR_CELLS_DEFAULT;
}
EXPORT_SYMBOL(of_n_addr_cells);

int of_n_size_cells(struct device_node *np)
{
74
	u32 cells;
75 76 77 78

	do {
		if (np->parent)
			np = np->parent;
79 80
		if (!of_property_read_u32(np, "#size-cells", &cells))
			return cells;
81 82 83 84 85 86
	} while (np->parent);
	/* No #size-cells property for the root node */
	return OF_ROOT_NODE_SIZE_CELLS_DEFAULT;
}
EXPORT_SYMBOL(of_n_size_cells);

87 88 89
#ifdef CONFIG_NUMA
int __weak of_node_to_nid(struct device_node *np)
{
90
	return NUMA_NO_NODE;
91 92 93
}
#endif

94
void __init of_core_init(void)
95 96 97 98
{
	struct device_node *np;

	/* Create the kset, and register existing nodes */
99
	mutex_lock(&of_mutex);
100 101
	of_kset = kset_create_and_add("devicetree", NULL, firmware_kobj);
	if (!of_kset) {
102
		mutex_unlock(&of_mutex);
103
		pr_err("failed to register existing nodes\n");
104
		return;
105 106
	}
	for_each_of_allnodes(np)
107
		__of_attach_node_sysfs(np);
108
	mutex_unlock(&of_mutex);
109

G
Grant Likely 已提交
110
	/* Symlink in /proc as required by userspace ABI */
G
Grant Likely 已提交
111
	if (of_root)
112 113 114
		proc_symlink("device-tree", NULL, "/sys/firmware/devicetree/base");
}

115 116
static struct property *__of_find_property(const struct device_node *np,
					   const char *name, int *lenp)
S
Stephen Rothwell 已提交
117 118 119
{
	struct property *pp;

120 121 122
	if (!np)
		return NULL;

123
	for (pp = np->properties; pp; pp = pp->next) {
S
Stephen Rothwell 已提交
124
		if (of_prop_cmp(pp->name, name) == 0) {
125
			if (lenp)
S
Stephen Rothwell 已提交
126 127 128 129
				*lenp = pp->length;
			break;
		}
	}
130 131 132 133 134 135 136 137 138

	return pp;
}

struct property *of_find_property(const struct device_node *np,
				  const char *name,
				  int *lenp)
{
	struct property *pp;
139
	unsigned long flags;
140

141
	raw_spin_lock_irqsave(&devtree_lock, flags);
142
	pp = __of_find_property(np, name, lenp);
143
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
S
Stephen Rothwell 已提交
144 145 146 147 148

	return pp;
}
EXPORT_SYMBOL(of_find_property);

G
Grant Likely 已提交
149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165
struct device_node *__of_find_all_nodes(struct device_node *prev)
{
	struct device_node *np;
	if (!prev) {
		np = of_root;
	} else if (prev->child) {
		np = prev->child;
	} else {
		/* Walk back up looking for a sibling, or the end of the structure */
		np = prev;
		while (np->parent && !np->sibling)
			np = np->parent;
		np = np->sibling; /* Might be null at the end of the tree */
	}
	return np;
}

166 167 168 169 170 171 172 173 174 175 176
/**
 * of_find_all_nodes - Get next node in global list
 * @prev:	Previous node or NULL to start iteration
 *		of_node_put() will be called on it
 *
 * Returns a node pointer with refcount incremented, use
 * of_node_put() on it when done.
 */
struct device_node *of_find_all_nodes(struct device_node *prev)
{
	struct device_node *np;
177
	unsigned long flags;
178

179
	raw_spin_lock_irqsave(&devtree_lock, flags);
G
Grant Likely 已提交
180 181
	np = __of_find_all_nodes(prev);
	of_node_get(np);
182
	of_node_put(prev);
183
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
184 185 186 187
	return np;
}
EXPORT_SYMBOL(of_find_all_nodes);

188 189 190 191
/*
 * Find a property with a given name for a given node
 * and return the value.
 */
192 193
const void *__of_get_property(const struct device_node *np,
			      const char *name, int *lenp)
194 195 196 197 198 199
{
	struct property *pp = __of_find_property(np, name, lenp);

	return pp ? pp->value : NULL;
}

200 201 202 203 204
/*
 * Find a property with a given name for a given node
 * and return the value.
 */
const void *of_get_property(const struct device_node *np, const char *name,
205
			    int *lenp)
206 207 208 209 210 211
{
	struct property *pp = of_find_property(np, name, lenp);

	return pp ? pp->value : NULL;
}
EXPORT_SYMBOL(of_get_property);
212

213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245
/*
 * arch_match_cpu_phys_id - Match the given logical CPU and physical id
 *
 * @cpu: logical cpu index of a core/thread
 * @phys_id: physical identifier of a core/thread
 *
 * CPU logical to physical index mapping is architecture specific.
 * However this __weak function provides a default match of physical
 * id to logical cpu index. phys_id provided here is usually values read
 * from the device tree which must match the hardware internal registers.
 *
 * Returns true if the physical identifier and the logical cpu index
 * correspond to the same core/thread, false otherwise.
 */
bool __weak arch_match_cpu_phys_id(int cpu, u64 phys_id)
{
	return (u32)phys_id == cpu;
}

/**
 * Checks if the given "prop_name" property holds the physical id of the
 * core/thread corresponding to the logical cpu 'cpu'. If 'thread' is not
 * NULL, local thread number within the core is returned in it.
 */
static bool __of_find_n_match_cpu_property(struct device_node *cpun,
			const char *prop_name, int cpu, unsigned int *thread)
{
	const __be32 *cell;
	int ac, prop_len, tid;
	u64 hwid;

	ac = of_n_addr_cells(cpun);
	cell = of_get_property(cpun, prop_name, &prop_len);
246
	if (!cell || !ac)
247
		return false;
248
	prop_len /= sizeof(*cell) * ac;
249 250 251 252 253 254 255 256 257 258 259 260
	for (tid = 0; tid < prop_len; tid++) {
		hwid = of_read_number(cell, ac);
		if (arch_match_cpu_phys_id(cpu, hwid)) {
			if (thread)
				*thread = tid;
			return true;
		}
		cell += ac;
	}
	return false;
}

261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279
/*
 * arch_find_n_match_cpu_physical_id - See if the given device node is
 * for the cpu corresponding to logical cpu 'cpu'.  Return true if so,
 * else false.  If 'thread' is non-NULL, the local thread number within the
 * core is returned in it.
 */
bool __weak arch_find_n_match_cpu_physical_id(struct device_node *cpun,
					      int cpu, unsigned int *thread)
{
	/* Check for non-standard "ibm,ppc-interrupt-server#s" property
	 * for thread ids on PowerPC. If it doesn't exist fallback to
	 * standard "reg" property.
	 */
	if (IS_ENABLED(CONFIG_PPC) &&
	    __of_find_n_match_cpu_property(cpun,
					   "ibm,ppc-interrupt-server#s",
					   cpu, thread))
		return true;

280
	return __of_find_n_match_cpu_property(cpun, "reg", cpu, thread);
281 282
}

283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298
/**
 * of_get_cpu_node - Get device node associated with the given logical CPU
 *
 * @cpu: CPU number(logical index) for which device node is required
 * @thread: if not NULL, local thread number within the physical core is
 *          returned
 *
 * The main purpose of this function is to retrieve the device node for the
 * given logical CPU index. It should be used to initialize the of_node in
 * cpu device. Once of_node in cpu device is populated, all the further
 * references can use that instead.
 *
 * CPU logical to physical index mapping is architecture specific and is built
 * before booting secondary cores. This function uses arch_match_cpu_phys_id
 * which can be overridden by architecture specific implementation.
 *
299 300
 * Returns a node pointer for the logical cpu with refcount incremented, use
 * of_node_put() on it when done. Returns NULL if not found.
301 302 303
 */
struct device_node *of_get_cpu_node(int cpu, unsigned int *thread)
{
304
	struct device_node *cpun;
305

306 307
	for_each_node_by_type(cpun, "cpu") {
		if (arch_find_n_match_cpu_physical_id(cpun, cpu, thread))
308 309 310 311 312 313
			return cpun;
	}
	return NULL;
}
EXPORT_SYMBOL(of_get_cpu_node);

314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339
/**
 * of_cpu_node_to_id: Get the logical CPU number for a given device_node
 *
 * @cpu_node: Pointer to the device_node for CPU.
 *
 * Returns the logical CPU number of the given CPU device_node.
 * Returns -ENODEV if the CPU is not found.
 */
int of_cpu_node_to_id(struct device_node *cpu_node)
{
	int cpu;
	bool found = false;
	struct device_node *np;

	for_each_possible_cpu(cpu) {
		np = of_cpu_device_node_get(cpu);
		found = (cpu_node == np);
		of_node_put(np);
		if (found)
			return cpu;
	}

	return -ENODEV;
}
EXPORT_SYMBOL(of_cpu_node_to_id);

340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368
/**
 * __of_device_is_compatible() - Check if the node matches given constraints
 * @device: pointer to node
 * @compat: required compatible string, NULL or "" for any match
 * @type: required device_type value, NULL or "" for any match
 * @name: required node name, NULL or "" for any match
 *
 * Checks if the given @compat, @type and @name strings match the
 * properties of the given @device. A constraints can be skipped by
 * passing NULL or an empty string as the constraint.
 *
 * Returns 0 for no match, and a positive integer on match. The return
 * value is a relative score with larger values indicating better
 * matches. The score is weighted for the most specific compatible value
 * to get the highest score. Matching type is next, followed by matching
 * name. Practically speaking, this results in the following priority
 * order for matches:
 *
 * 1. specific compatible && type && name
 * 2. specific compatible && type
 * 3. specific compatible && name
 * 4. specific compatible
 * 5. general compatible && type && name
 * 6. general compatible && type
 * 7. general compatible && name
 * 8. general compatible
 * 9. type && name
 * 10. type
 * 11. name
369
 */
370
static int __of_device_is_compatible(const struct device_node *device,
371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389
				     const char *compat, const char *type, const char *name)
{
	struct property *prop;
	const char *cp;
	int index = 0, score = 0;

	/* Compatible match has highest priority */
	if (compat && compat[0]) {
		prop = __of_find_property(device, "compatible", NULL);
		for (cp = of_prop_next_string(prop, NULL); cp;
		     cp = of_prop_next_string(prop, cp), index++) {
			if (of_compat_cmp(cp, compat, strlen(compat)) == 0) {
				score = INT_MAX/2 - (index << 2);
				break;
			}
		}
		if (!score)
			return 0;
	}
390

391 392 393 394 395
	/* Matching type is better than matching name */
	if (type && type[0]) {
		if (!device->type || of_node_cmp(type, device->type))
			return 0;
		score += 2;
396 397
	}

398 399 400 401 402 403 404 405
	/* Matching name is a bit better than not */
	if (name && name[0]) {
		if (!device->name || of_node_cmp(name, device->name))
			return 0;
		score++;
	}

	return score;
406
}
407 408 409 410 411 412 413

/** Checks if the given "compat" string matches one of the strings in
 * the device's "compatible" property
 */
int of_device_is_compatible(const struct device_node *device,
		const char *compat)
{
414
	unsigned long flags;
415 416
	int res;

417
	raw_spin_lock_irqsave(&devtree_lock, flags);
418
	res = __of_device_is_compatible(device, compat, NULL, NULL);
419
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
420 421
	return res;
}
422
EXPORT_SYMBOL(of_device_is_compatible);
S
Stephen Rothwell 已提交
423

424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445
/** Checks if the device is compatible with any of the entries in
 *  a NULL terminated array of strings. Returns the best match
 *  score or 0.
 */
int of_device_compatible_match(struct device_node *device,
			       const char *const *compat)
{
	unsigned int tmp, score = 0;

	if (!compat)
		return 0;

	while (*compat) {
		tmp = of_device_is_compatible(device, *compat);
		if (tmp > score)
			score = tmp;
		compat++;
	}

	return score;
}

G
Grant Likely 已提交
446
/**
447
 * of_machine_is_compatible - Test root of device tree for a given compatible value
G
Grant Likely 已提交
448 449
 * @compat: compatible string to look for in root node's compatible property.
 *
450
 * Returns a positive integer if the root node has the given value in its
G
Grant Likely 已提交
451 452
 * compatible property.
 */
453
int of_machine_is_compatible(const char *compat)
G
Grant Likely 已提交
454 455 456 457 458 459 460 461 462 463 464
{
	struct device_node *root;
	int rc = 0;

	root = of_find_node_by_path("/");
	if (root) {
		rc = of_device_is_compatible(root, compat);
		of_node_put(root);
	}
	return rc;
}
465
EXPORT_SYMBOL(of_machine_is_compatible);
G
Grant Likely 已提交
466

467
/**
468
 *  __of_device_is_available - check if a device is available for use
469
 *
470
 *  @device: Node to check for availability, with locks already held
471
 *
472 473
 *  Returns true if the status property is absent or set to "okay" or "ok",
 *  false otherwise
474
 */
475
static bool __of_device_is_available(const struct device_node *device)
476 477 478 479
{
	const char *status;
	int statlen;

480
	if (!device)
481
		return false;
482

483
	status = __of_get_property(device, "status", &statlen);
484
	if (status == NULL)
485
		return true;
486 487 488

	if (statlen > 0) {
		if (!strcmp(status, "okay") || !strcmp(status, "ok"))
489
			return true;
490 491
	}

492
	return false;
493
}
494 495 496 497 498 499

/**
 *  of_device_is_available - check if a device is available for use
 *
 *  @device: Node to check for availability
 *
500 501
 *  Returns true if the status property is absent or set to "okay" or "ok",
 *  false otherwise
502
 */
503
bool of_device_is_available(const struct device_node *device)
504 505
{
	unsigned long flags;
506
	bool res;
507 508 509 510 511 512 513

	raw_spin_lock_irqsave(&devtree_lock, flags);
	res = __of_device_is_available(device);
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
	return res;

}
514 515
EXPORT_SYMBOL(of_device_is_available);

516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538
/**
 *  of_device_is_big_endian - check if a device has BE registers
 *
 *  @device: Node to check for endianness
 *
 *  Returns true if the device has a "big-endian" property, or if the kernel
 *  was compiled for BE *and* the device has a "native-endian" property.
 *  Returns false otherwise.
 *
 *  Callers would nominally use ioread32be/iowrite32be if
 *  of_device_is_big_endian() == true, or readl/writel otherwise.
 */
bool of_device_is_big_endian(const struct device_node *device)
{
	if (of_property_read_bool(device, "big-endian"))
		return true;
	if (IS_ENABLED(CONFIG_CPU_BIG_ENDIAN) &&
	    of_property_read_bool(device, "native-endian"))
		return true;
	return false;
}
EXPORT_SYMBOL(of_device_is_big_endian);

S
Stephen Rothwell 已提交
539 540 541 542 543 544 545 546 547 548
/**
 *	of_get_parent - Get a node's parent if any
 *	@node:	Node to get parent
 *
 *	Returns a node pointer with refcount incremented, use
 *	of_node_put() on it when done.
 */
struct device_node *of_get_parent(const struct device_node *node)
{
	struct device_node *np;
549
	unsigned long flags;
S
Stephen Rothwell 已提交
550 551 552 553

	if (!node)
		return NULL;

554
	raw_spin_lock_irqsave(&devtree_lock, flags);
S
Stephen Rothwell 已提交
555
	np = of_node_get(node->parent);
556
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
S
Stephen Rothwell 已提交
557 558 559
	return np;
}
EXPORT_SYMBOL(of_get_parent);
S
Stephen Rothwell 已提交
560

561 562 563 564
/**
 *	of_get_next_parent - Iterate to a node's parent
 *	@node:	Node to get parent of
 *
G
Geert Uytterhoeven 已提交
565 566 567
 *	This is like of_get_parent() except that it drops the
 *	refcount on the passed node, making it suitable for iterating
 *	through a node's parents.
568 569 570 571 572 573 574
 *
 *	Returns a node pointer with refcount incremented, use
 *	of_node_put() on it when done.
 */
struct device_node *of_get_next_parent(struct device_node *node)
{
	struct device_node *parent;
575
	unsigned long flags;
576 577 578 579

	if (!node)
		return NULL;

580
	raw_spin_lock_irqsave(&devtree_lock, flags);
581 582
	parent = of_node_get(node->parent);
	of_node_put(node);
583
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
584 585
	return parent;
}
586
EXPORT_SYMBOL(of_get_next_parent);
587

588 589 590 591 592
static struct device_node *__of_get_next_child(const struct device_node *node,
						struct device_node *prev)
{
	struct device_node *next;

593 594 595
	if (!node)
		return NULL;

596 597 598 599 600 601 602 603 604 605 606
	next = prev ? prev->sibling : node->child;
	for (; next; next = next->sibling)
		if (of_node_get(next))
			break;
	of_node_put(prev);
	return next;
}
#define __for_each_child_of_node(parent, child) \
	for (child = __of_get_next_child(parent, NULL); child != NULL; \
	     child = __of_get_next_child(parent, child))

S
Stephen Rothwell 已提交
607 608 609 610 611
/**
 *	of_get_next_child - Iterate a node childs
 *	@node:	parent node
 *	@prev:	previous child of the parent node, or NULL to get first
 *
612 613 614
 *	Returns a node pointer with refcount incremented, use of_node_put() on
 *	it when done. Returns NULL when prev is the last child. Decrements the
 *	refcount of prev.
S
Stephen Rothwell 已提交
615 616 617 618 619
 */
struct device_node *of_get_next_child(const struct device_node *node,
	struct device_node *prev)
{
	struct device_node *next;
620
	unsigned long flags;
S
Stephen Rothwell 已提交
621

622
	raw_spin_lock_irqsave(&devtree_lock, flags);
623
	next = __of_get_next_child(node, prev);
624
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
S
Stephen Rothwell 已提交
625 626 627
	return next;
}
EXPORT_SYMBOL(of_get_next_child);
628

629 630 631 632 633 634 635 636 637 638 639 640
/**
 *	of_get_next_available_child - Find the next available child node
 *	@node:	parent node
 *	@prev:	previous child of the parent node, or NULL to get first
 *
 *      This function is like of_get_next_child(), except that it
 *      automatically skips any disabled nodes (i.e. status = "disabled").
 */
struct device_node *of_get_next_available_child(const struct device_node *node,
	struct device_node *prev)
{
	struct device_node *next;
641
	unsigned long flags;
642

643 644 645
	if (!node)
		return NULL;

646
	raw_spin_lock_irqsave(&devtree_lock, flags);
647 648
	next = prev ? prev->sibling : node->child;
	for (; next; next = next->sibling) {
649
		if (!__of_device_is_available(next))
650 651 652 653 654
			continue;
		if (of_node_get(next))
			break;
	}
	of_node_put(prev);
655
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
656 657 658 659
	return next;
}
EXPORT_SYMBOL(of_get_next_available_child);

660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682
/**
 *	of_get_child_by_name - Find the child node by name for a given parent
 *	@node:	parent node
 *	@name:	child name to look for.
 *
 *      This function looks for child node for given matching name
 *
 *	Returns a node pointer if found, with refcount incremented, use
 *	of_node_put() on it when done.
 *	Returns NULL if node is not found.
 */
struct device_node *of_get_child_by_name(const struct device_node *node,
				const char *name)
{
	struct device_node *child;

	for_each_child_of_node(node, child)
		if (child->name && (of_node_cmp(child->name, name) == 0))
			break;
	return child;
}
EXPORT_SYMBOL(of_get_child_by_name);

683
struct device_node *__of_find_node_by_path(struct device_node *parent,
684 685 686
						const char *path)
{
	struct device_node *child;
687
	int len;
688

689
	len = strcspn(path, "/:");
690 691 692 693
	if (!len)
		return NULL;

	__for_each_child_of_node(parent, child) {
694
		const char *name = kbasename(child->full_name);
695 696 697 698 699 700
		if (strncmp(path, name, len) == 0 && (strlen(name) == len))
			return child;
	}
	return NULL;
}

701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718
struct device_node *__of_find_node_by_full_path(struct device_node *node,
						const char *path)
{
	const char *separator = strchr(path, ':');

	while (node && *path == '/') {
		struct device_node *tmp = node;

		path++; /* Increment past '/' delimiter */
		node = __of_find_node_by_path(node, path);
		of_node_put(tmp);
		path = strchrnul(path, '/');
		if (separator && separator < path)
			break;
	}
	return node;
}

719
/**
720
 *	of_find_node_opts_by_path - Find a node matching a full OF path
721 722 723 724
 *	@path: Either the full path to match, or if the path does not
 *	       start with '/', the name of a property of the /aliases
 *	       node (an alias).  In the case of an alias, the node
 *	       matching the alias' value will be returned.
725 726 727
 *	@opts: Address of a pointer into which to store the start of
 *	       an options string appended to the end of the path with
 *	       a ':' separator.
728 729 730 731 732
 *
 *	Valid paths:
 *		/foo/bar	Full path
 *		foo		Valid alias
 *		foo/bar		Valid alias + relative path
733 734 735 736
 *
 *	Returns a node pointer with refcount incremented, use
 *	of_node_put() on it when done.
 */
737
struct device_node *of_find_node_opts_by_path(const char *path, const char **opts)
738
{
739 740
	struct device_node *np = NULL;
	struct property *pp;
741
	unsigned long flags;
742 743 744 745
	const char *separator = strchr(path, ':');

	if (opts)
		*opts = separator ? separator + 1 : NULL;
746

747
	if (strcmp(path, "/") == 0)
G
Grant Likely 已提交
748
		return of_node_get(of_root);
749 750 751

	/* The path could begin with an alias */
	if (*path != '/') {
752 753 754 755 756 757
		int len;
		const char *p = separator;

		if (!p)
			p = strchrnul(path, '/');
		len = p - path;
758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774

		/* of_aliases must not be NULL */
		if (!of_aliases)
			return NULL;

		for_each_property_of_node(of_aliases, pp) {
			if (strlen(pp->name) == len && !strncmp(pp->name, path, len)) {
				np = of_find_node_by_path(pp->value);
				break;
			}
		}
		if (!np)
			return NULL;
		path = p;
	}

	/* Step down the tree matching path components */
775
	raw_spin_lock_irqsave(&devtree_lock, flags);
776
	if (!np)
G
Grant Likely 已提交
777
		np = of_node_get(of_root);
778
	np = __of_find_node_by_full_path(np, path);
779
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
780 781
	return np;
}
782
EXPORT_SYMBOL(of_find_node_opts_by_path);
783 784 785

/**
 *	of_find_node_by_name - Find a node by its "name" property
786
 *	@from:	The node to start searching from or NULL; the node
787
 *		you pass will not be searched, only the next one
788 789
 *		will. Typically, you pass what the previous call
 *		returned. of_node_put() will be called on @from.
790 791 792 793 794 795 796 797 798
 *	@name:	The name string to match against
 *
 *	Returns a node pointer with refcount incremented, use
 *	of_node_put() on it when done.
 */
struct device_node *of_find_node_by_name(struct device_node *from,
	const char *name)
{
	struct device_node *np;
799
	unsigned long flags;
800

801
	raw_spin_lock_irqsave(&devtree_lock, flags);
G
Grant Likely 已提交
802
	for_each_of_allnodes_from(from, np)
803 804 805 806
		if (np->name && (of_node_cmp(np->name, name) == 0)
		    && of_node_get(np))
			break;
	of_node_put(from);
807
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827
	return np;
}
EXPORT_SYMBOL(of_find_node_by_name);

/**
 *	of_find_node_by_type - Find a node by its "device_type" property
 *	@from:	The node to start searching from, or NULL to start searching
 *		the entire device tree. The node you pass will not be
 *		searched, only the next one will; typically, you pass
 *		what the previous call returned. of_node_put() will be
 *		called on from for you.
 *	@type:	The type string to match against
 *
 *	Returns a node pointer with refcount incremented, use
 *	of_node_put() on it when done.
 */
struct device_node *of_find_node_by_type(struct device_node *from,
	const char *type)
{
	struct device_node *np;
828
	unsigned long flags;
829

830
	raw_spin_lock_irqsave(&devtree_lock, flags);
G
Grant Likely 已提交
831
	for_each_of_allnodes_from(from, np)
832 833 834 835
		if (np->type && (of_node_cmp(np->type, type) == 0)
		    && of_node_get(np))
			break;
	of_node_put(from);
836
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858
	return np;
}
EXPORT_SYMBOL(of_find_node_by_type);

/**
 *	of_find_compatible_node - Find a node based on type and one of the
 *                                tokens in its "compatible" property
 *	@from:		The node to start searching from or NULL, the node
 *			you pass will not be searched, only the next one
 *			will; typically, you pass what the previous call
 *			returned. of_node_put() will be called on it
 *	@type:		The type string to match "device_type" or NULL to ignore
 *	@compatible:	The string to match to one of the tokens in the device
 *			"compatible" list.
 *
 *	Returns a node pointer with refcount incremented, use
 *	of_node_put() on it when done.
 */
struct device_node *of_find_compatible_node(struct device_node *from,
	const char *type, const char *compatible)
{
	struct device_node *np;
859
	unsigned long flags;
860

861
	raw_spin_lock_irqsave(&devtree_lock, flags);
G
Grant Likely 已提交
862
	for_each_of_allnodes_from(from, np)
863
		if (__of_device_is_compatible(np, compatible, type, NULL) &&
864
		    of_node_get(np))
865 866
			break;
	of_node_put(from);
867
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
868 869 870
	return np;
}
EXPORT_SYMBOL(of_find_compatible_node);
871

872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888
/**
 *	of_find_node_with_property - Find a node which has a property with
 *                                   the given name.
 *	@from:		The node to start searching from or NULL, the node
 *			you pass will not be searched, only the next one
 *			will; typically, you pass what the previous call
 *			returned. of_node_put() will be called on it
 *	@prop_name:	The name of the property to look for.
 *
 *	Returns a node pointer with refcount incremented, use
 *	of_node_put() on it when done.
 */
struct device_node *of_find_node_with_property(struct device_node *from,
	const char *prop_name)
{
	struct device_node *np;
	struct property *pp;
889
	unsigned long flags;
890

891
	raw_spin_lock_irqsave(&devtree_lock, flags);
G
Grant Likely 已提交
892
	for_each_of_allnodes_from(from, np) {
893
		for (pp = np->properties; pp; pp = pp->next) {
894 895 896 897 898 899 900 901
			if (of_prop_cmp(pp->name, prop_name) == 0) {
				of_node_get(np);
				goto out;
			}
		}
	}
out:
	of_node_put(from);
902
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
903 904 905 906
	return np;
}
EXPORT_SYMBOL(of_find_node_with_property);

907 908 909
static
const struct of_device_id *__of_match_node(const struct of_device_id *matches,
					   const struct device_node *node)
910
{
911 912 913
	const struct of_device_id *best_match = NULL;
	int score, best_score = 0;

914 915 916
	if (!matches)
		return NULL;

917 918 919 920 921 922 923
	for (; matches->name[0] || matches->type[0] || matches->compatible[0]; matches++) {
		score = __of_device_is_compatible(node, matches->compatible,
						  matches->type, matches->name);
		if (score > best_score) {
			best_match = matches;
			best_score = score;
		}
924
	}
925 926

	return best_match;
927
}
928 929

/**
G
Geert Uytterhoeven 已提交
930
 * of_match_node - Tell if a device_node has a matching of_match structure
931 932 933
 *	@matches:	array of of device match structures to search in
 *	@node:		the of device structure to match against
 *
934
 *	Low level utility function used by device matching.
935 936 937 938 939
 */
const struct of_device_id *of_match_node(const struct of_device_id *matches,
					 const struct device_node *node)
{
	const struct of_device_id *match;
940
	unsigned long flags;
941

942
	raw_spin_lock_irqsave(&devtree_lock, flags);
943
	match = __of_match_node(matches, node);
944
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
945 946
	return match;
}
947 948 949
EXPORT_SYMBOL(of_match_node);

/**
950 951
 *	of_find_matching_node_and_match - Find a node based on an of_device_id
 *					  match table.
952 953 954 955 956
 *	@from:		The node to start searching from or NULL, the node
 *			you pass will not be searched, only the next one
 *			will; typically, you pass what the previous call
 *			returned. of_node_put() will be called on it
 *	@matches:	array of of device match structures to search in
957
 *	@match		Updated to point at the matches entry which matched
958 959 960 961
 *
 *	Returns a node pointer with refcount incremented, use
 *	of_node_put() on it when done.
 */
962 963 964
struct device_node *of_find_matching_node_and_match(struct device_node *from,
					const struct of_device_id *matches,
					const struct of_device_id **match)
965 966
{
	struct device_node *np;
967
	const struct of_device_id *m;
968
	unsigned long flags;
969

970 971 972
	if (match)
		*match = NULL;

973
	raw_spin_lock_irqsave(&devtree_lock, flags);
G
Grant Likely 已提交
974
	for_each_of_allnodes_from(from, np) {
975
		m = __of_match_node(matches, np);
976
		if (m && of_node_get(np)) {
977
			if (match)
978
				*match = m;
979
			break;
980
		}
981 982
	}
	of_node_put(from);
983
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
984 985
	return np;
}
986
EXPORT_SYMBOL(of_find_matching_node_and_match);
987 988 989 990 991 992 993

/**
 * of_modalias_node - Lookup appropriate modalias for a device node
 * @node:	pointer to a device tree node
 * @modalias:	Pointer to buffer that modalias value will be copied into
 * @len:	Length of modalias value
 *
994 995 996 997
 * Based on the value of the compatible property, this routine will attempt
 * to choose an appropriate modalias value for a particular device tree node.
 * It does this by stripping the manufacturer prefix (as delimited by a ',')
 * from the first entry in the compatible list property.
998
 *
999
 * This routine returns 0 on success, <0 on failure.
1000 1001 1002
 */
int of_modalias_node(struct device_node *node, char *modalias, int len)
{
1003 1004
	const char *compatible, *p;
	int cplen;
1005 1006

	compatible = of_get_property(node, "compatible", &cplen);
1007
	if (!compatible || strlen(compatible) > cplen)
1008 1009
		return -ENODEV;
	p = strchr(compatible, ',');
1010
	strlcpy(modalias, p ? p + 1 : compatible, len);
1011 1012 1013 1014
	return 0;
}
EXPORT_SYMBOL_GPL(of_modalias_node);

J
Jeremy Kerr 已提交
1015 1016 1017 1018 1019 1020 1021 1022 1023 1024
/**
 * of_find_node_by_phandle - Find a node given a phandle
 * @handle:	phandle of the node to find
 *
 * Returns a node pointer with refcount incremented, use
 * of_node_put() on it when done.
 */
struct device_node *of_find_node_by_phandle(phandle handle)
{
	struct device_node *np;
1025
	unsigned long flags;
J
Jeremy Kerr 已提交
1026

1027 1028 1029
	if (!handle)
		return NULL;

1030
	raw_spin_lock_irqsave(&devtree_lock, flags);
G
Grant Likely 已提交
1031
	for_each_of_allnodes(np)
J
Jeremy Kerr 已提交
1032 1033 1034
		if (np->phandle == handle)
			break;
	of_node_get(np);
1035
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
J
Jeremy Kerr 已提交
1036 1037 1038 1039
	return np;
}
EXPORT_SYMBOL(of_find_node_by_phandle);

1040 1041 1042
void of_print_phandle_args(const char *msg, const struct of_phandle_args *args)
{
	int i;
1043
	printk("%s %pOF", msg, args->np);
1044 1045 1046 1047 1048 1049
	for (i = 0; i < args->args_count; i++) {
		const char delim = i ? ',' : ':';

		pr_cont("%c%08x", delim, args->args[i]);
	}
	pr_cont("\n");
1050 1051
}

1052 1053 1054 1055 1056
int of_phandle_iterator_init(struct of_phandle_iterator *it,
		const struct device_node *np,
		const char *list_name,
		const char *cells_name,
		int cell_count)
1057
{
1058 1059 1060 1061
	const __be32 *list;
	int size;

	memset(it, 0, sizeof(*it));
1062 1063

	list = of_get_property(np, list_name, &size);
1064
	if (!list)
1065
		return -ENOENT;
1066

1067 1068 1069 1070 1071 1072 1073 1074 1075
	it->cells_name = cells_name;
	it->cell_count = cell_count;
	it->parent = np;
	it->list_end = list + size / sizeof(*list);
	it->phandle_end = list;
	it->cur = list;

	return 0;
}
1076
EXPORT_SYMBOL_GPL(of_phandle_iterator_init);
1077

1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095
int of_phandle_iterator_next(struct of_phandle_iterator *it)
{
	uint32_t count = 0;

	if (it->node) {
		of_node_put(it->node);
		it->node = NULL;
	}

	if (!it->cur || it->phandle_end >= it->list_end)
		return -ENOENT;

	it->cur = it->phandle_end;

	/* If phandle is 0, then it is an empty entry with no arguments. */
	it->phandle = be32_to_cpup(it->cur++);

	if (it->phandle) {
1096

1097
		/*
1098 1099
		 * Find the provider node and parse the #*-cells property to
		 * determine the argument length.
1100
		 */
1101
		it->node = of_find_node_by_phandle(it->phandle);
1102

1103 1104
		if (it->cells_name) {
			if (!it->node) {
1105 1106
				pr_err("%pOF: could not find phandle\n",
				       it->parent);
1107
				goto err;
1108
			}
1109

1110 1111
			if (of_property_read_u32(it->node, it->cells_name,
						 &count)) {
1112 1113
				pr_err("%pOF: could not get %s for %pOF\n",
				       it->parent,
1114
				       it->cells_name,
1115
				       it->node);
1116
				goto err;
1117
			}
1118 1119
		} else {
			count = it->cell_count;
1120 1121
		}

1122
		/*
1123 1124 1125 1126
		 * Make sure that the arguments actually fit in the remaining
		 * property data length
		 */
		if (it->cur + count > it->list_end) {
1127 1128
			pr_err("%pOF: arguments longer than property\n",
			       it->parent);
1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145
			goto err;
		}
	}

	it->phandle_end = it->cur + count;
	it->cur_count = count;

	return 0;

err:
	if (it->node) {
		of_node_put(it->node);
		it->node = NULL;
	}

	return -EINVAL;
}
1146
EXPORT_SYMBOL_GPL(of_phandle_iterator_next);
1147

1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164
int of_phandle_iterator_args(struct of_phandle_iterator *it,
			     uint32_t *args,
			     int size)
{
	int i, count;

	count = it->cur_count;

	if (WARN_ON(size < count))
		count = size;

	for (i = 0; i < count; i++)
		args[i] = be32_to_cpup(it->cur++);

	return count;
}

1165 1166
static int __of_parse_phandle_with_args(const struct device_node *np,
					const char *list_name,
1167 1168
					const char *cells_name,
					int cell_count, int index,
1169
					struct of_phandle_args *out_args)
1170
{
1171 1172
	struct of_phandle_iterator it;
	int rc, cur_index = 0;
1173

1174
	/* Loop over the phandles until all the requested entry is found */
1175
	of_for_each_phandle(&it, rc, np, list_name, cells_name, cell_count) {
1176
		/*
1177
		 * All of the error cases bail out of the loop, so at
1178 1179 1180 1181
		 * this point, the parsing is successful. If the requested
		 * index matches, then fill the out_args structure and return,
		 * or return -ENOENT for an empty entry.
		 */
1182
		rc = -ENOENT;
1183
		if (cur_index == index) {
1184
			if (!it.phandle)
1185
				goto err;
1186 1187

			if (out_args) {
1188 1189 1190 1191 1192
				int c;

				c = of_phandle_iterator_args(&it,
							     out_args->args,
							     MAX_PHANDLE_ARGS);
1193
				out_args->np = it.node;
1194
				out_args->args_count = c;
1195
			} else {
1196
				of_node_put(it.node);
1197
			}
1198 1199

			/* Found it! return success */
1200
			return 0;
1201 1202 1203 1204 1205
		}

		cur_index++;
	}

1206 1207 1208 1209 1210
	/*
	 * Unlock node before returning result; will be one of:
	 * -ENOENT : index is for empty phandle
	 * -EINVAL : parsing error on data
	 */
1211

1212
 err:
1213
	of_node_put(it.node);
1214
	return rc;
1215
}
1216

S
Stephen Warren 已提交
1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229
/**
 * of_parse_phandle - Resolve a phandle property to a device_node pointer
 * @np: Pointer to device node holding phandle property
 * @phandle_name: Name of property holding a phandle value
 * @index: For properties holding a table of phandles, this is the index into
 *         the table
 *
 * Returns the device_node pointer with refcount incremented.  Use
 * of_node_put() on it when done.
 */
struct device_node *of_parse_phandle(const struct device_node *np,
				     const char *phandle_name, int index)
{
1230 1231 1232 1233
	struct of_phandle_args args;

	if (index < 0)
		return NULL;
S
Stephen Warren 已提交
1234

1235 1236
	if (__of_parse_phandle_with_args(np, phandle_name, NULL, 0,
					 index, &args))
S
Stephen Warren 已提交
1237 1238
		return NULL;

1239
	return args.np;
S
Stephen Warren 已提交
1240 1241 1242
}
EXPORT_SYMBOL(of_parse_phandle);

1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254
/**
 * of_parse_phandle_with_args() - Find a node pointed by phandle in a list
 * @np:		pointer to a device tree node containing a list
 * @list_name:	property name that contains a list
 * @cells_name:	property name that specifies phandles' arguments count
 * @index:	index of a phandle to parse out
 * @out_args:	optional pointer to output arguments structure (will be filled)
 *
 * This function is useful to parse lists of phandles and their arguments.
 * Returns 0 on success and fills out_args, on error returns appropriate
 * errno value.
 *
1255
 * Caller is responsible to call of_node_put() on the returned out_args->np
1256 1257 1258 1259 1260
 * pointer.
 *
 * Example:
 *
 * phandle1: node1 {
G
Geert Uytterhoeven 已提交
1261
 *	#list-cells = <2>;
1262 1263 1264
 * }
 *
 * phandle2: node2 {
G
Geert Uytterhoeven 已提交
1265
 *	#list-cells = <1>;
1266 1267 1268
 * }
 *
 * node3 {
G
Geert Uytterhoeven 已提交
1269
 *	list = <&phandle1 1 2 &phandle2 3>;
1270 1271 1272 1273 1274
 * }
 *
 * To get a device_node of the `node2' node you may call this:
 * of_parse_phandle_with_args(node3, "list", "#list-cells", 1, &args);
 */
1275 1276 1277 1278 1279 1280
int of_parse_phandle_with_args(const struct device_node *np, const char *list_name,
				const char *cells_name, int index,
				struct of_phandle_args *out_args)
{
	if (index < 0)
		return -EINVAL;
1281 1282
	return __of_parse_phandle_with_args(np, list_name, cells_name, 0,
					    index, out_args);
1283
}
1284
EXPORT_SYMBOL(of_parse_phandle_with_args);
1285

1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297
/**
 * of_parse_phandle_with_fixed_args() - Find a node pointed by phandle in a list
 * @np:		pointer to a device tree node containing a list
 * @list_name:	property name that contains a list
 * @cell_count: number of argument cells following the phandle
 * @index:	index of a phandle to parse out
 * @out_args:	optional pointer to output arguments structure (will be filled)
 *
 * This function is useful to parse lists of phandles and their arguments.
 * Returns 0 on success and fills out_args, on error returns appropriate
 * errno value.
 *
1298
 * Caller is responsible to call of_node_put() on the returned out_args->np
1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309
 * pointer.
 *
 * Example:
 *
 * phandle1: node1 {
 * }
 *
 * phandle2: node2 {
 * }
 *
 * node3 {
G
Geert Uytterhoeven 已提交
1310
 *	list = <&phandle1 0 2 &phandle2 2 3>;
1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326
 * }
 *
 * To get a device_node of the `node2' node you may call this:
 * of_parse_phandle_with_fixed_args(node3, "list", 2, 1, &args);
 */
int of_parse_phandle_with_fixed_args(const struct device_node *np,
				const char *list_name, int cell_count,
				int index, struct of_phandle_args *out_args)
{
	if (index < 0)
		return -EINVAL;
	return __of_parse_phandle_with_args(np, list_name, NULL, cell_count,
					   index, out_args);
}
EXPORT_SYMBOL(of_parse_phandle_with_fixed_args);

1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344
/**
 * of_count_phandle_with_args() - Find the number of phandles references in a property
 * @np:		pointer to a device tree node containing a list
 * @list_name:	property name that contains a list
 * @cells_name:	property name that specifies phandles' arguments count
 *
 * Returns the number of phandle + argument tuples within a property. It
 * is a typical pattern to encode a list of phandle and variable
 * arguments into a single property. The number of arguments is encoded
 * by a property in the phandle-target node. For example, a gpios
 * property would contain a list of GPIO specifies consisting of a
 * phandle and 1 or more arguments. The number of arguments are
 * determined by the #gpio-cells property in the node pointed to by the
 * phandle.
 */
int of_count_phandle_with_args(const struct device_node *np, const char *list_name,
				const char *cells_name)
{
1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358
	struct of_phandle_iterator it;
	int rc, cur_index = 0;

	rc = of_phandle_iterator_init(&it, np, list_name, cells_name, 0);
	if (rc)
		return rc;

	while ((rc = of_phandle_iterator_next(&it)) == 0)
		cur_index += 1;

	if (rc != -ENOENT)
		return rc;

	return cur_index;
1359 1360 1361
}
EXPORT_SYMBOL(of_count_phandle_with_args);

1362 1363 1364
/**
 * __of_add_property - Add a property to a node without lock operations
 */
1365
int __of_add_property(struct device_node *np, struct property *prop)
1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382
{
	struct property **next;

	prop->next = NULL;
	next = &np->properties;
	while (*next) {
		if (strcmp(prop->name, (*next)->name) == 0)
			/* duplicate ! don't insert it */
			return -EEXIST;

		next = &(*next)->next;
	}
	*next = prop;

	return 0;
}

1383
/**
1384
 * of_add_property - Add a property to a node
1385
 */
1386
int of_add_property(struct device_node *np, struct property *prop)
1387 1388
{
	unsigned long flags;
1389 1390
	int rc;

1391
	mutex_lock(&of_mutex);
1392

1393
	raw_spin_lock_irqsave(&devtree_lock, flags);
1394
	rc = __of_add_property(np, prop);
1395
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
1396

1397
	if (!rc)
1398
		__of_add_property_sysfs(np, prop);
1399

1400 1401
	mutex_unlock(&of_mutex);

1402 1403 1404
	if (!rc)
		of_property_notify(OF_RECONFIG_ADD_PROPERTY, np, prop, NULL);

1405
	return rc;
1406 1407
}

1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426
int __of_remove_property(struct device_node *np, struct property *prop)
{
	struct property **next;

	for (next = &np->properties; *next; next = &(*next)->next) {
		if (*next == prop)
			break;
	}
	if (*next == NULL)
		return -ENODEV;

	/* found the node */
	*next = prop->next;
	prop->next = np->deadprops;
	np->deadprops = prop;

	return 0;
}

1427
/**
1428
 * of_remove_property - Remove a property from a node.
1429 1430 1431 1432 1433 1434
 *
 * Note that we don't actually remove it, since we have given out
 * who-knows-how-many pointers to the data using get-property.
 * Instead we just move the property to the "dead properties"
 * list, so it won't be found any more.
 */
1435
int of_remove_property(struct device_node *np, struct property *prop)
1436 1437
{
	unsigned long flags;
1438 1439
	int rc;

1440 1441 1442
	if (!prop)
		return -ENODEV;

1443
	mutex_lock(&of_mutex);
1444

1445
	raw_spin_lock_irqsave(&devtree_lock, flags);
1446
	rc = __of_remove_property(np, prop);
1447
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
1448

1449 1450
	if (!rc)
		__of_remove_property_sysfs(np, prop);
1451

1452
	mutex_unlock(&of_mutex);
1453

1454 1455
	if (!rc)
		of_property_notify(OF_RECONFIG_REMOVE_PROPERTY, np, prop, NULL);
1456

1457
	return rc;
1458 1459
}

1460 1461
int __of_update_property(struct device_node *np, struct property *newprop,
		struct property **oldpropp)
1462
{
1463
	struct property **next, *oldprop;
1464

1465 1466 1467 1468 1469
	for (next = &np->properties; *next; next = &(*next)->next) {
		if (of_prop_cmp((*next)->name, newprop->name) == 0)
			break;
	}
	*oldpropp = oldprop = *next;
1470

1471
	if (oldprop) {
1472
		/* replace the node */
1473 1474 1475 1476 1477 1478 1479 1480
		newprop->next = oldprop->next;
		*next = newprop;
		oldprop->next = np->deadprops;
		np->deadprops = oldprop;
	} else {
		/* new node */
		newprop->next = NULL;
		*next = newprop;
1481
	}
1482

1483 1484 1485
	return 0;
}

1486
/*
1487
 * of_update_property - Update a property in a node, if the property does
1488
 * not exist, add it.
1489
 *
1490 1491 1492 1493
 * Note that we don't actually remove it, since we have given out
 * who-knows-how-many pointers to the data using get-property.
 * Instead we just move the property to the "dead properties" list,
 * and add the new property to the property list
1494
 */
1495
int of_update_property(struct device_node *np, struct property *newprop)
1496
{
1497
	struct property *oldprop;
1498
	unsigned long flags;
1499 1500
	int rc;

1501 1502
	if (!newprop->name)
		return -EINVAL;
1503

1504
	mutex_lock(&of_mutex);
1505

1506
	raw_spin_lock_irqsave(&devtree_lock, flags);
1507
	rc = __of_update_property(np, newprop, &oldprop);
1508
	raw_spin_unlock_irqrestore(&devtree_lock, flags);
1509

1510 1511
	if (!rc)
		__of_update_property_sysfs(np, newprop, oldprop);
1512

1513
	mutex_unlock(&of_mutex);
1514

1515 1516
	if (!rc)
		of_property_notify(OF_RECONFIG_UPDATE_PROPERTY, np, newprop, oldprop);
1517

1518
	return rc;
1519 1520
}

1521 1522 1523 1524 1525 1526 1527 1528
static void of_alias_add(struct alias_prop *ap, struct device_node *np,
			 int id, const char *stem, int stem_len)
{
	ap->np = np;
	ap->id = id;
	strncpy(ap->stem, stem, stem_len);
	ap->stem[stem_len] = 0;
	list_add_tail(&ap->link, &aliases_lookup);
1529 1530
	pr_debug("adding DT alias:%s: stem=%s id=%i node=%pOF\n",
		 ap->alias, ap->stem, ap->id, np);
1531 1532 1533
}

/**
1534
 * of_alias_scan - Scan all properties of the 'aliases' node
1535
 *
1536 1537 1538
 * The function scans all the properties of the 'aliases' node and populates
 * the global lookup table with the properties.  It returns the
 * number of alias properties found, or an error code in case of failure.
1539 1540
 *
 * @dt_alloc:	An allocator that provides a virtual address to memory
1541
 *		for storing the resulting tree
1542 1543 1544 1545 1546
 */
void of_alias_scan(void * (*dt_alloc)(u64 size, u64 align))
{
	struct property *pp;

1547
	of_aliases = of_find_node_by_path("/aliases");
1548 1549 1550
	of_chosen = of_find_node_by_path("/chosen");
	if (of_chosen == NULL)
		of_chosen = of_find_node_by_path("/chosen@0");
1551 1552

	if (of_chosen) {
1553
		/* linux,stdout-path and /aliases/stdout are for legacy compatibility */
1554 1555 1556 1557 1558
		const char *name = NULL;

		if (of_property_read_string(of_chosen, "stdout-path", &name))
			of_property_read_string(of_chosen, "linux,stdout-path",
						&name);
1559
		if (IS_ENABLED(CONFIG_PPC) && !name)
1560
			of_property_read_string(of_aliases, "stdout", &name);
1561
		if (name)
1562
			of_stdout = of_find_node_opts_by_path(name, &of_stdout_options);
1563 1564
	}

1565 1566 1567
	if (!of_aliases)
		return;

1568
	for_each_property_of_node(of_aliases, pp) {
1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594
		const char *start = pp->name;
		const char *end = start + strlen(start);
		struct device_node *np;
		struct alias_prop *ap;
		int id, len;

		/* Skip those we do not want to proceed */
		if (!strcmp(pp->name, "name") ||
		    !strcmp(pp->name, "phandle") ||
		    !strcmp(pp->name, "linux,phandle"))
			continue;

		np = of_find_node_by_path(pp->value);
		if (!np)
			continue;

		/* walk the alias backwards to extract the id and work out
		 * the 'stem' string */
		while (isdigit(*(end-1)) && end > start)
			end--;
		len = end - start;

		if (kstrtoint(end, 10, &id) < 0)
			continue;

		/* Allocate an alias_prop with enough space for the stem */
1595
		ap = dt_alloc(sizeof(*ap) + len + 1, __alignof__(*ap));
1596 1597
		if (!ap)
			continue;
1598
		memset(ap, 0, sizeof(*ap) + len + 1);
1599 1600 1601 1602 1603 1604 1605 1606 1607 1608
		ap->alias = start;
		of_alias_add(ap, np, id, start, len);
	}
}

/**
 * of_alias_get_id - Get alias id for the given device_node
 * @np:		Pointer to the given device_node
 * @stem:	Alias stem of the given device_node
 *
1609 1610
 * The function travels the lookup table to get the alias id for the given
 * device_node and alias stem.  It returns the alias id if found.
1611 1612 1613 1614 1615 1616
 */
int of_alias_get_id(struct device_node *np, const char *stem)
{
	struct alias_prop *app;
	int id = -ENODEV;

1617
	mutex_lock(&of_mutex);
1618 1619 1620 1621 1622 1623 1624 1625 1626
	list_for_each_entry(app, &aliases_lookup, link) {
		if (strcmp(app->stem, stem) != 0)
			continue;

		if (np == app->np) {
			id = app->id;
			break;
		}
	}
1627
	mutex_unlock(&of_mutex);
1628 1629 1630 1631

	return id;
}
EXPORT_SYMBOL_GPL(of_alias_get_id);
1632

1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658
/**
 * of_alias_get_highest_id - Get highest alias id for the given stem
 * @stem:	Alias stem to be examined
 *
 * The function travels the lookup table to get the highest alias id for the
 * given alias stem.  It returns the alias id if found.
 */
int of_alias_get_highest_id(const char *stem)
{
	struct alias_prop *app;
	int id = -ENODEV;

	mutex_lock(&of_mutex);
	list_for_each_entry(app, &aliases_lookup, link) {
		if (strcmp(app->stem, stem) != 0)
			continue;

		if (app->id > id)
			id = app->id;
	}
	mutex_unlock(&of_mutex);

	return id;
}
EXPORT_SYMBOL_GPL(of_alias_get_highest_id);

1659
/**
1660 1661 1662 1663 1664 1665 1666 1667
 * of_console_check() - Test and setup console for DT setup
 * @dn - Pointer to device node
 * @name - Name to use for preferred console without index. ex. "ttyS"
 * @index - Index to use for preferred console.
 *
 * Check if the given device node matches the stdout-path property in the
 * /chosen node. If it does then register it as the preferred console and return
 * TRUE. Otherwise return FALSE.
1668
 */
1669
bool of_console_check(struct device_node *dn, char *name, int index)
1670
{
1671
	if (!dn || dn != of_stdout || console_set_on_cmdline)
1672
		return false;
1673 1674 1675 1676 1677 1678

	/*
	 * XXX: cast `options' to char pointer to suppress complication
	 * warnings: printk, UART and console drivers expect char pointer.
	 */
	return !add_preferred_console(name, index, (char *)of_stdout_options);
1679
}
1680
EXPORT_SYMBOL_GPL(of_console_check);
1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691

/**
 *	of_find_next_cache_node - Find a node's subsidiary cache
 *	@np:	node of type "cpu" or "cache"
 *
 *	Returns a node pointer with refcount incremented, use
 *	of_node_put() on it when done.  Caller should hold a reference
 *	to np.
 */
struct device_node *of_find_next_cache_node(const struct device_node *np)
{
1692
	struct device_node *child, *cache_node;
1693

1694 1695 1696
	cache_node = of_parse_phandle(np, "l2-cache", 0);
	if (!cache_node)
		cache_node = of_parse_phandle(np, "next-level-cache", 0);
1697

1698 1699
	if (cache_node)
		return cache_node;
1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710

	/* OF on pmac has nodes instead of properties named "l2-cache"
	 * beneath CPU nodes.
	 */
	if (!strcmp(np->type, "cpu"))
		for_each_child_of_node(np, child)
			if (!strcmp(child->type, "cache"))
				return child;

	return NULL;
}
1711

1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735
/**
 * of_find_last_cache_level - Find the level at which the last cache is
 * 		present for the given logical cpu
 *
 * @cpu: cpu number(logical index) for which the last cache level is needed
 *
 * Returns the the level at which the last cache is present. It is exactly
 * same as  the total number of cache levels for the given logical cpu.
 */
int of_find_last_cache_level(unsigned int cpu)
{
	u32 cache_level = 0;
	struct device_node *prev = NULL, *np = of_cpu_device_node_get(cpu);

	while (np) {
		prev = np;
		of_node_put(np);
		np = of_find_next_cache_node(np);
	}

	of_property_read_u32(prev, "cache-level", &cache_level);

	return cache_level;
}