183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
29e512045SSimon Glass /*
39e512045SSimon Glass * Copyright (c) 2017 Google, Inc
49e512045SSimon Glass * Written by Simon Glass <sjg@chromium.org>
59e512045SSimon Glass */
69e512045SSimon Glass
79e512045SSimon Glass #include <common.h>
89e512045SSimon Glass #include <dm.h>
99e512045SSimon Glass #include <fdtdec.h>
109e512045SSimon Glass #include <fdt_support.h>
11b08c8c48SMasahiro Yamada #include <linux/libfdt.h>
129e512045SSimon Glass #include <dm/of_access.h>
13bed77496SSimon Glass #include <dm/of_addr.h>
149e512045SSimon Glass #include <dm/ofnode.h>
159e512045SSimon Glass #include <linux/err.h>
16dcf98852SSimon Glass #include <linux/ioport.h>
179e512045SSimon Glass
ofnode_read_u32(ofnode node,const char * propname,u32 * outp)189e512045SSimon Glass int ofnode_read_u32(ofnode node, const char *propname, u32 *outp)
199e512045SSimon Glass {
209e512045SSimon Glass assert(ofnode_valid(node));
219e512045SSimon Glass debug("%s: %s: ", __func__, propname);
229e512045SSimon Glass
239e512045SSimon Glass if (ofnode_is_np(node)) {
249e512045SSimon Glass return of_read_u32(ofnode_to_np(node), propname, outp);
259e512045SSimon Glass } else {
268c9eaadaSMasahiro Yamada const fdt32_t *cell;
279e512045SSimon Glass int len;
289e512045SSimon Glass
299e512045SSimon Glass cell = fdt_getprop(gd->fdt_blob, ofnode_to_offset(node),
309e512045SSimon Glass propname, &len);
319e512045SSimon Glass if (!cell || len < sizeof(int)) {
329e512045SSimon Glass debug("(not found)\n");
339e512045SSimon Glass return -EINVAL;
349e512045SSimon Glass }
359e512045SSimon Glass *outp = fdt32_to_cpu(cell[0]);
369e512045SSimon Glass }
379e512045SSimon Glass debug("%#x (%d)\n", *outp, *outp);
389e512045SSimon Glass
399e512045SSimon Glass return 0;
409e512045SSimon Glass }
419e512045SSimon Glass
ofnode_read_u32_default(ofnode node,const char * propname,u32 def)429e512045SSimon Glass int ofnode_read_u32_default(ofnode node, const char *propname, u32 def)
439e512045SSimon Glass {
449e512045SSimon Glass assert(ofnode_valid(node));
459e512045SSimon Glass ofnode_read_u32(node, propname, &def);
469e512045SSimon Glass
479e512045SSimon Glass return def;
489e512045SSimon Glass }
499e512045SSimon Glass
ofnode_read_s32_default(ofnode node,const char * propname,s32 def)509e512045SSimon Glass int ofnode_read_s32_default(ofnode node, const char *propname, s32 def)
519e512045SSimon Glass {
529e512045SSimon Glass assert(ofnode_valid(node));
539e512045SSimon Glass ofnode_read_u32(node, propname, (u32 *)&def);
549e512045SSimon Glass
559e512045SSimon Glass return def;
569e512045SSimon Glass }
579e512045SSimon Glass
ofnode_read_u64(ofnode node,const char * propname,u64 * outp)587e5196c4SSimon Glass int ofnode_read_u64(ofnode node, const char *propname, u64 *outp)
597e5196c4SSimon Glass {
607e5196c4SSimon Glass const fdt64_t *cell;
617e5196c4SSimon Glass int len;
627e5196c4SSimon Glass
637e5196c4SSimon Glass assert(ofnode_valid(node));
647e5196c4SSimon Glass debug("%s: %s: ", __func__, propname);
657e5196c4SSimon Glass
667e5196c4SSimon Glass if (ofnode_is_np(node))
677e5196c4SSimon Glass return of_read_u64(ofnode_to_np(node), propname, outp);
687e5196c4SSimon Glass
697e5196c4SSimon Glass cell = fdt_getprop(gd->fdt_blob, ofnode_to_offset(node), propname,
707e5196c4SSimon Glass &len);
717e5196c4SSimon Glass if (!cell || len < sizeof(*cell)) {
727e5196c4SSimon Glass debug("(not found)\n");
737e5196c4SSimon Glass return -EINVAL;
747e5196c4SSimon Glass }
757e5196c4SSimon Glass *outp = fdt64_to_cpu(cell[0]);
767e5196c4SSimon Glass debug("%#llx (%lld)\n", (unsigned long long)*outp,
777e5196c4SSimon Glass (unsigned long long)*outp);
787e5196c4SSimon Glass
797e5196c4SSimon Glass return 0;
807e5196c4SSimon Glass }
817e5196c4SSimon Glass
ofnode_read_u64_default(ofnode node,const char * propname,u64 def)827e5196c4SSimon Glass int ofnode_read_u64_default(ofnode node, const char *propname, u64 def)
837e5196c4SSimon Glass {
847e5196c4SSimon Glass assert(ofnode_valid(node));
857e5196c4SSimon Glass ofnode_read_u64(node, propname, &def);
867e5196c4SSimon Glass
877e5196c4SSimon Glass return def;
887e5196c4SSimon Glass }
897e5196c4SSimon Glass
ofnode_read_bool(ofnode node,const char * propname)909e512045SSimon Glass bool ofnode_read_bool(ofnode node, const char *propname)
919e512045SSimon Glass {
92b2ec7ea7SMasahiro Yamada const void *prop;
939e512045SSimon Glass
949e512045SSimon Glass assert(ofnode_valid(node));
959e512045SSimon Glass debug("%s: %s: ", __func__, propname);
969e512045SSimon Glass
97b2ec7ea7SMasahiro Yamada prop = ofnode_get_property(node, propname, NULL);
989e512045SSimon Glass
99b2ec7ea7SMasahiro Yamada debug("%s\n", prop ? "true" : "false");
100b2ec7ea7SMasahiro Yamada
101b2ec7ea7SMasahiro Yamada return prop ? true : false;
1029e512045SSimon Glass }
1039e512045SSimon Glass
ofnode_read_string(ofnode node,const char * propname)1049e512045SSimon Glass const char *ofnode_read_string(ofnode node, const char *propname)
1059e512045SSimon Glass {
1069e512045SSimon Glass const char *str = NULL;
1079e512045SSimon Glass int len = -1;
1089e512045SSimon Glass
1099e512045SSimon Glass assert(ofnode_valid(node));
1109e512045SSimon Glass debug("%s: %s: ", __func__, propname);
1119e512045SSimon Glass
1129e512045SSimon Glass if (ofnode_is_np(node)) {
1139e512045SSimon Glass struct property *prop = of_find_property(
1149e512045SSimon Glass ofnode_to_np(node), propname, NULL);
1159e512045SSimon Glass
1169e512045SSimon Glass if (prop) {
1179e512045SSimon Glass str = prop->value;
1189e512045SSimon Glass len = prop->length;
1199e512045SSimon Glass }
1209e512045SSimon Glass } else {
1219e512045SSimon Glass str = fdt_getprop(gd->fdt_blob, ofnode_to_offset(node),
1229e512045SSimon Glass propname, &len);
1239e512045SSimon Glass }
1249e512045SSimon Glass if (!str) {
1259e512045SSimon Glass debug("<not found>\n");
1269e512045SSimon Glass return NULL;
1279e512045SSimon Glass }
1289e512045SSimon Glass if (strnlen(str, len) >= len) {
1299e512045SSimon Glass debug("<invalid>\n");
1309e512045SSimon Glass return NULL;
1319e512045SSimon Glass }
1329e512045SSimon Glass debug("%s\n", str);
1339e512045SSimon Glass
1349e512045SSimon Glass return str;
1359e512045SSimon Glass }
1369e512045SSimon Glass
ofnode_find_subnode(ofnode node,const char * subnode_name)1379e512045SSimon Glass ofnode ofnode_find_subnode(ofnode node, const char *subnode_name)
1389e512045SSimon Glass {
1399e512045SSimon Glass ofnode subnode;
1409e512045SSimon Glass
1419e512045SSimon Glass assert(ofnode_valid(node));
1429e512045SSimon Glass debug("%s: %s: ", __func__, subnode_name);
1439e512045SSimon Glass
1449e512045SSimon Glass if (ofnode_is_np(node)) {
1459e512045SSimon Glass const struct device_node *np = ofnode_to_np(node);
1469e512045SSimon Glass
1479e512045SSimon Glass for (np = np->child; np; np = np->sibling) {
1489e512045SSimon Glass if (!strcmp(subnode_name, np->name))
1499e512045SSimon Glass break;
1509e512045SSimon Glass }
1519e512045SSimon Glass subnode = np_to_ofnode(np);
1529e512045SSimon Glass } else {
1539e512045SSimon Glass int ooffset = fdt_subnode_offset(gd->fdt_blob,
1549e512045SSimon Glass ofnode_to_offset(node), subnode_name);
1559e512045SSimon Glass subnode = offset_to_ofnode(ooffset);
1569e512045SSimon Glass }
1579e512045SSimon Glass debug("%s\n", ofnode_valid(subnode) ?
1589e512045SSimon Glass ofnode_get_name(subnode) : "<none>");
1599e512045SSimon Glass
1609e512045SSimon Glass return subnode;
1619e512045SSimon Glass }
1629e512045SSimon Glass
ofnode_read_u32_array(ofnode node,const char * propname,u32 * out_values,size_t sz)1639e512045SSimon Glass int ofnode_read_u32_array(ofnode node, const char *propname,
1649e512045SSimon Glass u32 *out_values, size_t sz)
1659e512045SSimon Glass {
1669e512045SSimon Glass assert(ofnode_valid(node));
1679e512045SSimon Glass debug("%s: %s: ", __func__, propname);
1689e512045SSimon Glass
1699e512045SSimon Glass if (ofnode_is_np(node)) {
1709e512045SSimon Glass return of_read_u32_array(ofnode_to_np(node), propname,
1719e512045SSimon Glass out_values, sz);
1729e512045SSimon Glass } else {
1739e512045SSimon Glass return fdtdec_get_int_array(gd->fdt_blob,
1749e512045SSimon Glass ofnode_to_offset(node), propname,
1759e512045SSimon Glass out_values, sz);
1769e512045SSimon Glass }
1779e512045SSimon Glass }
1789e512045SSimon Glass
ofnode_first_subnode(ofnode node)1799e512045SSimon Glass ofnode ofnode_first_subnode(ofnode node)
1809e512045SSimon Glass {
1819e512045SSimon Glass assert(ofnode_valid(node));
1829e512045SSimon Glass if (ofnode_is_np(node))
1839e512045SSimon Glass return np_to_ofnode(node.np->child);
1849e512045SSimon Glass
1859e512045SSimon Glass return offset_to_ofnode(
1869e512045SSimon Glass fdt_first_subnode(gd->fdt_blob, ofnode_to_offset(node)));
1879e512045SSimon Glass }
1889e512045SSimon Glass
ofnode_next_subnode(ofnode node)1899e512045SSimon Glass ofnode ofnode_next_subnode(ofnode node)
1909e512045SSimon Glass {
1919e512045SSimon Glass assert(ofnode_valid(node));
1929e512045SSimon Glass if (ofnode_is_np(node))
1939e512045SSimon Glass return np_to_ofnode(node.np->sibling);
1949e512045SSimon Glass
1959e512045SSimon Glass return offset_to_ofnode(
1969e512045SSimon Glass fdt_next_subnode(gd->fdt_blob, ofnode_to_offset(node)));
1979e512045SSimon Glass }
1989e512045SSimon Glass
ofnode_get_parent(ofnode node)199e2d5997fSPhilipp Tomsich ofnode ofnode_get_parent(ofnode node)
200e2d5997fSPhilipp Tomsich {
201e2d5997fSPhilipp Tomsich ofnode parent;
202e2d5997fSPhilipp Tomsich
203e2d5997fSPhilipp Tomsich assert(ofnode_valid(node));
204e2d5997fSPhilipp Tomsich if (ofnode_is_np(node))
205e2d5997fSPhilipp Tomsich parent = np_to_ofnode(of_get_parent(ofnode_to_np(node)));
206e2d5997fSPhilipp Tomsich else
207e2d5997fSPhilipp Tomsich parent.of_offset = fdt_parent_offset(gd->fdt_blob,
208e2d5997fSPhilipp Tomsich ofnode_to_offset(node));
209e2d5997fSPhilipp Tomsich
210e2d5997fSPhilipp Tomsich return parent;
211e2d5997fSPhilipp Tomsich }
212e2d5997fSPhilipp Tomsich
ofnode_get_name(ofnode node)2139e512045SSimon Glass const char *ofnode_get_name(ofnode node)
2149e512045SSimon Glass {
2159e512045SSimon Glass assert(ofnode_valid(node));
2169e512045SSimon Glass if (ofnode_is_np(node))
2179e512045SSimon Glass return strrchr(node.np->full_name, '/') + 1;
2189e512045SSimon Glass
2199e512045SSimon Glass return fdt_get_name(gd->fdt_blob, ofnode_to_offset(node), NULL);
2209e512045SSimon Glass }
2219e512045SSimon Glass
ofnode_get_by_phandle(uint phandle)222b4f20767SKever Yang ofnode ofnode_get_by_phandle(uint phandle)
223b4f20767SKever Yang {
224b4f20767SKever Yang ofnode node;
225b4f20767SKever Yang
226b4f20767SKever Yang if (of_live_active())
227b4f20767SKever Yang node = np_to_ofnode(of_find_node_by_phandle(phandle));
228b4f20767SKever Yang else
229b4f20767SKever Yang node.of_offset = fdt_node_offset_by_phandle(gd->fdt_blob,
230b4f20767SKever Yang phandle);
231b4f20767SKever Yang
232b4f20767SKever Yang return node;
233b4f20767SKever Yang }
234b4f20767SKever Yang
ofnode_read_size(ofnode node,const char * propname)2359e512045SSimon Glass int ofnode_read_size(ofnode node, const char *propname)
2369e512045SSimon Glass {
2379e512045SSimon Glass int len;
2389e512045SSimon Glass
2399e512045SSimon Glass if (ofnode_is_np(node)) {
2409e512045SSimon Glass struct property *prop = of_find_property(
2419e512045SSimon Glass ofnode_to_np(node), propname, NULL);
2429e512045SSimon Glass
2439e512045SSimon Glass if (prop)
2449e512045SSimon Glass return prop->length;
2459e512045SSimon Glass } else {
2469e512045SSimon Glass if (fdt_getprop(gd->fdt_blob, ofnode_to_offset(node), propname,
2479e512045SSimon Glass &len))
2489e512045SSimon Glass return len;
2499e512045SSimon Glass }
2509e512045SSimon Glass
2519e512045SSimon Glass return -EINVAL;
2529e512045SSimon Glass }
2539e512045SSimon Glass
ofnode_get_addr_index(ofnode node,int index)254bed77496SSimon Glass fdt_addr_t ofnode_get_addr_index(ofnode node, int index)
255bed77496SSimon Glass {
256*1678754fSKeerthy int na, ns;
257*1678754fSKeerthy fdt_size_t size;
258*1678754fSKeerthy
259bed77496SSimon Glass if (ofnode_is_np(node)) {
260bed77496SSimon Glass const __be32 *prop_val;
261bed77496SSimon Glass uint flags;
262bed77496SSimon Glass
263*1678754fSKeerthy prop_val = of_get_address(ofnode_to_np(node), index,
264*1678754fSKeerthy (u64 *)&size, &flags);
265bed77496SSimon Glass if (!prop_val)
266bed77496SSimon Glass return FDT_ADDR_T_NONE;
267286ede65SMario Six
268e8d52918SMario Six ns = of_n_size_cells(ofnode_to_np(node));
269e8d52918SMario Six
270e8d52918SMario Six if (IS_ENABLED(CONFIG_OF_TRANSLATE) && ns > 0) {
271286ede65SMario Six return of_translate_address(ofnode_to_np(node), prop_val);
272286ede65SMario Six } else {
2730f6507a7SSimon Glass na = of_n_addr_cells(ofnode_to_np(node));
2740f6507a7SSimon Glass return of_read_number(prop_val, na);
275286ede65SMario Six }
276bed77496SSimon Glass } else {
277*1678754fSKeerthy na = ofnode_read_simple_addr_cells(ofnode_get_parent(node));
278*1678754fSKeerthy ns = ofnode_read_simple_size_cells(ofnode_get_parent(node));
279*1678754fSKeerthy return fdtdec_get_addr_size_fixed(gd->fdt_blob,
280*1678754fSKeerthy ofnode_to_offset(node), "reg",
281*1678754fSKeerthy index, na, ns, &size, true);
282bed77496SSimon Glass }
283bed77496SSimon Glass
284bed77496SSimon Glass return FDT_ADDR_T_NONE;
285bed77496SSimon Glass }
286bed77496SSimon Glass
ofnode_get_addr(ofnode node)287bed77496SSimon Glass fdt_addr_t ofnode_get_addr(ofnode node)
288bed77496SSimon Glass {
289bed77496SSimon Glass return ofnode_get_addr_index(node, 0);
290bed77496SSimon Glass }
291bed77496SSimon Glass
ofnode_stringlist_search(ofnode node,const char * property,const char * string)2929e512045SSimon Glass int ofnode_stringlist_search(ofnode node, const char *property,
2939e512045SSimon Glass const char *string)
2949e512045SSimon Glass {
2959e512045SSimon Glass if (ofnode_is_np(node)) {
2969e512045SSimon Glass return of_property_match_string(ofnode_to_np(node),
2979e512045SSimon Glass property, string);
2989e512045SSimon Glass } else {
2999e512045SSimon Glass int ret;
3009e512045SSimon Glass
3019e512045SSimon Glass ret = fdt_stringlist_search(gd->fdt_blob,
3029e512045SSimon Glass ofnode_to_offset(node), property,
3039e512045SSimon Glass string);
3049e512045SSimon Glass if (ret == -FDT_ERR_NOTFOUND)
3059e512045SSimon Glass return -ENODATA;
3069e512045SSimon Glass else if (ret < 0)
3079e512045SSimon Glass return -EINVAL;
3089e512045SSimon Glass
3099e512045SSimon Glass return ret;
3109e512045SSimon Glass }
3119e512045SSimon Glass }
3129e512045SSimon Glass
ofnode_read_string_index(ofnode node,const char * property,int index,const char ** outp)3139e512045SSimon Glass int ofnode_read_string_index(ofnode node, const char *property, int index,
3149e512045SSimon Glass const char **outp)
3159e512045SSimon Glass {
3169e512045SSimon Glass if (ofnode_is_np(node)) {
3179e512045SSimon Glass return of_property_read_string_index(ofnode_to_np(node),
3189e512045SSimon Glass property, index, outp);
3199e512045SSimon Glass } else {
3209e512045SSimon Glass int len;
3219e512045SSimon Glass
3229e512045SSimon Glass *outp = fdt_stringlist_get(gd->fdt_blob, ofnode_to_offset(node),
3239e512045SSimon Glass property, index, &len);
3249e512045SSimon Glass if (len < 0)
3259e512045SSimon Glass return -EINVAL;
3269e512045SSimon Glass return 0;
3279e512045SSimon Glass }
3289e512045SSimon Glass }
3299e512045SSimon Glass
ofnode_read_string_count(ofnode node,const char * property)3308c293d6aSSimon Glass int ofnode_read_string_count(ofnode node, const char *property)
3318c293d6aSSimon Glass {
3328c293d6aSSimon Glass if (ofnode_is_np(node)) {
3338c293d6aSSimon Glass return of_property_count_strings(ofnode_to_np(node), property);
3348c293d6aSSimon Glass } else {
3358c293d6aSSimon Glass return fdt_stringlist_count(gd->fdt_blob,
3368c293d6aSSimon Glass ofnode_to_offset(node), property);
3378c293d6aSSimon Glass }
3388c293d6aSSimon Glass }
3398c293d6aSSimon Glass
ofnode_from_fdtdec_phandle_args(struct fdtdec_phandle_args * in,struct ofnode_phandle_args * out)3409e512045SSimon Glass static void ofnode_from_fdtdec_phandle_args(struct fdtdec_phandle_args *in,
3419e512045SSimon Glass struct ofnode_phandle_args *out)
3429e512045SSimon Glass {
3439e512045SSimon Glass assert(OF_MAX_PHANDLE_ARGS == MAX_PHANDLE_ARGS);
3449e512045SSimon Glass out->node = offset_to_ofnode(in->node);
3459e512045SSimon Glass out->args_count = in->args_count;
3469e512045SSimon Glass memcpy(out->args, in->args, sizeof(out->args));
3479e512045SSimon Glass }
3489e512045SSimon Glass
ofnode_from_of_phandle_args(struct of_phandle_args * in,struct ofnode_phandle_args * out)3499e512045SSimon Glass static void ofnode_from_of_phandle_args(struct of_phandle_args *in,
3509e512045SSimon Glass struct ofnode_phandle_args *out)
3519e512045SSimon Glass {
3529e512045SSimon Glass assert(OF_MAX_PHANDLE_ARGS == MAX_PHANDLE_ARGS);
3539e512045SSimon Glass out->node = np_to_ofnode(in->np);
3549e512045SSimon Glass out->args_count = in->args_count;
3559e512045SSimon Glass memcpy(out->args, in->args, sizeof(out->args));
3569e512045SSimon Glass }
3579e512045SSimon Glass
ofnode_parse_phandle_with_args(ofnode node,const char * list_name,const char * cells_name,int cell_count,int index,struct ofnode_phandle_args * out_args)3589e512045SSimon Glass int ofnode_parse_phandle_with_args(ofnode node, const char *list_name,
3599e512045SSimon Glass const char *cells_name, int cell_count,
3609e512045SSimon Glass int index,
3619e512045SSimon Glass struct ofnode_phandle_args *out_args)
3629e512045SSimon Glass {
3639e512045SSimon Glass if (ofnode_is_np(node)) {
3649e512045SSimon Glass struct of_phandle_args args;
3659e512045SSimon Glass int ret;
3669e512045SSimon Glass
3679e512045SSimon Glass ret = of_parse_phandle_with_args(ofnode_to_np(node),
36851db287aSMario Six list_name, cells_name, index,
36951db287aSMario Six &args);
3709e512045SSimon Glass if (ret)
3719e512045SSimon Glass return ret;
3729e512045SSimon Glass ofnode_from_of_phandle_args(&args, out_args);
3739e512045SSimon Glass } else {
3749e512045SSimon Glass struct fdtdec_phandle_args args;
3759e512045SSimon Glass int ret;
3769e512045SSimon Glass
3779e512045SSimon Glass ret = fdtdec_parse_phandle_with_args(gd->fdt_blob,
37851db287aSMario Six ofnode_to_offset(node),
37951db287aSMario Six list_name, cells_name,
3809e512045SSimon Glass cell_count, index, &args);
3819e512045SSimon Glass if (ret)
3829e512045SSimon Glass return ret;
3839e512045SSimon Glass ofnode_from_fdtdec_phandle_args(&args, out_args);
3849e512045SSimon Glass }
3859e512045SSimon Glass
3869e512045SSimon Glass return 0;
3879e512045SSimon Glass }
3889e512045SSimon Glass
ofnode_count_phandle_with_args(ofnode node,const char * list_name,const char * cells_name)389642346aeSPatrice Chotard int ofnode_count_phandle_with_args(ofnode node, const char *list_name,
390642346aeSPatrice Chotard const char *cells_name)
391642346aeSPatrice Chotard {
392642346aeSPatrice Chotard if (ofnode_is_np(node))
393642346aeSPatrice Chotard return of_count_phandle_with_args(ofnode_to_np(node),
394642346aeSPatrice Chotard list_name, cells_name);
395642346aeSPatrice Chotard else
396642346aeSPatrice Chotard return fdtdec_parse_phandle_with_args(gd->fdt_blob,
397642346aeSPatrice Chotard ofnode_to_offset(node), list_name, cells_name,
398642346aeSPatrice Chotard 0, -1, NULL);
399642346aeSPatrice Chotard }
400642346aeSPatrice Chotard
ofnode_path(const char * path)4019e512045SSimon Glass ofnode ofnode_path(const char *path)
4029e512045SSimon Glass {
4039e512045SSimon Glass if (of_live_active())
4049e512045SSimon Glass return np_to_ofnode(of_find_node_by_path(path));
4059e512045SSimon Glass else
4069e512045SSimon Glass return offset_to_ofnode(fdt_path_offset(gd->fdt_blob, path));
4079e512045SSimon Glass }
4089e512045SSimon Glass
ofnode_get_chosen_prop(const char * name)4099e512045SSimon Glass const char *ofnode_get_chosen_prop(const char *name)
4109e512045SSimon Glass {
4119e512045SSimon Glass ofnode chosen_node;
4129e512045SSimon Glass
4139e512045SSimon Glass chosen_node = ofnode_path("/chosen");
4149e512045SSimon Glass
4159e512045SSimon Glass return ofnode_read_string(chosen_node, name);
4169e512045SSimon Glass }
4179e512045SSimon Glass
ofnode_get_chosen_node(const char * name)4189e512045SSimon Glass ofnode ofnode_get_chosen_node(const char *name)
4199e512045SSimon Glass {
4209e512045SSimon Glass const char *prop;
4219e512045SSimon Glass
4229e512045SSimon Glass prop = ofnode_get_chosen_prop(name);
4239e512045SSimon Glass if (!prop)
4249e512045SSimon Glass return ofnode_null();
4259e512045SSimon Glass
4269e512045SSimon Glass return ofnode_path(prop);
4279e512045SSimon Glass }
4289e512045SSimon Glass
decode_timing_property(ofnode node,const char * name,struct timing_entry * result)4299e512045SSimon Glass static int decode_timing_property(ofnode node, const char *name,
4309e512045SSimon Glass struct timing_entry *result)
4319e512045SSimon Glass {
4329e512045SSimon Glass int length, ret = 0;
4339e512045SSimon Glass
4349e512045SSimon Glass length = ofnode_read_size(node, name);
4359e512045SSimon Glass if (length < 0) {
4369e512045SSimon Glass debug("%s: could not find property %s\n",
4379e512045SSimon Glass ofnode_get_name(node), name);
4389e512045SSimon Glass return length;
4399e512045SSimon Glass }
4409e512045SSimon Glass
4419e512045SSimon Glass if (length == sizeof(u32)) {
4429e512045SSimon Glass result->typ = ofnode_read_u32_default(node, name, 0);
4439e512045SSimon Glass result->min = result->typ;
4449e512045SSimon Glass result->max = result->typ;
4459e512045SSimon Glass } else {
4469e512045SSimon Glass ret = ofnode_read_u32_array(node, name, &result->min, 3);
4479e512045SSimon Glass }
4489e512045SSimon Glass
4499e512045SSimon Glass return ret;
4509e512045SSimon Glass }
4519e512045SSimon Glass
ofnode_decode_display_timing(ofnode parent,int index,struct display_timing * dt)4529e512045SSimon Glass int ofnode_decode_display_timing(ofnode parent, int index,
4539e512045SSimon Glass struct display_timing *dt)
4549e512045SSimon Glass {
4559e512045SSimon Glass int i;
4569e512045SSimon Glass ofnode timings, node;
4579e512045SSimon Glass u32 val = 0;
4589e512045SSimon Glass int ret = 0;
4599e512045SSimon Glass
4609e512045SSimon Glass timings = ofnode_find_subnode(parent, "display-timings");
4619e512045SSimon Glass if (!ofnode_valid(timings))
4629e512045SSimon Glass return -EINVAL;
4639e512045SSimon Glass
4643991f42eSSimon Glass i = 0;
4653991f42eSSimon Glass ofnode_for_each_subnode(node, timings) {
4663991f42eSSimon Glass if (i++ == index)
4673991f42eSSimon Glass break;
4683991f42eSSimon Glass }
4699e512045SSimon Glass
4709e512045SSimon Glass if (!ofnode_valid(node))
4719e512045SSimon Glass return -EINVAL;
4729e512045SSimon Glass
4739e512045SSimon Glass memset(dt, 0, sizeof(*dt));
4749e512045SSimon Glass
4759e512045SSimon Glass ret |= decode_timing_property(node, "hback-porch", &dt->hback_porch);
4769e512045SSimon Glass ret |= decode_timing_property(node, "hfront-porch", &dt->hfront_porch);
4779e512045SSimon Glass ret |= decode_timing_property(node, "hactive", &dt->hactive);
4789e512045SSimon Glass ret |= decode_timing_property(node, "hsync-len", &dt->hsync_len);
4799e512045SSimon Glass ret |= decode_timing_property(node, "vback-porch", &dt->vback_porch);
4809e512045SSimon Glass ret |= decode_timing_property(node, "vfront-porch", &dt->vfront_porch);
4819e512045SSimon Glass ret |= decode_timing_property(node, "vactive", &dt->vactive);
4829e512045SSimon Glass ret |= decode_timing_property(node, "vsync-len", &dt->vsync_len);
4839e512045SSimon Glass ret |= decode_timing_property(node, "clock-frequency", &dt->pixelclock);
4849e512045SSimon Glass
4859e512045SSimon Glass dt->flags = 0;
4869e512045SSimon Glass val = ofnode_read_u32_default(node, "vsync-active", -1);
4879e512045SSimon Glass if (val != -1) {
4889e512045SSimon Glass dt->flags |= val ? DISPLAY_FLAGS_VSYNC_HIGH :
4899e512045SSimon Glass DISPLAY_FLAGS_VSYNC_LOW;
4909e512045SSimon Glass }
4919e512045SSimon Glass val = ofnode_read_u32_default(node, "hsync-active", -1);
4929e512045SSimon Glass if (val != -1) {
4939e512045SSimon Glass dt->flags |= val ? DISPLAY_FLAGS_HSYNC_HIGH :
4949e512045SSimon Glass DISPLAY_FLAGS_HSYNC_LOW;
4959e512045SSimon Glass }
4969e512045SSimon Glass val = ofnode_read_u32_default(node, "de-active", -1);
4979e512045SSimon Glass if (val != -1) {
4989e512045SSimon Glass dt->flags |= val ? DISPLAY_FLAGS_DE_HIGH :
4999e512045SSimon Glass DISPLAY_FLAGS_DE_LOW;
5009e512045SSimon Glass }
5019e512045SSimon Glass val = ofnode_read_u32_default(node, "pixelclk-active", -1);
5029e512045SSimon Glass if (val != -1) {
5039e512045SSimon Glass dt->flags |= val ? DISPLAY_FLAGS_PIXDATA_POSEDGE :
5049e512045SSimon Glass DISPLAY_FLAGS_PIXDATA_NEGEDGE;
5059e512045SSimon Glass }
5069e512045SSimon Glass
5079e512045SSimon Glass if (ofnode_read_bool(node, "interlaced"))
5089e512045SSimon Glass dt->flags |= DISPLAY_FLAGS_INTERLACED;
5099e512045SSimon Glass if (ofnode_read_bool(node, "doublescan"))
5109e512045SSimon Glass dt->flags |= DISPLAY_FLAGS_DOUBLESCAN;
5119e512045SSimon Glass if (ofnode_read_bool(node, "doubleclk"))
5129e512045SSimon Glass dt->flags |= DISPLAY_FLAGS_DOUBLECLK;
5139e512045SSimon Glass
5149e512045SSimon Glass return ret;
5159e512045SSimon Glass }
5169e512045SSimon Glass
ofnode_get_property(ofnode node,const char * propname,int * lenp)51761e51babSMasahiro Yamada const void *ofnode_get_property(ofnode node, const char *propname, int *lenp)
5189e512045SSimon Glass {
519cb7dbe1fSMasahiro Yamada if (ofnode_is_np(node))
520cb7dbe1fSMasahiro Yamada return of_get_property(ofnode_to_np(node), propname, lenp);
521cb7dbe1fSMasahiro Yamada else
5229e512045SSimon Glass return fdt_getprop(gd->fdt_blob, ofnode_to_offset(node),
5239e512045SSimon Glass propname, lenp);
5249e512045SSimon Glass }
5259e512045SSimon Glass
ofnode_is_available(ofnode node)5269e512045SSimon Glass bool ofnode_is_available(ofnode node)
5279e512045SSimon Glass {
5289e512045SSimon Glass if (ofnode_is_np(node))
5299e512045SSimon Glass return of_device_is_available(ofnode_to_np(node));
5309e512045SSimon Glass else
5319e512045SSimon Glass return fdtdec_get_is_enabled(gd->fdt_blob,
5329e512045SSimon Glass ofnode_to_offset(node));
5339e512045SSimon Glass }
5349e512045SSimon Glass
ofnode_get_addr_size(ofnode node,const char * property,fdt_size_t * sizep)5359e512045SSimon Glass fdt_addr_t ofnode_get_addr_size(ofnode node, const char *property,
5369e512045SSimon Glass fdt_size_t *sizep)
5379e512045SSimon Glass {
5389e512045SSimon Glass if (ofnode_is_np(node)) {
5399e512045SSimon Glass int na, ns;
5409e512045SSimon Glass int psize;
5419e512045SSimon Glass const struct device_node *np = ofnode_to_np(node);
54268a34529SKlaus Goger const __be32 *prop = of_get_property(np, property, &psize);
5439e512045SSimon Glass
54468a34529SKlaus Goger if (!prop)
54568a34529SKlaus Goger return FDT_ADDR_T_NONE;
5469e512045SSimon Glass na = of_n_addr_cells(np);
54751cb9275SMarek Vasut ns = of_n_size_cells(np);
548a4b8e372SSimon Glass *sizep = of_read_number(prop + na, ns);
549a6a45cd3SMarek Vasut
550a6a45cd3SMarek Vasut if (IS_ENABLED(CONFIG_OF_TRANSLATE) && ns > 0)
551a6a45cd3SMarek Vasut return of_translate_address(np, prop);
552a6a45cd3SMarek Vasut else
553a4b8e372SSimon Glass return of_read_number(prop, na);
5549e512045SSimon Glass } else {
5559e512045SSimon Glass return fdtdec_get_addr_size(gd->fdt_blob,
5569e512045SSimon Glass ofnode_to_offset(node), property,
5579e512045SSimon Glass sizep);
5589e512045SSimon Glass }
5599e512045SSimon Glass }
5609e512045SSimon Glass
ofnode_read_u8_array_ptr(ofnode node,const char * propname,size_t sz)5619e512045SSimon Glass const uint8_t *ofnode_read_u8_array_ptr(ofnode node, const char *propname,
5629e512045SSimon Glass size_t sz)
5639e512045SSimon Glass {
5649e512045SSimon Glass if (ofnode_is_np(node)) {
5659e512045SSimon Glass const struct device_node *np = ofnode_to_np(node);
5669e512045SSimon Glass int psize;
5679e512045SSimon Glass const __be32 *prop = of_get_property(np, propname, &psize);
5689e512045SSimon Glass
5699e512045SSimon Glass if (!prop || sz != psize)
5709e512045SSimon Glass return NULL;
5719e512045SSimon Glass return (uint8_t *)prop;
5729e512045SSimon Glass
5739e512045SSimon Glass } else {
5749e512045SSimon Glass return fdtdec_locate_byte_array(gd->fdt_blob,
5759e512045SSimon Glass ofnode_to_offset(node), propname, sz);
5769e512045SSimon Glass }
5779e512045SSimon Glass }
5789e512045SSimon Glass
ofnode_read_pci_addr(ofnode node,enum fdt_pci_space type,const char * propname,struct fdt_pci_addr * addr)5799e512045SSimon Glass int ofnode_read_pci_addr(ofnode node, enum fdt_pci_space type,
5809e512045SSimon Glass const char *propname, struct fdt_pci_addr *addr)
5819e512045SSimon Glass {
5828c9eaadaSMasahiro Yamada const fdt32_t *cell;
5839e512045SSimon Glass int len;
5849e512045SSimon Glass int ret = -ENOENT;
5859e512045SSimon Glass
5869e512045SSimon Glass debug("%s: %s: ", __func__, propname);
5879e512045SSimon Glass
5889e512045SSimon Glass /*
5899e512045SSimon Glass * If we follow the pci bus bindings strictly, we should check
5909e512045SSimon Glass * the value of the node's parent node's #address-cells and
5919e512045SSimon Glass * #size-cells. They need to be 3 and 2 accordingly. However,
5929e512045SSimon Glass * for simplicity we skip the check here.
5939e512045SSimon Glass */
59461e51babSMasahiro Yamada cell = ofnode_get_property(node, propname, &len);
5959e512045SSimon Glass if (!cell)
5969e512045SSimon Glass goto fail;
5979e512045SSimon Glass
5989e512045SSimon Glass if ((len % FDT_PCI_REG_SIZE) == 0) {
5999e512045SSimon Glass int num = len / FDT_PCI_REG_SIZE;
6009e512045SSimon Glass int i;
6019e512045SSimon Glass
6029e512045SSimon Glass for (i = 0; i < num; i++) {
6039e512045SSimon Glass debug("pci address #%d: %08lx %08lx %08lx\n", i,
6049e512045SSimon Glass (ulong)fdt32_to_cpu(cell[0]),
6059e512045SSimon Glass (ulong)fdt32_to_cpu(cell[1]),
6069e512045SSimon Glass (ulong)fdt32_to_cpu(cell[2]));
6079e512045SSimon Glass if ((fdt32_to_cpu(*cell) & type) == type) {
6089e512045SSimon Glass addr->phys_hi = fdt32_to_cpu(cell[0]);
6099e512045SSimon Glass addr->phys_mid = fdt32_to_cpu(cell[1]);
6109e512045SSimon Glass addr->phys_lo = fdt32_to_cpu(cell[1]);
6119e512045SSimon Glass break;
61251db287aSMario Six }
61351db287aSMario Six
6149e512045SSimon Glass cell += (FDT_PCI_ADDR_CELLS +
6159e512045SSimon Glass FDT_PCI_SIZE_CELLS);
6169e512045SSimon Glass }
6179e512045SSimon Glass
6189e512045SSimon Glass if (i == num) {
6199e512045SSimon Glass ret = -ENXIO;
6209e512045SSimon Glass goto fail;
6219e512045SSimon Glass }
6229e512045SSimon Glass
6239e512045SSimon Glass return 0;
6249e512045SSimon Glass }
6259e512045SSimon Glass
62651db287aSMario Six ret = -EINVAL;
62751db287aSMario Six
6289e512045SSimon Glass fail:
6299e512045SSimon Glass debug("(not found)\n");
6309e512045SSimon Glass return ret;
6319e512045SSimon Glass }
6329e512045SSimon Glass
ofnode_read_pci_vendev(ofnode node,u16 * vendor,u16 * device)6337b9cbaddSBin Meng int ofnode_read_pci_vendev(ofnode node, u16 *vendor, u16 *device)
6347b9cbaddSBin Meng {
6357b9cbaddSBin Meng const char *list, *end;
6367b9cbaddSBin Meng int len;
6377b9cbaddSBin Meng
6387b9cbaddSBin Meng list = ofnode_get_property(node, "compatible", &len);
6397b9cbaddSBin Meng if (!list)
6407b9cbaddSBin Meng return -ENOENT;
6417b9cbaddSBin Meng
6427b9cbaddSBin Meng end = list + len;
6437b9cbaddSBin Meng while (list < end) {
6447b9cbaddSBin Meng len = strlen(list);
6457b9cbaddSBin Meng if (len >= strlen("pciVVVV,DDDD")) {
6467b9cbaddSBin Meng char *s = strstr(list, "pci");
6477b9cbaddSBin Meng
6487b9cbaddSBin Meng /*
6497b9cbaddSBin Meng * check if the string is something like pciVVVV,DDDD.RR
6507b9cbaddSBin Meng * or just pciVVVV,DDDD
6517b9cbaddSBin Meng */
6527b9cbaddSBin Meng if (s && s[7] == ',' &&
6537b9cbaddSBin Meng (s[12] == '.' || s[12] == 0)) {
6547b9cbaddSBin Meng s += 3;
6557b9cbaddSBin Meng *vendor = simple_strtol(s, NULL, 16);
6567b9cbaddSBin Meng
6577b9cbaddSBin Meng s += 5;
6587b9cbaddSBin Meng *device = simple_strtol(s, NULL, 16);
6597b9cbaddSBin Meng
6607b9cbaddSBin Meng return 0;
6617b9cbaddSBin Meng }
6627b9cbaddSBin Meng }
6637b9cbaddSBin Meng list += (len + 1);
6647b9cbaddSBin Meng }
6657b9cbaddSBin Meng
6667b9cbaddSBin Meng return -ENOENT;
6677b9cbaddSBin Meng }
6687b9cbaddSBin Meng
ofnode_read_addr_cells(ofnode node)6699e512045SSimon Glass int ofnode_read_addr_cells(ofnode node)
6709e512045SSimon Glass {
6719e512045SSimon Glass if (ofnode_is_np(node))
6729e512045SSimon Glass return of_n_addr_cells(ofnode_to_np(node));
673878d68c0SSimon Glass else /* NOTE: this call should walk up the parent stack */
6749e512045SSimon Glass return fdt_address_cells(gd->fdt_blob, ofnode_to_offset(node));
6759e512045SSimon Glass }
6769e512045SSimon Glass
ofnode_read_size_cells(ofnode node)6779e512045SSimon Glass int ofnode_read_size_cells(ofnode node)
6789e512045SSimon Glass {
6799e512045SSimon Glass if (ofnode_is_np(node))
6809e512045SSimon Glass return of_n_size_cells(ofnode_to_np(node));
681878d68c0SSimon Glass else /* NOTE: this call should walk up the parent stack */
682878d68c0SSimon Glass return fdt_size_cells(gd->fdt_blob, ofnode_to_offset(node));
683878d68c0SSimon Glass }
684878d68c0SSimon Glass
ofnode_read_simple_addr_cells(ofnode node)685878d68c0SSimon Glass int ofnode_read_simple_addr_cells(ofnode node)
686878d68c0SSimon Glass {
687878d68c0SSimon Glass if (ofnode_is_np(node))
688878d68c0SSimon Glass return of_simple_addr_cells(ofnode_to_np(node));
689878d68c0SSimon Glass else
690878d68c0SSimon Glass return fdt_address_cells(gd->fdt_blob, ofnode_to_offset(node));
691878d68c0SSimon Glass }
692878d68c0SSimon Glass
ofnode_read_simple_size_cells(ofnode node)693878d68c0SSimon Glass int ofnode_read_simple_size_cells(ofnode node)
694878d68c0SSimon Glass {
695878d68c0SSimon Glass if (ofnode_is_np(node))
696878d68c0SSimon Glass return of_simple_size_cells(ofnode_to_np(node));
6979e512045SSimon Glass else
6989e512045SSimon Glass return fdt_size_cells(gd->fdt_blob, ofnode_to_offset(node));
6999e512045SSimon Glass }
7009e512045SSimon Glass
ofnode_pre_reloc(ofnode node)7019e512045SSimon Glass bool ofnode_pre_reloc(ofnode node)
7029e512045SSimon Glass {
703252510acSMasahiro Yamada if (ofnode_read_bool(node, "u-boot,dm-pre-reloc"))
7049e512045SSimon Glass return true;
70506f94461SSimon Glass if (ofnode_read_bool(node, "u-boot,dm-pre-proper"))
70606f94461SSimon Glass return true;
7079e512045SSimon Glass
7089e512045SSimon Glass #ifdef CONFIG_TPL_BUILD
709252510acSMasahiro Yamada if (ofnode_read_bool(node, "u-boot,dm-tpl"))
7109e512045SSimon Glass return true;
7119e512045SSimon Glass #elif defined(CONFIG_SPL_BUILD)
712252510acSMasahiro Yamada if (ofnode_read_bool(node, "u-boot,dm-spl"))
7139e512045SSimon Glass return true;
7149e512045SSimon Glass #else
7159e512045SSimon Glass /*
7169e512045SSimon Glass * In regular builds individual spl and tpl handling both
7179e512045SSimon Glass * count as handled pre-relocation for later second init.
7189e512045SSimon Glass */
719252510acSMasahiro Yamada if (ofnode_read_bool(node, "u-boot,dm-spl") ||
720252510acSMasahiro Yamada ofnode_read_bool(node, "u-boot,dm-tpl"))
7219e512045SSimon Glass return true;
7229e512045SSimon Glass #endif
7239e512045SSimon Glass
7249e512045SSimon Glass return false;
7259e512045SSimon Glass }
726dcf98852SSimon Glass
ofnode_read_resource(ofnode node,uint index,struct resource * res)727dcf98852SSimon Glass int ofnode_read_resource(ofnode node, uint index, struct resource *res)
728dcf98852SSimon Glass {
729dcf98852SSimon Glass if (ofnode_is_np(node)) {
730dcf98852SSimon Glass return of_address_to_resource(ofnode_to_np(node), index, res);
731dcf98852SSimon Glass } else {
732dcf98852SSimon Glass struct fdt_resource fres;
733dcf98852SSimon Glass int ret;
734dcf98852SSimon Glass
735dcf98852SSimon Glass ret = fdt_get_resource(gd->fdt_blob, ofnode_to_offset(node),
736dcf98852SSimon Glass "reg", index, &fres);
737dcf98852SSimon Glass if (ret < 0)
738dcf98852SSimon Glass return -EINVAL;
739dcf98852SSimon Glass memset(res, '\0', sizeof(*res));
740dcf98852SSimon Glass res->start = fres.start;
741dcf98852SSimon Glass res->end = fres.end;
742dcf98852SSimon Glass
743dcf98852SSimon Glass return 0;
744dcf98852SSimon Glass }
745dcf98852SSimon Glass }
7467b8b47bdSMasahiro Yamada
ofnode_read_resource_byname(ofnode node,const char * name,struct resource * res)7477b8b47bdSMasahiro Yamada int ofnode_read_resource_byname(ofnode node, const char *name,
7487b8b47bdSMasahiro Yamada struct resource *res)
7497b8b47bdSMasahiro Yamada {
7507b8b47bdSMasahiro Yamada int index;
7517b8b47bdSMasahiro Yamada
7527b8b47bdSMasahiro Yamada index = ofnode_stringlist_search(node, "reg-names", name);
7537b8b47bdSMasahiro Yamada if (index < 0)
7547b8b47bdSMasahiro Yamada return index;
7557b8b47bdSMasahiro Yamada
7567b8b47bdSMasahiro Yamada return ofnode_read_resource(node, index, res);
7577b8b47bdSMasahiro Yamada }
758147c6074SMario Six
ofnode_translate_address(ofnode node,const fdt32_t * in_addr)759147c6074SMario Six u64 ofnode_translate_address(ofnode node, const fdt32_t *in_addr)
760147c6074SMario Six {
761147c6074SMario Six if (ofnode_is_np(node))
762147c6074SMario Six return of_translate_address(ofnode_to_np(node), in_addr);
763147c6074SMario Six else
764147c6074SMario Six return fdt_translate_address(gd->fdt_blob, ofnode_to_offset(node), in_addr);
765147c6074SMario Six }
7665ccc2c21SMasahiro Yamada
ofnode_device_is_compatible(ofnode node,const char * compat)7675ccc2c21SMasahiro Yamada int ofnode_device_is_compatible(ofnode node, const char *compat)
7685ccc2c21SMasahiro Yamada {
7695ccc2c21SMasahiro Yamada if (ofnode_is_np(node))
7705ccc2c21SMasahiro Yamada return of_device_is_compatible(ofnode_to_np(node), compat,
7715ccc2c21SMasahiro Yamada NULL, NULL);
7725ccc2c21SMasahiro Yamada else
7735ccc2c21SMasahiro Yamada return !fdt_node_check_compatible(gd->fdt_blob,
7745ccc2c21SMasahiro Yamada ofnode_to_offset(node),
7755ccc2c21SMasahiro Yamada compat);
7765ccc2c21SMasahiro Yamada }
777c60f671bSSimon Glass
ofnode_by_compatible(ofnode from,const char * compat)778c60f671bSSimon Glass ofnode ofnode_by_compatible(ofnode from, const char *compat)
779c60f671bSSimon Glass {
780c60f671bSSimon Glass if (of_live_active()) {
781c60f671bSSimon Glass return np_to_ofnode(of_find_compatible_node(
782c60f671bSSimon Glass (struct device_node *)ofnode_to_np(from), NULL,
783c60f671bSSimon Glass compat));
784c60f671bSSimon Glass } else {
785c60f671bSSimon Glass return offset_to_ofnode(fdt_node_offset_by_compatible(
786c60f671bSSimon Glass gd->fdt_blob, ofnode_to_offset(from), compat));
787c60f671bSSimon Glass }
788c60f671bSSimon Glass }
78961fba0faSJens Wiklander
ofnode_by_prop_value(ofnode from,const char * propname,const void * propval,int proplen)79061fba0faSJens Wiklander ofnode ofnode_by_prop_value(ofnode from, const char *propname,
79161fba0faSJens Wiklander const void *propval, int proplen)
79261fba0faSJens Wiklander {
79361fba0faSJens Wiklander if (of_live_active()) {
79461fba0faSJens Wiklander return np_to_ofnode(of_find_node_by_prop_value(
79561fba0faSJens Wiklander (struct device_node *)ofnode_to_np(from), propname,
79661fba0faSJens Wiklander propval, proplen));
79761fba0faSJens Wiklander } else {
79861fba0faSJens Wiklander return offset_to_ofnode(fdt_node_offset_by_prop_value(
79961fba0faSJens Wiklander gd->fdt_blob, ofnode_to_offset(from),
80061fba0faSJens Wiklander propname, propval, proplen));
80161fba0faSJens Wiklander }
80261fba0faSJens Wiklander }
803e369e58dSMario Six
ofnode_write_prop(ofnode node,const char * propname,int len,const void * value)804e369e58dSMario Six int ofnode_write_prop(ofnode node, const char *propname, int len,
805e369e58dSMario Six const void *value)
806e369e58dSMario Six {
807e369e58dSMario Six const struct device_node *np = ofnode_to_np(node);
808e369e58dSMario Six struct property *pp;
809e369e58dSMario Six struct property *pp_last = NULL;
810e369e58dSMario Six struct property *new;
811e369e58dSMario Six
812e369e58dSMario Six if (!of_live_active())
813e369e58dSMario Six return -ENOSYS;
814e369e58dSMario Six
815e369e58dSMario Six if (!np)
816e369e58dSMario Six return -EINVAL;
817e369e58dSMario Six
818e369e58dSMario Six for (pp = np->properties; pp; pp = pp->next) {
819e369e58dSMario Six if (strcmp(pp->name, propname) == 0) {
820e369e58dSMario Six /* Property exists -> change value */
821e369e58dSMario Six pp->value = (void *)value;
822e369e58dSMario Six pp->length = len;
823e369e58dSMario Six return 0;
824e369e58dSMario Six }
825e369e58dSMario Six pp_last = pp;
826e369e58dSMario Six }
827e369e58dSMario Six
828e369e58dSMario Six if (!pp_last)
829e369e58dSMario Six return -ENOENT;
830e369e58dSMario Six
831e369e58dSMario Six /* Property does not exist -> append new property */
832e369e58dSMario Six new = malloc(sizeof(struct property));
833e369e58dSMario Six if (!new)
834e369e58dSMario Six return -ENOMEM;
835e369e58dSMario Six
836e369e58dSMario Six new->name = strdup(propname);
837205dd5afSMario Six if (!new->name) {
838205dd5afSMario Six free(new);
839e369e58dSMario Six return -ENOMEM;
840205dd5afSMario Six }
841e369e58dSMario Six
842e369e58dSMario Six new->value = (void *)value;
843e369e58dSMario Six new->length = len;
844e369e58dSMario Six new->next = NULL;
845e369e58dSMario Six
846e369e58dSMario Six pp_last->next = new;
847e369e58dSMario Six
848e369e58dSMario Six return 0;
849e369e58dSMario Six }
850e369e58dSMario Six
ofnode_write_string(ofnode node,const char * propname,const char * value)851e369e58dSMario Six int ofnode_write_string(ofnode node, const char *propname, const char *value)
852e369e58dSMario Six {
853e369e58dSMario Six if (!of_live_active())
854e369e58dSMario Six return -ENOSYS;
855e369e58dSMario Six
856e369e58dSMario Six assert(ofnode_valid(node));
857e369e58dSMario Six
858e369e58dSMario Six debug("%s: %s = %s", __func__, propname, value);
859e369e58dSMario Six
860e369e58dSMario Six return ofnode_write_prop(node, propname, strlen(value) + 1, value);
861e369e58dSMario Six }
862e369e58dSMario Six
ofnode_set_enabled(ofnode node,bool value)863e369e58dSMario Six int ofnode_set_enabled(ofnode node, bool value)
864e369e58dSMario Six {
865e369e58dSMario Six if (!of_live_active())
866e369e58dSMario Six return -ENOSYS;
867e369e58dSMario Six
868e369e58dSMario Six assert(ofnode_valid(node));
869e369e58dSMario Six
870e369e58dSMario Six if (value)
871e369e58dSMario Six return ofnode_write_string(node, "status", "okay");
872e369e58dSMario Six else
873e369e58dSMario Six return ofnode_write_string(node, "status", "disable");
874e369e58dSMario Six }
875