]>
Commit | Line | Data |
---|---|---|
35748177 GVB |
1 | /* |
2 | * libfdt - Flat Device Tree manipulation | |
3 | * Copyright (C) 2006 David Gibson, IBM Corporation. | |
35084760 | 4 | * SPDX-License-Identifier: GPL-2.0+ BSD-2-Clause |
35748177 | 5 | */ |
6feed2a5 | 6 | #include <libfdt_env.h> |
35748177 | 7 | |
8cf30809 | 8 | #ifndef USE_HOSTCC |
35748177 GVB |
9 | #include <fdt.h> |
10 | #include <libfdt.h> | |
8cf30809 BS |
11 | #else |
12 | #include "fdt_host.h" | |
13 | #endif | |
35748177 GVB |
14 | |
15 | #include "libfdt_internal.h" | |
16 | ||
fc7758ee | 17 | static int _fdt_blocks_misordered(const void *fdt, |
8d04f02f KG |
18 | int mem_rsv_size, int struct_size) |
19 | { | |
fc7758ee | 20 | return (fdt_off_mem_rsvmap(fdt) < FDT_ALIGN(sizeof(struct fdt_header), 8)) |
8d04f02f KG |
21 | || (fdt_off_dt_struct(fdt) < |
22 | (fdt_off_mem_rsvmap(fdt) + mem_rsv_size)) | |
23 | || (fdt_off_dt_strings(fdt) < | |
24 | (fdt_off_dt_struct(fdt) + struct_size)) | |
25 | || (fdt_totalsize(fdt) < | |
26 | (fdt_off_dt_strings(fdt) + fdt_size_dt_strings(fdt))); | |
27 | } | |
28 | ||
fc7758ee | 29 | static int _fdt_rw_check_header(void *fdt) |
35748177 | 30 | { |
fc7758ee | 31 | FDT_CHECK_HEADER(fdt); |
35748177 | 32 | |
8d04f02f | 33 | if (fdt_version(fdt) < 17) |
35748177 | 34 | return -FDT_ERR_BADVERSION; |
fc7758ee DG |
35 | if (_fdt_blocks_misordered(fdt, sizeof(struct fdt_reserve_entry), |
36 | fdt_size_dt_struct(fdt))) | |
35748177 | 37 | return -FDT_ERR_BADLAYOUT; |
8d04f02f KG |
38 | if (fdt_version(fdt) > 17) |
39 | fdt_set_version(fdt, 17); | |
40 | ||
35748177 GVB |
41 | return 0; |
42 | } | |
43 | ||
fc7758ee | 44 | #define FDT_RW_CHECK_HEADER(fdt) \ |
35748177 | 45 | { \ |
0596d35d SG |
46 | int __err; \ |
47 | if ((__err = _fdt_rw_check_header(fdt)) != 0) \ | |
48 | return __err; \ | |
35748177 GVB |
49 | } |
50 | ||
fc7758ee | 51 | static inline int _fdt_data_size(void *fdt) |
35748177 GVB |
52 | { |
53 | return fdt_off_dt_strings(fdt) + fdt_size_dt_strings(fdt); | |
54 | } | |
55 | ||
fc7758ee | 56 | static int _fdt_splice(void *fdt, void *splicepoint, int oldlen, int newlen) |
35748177 | 57 | { |
ef4e8ce1 | 58 | char *p = splicepoint; |
fc7758ee | 59 | char *end = (char *)fdt + _fdt_data_size(fdt); |
35748177 GVB |
60 | |
61 | if (((p + oldlen) < p) || ((p + oldlen) > end)) | |
62 | return -FDT_ERR_BADOFFSET; | |
9c07b987 SG |
63 | if ((p < (char *)fdt) || ((end - oldlen + newlen) < (char *)fdt)) |
64 | return -FDT_ERR_BADOFFSET; | |
ef4e8ce1 | 65 | if ((end - oldlen + newlen) > ((char *)fdt + fdt_totalsize(fdt))) |
35748177 GVB |
66 | return -FDT_ERR_NOSPACE; |
67 | memmove(p + newlen, p + oldlen, end - p - oldlen); | |
68 | return 0; | |
69 | } | |
70 | ||
fc7758ee DG |
71 | static int _fdt_splice_mem_rsv(void *fdt, struct fdt_reserve_entry *p, |
72 | int oldn, int newn) | |
8d04f02f KG |
73 | { |
74 | int delta = (newn - oldn) * sizeof(*p); | |
75 | int err; | |
fc7758ee | 76 | err = _fdt_splice(fdt, p, oldn * sizeof(*p), newn * sizeof(*p)); |
8d04f02f KG |
77 | if (err) |
78 | return err; | |
79 | fdt_set_off_dt_struct(fdt, fdt_off_dt_struct(fdt) + delta); | |
80 | fdt_set_off_dt_strings(fdt, fdt_off_dt_strings(fdt) + delta); | |
81 | return 0; | |
82 | } | |
83 | ||
fc7758ee DG |
84 | static int _fdt_splice_struct(void *fdt, void *p, |
85 | int oldlen, int newlen) | |
35748177 GVB |
86 | { |
87 | int delta = newlen - oldlen; | |
88 | int err; | |
89 | ||
fc7758ee | 90 | if ((err = _fdt_splice(fdt, p, oldlen, newlen))) |
35748177 GVB |
91 | return err; |
92 | ||
8d04f02f KG |
93 | fdt_set_size_dt_struct(fdt, fdt_size_dt_struct(fdt) + delta); |
94 | fdt_set_off_dt_strings(fdt, fdt_off_dt_strings(fdt) + delta); | |
35748177 GVB |
95 | return 0; |
96 | } | |
97 | ||
fc7758ee | 98 | static int _fdt_splice_string(void *fdt, int newlen) |
35748177 | 99 | { |
ef4e8ce1 DG |
100 | void *p = (char *)fdt |
101 | + fdt_off_dt_strings(fdt) + fdt_size_dt_strings(fdt); | |
35748177 GVB |
102 | int err; |
103 | ||
fc7758ee | 104 | if ((err = _fdt_splice(fdt, p, 0, newlen))) |
35748177 GVB |
105 | return err; |
106 | ||
8d04f02f | 107 | fdt_set_size_dt_strings(fdt, fdt_size_dt_strings(fdt) + newlen); |
35748177 GVB |
108 | return 0; |
109 | } | |
110 | ||
fc7758ee | 111 | static int _fdt_find_add_string(void *fdt, const char *s) |
35748177 GVB |
112 | { |
113 | char *strtab = (char *)fdt + fdt_off_dt_strings(fdt); | |
114 | const char *p; | |
115 | char *new; | |
116 | int len = strlen(s) + 1; | |
117 | int err; | |
118 | ||
119 | p = _fdt_find_string(strtab, fdt_size_dt_strings(fdt), s); | |
120 | if (p) | |
121 | /* found it */ | |
122 | return (p - strtab); | |
123 | ||
124 | new = strtab + fdt_size_dt_strings(fdt); | |
fc7758ee | 125 | err = _fdt_splice_string(fdt, len); |
35748177 GVB |
126 | if (err) |
127 | return err; | |
128 | ||
129 | memcpy(new, s, len); | |
130 | return (new - strtab); | |
131 | } | |
132 | ||
8d04f02f KG |
133 | int fdt_add_mem_rsv(void *fdt, uint64_t address, uint64_t size) |
134 | { | |
135 | struct fdt_reserve_entry *re; | |
136 | int err; | |
137 | ||
fc7758ee | 138 | FDT_RW_CHECK_HEADER(fdt); |
8d04f02f KG |
139 | |
140 | re = _fdt_mem_rsv_w(fdt, fdt_num_mem_rsv(fdt)); | |
fc7758ee | 141 | err = _fdt_splice_mem_rsv(fdt, re, 0, 1); |
8d04f02f KG |
142 | if (err) |
143 | return err; | |
144 | ||
145 | re->address = cpu_to_fdt64(address); | |
146 | re->size = cpu_to_fdt64(size); | |
147 | return 0; | |
148 | } | |
149 | ||
150 | int fdt_del_mem_rsv(void *fdt, int n) | |
151 | { | |
152 | struct fdt_reserve_entry *re = _fdt_mem_rsv_w(fdt, n); | |
8d04f02f | 153 | |
fc7758ee | 154 | FDT_RW_CHECK_HEADER(fdt); |
2f08bfa9 | 155 | |
8d04f02f KG |
156 | if (n >= fdt_num_mem_rsv(fdt)) |
157 | return -FDT_ERR_NOTFOUND; | |
158 | ||
7dc07895 | 159 | return _fdt_splice_mem_rsv(fdt, re, 1, 0); |
8d04f02f KG |
160 | } |
161 | ||
fc7758ee DG |
162 | static int _fdt_resize_property(void *fdt, int nodeoffset, const char *name, |
163 | int len, struct fdt_property **prop) | |
35748177 GVB |
164 | { |
165 | int oldlen; | |
166 | int err; | |
167 | ||
8d04f02f | 168 | *prop = fdt_get_property_w(fdt, nodeoffset, name, &oldlen); |
9c07b987 | 169 | if (!*prop) |
35748177 GVB |
170 | return oldlen; |
171 | ||
fc7758ee DG |
172 | if ((err = _fdt_splice_struct(fdt, (*prop)->data, FDT_TAGALIGN(oldlen), |
173 | FDT_TAGALIGN(len)))) | |
35748177 GVB |
174 | return err; |
175 | ||
176 | (*prop)->len = cpu_to_fdt32(len); | |
177 | return 0; | |
178 | } | |
179 | ||
fc7758ee DG |
180 | static int _fdt_add_property(void *fdt, int nodeoffset, const char *name, |
181 | int len, struct fdt_property **prop) | |
35748177 | 182 | { |
35748177 GVB |
183 | int proplen; |
184 | int nextoffset; | |
185 | int namestroff; | |
186 | int err; | |
187 | ||
2f08bfa9 DG |
188 | if ((nextoffset = _fdt_check_node_offset(fdt, nodeoffset)) < 0) |
189 | return nextoffset; | |
35748177 | 190 | |
fc7758ee | 191 | namestroff = _fdt_find_add_string(fdt, name); |
35748177 GVB |
192 | if (namestroff < 0) |
193 | return namestroff; | |
194 | ||
8d04f02f | 195 | *prop = _fdt_offset_ptr_w(fdt, nextoffset); |
fc7758ee | 196 | proplen = sizeof(**prop) + FDT_TAGALIGN(len); |
35748177 | 197 | |
fc7758ee | 198 | err = _fdt_splice_struct(fdt, *prop, 0, proplen); |
35748177 GVB |
199 | if (err) |
200 | return err; | |
201 | ||
202 | (*prop)->tag = cpu_to_fdt32(FDT_PROP); | |
203 | (*prop)->nameoff = cpu_to_fdt32(namestroff); | |
204 | (*prop)->len = cpu_to_fdt32(len); | |
205 | return 0; | |
206 | } | |
207 | ||
9eaeb07a DG |
208 | int fdt_set_name(void *fdt, int nodeoffset, const char *name) |
209 | { | |
210 | char *namep; | |
211 | int oldlen, newlen; | |
212 | int err; | |
213 | ||
fc7758ee | 214 | FDT_RW_CHECK_HEADER(fdt); |
9eaeb07a | 215 | |
c6683026 | 216 | namep = (char *)(uintptr_t)fdt_get_name(fdt, nodeoffset, &oldlen); |
9eaeb07a DG |
217 | if (!namep) |
218 | return oldlen; | |
219 | ||
220 | newlen = strlen(name); | |
221 | ||
fc7758ee DG |
222 | err = _fdt_splice_struct(fdt, namep, FDT_TAGALIGN(oldlen+1), |
223 | FDT_TAGALIGN(newlen+1)); | |
9eaeb07a DG |
224 | if (err) |
225 | return err; | |
226 | ||
227 | memcpy(namep, name, newlen+1); | |
228 | return 0; | |
229 | } | |
230 | ||
35748177 GVB |
231 | int fdt_setprop(void *fdt, int nodeoffset, const char *name, |
232 | const void *val, int len) | |
233 | { | |
234 | struct fdt_property *prop; | |
235 | int err; | |
236 | ||
fc7758ee | 237 | FDT_RW_CHECK_HEADER(fdt); |
35748177 | 238 | |
fc7758ee | 239 | err = _fdt_resize_property(fdt, nodeoffset, name, len, &prop); |
35748177 | 240 | if (err == -FDT_ERR_NOTFOUND) |
fc7758ee | 241 | err = _fdt_add_property(fdt, nodeoffset, name, len, &prop); |
35748177 GVB |
242 | if (err) |
243 | return err; | |
244 | ||
245 | memcpy(prop->data, val, len); | |
246 | return 0; | |
247 | } | |
248 | ||
36ad18a6 ML |
249 | int fdt_appendprop(void *fdt, int nodeoffset, const char *name, |
250 | const void *val, int len) | |
251 | { | |
252 | struct fdt_property *prop; | |
253 | int err, oldlen, newlen; | |
254 | ||
255 | FDT_RW_CHECK_HEADER(fdt); | |
256 | ||
257 | prop = fdt_get_property_w(fdt, nodeoffset, name, &oldlen); | |
258 | if (prop) { | |
259 | newlen = len + oldlen; | |
260 | err = _fdt_splice_struct(fdt, prop->data, | |
261 | FDT_TAGALIGN(oldlen), | |
262 | FDT_TAGALIGN(newlen)); | |
263 | if (err) | |
264 | return err; | |
265 | prop->len = cpu_to_fdt32(newlen); | |
266 | memcpy(prop->data + oldlen, val, len); | |
267 | } else { | |
268 | err = _fdt_add_property(fdt, nodeoffset, name, len, &prop); | |
269 | if (err) | |
270 | return err; | |
271 | memcpy(prop->data, val, len); | |
272 | } | |
273 | return 0; | |
274 | } | |
275 | ||
35748177 GVB |
276 | int fdt_delprop(void *fdt, int nodeoffset, const char *name) |
277 | { | |
278 | struct fdt_property *prop; | |
279 | int len, proplen; | |
280 | ||
fc7758ee | 281 | FDT_RW_CHECK_HEADER(fdt); |
35748177 | 282 | |
8d04f02f | 283 | prop = fdt_get_property_w(fdt, nodeoffset, name, &len); |
6feed2a5 | 284 | if (!prop) |
35748177 GVB |
285 | return len; |
286 | ||
fc7758ee DG |
287 | proplen = sizeof(*prop) + FDT_TAGALIGN(len); |
288 | return _fdt_splice_struct(fdt, prop, proplen, 0); | |
35748177 GVB |
289 | } |
290 | ||
291 | int fdt_add_subnode_namelen(void *fdt, int parentoffset, | |
292 | const char *name, int namelen) | |
293 | { | |
294 | struct fdt_node_header *nh; | |
295 | int offset, nextoffset; | |
296 | int nodelen; | |
297 | int err; | |
298 | uint32_t tag; | |
b2ba62a1 | 299 | fdt32_t *endtag; |
35748177 | 300 | |
fc7758ee | 301 | FDT_RW_CHECK_HEADER(fdt); |
35748177 GVB |
302 | |
303 | offset = fdt_subnode_offset_namelen(fdt, parentoffset, name, namelen); | |
304 | if (offset >= 0) | |
305 | return -FDT_ERR_EXISTS; | |
306 | else if (offset != -FDT_ERR_NOTFOUND) | |
307 | return offset; | |
308 | ||
309 | /* Try to place the new node after the parent's properties */ | |
8d04f02f | 310 | fdt_next_tag(fdt, parentoffset, &nextoffset); /* skip the BEGIN_NODE */ |
35748177 GVB |
311 | do { |
312 | offset = nextoffset; | |
8d04f02f | 313 | tag = fdt_next_tag(fdt, offset, &nextoffset); |
f84d65f9 | 314 | } while ((tag == FDT_PROP) || (tag == FDT_NOP)); |
35748177 | 315 | |
8d04f02f | 316 | nh = _fdt_offset_ptr_w(fdt, offset); |
fc7758ee | 317 | nodelen = sizeof(*nh) + FDT_TAGALIGN(namelen+1) + FDT_TAGSIZE; |
35748177 | 318 | |
fc7758ee | 319 | err = _fdt_splice_struct(fdt, nh, 0, nodelen); |
35748177 GVB |
320 | if (err) |
321 | return err; | |
322 | ||
323 | nh->tag = cpu_to_fdt32(FDT_BEGIN_NODE); | |
fc7758ee | 324 | memset(nh->name, 0, FDT_TAGALIGN(namelen+1)); |
35748177 | 325 | memcpy(nh->name, name, namelen); |
b2ba62a1 | 326 | endtag = (fdt32_t *)((char *)nh + nodelen - FDT_TAGSIZE); |
35748177 GVB |
327 | *endtag = cpu_to_fdt32(FDT_END_NODE); |
328 | ||
329 | return offset; | |
330 | } | |
331 | ||
332 | int fdt_add_subnode(void *fdt, int parentoffset, const char *name) | |
333 | { | |
334 | return fdt_add_subnode_namelen(fdt, parentoffset, name, strlen(name)); | |
335 | } | |
336 | ||
337 | int fdt_del_node(void *fdt, int nodeoffset) | |
338 | { | |
339 | int endoffset; | |
340 | ||
fc7758ee | 341 | FDT_RW_CHECK_HEADER(fdt); |
8d04f02f | 342 | |
35748177 GVB |
343 | endoffset = _fdt_node_end_offset(fdt, nodeoffset); |
344 | if (endoffset < 0) | |
345 | return endoffset; | |
346 | ||
fc7758ee DG |
347 | return _fdt_splice_struct(fdt, _fdt_offset_ptr_w(fdt, nodeoffset), |
348 | endoffset - nodeoffset, 0); | |
35748177 GVB |
349 | } |
350 | ||
fc7758ee DG |
351 | static void _fdt_packblocks(const char *old, char *new, |
352 | int mem_rsv_size, int struct_size) | |
8d04f02f KG |
353 | { |
354 | int mem_rsv_off, struct_off, strings_off; | |
355 | ||
fc7758ee | 356 | mem_rsv_off = FDT_ALIGN(sizeof(struct fdt_header), 8); |
8d04f02f KG |
357 | struct_off = mem_rsv_off + mem_rsv_size; |
358 | strings_off = struct_off + struct_size; | |
359 | ||
ef4e8ce1 DG |
360 | memmove(new + mem_rsv_off, old + fdt_off_mem_rsvmap(old), mem_rsv_size); |
361 | fdt_set_off_mem_rsvmap(new, mem_rsv_off); | |
8d04f02f | 362 | |
ef4e8ce1 DG |
363 | memmove(new + struct_off, old + fdt_off_dt_struct(old), struct_size); |
364 | fdt_set_off_dt_struct(new, struct_off); | |
365 | fdt_set_size_dt_struct(new, struct_size); | |
8d04f02f | 366 | |
ef4e8ce1 DG |
367 | memmove(new + strings_off, old + fdt_off_dt_strings(old), |
368 | fdt_size_dt_strings(old)); | |
369 | fdt_set_off_dt_strings(new, strings_off); | |
370 | fdt_set_size_dt_strings(new, fdt_size_dt_strings(old)); | |
8d04f02f KG |
371 | } |
372 | ||
373 | int fdt_open_into(const void *fdt, void *buf, int bufsize) | |
35748177 GVB |
374 | { |
375 | int err; | |
8d04f02f KG |
376 | int mem_rsv_size, struct_size; |
377 | int newsize; | |
ef4e8ce1 DG |
378 | const char *fdtstart = fdt; |
379 | const char *fdtend = fdtstart + fdt_totalsize(fdt); | |
380 | char *tmp; | |
35748177 | 381 | |
fc7758ee | 382 | FDT_CHECK_HEADER(fdt); |
35748177 | 383 | |
8d04f02f KG |
384 | mem_rsv_size = (fdt_num_mem_rsv(fdt)+1) |
385 | * sizeof(struct fdt_reserve_entry); | |
35748177 | 386 | |
8d04f02f KG |
387 | if (fdt_version(fdt) >= 17) { |
388 | struct_size = fdt_size_dt_struct(fdt); | |
389 | } else { | |
390 | struct_size = 0; | |
391 | while (fdt_next_tag(fdt, struct_size, &struct_size) != FDT_END) | |
392 | ; | |
a22d9cfb DG |
393 | if (struct_size < 0) |
394 | return struct_size; | |
8d04f02f | 395 | } |
35748177 | 396 | |
fc7758ee | 397 | if (!_fdt_blocks_misordered(fdt, mem_rsv_size, struct_size)) { |
8d04f02f KG |
398 | /* no further work necessary */ |
399 | err = fdt_move(fdt, buf, bufsize); | |
400 | if (err) | |
401 | return err; | |
402 | fdt_set_version(buf, 17); | |
403 | fdt_set_size_dt_struct(buf, struct_size); | |
404 | fdt_set_totalsize(buf, bufsize); | |
405 | return 0; | |
406 | } | |
35748177 | 407 | |
8d04f02f | 408 | /* Need to reorder */ |
fc7758ee | 409 | newsize = FDT_ALIGN(sizeof(struct fdt_header), 8) + mem_rsv_size |
8d04f02f KG |
410 | + struct_size + fdt_size_dt_strings(fdt); |
411 | ||
412 | if (bufsize < newsize) | |
413 | return -FDT_ERR_NOSPACE; | |
414 | ||
ef4e8ce1 DG |
415 | /* First attempt to build converted tree at beginning of buffer */ |
416 | tmp = buf; | |
417 | /* But if that overlaps with the old tree... */ | |
418 | if (((tmp + newsize) > fdtstart) && (tmp < fdtend)) { | |
419 | /* Try right after the old tree instead */ | |
c6683026 | 420 | tmp = (char *)(uintptr_t)fdtend; |
ef4e8ce1 | 421 | if ((tmp + newsize) > ((char *)buf + bufsize)) |
8d04f02f KG |
422 | return -FDT_ERR_NOSPACE; |
423 | } | |
424 | ||
fc7758ee | 425 | _fdt_packblocks(fdt, tmp, mem_rsv_size, struct_size); |
8d04f02f KG |
426 | memmove(buf, tmp, newsize); |
427 | ||
428 | fdt_set_magic(buf, FDT_MAGIC); | |
429 | fdt_set_totalsize(buf, bufsize); | |
430 | fdt_set_version(buf, 17); | |
431 | fdt_set_last_comp_version(buf, 16); | |
432 | fdt_set_boot_cpuid_phys(buf, fdt_boot_cpuid_phys(fdt)); | |
35748177 GVB |
433 | |
434 | return 0; | |
435 | } | |
436 | ||
437 | int fdt_pack(void *fdt) | |
438 | { | |
8d04f02f | 439 | int mem_rsv_size; |
35748177 | 440 | |
fc7758ee | 441 | FDT_RW_CHECK_HEADER(fdt); |
35748177 | 442 | |
8d04f02f KG |
443 | mem_rsv_size = (fdt_num_mem_rsv(fdt)+1) |
444 | * sizeof(struct fdt_reserve_entry); | |
fc7758ee DG |
445 | _fdt_packblocks(fdt, fdt, mem_rsv_size, fdt_size_dt_struct(fdt)); |
446 | fdt_set_totalsize(fdt, _fdt_data_size(fdt)); | |
8d04f02f | 447 | |
35748177 GVB |
448 | return 0; |
449 | } | |
8f6e2e1e SG |
450 | |
451 | int fdt_remove_unused_strings(const void *old, void *new) | |
452 | { | |
453 | const struct fdt_property *old_prop; | |
454 | struct fdt_property *new_prop; | |
455 | int size = fdt_totalsize(old); | |
456 | int next_offset, offset; | |
457 | const char *str; | |
458 | int ret; | |
459 | int tag = FDT_PROP; | |
460 | ||
461 | /* Make a copy and remove the strings */ | |
462 | memcpy(new, old, size); | |
463 | fdt_set_size_dt_strings(new, 0); | |
464 | ||
465 | /* Add every property name back into the new string table */ | |
466 | for (offset = 0; tag != FDT_END; offset = next_offset) { | |
467 | tag = fdt_next_tag(old, offset, &next_offset); | |
468 | if (tag != FDT_PROP) | |
469 | continue; | |
470 | old_prop = fdt_get_property_by_offset(old, offset, NULL); | |
471 | new_prop = (struct fdt_property *)(unsigned long) | |
472 | fdt_get_property_by_offset(new, offset, NULL); | |
473 | str = fdt_string(old, fdt32_to_cpu(old_prop->nameoff)); | |
474 | ret = _fdt_find_add_string(new, str); | |
475 | if (ret < 0) | |
476 | return ret; | |
477 | new_prop->nameoff = cpu_to_fdt32(ret); | |
478 | } | |
479 | ||
480 | return 0; | |
481 | } |