dm writecache: correct uncommitted_block when discarding uncommitted entry
[linux/fpc-iii.git] / drivers / of / property.c
blob6dc542af5a70fde21bd74f1a62743c1447def8da
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * drivers/of/property.c - Procedures for accessing and interpreting
4 * Devicetree properties and graphs.
6 * Initially created by copying procedures from drivers/of/base.c. This
7 * file contains the OF property as well as the OF graph interface
8 * functions.
10 * Paul Mackerras August 1996.
11 * Copyright (C) 1996-2005 Paul Mackerras.
13 * Adapted for 64bit PowerPC by Dave Engebretsen and Peter Bergner.
14 * {engebret|bergner}@us.ibm.com
16 * Adapted for sparc and sparc64 by David S. Miller davem@davemloft.net
18 * Reconsolidated from arch/x/kernel/prom.c by Stephen Rothwell and
19 * Grant Likely.
22 #define pr_fmt(fmt) "OF: " fmt
24 #include <linux/of.h>
25 #include <linux/of_device.h>
26 #include <linux/of_graph.h>
27 #include <linux/string.h>
28 #include <linux/moduleparam.h>
30 #include "of_private.h"
32 /**
33 * of_property_count_elems_of_size - Count the number of elements in a property
35 * @np: device node from which the property value is to be read.
36 * @propname: name of the property to be searched.
37 * @elem_size: size of the individual element
39 * Search for a property in a device node and count the number of elements of
40 * size elem_size in it. Returns number of elements on sucess, -EINVAL if the
41 * property does not exist or its length does not match a multiple of elem_size
42 * and -ENODATA if the property does not have a value.
44 int of_property_count_elems_of_size(const struct device_node *np,
45 const char *propname, int elem_size)
47 struct property *prop = of_find_property(np, propname, NULL);
49 if (!prop)
50 return -EINVAL;
51 if (!prop->value)
52 return -ENODATA;
54 if (prop->length % elem_size != 0) {
55 pr_err("size of %s in node %pOF is not a multiple of %d\n",
56 propname, np, elem_size);
57 return -EINVAL;
60 return prop->length / elem_size;
62 EXPORT_SYMBOL_GPL(of_property_count_elems_of_size);
64 /**
65 * of_find_property_value_of_size
67 * @np: device node from which the property value is to be read.
68 * @propname: name of the property to be searched.
69 * @min: minimum allowed length of property value
70 * @max: maximum allowed length of property value (0 means unlimited)
71 * @len: if !=NULL, actual length is written to here
73 * Search for a property in a device node and valid the requested size.
74 * Returns the property value on success, -EINVAL if the property does not
75 * exist, -ENODATA if property does not have a value, and -EOVERFLOW if the
76 * property data is too small or too large.
79 static void *of_find_property_value_of_size(const struct device_node *np,
80 const char *propname, u32 min, u32 max, size_t *len)
82 struct property *prop = of_find_property(np, propname, NULL);
84 if (!prop)
85 return ERR_PTR(-EINVAL);
86 if (!prop->value)
87 return ERR_PTR(-ENODATA);
88 if (prop->length < min)
89 return ERR_PTR(-EOVERFLOW);
90 if (max && prop->length > max)
91 return ERR_PTR(-EOVERFLOW);
93 if (len)
94 *len = prop->length;
96 return prop->value;
99 /**
100 * of_property_read_u32_index - Find and read a u32 from a multi-value property.
102 * @np: device node from which the property value is to be read.
103 * @propname: name of the property to be searched.
104 * @index: index of the u32 in the list of values
105 * @out_value: pointer to return value, modified only if no error.
107 * Search for a property in a device node and read nth 32-bit value from
108 * it. Returns 0 on success, -EINVAL if the property does not exist,
109 * -ENODATA if property does not have a value, and -EOVERFLOW if the
110 * property data isn't large enough.
112 * The out_value is modified only if a valid u32 value can be decoded.
114 int of_property_read_u32_index(const struct device_node *np,
115 const char *propname,
116 u32 index, u32 *out_value)
118 const u32 *val = of_find_property_value_of_size(np, propname,
119 ((index + 1) * sizeof(*out_value)),
121 NULL);
123 if (IS_ERR(val))
124 return PTR_ERR(val);
126 *out_value = be32_to_cpup(((__be32 *)val) + index);
127 return 0;
129 EXPORT_SYMBOL_GPL(of_property_read_u32_index);
132 * of_property_read_u64_index - Find and read a u64 from a multi-value property.
134 * @np: device node from which the property value is to be read.
135 * @propname: name of the property to be searched.
136 * @index: index of the u64 in the list of values
137 * @out_value: pointer to return value, modified only if no error.
139 * Search for a property in a device node and read nth 64-bit value from
140 * it. Returns 0 on success, -EINVAL if the property does not exist,
141 * -ENODATA if property does not have a value, and -EOVERFLOW if the
142 * property data isn't large enough.
144 * The out_value is modified only if a valid u64 value can be decoded.
146 int of_property_read_u64_index(const struct device_node *np,
147 const char *propname,
148 u32 index, u64 *out_value)
150 const u64 *val = of_find_property_value_of_size(np, propname,
151 ((index + 1) * sizeof(*out_value)),
152 0, NULL);
154 if (IS_ERR(val))
155 return PTR_ERR(val);
157 *out_value = be64_to_cpup(((__be64 *)val) + index);
158 return 0;
160 EXPORT_SYMBOL_GPL(of_property_read_u64_index);
163 * of_property_read_variable_u8_array - Find and read an array of u8 from a
164 * property, with bounds on the minimum and maximum array size.
166 * @np: device node from which the property value is to be read.
167 * @propname: name of the property to be searched.
168 * @out_values: pointer to found values.
169 * @sz_min: minimum number of array elements to read
170 * @sz_max: maximum number of array elements to read, if zero there is no
171 * upper limit on the number of elements in the dts entry but only
172 * sz_min will be read.
174 * Search for a property in a device node and read 8-bit value(s) from
175 * it. Returns number of elements read on success, -EINVAL if the property
176 * does not exist, -ENODATA if property does not have a value, and -EOVERFLOW
177 * if the property data is smaller than sz_min or longer than sz_max.
179 * dts entry of array should be like:
180 * property = /bits/ 8 <0x50 0x60 0x70>;
182 * The out_values is modified only if a valid u8 value can be decoded.
184 int of_property_read_variable_u8_array(const struct device_node *np,
185 const char *propname, u8 *out_values,
186 size_t sz_min, size_t sz_max)
188 size_t sz, count;
189 const u8 *val = of_find_property_value_of_size(np, propname,
190 (sz_min * sizeof(*out_values)),
191 (sz_max * sizeof(*out_values)),
192 &sz);
194 if (IS_ERR(val))
195 return PTR_ERR(val);
197 if (!sz_max)
198 sz = sz_min;
199 else
200 sz /= sizeof(*out_values);
202 count = sz;
203 while (count--)
204 *out_values++ = *val++;
206 return sz;
208 EXPORT_SYMBOL_GPL(of_property_read_variable_u8_array);
211 * of_property_read_variable_u16_array - Find and read an array of u16 from a
212 * property, with bounds on the minimum and maximum array size.
214 * @np: device node from which the property value is to be read.
215 * @propname: name of the property to be searched.
216 * @out_values: pointer to found values.
217 * @sz_min: minimum number of array elements to read
218 * @sz_max: maximum number of array elements to read, if zero there is no
219 * upper limit on the number of elements in the dts entry but only
220 * sz_min will be read.
222 * Search for a property in a device node and read 16-bit value(s) from
223 * it. Returns number of elements read on success, -EINVAL if the property
224 * does not exist, -ENODATA if property does not have a value, and -EOVERFLOW
225 * if the property data is smaller than sz_min or longer than sz_max.
227 * dts entry of array should be like:
228 * property = /bits/ 16 <0x5000 0x6000 0x7000>;
230 * The out_values is modified only if a valid u16 value can be decoded.
232 int of_property_read_variable_u16_array(const struct device_node *np,
233 const char *propname, u16 *out_values,
234 size_t sz_min, size_t sz_max)
236 size_t sz, count;
237 const __be16 *val = of_find_property_value_of_size(np, propname,
238 (sz_min * sizeof(*out_values)),
239 (sz_max * sizeof(*out_values)),
240 &sz);
242 if (IS_ERR(val))
243 return PTR_ERR(val);
245 if (!sz_max)
246 sz = sz_min;
247 else
248 sz /= sizeof(*out_values);
250 count = sz;
251 while (count--)
252 *out_values++ = be16_to_cpup(val++);
254 return sz;
256 EXPORT_SYMBOL_GPL(of_property_read_variable_u16_array);
259 * of_property_read_variable_u32_array - Find and read an array of 32 bit
260 * integers from a property, with bounds on the minimum and maximum array size.
262 * @np: device node from which the property value is to be read.
263 * @propname: name of the property to be searched.
264 * @out_values: pointer to return found values.
265 * @sz_min: minimum number of array elements to read
266 * @sz_max: maximum number of array elements to read, if zero there is no
267 * upper limit on the number of elements in the dts entry but only
268 * sz_min will be read.
270 * Search for a property in a device node and read 32-bit value(s) from
271 * it. Returns number of elements read on success, -EINVAL if the property
272 * does not exist, -ENODATA if property does not have a value, and -EOVERFLOW
273 * if the property data is smaller than sz_min or longer than sz_max.
275 * The out_values is modified only if a valid u32 value can be decoded.
277 int of_property_read_variable_u32_array(const struct device_node *np,
278 const char *propname, u32 *out_values,
279 size_t sz_min, size_t sz_max)
281 size_t sz, count;
282 const __be32 *val = of_find_property_value_of_size(np, propname,
283 (sz_min * sizeof(*out_values)),
284 (sz_max * sizeof(*out_values)),
285 &sz);
287 if (IS_ERR(val))
288 return PTR_ERR(val);
290 if (!sz_max)
291 sz = sz_min;
292 else
293 sz /= sizeof(*out_values);
295 count = sz;
296 while (count--)
297 *out_values++ = be32_to_cpup(val++);
299 return sz;
301 EXPORT_SYMBOL_GPL(of_property_read_variable_u32_array);
304 * of_property_read_u64 - Find and read a 64 bit integer from a property
305 * @np: device node from which the property value is to be read.
306 * @propname: name of the property to be searched.
307 * @out_value: pointer to return value, modified only if return value is 0.
309 * Search for a property in a device node and read a 64-bit value from
310 * it. Returns 0 on success, -EINVAL if the property does not exist,
311 * -ENODATA if property does not have a value, and -EOVERFLOW if the
312 * property data isn't large enough.
314 * The out_value is modified only if a valid u64 value can be decoded.
316 int of_property_read_u64(const struct device_node *np, const char *propname,
317 u64 *out_value)
319 const __be32 *val = of_find_property_value_of_size(np, propname,
320 sizeof(*out_value),
322 NULL);
324 if (IS_ERR(val))
325 return PTR_ERR(val);
327 *out_value = of_read_number(val, 2);
328 return 0;
330 EXPORT_SYMBOL_GPL(of_property_read_u64);
333 * of_property_read_variable_u64_array - Find and read an array of 64 bit
334 * integers from a property, with bounds on the minimum and maximum array size.
336 * @np: device node from which the property value is to be read.
337 * @propname: name of the property to be searched.
338 * @out_values: pointer to found values.
339 * @sz_min: minimum number of array elements to read
340 * @sz_max: maximum number of array elements to read, if zero there is no
341 * upper limit on the number of elements in the dts entry but only
342 * sz_min will be read.
344 * Search for a property in a device node and read 64-bit value(s) from
345 * it. Returns number of elements read on success, -EINVAL if the property
346 * does not exist, -ENODATA if property does not have a value, and -EOVERFLOW
347 * if the property data is smaller than sz_min or longer than sz_max.
349 * The out_values is modified only if a valid u64 value can be decoded.
351 int of_property_read_variable_u64_array(const struct device_node *np,
352 const char *propname, u64 *out_values,
353 size_t sz_min, size_t sz_max)
355 size_t sz, count;
356 const __be32 *val = of_find_property_value_of_size(np, propname,
357 (sz_min * sizeof(*out_values)),
358 (sz_max * sizeof(*out_values)),
359 &sz);
361 if (IS_ERR(val))
362 return PTR_ERR(val);
364 if (!sz_max)
365 sz = sz_min;
366 else
367 sz /= sizeof(*out_values);
369 count = sz;
370 while (count--) {
371 *out_values++ = of_read_number(val, 2);
372 val += 2;
375 return sz;
377 EXPORT_SYMBOL_GPL(of_property_read_variable_u64_array);
380 * of_property_read_string - Find and read a string from a property
381 * @np: device node from which the property value is to be read.
382 * @propname: name of the property to be searched.
383 * @out_string: pointer to null terminated return string, modified only if
384 * return value is 0.
386 * Search for a property in a device tree node and retrieve a null
387 * terminated string value (pointer to data, not a copy). Returns 0 on
388 * success, -EINVAL if the property does not exist, -ENODATA if property
389 * does not have a value, and -EILSEQ if the string is not null-terminated
390 * within the length of the property data.
392 * The out_string pointer is modified only if a valid string can be decoded.
394 int of_property_read_string(const struct device_node *np, const char *propname,
395 const char **out_string)
397 const struct property *prop = of_find_property(np, propname, NULL);
398 if (!prop)
399 return -EINVAL;
400 if (!prop->value)
401 return -ENODATA;
402 if (strnlen(prop->value, prop->length) >= prop->length)
403 return -EILSEQ;
404 *out_string = prop->value;
405 return 0;
407 EXPORT_SYMBOL_GPL(of_property_read_string);
410 * of_property_match_string() - Find string in a list and return index
411 * @np: pointer to node containing string list property
412 * @propname: string list property name
413 * @string: pointer to string to search for in string list
415 * This function searches a string list property and returns the index
416 * of a specific string value.
418 int of_property_match_string(const struct device_node *np, const char *propname,
419 const char *string)
421 const struct property *prop = of_find_property(np, propname, NULL);
422 size_t l;
423 int i;
424 const char *p, *end;
426 if (!prop)
427 return -EINVAL;
428 if (!prop->value)
429 return -ENODATA;
431 p = prop->value;
432 end = p + prop->length;
434 for (i = 0; p < end; i++, p += l) {
435 l = strnlen(p, end - p) + 1;
436 if (p + l > end)
437 return -EILSEQ;
438 pr_debug("comparing %s with %s\n", string, p);
439 if (strcmp(string, p) == 0)
440 return i; /* Found it; return index */
442 return -ENODATA;
444 EXPORT_SYMBOL_GPL(of_property_match_string);
447 * of_property_read_string_helper() - Utility helper for parsing string properties
448 * @np: device node from which the property value is to be read.
449 * @propname: name of the property to be searched.
450 * @out_strs: output array of string pointers.
451 * @sz: number of array elements to read.
452 * @skip: Number of strings to skip over at beginning of list.
454 * Don't call this function directly. It is a utility helper for the
455 * of_property_read_string*() family of functions.
457 int of_property_read_string_helper(const struct device_node *np,
458 const char *propname, const char **out_strs,
459 size_t sz, int skip)
461 const struct property *prop = of_find_property(np, propname, NULL);
462 int l = 0, i = 0;
463 const char *p, *end;
465 if (!prop)
466 return -EINVAL;
467 if (!prop->value)
468 return -ENODATA;
469 p = prop->value;
470 end = p + prop->length;
472 for (i = 0; p < end && (!out_strs || i < skip + sz); i++, p += l) {
473 l = strnlen(p, end - p) + 1;
474 if (p + l > end)
475 return -EILSEQ;
476 if (out_strs && i >= skip)
477 *out_strs++ = p;
479 i -= skip;
480 return i <= 0 ? -ENODATA : i;
482 EXPORT_SYMBOL_GPL(of_property_read_string_helper);
484 const __be32 *of_prop_next_u32(struct property *prop, const __be32 *cur,
485 u32 *pu)
487 const void *curv = cur;
489 if (!prop)
490 return NULL;
492 if (!cur) {
493 curv = prop->value;
494 goto out_val;
497 curv += sizeof(*cur);
498 if (curv >= prop->value + prop->length)
499 return NULL;
501 out_val:
502 *pu = be32_to_cpup(curv);
503 return curv;
505 EXPORT_SYMBOL_GPL(of_prop_next_u32);
507 const char *of_prop_next_string(struct property *prop, const char *cur)
509 const void *curv = cur;
511 if (!prop)
512 return NULL;
514 if (!cur)
515 return prop->value;
517 curv += strlen(cur) + 1;
518 if (curv >= prop->value + prop->length)
519 return NULL;
521 return curv;
523 EXPORT_SYMBOL_GPL(of_prop_next_string);
526 * of_graph_parse_endpoint() - parse common endpoint node properties
527 * @node: pointer to endpoint device_node
528 * @endpoint: pointer to the OF endpoint data structure
530 * The caller should hold a reference to @node.
532 int of_graph_parse_endpoint(const struct device_node *node,
533 struct of_endpoint *endpoint)
535 struct device_node *port_node = of_get_parent(node);
537 WARN_ONCE(!port_node, "%s(): endpoint %pOF has no parent node\n",
538 __func__, node);
540 memset(endpoint, 0, sizeof(*endpoint));
542 endpoint->local_node = node;
544 * It doesn't matter whether the two calls below succeed.
545 * If they don't then the default value 0 is used.
547 of_property_read_u32(port_node, "reg", &endpoint->port);
548 of_property_read_u32(node, "reg", &endpoint->id);
550 of_node_put(port_node);
552 return 0;
554 EXPORT_SYMBOL(of_graph_parse_endpoint);
557 * of_graph_get_port_by_id() - get the port matching a given id
558 * @parent: pointer to the parent device node
559 * @id: id of the port
561 * Return: A 'port' node pointer with refcount incremented. The caller
562 * has to use of_node_put() on it when done.
564 struct device_node *of_graph_get_port_by_id(struct device_node *parent, u32 id)
566 struct device_node *node, *port;
568 node = of_get_child_by_name(parent, "ports");
569 if (node)
570 parent = node;
572 for_each_child_of_node(parent, port) {
573 u32 port_id = 0;
575 if (!of_node_name_eq(port, "port"))
576 continue;
577 of_property_read_u32(port, "reg", &port_id);
578 if (id == port_id)
579 break;
582 of_node_put(node);
584 return port;
586 EXPORT_SYMBOL(of_graph_get_port_by_id);
589 * of_graph_get_next_endpoint() - get next endpoint node
590 * @parent: pointer to the parent device node
591 * @prev: previous endpoint node, or NULL to get first
593 * Return: An 'endpoint' node pointer with refcount incremented. Refcount
594 * of the passed @prev node is decremented.
596 struct device_node *of_graph_get_next_endpoint(const struct device_node *parent,
597 struct device_node *prev)
599 struct device_node *endpoint;
600 struct device_node *port;
602 if (!parent)
603 return NULL;
606 * Start by locating the port node. If no previous endpoint is specified
607 * search for the first port node, otherwise get the previous endpoint
608 * parent port node.
610 if (!prev) {
611 struct device_node *node;
613 node = of_get_child_by_name(parent, "ports");
614 if (node)
615 parent = node;
617 port = of_get_child_by_name(parent, "port");
618 of_node_put(node);
620 if (!port) {
621 pr_err("graph: no port node found in %pOF\n", parent);
622 return NULL;
624 } else {
625 port = of_get_parent(prev);
626 if (WARN_ONCE(!port, "%s(): endpoint %pOF has no parent node\n",
627 __func__, prev))
628 return NULL;
631 while (1) {
633 * Now that we have a port node, get the next endpoint by
634 * getting the next child. If the previous endpoint is NULL this
635 * will return the first child.
637 endpoint = of_get_next_child(port, prev);
638 if (endpoint) {
639 of_node_put(port);
640 return endpoint;
643 /* No more endpoints under this port, try the next one. */
644 prev = NULL;
646 do {
647 port = of_get_next_child(parent, port);
648 if (!port)
649 return NULL;
650 } while (!of_node_name_eq(port, "port"));
653 EXPORT_SYMBOL(of_graph_get_next_endpoint);
656 * of_graph_get_endpoint_by_regs() - get endpoint node of specific identifiers
657 * @parent: pointer to the parent device node
658 * @port_reg: identifier (value of reg property) of the parent port node
659 * @reg: identifier (value of reg property) of the endpoint node
661 * Return: An 'endpoint' node pointer which is identified by reg and at the same
662 * is the child of a port node identified by port_reg. reg and port_reg are
663 * ignored when they are -1. Use of_node_put() on the pointer when done.
665 struct device_node *of_graph_get_endpoint_by_regs(
666 const struct device_node *parent, int port_reg, int reg)
668 struct of_endpoint endpoint;
669 struct device_node *node = NULL;
671 for_each_endpoint_of_node(parent, node) {
672 of_graph_parse_endpoint(node, &endpoint);
673 if (((port_reg == -1) || (endpoint.port == port_reg)) &&
674 ((reg == -1) || (endpoint.id == reg)))
675 return node;
678 return NULL;
680 EXPORT_SYMBOL(of_graph_get_endpoint_by_regs);
683 * of_graph_get_remote_endpoint() - get remote endpoint node
684 * @node: pointer to a local endpoint device_node
686 * Return: Remote endpoint node associated with remote endpoint node linked
687 * to @node. Use of_node_put() on it when done.
689 struct device_node *of_graph_get_remote_endpoint(const struct device_node *node)
691 /* Get remote endpoint node. */
692 return of_parse_phandle(node, "remote-endpoint", 0);
694 EXPORT_SYMBOL(of_graph_get_remote_endpoint);
697 * of_graph_get_port_parent() - get port's parent node
698 * @node: pointer to a local endpoint device_node
700 * Return: device node associated with endpoint node linked
701 * to @node. Use of_node_put() on it when done.
703 struct device_node *of_graph_get_port_parent(struct device_node *node)
705 unsigned int depth;
707 if (!node)
708 return NULL;
711 * Preserve usecount for passed in node as of_get_next_parent()
712 * will do of_node_put() on it.
714 of_node_get(node);
716 /* Walk 3 levels up only if there is 'ports' node. */
717 for (depth = 3; depth && node; depth--) {
718 node = of_get_next_parent(node);
719 if (depth == 2 && !of_node_name_eq(node, "ports"))
720 break;
722 return node;
724 EXPORT_SYMBOL(of_graph_get_port_parent);
727 * of_graph_get_remote_port_parent() - get remote port's parent node
728 * @node: pointer to a local endpoint device_node
730 * Return: Remote device node associated with remote endpoint node linked
731 * to @node. Use of_node_put() on it when done.
733 struct device_node *of_graph_get_remote_port_parent(
734 const struct device_node *node)
736 struct device_node *np, *pp;
738 /* Get remote endpoint node. */
739 np = of_graph_get_remote_endpoint(node);
741 pp = of_graph_get_port_parent(np);
743 of_node_put(np);
745 return pp;
747 EXPORT_SYMBOL(of_graph_get_remote_port_parent);
750 * of_graph_get_remote_port() - get remote port node
751 * @node: pointer to a local endpoint device_node
753 * Return: Remote port node associated with remote endpoint node linked
754 * to @node. Use of_node_put() on it when done.
756 struct device_node *of_graph_get_remote_port(const struct device_node *node)
758 struct device_node *np;
760 /* Get remote endpoint node. */
761 np = of_graph_get_remote_endpoint(node);
762 if (!np)
763 return NULL;
764 return of_get_next_parent(np);
766 EXPORT_SYMBOL(of_graph_get_remote_port);
768 int of_graph_get_endpoint_count(const struct device_node *np)
770 struct device_node *endpoint;
771 int num = 0;
773 for_each_endpoint_of_node(np, endpoint)
774 num++;
776 return num;
778 EXPORT_SYMBOL(of_graph_get_endpoint_count);
781 * of_graph_get_remote_node() - get remote parent device_node for given port/endpoint
782 * @node: pointer to parent device_node containing graph port/endpoint
783 * @port: identifier (value of reg property) of the parent port node
784 * @endpoint: identifier (value of reg property) of the endpoint node
786 * Return: Remote device node associated with remote endpoint node linked
787 * to @node. Use of_node_put() on it when done.
789 struct device_node *of_graph_get_remote_node(const struct device_node *node,
790 u32 port, u32 endpoint)
792 struct device_node *endpoint_node, *remote;
794 endpoint_node = of_graph_get_endpoint_by_regs(node, port, endpoint);
795 if (!endpoint_node) {
796 pr_debug("no valid endpoint (%d, %d) for node %pOF\n",
797 port, endpoint, node);
798 return NULL;
801 remote = of_graph_get_remote_port_parent(endpoint_node);
802 of_node_put(endpoint_node);
803 if (!remote) {
804 pr_debug("no valid remote node\n");
805 return NULL;
808 if (!of_device_is_available(remote)) {
809 pr_debug("not available for remote node\n");
810 of_node_put(remote);
811 return NULL;
814 return remote;
816 EXPORT_SYMBOL(of_graph_get_remote_node);
818 static struct fwnode_handle *of_fwnode_get(struct fwnode_handle *fwnode)
820 return of_fwnode_handle(of_node_get(to_of_node(fwnode)));
823 static void of_fwnode_put(struct fwnode_handle *fwnode)
825 of_node_put(to_of_node(fwnode));
828 static bool of_fwnode_device_is_available(const struct fwnode_handle *fwnode)
830 return of_device_is_available(to_of_node(fwnode));
833 static bool of_fwnode_property_present(const struct fwnode_handle *fwnode,
834 const char *propname)
836 return of_property_read_bool(to_of_node(fwnode), propname);
839 static int of_fwnode_property_read_int_array(const struct fwnode_handle *fwnode,
840 const char *propname,
841 unsigned int elem_size, void *val,
842 size_t nval)
844 const struct device_node *node = to_of_node(fwnode);
846 if (!val)
847 return of_property_count_elems_of_size(node, propname,
848 elem_size);
850 switch (elem_size) {
851 case sizeof(u8):
852 return of_property_read_u8_array(node, propname, val, nval);
853 case sizeof(u16):
854 return of_property_read_u16_array(node, propname, val, nval);
855 case sizeof(u32):
856 return of_property_read_u32_array(node, propname, val, nval);
857 case sizeof(u64):
858 return of_property_read_u64_array(node, propname, val, nval);
861 return -ENXIO;
864 static int
865 of_fwnode_property_read_string_array(const struct fwnode_handle *fwnode,
866 const char *propname, const char **val,
867 size_t nval)
869 const struct device_node *node = to_of_node(fwnode);
871 return val ?
872 of_property_read_string_array(node, propname, val, nval) :
873 of_property_count_strings(node, propname);
876 static const char *of_fwnode_get_name(const struct fwnode_handle *fwnode)
878 return kbasename(to_of_node(fwnode)->full_name);
881 static const char *of_fwnode_get_name_prefix(const struct fwnode_handle *fwnode)
883 /* Root needs no prefix here (its name is "/"). */
884 if (!to_of_node(fwnode)->parent)
885 return "";
887 return "/";
890 static struct fwnode_handle *
891 of_fwnode_get_parent(const struct fwnode_handle *fwnode)
893 return of_fwnode_handle(of_get_parent(to_of_node(fwnode)));
896 static struct fwnode_handle *
897 of_fwnode_get_next_child_node(const struct fwnode_handle *fwnode,
898 struct fwnode_handle *child)
900 return of_fwnode_handle(of_get_next_available_child(to_of_node(fwnode),
901 to_of_node(child)));
904 static struct fwnode_handle *
905 of_fwnode_get_named_child_node(const struct fwnode_handle *fwnode,
906 const char *childname)
908 const struct device_node *node = to_of_node(fwnode);
909 struct device_node *child;
911 for_each_available_child_of_node(node, child)
912 if (of_node_name_eq(child, childname))
913 return of_fwnode_handle(child);
915 return NULL;
918 static int
919 of_fwnode_get_reference_args(const struct fwnode_handle *fwnode,
920 const char *prop, const char *nargs_prop,
921 unsigned int nargs, unsigned int index,
922 struct fwnode_reference_args *args)
924 struct of_phandle_args of_args;
925 unsigned int i;
926 int ret;
928 if (nargs_prop)
929 ret = of_parse_phandle_with_args(to_of_node(fwnode), prop,
930 nargs_prop, index, &of_args);
931 else
932 ret = of_parse_phandle_with_fixed_args(to_of_node(fwnode), prop,
933 nargs, index, &of_args);
934 if (ret < 0)
935 return ret;
936 if (!args)
937 return 0;
939 args->nargs = of_args.args_count;
940 args->fwnode = of_fwnode_handle(of_args.np);
942 for (i = 0; i < NR_FWNODE_REFERENCE_ARGS; i++)
943 args->args[i] = i < of_args.args_count ? of_args.args[i] : 0;
945 return 0;
948 static struct fwnode_handle *
949 of_fwnode_graph_get_next_endpoint(const struct fwnode_handle *fwnode,
950 struct fwnode_handle *prev)
952 return of_fwnode_handle(of_graph_get_next_endpoint(to_of_node(fwnode),
953 to_of_node(prev)));
956 static struct fwnode_handle *
957 of_fwnode_graph_get_remote_endpoint(const struct fwnode_handle *fwnode)
959 return of_fwnode_handle(
960 of_graph_get_remote_endpoint(to_of_node(fwnode)));
963 static struct fwnode_handle *
964 of_fwnode_graph_get_port_parent(struct fwnode_handle *fwnode)
966 struct device_node *np;
968 /* Get the parent of the port */
969 np = of_get_parent(to_of_node(fwnode));
970 if (!np)
971 return NULL;
973 /* Is this the "ports" node? If not, it's the port parent. */
974 if (!of_node_name_eq(np, "ports"))
975 return of_fwnode_handle(np);
977 return of_fwnode_handle(of_get_next_parent(np));
980 static int of_fwnode_graph_parse_endpoint(const struct fwnode_handle *fwnode,
981 struct fwnode_endpoint *endpoint)
983 const struct device_node *node = to_of_node(fwnode);
984 struct device_node *port_node = of_get_parent(node);
986 endpoint->local_fwnode = fwnode;
988 of_property_read_u32(port_node, "reg", &endpoint->port);
989 of_property_read_u32(node, "reg", &endpoint->id);
991 of_node_put(port_node);
993 return 0;
996 static const void *
997 of_fwnode_device_get_match_data(const struct fwnode_handle *fwnode,
998 const struct device *dev)
1000 return of_device_get_match_data(dev);
1003 static bool of_is_ancestor_of(struct device_node *test_ancestor,
1004 struct device_node *child)
1006 of_node_get(child);
1007 while (child) {
1008 if (child == test_ancestor) {
1009 of_node_put(child);
1010 return true;
1012 child = of_get_next_parent(child);
1014 return false;
1018 * of_link_to_phandle - Add device link to supplier from supplier phandle
1019 * @dev: consumer device
1020 * @sup_np: phandle to supplier device tree node
1022 * Given a phandle to a supplier device tree node (@sup_np), this function
1023 * finds the device that owns the supplier device tree node and creates a
1024 * device link from @dev consumer device to the supplier device. This function
1025 * doesn't create device links for invalid scenarios such as trying to create a
1026 * link with a parent device as the consumer of its child device. In such
1027 * cases, it returns an error.
1029 * Returns:
1030 * - 0 if link successfully created to supplier
1031 * - -EAGAIN if linking to the supplier should be reattempted
1032 * - -EINVAL if the supplier link is invalid and should not be created
1033 * - -ENODEV if there is no device that corresponds to the supplier phandle
1035 static int of_link_to_phandle(struct device *dev, struct device_node *sup_np,
1036 u32 dl_flags)
1038 struct device *sup_dev;
1039 int ret = 0;
1040 struct device_node *tmp_np = sup_np;
1041 int is_populated;
1043 of_node_get(sup_np);
1045 * Find the device node that contains the supplier phandle. It may be
1046 * @sup_np or it may be an ancestor of @sup_np.
1048 while (sup_np) {
1050 /* Don't allow linking to a disabled supplier */
1051 if (!of_device_is_available(sup_np)) {
1052 of_node_put(sup_np);
1053 sup_np = NULL;
1056 if (of_find_property(sup_np, "compatible", NULL))
1057 break;
1059 sup_np = of_get_next_parent(sup_np);
1062 if (!sup_np) {
1063 dev_dbg(dev, "Not linking to %pOFP - No device\n", tmp_np);
1064 return -ENODEV;
1068 * Don't allow linking a device node as a consumer of one of its
1069 * descendant nodes. By definition, a child node can't be a functional
1070 * dependency for the parent node.
1072 if (of_is_ancestor_of(dev->of_node, sup_np)) {
1073 dev_dbg(dev, "Not linking to %pOFP - is descendant\n", sup_np);
1074 of_node_put(sup_np);
1075 return -EINVAL;
1077 sup_dev = get_dev_from_fwnode(&sup_np->fwnode);
1078 is_populated = of_node_check_flag(sup_np, OF_POPULATED);
1079 of_node_put(sup_np);
1080 if (!sup_dev && is_populated) {
1081 /* Early device without struct device. */
1082 dev_dbg(dev, "Not linking to %pOFP - No struct device\n",
1083 sup_np);
1084 return -ENODEV;
1085 } else if (!sup_dev) {
1086 return -EAGAIN;
1088 if (!device_link_add(dev, sup_dev, dl_flags))
1089 ret = -EAGAIN;
1090 put_device(sup_dev);
1091 return ret;
1095 * parse_prop_cells - Property parsing function for suppliers
1097 * @np: Pointer to device tree node containing a list
1098 * @prop_name: Name of property to be parsed. Expected to hold phandle values
1099 * @index: For properties holding a list of phandles, this is the index
1100 * into the list.
1101 * @list_name: Property name that is known to contain list of phandle(s) to
1102 * supplier(s)
1103 * @cells_name: property name that specifies phandles' arguments count
1105 * This is a helper function to parse properties that have a known fixed name
1106 * and are a list of phandles and phandle arguments.
1108 * Returns:
1109 * - phandle node pointer with refcount incremented. Caller must of_node_put()
1110 * on it when done.
1111 * - NULL if no phandle found at index
1113 static struct device_node *parse_prop_cells(struct device_node *np,
1114 const char *prop_name, int index,
1115 const char *list_name,
1116 const char *cells_name)
1118 struct of_phandle_args sup_args;
1120 if (strcmp(prop_name, list_name))
1121 return NULL;
1123 if (of_parse_phandle_with_args(np, list_name, cells_name, index,
1124 &sup_args))
1125 return NULL;
1127 return sup_args.np;
1130 #define DEFINE_SIMPLE_PROP(fname, name, cells) \
1131 static struct device_node *parse_##fname(struct device_node *np, \
1132 const char *prop_name, int index) \
1134 return parse_prop_cells(np, prop_name, index, name, cells); \
1137 static int strcmp_suffix(const char *str, const char *suffix)
1139 unsigned int len, suffix_len;
1141 len = strlen(str);
1142 suffix_len = strlen(suffix);
1143 if (len <= suffix_len)
1144 return -1;
1145 return strcmp(str + len - suffix_len, suffix);
1149 * parse_suffix_prop_cells - Suffix property parsing function for suppliers
1151 * @np: Pointer to device tree node containing a list
1152 * @prop_name: Name of property to be parsed. Expected to hold phandle values
1153 * @index: For properties holding a list of phandles, this is the index
1154 * into the list.
1155 * @suffix: Property suffix that is known to contain list of phandle(s) to
1156 * supplier(s)
1157 * @cells_name: property name that specifies phandles' arguments count
1159 * This is a helper function to parse properties that have a known fixed suffix
1160 * and are a list of phandles and phandle arguments.
1162 * Returns:
1163 * - phandle node pointer with refcount incremented. Caller must of_node_put()
1164 * on it when done.
1165 * - NULL if no phandle found at index
1167 static struct device_node *parse_suffix_prop_cells(struct device_node *np,
1168 const char *prop_name, int index,
1169 const char *suffix,
1170 const char *cells_name)
1172 struct of_phandle_args sup_args;
1174 if (strcmp_suffix(prop_name, suffix))
1175 return NULL;
1177 if (of_parse_phandle_with_args(np, prop_name, cells_name, index,
1178 &sup_args))
1179 return NULL;
1181 return sup_args.np;
1184 #define DEFINE_SUFFIX_PROP(fname, suffix, cells) \
1185 static struct device_node *parse_##fname(struct device_node *np, \
1186 const char *prop_name, int index) \
1188 return parse_suffix_prop_cells(np, prop_name, index, suffix, cells); \
1192 * struct supplier_bindings - Property parsing functions for suppliers
1194 * @parse_prop: function name
1195 * parse_prop() finds the node corresponding to a supplier phandle
1196 * @parse_prop.np: Pointer to device node holding supplier phandle property
1197 * @parse_prop.prop_name: Name of property holding a phandle value
1198 * @parse_prop.index: For properties holding a list of phandles, this is the
1199 * index into the list
1201 * Returns:
1202 * parse_prop() return values are
1203 * - phandle node pointer with refcount incremented. Caller must of_node_put()
1204 * on it when done.
1205 * - NULL if no phandle found at index
1207 struct supplier_bindings {
1208 struct device_node *(*parse_prop)(struct device_node *np,
1209 const char *prop_name, int index);
1212 DEFINE_SIMPLE_PROP(clocks, "clocks", "#clock-cells")
1213 DEFINE_SIMPLE_PROP(interconnects, "interconnects", "#interconnect-cells")
1214 DEFINE_SIMPLE_PROP(iommus, "iommus", "#iommu-cells")
1215 DEFINE_SIMPLE_PROP(mboxes, "mboxes", "#mbox-cells")
1216 DEFINE_SIMPLE_PROP(io_channels, "io-channel", "#io-channel-cells")
1217 DEFINE_SIMPLE_PROP(interrupt_parent, "interrupt-parent", NULL)
1218 DEFINE_SIMPLE_PROP(dmas, "dmas", "#dma-cells")
1219 DEFINE_SIMPLE_PROP(power_domains, "power-domains", "#power-domain-cells")
1220 DEFINE_SIMPLE_PROP(hwlocks, "hwlocks", "#hwlock-cells")
1221 DEFINE_SUFFIX_PROP(regulators, "-supply", NULL)
1222 DEFINE_SUFFIX_PROP(gpio, "-gpio", "#gpio-cells")
1223 DEFINE_SUFFIX_PROP(gpios, "-gpios", "#gpio-cells")
1225 static struct device_node *parse_iommu_maps(struct device_node *np,
1226 const char *prop_name, int index)
1228 if (strcmp(prop_name, "iommu-map"))
1229 return NULL;
1231 return of_parse_phandle(np, prop_name, (index * 4) + 1);
1234 static const struct supplier_bindings of_supplier_bindings[] = {
1235 { .parse_prop = parse_clocks, },
1236 { .parse_prop = parse_interconnects, },
1237 { .parse_prop = parse_iommus, },
1238 { .parse_prop = parse_iommu_maps, },
1239 { .parse_prop = parse_mboxes, },
1240 { .parse_prop = parse_io_channels, },
1241 { .parse_prop = parse_interrupt_parent, },
1242 { .parse_prop = parse_dmas, },
1243 { .parse_prop = parse_power_domains, },
1244 { .parse_prop = parse_hwlocks, },
1245 { .parse_prop = parse_regulators, },
1246 { .parse_prop = parse_gpio, },
1247 { .parse_prop = parse_gpios, },
1252 * of_link_property - Create device links to suppliers listed in a property
1253 * @dev: Consumer device
1254 * @con_np: The consumer device tree node which contains the property
1255 * @prop_name: Name of property to be parsed
1257 * This function checks if the property @prop_name that is present in the
1258 * @con_np device tree node is one of the known common device tree bindings
1259 * that list phandles to suppliers. If @prop_name isn't one, this function
1260 * doesn't do anything.
1262 * If @prop_name is one, this function attempts to create device links from the
1263 * consumer device @dev to all the devices of the suppliers listed in
1264 * @prop_name.
1266 * Any failed attempt to create a device link will NOT result in an immediate
1267 * return. of_link_property() must create links to all the available supplier
1268 * devices even when attempts to create a link to one or more suppliers fail.
1270 static int of_link_property(struct device *dev, struct device_node *con_np,
1271 const char *prop_name)
1273 struct device_node *phandle;
1274 const struct supplier_bindings *s = of_supplier_bindings;
1275 unsigned int i = 0;
1276 bool matched = false;
1277 int ret = 0;
1278 u32 dl_flags;
1280 if (dev->of_node == con_np)
1281 dl_flags = fw_devlink_get_flags();
1282 else
1283 dl_flags = DL_FLAG_SYNC_STATE_ONLY;
1285 /* Do not stop at first failed link, link all available suppliers. */
1286 while (!matched && s->parse_prop) {
1287 while ((phandle = s->parse_prop(con_np, prop_name, i))) {
1288 matched = true;
1289 i++;
1290 if (of_link_to_phandle(dev, phandle, dl_flags)
1291 == -EAGAIN)
1292 ret = -EAGAIN;
1293 of_node_put(phandle);
1295 s++;
1297 return ret;
1300 static int of_link_to_suppliers(struct device *dev,
1301 struct device_node *con_np)
1303 struct device_node *child;
1304 struct property *p;
1305 int ret = 0;
1307 for_each_property_of_node(con_np, p)
1308 if (of_link_property(dev, con_np, p->name))
1309 ret = -ENODEV;
1311 for_each_available_child_of_node(con_np, child)
1312 if (of_link_to_suppliers(dev, child) && !ret)
1313 ret = -EAGAIN;
1315 return ret;
1318 static int of_fwnode_add_links(const struct fwnode_handle *fwnode,
1319 struct device *dev)
1321 if (unlikely(!is_of_node(fwnode)))
1322 return 0;
1324 return of_link_to_suppliers(dev, to_of_node(fwnode));
1327 const struct fwnode_operations of_fwnode_ops = {
1328 .get = of_fwnode_get,
1329 .put = of_fwnode_put,
1330 .device_is_available = of_fwnode_device_is_available,
1331 .device_get_match_data = of_fwnode_device_get_match_data,
1332 .property_present = of_fwnode_property_present,
1333 .property_read_int_array = of_fwnode_property_read_int_array,
1334 .property_read_string_array = of_fwnode_property_read_string_array,
1335 .get_name = of_fwnode_get_name,
1336 .get_name_prefix = of_fwnode_get_name_prefix,
1337 .get_parent = of_fwnode_get_parent,
1338 .get_next_child_node = of_fwnode_get_next_child_node,
1339 .get_named_child_node = of_fwnode_get_named_child_node,
1340 .get_reference_args = of_fwnode_get_reference_args,
1341 .graph_get_next_endpoint = of_fwnode_graph_get_next_endpoint,
1342 .graph_get_remote_endpoint = of_fwnode_graph_get_remote_endpoint,
1343 .graph_get_port_parent = of_fwnode_graph_get_port_parent,
1344 .graph_parse_endpoint = of_fwnode_graph_parse_endpoint,
1345 .add_links = of_fwnode_add_links,
1347 EXPORT_SYMBOL_GPL(of_fwnode_ops);