1 /*
2 * libfdt - Flat Device Tree manipulation
3 * Copyright (C) 2006 David Gibson, IBM Corporation.
4 *
5 * libfdt is dual licensed: you can use it either under the terms of
6 * the GPL, or the BSD license, at your option.
7 *
8 * a) This library is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 of the
11 * License, or (at your option) any later version.
12 *
13 * This library is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public
19 * License along with this library; if not, write to the Free
20 * Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
21 * MA 02110-1301 USA
22 *
23 * Alternatively,
24 *
25 * b) Redistribution and use in source and binary forms, with or
26 * without modification, are permitted provided that the following
27 * conditions are met:
28 *
29 * 1. Redistributions of source code must retain the above
30 * copyright notice, this list of conditions and the following
31 * disclaimer.
32 * 2. Redistributions in binary form must reproduce the above
33 * copyright notice, this list of conditions and the following
34 * disclaimer in the documentation and/or other materials
35 * provided with the distribution.
36 *
37 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
38 * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,
39 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
40 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
41 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
42 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
43 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
44 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
45 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
46 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
47 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
48 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
49 * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
50 */
51 #include "libfdt_env.h"
52 #include "fdt.h"
53 #include "libfdt.h"
54 #include "libfdt_internal.h"
55
fdt_setprop_inplace_namelen_partial(void * fdt,int nodeoffset,const char * name,int namelen,uint32_t idx,const void * val,int len)56 int fdt_setprop_inplace_namelen_partial(void *fdt, int nodeoffset,
57 const char *name, int namelen,
58 uint32_t idx, const void *val,
59 int len)
60 {
61 void *propval;
62 int proplen;
63
64 propval = fdt_getprop_namelen_w(fdt, nodeoffset, name, namelen,
65 &proplen);
66 if (!propval)
67 return proplen;
68
69 if (proplen < (len + idx))
70 return -FDT_ERR_NOSPACE;
71
72 memcpy((char *)propval + idx, val, len);
73 return 0;
74 }
75
fdt_setprop_inplace(void * fdt,int nodeoffset,const char * name,const void * val,int len)76 int fdt_setprop_inplace(void *fdt, int nodeoffset, const char *name,
77 const void *val, int len)
78 {
79 const void *propval;
80 int proplen;
81
82 propval = fdt_getprop(fdt, nodeoffset, name, &proplen);
83 if (! propval)
84 return proplen;
85
86 if (proplen != len)
87 return -FDT_ERR_NOSPACE;
88
89 return fdt_setprop_inplace_namelen_partial(fdt, nodeoffset, name,
90 strlen(name), 0,
91 val, len);
92 }
93
_fdt_nop_region(void * start,int len)94 static void _fdt_nop_region(void *start, int len)
95 {
96 fdt32_t *p;
97
98 for (p = start; (char *)p < ((char *)start + len); p++)
99 *p = cpu_to_fdt32(FDT_NOP);
100 }
101
fdt_nop_property(void * fdt,int nodeoffset,const char * name)102 int fdt_nop_property(void *fdt, int nodeoffset, const char *name)
103 {
104 struct fdt_property *prop;
105 int len;
106
107 prop = fdt_get_property_w(fdt, nodeoffset, name, &len);
108 if (! prop)
109 return len;
110
111 _fdt_nop_region(prop, len + sizeof(*prop));
112
113 return 0;
114 }
115
_fdt_node_end_offset(void * fdt,int offset)116 int _fdt_node_end_offset(void *fdt, int offset)
117 {
118 int depth = 0;
119
120 while ((offset >= 0) && (depth >= 0))
121 offset = fdt_next_node(fdt, offset, &depth);
122
123 return offset;
124 }
125
fdt_nop_node(void * fdt,int nodeoffset)126 int fdt_nop_node(void *fdt, int nodeoffset)
127 {
128 int endoffset;
129
130 endoffset = _fdt_node_end_offset(fdt, nodeoffset);
131 if (endoffset < 0)
132 return endoffset;
133
134 _fdt_nop_region(fdt_offset_ptr_w(fdt, nodeoffset, 0),
135 endoffset - nodeoffset);
136 return 0;
137 }
138