1 /*
2  * Procedures for creating, accessing and interpreting the device tree.
3  *
4  * Paul Mackerras	August 1996.
5  * Copyright (C) 1996-2005 Paul Mackerras.
6  *
7  *  Adapted for 64bit PowerPC by Dave Engebretsen and Peter Bergner.
8  *    {engebret|bergner}@us.ibm.com
9  *
10  *  Adapted for sparc and sparc64 by David S. Miller davem@davemloft.net
11  *
12  *  Reconsolidated from arch/x/kernel/prom.c by Stephen Rothwell and
13  *  Grant Likely.
14  *
15  *      This program is free software; you can redistribute it and/or
16  *      modify it under the terms of the GNU General Public License
17  *      as published by the Free Software Foundation; either version
18  *      2 of the License, or (at your option) any later version.
19  */
20 #include <linux/module.h>
21 #include <linux/of.h>
22 #include <linux/spinlock.h>
23 #include <linux/slab.h>
24 #include <linux/proc_fs.h>
25 
26 struct device_node *allnodes;
27 struct device_node *of_chosen;
28 
29 /* use when traversing tree through the allnext, child, sibling,
30  * or parent members of struct device_node.
31  */
32 DEFINE_RWLOCK(devtree_lock);
33 
of_n_addr_cells(struct device_node * np)34 int of_n_addr_cells(struct device_node *np)
35 {
36 	const __be32 *ip;
37 
38 	do {
39 		if (np->parent)
40 			np = np->parent;
41 		ip = of_get_property(np, "#address-cells", NULL);
42 		if (ip)
43 			return be32_to_cpup(ip);
44 	} while (np->parent);
45 	/* No #address-cells property for the root node */
46 	return OF_ROOT_NODE_ADDR_CELLS_DEFAULT;
47 }
48 EXPORT_SYMBOL(of_n_addr_cells);
49 
of_n_size_cells(struct device_node * np)50 int of_n_size_cells(struct device_node *np)
51 {
52 	const __be32 *ip;
53 
54 	do {
55 		if (np->parent)
56 			np = np->parent;
57 		ip = of_get_property(np, "#size-cells", NULL);
58 		if (ip)
59 			return be32_to_cpup(ip);
60 	} while (np->parent);
61 	/* No #size-cells property for the root node */
62 	return OF_ROOT_NODE_SIZE_CELLS_DEFAULT;
63 }
64 EXPORT_SYMBOL(of_n_size_cells);
65 
66 #if !defined(CONFIG_SPARC)   /* SPARC doesn't do ref counting (yet) */
67 /**
68  *	of_node_get - Increment refcount of a node
69  *	@node:	Node to inc refcount, NULL is supported to
70  *		simplify writing of callers
71  *
72  *	Returns node.
73  */
of_node_get(struct device_node * node)74 struct device_node *of_node_get(struct device_node *node)
75 {
76 	if (node)
77 		kref_get(&node->kref);
78 	return node;
79 }
80 EXPORT_SYMBOL(of_node_get);
81 
kref_to_device_node(struct kref * kref)82 static inline struct device_node *kref_to_device_node(struct kref *kref)
83 {
84 	return container_of(kref, struct device_node, kref);
85 }
86 
87 /**
88  *	of_node_release - release a dynamically allocated node
89  *	@kref:  kref element of the node to be released
90  *
91  *	In of_node_put() this function is passed to kref_put()
92  *	as the destructor.
93  */
of_node_release(struct kref * kref)94 static void of_node_release(struct kref *kref)
95 {
96 	struct device_node *node = kref_to_device_node(kref);
97 	struct property *prop = node->properties;
98 
99 	/* We should never be releasing nodes that haven't been detached. */
100 	if (!of_node_check_flag(node, OF_DETACHED)) {
101 		pr_err("ERROR: Bad of_node_put() on %s\n", node->full_name);
102 		dump_stack();
103 		kref_init(&node->kref);
104 		return;
105 	}
106 
107 	if (!of_node_check_flag(node, OF_DYNAMIC))
108 		return;
109 
110 	while (prop) {
111 		struct property *next = prop->next;
112 		kfree(prop->name);
113 		kfree(prop->value);
114 		kfree(prop);
115 		prop = next;
116 
117 		if (!prop) {
118 			prop = node->deadprops;
119 			node->deadprops = NULL;
120 		}
121 	}
122 	kfree(node->full_name);
123 	kfree(node->data);
124 	kfree(node);
125 }
126 
127 /**
128  *	of_node_put - Decrement refcount of a node
129  *	@node:	Node to dec refcount, NULL is supported to
130  *		simplify writing of callers
131  *
132  */
of_node_put(struct device_node * node)133 void of_node_put(struct device_node *node)
134 {
135 	if (node)
136 		kref_put(&node->kref, of_node_release);
137 }
138 EXPORT_SYMBOL(of_node_put);
139 #endif /* !CONFIG_SPARC */
140 
of_find_property(const struct device_node * np,const char * name,int * lenp)141 struct property *of_find_property(const struct device_node *np,
142 				  const char *name,
143 				  int *lenp)
144 {
145 	struct property *pp;
146 
147 	if (!np)
148 		return NULL;
149 
150 	read_lock(&devtree_lock);
151 	for (pp = np->properties; pp != 0; pp = pp->next) {
152 		if (of_prop_cmp(pp->name, name) == 0) {
153 			if (lenp != 0)
154 				*lenp = pp->length;
155 			break;
156 		}
157 	}
158 	read_unlock(&devtree_lock);
159 
160 	return pp;
161 }
162 EXPORT_SYMBOL(of_find_property);
163 
164 /**
165  * of_find_all_nodes - Get next node in global list
166  * @prev:	Previous node or NULL to start iteration
167  *		of_node_put() will be called on it
168  *
169  * Returns a node pointer with refcount incremented, use
170  * of_node_put() on it when done.
171  */
of_find_all_nodes(struct device_node * prev)172 struct device_node *of_find_all_nodes(struct device_node *prev)
173 {
174 	struct device_node *np;
175 
176 	read_lock(&devtree_lock);
177 	np = prev ? prev->allnext : allnodes;
178 	for (; np != NULL; np = np->allnext)
179 		if (of_node_get(np))
180 			break;
181 	of_node_put(prev);
182 	read_unlock(&devtree_lock);
183 	return np;
184 }
185 EXPORT_SYMBOL(of_find_all_nodes);
186 
187 /*
188  * Find a property with a given name for a given node
189  * and return the value.
190  */
of_get_property(const struct device_node * np,const char * name,int * lenp)191 const void *of_get_property(const struct device_node *np, const char *name,
192 			 int *lenp)
193 {
194 	struct property *pp = of_find_property(np, name, lenp);
195 
196 	return pp ? pp->value : NULL;
197 }
198 EXPORT_SYMBOL(of_get_property);
199 
200 /** Checks if the given "compat" string matches one of the strings in
201  * the device's "compatible" property
202  */
of_device_is_compatible(const struct device_node * device,const char * compat)203 int of_device_is_compatible(const struct device_node *device,
204 		const char *compat)
205 {
206 	const char* cp;
207 	int cplen, l;
208 
209 	cp = of_get_property(device, "compatible", &cplen);
210 	if (cp == NULL)
211 		return 0;
212 	while (cplen > 0) {
213 		if (of_compat_cmp(cp, compat, strlen(compat)) == 0)
214 			return 1;
215 		l = strlen(cp) + 1;
216 		cp += l;
217 		cplen -= l;
218 	}
219 
220 	return 0;
221 }
222 EXPORT_SYMBOL(of_device_is_compatible);
223 
224 /**
225  * of_machine_is_compatible - Test root of device tree for a given compatible value
226  * @compat: compatible string to look for in root node's compatible property.
227  *
228  * Returns true if the root node has the given value in its
229  * compatible property.
230  */
of_machine_is_compatible(const char * compat)231 int of_machine_is_compatible(const char *compat)
232 {
233 	struct device_node *root;
234 	int rc = 0;
235 
236 	root = of_find_node_by_path("/");
237 	if (root) {
238 		rc = of_device_is_compatible(root, compat);
239 		of_node_put(root);
240 	}
241 	return rc;
242 }
243 EXPORT_SYMBOL(of_machine_is_compatible);
244 
245 /**
246  *  of_device_is_available - check if a device is available for use
247  *
248  *  @device: Node to check for availability
249  *
250  *  Returns 1 if the status property is absent or set to "okay" or "ok",
251  *  0 otherwise
252  */
of_device_is_available(const struct device_node * device)253 int of_device_is_available(const struct device_node *device)
254 {
255 	const char *status;
256 	int statlen;
257 
258 	status = of_get_property(device, "status", &statlen);
259 	if (status == NULL)
260 		return 1;
261 
262 	if (statlen > 0) {
263 		if (!strcmp(status, "okay") || !strcmp(status, "ok"))
264 			return 1;
265 	}
266 
267 	return 0;
268 }
269 EXPORT_SYMBOL(of_device_is_available);
270 
271 /**
272  *	of_get_parent - Get a node's parent if any
273  *	@node:	Node to get parent
274  *
275  *	Returns a node pointer with refcount incremented, use
276  *	of_node_put() on it when done.
277  */
of_get_parent(const struct device_node * node)278 struct device_node *of_get_parent(const struct device_node *node)
279 {
280 	struct device_node *np;
281 
282 	if (!node)
283 		return NULL;
284 
285 	read_lock(&devtree_lock);
286 	np = of_node_get(node->parent);
287 	read_unlock(&devtree_lock);
288 	return np;
289 }
290 EXPORT_SYMBOL(of_get_parent);
291 
292 /**
293  *	of_get_next_parent - Iterate to a node's parent
294  *	@node:	Node to get parent of
295  *
296  * 	This is like of_get_parent() except that it drops the
297  * 	refcount on the passed node, making it suitable for iterating
298  * 	through a node's parents.
299  *
300  *	Returns a node pointer with refcount incremented, use
301  *	of_node_put() on it when done.
302  */
of_get_next_parent(struct device_node * node)303 struct device_node *of_get_next_parent(struct device_node *node)
304 {
305 	struct device_node *parent;
306 
307 	if (!node)
308 		return NULL;
309 
310 	read_lock(&devtree_lock);
311 	parent = of_node_get(node->parent);
312 	of_node_put(node);
313 	read_unlock(&devtree_lock);
314 	return parent;
315 }
316 
317 /**
318  *	of_get_next_child - Iterate a node childs
319  *	@node:	parent node
320  *	@prev:	previous child of the parent node, or NULL to get first
321  *
322  *	Returns a node pointer with refcount incremented, use
323  *	of_node_put() on it when done.
324  */
of_get_next_child(const struct device_node * node,struct device_node * prev)325 struct device_node *of_get_next_child(const struct device_node *node,
326 	struct device_node *prev)
327 {
328 	struct device_node *next;
329 
330 	read_lock(&devtree_lock);
331 	next = prev ? prev->sibling : node->child;
332 	for (; next; next = next->sibling)
333 		if (of_node_get(next))
334 			break;
335 	of_node_put(prev);
336 	read_unlock(&devtree_lock);
337 	return next;
338 }
339 EXPORT_SYMBOL(of_get_next_child);
340 
341 /**
342  *	of_find_node_by_path - Find a node matching a full OF path
343  *	@path:	The full path to match
344  *
345  *	Returns a node pointer with refcount incremented, use
346  *	of_node_put() on it when done.
347  */
of_find_node_by_path(const char * path)348 struct device_node *of_find_node_by_path(const char *path)
349 {
350 	struct device_node *np = allnodes;
351 
352 	read_lock(&devtree_lock);
353 	for (; np; np = np->allnext) {
354 		if (np->full_name && (of_node_cmp(np->full_name, path) == 0)
355 		    && of_node_get(np))
356 			break;
357 	}
358 	read_unlock(&devtree_lock);
359 	return np;
360 }
361 EXPORT_SYMBOL(of_find_node_by_path);
362 
363 /**
364  *	of_find_node_by_name - Find a node by its "name" property
365  *	@from:	The node to start searching from or NULL, the node
366  *		you pass will not be searched, only the next one
367  *		will; typically, you pass what the previous call
368  *		returned. of_node_put() will be called on it
369  *	@name:	The name string to match against
370  *
371  *	Returns a node pointer with refcount incremented, use
372  *	of_node_put() on it when done.
373  */
of_find_node_by_name(struct device_node * from,const char * name)374 struct device_node *of_find_node_by_name(struct device_node *from,
375 	const char *name)
376 {
377 	struct device_node *np;
378 
379 	read_lock(&devtree_lock);
380 	np = from ? from->allnext : allnodes;
381 	for (; np; np = np->allnext)
382 		if (np->name && (of_node_cmp(np->name, name) == 0)
383 		    && of_node_get(np))
384 			break;
385 	of_node_put(from);
386 	read_unlock(&devtree_lock);
387 	return np;
388 }
389 EXPORT_SYMBOL(of_find_node_by_name);
390 
391 /**
392  *	of_find_node_by_type - Find a node by its "device_type" property
393  *	@from:	The node to start searching from, or NULL to start searching
394  *		the entire device tree. The node you pass will not be
395  *		searched, only the next one will; typically, you pass
396  *		what the previous call returned. of_node_put() will be
397  *		called on from for you.
398  *	@type:	The type string to match against
399  *
400  *	Returns a node pointer with refcount incremented, use
401  *	of_node_put() on it when done.
402  */
of_find_node_by_type(struct device_node * from,const char * type)403 struct device_node *of_find_node_by_type(struct device_node *from,
404 	const char *type)
405 {
406 	struct device_node *np;
407 
408 	read_lock(&devtree_lock);
409 	np = from ? from->allnext : allnodes;
410 	for (; np; np = np->allnext)
411 		if (np->type && (of_node_cmp(np->type, type) == 0)
412 		    && of_node_get(np))
413 			break;
414 	of_node_put(from);
415 	read_unlock(&devtree_lock);
416 	return np;
417 }
418 EXPORT_SYMBOL(of_find_node_by_type);
419 
420 /**
421  *	of_find_compatible_node - Find a node based on type and one of the
422  *                                tokens in its "compatible" property
423  *	@from:		The node to start searching from or NULL, the node
424  *			you pass will not be searched, only the next one
425  *			will; typically, you pass what the previous call
426  *			returned. of_node_put() will be called on it
427  *	@type:		The type string to match "device_type" or NULL to ignore
428  *	@compatible:	The string to match to one of the tokens in the device
429  *			"compatible" list.
430  *
431  *	Returns a node pointer with refcount incremented, use
432  *	of_node_put() on it when done.
433  */
of_find_compatible_node(struct device_node * from,const char * type,const char * compatible)434 struct device_node *of_find_compatible_node(struct device_node *from,
435 	const char *type, const char *compatible)
436 {
437 	struct device_node *np;
438 
439 	read_lock(&devtree_lock);
440 	np = from ? from->allnext : allnodes;
441 	for (; np; np = np->allnext) {
442 		if (type
443 		    && !(np->type && (of_node_cmp(np->type, type) == 0)))
444 			continue;
445 		if (of_device_is_compatible(np, compatible) && of_node_get(np))
446 			break;
447 	}
448 	of_node_put(from);
449 	read_unlock(&devtree_lock);
450 	return np;
451 }
452 EXPORT_SYMBOL(of_find_compatible_node);
453 
454 /**
455  *	of_find_node_with_property - Find a node which has a property with
456  *                                   the given name.
457  *	@from:		The node to start searching from or NULL, the node
458  *			you pass will not be searched, only the next one
459  *			will; typically, you pass what the previous call
460  *			returned. of_node_put() will be called on it
461  *	@prop_name:	The name of the property to look for.
462  *
463  *	Returns a node pointer with refcount incremented, use
464  *	of_node_put() on it when done.
465  */
of_find_node_with_property(struct device_node * from,const char * prop_name)466 struct device_node *of_find_node_with_property(struct device_node *from,
467 	const char *prop_name)
468 {
469 	struct device_node *np;
470 	struct property *pp;
471 
472 	read_lock(&devtree_lock);
473 	np = from ? from->allnext : allnodes;
474 	for (; np; np = np->allnext) {
475 		for (pp = np->properties; pp != 0; pp = pp->next) {
476 			if (of_prop_cmp(pp->name, prop_name) == 0) {
477 				of_node_get(np);
478 				goto out;
479 			}
480 		}
481 	}
482 out:
483 	of_node_put(from);
484 	read_unlock(&devtree_lock);
485 	return np;
486 }
487 EXPORT_SYMBOL(of_find_node_with_property);
488 
489 /**
490  * of_match_node - Tell if an device_node has a matching of_match structure
491  *	@matches:	array of of device match structures to search in
492  *	@node:		the of device structure to match against
493  *
494  *	Low level utility function used by device matching.
495  */
of_match_node(const struct of_device_id * matches,const struct device_node * node)496 const struct of_device_id *of_match_node(const struct of_device_id *matches,
497 					 const struct device_node *node)
498 {
499 	if (!matches)
500 		return NULL;
501 
502 	while (matches->name[0] || matches->type[0] || matches->compatible[0]) {
503 		int match = 1;
504 		if (matches->name[0])
505 			match &= node->name
506 				&& !strcmp(matches->name, node->name);
507 		if (matches->type[0])
508 			match &= node->type
509 				&& !strcmp(matches->type, node->type);
510 		if (matches->compatible[0])
511 			match &= of_device_is_compatible(node,
512 						matches->compatible);
513 		if (match)
514 			return matches;
515 		matches++;
516 	}
517 	return NULL;
518 }
519 EXPORT_SYMBOL(of_match_node);
520 
521 /**
522  *	of_find_matching_node - Find a node based on an of_device_id match
523  *				table.
524  *	@from:		The node to start searching from or NULL, the node
525  *			you pass will not be searched, only the next one
526  *			will; typically, you pass what the previous call
527  *			returned. of_node_put() will be called on it
528  *	@matches:	array of of device match structures to search in
529  *
530  *	Returns a node pointer with refcount incremented, use
531  *	of_node_put() on it when done.
532  */
of_find_matching_node(struct device_node * from,const struct of_device_id * matches)533 struct device_node *of_find_matching_node(struct device_node *from,
534 					  const struct of_device_id *matches)
535 {
536 	struct device_node *np;
537 
538 	read_lock(&devtree_lock);
539 	np = from ? from->allnext : allnodes;
540 	for (; np; np = np->allnext) {
541 		if (of_match_node(matches, np) && of_node_get(np))
542 			break;
543 	}
544 	of_node_put(from);
545 	read_unlock(&devtree_lock);
546 	return np;
547 }
548 EXPORT_SYMBOL(of_find_matching_node);
549 
550 /**
551  * of_modalias_node - Lookup appropriate modalias for a device node
552  * @node:	pointer to a device tree node
553  * @modalias:	Pointer to buffer that modalias value will be copied into
554  * @len:	Length of modalias value
555  *
556  * Based on the value of the compatible property, this routine will attempt
557  * to choose an appropriate modalias value for a particular device tree node.
558  * It does this by stripping the manufacturer prefix (as delimited by a ',')
559  * from the first entry in the compatible list property.
560  *
561  * This routine returns 0 on success, <0 on failure.
562  */
of_modalias_node(struct device_node * node,char * modalias,int len)563 int of_modalias_node(struct device_node *node, char *modalias, int len)
564 {
565 	const char *compatible, *p;
566 	int cplen;
567 
568 	compatible = of_get_property(node, "compatible", &cplen);
569 	if (!compatible || strlen(compatible) > cplen)
570 		return -ENODEV;
571 	p = strchr(compatible, ',');
572 	strlcpy(modalias, p ? p + 1 : compatible, len);
573 	return 0;
574 }
575 EXPORT_SYMBOL_GPL(of_modalias_node);
576 
577 /**
578  * of_find_node_by_phandle - Find a node given a phandle
579  * @handle:	phandle of the node to find
580  *
581  * Returns a node pointer with refcount incremented, use
582  * of_node_put() on it when done.
583  */
of_find_node_by_phandle(phandle handle)584 struct device_node *of_find_node_by_phandle(phandle handle)
585 {
586 	struct device_node *np;
587 
588 	read_lock(&devtree_lock);
589 	for (np = allnodes; np; np = np->allnext)
590 		if (np->phandle == handle)
591 			break;
592 	of_node_get(np);
593 	read_unlock(&devtree_lock);
594 	return np;
595 }
596 EXPORT_SYMBOL(of_find_node_by_phandle);
597 
598 /**
599  * of_parse_phandle - Resolve a phandle property to a device_node pointer
600  * @np: Pointer to device node holding phandle property
601  * @phandle_name: Name of property holding a phandle value
602  * @index: For properties holding a table of phandles, this is the index into
603  *         the table
604  *
605  * Returns the device_node pointer with refcount incremented.  Use
606  * of_node_put() on it when done.
607  */
608 struct device_node *
of_parse_phandle(struct device_node * np,const char * phandle_name,int index)609 of_parse_phandle(struct device_node *np, const char *phandle_name, int index)
610 {
611 	const __be32 *phandle;
612 	int size;
613 
614 	phandle = of_get_property(np, phandle_name, &size);
615 	if ((!phandle) || (size < sizeof(*phandle) * (index + 1)))
616 		return NULL;
617 
618 	return of_find_node_by_phandle(be32_to_cpup(phandle + index));
619 }
620 EXPORT_SYMBOL(of_parse_phandle);
621 
622 /**
623  * of_parse_phandles_with_args - Find a node pointed by phandle in a list
624  * @np:		pointer to a device tree node containing a list
625  * @list_name:	property name that contains a list
626  * @cells_name:	property name that specifies phandles' arguments count
627  * @index:	index of a phandle to parse out
628  * @out_node:	optional pointer to device_node struct pointer (will be filled)
629  * @out_args:	optional pointer to arguments pointer (will be filled)
630  *
631  * This function is useful to parse lists of phandles and their arguments.
632  * Returns 0 on success and fills out_node and out_args, on error returns
633  * appropriate errno value.
634  *
635  * Example:
636  *
637  * phandle1: node1 {
638  * 	#list-cells = <2>;
639  * }
640  *
641  * phandle2: node2 {
642  * 	#list-cells = <1>;
643  * }
644  *
645  * node3 {
646  * 	list = <&phandle1 1 2 &phandle2 3>;
647  * }
648  *
649  * To get a device_node of the `node2' node you may call this:
650  * of_parse_phandles_with_args(node3, "list", "#list-cells", 2, &node2, &args);
651  */
of_parse_phandles_with_args(struct device_node * np,const char * list_name,const char * cells_name,int index,struct device_node ** out_node,const void ** out_args)652 int of_parse_phandles_with_args(struct device_node *np, const char *list_name,
653 				const char *cells_name, int index,
654 				struct device_node **out_node,
655 				const void **out_args)
656 {
657 	int ret = -EINVAL;
658 	const __be32 *list;
659 	const __be32 *list_end;
660 	int size;
661 	int cur_index = 0;
662 	struct device_node *node = NULL;
663 	const void *args = NULL;
664 
665 	list = of_get_property(np, list_name, &size);
666 	if (!list) {
667 		ret = -ENOENT;
668 		goto err0;
669 	}
670 	list_end = list + size / sizeof(*list);
671 
672 	while (list < list_end) {
673 		const __be32 *cells;
674 		phandle phandle;
675 
676 		phandle = be32_to_cpup(list++);
677 		args = list;
678 
679 		/* one cell hole in the list = <>; */
680 		if (!phandle)
681 			goto next;
682 
683 		node = of_find_node_by_phandle(phandle);
684 		if (!node) {
685 			pr_debug("%s: could not find phandle\n",
686 				 np->full_name);
687 			goto err0;
688 		}
689 
690 		cells = of_get_property(node, cells_name, &size);
691 		if (!cells || size != sizeof(*cells)) {
692 			pr_debug("%s: could not get %s for %s\n",
693 				 np->full_name, cells_name, node->full_name);
694 			goto err1;
695 		}
696 
697 		list += be32_to_cpup(cells);
698 		if (list > list_end) {
699 			pr_debug("%s: insufficient arguments length\n",
700 				 np->full_name);
701 			goto err1;
702 		}
703 next:
704 		if (cur_index == index)
705 			break;
706 
707 		of_node_put(node);
708 		node = NULL;
709 		args = NULL;
710 		cur_index++;
711 	}
712 
713 	if (!node) {
714 		/*
715 		 * args w/o node indicates that the loop above has stopped at
716 		 * the 'hole' cell. Report this differently.
717 		 */
718 		if (args)
719 			ret = -EEXIST;
720 		else
721 			ret = -ENOENT;
722 		goto err0;
723 	}
724 
725 	if (out_node)
726 		*out_node = node;
727 	if (out_args)
728 		*out_args = args;
729 
730 	return 0;
731 err1:
732 	of_node_put(node);
733 err0:
734 	pr_debug("%s failed with status %d\n", __func__, ret);
735 	return ret;
736 }
737 EXPORT_SYMBOL(of_parse_phandles_with_args);
738 
739 /**
740  * prom_add_property - Add a property to a node
741  */
prom_add_property(struct device_node * np,struct property * prop)742 int prom_add_property(struct device_node *np, struct property *prop)
743 {
744 	struct property **next;
745 	unsigned long flags;
746 
747 	prop->next = NULL;
748 	write_lock_irqsave(&devtree_lock, flags);
749 	next = &np->properties;
750 	while (*next) {
751 		if (strcmp(prop->name, (*next)->name) == 0) {
752 			/* duplicate ! don't insert it */
753 			write_unlock_irqrestore(&devtree_lock, flags);
754 			return -1;
755 		}
756 		next = &(*next)->next;
757 	}
758 	*next = prop;
759 	write_unlock_irqrestore(&devtree_lock, flags);
760 
761 #ifdef CONFIG_PROC_DEVICETREE
762 	/* try to add to proc as well if it was initialized */
763 	if (np->pde)
764 		proc_device_tree_add_prop(np->pde, prop);
765 #endif /* CONFIG_PROC_DEVICETREE */
766 
767 	return 0;
768 }
769 
770 /**
771  * prom_remove_property - Remove a property from a node.
772  *
773  * Note that we don't actually remove it, since we have given out
774  * who-knows-how-many pointers to the data using get-property.
775  * Instead we just move the property to the "dead properties"
776  * list, so it won't be found any more.
777  */
prom_remove_property(struct device_node * np,struct property * prop)778 int prom_remove_property(struct device_node *np, struct property *prop)
779 {
780 	struct property **next;
781 	unsigned long flags;
782 	int found = 0;
783 
784 	write_lock_irqsave(&devtree_lock, flags);
785 	next = &np->properties;
786 	while (*next) {
787 		if (*next == prop) {
788 			/* found the node */
789 			*next = prop->next;
790 			prop->next = np->deadprops;
791 			np->deadprops = prop;
792 			found = 1;
793 			break;
794 		}
795 		next = &(*next)->next;
796 	}
797 	write_unlock_irqrestore(&devtree_lock, flags);
798 
799 	if (!found)
800 		return -ENODEV;
801 
802 #ifdef CONFIG_PROC_DEVICETREE
803 	/* try to remove the proc node as well */
804 	if (np->pde)
805 		proc_device_tree_remove_prop(np->pde, prop);
806 #endif /* CONFIG_PROC_DEVICETREE */
807 
808 	return 0;
809 }
810 
811 /*
812  * prom_update_property - Update a property in a node.
813  *
814  * Note that we don't actually remove it, since we have given out
815  * who-knows-how-many pointers to the data using get-property.
816  * Instead we just move the property to the "dead properties" list,
817  * and add the new property to the property list
818  */
prom_update_property(struct device_node * np,struct property * newprop,struct property * oldprop)819 int prom_update_property(struct device_node *np,
820 			 struct property *newprop,
821 			 struct property *oldprop)
822 {
823 	struct property **next;
824 	unsigned long flags;
825 	int found = 0;
826 
827 	write_lock_irqsave(&devtree_lock, flags);
828 	next = &np->properties;
829 	while (*next) {
830 		if (*next == oldprop) {
831 			/* found the node */
832 			newprop->next = oldprop->next;
833 			*next = newprop;
834 			oldprop->next = np->deadprops;
835 			np->deadprops = oldprop;
836 			found = 1;
837 			break;
838 		}
839 		next = &(*next)->next;
840 	}
841 	write_unlock_irqrestore(&devtree_lock, flags);
842 
843 	if (!found)
844 		return -ENODEV;
845 
846 #ifdef CONFIG_PROC_DEVICETREE
847 	/* try to add to proc as well if it was initialized */
848 	if (np->pde)
849 		proc_device_tree_update_prop(np->pde, newprop, oldprop);
850 #endif /* CONFIG_PROC_DEVICETREE */
851 
852 	return 0;
853 }
854 
855 #if defined(CONFIG_OF_DYNAMIC)
856 /*
857  * Support for dynamic device trees.
858  *
859  * On some platforms, the device tree can be manipulated at runtime.
860  * The routines in this section support adding, removing and changing
861  * device tree nodes.
862  */
863 
864 /**
865  * of_attach_node - Plug a device node into the tree and global list.
866  */
of_attach_node(struct device_node * np)867 void of_attach_node(struct device_node *np)
868 {
869 	unsigned long flags;
870 
871 	write_lock_irqsave(&devtree_lock, flags);
872 	np->sibling = np->parent->child;
873 	np->allnext = allnodes;
874 	np->parent->child = np;
875 	allnodes = np;
876 	write_unlock_irqrestore(&devtree_lock, flags);
877 }
878 
879 /**
880  * of_detach_node - "Unplug" a node from the device tree.
881  *
882  * The caller must hold a reference to the node.  The memory associated with
883  * the node is not freed until its refcount goes to zero.
884  */
of_detach_node(struct device_node * np)885 void of_detach_node(struct device_node *np)
886 {
887 	struct device_node *parent;
888 	unsigned long flags;
889 
890 	write_lock_irqsave(&devtree_lock, flags);
891 
892 	parent = np->parent;
893 	if (!parent)
894 		goto out_unlock;
895 
896 	if (allnodes == np)
897 		allnodes = np->allnext;
898 	else {
899 		struct device_node *prev;
900 		for (prev = allnodes;
901 		     prev->allnext != np;
902 		     prev = prev->allnext)
903 			;
904 		prev->allnext = np->allnext;
905 	}
906 
907 	if (parent->child == np)
908 		parent->child = np->sibling;
909 	else {
910 		struct device_node *prevsib;
911 		for (prevsib = np->parent->child;
912 		     prevsib->sibling != np;
913 		     prevsib = prevsib->sibling)
914 			;
915 		prevsib->sibling = np->sibling;
916 	}
917 
918 	of_node_set_flag(np, OF_DETACHED);
919 
920 out_unlock:
921 	write_unlock_irqrestore(&devtree_lock, flags);
922 }
923 #endif /* defined(CONFIG_OF_DYNAMIC) */
924 
925