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