blob: 632ebae7f17a4444f7aa3ad193bdbce0212c6c09 [file] [log] [blame]
Stephen Rothwell97e873e2007-05-01 16:26:07 +10001/*
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 *
Grant Likelye91edcf2009-10-15 10:58:09 -060012 * Reconsolidated from arch/x/kernel/prom.c by Stephen Rothwell and
13 * Grant Likely.
Stephen Rothwell97e873e2007-05-01 16:26:07 +100014 *
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>
Stephen Rothwell581b6052007-04-24 16:46:53 +100022#include <linux/spinlock.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090023#include <linux/slab.h>
Jeremy Kerra9f2f632010-02-01 21:34:14 -070024#include <linux/proc_fs.h>
Stephen Rothwell581b6052007-04-24 16:46:53 +100025
Stephen Rothwell1ef4d422007-04-24 17:57:33 +100026struct device_node *allnodes;
Grant Likelyfc0bdae2010-02-14 07:13:55 -070027struct device_node *of_chosen;
Stephen Rothwell1ef4d422007-04-24 17:57:33 +100028
Stephen Rothwell581b6052007-04-24 16:46:53 +100029/* use when traversing tree through the allnext, child, sibling,
30 * or parent members of struct device_node.
31 */
32DEFINE_RWLOCK(devtree_lock);
Stephen Rothwell97e873e2007-05-01 16:26:07 +100033
34int of_n_addr_cells(struct device_node *np)
35{
Jeremy Kerra9fadee2010-10-10 21:24:10 -060036 const __be32 *ip;
Stephen Rothwell97e873e2007-05-01 16:26:07 +100037
38 do {
39 if (np->parent)
40 np = np->parent;
41 ip = of_get_property(np, "#address-cells", NULL);
42 if (ip)
Jeremy Kerr33714882010-01-30 01:45:26 -070043 return be32_to_cpup(ip);
Stephen Rothwell97e873e2007-05-01 16:26:07 +100044 } while (np->parent);
45 /* No #address-cells property for the root node */
46 return OF_ROOT_NODE_ADDR_CELLS_DEFAULT;
47}
48EXPORT_SYMBOL(of_n_addr_cells);
49
50int of_n_size_cells(struct device_node *np)
51{
Jeremy Kerra9fadee2010-10-10 21:24:10 -060052 const __be32 *ip;
Stephen Rothwell97e873e2007-05-01 16:26:07 +100053
54 do {
55 if (np->parent)
56 np = np->parent;
57 ip = of_get_property(np, "#size-cells", NULL);
58 if (ip)
Jeremy Kerr33714882010-01-30 01:45:26 -070059 return be32_to_cpup(ip);
Stephen Rothwell97e873e2007-05-01 16:26:07 +100060 } while (np->parent);
61 /* No #size-cells property for the root node */
62 return OF_ROOT_NODE_SIZE_CELLS_DEFAULT;
63}
64EXPORT_SYMBOL(of_n_size_cells);
65
Grant Likely923f7e32010-01-28 13:52:53 -070066#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 */
74struct device_node *of_node_get(struct device_node *node)
75{
76 if (node)
77 kref_get(&node->kref);
78 return node;
79}
80EXPORT_SYMBOL(of_node_get);
81
82static 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 */
94static 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 */
133void of_node_put(struct device_node *node)
134{
135 if (node)
136 kref_put(&node->kref, of_node_release);
137}
138EXPORT_SYMBOL(of_node_put);
139#endif /* !CONFIG_SPARC */
140
Stephen Rothwell581b6052007-04-24 16:46:53 +1000141struct property *of_find_property(const struct device_node *np,
142 const char *name,
143 int *lenp)
144{
145 struct property *pp;
146
Timur Tabi64e45662008-05-08 05:19:59 +1000147 if (!np)
148 return NULL;
149
Stephen Rothwell581b6052007-04-24 16:46:53 +1000150 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}
162EXPORT_SYMBOL(of_find_property);
163
Grant Likelye91edcf2009-10-15 10:58:09 -0600164/**
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 */
172struct 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}
185EXPORT_SYMBOL(of_find_all_nodes);
186
Stephen Rothwell97e873e2007-05-01 16:26:07 +1000187/*
188 * Find a property with a given name for a given node
189 * and return the value.
190 */
191const 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}
198EXPORT_SYMBOL(of_get_property);
Stephen Rothwell0081cbc2007-05-01 16:29:19 +1000199
200/** Checks if the given "compat" string matches one of the strings in
201 * the device's "compatible" property
202 */
203int 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}
222EXPORT_SYMBOL(of_device_is_compatible);
Stephen Rothwelle679c5f2007-04-24 17:16:16 +1000223
224/**
Grant Likely71a157e2010-02-01 21:34:14 -0700225 * of_machine_is_compatible - Test root of device tree for a given compatible value
Grant Likely1f43cfb2010-01-28 13:47:25 -0700226 * @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 */
Grant Likely71a157e2010-02-01 21:34:14 -0700231int of_machine_is_compatible(const char *compat)
Grant Likely1f43cfb2010-01-28 13:47:25 -0700232{
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}
Grant Likely71a157e2010-02-01 21:34:14 -0700243EXPORT_SYMBOL(of_machine_is_compatible);
Grant Likely1f43cfb2010-01-28 13:47:25 -0700244
245/**
Josh Boyer834d97d2008-03-27 00:33:14 +1100246 * 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 */
253int 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}
269EXPORT_SYMBOL(of_device_is_available);
270
271/**
Stephen Rothwelle679c5f2007-04-24 17:16:16 +1000272 * 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 */
278struct 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}
290EXPORT_SYMBOL(of_get_parent);
Stephen Rothwelld1cd3552007-04-24 17:21:29 +1000291
292/**
Michael Ellermanf4eb0102007-10-26 16:54:31 +1000293 * 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 */
303struct 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/**
Stephen Rothwelld1cd3552007-04-24 17:21:29 +1000318 * 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 */
325struct 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}
339EXPORT_SYMBOL(of_get_next_child);
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000340
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 */
348struct 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}
361EXPORT_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 */
374struct 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}
389EXPORT_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 */
403struct 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}
418EXPORT_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 */
434struct 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}
452EXPORT_SYMBOL(of_find_compatible_node);
Grant Likely283029d2008-01-09 06:20:40 +1100453
454/**
Michael Ellerman1e291b12008-11-12 18:54:42 +0000455 * 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 */
466struct 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 }
482out:
483 of_node_put(from);
484 read_unlock(&devtree_lock);
485 return np;
486}
487EXPORT_SYMBOL(of_find_node_with_property);
488
489/**
Grant Likely283029d2008-01-09 06:20:40 +1100490 * 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 */
496const struct of_device_id *of_match_node(const struct of_device_id *matches,
497 const struct device_node *node)
498{
Grant Likelya52f07e2011-03-18 10:21:29 -0600499 if (!matches)
500 return NULL;
501
Grant Likely283029d2008-01-09 06:20:40 +1100502 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}
519EXPORT_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 */
533struct 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}
548EXPORT_SYMBOL(of_find_matching_node);
Grant Likely3f07af42008-07-25 22:25:13 -0400549
550/**
Grant Likely3f07af42008-07-25 22:25:13 -0400551 * 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 *
Grant Likely2ffe8c52010-06-08 07:48:19 -0600556 * 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.
Grant Likely3f07af42008-07-25 22:25:13 -0400560 *
Grant Likely2ffe8c52010-06-08 07:48:19 -0600561 * This routine returns 0 on success, <0 on failure.
Grant Likely3f07af42008-07-25 22:25:13 -0400562 */
563int of_modalias_node(struct device_node *node, char *modalias, int len)
564{
Grant Likely2ffe8c52010-06-08 07:48:19 -0600565 const char *compatible, *p;
566 int cplen;
Grant Likely3f07af42008-07-25 22:25:13 -0400567
568 compatible = of_get_property(node, "compatible", &cplen);
Grant Likely2ffe8c52010-06-08 07:48:19 -0600569 if (!compatible || strlen(compatible) > cplen)
Grant Likely3f07af42008-07-25 22:25:13 -0400570 return -ENODEV;
Grant Likely3f07af42008-07-25 22:25:13 -0400571 p = strchr(compatible, ',');
Grant Likely2ffe8c52010-06-08 07:48:19 -0600572 strlcpy(modalias, p ? p + 1 : compatible, len);
Grant Likely3f07af42008-07-25 22:25:13 -0400573 return 0;
574}
575EXPORT_SYMBOL_GPL(of_modalias_node);
576
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000577/**
Jeremy Kerr89751a72010-02-01 21:34:11 -0700578 * 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 */
584struct 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}
596EXPORT_SYMBOL(of_find_node_by_phandle);
597
598/**
Grant Likely739649c2009-04-25 12:52:40 +0000599 * 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 */
608struct device_node *
609of_parse_phandle(struct device_node *np, const char *phandle_name, int index)
610{
Grant Likely9a6b2e52010-07-23 01:48:25 -0600611 const __be32 *phandle;
Grant Likely739649c2009-04-25 12:52:40 +0000612 int size;
613
614 phandle = of_get_property(np, phandle_name, &size);
615 if ((!phandle) || (size < sizeof(*phandle) * (index + 1)))
616 return NULL;
617
Grant Likely9a6b2e52010-07-23 01:48:25 -0600618 return of_find_node_by_phandle(be32_to_cpup(phandle + index));
Grant Likely739649c2009-04-25 12:52:40 +0000619}
620EXPORT_SYMBOL(of_parse_phandle);
621
622/**
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000623 * 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
Anton Vorontsov7736a3d2008-12-05 08:15:46 +0000628 * @out_node: optional pointer to device_node struct pointer (will be filled)
629 * @out_args: optional pointer to arguments pointer (will be filled)
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000630 *
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 */
652int 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;
Jeremy Kerr33714882010-01-30 01:45:26 -0700658 const __be32 *list;
659 const __be32 *list_end;
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000660 int size;
661 int cur_index = 0;
662 struct device_node *node = NULL;
Anton Vorontsov7736a3d2008-12-05 08:15:46 +0000663 const void *args = NULL;
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000664
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) {
Jeremy Kerr33714882010-01-30 01:45:26 -0700673 const __be32 *cells;
Grant Likely9a6b2e52010-07-23 01:48:25 -0600674 phandle phandle;
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000675
Grant Likely9a6b2e52010-07-23 01:48:25 -0600676 phandle = be32_to_cpup(list++);
Anton Vorontsovc1bb7c62008-12-05 08:15:39 +0000677 args = list;
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000678
679 /* one cell hole in the list = <>; */
Grant Likely9a6b2e52010-07-23 01:48:25 -0600680 if (!phandle)
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000681 goto next;
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000682
Grant Likely9a6b2e52010-07-23 01:48:25 -0600683 node = of_find_node_by_phandle(phandle);
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000684 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
Jeremy Kerr33714882010-01-30 01:45:26 -0700697 list += be32_to_cpup(cells);
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000698 if (list > list_end) {
699 pr_debug("%s: insufficient arguments length\n",
700 np->full_name);
701 goto err1;
702 }
703next:
704 if (cur_index == index)
705 break;
706
707 of_node_put(node);
708 node = NULL;
Anton Vorontsov7736a3d2008-12-05 08:15:46 +0000709 args = NULL;
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000710 cur_index++;
711 }
712
713 if (!node) {
Anton Vorontsov7736a3d2008-12-05 08:15:46 +0000714 /*
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;
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000722 goto err0;
723 }
724
Anton Vorontsov7736a3d2008-12-05 08:15:46 +0000725 if (out_node)
726 *out_node = node;
727 if (out_args)
728 *out_args = args;
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000729
730 return 0;
731err1:
732 of_node_put(node);
733err0:
734 pr_debug("%s failed with status %d\n", __func__, ret);
735 return ret;
736}
737EXPORT_SYMBOL(of_parse_phandles_with_args);
Grant Likely02af11b2009-11-23 20:16:45 -0700738
739/**
740 * prom_add_property - Add a property to a node
741 */
742int 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 */
778int 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 */
819int 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}
Grant Likelyfcdeb7f2010-01-29 05:04:33 -0700854
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 */
867void 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 */
885void 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
920out_unlock:
921 write_unlock_irqrestore(&devtree_lock, flags);
922}
923#endif /* defined(CONFIG_OF_DYNAMIC) */
924