blob: c458c63e353f1d62f5c73ef0c91f826d5323088a [file] [log] [blame]
Rafael J. Wysockib31384f2014-11-04 01:28:56 +01001/*
2 * property.c - Unified device property interface.
3 *
4 * Copyright (C) 2014, Intel Corporation
5 * Authors: Rafael J. Wysocki <rafael.j.wysocki@intel.com>
6 * Mika Westerberg <mika.westerberg@linux.intel.com>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 */
12
Rafael J. Wysockib31384f2014-11-04 01:28:56 +010013#include <linux/acpi.h>
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020014#include <linux/export.h>
15#include <linux/kernel.h>
Rafael J. Wysockib31384f2014-11-04 01:28:56 +010016#include <linux/of.h>
Suthikulpanit, Suravee05ca5562015-06-10 11:08:54 -050017#include <linux/of_address.h>
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020018#include <linux/property.h>
Jeremy Linton4c96b7d2015-08-12 17:06:26 -050019#include <linux/etherdevice.h>
20#include <linux/phy.h>
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020021
Heikki Krogerusf4d05262016-03-29 14:52:23 +030022struct property_set {
23 struct fwnode_handle fwnode;
Dmitry Torokhovbec84da2017-02-02 17:41:25 -080024 const struct property_entry *properties;
Heikki Krogerusf4d05262016-03-29 14:52:23 +030025};
26
Andy Shevchenko61f5e292015-11-30 17:11:30 +020027static inline bool is_pset_node(struct fwnode_handle *fwnode)
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020028{
Heikki Krogerus0224a4a2016-04-27 14:04:20 +030029 return !IS_ERR_OR_NULL(fwnode) && fwnode->type == FWNODE_PDATA;
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020030}
31
Andy Shevchenko61f5e292015-11-30 17:11:30 +020032static inline struct property_set *to_pset_node(struct fwnode_handle *fwnode)
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020033{
Andy Shevchenko61f5e292015-11-30 17:11:30 +020034 return is_pset_node(fwnode) ?
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020035 container_of(fwnode, struct property_set, fwnode) : NULL;
36}
37
Dmitry Torokhovbec84da2017-02-02 17:41:25 -080038static const struct property_entry *pset_prop_get(struct property_set *pset,
39 const char *name)
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020040{
Dmitry Torokhovbec84da2017-02-02 17:41:25 -080041 const struct property_entry *prop;
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020042
43 if (!pset || !pset->properties)
44 return NULL;
45
46 for (prop = pset->properties; prop->name; prop++)
47 if (!strcmp(name, prop->name))
48 return prop;
49
50 return NULL;
51}
52
Dmitry Torokhovbec84da2017-02-02 17:41:25 -080053static const void *pset_prop_find(struct property_set *pset,
54 const char *propname, size_t length)
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020055{
Dmitry Torokhovbec84da2017-02-02 17:41:25 -080056 const struct property_entry *prop;
57 const void *pointer;
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020058
Andy Shevchenko318a19712015-11-30 17:11:31 +020059 prop = pset_prop_get(pset, propname);
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020060 if (!prop)
Andy Shevchenko318a19712015-11-30 17:11:31 +020061 return ERR_PTR(-EINVAL);
Andy Shevchenko66586ba2015-11-30 17:11:32 +020062 if (prop->is_array)
63 pointer = prop->pointer.raw_data;
64 else
65 pointer = &prop->value.raw_data;
Andy Shevchenko318a19712015-11-30 17:11:31 +020066 if (!pointer)
67 return ERR_PTR(-ENODATA);
68 if (length > prop->length)
69 return ERR_PTR(-EOVERFLOW);
70 return pointer;
71}
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020072
Andy Shevchenko318a19712015-11-30 17:11:31 +020073static int pset_prop_read_u8_array(struct property_set *pset,
74 const char *propname,
75 u8 *values, size_t nval)
76{
Dmitry Torokhovbec84da2017-02-02 17:41:25 -080077 const void *pointer;
Andy Shevchenko318a19712015-11-30 17:11:31 +020078 size_t length = nval * sizeof(*values);
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020079
Andy Shevchenko318a19712015-11-30 17:11:31 +020080 pointer = pset_prop_find(pset, propname, length);
81 if (IS_ERR(pointer))
82 return PTR_ERR(pointer);
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020083
Andy Shevchenko318a19712015-11-30 17:11:31 +020084 memcpy(values, pointer, length);
85 return 0;
86}
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +020087
Andy Shevchenko318a19712015-11-30 17:11:31 +020088static int pset_prop_read_u16_array(struct property_set *pset,
89 const char *propname,
90 u16 *values, size_t nval)
91{
Dmitry Torokhovbec84da2017-02-02 17:41:25 -080092 const void *pointer;
Andy Shevchenko318a19712015-11-30 17:11:31 +020093 size_t length = nval * sizeof(*values);
94
95 pointer = pset_prop_find(pset, propname, length);
96 if (IS_ERR(pointer))
97 return PTR_ERR(pointer);
98
99 memcpy(values, pointer, length);
100 return 0;
101}
102
103static int pset_prop_read_u32_array(struct property_set *pset,
104 const char *propname,
105 u32 *values, size_t nval)
106{
Dmitry Torokhovbec84da2017-02-02 17:41:25 -0800107 const void *pointer;
Andy Shevchenko318a19712015-11-30 17:11:31 +0200108 size_t length = nval * sizeof(*values);
109
110 pointer = pset_prop_find(pset, propname, length);
111 if (IS_ERR(pointer))
112 return PTR_ERR(pointer);
113
114 memcpy(values, pointer, length);
115 return 0;
116}
117
118static int pset_prop_read_u64_array(struct property_set *pset,
119 const char *propname,
120 u64 *values, size_t nval)
121{
Dmitry Torokhovbec84da2017-02-02 17:41:25 -0800122 const void *pointer;
Andy Shevchenko318a19712015-11-30 17:11:31 +0200123 size_t length = nval * sizeof(*values);
124
125 pointer = pset_prop_find(pset, propname, length);
126 if (IS_ERR(pointer))
127 return PTR_ERR(pointer);
128
129 memcpy(values, pointer, length);
130 return 0;
131}
132
133static int pset_prop_count_elems_of_size(struct property_set *pset,
134 const char *propname, size_t length)
135{
Dmitry Torokhovbec84da2017-02-02 17:41:25 -0800136 const struct property_entry *prop;
Andy Shevchenko318a19712015-11-30 17:11:31 +0200137
138 prop = pset_prop_get(pset, propname);
139 if (!prop)
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +0200140 return -EINVAL;
Andy Shevchenko318a19712015-11-30 17:11:31 +0200141
142 return prop->length / length;
143}
144
145static int pset_prop_read_string_array(struct property_set *pset,
146 const char *propname,
147 const char **strings, size_t nval)
148{
Dmitry Torokhovbec84da2017-02-02 17:41:25 -0800149 const void *pointer;
Andy Shevchenko318a19712015-11-30 17:11:31 +0200150 size_t length = nval * sizeof(*strings);
151
152 pointer = pset_prop_find(pset, propname, length);
153 if (IS_ERR(pointer))
154 return PTR_ERR(pointer);
155
156 memcpy(strings, pointer, length);
Rafael J. Wysocki16ba08d2015-04-03 16:05:11 +0200157 return 0;
158}
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100159
Andy Shevchenko66586ba2015-11-30 17:11:32 +0200160static int pset_prop_read_string(struct property_set *pset,
161 const char *propname, const char **strings)
162{
Dmitry Torokhovbec84da2017-02-02 17:41:25 -0800163 const struct property_entry *prop;
164 const char * const *pointer;
Andy Shevchenko66586ba2015-11-30 17:11:32 +0200165
166 prop = pset_prop_get(pset, propname);
167 if (!prop)
168 return -EINVAL;
169 if (!prop->is_string)
170 return -EILSEQ;
171 if (prop->is_array) {
172 pointer = prop->pointer.str;
173 if (!pointer)
174 return -ENODATA;
175 } else {
176 pointer = &prop->value.str;
177 if (*pointer && strnlen(*pointer, prop->length) >= prop->length)
178 return -EILSEQ;
179 }
180
181 *strings = *pointer;
182 return 0;
183}
184
Rafael J. Wysocki9017f252015-03-24 00:24:16 +0100185static inline struct fwnode_handle *dev_fwnode(struct device *dev)
186{
187 return IS_ENABLED(CONFIG_OF) && dev->of_node ?
188 &dev->of_node->fwnode : dev->fwnode;
189}
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100190
191/**
192 * device_property_present - check if a property of a device is present
193 * @dev: Device whose property is being checked
194 * @propname: Name of the property
195 *
196 * Check if property @propname is present in the device firmware description.
197 */
198bool device_property_present(struct device *dev, const char *propname)
199{
Rafael J. Wysocki9017f252015-03-24 00:24:16 +0100200 return fwnode_property_present(dev_fwnode(dev), propname);
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100201}
202EXPORT_SYMBOL_GPL(device_property_present);
203
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200204static bool __fwnode_property_present(struct fwnode_handle *fwnode,
205 const char *propname)
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100206{
207 if (is_of_node(fwnode))
Alexander Sverdlinc181fb32015-06-22 22:38:53 +0200208 return of_property_read_bool(to_of_node(fwnode), propname);
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100209 else if (is_acpi_node(fwnode))
Rafael J. Wysocki3a7a2ab2015-08-27 04:40:05 +0200210 return !acpi_node_prop_get(fwnode, propname, NULL);
Andy Shevchenko61f5e292015-11-30 17:11:30 +0200211 else if (is_pset_node(fwnode))
212 return !!pset_prop_get(to_pset_node(fwnode), propname);
Andy Shevchenkoe3f9e292015-11-30 17:11:29 +0200213 return false;
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100214}
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200215
216/**
217 * fwnode_property_present - check if a property of a firmware node is present
218 * @fwnode: Firmware node whose property to check
219 * @propname: Name of the property
220 */
221bool fwnode_property_present(struct fwnode_handle *fwnode, const char *propname)
222{
223 bool ret;
224
225 ret = __fwnode_property_present(fwnode, propname);
Heikki Krogerus0d67e0f2016-03-10 13:03:18 +0200226 if (ret == false && !IS_ERR_OR_NULL(fwnode) &&
227 !IS_ERR_OR_NULL(fwnode->secondary))
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200228 ret = __fwnode_property_present(fwnode->secondary, propname);
229 return ret;
230}
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100231EXPORT_SYMBOL_GPL(fwnode_property_present);
232
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100233/**
234 * device_property_read_u8_array - return a u8 array property of a device
235 * @dev: Device to get the property of
236 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200237 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100238 * @nval: Size of the @val array
239 *
240 * Function reads an array of u8 properties with @propname from the device
241 * firmware description and stores them to @val if found.
242 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200243 * Return: number of values if @val was %NULL,
244 * %0 if the property was found (success),
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100245 * %-EINVAL if given arguments are not valid,
246 * %-ENODATA if the property does not have a value,
247 * %-EPROTO if the property is not an array of numbers,
248 * %-EOVERFLOW if the size of the property is not as expected.
Guenter Roeck4fa7508e2015-08-26 20:27:04 -0700249 * %-ENXIO if no suitable firmware interface is present.
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100250 */
251int device_property_read_u8_array(struct device *dev, const char *propname,
252 u8 *val, size_t nval)
253{
Rafael J. Wysocki9017f252015-03-24 00:24:16 +0100254 return fwnode_property_read_u8_array(dev_fwnode(dev), propname, val, nval);
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100255}
256EXPORT_SYMBOL_GPL(device_property_read_u8_array);
257
258/**
259 * device_property_read_u16_array - return a u16 array property of a device
260 * @dev: Device to get the property of
261 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200262 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100263 * @nval: Size of the @val array
264 *
265 * Function reads an array of u16 properties with @propname from the device
266 * firmware description and stores them to @val if found.
267 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200268 * Return: number of values if @val was %NULL,
269 * %0 if the property was found (success),
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100270 * %-EINVAL if given arguments are not valid,
271 * %-ENODATA if the property does not have a value,
272 * %-EPROTO if the property is not an array of numbers,
273 * %-EOVERFLOW if the size of the property is not as expected.
Guenter Roeck4fa7508e2015-08-26 20:27:04 -0700274 * %-ENXIO if no suitable firmware interface is present.
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100275 */
276int device_property_read_u16_array(struct device *dev, const char *propname,
277 u16 *val, size_t nval)
278{
Rafael J. Wysocki9017f252015-03-24 00:24:16 +0100279 return fwnode_property_read_u16_array(dev_fwnode(dev), propname, val, nval);
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100280}
281EXPORT_SYMBOL_GPL(device_property_read_u16_array);
282
283/**
284 * device_property_read_u32_array - return a u32 array property of a device
285 * @dev: Device to get the property of
286 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200287 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100288 * @nval: Size of the @val array
289 *
290 * Function reads an array of u32 properties with @propname from the device
291 * firmware description and stores them to @val if found.
292 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200293 * Return: number of values if @val was %NULL,
294 * %0 if the property was found (success),
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100295 * %-EINVAL if given arguments are not valid,
296 * %-ENODATA if the property does not have a value,
297 * %-EPROTO if the property is not an array of numbers,
298 * %-EOVERFLOW if the size of the property is not as expected.
Guenter Roeck4fa7508e2015-08-26 20:27:04 -0700299 * %-ENXIO if no suitable firmware interface is present.
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100300 */
301int device_property_read_u32_array(struct device *dev, const char *propname,
302 u32 *val, size_t nval)
303{
Rafael J. Wysocki9017f252015-03-24 00:24:16 +0100304 return fwnode_property_read_u32_array(dev_fwnode(dev), propname, val, nval);
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100305}
306EXPORT_SYMBOL_GPL(device_property_read_u32_array);
307
308/**
309 * device_property_read_u64_array - return a u64 array property of a device
310 * @dev: Device to get the property of
311 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200312 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100313 * @nval: Size of the @val array
314 *
315 * Function reads an array of u64 properties with @propname from the device
316 * firmware description and stores them to @val if found.
317 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200318 * Return: number of values if @val was %NULL,
319 * %0 if the property was found (success),
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100320 * %-EINVAL if given arguments are not valid,
321 * %-ENODATA if the property does not have a value,
322 * %-EPROTO if the property is not an array of numbers,
323 * %-EOVERFLOW if the size of the property is not as expected.
Guenter Roeck4fa7508e2015-08-26 20:27:04 -0700324 * %-ENXIO if no suitable firmware interface is present.
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100325 */
326int device_property_read_u64_array(struct device *dev, const char *propname,
327 u64 *val, size_t nval)
328{
Rafael J. Wysocki9017f252015-03-24 00:24:16 +0100329 return fwnode_property_read_u64_array(dev_fwnode(dev), propname, val, nval);
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100330}
331EXPORT_SYMBOL_GPL(device_property_read_u64_array);
332
333/**
334 * device_property_read_string_array - return a string array property of device
335 * @dev: Device to get the property of
336 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200337 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100338 * @nval: Size of the @val array
339 *
340 * Function reads an array of string properties with @propname from the device
341 * firmware description and stores them to @val if found.
342 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200343 * Return: number of values if @val was %NULL,
344 * %0 if the property was found (success),
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100345 * %-EINVAL if given arguments are not valid,
346 * %-ENODATA if the property does not have a value,
347 * %-EPROTO or %-EILSEQ if the property is not an array of strings,
348 * %-EOVERFLOW if the size of the property is not as expected.
Guenter Roeck4fa7508e2015-08-26 20:27:04 -0700349 * %-ENXIO if no suitable firmware interface is present.
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100350 */
351int device_property_read_string_array(struct device *dev, const char *propname,
352 const char **val, size_t nval)
353{
Rafael J. Wysocki9017f252015-03-24 00:24:16 +0100354 return fwnode_property_read_string_array(dev_fwnode(dev), propname, val, nval);
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100355}
356EXPORT_SYMBOL_GPL(device_property_read_string_array);
357
358/**
359 * device_property_read_string - return a string property of a device
360 * @dev: Device to get the property of
361 * @propname: Name of the property
362 * @val: The value is stored here
363 *
364 * Function reads property @propname from the device firmware description and
365 * stores the value into @val if found. The value is checked to be a string.
366 *
367 * Return: %0 if the property was found (success),
368 * %-EINVAL if given arguments are not valid,
369 * %-ENODATA if the property does not have a value,
370 * %-EPROTO or %-EILSEQ if the property type is not a string.
Guenter Roeck4fa7508e2015-08-26 20:27:04 -0700371 * %-ENXIO if no suitable firmware interface is present.
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100372 */
373int device_property_read_string(struct device *dev, const char *propname,
374 const char **val)
375{
Rafael J. Wysocki9017f252015-03-24 00:24:16 +0100376 return fwnode_property_read_string(dev_fwnode(dev), propname, val);
Rafael J. Wysockib31384f2014-11-04 01:28:56 +0100377}
378EXPORT_SYMBOL_GPL(device_property_read_string);
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100379
Mika Westerberg3f5c8d32015-09-14 17:37:35 +0300380/**
381 * device_property_match_string - find a string in an array and return index
382 * @dev: Device to get the property of
383 * @propname: Name of the property holding the array
384 * @string: String to look for
385 *
386 * Find a given string in a string array and if it is found return the
387 * index back.
388 *
389 * Return: %0 if the property was found (success),
390 * %-EINVAL if given arguments are not valid,
391 * %-ENODATA if the property does not have a value,
392 * %-EPROTO if the property is not an array of strings,
393 * %-ENXIO if no suitable firmware interface is present.
394 */
395int device_property_match_string(struct device *dev, const char *propname,
396 const char *string)
397{
398 return fwnode_property_match_string(dev_fwnode(dev), propname, string);
399}
400EXPORT_SYMBOL_GPL(device_property_match_string);
401
Andy Shevchenko1d656fb2015-11-30 17:11:34 +0200402#define OF_DEV_PROP_READ_ARRAY(node, propname, type, val, nval) \
403 (val) ? of_property_read_##type##_array((node), (propname), (val), (nval)) \
Rafael J. Wysocki9017f252015-03-24 00:24:16 +0100404 : of_property_count_elems_of_size((node), (propname), sizeof(type))
405
Andy Shevchenko318a19712015-11-30 17:11:31 +0200406#define PSET_PROP_READ_ARRAY(node, propname, type, val, nval) \
407 (val) ? pset_prop_read_##type##_array((node), (propname), (val), (nval)) \
408 : pset_prop_count_elems_of_size((node), (propname), sizeof(type))
409
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200410#define FWNODE_PROP_READ(_fwnode_, _propname_, _type_, _proptype_, _val_, _nval_) \
Andy Shevchenko1d656fb2015-11-30 17:11:34 +0200411({ \
412 int _ret_; \
413 if (is_of_node(_fwnode_)) \
414 _ret_ = OF_DEV_PROP_READ_ARRAY(to_of_node(_fwnode_), _propname_, \
415 _type_, _val_, _nval_); \
416 else if (is_acpi_node(_fwnode_)) \
417 _ret_ = acpi_node_prop_read(_fwnode_, _propname_, _proptype_, \
418 _val_, _nval_); \
Andy Shevchenko61f5e292015-11-30 17:11:30 +0200419 else if (is_pset_node(_fwnode_)) \
Andy Shevchenko318a19712015-11-30 17:11:31 +0200420 _ret_ = PSET_PROP_READ_ARRAY(to_pset_node(_fwnode_), _propname_, \
421 _type_, _val_, _nval_); \
Andy Shevchenko1d656fb2015-11-30 17:11:34 +0200422 else \
423 _ret_ = -ENXIO; \
424 _ret_; \
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100425})
426
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200427#define FWNODE_PROP_READ_ARRAY(_fwnode_, _propname_, _type_, _proptype_, _val_, _nval_) \
428({ \
429 int _ret_; \
430 _ret_ = FWNODE_PROP_READ(_fwnode_, _propname_, _type_, _proptype_, \
431 _val_, _nval_); \
Heikki Krogerus0d67e0f2016-03-10 13:03:18 +0200432 if (_ret_ == -EINVAL && !IS_ERR_OR_NULL(_fwnode_) && \
433 !IS_ERR_OR_NULL(_fwnode_->secondary)) \
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200434 _ret_ = FWNODE_PROP_READ(_fwnode_->secondary, _propname_, _type_, \
435 _proptype_, _val_, _nval_); \
436 _ret_; \
437})
438
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100439/**
440 * fwnode_property_read_u8_array - return a u8 array property of firmware node
441 * @fwnode: Firmware node to get the property of
442 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200443 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100444 * @nval: Size of the @val array
445 *
446 * Read an array of u8 properties with @propname from @fwnode and stores them to
447 * @val if found.
448 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200449 * Return: number of values if @val was %NULL,
450 * %0 if the property was found (success),
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100451 * %-EINVAL if given arguments are not valid,
452 * %-ENODATA if the property does not have a value,
453 * %-EPROTO if the property is not an array of numbers,
454 * %-EOVERFLOW if the size of the property is not as expected,
455 * %-ENXIO if no suitable firmware interface is present.
456 */
457int fwnode_property_read_u8_array(struct fwnode_handle *fwnode,
458 const char *propname, u8 *val, size_t nval)
459{
460 return FWNODE_PROP_READ_ARRAY(fwnode, propname, u8, DEV_PROP_U8,
461 val, nval);
462}
463EXPORT_SYMBOL_GPL(fwnode_property_read_u8_array);
464
465/**
466 * fwnode_property_read_u16_array - return a u16 array property of firmware node
467 * @fwnode: Firmware node to get the property of
468 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200469 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100470 * @nval: Size of the @val array
471 *
472 * Read an array of u16 properties with @propname from @fwnode and store them to
473 * @val if found.
474 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200475 * Return: number of values if @val was %NULL,
476 * %0 if the property was found (success),
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100477 * %-EINVAL if given arguments are not valid,
478 * %-ENODATA if the property does not have a value,
479 * %-EPROTO if the property is not an array of numbers,
480 * %-EOVERFLOW if the size of the property is not as expected,
481 * %-ENXIO if no suitable firmware interface is present.
482 */
483int fwnode_property_read_u16_array(struct fwnode_handle *fwnode,
484 const char *propname, u16 *val, size_t nval)
485{
486 return FWNODE_PROP_READ_ARRAY(fwnode, propname, u16, DEV_PROP_U16,
487 val, nval);
488}
489EXPORT_SYMBOL_GPL(fwnode_property_read_u16_array);
490
491/**
492 * fwnode_property_read_u32_array - return a u32 array property of firmware node
493 * @fwnode: Firmware node to get the property of
494 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200495 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100496 * @nval: Size of the @val array
497 *
498 * Read an array of u32 properties with @propname from @fwnode store them to
499 * @val if found.
500 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200501 * Return: number of values if @val was %NULL,
502 * %0 if the property was found (success),
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100503 * %-EINVAL if given arguments are not valid,
504 * %-ENODATA if the property does not have a value,
505 * %-EPROTO if the property is not an array of numbers,
506 * %-EOVERFLOW if the size of the property is not as expected,
507 * %-ENXIO if no suitable firmware interface is present.
508 */
509int fwnode_property_read_u32_array(struct fwnode_handle *fwnode,
510 const char *propname, u32 *val, size_t nval)
511{
512 return FWNODE_PROP_READ_ARRAY(fwnode, propname, u32, DEV_PROP_U32,
513 val, nval);
514}
515EXPORT_SYMBOL_GPL(fwnode_property_read_u32_array);
516
517/**
518 * fwnode_property_read_u64_array - return a u64 array property firmware node
519 * @fwnode: Firmware node to get the property of
520 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200521 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100522 * @nval: Size of the @val array
523 *
524 * Read an array of u64 properties with @propname from @fwnode and store them to
525 * @val if found.
526 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200527 * Return: number of values if @val was %NULL,
528 * %0 if the property was found (success),
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100529 * %-EINVAL if given arguments are not valid,
530 * %-ENODATA if the property does not have a value,
531 * %-EPROTO if the property is not an array of numbers,
532 * %-EOVERFLOW if the size of the property is not as expected,
533 * %-ENXIO if no suitable firmware interface is present.
534 */
535int fwnode_property_read_u64_array(struct fwnode_handle *fwnode,
536 const char *propname, u64 *val, size_t nval)
537{
538 return FWNODE_PROP_READ_ARRAY(fwnode, propname, u64, DEV_PROP_U64,
539 val, nval);
540}
541EXPORT_SYMBOL_GPL(fwnode_property_read_u64_array);
542
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200543static int __fwnode_property_read_string_array(struct fwnode_handle *fwnode,
544 const char *propname,
545 const char **val, size_t nval)
546{
547 if (is_of_node(fwnode))
548 return val ?
549 of_property_read_string_array(to_of_node(fwnode),
550 propname, val, nval) :
551 of_property_count_strings(to_of_node(fwnode), propname);
552 else if (is_acpi_node(fwnode))
553 return acpi_node_prop_read(fwnode, propname, DEV_PROP_STRING,
554 val, nval);
555 else if (is_pset_node(fwnode))
556 return val ?
557 pset_prop_read_string_array(to_pset_node(fwnode),
558 propname, val, nval) :
559 pset_prop_count_elems_of_size(to_pset_node(fwnode),
560 propname,
561 sizeof(const char *));
562 return -ENXIO;
563}
564
565static int __fwnode_property_read_string(struct fwnode_handle *fwnode,
566 const char *propname, const char **val)
567{
568 if (is_of_node(fwnode))
569 return of_property_read_string(to_of_node(fwnode), propname, val);
570 else if (is_acpi_node(fwnode))
571 return acpi_node_prop_read(fwnode, propname, DEV_PROP_STRING,
572 val, 1);
573 else if (is_pset_node(fwnode))
574 return pset_prop_read_string(to_pset_node(fwnode), propname, val);
575 return -ENXIO;
576}
577
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100578/**
579 * fwnode_property_read_string_array - return string array property of a node
580 * @fwnode: Firmware node to get the property of
581 * @propname: Name of the property
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200582 * @val: The values are stored here or %NULL to return the number of values
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100583 * @nval: Size of the @val array
584 *
585 * Read an string list property @propname from the given firmware node and store
586 * them to @val if found.
587 *
Adrian Hunter5c0acf32015-03-17 09:58:58 +0200588 * Return: number of values if @val was %NULL,
589 * %0 if the property was found (success),
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100590 * %-EINVAL if given arguments are not valid,
591 * %-ENODATA if the property does not have a value,
592 * %-EPROTO if the property is not an array of strings,
593 * %-EOVERFLOW if the size of the property is not as expected,
594 * %-ENXIO if no suitable firmware interface is present.
595 */
596int fwnode_property_read_string_array(struct fwnode_handle *fwnode,
597 const char *propname, const char **val,
598 size_t nval)
599{
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200600 int ret;
601
602 ret = __fwnode_property_read_string_array(fwnode, propname, val, nval);
Heikki Krogerus0d67e0f2016-03-10 13:03:18 +0200603 if (ret == -EINVAL && !IS_ERR_OR_NULL(fwnode) &&
604 !IS_ERR_OR_NULL(fwnode->secondary))
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200605 ret = __fwnode_property_read_string_array(fwnode->secondary,
606 propname, val, nval);
607 return ret;
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100608}
609EXPORT_SYMBOL_GPL(fwnode_property_read_string_array);
610
611/**
612 * fwnode_property_read_string - return a string property of a firmware node
613 * @fwnode: Firmware node to get the property of
614 * @propname: Name of the property
615 * @val: The value is stored here
616 *
617 * Read property @propname from the given firmware node and store the value into
618 * @val if found. The value is checked to be a string.
619 *
620 * Return: %0 if the property was found (success),
621 * %-EINVAL if given arguments are not valid,
622 * %-ENODATA if the property does not have a value,
623 * %-EPROTO or %-EILSEQ if the property is not a string,
624 * %-ENXIO if no suitable firmware interface is present.
625 */
626int fwnode_property_read_string(struct fwnode_handle *fwnode,
627 const char *propname, const char **val)
628{
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200629 int ret;
630
631 ret = __fwnode_property_read_string(fwnode, propname, val);
Heikki Krogerus0d67e0f2016-03-10 13:03:18 +0200632 if (ret == -EINVAL && !IS_ERR_OR_NULL(fwnode) &&
633 !IS_ERR_OR_NULL(fwnode->secondary))
Andy Shevchenko362c0b32015-11-30 17:11:36 +0200634 ret = __fwnode_property_read_string(fwnode->secondary,
635 propname, val);
636 return ret;
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100637}
638EXPORT_SYMBOL_GPL(fwnode_property_read_string);
639
640/**
Mika Westerberg3f5c8d32015-09-14 17:37:35 +0300641 * fwnode_property_match_string - find a string in an array and return index
642 * @fwnode: Firmware node to get the property of
643 * @propname: Name of the property holding the array
644 * @string: String to look for
645 *
646 * Find a given string in a string array and if it is found return the
647 * index back.
648 *
649 * Return: %0 if the property was found (success),
650 * %-EINVAL if given arguments are not valid,
651 * %-ENODATA if the property does not have a value,
652 * %-EPROTO if the property is not an array of strings,
653 * %-ENXIO if no suitable firmware interface is present.
654 */
655int fwnode_property_match_string(struct fwnode_handle *fwnode,
656 const char *propname, const char *string)
657{
658 const char **values;
Andy Shevchenkoa7c1d0a2016-03-17 14:22:17 -0700659 int nval, ret;
Mika Westerberg3f5c8d32015-09-14 17:37:35 +0300660
661 nval = fwnode_property_read_string_array(fwnode, propname, NULL, 0);
662 if (nval < 0)
663 return nval;
664
Andy Shevchenkof6740c12015-12-29 13:07:50 +0200665 if (nval == 0)
666 return -ENODATA;
667
Mika Westerberg3f5c8d32015-09-14 17:37:35 +0300668 values = kcalloc(nval, sizeof(*values), GFP_KERNEL);
669 if (!values)
670 return -ENOMEM;
671
672 ret = fwnode_property_read_string_array(fwnode, propname, values, nval);
673 if (ret < 0)
674 goto out;
675
Andy Shevchenkoa7c1d0a2016-03-17 14:22:17 -0700676 ret = match_string(values, nval, string);
677 if (ret < 0)
678 ret = -ENODATA;
Mika Westerberg3f5c8d32015-09-14 17:37:35 +0300679out:
680 kfree(values);
681 return ret;
682}
683EXPORT_SYMBOL_GPL(fwnode_property_match_string);
684
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800685static int property_copy_string_array(struct property_entry *dst,
686 const struct property_entry *src)
Mika Westerberg13141e12015-11-30 17:11:37 +0200687{
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800688 char **d;
689 size_t nval = src->length / sizeof(*d);
690 int i;
Mika Westerberg13141e12015-11-30 17:11:37 +0200691
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800692 d = kcalloc(nval, sizeof(*d), GFP_KERNEL);
693 if (!d)
694 return -ENOMEM;
Mika Westerberg13141e12015-11-30 17:11:37 +0200695
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800696 for (i = 0; i < nval; i++) {
697 d[i] = kstrdup(src->pointer.str[i], GFP_KERNEL);
698 if (!d[i] && src->pointer.str[i]) {
699 while (--i >= 0)
700 kfree(d[i]);
701 kfree(d);
702 return -ENOMEM;
Mika Westerberg13141e12015-11-30 17:11:37 +0200703 }
Mika Westerberg13141e12015-11-30 17:11:37 +0200704 }
705
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800706 dst->pointer.raw_data = d;
707 return 0;
Mika Westerberg13141e12015-11-30 17:11:37 +0200708}
709
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800710static int property_entry_copy_data(struct property_entry *dst,
711 const struct property_entry *src)
Mika Westerberg13141e12015-11-30 17:11:37 +0200712{
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800713 int error;
Mika Westerberg13141e12015-11-30 17:11:37 +0200714
715 dst->name = kstrdup(src->name, GFP_KERNEL);
716 if (!dst->name)
717 return -ENOMEM;
718
719 if (src->is_array) {
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800720 if (!src->length) {
721 error = -ENODATA;
722 goto out_free_name;
723 }
Andy Shevchenkof6740c12015-12-29 13:07:50 +0200724
Mika Westerberg13141e12015-11-30 17:11:37 +0200725 if (src->is_string) {
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800726 error = property_copy_string_array(dst, src);
727 if (error)
728 goto out_free_name;
Mika Westerberg13141e12015-11-30 17:11:37 +0200729 } else {
730 dst->pointer.raw_data = kmemdup(src->pointer.raw_data,
731 src->length, GFP_KERNEL);
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800732 if (!dst->pointer.raw_data) {
733 error = -ENOMEM;
734 goto out_free_name;
735 }
Mika Westerberg13141e12015-11-30 17:11:37 +0200736 }
737 } else if (src->is_string) {
738 dst->value.str = kstrdup(src->value.str, GFP_KERNEL);
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800739 if (!dst->value.str && src->value.str) {
740 error = -ENOMEM;
741 goto out_free_name;
742 }
Mika Westerberg13141e12015-11-30 17:11:37 +0200743 } else {
744 dst->value.raw_data = src->value.raw_data;
745 }
746
747 dst->length = src->length;
748 dst->is_array = src->is_array;
749 dst->is_string = src->is_string;
750
751 return 0;
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800752
753out_free_name:
754 kfree(dst->name);
755 return error;
756}
757
758static void property_entry_free_data(const struct property_entry *p)
759{
760 size_t i, nval;
761
762 if (p->is_array) {
763 if (p->is_string && p->pointer.str) {
764 nval = p->length / sizeof(const char *);
765 for (i = 0; i < nval; i++)
766 kfree(p->pointer.str[i]);
767 }
768 kfree(p->pointer.raw_data);
769 } else if (p->is_string) {
770 kfree(p->value.str);
771 }
772 kfree(p->name);
773}
774
775/**
776 * property_entries_dup - duplicate array of properties
777 * @properties: array of properties to copy
778 *
779 * This function creates a deep copy of the given NULL-terminated array
780 * of property entries.
781 */
782struct property_entry *
783property_entries_dup(const struct property_entry *properties)
784{
785 struct property_entry *p;
786 int i, n = 0;
787
788 while (properties[n].name)
789 n++;
790
791 p = kcalloc(n + 1, sizeof(*p), GFP_KERNEL);
792 if (!p)
793 return ERR_PTR(-ENOMEM);
794
795 for (i = 0; i < n; i++) {
796 int ret = property_entry_copy_data(&p[i], &properties[i]);
797 if (ret) {
798 while (--i >= 0)
799 property_entry_free_data(&p[i]);
800 kfree(p);
801 return ERR_PTR(ret);
802 }
803 }
804
805 return p;
806}
807EXPORT_SYMBOL_GPL(property_entries_dup);
808
809/**
810 * property_entries_free - free previously allocated array of properties
811 * @properties: array of properties to destroy
812 *
813 * This function frees given NULL-terminated array of property entries,
814 * along with their data.
815 */
816void property_entries_free(const struct property_entry *properties)
817{
818 const struct property_entry *p;
819
820 for (p = properties; p->name; p++)
821 property_entry_free_data(p);
822
823 kfree(properties);
824}
825EXPORT_SYMBOL_GPL(property_entries_free);
826
827/**
828 * pset_free_set - releases memory allocated for copied property set
829 * @pset: Property set to release
830 *
831 * Function takes previously copied property set and releases all the
832 * memory allocated to it.
833 */
834static void pset_free_set(struct property_set *pset)
835{
836 if (!pset)
837 return;
838
839 property_entries_free(pset->properties);
840 kfree(pset);
Mika Westerberg13141e12015-11-30 17:11:37 +0200841}
842
843/**
844 * pset_copy_set - copies property set
845 * @pset: Property set to copy
846 *
847 * This function takes a deep copy of the given property set and returns
848 * pointer to the copy. Call device_free_property_set() to free resources
849 * allocated in this function.
850 *
851 * Return: Pointer to the new property set or error pointer.
852 */
853static struct property_set *pset_copy_set(const struct property_set *pset)
854{
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800855 struct property_entry *properties;
Mika Westerberg13141e12015-11-30 17:11:37 +0200856 struct property_set *p;
Mika Westerberg13141e12015-11-30 17:11:37 +0200857
858 p = kzalloc(sizeof(*p), GFP_KERNEL);
859 if (!p)
860 return ERR_PTR(-ENOMEM);
861
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800862 properties = property_entries_dup(pset->properties);
863 if (IS_ERR(properties)) {
Mika Westerberg13141e12015-11-30 17:11:37 +0200864 kfree(p);
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800865 return ERR_CAST(properties);
Mika Westerberg13141e12015-11-30 17:11:37 +0200866 }
867
Dmitry Torokhov2d479e12017-02-02 17:41:27 -0800868 p->properties = properties;
Mika Westerberg13141e12015-11-30 17:11:37 +0200869 return p;
870}
871
872/**
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300873 * device_remove_properties - Remove properties from a device object.
Mika Westerberg13141e12015-11-30 17:11:37 +0200874 * @dev: Device whose properties to remove.
875 *
876 * The function removes properties previously associated to the device
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300877 * secondary firmware node with device_add_properties(). Memory allocated
Mika Westerberg13141e12015-11-30 17:11:37 +0200878 * to the properties will also be released.
879 */
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300880void device_remove_properties(struct device *dev)
Mika Westerberg13141e12015-11-30 17:11:37 +0200881{
882 struct fwnode_handle *fwnode;
883
884 fwnode = dev_fwnode(dev);
885 if (!fwnode)
886 return;
887 /*
888 * Pick either primary or secondary node depending which one holds
889 * the pset. If there is no real firmware node (ACPI/DT) primary
890 * will hold the pset.
891 */
Heikki Krogerus0d67e0f2016-03-10 13:03:18 +0200892 if (is_pset_node(fwnode)) {
893 set_primary_fwnode(dev, NULL);
Mika Westerberg13141e12015-11-30 17:11:37 +0200894 pset_free_set(to_pset_node(fwnode));
Heikki Krogerus0d67e0f2016-03-10 13:03:18 +0200895 } else {
896 fwnode = fwnode->secondary;
897 if (!IS_ERR(fwnode) && is_pset_node(fwnode)) {
898 set_secondary_fwnode(dev, NULL);
899 pset_free_set(to_pset_node(fwnode));
900 }
901 }
Mika Westerberg13141e12015-11-30 17:11:37 +0200902}
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300903EXPORT_SYMBOL_GPL(device_remove_properties);
Mika Westerberg13141e12015-11-30 17:11:37 +0200904
905/**
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300906 * device_add_properties - Add a collection of properties to a device object.
Mika Westerberg13141e12015-11-30 17:11:37 +0200907 * @dev: Device to add properties to.
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300908 * @properties: Collection of properties to add.
Mika Westerberg13141e12015-11-30 17:11:37 +0200909 *
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300910 * Associate a collection of device properties represented by @properties with
911 * @dev as its secondary firmware node. The function takes a copy of
912 * @properties.
Mika Westerberg13141e12015-11-30 17:11:37 +0200913 */
Dmitry Torokhovbec84da2017-02-02 17:41:25 -0800914int device_add_properties(struct device *dev,
915 const struct property_entry *properties)
Mika Westerberg13141e12015-11-30 17:11:37 +0200916{
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300917 struct property_set *p, pset;
Mika Westerberg13141e12015-11-30 17:11:37 +0200918
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300919 if (!properties)
Mika Westerberg13141e12015-11-30 17:11:37 +0200920 return -EINVAL;
921
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300922 pset.properties = properties;
923
924 p = pset_copy_set(&pset);
Mika Westerberg13141e12015-11-30 17:11:37 +0200925 if (IS_ERR(p))
926 return PTR_ERR(p);
927
928 p->fwnode.type = FWNODE_PDATA;
929 set_secondary_fwnode(dev, &p->fwnode);
930 return 0;
931}
Heikki Krogerusf4d05262016-03-29 14:52:23 +0300932EXPORT_SYMBOL_GPL(device_add_properties);
Mika Westerberg13141e12015-11-30 17:11:37 +0200933
934/**
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100935 * device_get_next_child_node - Return the next child node handle for a device
936 * @dev: Device to find the next child node for.
937 * @child: Handle to one of the device's child nodes or a null handle.
938 */
939struct fwnode_handle *device_get_next_child_node(struct device *dev,
940 struct fwnode_handle *child)
941{
942 if (IS_ENABLED(CONFIG_OF) && dev->of_node) {
943 struct device_node *node;
944
Alexander Sverdlinc181fb32015-06-22 22:38:53 +0200945 node = of_get_next_available_child(dev->of_node, to_of_node(child));
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100946 if (node)
947 return &node->fwnode;
948 } else if (IS_ENABLED(CONFIG_ACPI)) {
Rafael J. Wysocki504a3372015-08-27 04:42:33 +0200949 return acpi_get_next_subnode(dev, child);
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100950 }
951 return NULL;
952}
953EXPORT_SYMBOL_GPL(device_get_next_child_node);
954
955/**
Adam Thomson613e9722016-06-21 18:50:20 +0100956 * device_get_named_child_node - Return first matching named child node handle
957 * @dev: Device to find the named child node for.
958 * @childname: String to match child node name against.
959 */
960struct fwnode_handle *device_get_named_child_node(struct device *dev,
961 const char *childname)
962{
963 struct fwnode_handle *child;
964
965 /*
966 * Find first matching named child node of this device.
967 * For ACPI this will be a data only sub-node.
968 */
969 device_for_each_child_node(dev, child) {
970 if (is_of_node(child)) {
971 if (!of_node_cmp(to_of_node(child)->name, childname))
972 return child;
973 } else if (is_acpi_data_node(child)) {
974 if (acpi_data_node_match(child, childname))
975 return child;
976 }
977 }
978
979 return NULL;
980}
981EXPORT_SYMBOL_GPL(device_get_named_child_node);
982
983/**
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100984 * fwnode_handle_put - Drop reference to a device node
985 * @fwnode: Pointer to the device node to drop the reference to.
986 *
987 * This has to be used when terminating device_for_each_child_node() iteration
988 * with break or return to prevent stale device node references from being left
989 * behind.
990 */
991void fwnode_handle_put(struct fwnode_handle *fwnode)
992{
993 if (is_of_node(fwnode))
Alexander Sverdlinc181fb32015-06-22 22:38:53 +0200994 of_node_put(to_of_node(fwnode));
Rafael J. Wysocki8a0662d2014-11-04 14:03:59 +0100995}
996EXPORT_SYMBOL_GPL(fwnode_handle_put);
997
998/**
999 * device_get_child_node_count - return the number of child nodes for device
1000 * @dev: Device to cound the child nodes for
1001 */
1002unsigned int device_get_child_node_count(struct device *dev)
1003{
1004 struct fwnode_handle *child;
1005 unsigned int count = 0;
1006
1007 device_for_each_child_node(dev, child)
1008 count++;
1009
1010 return count;
1011}
1012EXPORT_SYMBOL_GPL(device_get_child_node_count);
Suthikulpanit, Suravee05ca5562015-06-10 11:08:54 -05001013
Suthikulpanit, Suraveee5e55862015-10-28 15:50:49 -07001014bool device_dma_supported(struct device *dev)
1015{
1016 /* For DT, this is always supported.
1017 * For ACPI, this depends on CCA, which
1018 * is determined by the acpi_dma_supported().
1019 */
1020 if (IS_ENABLED(CONFIG_OF) && dev->of_node)
1021 return true;
1022
1023 return acpi_dma_supported(ACPI_COMPANION(dev));
1024}
1025EXPORT_SYMBOL_GPL(device_dma_supported);
1026
1027enum dev_dma_attr device_get_dma_attr(struct device *dev)
1028{
1029 enum dev_dma_attr attr = DEV_DMA_NOT_SUPPORTED;
1030
1031 if (IS_ENABLED(CONFIG_OF) && dev->of_node) {
1032 if (of_dma_is_coherent(dev->of_node))
1033 attr = DEV_DMA_COHERENT;
1034 else
1035 attr = DEV_DMA_NON_COHERENT;
1036 } else
1037 attr = acpi_get_dma_attr(ACPI_COMPANION(dev));
1038
1039 return attr;
1040}
1041EXPORT_SYMBOL_GPL(device_get_dma_attr);
1042
Jeremy Linton4c96b7d2015-08-12 17:06:26 -05001043/**
Jeremy Linton2f710a32015-08-19 11:46:42 -05001044 * device_get_phy_mode - Get phy mode for given device
Jeremy Linton4c96b7d2015-08-12 17:06:26 -05001045 * @dev: Pointer to the given device
1046 *
1047 * The function gets phy interface string from property 'phy-mode' or
1048 * 'phy-connection-type', and return its index in phy_modes table, or errno in
1049 * error case.
1050 */
1051int device_get_phy_mode(struct device *dev)
1052{
1053 const char *pm;
1054 int err, i;
1055
1056 err = device_property_read_string(dev, "phy-mode", &pm);
1057 if (err < 0)
1058 err = device_property_read_string(dev,
1059 "phy-connection-type", &pm);
1060 if (err < 0)
1061 return err;
1062
1063 for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++)
1064 if (!strcasecmp(pm, phy_modes(i)))
1065 return i;
1066
1067 return -ENODEV;
1068}
1069EXPORT_SYMBOL_GPL(device_get_phy_mode);
1070
1071static void *device_get_mac_addr(struct device *dev,
1072 const char *name, char *addr,
1073 int alen)
1074{
1075 int ret = device_property_read_u8_array(dev, name, addr, alen);
1076
Jeremy Linton2f710a32015-08-19 11:46:42 -05001077 if (ret == 0 && alen == ETH_ALEN && is_valid_ether_addr(addr))
Jeremy Linton4c96b7d2015-08-12 17:06:26 -05001078 return addr;
1079 return NULL;
1080}
1081
1082/**
Jeremy Linton2f710a32015-08-19 11:46:42 -05001083 * device_get_mac_address - Get the MAC for a given device
1084 * @dev: Pointer to the device
1085 * @addr: Address of buffer to store the MAC in
1086 * @alen: Length of the buffer pointed to by addr, should be ETH_ALEN
1087 *
1088 * Search the firmware node for the best MAC address to use. 'mac-address' is
Jeremy Linton4c96b7d2015-08-12 17:06:26 -05001089 * checked first, because that is supposed to contain to "most recent" MAC
1090 * address. If that isn't set, then 'local-mac-address' is checked next,
1091 * because that is the default address. If that isn't set, then the obsolete
1092 * 'address' is checked, just in case we're using an old device tree.
1093 *
1094 * Note that the 'address' property is supposed to contain a virtual address of
1095 * the register set, but some DTS files have redefined that property to be the
1096 * MAC address.
1097 *
1098 * All-zero MAC addresses are rejected, because those could be properties that
Jeremy Linton2f710a32015-08-19 11:46:42 -05001099 * exist in the firmware tables, but were not updated by the firmware. For
1100 * example, the DTS could define 'mac-address' and 'local-mac-address', with
1101 * zero MAC addresses. Some older U-Boots only initialized 'local-mac-address'.
1102 * In this case, the real MAC is in 'local-mac-address', and 'mac-address'
1103 * exists but is all zeros.
Jeremy Linton4c96b7d2015-08-12 17:06:26 -05001104*/
1105void *device_get_mac_address(struct device *dev, char *addr, int alen)
1106{
Julien Grall5b902d62015-09-03 23:59:50 +01001107 char *res;
Jeremy Linton4c96b7d2015-08-12 17:06:26 -05001108
Julien Grall5b902d62015-09-03 23:59:50 +01001109 res = device_get_mac_addr(dev, "mac-address", addr, alen);
1110 if (res)
1111 return res;
1112
1113 res = device_get_mac_addr(dev, "local-mac-address", addr, alen);
1114 if (res)
1115 return res;
Jeremy Linton4c96b7d2015-08-12 17:06:26 -05001116
1117 return device_get_mac_addr(dev, "address", addr, alen);
1118}
1119EXPORT_SYMBOL(device_get_mac_address);