blob: c2d7566a67dcf114cb15e0e233c8bff126744365 [file] [log] [blame]
Simon Glassa5e1a582019-10-27 09:47:42 -06001// SPDX-License-Identifier: (GPL-2.0-or-later OR BSD-2-Clause)
Tom Rinibd391732017-09-23 12:52:44 -04002/*
3 * libfdt - Flat Device Tree manipulation
4 * Copyright (C) 2006 David Gibson, IBM Corporation.
Tom Rinibd391732017-09-23 12:52:44 -04005 */
6#include "libfdt_env.h"
7
8#include <fdt.h>
9#include <libfdt.h>
10
11#include "libfdt_internal.h"
12
13int fdt_setprop_inplace_namelen_partial(void *fdt, int nodeoffset,
14 const char *name, int namelen,
15 uint32_t idx, const void *val,
16 int len)
17{
18 void *propval;
19 int proplen;
20
21 propval = fdt_getprop_namelen_w(fdt, nodeoffset, name, namelen,
22 &proplen);
23 if (!propval)
24 return proplen;
25
Andre Przywaradaa7e752020-10-16 15:42:50 +010026 if ((unsigned)proplen < (len + idx))
Tom Rinibd391732017-09-23 12:52:44 -040027 return -FDT_ERR_NOSPACE;
28
29 memcpy((char *)propval + idx, val, len);
30 return 0;
31}
32
33int fdt_setprop_inplace(void *fdt, int nodeoffset, const char *name,
34 const void *val, int len)
35{
36 const void *propval;
37 int proplen;
38
39 propval = fdt_getprop(fdt, nodeoffset, name, &proplen);
Tom Rini0eb096d2017-09-23 17:31:59 -040040 if (!propval)
Tom Rinibd391732017-09-23 12:52:44 -040041 return proplen;
42
43 if (proplen != len)
44 return -FDT_ERR_NOSPACE;
45
46 return fdt_setprop_inplace_namelen_partial(fdt, nodeoffset, name,
47 strlen(name), 0,
48 val, len);
49}
50
Rob Herringcd5f70d2018-05-19 14:13:53 +020051static void fdt_nop_region_(void *start, int len)
Tom Rinibd391732017-09-23 12:52:44 -040052{
53 fdt32_t *p;
54
55 for (p = start; (char *)p < ((char *)start + len); p++)
56 *p = cpu_to_fdt32(FDT_NOP);
57}
58
59int fdt_nop_property(void *fdt, int nodeoffset, const char *name)
60{
61 struct fdt_property *prop;
62 int len;
63
64 prop = fdt_get_property_w(fdt, nodeoffset, name, &len);
Tom Rini0eb096d2017-09-23 17:31:59 -040065 if (!prop)
Tom Rinibd391732017-09-23 12:52:44 -040066 return len;
67
Rob Herringcd5f70d2018-05-19 14:13:53 +020068 fdt_nop_region_(prop, len + sizeof(*prop));
Tom Rinibd391732017-09-23 12:52:44 -040069
70 return 0;
71}
72
Rob Herringcd5f70d2018-05-19 14:13:53 +020073int fdt_node_end_offset_(void *fdt, int offset)
Tom Rinibd391732017-09-23 12:52:44 -040074{
75 int depth = 0;
76
77 while ((offset >= 0) && (depth >= 0))
78 offset = fdt_next_node(fdt, offset, &depth);
79
80 return offset;
81}
82
83int fdt_nop_node(void *fdt, int nodeoffset)
84{
85 int endoffset;
86
Rob Herringcd5f70d2018-05-19 14:13:53 +020087 endoffset = fdt_node_end_offset_(fdt, nodeoffset);
Tom Rinibd391732017-09-23 12:52:44 -040088 if (endoffset < 0)
89 return endoffset;
90
Rob Herringcd5f70d2018-05-19 14:13:53 +020091 fdt_nop_region_(fdt_offset_ptr_w(fdt, nodeoffset, 0),
Tom Rinibd391732017-09-23 12:52:44 -040092 endoffset - nodeoffset);
93 return 0;
94}