blob: ba195fbce4c637ac85edbffbb73ccbdf39c1f6b0 [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 */
Shawn Guo611cad72011-08-15 15:28:14 +080020#include <linux/ctype.h>
Sudeep KarkadaNagesha183912d2013-08-15 14:01:40 +010021#include <linux/cpu.h>
Stephen Rothwell97e873e2007-05-01 16:26:07 +100022#include <linux/module.h>
23#include <linux/of.h>
Stephen Rothwell581b6052007-04-24 16:46:53 +100024#include <linux/spinlock.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090025#include <linux/slab.h>
Jeremy Kerra9f2f632010-02-01 21:34:14 -070026#include <linux/proc_fs.h>
Stephen Rothwell581b6052007-04-24 16:46:53 +100027
Stepan Moskovchenkoced4eec2012-12-06 14:55:41 -080028#include "of_private.h"
Shawn Guo611cad72011-08-15 15:28:14 +080029
Stepan Moskovchenkoced4eec2012-12-06 14:55:41 -080030LIST_HEAD(aliases_lookup);
Shawn Guo611cad72011-08-15 15:28:14 +080031
Randy Dunlap465aac62012-11-30 10:01:51 +000032struct device_node *of_allnodes;
33EXPORT_SYMBOL(of_allnodes);
Grant Likelyfc0bdae2010-02-14 07:13:55 -070034struct device_node *of_chosen;
Shawn Guo611cad72011-08-15 15:28:14 +080035struct device_node *of_aliases;
Sascha Hauer5c19e952013-08-05 14:40:44 +020036static struct device_node *of_stdout;
Shawn Guo611cad72011-08-15 15:28:14 +080037
Stepan Moskovchenkoced4eec2012-12-06 14:55:41 -080038DEFINE_MUTEX(of_aliases_mutex);
Stephen Rothwell1ef4d422007-04-24 17:57:33 +100039
Stephen Rothwell581b6052007-04-24 16:46:53 +100040/* use when traversing tree through the allnext, child, sibling,
41 * or parent members of struct device_node.
42 */
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -050043DEFINE_RAW_SPINLOCK(devtree_lock);
Stephen Rothwell97e873e2007-05-01 16:26:07 +100044
45int of_n_addr_cells(struct device_node *np)
46{
Jeremy Kerra9fadee2010-10-10 21:24:10 -060047 const __be32 *ip;
Stephen Rothwell97e873e2007-05-01 16:26:07 +100048
49 do {
50 if (np->parent)
51 np = np->parent;
52 ip = of_get_property(np, "#address-cells", NULL);
53 if (ip)
Jeremy Kerr33714882010-01-30 01:45:26 -070054 return be32_to_cpup(ip);
Stephen Rothwell97e873e2007-05-01 16:26:07 +100055 } while (np->parent);
56 /* No #address-cells property for the root node */
57 return OF_ROOT_NODE_ADDR_CELLS_DEFAULT;
58}
59EXPORT_SYMBOL(of_n_addr_cells);
60
61int of_n_size_cells(struct device_node *np)
62{
Jeremy Kerra9fadee2010-10-10 21:24:10 -060063 const __be32 *ip;
Stephen Rothwell97e873e2007-05-01 16:26:07 +100064
65 do {
66 if (np->parent)
67 np = np->parent;
68 ip = of_get_property(np, "#size-cells", NULL);
69 if (ip)
Jeremy Kerr33714882010-01-30 01:45:26 -070070 return be32_to_cpup(ip);
Stephen Rothwell97e873e2007-05-01 16:26:07 +100071 } while (np->parent);
72 /* No #size-cells property for the root node */
73 return OF_ROOT_NODE_SIZE_CELLS_DEFAULT;
74}
75EXPORT_SYMBOL(of_n_size_cells);
76
Rob Herring0c3f0612013-09-17 10:42:50 -050077#ifdef CONFIG_NUMA
78int __weak of_node_to_nid(struct device_node *np)
79{
80 return numa_node_id();
81}
82#endif
83
Grant Likely0f22dd32012-02-15 20:38:40 -070084#if defined(CONFIG_OF_DYNAMIC)
Grant Likely923f7e32010-01-28 13:52:53 -070085/**
86 * of_node_get - Increment refcount of a node
87 * @node: Node to inc refcount, NULL is supported to
88 * simplify writing of callers
89 *
90 * Returns node.
91 */
92struct device_node *of_node_get(struct device_node *node)
93{
94 if (node)
95 kref_get(&node->kref);
96 return node;
97}
98EXPORT_SYMBOL(of_node_get);
99
100static inline struct device_node *kref_to_device_node(struct kref *kref)
101{
102 return container_of(kref, struct device_node, kref);
103}
104
105/**
106 * of_node_release - release a dynamically allocated node
107 * @kref: kref element of the node to be released
108 *
109 * In of_node_put() this function is passed to kref_put()
110 * as the destructor.
111 */
112static void of_node_release(struct kref *kref)
113{
114 struct device_node *node = kref_to_device_node(kref);
115 struct property *prop = node->properties;
116
117 /* We should never be releasing nodes that haven't been detached. */
118 if (!of_node_check_flag(node, OF_DETACHED)) {
119 pr_err("ERROR: Bad of_node_put() on %s\n", node->full_name);
120 dump_stack();
121 kref_init(&node->kref);
122 return;
123 }
124
125 if (!of_node_check_flag(node, OF_DYNAMIC))
126 return;
127
128 while (prop) {
129 struct property *next = prop->next;
130 kfree(prop->name);
131 kfree(prop->value);
132 kfree(prop);
133 prop = next;
134
135 if (!prop) {
136 prop = node->deadprops;
137 node->deadprops = NULL;
138 }
139 }
140 kfree(node->full_name);
141 kfree(node->data);
142 kfree(node);
143}
144
145/**
146 * of_node_put - Decrement refcount of a node
147 * @node: Node to dec refcount, NULL is supported to
148 * simplify writing of callers
149 *
150 */
151void of_node_put(struct device_node *node)
152{
153 if (node)
154 kref_put(&node->kref, of_node_release);
155}
156EXPORT_SYMBOL(of_node_put);
Grant Likely0f22dd32012-02-15 20:38:40 -0700157#endif /* CONFIG_OF_DYNAMIC */
Grant Likely923f7e32010-01-28 13:52:53 -0700158
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500159static struct property *__of_find_property(const struct device_node *np,
160 const char *name, int *lenp)
Stephen Rothwell581b6052007-04-24 16:46:53 +1000161{
162 struct property *pp;
163
Timur Tabi64e45662008-05-08 05:19:59 +1000164 if (!np)
165 return NULL;
166
Sachin Kamata3a7cab2012-06-27 09:44:45 +0530167 for (pp = np->properties; pp; pp = pp->next) {
Stephen Rothwell581b6052007-04-24 16:46:53 +1000168 if (of_prop_cmp(pp->name, name) == 0) {
Sachin Kamata3a7cab2012-06-27 09:44:45 +0530169 if (lenp)
Stephen Rothwell581b6052007-04-24 16:46:53 +1000170 *lenp = pp->length;
171 break;
172 }
173 }
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500174
175 return pp;
176}
177
178struct property *of_find_property(const struct device_node *np,
179 const char *name,
180 int *lenp)
181{
182 struct property *pp;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500183 unsigned long flags;
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500184
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500185 raw_spin_lock_irqsave(&devtree_lock, flags);
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500186 pp = __of_find_property(np, name, lenp);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500187 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Stephen Rothwell581b6052007-04-24 16:46:53 +1000188
189 return pp;
190}
191EXPORT_SYMBOL(of_find_property);
192
Grant Likelye91edcf2009-10-15 10:58:09 -0600193/**
194 * of_find_all_nodes - Get next node in global list
195 * @prev: Previous node or NULL to start iteration
196 * of_node_put() will be called on it
197 *
198 * Returns a node pointer with refcount incremented, use
199 * of_node_put() on it when done.
200 */
201struct device_node *of_find_all_nodes(struct device_node *prev)
202{
203 struct device_node *np;
Benjamin Herrenschmidtd25d8692013-06-12 15:39:04 +1000204 unsigned long flags;
Grant Likelye91edcf2009-10-15 10:58:09 -0600205
Benjamin Herrenschmidtd25d8692013-06-12 15:39:04 +1000206 raw_spin_lock_irqsave(&devtree_lock, flags);
Randy Dunlap465aac62012-11-30 10:01:51 +0000207 np = prev ? prev->allnext : of_allnodes;
Grant Likelye91edcf2009-10-15 10:58:09 -0600208 for (; np != NULL; np = np->allnext)
209 if (of_node_get(np))
210 break;
211 of_node_put(prev);
Benjamin Herrenschmidtd25d8692013-06-12 15:39:04 +1000212 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Grant Likelye91edcf2009-10-15 10:58:09 -0600213 return np;
214}
215EXPORT_SYMBOL(of_find_all_nodes);
216
Stephen Rothwell97e873e2007-05-01 16:26:07 +1000217/*
218 * Find a property with a given name for a given node
219 * and return the value.
220 */
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500221static const void *__of_get_property(const struct device_node *np,
222 const char *name, int *lenp)
223{
224 struct property *pp = __of_find_property(np, name, lenp);
225
226 return pp ? pp->value : NULL;
227}
228
229/*
230 * Find a property with a given name for a given node
231 * and return the value.
232 */
Stephen Rothwell97e873e2007-05-01 16:26:07 +1000233const void *of_get_property(const struct device_node *np, const char *name,
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500234 int *lenp)
Stephen Rothwell97e873e2007-05-01 16:26:07 +1000235{
236 struct property *pp = of_find_property(np, name, lenp);
237
238 return pp ? pp->value : NULL;
239}
240EXPORT_SYMBOL(of_get_property);
Stephen Rothwell0081cbc2007-05-01 16:29:19 +1000241
Sudeep KarkadaNagesha183912d2013-08-15 14:01:40 +0100242/*
243 * arch_match_cpu_phys_id - Match the given logical CPU and physical id
244 *
245 * @cpu: logical cpu index of a core/thread
246 * @phys_id: physical identifier of a core/thread
247 *
248 * CPU logical to physical index mapping is architecture specific.
249 * However this __weak function provides a default match of physical
250 * id to logical cpu index. phys_id provided here is usually values read
251 * from the device tree which must match the hardware internal registers.
252 *
253 * Returns true if the physical identifier and the logical cpu index
254 * correspond to the same core/thread, false otherwise.
255 */
256bool __weak arch_match_cpu_phys_id(int cpu, u64 phys_id)
257{
258 return (u32)phys_id == cpu;
259}
260
261/**
262 * Checks if the given "prop_name" property holds the physical id of the
263 * core/thread corresponding to the logical cpu 'cpu'. If 'thread' is not
264 * NULL, local thread number within the core is returned in it.
265 */
266static bool __of_find_n_match_cpu_property(struct device_node *cpun,
267 const char *prop_name, int cpu, unsigned int *thread)
268{
269 const __be32 *cell;
270 int ac, prop_len, tid;
271 u64 hwid;
272
273 ac = of_n_addr_cells(cpun);
274 cell = of_get_property(cpun, prop_name, &prop_len);
Grant Likelyf3cea452013-10-04 17:24:26 +0100275 if (!cell || !ac)
Sudeep KarkadaNagesha183912d2013-08-15 14:01:40 +0100276 return false;
Grant Likelyf3cea452013-10-04 17:24:26 +0100277 prop_len /= sizeof(*cell) * ac;
Sudeep KarkadaNagesha183912d2013-08-15 14:01:40 +0100278 for (tid = 0; tid < prop_len; tid++) {
279 hwid = of_read_number(cell, ac);
280 if (arch_match_cpu_phys_id(cpu, hwid)) {
281 if (thread)
282 *thread = tid;
283 return true;
284 }
285 cell += ac;
286 }
287 return false;
288}
289
David Millerd1cb9d12013-10-03 17:24:51 -0400290/*
291 * arch_find_n_match_cpu_physical_id - See if the given device node is
292 * for the cpu corresponding to logical cpu 'cpu'. Return true if so,
293 * else false. If 'thread' is non-NULL, the local thread number within the
294 * core is returned in it.
295 */
296bool __weak arch_find_n_match_cpu_physical_id(struct device_node *cpun,
297 int cpu, unsigned int *thread)
298{
299 /* Check for non-standard "ibm,ppc-interrupt-server#s" property
300 * for thread ids on PowerPC. If it doesn't exist fallback to
301 * standard "reg" property.
302 */
303 if (IS_ENABLED(CONFIG_PPC) &&
304 __of_find_n_match_cpu_property(cpun,
305 "ibm,ppc-interrupt-server#s",
306 cpu, thread))
307 return true;
308
309 if (__of_find_n_match_cpu_property(cpun, "reg", cpu, thread))
310 return true;
311
312 return false;
313}
314
Sudeep KarkadaNagesha183912d2013-08-15 14:01:40 +0100315/**
316 * of_get_cpu_node - Get device node associated with the given logical CPU
317 *
318 * @cpu: CPU number(logical index) for which device node is required
319 * @thread: if not NULL, local thread number within the physical core is
320 * returned
321 *
322 * The main purpose of this function is to retrieve the device node for the
323 * given logical CPU index. It should be used to initialize the of_node in
324 * cpu device. Once of_node in cpu device is populated, all the further
325 * references can use that instead.
326 *
327 * CPU logical to physical index mapping is architecture specific and is built
328 * before booting secondary cores. This function uses arch_match_cpu_phys_id
329 * which can be overridden by architecture specific implementation.
330 *
331 * Returns a node pointer for the logical cpu if found, else NULL.
332 */
333struct device_node *of_get_cpu_node(int cpu, unsigned int *thread)
334{
David Millerd1cb9d12013-10-03 17:24:51 -0400335 struct device_node *cpun;
Sudeep KarkadaNagesha183912d2013-08-15 14:01:40 +0100336
David Millerd1cb9d12013-10-03 17:24:51 -0400337 for_each_node_by_type(cpun, "cpu") {
338 if (arch_find_n_match_cpu_physical_id(cpun, cpu, thread))
Sudeep KarkadaNagesha183912d2013-08-15 14:01:40 +0100339 return cpun;
340 }
341 return NULL;
342}
343EXPORT_SYMBOL(of_get_cpu_node);
344
Stephen Rothwell0081cbc2007-05-01 16:29:19 +1000345/** Checks if the given "compat" string matches one of the strings in
346 * the device's "compatible" property
347 */
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500348static int __of_device_is_compatible(const struct device_node *device,
349 const char *compat)
Stephen Rothwell0081cbc2007-05-01 16:29:19 +1000350{
351 const char* cp;
352 int cplen, l;
353
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500354 cp = __of_get_property(device, "compatible", &cplen);
Stephen Rothwell0081cbc2007-05-01 16:29:19 +1000355 if (cp == NULL)
356 return 0;
357 while (cplen > 0) {
358 if (of_compat_cmp(cp, compat, strlen(compat)) == 0)
359 return 1;
360 l = strlen(cp) + 1;
361 cp += l;
362 cplen -= l;
363 }
364
365 return 0;
366}
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500367
368/** Checks if the given "compat" string matches one of the strings in
369 * the device's "compatible" property
370 */
371int of_device_is_compatible(const struct device_node *device,
372 const char *compat)
373{
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500374 unsigned long flags;
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500375 int res;
376
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500377 raw_spin_lock_irqsave(&devtree_lock, flags);
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500378 res = __of_device_is_compatible(device, compat);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500379 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500380 return res;
381}
Stephen Rothwell0081cbc2007-05-01 16:29:19 +1000382EXPORT_SYMBOL(of_device_is_compatible);
Stephen Rothwelle679c5f2007-04-24 17:16:16 +1000383
384/**
Grant Likely71a157e2010-02-01 21:34:14 -0700385 * of_machine_is_compatible - Test root of device tree for a given compatible value
Grant Likely1f43cfb2010-01-28 13:47:25 -0700386 * @compat: compatible string to look for in root node's compatible property.
387 *
388 * Returns true if the root node has the given value in its
389 * compatible property.
390 */
Grant Likely71a157e2010-02-01 21:34:14 -0700391int of_machine_is_compatible(const char *compat)
Grant Likely1f43cfb2010-01-28 13:47:25 -0700392{
393 struct device_node *root;
394 int rc = 0;
395
396 root = of_find_node_by_path("/");
397 if (root) {
398 rc = of_device_is_compatible(root, compat);
399 of_node_put(root);
400 }
401 return rc;
402}
Grant Likely71a157e2010-02-01 21:34:14 -0700403EXPORT_SYMBOL(of_machine_is_compatible);
Grant Likely1f43cfb2010-01-28 13:47:25 -0700404
405/**
Stephen Warrenc31a0c02013-02-11 14:15:32 -0700406 * __of_device_is_available - check if a device is available for use
Josh Boyer834d97d2008-03-27 00:33:14 +1100407 *
Stephen Warrenc31a0c02013-02-11 14:15:32 -0700408 * @device: Node to check for availability, with locks already held
Josh Boyer834d97d2008-03-27 00:33:14 +1100409 *
410 * Returns 1 if the status property is absent or set to "okay" or "ok",
411 * 0 otherwise
412 */
Stephen Warrenc31a0c02013-02-11 14:15:32 -0700413static int __of_device_is_available(const struct device_node *device)
Josh Boyer834d97d2008-03-27 00:33:14 +1100414{
415 const char *status;
416 int statlen;
417
Xiubo Li42ccd782014-01-13 11:07:28 +0800418 if (!device)
419 return 0;
420
Stephen Warrenc31a0c02013-02-11 14:15:32 -0700421 status = __of_get_property(device, "status", &statlen);
Josh Boyer834d97d2008-03-27 00:33:14 +1100422 if (status == NULL)
423 return 1;
424
425 if (statlen > 0) {
426 if (!strcmp(status, "okay") || !strcmp(status, "ok"))
427 return 1;
428 }
429
430 return 0;
431}
Stephen Warrenc31a0c02013-02-11 14:15:32 -0700432
433/**
434 * of_device_is_available - check if a device is available for use
435 *
436 * @device: Node to check for availability
437 *
438 * Returns 1 if the status property is absent or set to "okay" or "ok",
439 * 0 otherwise
440 */
441int of_device_is_available(const struct device_node *device)
442{
443 unsigned long flags;
444 int res;
445
446 raw_spin_lock_irqsave(&devtree_lock, flags);
447 res = __of_device_is_available(device);
448 raw_spin_unlock_irqrestore(&devtree_lock, flags);
449 return res;
450
451}
Josh Boyer834d97d2008-03-27 00:33:14 +1100452EXPORT_SYMBOL(of_device_is_available);
453
454/**
Stephen Rothwelle679c5f2007-04-24 17:16:16 +1000455 * of_get_parent - Get a node's parent if any
456 * @node: Node to get parent
457 *
458 * Returns a node pointer with refcount incremented, use
459 * of_node_put() on it when done.
460 */
461struct device_node *of_get_parent(const struct device_node *node)
462{
463 struct device_node *np;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500464 unsigned long flags;
Stephen Rothwelle679c5f2007-04-24 17:16:16 +1000465
466 if (!node)
467 return NULL;
468
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500469 raw_spin_lock_irqsave(&devtree_lock, flags);
Stephen Rothwelle679c5f2007-04-24 17:16:16 +1000470 np = of_node_get(node->parent);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500471 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Stephen Rothwelle679c5f2007-04-24 17:16:16 +1000472 return np;
473}
474EXPORT_SYMBOL(of_get_parent);
Stephen Rothwelld1cd3552007-04-24 17:21:29 +1000475
476/**
Michael Ellermanf4eb0102007-10-26 16:54:31 +1000477 * of_get_next_parent - Iterate to a node's parent
478 * @node: Node to get parent of
479 *
480 * This is like of_get_parent() except that it drops the
481 * refcount on the passed node, making it suitable for iterating
482 * through a node's parents.
483 *
484 * Returns a node pointer with refcount incremented, use
485 * of_node_put() on it when done.
486 */
487struct device_node *of_get_next_parent(struct device_node *node)
488{
489 struct device_node *parent;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500490 unsigned long flags;
Michael Ellermanf4eb0102007-10-26 16:54:31 +1000491
492 if (!node)
493 return NULL;
494
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500495 raw_spin_lock_irqsave(&devtree_lock, flags);
Michael Ellermanf4eb0102007-10-26 16:54:31 +1000496 parent = of_node_get(node->parent);
497 of_node_put(node);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500498 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Michael Ellermanf4eb0102007-10-26 16:54:31 +1000499 return parent;
500}
Guennadi Liakhovetski6695be62013-04-02 12:28:11 -0300501EXPORT_SYMBOL(of_get_next_parent);
Michael Ellermanf4eb0102007-10-26 16:54:31 +1000502
503/**
Stephen Rothwelld1cd3552007-04-24 17:21:29 +1000504 * of_get_next_child - Iterate a node childs
505 * @node: parent node
506 * @prev: previous child of the parent node, or NULL to get first
507 *
508 * Returns a node pointer with refcount incremented, use
509 * of_node_put() on it when done.
510 */
511struct device_node *of_get_next_child(const struct device_node *node,
512 struct device_node *prev)
513{
514 struct device_node *next;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500515 unsigned long flags;
Stephen Rothwelld1cd3552007-04-24 17:21:29 +1000516
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500517 raw_spin_lock_irqsave(&devtree_lock, flags);
Stephen Rothwelld1cd3552007-04-24 17:21:29 +1000518 next = prev ? prev->sibling : node->child;
519 for (; next; next = next->sibling)
520 if (of_node_get(next))
521 break;
522 of_node_put(prev);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500523 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Stephen Rothwelld1cd3552007-04-24 17:21:29 +1000524 return next;
525}
526EXPORT_SYMBOL(of_get_next_child);
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000527
528/**
Timur Tabi32961932012-08-14 13:20:23 +0000529 * of_get_next_available_child - Find the next available child node
530 * @node: parent node
531 * @prev: previous child of the parent node, or NULL to get first
532 *
533 * This function is like of_get_next_child(), except that it
534 * automatically skips any disabled nodes (i.e. status = "disabled").
535 */
536struct device_node *of_get_next_available_child(const struct device_node *node,
537 struct device_node *prev)
538{
539 struct device_node *next;
Benjamin Herrenschmidtd25d8692013-06-12 15:39:04 +1000540 unsigned long flags;
Timur Tabi32961932012-08-14 13:20:23 +0000541
Benjamin Herrenschmidtd25d8692013-06-12 15:39:04 +1000542 raw_spin_lock_irqsave(&devtree_lock, flags);
Timur Tabi32961932012-08-14 13:20:23 +0000543 next = prev ? prev->sibling : node->child;
544 for (; next; next = next->sibling) {
Stephen Warrenc31a0c02013-02-11 14:15:32 -0700545 if (!__of_device_is_available(next))
Timur Tabi32961932012-08-14 13:20:23 +0000546 continue;
547 if (of_node_get(next))
548 break;
549 }
550 of_node_put(prev);
Benjamin Herrenschmidtd25d8692013-06-12 15:39:04 +1000551 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Timur Tabi32961932012-08-14 13:20:23 +0000552 return next;
553}
554EXPORT_SYMBOL(of_get_next_available_child);
555
556/**
Srinivas Kandagatla9c197612012-09-18 08:10:28 +0100557 * of_get_child_by_name - Find the child node by name for a given parent
558 * @node: parent node
559 * @name: child name to look for.
560 *
561 * This function looks for child node for given matching name
562 *
563 * Returns a node pointer if found, with refcount incremented, use
564 * of_node_put() on it when done.
565 * Returns NULL if node is not found.
566 */
567struct device_node *of_get_child_by_name(const struct device_node *node,
568 const char *name)
569{
570 struct device_node *child;
571
572 for_each_child_of_node(node, child)
573 if (child->name && (of_node_cmp(child->name, name) == 0))
574 break;
575 return child;
576}
577EXPORT_SYMBOL(of_get_child_by_name);
578
579/**
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000580 * of_find_node_by_path - Find a node matching a full OF path
581 * @path: The full path to match
582 *
583 * Returns a node pointer with refcount incremented, use
584 * of_node_put() on it when done.
585 */
586struct device_node *of_find_node_by_path(const char *path)
587{
Randy Dunlap465aac62012-11-30 10:01:51 +0000588 struct device_node *np = of_allnodes;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500589 unsigned long flags;
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000590
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500591 raw_spin_lock_irqsave(&devtree_lock, flags);
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000592 for (; np; np = np->allnext) {
593 if (np->full_name && (of_node_cmp(np->full_name, path) == 0)
594 && of_node_get(np))
595 break;
596 }
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500597 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000598 return np;
599}
600EXPORT_SYMBOL(of_find_node_by_path);
601
602/**
603 * of_find_node_by_name - Find a node by its "name" property
604 * @from: The node to start searching from or NULL, the node
605 * you pass will not be searched, only the next one
606 * will; typically, you pass what the previous call
607 * returned. of_node_put() will be called on it
608 * @name: The name string to match against
609 *
610 * Returns a node pointer with refcount incremented, use
611 * of_node_put() on it when done.
612 */
613struct device_node *of_find_node_by_name(struct device_node *from,
614 const char *name)
615{
616 struct device_node *np;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500617 unsigned long flags;
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000618
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500619 raw_spin_lock_irqsave(&devtree_lock, flags);
Randy Dunlap465aac62012-11-30 10:01:51 +0000620 np = from ? from->allnext : of_allnodes;
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000621 for (; np; np = np->allnext)
622 if (np->name && (of_node_cmp(np->name, name) == 0)
623 && of_node_get(np))
624 break;
625 of_node_put(from);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500626 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000627 return np;
628}
629EXPORT_SYMBOL(of_find_node_by_name);
630
631/**
632 * of_find_node_by_type - Find a node by its "device_type" property
633 * @from: The node to start searching from, or NULL to start searching
634 * the entire device tree. The node you pass will not be
635 * searched, only the next one will; typically, you pass
636 * what the previous call returned. of_node_put() will be
637 * called on from for you.
638 * @type: The type string to match against
639 *
640 * Returns a node pointer with refcount incremented, use
641 * of_node_put() on it when done.
642 */
643struct device_node *of_find_node_by_type(struct device_node *from,
644 const char *type)
645{
646 struct device_node *np;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500647 unsigned long flags;
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000648
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500649 raw_spin_lock_irqsave(&devtree_lock, flags);
Randy Dunlap465aac62012-11-30 10:01:51 +0000650 np = from ? from->allnext : of_allnodes;
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000651 for (; np; np = np->allnext)
652 if (np->type && (of_node_cmp(np->type, type) == 0)
653 && of_node_get(np))
654 break;
655 of_node_put(from);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500656 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000657 return np;
658}
659EXPORT_SYMBOL(of_find_node_by_type);
660
661/**
662 * of_find_compatible_node - Find a node based on type and one of the
663 * tokens in its "compatible" property
664 * @from: The node to start searching from or NULL, the node
665 * you pass will not be searched, only the next one
666 * will; typically, you pass what the previous call
667 * returned. of_node_put() will be called on it
668 * @type: The type string to match "device_type" or NULL to ignore
669 * @compatible: The string to match to one of the tokens in the device
670 * "compatible" list.
671 *
672 * Returns a node pointer with refcount incremented, use
673 * of_node_put() on it when done.
674 */
675struct device_node *of_find_compatible_node(struct device_node *from,
676 const char *type, const char *compatible)
677{
678 struct device_node *np;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500679 unsigned long flags;
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000680
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500681 raw_spin_lock_irqsave(&devtree_lock, flags);
Randy Dunlap465aac62012-11-30 10:01:51 +0000682 np = from ? from->allnext : of_allnodes;
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000683 for (; np; np = np->allnext) {
684 if (type
685 && !(np->type && (of_node_cmp(np->type, type) == 0)))
686 continue;
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500687 if (__of_device_is_compatible(np, compatible) &&
688 of_node_get(np))
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000689 break;
690 }
691 of_node_put(from);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500692 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Stephen Rothwell1ef4d422007-04-24 17:57:33 +1000693 return np;
694}
695EXPORT_SYMBOL(of_find_compatible_node);
Grant Likely283029d2008-01-09 06:20:40 +1100696
697/**
Michael Ellerman1e291b12008-11-12 18:54:42 +0000698 * of_find_node_with_property - Find a node which has a property with
699 * the given name.
700 * @from: The node to start searching from or NULL, the node
701 * you pass will not be searched, only the next one
702 * will; typically, you pass what the previous call
703 * returned. of_node_put() will be called on it
704 * @prop_name: The name of the property to look for.
705 *
706 * Returns a node pointer with refcount incremented, use
707 * of_node_put() on it when done.
708 */
709struct device_node *of_find_node_with_property(struct device_node *from,
710 const char *prop_name)
711{
712 struct device_node *np;
713 struct property *pp;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500714 unsigned long flags;
Michael Ellerman1e291b12008-11-12 18:54:42 +0000715
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500716 raw_spin_lock_irqsave(&devtree_lock, flags);
Randy Dunlap465aac62012-11-30 10:01:51 +0000717 np = from ? from->allnext : of_allnodes;
Michael Ellerman1e291b12008-11-12 18:54:42 +0000718 for (; np; np = np->allnext) {
Sachin Kamata3a7cab2012-06-27 09:44:45 +0530719 for (pp = np->properties; pp; pp = pp->next) {
Michael Ellerman1e291b12008-11-12 18:54:42 +0000720 if (of_prop_cmp(pp->name, prop_name) == 0) {
721 of_node_get(np);
722 goto out;
723 }
724 }
725 }
726out:
727 of_node_put(from);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500728 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Michael Ellerman1e291b12008-11-12 18:54:42 +0000729 return np;
730}
731EXPORT_SYMBOL(of_find_node_with_property);
732
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500733static
734const struct of_device_id *__of_match_node(const struct of_device_id *matches,
735 const struct device_node *node)
Grant Likely283029d2008-01-09 06:20:40 +1100736{
Grant Likelya52f07e2011-03-18 10:21:29 -0600737 if (!matches)
738 return NULL;
739
Kevin Hao4e8ca6e2014-02-14 13:22:45 +0800740 while (matches->name[0] || matches->type[0] || matches->compatible[0]) {
741 int match = 1;
742 if (matches->name[0])
743 match &= node->name
744 && !strcmp(matches->name, node->name);
745 if (matches->type[0])
746 match &= node->type
747 && !strcmp(matches->type, node->type);
748 if (matches->compatible[0])
749 match &= __of_device_is_compatible(node,
750 matches->compatible);
751 if (match)
752 return matches;
753 matches++;
754 }
Grant Likely283029d2008-01-09 06:20:40 +1100755 return NULL;
756}
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500757
758/**
759 * of_match_node - Tell if an device_node has a matching of_match structure
760 * @matches: array of of device match structures to search in
761 * @node: the of device structure to match against
762 *
Kevin Hao4e8ca6e2014-02-14 13:22:45 +0800763 * Low level utility function used by device matching.
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500764 */
765const struct of_device_id *of_match_node(const struct of_device_id *matches,
766 const struct device_node *node)
767{
768 const struct of_device_id *match;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500769 unsigned long flags;
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500770
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500771 raw_spin_lock_irqsave(&devtree_lock, flags);
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500772 match = __of_match_node(matches, node);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500773 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500774 return match;
775}
Grant Likely283029d2008-01-09 06:20:40 +1100776EXPORT_SYMBOL(of_match_node);
777
778/**
Stephen Warren50c8af42012-11-20 16:12:20 -0700779 * of_find_matching_node_and_match - Find a node based on an of_device_id
780 * match table.
Grant Likely283029d2008-01-09 06:20:40 +1100781 * @from: The node to start searching from or NULL, the node
782 * you pass will not be searched, only the next one
783 * will; typically, you pass what the previous call
784 * returned. of_node_put() will be called on it
785 * @matches: array of of device match structures to search in
Stephen Warren50c8af42012-11-20 16:12:20 -0700786 * @match Updated to point at the matches entry which matched
Grant Likely283029d2008-01-09 06:20:40 +1100787 *
788 * Returns a node pointer with refcount incremented, use
789 * of_node_put() on it when done.
790 */
Stephen Warren50c8af42012-11-20 16:12:20 -0700791struct device_node *of_find_matching_node_and_match(struct device_node *from,
792 const struct of_device_id *matches,
793 const struct of_device_id **match)
Grant Likely283029d2008-01-09 06:20:40 +1100794{
795 struct device_node *np;
Thomas Abrahamdc71bcf2013-01-19 10:20:42 -0800796 const struct of_device_id *m;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500797 unsigned long flags;
Grant Likely283029d2008-01-09 06:20:40 +1100798
Stephen Warren50c8af42012-11-20 16:12:20 -0700799 if (match)
800 *match = NULL;
801
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500802 raw_spin_lock_irqsave(&devtree_lock, flags);
Randy Dunlap465aac62012-11-30 10:01:51 +0000803 np = from ? from->allnext : of_allnodes;
Grant Likely283029d2008-01-09 06:20:40 +1100804 for (; np; np = np->allnext) {
Thomas Gleixner28d0e362013-01-25 13:21:47 -0500805 m = __of_match_node(matches, np);
Thomas Abrahamdc71bcf2013-01-19 10:20:42 -0800806 if (m && of_node_get(np)) {
Stephen Warren50c8af42012-11-20 16:12:20 -0700807 if (match)
Thomas Abrahamdc71bcf2013-01-19 10:20:42 -0800808 *match = m;
Grant Likely283029d2008-01-09 06:20:40 +1100809 break;
Stephen Warren50c8af42012-11-20 16:12:20 -0700810 }
Grant Likely283029d2008-01-09 06:20:40 +1100811 }
812 of_node_put(from);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -0500813 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Grant Likely283029d2008-01-09 06:20:40 +1100814 return np;
815}
Grant Likely80c20222012-12-19 10:45:36 +0000816EXPORT_SYMBOL(of_find_matching_node_and_match);
Grant Likely3f07af42008-07-25 22:25:13 -0400817
818/**
Grant Likely3f07af42008-07-25 22:25:13 -0400819 * of_modalias_node - Lookup appropriate modalias for a device node
820 * @node: pointer to a device tree node
821 * @modalias: Pointer to buffer that modalias value will be copied into
822 * @len: Length of modalias value
823 *
Grant Likely2ffe8c52010-06-08 07:48:19 -0600824 * Based on the value of the compatible property, this routine will attempt
825 * to choose an appropriate modalias value for a particular device tree node.
826 * It does this by stripping the manufacturer prefix (as delimited by a ',')
827 * from the first entry in the compatible list property.
Grant Likely3f07af42008-07-25 22:25:13 -0400828 *
Grant Likely2ffe8c52010-06-08 07:48:19 -0600829 * This routine returns 0 on success, <0 on failure.
Grant Likely3f07af42008-07-25 22:25:13 -0400830 */
831int of_modalias_node(struct device_node *node, char *modalias, int len)
832{
Grant Likely2ffe8c52010-06-08 07:48:19 -0600833 const char *compatible, *p;
834 int cplen;
Grant Likely3f07af42008-07-25 22:25:13 -0400835
836 compatible = of_get_property(node, "compatible", &cplen);
Grant Likely2ffe8c52010-06-08 07:48:19 -0600837 if (!compatible || strlen(compatible) > cplen)
Grant Likely3f07af42008-07-25 22:25:13 -0400838 return -ENODEV;
Grant Likely3f07af42008-07-25 22:25:13 -0400839 p = strchr(compatible, ',');
Grant Likely2ffe8c52010-06-08 07:48:19 -0600840 strlcpy(modalias, p ? p + 1 : compatible, len);
Grant Likely3f07af42008-07-25 22:25:13 -0400841 return 0;
842}
843EXPORT_SYMBOL_GPL(of_modalias_node);
844
Anton Vorontsov64b60e02008-10-10 04:43:17 +0000845/**
Jeremy Kerr89751a72010-02-01 21:34:11 -0700846 * of_find_node_by_phandle - Find a node given a phandle
847 * @handle: phandle of the node to find
848 *
849 * Returns a node pointer with refcount incremented, use
850 * of_node_put() on it when done.
851 */
852struct device_node *of_find_node_by_phandle(phandle handle)
853{
854 struct device_node *np;
Benjamin Herrenschmidtd25d8692013-06-12 15:39:04 +1000855 unsigned long flags;
Jeremy Kerr89751a72010-02-01 21:34:11 -0700856
Benjamin Herrenschmidtd25d8692013-06-12 15:39:04 +1000857 raw_spin_lock_irqsave(&devtree_lock, flags);
Randy Dunlap465aac62012-11-30 10:01:51 +0000858 for (np = of_allnodes; np; np = np->allnext)
Jeremy Kerr89751a72010-02-01 21:34:11 -0700859 if (np->phandle == handle)
860 break;
861 of_node_get(np);
Benjamin Herrenschmidtd25d8692013-06-12 15:39:04 +1000862 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Jeremy Kerr89751a72010-02-01 21:34:11 -0700863 return np;
864}
865EXPORT_SYMBOL(of_find_node_by_phandle);
866
867/**
Tony Priskdaeec1f2013-04-03 17:57:11 +1300868 * of_find_property_value_of_size
869 *
870 * @np: device node from which the property value is to be read.
871 * @propname: name of the property to be searched.
872 * @len: requested length of property value
873 *
874 * Search for a property in a device node and valid the requested size.
875 * Returns the property value on success, -EINVAL if the property does not
876 * exist, -ENODATA if property does not have a value, and -EOVERFLOW if the
877 * property data isn't large enough.
878 *
879 */
880static void *of_find_property_value_of_size(const struct device_node *np,
881 const char *propname, u32 len)
882{
883 struct property *prop = of_find_property(np, propname, NULL);
884
885 if (!prop)
886 return ERR_PTR(-EINVAL);
887 if (!prop->value)
888 return ERR_PTR(-ENODATA);
889 if (len > prop->length)
890 return ERR_PTR(-EOVERFLOW);
891
892 return prop->value;
893}
894
895/**
Tony Prisk3daf3722013-03-23 17:02:15 +1300896 * of_property_read_u32_index - Find and read a u32 from a multi-value property.
897 *
898 * @np: device node from which the property value is to be read.
899 * @propname: name of the property to be searched.
900 * @index: index of the u32 in the list of values
901 * @out_value: pointer to return value, modified only if no error.
902 *
903 * Search for a property in a device node and read nth 32-bit value from
904 * it. Returns 0 on success, -EINVAL if the property does not exist,
905 * -ENODATA if property does not have a value, and -EOVERFLOW if the
906 * property data isn't large enough.
907 *
908 * The out_value is modified only if a valid u32 value can be decoded.
909 */
910int of_property_read_u32_index(const struct device_node *np,
911 const char *propname,
912 u32 index, u32 *out_value)
913{
Tony Priskdaeec1f2013-04-03 17:57:11 +1300914 const u32 *val = of_find_property_value_of_size(np, propname,
915 ((index + 1) * sizeof(*out_value)));
Tony Prisk3daf3722013-03-23 17:02:15 +1300916
Tony Priskdaeec1f2013-04-03 17:57:11 +1300917 if (IS_ERR(val))
918 return PTR_ERR(val);
Tony Prisk3daf3722013-03-23 17:02:15 +1300919
Tony Priskdaeec1f2013-04-03 17:57:11 +1300920 *out_value = be32_to_cpup(((__be32 *)val) + index);
Tony Prisk3daf3722013-03-23 17:02:15 +1300921 return 0;
922}
923EXPORT_SYMBOL_GPL(of_property_read_u32_index);
924
925/**
Viresh Kumarbe193242012-11-20 10:15:19 +0530926 * of_property_read_u8_array - Find and read an array of u8 from a property.
927 *
928 * @np: device node from which the property value is to be read.
929 * @propname: name of the property to be searched.
Lad, Prabhakar792efb82013-05-07 11:34:11 +0530930 * @out_values: pointer to return value, modified only if return value is 0.
Viresh Kumarbe193242012-11-20 10:15:19 +0530931 * @sz: number of array elements to read
932 *
933 * Search for a property in a device node and read 8-bit value(s) from
934 * it. Returns 0 on success, -EINVAL if the property does not exist,
935 * -ENODATA if property does not have a value, and -EOVERFLOW if the
936 * property data isn't large enough.
937 *
938 * dts entry of array should be like:
939 * property = /bits/ 8 <0x50 0x60 0x70>;
940 *
Lad, Prabhakar792efb82013-05-07 11:34:11 +0530941 * The out_values is modified only if a valid u8 value can be decoded.
Viresh Kumarbe193242012-11-20 10:15:19 +0530942 */
943int of_property_read_u8_array(const struct device_node *np,
944 const char *propname, u8 *out_values, size_t sz)
945{
Tony Priskdaeec1f2013-04-03 17:57:11 +1300946 const u8 *val = of_find_property_value_of_size(np, propname,
947 (sz * sizeof(*out_values)));
Viresh Kumarbe193242012-11-20 10:15:19 +0530948
Tony Priskdaeec1f2013-04-03 17:57:11 +1300949 if (IS_ERR(val))
950 return PTR_ERR(val);
Viresh Kumarbe193242012-11-20 10:15:19 +0530951
Viresh Kumarbe193242012-11-20 10:15:19 +0530952 while (sz--)
953 *out_values++ = *val++;
954 return 0;
955}
956EXPORT_SYMBOL_GPL(of_property_read_u8_array);
957
958/**
959 * of_property_read_u16_array - Find and read an array of u16 from a property.
960 *
961 * @np: device node from which the property value is to be read.
962 * @propname: name of the property to be searched.
Lad, Prabhakar792efb82013-05-07 11:34:11 +0530963 * @out_values: pointer to return value, modified only if return value is 0.
Viresh Kumarbe193242012-11-20 10:15:19 +0530964 * @sz: number of array elements to read
965 *
966 * Search for a property in a device node and read 16-bit value(s) from
967 * it. Returns 0 on success, -EINVAL if the property does not exist,
968 * -ENODATA if property does not have a value, and -EOVERFLOW if the
969 * property data isn't large enough.
970 *
971 * dts entry of array should be like:
972 * property = /bits/ 16 <0x5000 0x6000 0x7000>;
973 *
Lad, Prabhakar792efb82013-05-07 11:34:11 +0530974 * The out_values is modified only if a valid u16 value can be decoded.
Viresh Kumarbe193242012-11-20 10:15:19 +0530975 */
976int of_property_read_u16_array(const struct device_node *np,
977 const char *propname, u16 *out_values, size_t sz)
978{
Tony Priskdaeec1f2013-04-03 17:57:11 +1300979 const __be16 *val = of_find_property_value_of_size(np, propname,
980 (sz * sizeof(*out_values)));
Viresh Kumarbe193242012-11-20 10:15:19 +0530981
Tony Priskdaeec1f2013-04-03 17:57:11 +1300982 if (IS_ERR(val))
983 return PTR_ERR(val);
Viresh Kumarbe193242012-11-20 10:15:19 +0530984
Viresh Kumarbe193242012-11-20 10:15:19 +0530985 while (sz--)
986 *out_values++ = be16_to_cpup(val++);
987 return 0;
988}
989EXPORT_SYMBOL_GPL(of_property_read_u16_array);
990
991/**
Rob Herring0e373632011-07-06 15:42:58 -0500992 * of_property_read_u32_array - Find and read an array of 32 bit integers
993 * from a property.
994 *
Thomas Abrahama3b85362011-06-30 21:26:10 +0530995 * @np: device node from which the property value is to be read.
996 * @propname: name of the property to be searched.
Lad, Prabhakar792efb82013-05-07 11:34:11 +0530997 * @out_values: pointer to return value, modified only if return value is 0.
Viresh Kumarbe193242012-11-20 10:15:19 +0530998 * @sz: number of array elements to read
Thomas Abrahama3b85362011-06-30 21:26:10 +0530999 *
Rob Herring0e373632011-07-06 15:42:58 -05001000 * Search for a property in a device node and read 32-bit value(s) from
Thomas Abrahama3b85362011-06-30 21:26:10 +05301001 * it. Returns 0 on success, -EINVAL if the property does not exist,
1002 * -ENODATA if property does not have a value, and -EOVERFLOW if the
1003 * property data isn't large enough.
1004 *
Lad, Prabhakar792efb82013-05-07 11:34:11 +05301005 * The out_values is modified only if a valid u32 value can be decoded.
Thomas Abrahama3b85362011-06-30 21:26:10 +05301006 */
Jamie Ilesaac285c2011-08-02 15:45:07 +01001007int of_property_read_u32_array(const struct device_node *np,
1008 const char *propname, u32 *out_values,
1009 size_t sz)
Thomas Abrahama3b85362011-06-30 21:26:10 +05301010{
Tony Priskdaeec1f2013-04-03 17:57:11 +13001011 const __be32 *val = of_find_property_value_of_size(np, propname,
1012 (sz * sizeof(*out_values)));
Thomas Abrahama3b85362011-06-30 21:26:10 +05301013
Tony Priskdaeec1f2013-04-03 17:57:11 +13001014 if (IS_ERR(val))
1015 return PTR_ERR(val);
Rob Herring0e373632011-07-06 15:42:58 -05001016
Rob Herring0e373632011-07-06 15:42:58 -05001017 while (sz--)
1018 *out_values++ = be32_to_cpup(val++);
Thomas Abrahama3b85362011-06-30 21:26:10 +05301019 return 0;
1020}
Rob Herring0e373632011-07-06 15:42:58 -05001021EXPORT_SYMBOL_GPL(of_property_read_u32_array);
Thomas Abrahama3b85362011-06-30 21:26:10 +05301022
1023/**
Jamie Iles4cd7f7a2011-09-14 20:49:59 +01001024 * of_property_read_u64 - Find and read a 64 bit integer from a property
1025 * @np: device node from which the property value is to be read.
1026 * @propname: name of the property to be searched.
1027 * @out_value: pointer to return value, modified only if return value is 0.
1028 *
1029 * Search for a property in a device node and read a 64-bit value from
1030 * it. Returns 0 on success, -EINVAL if the property does not exist,
1031 * -ENODATA if property does not have a value, and -EOVERFLOW if the
1032 * property data isn't large enough.
1033 *
1034 * The out_value is modified only if a valid u64 value can be decoded.
1035 */
1036int of_property_read_u64(const struct device_node *np, const char *propname,
1037 u64 *out_value)
1038{
Tony Priskdaeec1f2013-04-03 17:57:11 +13001039 const __be32 *val = of_find_property_value_of_size(np, propname,
1040 sizeof(*out_value));
Jamie Iles4cd7f7a2011-09-14 20:49:59 +01001041
Tony Priskdaeec1f2013-04-03 17:57:11 +13001042 if (IS_ERR(val))
1043 return PTR_ERR(val);
1044
1045 *out_value = of_read_number(val, 2);
Jamie Iles4cd7f7a2011-09-14 20:49:59 +01001046 return 0;
1047}
1048EXPORT_SYMBOL_GPL(of_property_read_u64);
1049
1050/**
Thomas Abrahama3b85362011-06-30 21:26:10 +05301051 * of_property_read_string - Find and read a string from a property
1052 * @np: device node from which the property value is to be read.
1053 * @propname: name of the property to be searched.
1054 * @out_string: pointer to null terminated return string, modified only if
1055 * return value is 0.
1056 *
1057 * Search for a property in a device tree node and retrieve a null
1058 * terminated string value (pointer to data, not a copy). Returns 0 on
1059 * success, -EINVAL if the property does not exist, -ENODATA if property
1060 * does not have a value, and -EILSEQ if the string is not null-terminated
1061 * within the length of the property data.
1062 *
1063 * The out_string pointer is modified only if a valid string can be decoded.
1064 */
Jamie Ilesaac285c2011-08-02 15:45:07 +01001065int of_property_read_string(struct device_node *np, const char *propname,
Shawn Guof09bc832011-07-04 09:01:18 +08001066 const char **out_string)
Thomas Abrahama3b85362011-06-30 21:26:10 +05301067{
1068 struct property *prop = of_find_property(np, propname, NULL);
1069 if (!prop)
1070 return -EINVAL;
1071 if (!prop->value)
1072 return -ENODATA;
1073 if (strnlen(prop->value, prop->length) >= prop->length)
1074 return -EILSEQ;
1075 *out_string = prop->value;
1076 return 0;
1077}
1078EXPORT_SYMBOL_GPL(of_property_read_string);
1079
1080/**
Benoit Cousson4fcd15a2011-09-27 17:45:43 +02001081 * of_property_read_string_index - Find and read a string from a multiple
1082 * strings property.
1083 * @np: device node from which the property value is to be read.
1084 * @propname: name of the property to be searched.
1085 * @index: index of the string in the list of strings
1086 * @out_string: pointer to null terminated return string, modified only if
1087 * return value is 0.
1088 *
1089 * Search for a property in a device tree node and retrieve a null
1090 * terminated string value (pointer to data, not a copy) in the list of strings
1091 * contained in that property.
1092 * Returns 0 on success, -EINVAL if the property does not exist, -ENODATA if
1093 * property does not have a value, and -EILSEQ if the string is not
1094 * null-terminated within the length of the property data.
1095 *
1096 * The out_string pointer is modified only if a valid string can be decoded.
1097 */
1098int of_property_read_string_index(struct device_node *np, const char *propname,
1099 int index, const char **output)
1100{
1101 struct property *prop = of_find_property(np, propname, NULL);
1102 int i = 0;
1103 size_t l = 0, total = 0;
1104 const char *p;
1105
1106 if (!prop)
1107 return -EINVAL;
1108 if (!prop->value)
1109 return -ENODATA;
1110 if (strnlen(prop->value, prop->length) >= prop->length)
1111 return -EILSEQ;
1112
1113 p = prop->value;
1114
1115 for (i = 0; total < prop->length; total += l, p += l) {
1116 l = strlen(p) + 1;
Benoit Cousson88af7f52011-12-05 15:23:54 +01001117 if (i++ == index) {
Benoit Cousson4fcd15a2011-09-27 17:45:43 +02001118 *output = p;
1119 return 0;
1120 }
1121 }
1122 return -ENODATA;
1123}
1124EXPORT_SYMBOL_GPL(of_property_read_string_index);
1125
Grant Likely7aff0fe2011-12-12 09:25:58 -07001126/**
1127 * of_property_match_string() - Find string in a list and return index
1128 * @np: pointer to node containing string list property
1129 * @propname: string list property name
1130 * @string: pointer to string to search for in string list
1131 *
1132 * This function searches a string list property and returns the index
1133 * of a specific string value.
1134 */
1135int of_property_match_string(struct device_node *np, const char *propname,
1136 const char *string)
1137{
1138 struct property *prop = of_find_property(np, propname, NULL);
1139 size_t l;
1140 int i;
1141 const char *p, *end;
1142
1143 if (!prop)
1144 return -EINVAL;
1145 if (!prop->value)
1146 return -ENODATA;
1147
1148 p = prop->value;
1149 end = p + prop->length;
1150
1151 for (i = 0; p < end; i++, p += l) {
1152 l = strlen(p) + 1;
1153 if (p + l > end)
1154 return -EILSEQ;
1155 pr_debug("comparing %s with %s\n", string, p);
1156 if (strcmp(string, p) == 0)
1157 return i; /* Found it; return index */
1158 }
1159 return -ENODATA;
1160}
1161EXPORT_SYMBOL_GPL(of_property_match_string);
Benoit Cousson4fcd15a2011-09-27 17:45:43 +02001162
1163/**
1164 * of_property_count_strings - Find and return the number of strings from a
1165 * multiple strings property.
1166 * @np: device node from which the property value is to be read.
1167 * @propname: name of the property to be searched.
1168 *
1169 * Search for a property in a device tree node and retrieve the number of null
1170 * terminated string contain in it. Returns the number of strings on
1171 * success, -EINVAL if the property does not exist, -ENODATA if property
1172 * does not have a value, and -EILSEQ if the string is not null-terminated
1173 * within the length of the property data.
1174 */
1175int of_property_count_strings(struct device_node *np, const char *propname)
1176{
1177 struct property *prop = of_find_property(np, propname, NULL);
1178 int i = 0;
1179 size_t l = 0, total = 0;
1180 const char *p;
1181
1182 if (!prop)
1183 return -EINVAL;
1184 if (!prop->value)
1185 return -ENODATA;
1186 if (strnlen(prop->value, prop->length) >= prop->length)
1187 return -EILSEQ;
1188
1189 p = prop->value;
1190
Benoit Cousson88af7f52011-12-05 15:23:54 +01001191 for (i = 0; total < prop->length; total += l, p += l, i++)
Benoit Cousson4fcd15a2011-09-27 17:45:43 +02001192 l = strlen(p) + 1;
Benoit Cousson88af7f52011-12-05 15:23:54 +01001193
Benoit Cousson4fcd15a2011-09-27 17:45:43 +02001194 return i;
1195}
1196EXPORT_SYMBOL_GPL(of_property_count_strings);
1197
Grant Likely624cfca2013-10-11 22:05:10 +01001198void of_print_phandle_args(const char *msg, const struct of_phandle_args *args)
1199{
1200 int i;
1201 printk("%s %s", msg, of_node_full_name(args->np));
1202 for (i = 0; i < args->args_count; i++)
1203 printk(i ? ",%08x" : ":%08x", args->args[i]);
1204 printk("\n");
1205}
1206
Grant Likelybd69f732013-02-10 22:57:21 +00001207static int __of_parse_phandle_with_args(const struct device_node *np,
1208 const char *list_name,
Stephen Warren035fd942013-08-14 15:27:10 -06001209 const char *cells_name,
1210 int cell_count, int index,
Grant Likelybd69f732013-02-10 22:57:21 +00001211 struct of_phandle_args *out_args)
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001212{
Grant Likely15c9a0a2011-12-12 09:25:57 -07001213 const __be32 *list, *list_end;
Grant Likely23ce04c2013-02-12 21:21:49 +00001214 int rc = 0, size, cur_index = 0;
Grant Likely15c9a0a2011-12-12 09:25:57 -07001215 uint32_t count = 0;
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001216 struct device_node *node = NULL;
Grant Likely15c9a0a2011-12-12 09:25:57 -07001217 phandle phandle;
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001218
Grant Likely15c9a0a2011-12-12 09:25:57 -07001219 /* Retrieve the phandle list property */
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001220 list = of_get_property(np, list_name, &size);
Grant Likely15c9a0a2011-12-12 09:25:57 -07001221 if (!list)
Alexandre Courbot1af4c7f2012-06-29 13:57:58 +09001222 return -ENOENT;
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001223 list_end = list + size / sizeof(*list);
1224
Grant Likely15c9a0a2011-12-12 09:25:57 -07001225 /* Loop over the phandles until all the requested entry is found */
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001226 while (list < list_end) {
Grant Likely23ce04c2013-02-12 21:21:49 +00001227 rc = -EINVAL;
Grant Likely15c9a0a2011-12-12 09:25:57 -07001228 count = 0;
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001229
Grant Likely15c9a0a2011-12-12 09:25:57 -07001230 /*
1231 * If phandle is 0, then it is an empty entry with no
1232 * arguments. Skip forward to the next entry.
1233 */
Grant Likely9a6b2e52010-07-23 01:48:25 -06001234 phandle = be32_to_cpup(list++);
Grant Likely15c9a0a2011-12-12 09:25:57 -07001235 if (phandle) {
1236 /*
1237 * Find the provider node and parse the #*-cells
Stephen Warren91d99422013-08-14 15:27:11 -06001238 * property to determine the argument length.
1239 *
1240 * This is not needed if the cell count is hard-coded
1241 * (i.e. cells_name not set, but cell_count is set),
1242 * except when we're going to return the found node
1243 * below.
Grant Likely15c9a0a2011-12-12 09:25:57 -07001244 */
Stephen Warren91d99422013-08-14 15:27:11 -06001245 if (cells_name || cur_index == index) {
1246 node = of_find_node_by_phandle(phandle);
1247 if (!node) {
1248 pr_err("%s: could not find phandle\n",
1249 np->full_name);
1250 goto err;
1251 }
Grant Likely15c9a0a2011-12-12 09:25:57 -07001252 }
Stephen Warren035fd942013-08-14 15:27:10 -06001253
1254 if (cells_name) {
1255 if (of_property_read_u32(node, cells_name,
1256 &count)) {
1257 pr_err("%s: could not get %s for %s\n",
1258 np->full_name, cells_name,
1259 node->full_name);
1260 goto err;
1261 }
1262 } else {
1263 count = cell_count;
Grant Likely15c9a0a2011-12-12 09:25:57 -07001264 }
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001265
Grant Likely15c9a0a2011-12-12 09:25:57 -07001266 /*
1267 * Make sure that the arguments actually fit in the
1268 * remaining property data length
1269 */
1270 if (list + count > list_end) {
1271 pr_err("%s: arguments longer than property\n",
1272 np->full_name);
Grant Likely23ce04c2013-02-12 21:21:49 +00001273 goto err;
Grant Likely15c9a0a2011-12-12 09:25:57 -07001274 }
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001275 }
1276
Grant Likely15c9a0a2011-12-12 09:25:57 -07001277 /*
1278 * All of the error cases above bail out of the loop, so at
1279 * this point, the parsing is successful. If the requested
1280 * index matches, then fill the out_args structure and return,
1281 * or return -ENOENT for an empty entry.
1282 */
Grant Likely23ce04c2013-02-12 21:21:49 +00001283 rc = -ENOENT;
Grant Likely15c9a0a2011-12-12 09:25:57 -07001284 if (cur_index == index) {
1285 if (!phandle)
Grant Likely23ce04c2013-02-12 21:21:49 +00001286 goto err;
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001287
Grant Likely15c9a0a2011-12-12 09:25:57 -07001288 if (out_args) {
1289 int i;
1290 if (WARN_ON(count > MAX_PHANDLE_ARGS))
1291 count = MAX_PHANDLE_ARGS;
1292 out_args->np = node;
1293 out_args->args_count = count;
1294 for (i = 0; i < count; i++)
1295 out_args->args[i] = be32_to_cpup(list++);
Tang Yuantianb855f162013-04-10 11:36:39 +08001296 } else {
1297 of_node_put(node);
Grant Likely15c9a0a2011-12-12 09:25:57 -07001298 }
Grant Likely23ce04c2013-02-12 21:21:49 +00001299
1300 /* Found it! return success */
Grant Likely15c9a0a2011-12-12 09:25:57 -07001301 return 0;
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001302 }
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001303
1304 of_node_put(node);
1305 node = NULL;
Grant Likely15c9a0a2011-12-12 09:25:57 -07001306 list += count;
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001307 cur_index++;
1308 }
1309
Grant Likely23ce04c2013-02-12 21:21:49 +00001310 /*
1311 * Unlock node before returning result; will be one of:
1312 * -ENOENT : index is for empty phandle
1313 * -EINVAL : parsing error on data
Grant Likelybd69f732013-02-10 22:57:21 +00001314 * [1..n] : Number of phandle (count mode; when index = -1)
Grant Likely23ce04c2013-02-12 21:21:49 +00001315 */
Grant Likelybd69f732013-02-10 22:57:21 +00001316 rc = index < 0 ? cur_index : -ENOENT;
Grant Likely23ce04c2013-02-12 21:21:49 +00001317 err:
Grant Likely15c9a0a2011-12-12 09:25:57 -07001318 if (node)
1319 of_node_put(node);
Grant Likely23ce04c2013-02-12 21:21:49 +00001320 return rc;
Anton Vorontsov64b60e02008-10-10 04:43:17 +00001321}
Grant Likelybd69f732013-02-10 22:57:21 +00001322
Stephen Warreneded9dd2013-08-14 15:27:08 -06001323/**
Stephen Warren5fba49e2013-08-14 15:27:09 -06001324 * of_parse_phandle - Resolve a phandle property to a device_node pointer
1325 * @np: Pointer to device node holding phandle property
1326 * @phandle_name: Name of property holding a phandle value
1327 * @index: For properties holding a table of phandles, this is the index into
1328 * the table
1329 *
1330 * Returns the device_node pointer with refcount incremented. Use
1331 * of_node_put() on it when done.
1332 */
1333struct device_node *of_parse_phandle(const struct device_node *np,
1334 const char *phandle_name, int index)
1335{
Stephen Warren91d99422013-08-14 15:27:11 -06001336 struct of_phandle_args args;
Stephen Warren5fba49e2013-08-14 15:27:09 -06001337
Stephen Warren91d99422013-08-14 15:27:11 -06001338 if (index < 0)
Stephen Warren5fba49e2013-08-14 15:27:09 -06001339 return NULL;
1340
Stephen Warren91d99422013-08-14 15:27:11 -06001341 if (__of_parse_phandle_with_args(np, phandle_name, NULL, 0,
1342 index, &args))
1343 return NULL;
1344
1345 return args.np;
Stephen Warren5fba49e2013-08-14 15:27:09 -06001346}
1347EXPORT_SYMBOL(of_parse_phandle);
1348
1349/**
Stephen Warreneded9dd2013-08-14 15:27:08 -06001350 * of_parse_phandle_with_args() - Find a node pointed by phandle in a list
1351 * @np: pointer to a device tree node containing a list
1352 * @list_name: property name that contains a list
1353 * @cells_name: property name that specifies phandles' arguments count
1354 * @index: index of a phandle to parse out
1355 * @out_args: optional pointer to output arguments structure (will be filled)
1356 *
1357 * This function is useful to parse lists of phandles and their arguments.
1358 * Returns 0 on success and fills out_args, on error returns appropriate
1359 * errno value.
1360 *
1361 * Caller is responsible to call of_node_put() on the returned out_args->node
1362 * pointer.
1363 *
1364 * Example:
1365 *
1366 * phandle1: node1 {
1367 * #list-cells = <2>;
1368 * }
1369 *
1370 * phandle2: node2 {
1371 * #list-cells = <1>;
1372 * }
1373 *
1374 * node3 {
1375 * list = <&phandle1 1 2 &phandle2 3>;
1376 * }
1377 *
1378 * To get a device_node of the `node2' node you may call this:
1379 * of_parse_phandle_with_args(node3, "list", "#list-cells", 1, &args);
1380 */
Grant Likelybd69f732013-02-10 22:57:21 +00001381int of_parse_phandle_with_args(const struct device_node *np, const char *list_name,
1382 const char *cells_name, int index,
1383 struct of_phandle_args *out_args)
1384{
1385 if (index < 0)
1386 return -EINVAL;
Stephen Warren035fd942013-08-14 15:27:10 -06001387 return __of_parse_phandle_with_args(np, list_name, cells_name, 0,
1388 index, out_args);
Grant Likelybd69f732013-02-10 22:57:21 +00001389}
Grant Likely15c9a0a2011-12-12 09:25:57 -07001390EXPORT_SYMBOL(of_parse_phandle_with_args);
Grant Likely02af11b2009-11-23 20:16:45 -07001391
Grant Likelybd69f732013-02-10 22:57:21 +00001392/**
Stephen Warren035fd942013-08-14 15:27:10 -06001393 * of_parse_phandle_with_fixed_args() - Find a node pointed by phandle in a list
1394 * @np: pointer to a device tree node containing a list
1395 * @list_name: property name that contains a list
1396 * @cell_count: number of argument cells following the phandle
1397 * @index: index of a phandle to parse out
1398 * @out_args: optional pointer to output arguments structure (will be filled)
1399 *
1400 * This function is useful to parse lists of phandles and their arguments.
1401 * Returns 0 on success and fills out_args, on error returns appropriate
1402 * errno value.
1403 *
1404 * Caller is responsible to call of_node_put() on the returned out_args->node
1405 * pointer.
1406 *
1407 * Example:
1408 *
1409 * phandle1: node1 {
1410 * }
1411 *
1412 * phandle2: node2 {
1413 * }
1414 *
1415 * node3 {
1416 * list = <&phandle1 0 2 &phandle2 2 3>;
1417 * }
1418 *
1419 * To get a device_node of the `node2' node you may call this:
1420 * of_parse_phandle_with_fixed_args(node3, "list", 2, 1, &args);
1421 */
1422int of_parse_phandle_with_fixed_args(const struct device_node *np,
1423 const char *list_name, int cell_count,
1424 int index, struct of_phandle_args *out_args)
1425{
1426 if (index < 0)
1427 return -EINVAL;
1428 return __of_parse_phandle_with_args(np, list_name, NULL, cell_count,
1429 index, out_args);
1430}
1431EXPORT_SYMBOL(of_parse_phandle_with_fixed_args);
1432
1433/**
Grant Likelybd69f732013-02-10 22:57:21 +00001434 * of_count_phandle_with_args() - Find the number of phandles references in a property
1435 * @np: pointer to a device tree node containing a list
1436 * @list_name: property name that contains a list
1437 * @cells_name: property name that specifies phandles' arguments count
1438 *
1439 * Returns the number of phandle + argument tuples within a property. It
1440 * is a typical pattern to encode a list of phandle and variable
1441 * arguments into a single property. The number of arguments is encoded
1442 * by a property in the phandle-target node. For example, a gpios
1443 * property would contain a list of GPIO specifies consisting of a
1444 * phandle and 1 or more arguments. The number of arguments are
1445 * determined by the #gpio-cells property in the node pointed to by the
1446 * phandle.
1447 */
1448int of_count_phandle_with_args(const struct device_node *np, const char *list_name,
1449 const char *cells_name)
1450{
Stephen Warren035fd942013-08-14 15:27:10 -06001451 return __of_parse_phandle_with_args(np, list_name, cells_name, 0, -1,
1452 NULL);
Grant Likelybd69f732013-02-10 22:57:21 +00001453}
1454EXPORT_SYMBOL(of_count_phandle_with_args);
1455
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001456#if defined(CONFIG_OF_DYNAMIC)
1457static int of_property_notify(int action, struct device_node *np,
1458 struct property *prop)
1459{
1460 struct of_prop_reconfig pr;
1461
1462 pr.dn = np;
1463 pr.prop = prop;
1464 return of_reconfig_notify(action, &pr);
1465}
1466#else
1467static int of_property_notify(int action, struct device_node *np,
1468 struct property *prop)
1469{
1470 return 0;
1471}
1472#endif
1473
Grant Likely02af11b2009-11-23 20:16:45 -07001474/**
Nathan Fontenot79d1c712012-10-02 16:58:46 +00001475 * of_add_property - Add a property to a node
Grant Likely02af11b2009-11-23 20:16:45 -07001476 */
Nathan Fontenot79d1c712012-10-02 16:58:46 +00001477int of_add_property(struct device_node *np, struct property *prop)
Grant Likely02af11b2009-11-23 20:16:45 -07001478{
1479 struct property **next;
1480 unsigned long flags;
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001481 int rc;
1482
1483 rc = of_property_notify(OF_RECONFIG_ADD_PROPERTY, np, prop);
1484 if (rc)
1485 return rc;
Grant Likely02af11b2009-11-23 20:16:45 -07001486
1487 prop->next = NULL;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001488 raw_spin_lock_irqsave(&devtree_lock, flags);
Grant Likely02af11b2009-11-23 20:16:45 -07001489 next = &np->properties;
1490 while (*next) {
1491 if (strcmp(prop->name, (*next)->name) == 0) {
1492 /* duplicate ! don't insert it */
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001493 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Grant Likely02af11b2009-11-23 20:16:45 -07001494 return -1;
1495 }
1496 next = &(*next)->next;
1497 }
1498 *next = prop;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001499 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Grant Likely02af11b2009-11-23 20:16:45 -07001500
1501#ifdef CONFIG_PROC_DEVICETREE
1502 /* try to add to proc as well if it was initialized */
1503 if (np->pde)
1504 proc_device_tree_add_prop(np->pde, prop);
1505#endif /* CONFIG_PROC_DEVICETREE */
1506
1507 return 0;
1508}
1509
1510/**
Nathan Fontenot79d1c712012-10-02 16:58:46 +00001511 * of_remove_property - Remove a property from a node.
Grant Likely02af11b2009-11-23 20:16:45 -07001512 *
1513 * Note that we don't actually remove it, since we have given out
1514 * who-knows-how-many pointers to the data using get-property.
1515 * Instead we just move the property to the "dead properties"
1516 * list, so it won't be found any more.
1517 */
Nathan Fontenot79d1c712012-10-02 16:58:46 +00001518int of_remove_property(struct device_node *np, struct property *prop)
Grant Likely02af11b2009-11-23 20:16:45 -07001519{
1520 struct property **next;
1521 unsigned long flags;
1522 int found = 0;
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001523 int rc;
1524
1525 rc = of_property_notify(OF_RECONFIG_REMOVE_PROPERTY, np, prop);
1526 if (rc)
1527 return rc;
Grant Likely02af11b2009-11-23 20:16:45 -07001528
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001529 raw_spin_lock_irqsave(&devtree_lock, flags);
Grant Likely02af11b2009-11-23 20:16:45 -07001530 next = &np->properties;
1531 while (*next) {
1532 if (*next == prop) {
1533 /* found the node */
1534 *next = prop->next;
1535 prop->next = np->deadprops;
1536 np->deadprops = prop;
1537 found = 1;
1538 break;
1539 }
1540 next = &(*next)->next;
1541 }
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001542 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Grant Likely02af11b2009-11-23 20:16:45 -07001543
1544 if (!found)
1545 return -ENODEV;
1546
1547#ifdef CONFIG_PROC_DEVICETREE
1548 /* try to remove the proc node as well */
1549 if (np->pde)
1550 proc_device_tree_remove_prop(np->pde, prop);
1551#endif /* CONFIG_PROC_DEVICETREE */
1552
1553 return 0;
1554}
1555
1556/*
Nathan Fontenot79d1c712012-10-02 16:58:46 +00001557 * of_update_property - Update a property in a node, if the property does
Dong Aisheng475d0092012-07-11 15:16:37 +10001558 * not exist, add it.
Grant Likely02af11b2009-11-23 20:16:45 -07001559 *
1560 * Note that we don't actually remove it, since we have given out
1561 * who-knows-how-many pointers to the data using get-property.
1562 * Instead we just move the property to the "dead properties" list,
1563 * and add the new property to the property list
1564 */
Nathan Fontenot79d1c712012-10-02 16:58:46 +00001565int of_update_property(struct device_node *np, struct property *newprop)
Grant Likely02af11b2009-11-23 20:16:45 -07001566{
Dong Aisheng475d0092012-07-11 15:16:37 +10001567 struct property **next, *oldprop;
Grant Likely02af11b2009-11-23 20:16:45 -07001568 unsigned long flags;
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001569 int rc, found = 0;
1570
1571 rc = of_property_notify(OF_RECONFIG_UPDATE_PROPERTY, np, newprop);
1572 if (rc)
1573 return rc;
Grant Likely02af11b2009-11-23 20:16:45 -07001574
Dong Aisheng475d0092012-07-11 15:16:37 +10001575 if (!newprop->name)
1576 return -EINVAL;
1577
1578 oldprop = of_find_property(np, newprop->name, NULL);
1579 if (!oldprop)
Nathan Fontenot79d1c712012-10-02 16:58:46 +00001580 return of_add_property(np, newprop);
Dong Aisheng475d0092012-07-11 15:16:37 +10001581
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001582 raw_spin_lock_irqsave(&devtree_lock, flags);
Grant Likely02af11b2009-11-23 20:16:45 -07001583 next = &np->properties;
1584 while (*next) {
1585 if (*next == oldprop) {
1586 /* found the node */
1587 newprop->next = oldprop->next;
1588 *next = newprop;
1589 oldprop->next = np->deadprops;
1590 np->deadprops = oldprop;
1591 found = 1;
1592 break;
1593 }
1594 next = &(*next)->next;
1595 }
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001596 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Grant Likely02af11b2009-11-23 20:16:45 -07001597
1598 if (!found)
1599 return -ENODEV;
1600
1601#ifdef CONFIG_PROC_DEVICETREE
1602 /* try to add to proc as well if it was initialized */
1603 if (np->pde)
1604 proc_device_tree_update_prop(np->pde, newprop, oldprop);
1605#endif /* CONFIG_PROC_DEVICETREE */
1606
1607 return 0;
1608}
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001609
1610#if defined(CONFIG_OF_DYNAMIC)
1611/*
1612 * Support for dynamic device trees.
1613 *
1614 * On some platforms, the device tree can be manipulated at runtime.
1615 * The routines in this section support adding, removing and changing
1616 * device tree nodes.
1617 */
1618
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001619static BLOCKING_NOTIFIER_HEAD(of_reconfig_chain);
1620
1621int of_reconfig_notifier_register(struct notifier_block *nb)
1622{
1623 return blocking_notifier_chain_register(&of_reconfig_chain, nb);
1624}
Nathan Fontenot1a9bd452012-11-28 09:42:26 +00001625EXPORT_SYMBOL_GPL(of_reconfig_notifier_register);
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001626
1627int of_reconfig_notifier_unregister(struct notifier_block *nb)
1628{
1629 return blocking_notifier_chain_unregister(&of_reconfig_chain, nb);
1630}
Nathan Fontenot1a9bd452012-11-28 09:42:26 +00001631EXPORT_SYMBOL_GPL(of_reconfig_notifier_unregister);
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001632
1633int of_reconfig_notify(unsigned long action, void *p)
1634{
1635 int rc;
1636
1637 rc = blocking_notifier_call_chain(&of_reconfig_chain, action, p);
1638 return notifier_to_errno(rc);
1639}
1640
Nathan Fontenote81b3292012-10-02 16:55:01 +00001641#ifdef CONFIG_PROC_DEVICETREE
1642static void of_add_proc_dt_entry(struct device_node *dn)
1643{
1644 struct proc_dir_entry *ent;
1645
1646 ent = proc_mkdir(strrchr(dn->full_name, '/') + 1, dn->parent->pde);
1647 if (ent)
1648 proc_device_tree_add_node(dn, ent);
1649}
1650#else
1651static void of_add_proc_dt_entry(struct device_node *dn)
1652{
1653 return;
1654}
1655#endif
1656
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001657/**
1658 * of_attach_node - Plug a device node into the tree and global list.
1659 */
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001660int of_attach_node(struct device_node *np)
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001661{
1662 unsigned long flags;
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001663 int rc;
1664
1665 rc = of_reconfig_notify(OF_RECONFIG_ATTACH_NODE, np);
1666 if (rc)
1667 return rc;
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001668
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001669 raw_spin_lock_irqsave(&devtree_lock, flags);
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001670 np->sibling = np->parent->child;
Randy Dunlap465aac62012-11-30 10:01:51 +00001671 np->allnext = of_allnodes;
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001672 np->parent->child = np;
Randy Dunlap465aac62012-11-30 10:01:51 +00001673 of_allnodes = np;
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001674 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Nathan Fontenote81b3292012-10-02 16:55:01 +00001675
1676 of_add_proc_dt_entry(np);
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001677 return 0;
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001678}
1679
Nathan Fontenote81b3292012-10-02 16:55:01 +00001680#ifdef CONFIG_PROC_DEVICETREE
1681static void of_remove_proc_dt_entry(struct device_node *dn)
1682{
David Howellsa8ca16e2013-04-12 17:27:28 +01001683 proc_remove(dn->pde);
Nathan Fontenote81b3292012-10-02 16:55:01 +00001684}
1685#else
1686static void of_remove_proc_dt_entry(struct device_node *dn)
1687{
1688 return;
1689}
1690#endif
1691
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001692/**
1693 * of_detach_node - "Unplug" a node from the device tree.
1694 *
1695 * The caller must hold a reference to the node. The memory associated with
1696 * the node is not freed until its refcount goes to zero.
1697 */
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001698int of_detach_node(struct device_node *np)
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001699{
1700 struct device_node *parent;
1701 unsigned long flags;
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001702 int rc = 0;
1703
1704 rc = of_reconfig_notify(OF_RECONFIG_DETACH_NODE, np);
1705 if (rc)
1706 return rc;
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001707
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001708 raw_spin_lock_irqsave(&devtree_lock, flags);
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001709
Nathan Fontenote81b3292012-10-02 16:55:01 +00001710 if (of_node_check_flag(np, OF_DETACHED)) {
1711 /* someone already detached it */
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001712 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001713 return rc;
Nathan Fontenote81b3292012-10-02 16:55:01 +00001714 }
1715
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001716 parent = np->parent;
Nathan Fontenote81b3292012-10-02 16:55:01 +00001717 if (!parent) {
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001718 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001719 return rc;
Nathan Fontenote81b3292012-10-02 16:55:01 +00001720 }
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001721
Randy Dunlap465aac62012-11-30 10:01:51 +00001722 if (of_allnodes == np)
1723 of_allnodes = np->allnext;
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001724 else {
1725 struct device_node *prev;
Randy Dunlap465aac62012-11-30 10:01:51 +00001726 for (prev = of_allnodes;
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001727 prev->allnext != np;
1728 prev = prev->allnext)
1729 ;
1730 prev->allnext = np->allnext;
1731 }
1732
1733 if (parent->child == np)
1734 parent->child = np->sibling;
1735 else {
1736 struct device_node *prevsib;
1737 for (prevsib = np->parent->child;
1738 prevsib->sibling != np;
1739 prevsib = prevsib->sibling)
1740 ;
1741 prevsib->sibling = np->sibling;
1742 }
1743
1744 of_node_set_flag(np, OF_DETACHED);
Thomas Gleixnerd6d3c4e2013-02-06 15:30:56 -05001745 raw_spin_unlock_irqrestore(&devtree_lock, flags);
Nathan Fontenote81b3292012-10-02 16:55:01 +00001746
1747 of_remove_proc_dt_entry(np);
Nathan Fontenot1cf3d8b2012-10-02 16:57:57 +00001748 return rc;
Grant Likelyfcdeb7f2010-01-29 05:04:33 -07001749}
1750#endif /* defined(CONFIG_OF_DYNAMIC) */
1751
Shawn Guo611cad72011-08-15 15:28:14 +08001752static void of_alias_add(struct alias_prop *ap, struct device_node *np,
1753 int id, const char *stem, int stem_len)
1754{
1755 ap->np = np;
1756 ap->id = id;
1757 strncpy(ap->stem, stem, stem_len);
1758 ap->stem[stem_len] = 0;
1759 list_add_tail(&ap->link, &aliases_lookup);
1760 pr_debug("adding DT alias:%s: stem=%s id=%i node=%s\n",
Grant Likely74a7f082012-06-15 11:50:25 -06001761 ap->alias, ap->stem, ap->id, of_node_full_name(np));
Shawn Guo611cad72011-08-15 15:28:14 +08001762}
1763
1764/**
1765 * of_alias_scan - Scan all properties of 'aliases' node
1766 *
1767 * The function scans all the properties of 'aliases' node and populate
1768 * the the global lookup table with the properties. It returns the
1769 * number of alias_prop found, or error code in error case.
1770 *
1771 * @dt_alloc: An allocator that provides a virtual address to memory
1772 * for the resulting tree
1773 */
1774void of_alias_scan(void * (*dt_alloc)(u64 size, u64 align))
1775{
1776 struct property *pp;
1777
1778 of_chosen = of_find_node_by_path("/chosen");
1779 if (of_chosen == NULL)
1780 of_chosen = of_find_node_by_path("/chosen@0");
Sascha Hauer5c19e952013-08-05 14:40:44 +02001781
1782 if (of_chosen) {
1783 const char *name;
1784
1785 name = of_get_property(of_chosen, "linux,stdout-path", NULL);
1786 if (name)
1787 of_stdout = of_find_node_by_path(name);
1788 }
1789
Shawn Guo611cad72011-08-15 15:28:14 +08001790 of_aliases = of_find_node_by_path("/aliases");
1791 if (!of_aliases)
1792 return;
1793
Dong Aisheng8af0da92011-12-22 20:19:24 +08001794 for_each_property_of_node(of_aliases, pp) {
Shawn Guo611cad72011-08-15 15:28:14 +08001795 const char *start = pp->name;
1796 const char *end = start + strlen(start);
1797 struct device_node *np;
1798 struct alias_prop *ap;
1799 int id, len;
1800
1801 /* Skip those we do not want to proceed */
1802 if (!strcmp(pp->name, "name") ||
1803 !strcmp(pp->name, "phandle") ||
1804 !strcmp(pp->name, "linux,phandle"))
1805 continue;
1806
1807 np = of_find_node_by_path(pp->value);
1808 if (!np)
1809 continue;
1810
1811 /* walk the alias backwards to extract the id and work out
1812 * the 'stem' string */
1813 while (isdigit(*(end-1)) && end > start)
1814 end--;
1815 len = end - start;
1816
1817 if (kstrtoint(end, 10, &id) < 0)
1818 continue;
1819
1820 /* Allocate an alias_prop with enough space for the stem */
1821 ap = dt_alloc(sizeof(*ap) + len + 1, 4);
1822 if (!ap)
1823 continue;
Grant Likely0640332e2013-08-28 21:24:17 +01001824 memset(ap, 0, sizeof(*ap) + len + 1);
Shawn Guo611cad72011-08-15 15:28:14 +08001825 ap->alias = start;
1826 of_alias_add(ap, np, id, start, len);
1827 }
1828}
1829
1830/**
1831 * of_alias_get_id - Get alias id for the given device_node
1832 * @np: Pointer to the given device_node
1833 * @stem: Alias stem of the given device_node
1834 *
1835 * The function travels the lookup table to get alias id for the given
1836 * device_node and alias stem. It returns the alias id if find it.
1837 */
1838int of_alias_get_id(struct device_node *np, const char *stem)
1839{
1840 struct alias_prop *app;
1841 int id = -ENODEV;
1842
1843 mutex_lock(&of_aliases_mutex);
1844 list_for_each_entry(app, &aliases_lookup, link) {
1845 if (strcmp(app->stem, stem) != 0)
1846 continue;
1847
1848 if (np == app->np) {
1849 id = app->id;
1850 break;
1851 }
1852 }
1853 mutex_unlock(&of_aliases_mutex);
1854
1855 return id;
1856}
1857EXPORT_SYMBOL_GPL(of_alias_get_id);
Stephen Warrenc541adc2012-04-04 09:27:46 -06001858
1859const __be32 *of_prop_next_u32(struct property *prop, const __be32 *cur,
1860 u32 *pu)
1861{
1862 const void *curv = cur;
1863
1864 if (!prop)
1865 return NULL;
1866
1867 if (!cur) {
1868 curv = prop->value;
1869 goto out_val;
1870 }
1871
1872 curv += sizeof(*cur);
1873 if (curv >= prop->value + prop->length)
1874 return NULL;
1875
1876out_val:
1877 *pu = be32_to_cpup(curv);
1878 return curv;
1879}
1880EXPORT_SYMBOL_GPL(of_prop_next_u32);
1881
1882const char *of_prop_next_string(struct property *prop, const char *cur)
1883{
1884 const void *curv = cur;
1885
1886 if (!prop)
1887 return NULL;
1888
1889 if (!cur)
1890 return prop->value;
1891
1892 curv += strlen(cur) + 1;
1893 if (curv >= prop->value + prop->length)
1894 return NULL;
1895
1896 return curv;
1897}
1898EXPORT_SYMBOL_GPL(of_prop_next_string);
Sascha Hauer5c19e952013-08-05 14:40:44 +02001899
1900/**
1901 * of_device_is_stdout_path - check if a device node matches the
1902 * linux,stdout-path property
1903 *
1904 * Check if this device node matches the linux,stdout-path property
1905 * in the chosen node. return true if yes, false otherwise.
1906 */
1907int of_device_is_stdout_path(struct device_node *dn)
1908{
1909 if (!of_stdout)
1910 return false;
1911
1912 return of_stdout == dn;
1913}
1914EXPORT_SYMBOL_GPL(of_device_is_stdout_path);
Sudeep KarkadaNageshaa3e31b42013-09-18 11:53:05 +01001915
1916/**
1917 * of_find_next_cache_node - Find a node's subsidiary cache
1918 * @np: node of type "cpu" or "cache"
1919 *
1920 * Returns a node pointer with refcount incremented, use
1921 * of_node_put() on it when done. Caller should hold a reference
1922 * to np.
1923 */
1924struct device_node *of_find_next_cache_node(const struct device_node *np)
1925{
1926 struct device_node *child;
1927 const phandle *handle;
1928
1929 handle = of_get_property(np, "l2-cache", NULL);
1930 if (!handle)
1931 handle = of_get_property(np, "next-level-cache", NULL);
1932
1933 if (handle)
1934 return of_find_node_by_phandle(be32_to_cpup(handle));
1935
1936 /* OF on pmac has nodes instead of properties named "l2-cache"
1937 * beneath CPU nodes.
1938 */
1939 if (!strcmp(np->type, "cpu"))
1940 for_each_child_of_node(np, child)
1941 if (!strcmp(child->type, "cache"))
1942 return child;
1943
1944 return NULL;
1945}