]>
git.ipfire.org Git - thirdparty/u-boot.git/blob - common/fdt_region.c
1 // SPDX-License-Identifier: GPL-2.0+ OR BSD-2-Clause
3 * libfdt - Flat Device Tree manipulation
4 * Copyright (C) 2013 Google, Inc
5 * Written by Simon Glass <sjg@chromium.org>
8 #include <fdt_support.h>
9 #include <linux/libfdt_env.h>
10 #include <fdt_region.h>
14 #include <linux/libfdt.h>
19 #define FDT_MAX_DEPTH 32
21 static int str_in_list(const char *str
, char * const list
[], int count
)
25 for (i
= 0; i
< count
; i
++)
26 if (!strcmp(list
[i
], str
))
32 int fdt_find_regions(const void *fdt
, char * const inc
[], int inc_count
,
33 char * const exc_prop
[], int exc_prop_count
,
34 struct fdt_region region
[], int max_regions
,
35 char *path
, int path_len
, int add_string_tab
)
37 int stack
[FDT_MAX_DEPTH
] = { 0 };
45 int base
= fdt_off_dt_struct(fdt
);
50 const struct fdt_property
*prop
;
59 tag
= fdt_next_tag(fdt
, offset
, &nextoffset
);
66 prop
= fdt_get_property_by_offset(fdt
, offset
, NULL
);
67 str
= fdt_string(fdt
, fdt32_to_cpu(prop
->nameoff
));
68 if (str_in_list(str
, exc_prop
, exc_prop_count
))
79 if (depth
== FDT_MAX_DEPTH
)
80 return -FDT_ERR_BADSTRUCTURE
;
81 name
= fdt_get_name(fdt
, offset
, &len
);
82 if (end
- path
+ 2 + len
>= path_len
)
83 return -FDT_ERR_NOSPACE
;
91 if (str_in_list(path
, inc
, inc_count
))
101 /* Depth must never go below -1 */
103 return -FDT_ERR_BADSTRUCTURE
;
105 want
= stack
[depth
--];
106 while (end
> path
&& *--end
!= '/')
116 if (include
&& start
== -1) {
117 /* Should we merge with previous? */
118 if (count
&& count
<= max_regions
&&
119 offset
== region
[count
- 1].offset
+
120 region
[count
- 1].size
- base
)
121 start
= region
[--count
].offset
- base
;
126 if (!include
&& start
!= -1) {
127 if (count
< max_regions
) {
128 region
[count
].offset
= base
+ start
;
129 region
[count
].size
= stop_at
- start
;
134 } while (tag
!= FDT_END
);
136 if (nextoffset
!= fdt_size_dt_struct(fdt
))
137 return -FDT_ERR_BADLAYOUT
;
139 /* Add a region for the END tag and the string table */
140 if (count
< max_regions
) {
141 region
[count
].offset
= base
+ start
;
142 region
[count
].size
= nextoffset
- start
;
144 region
[count
].size
+= fdt_size_dt_strings(fdt
);
152 * fdt_add_region() - Add a new region to our list
153 * @info: State information
154 * @offset: Start offset of region
155 * @size: Size of region
157 * The region is added if there is space, but in any case we increment the
158 * count. If permitted, and the new region overlaps the last one, we merge
161 static int fdt_add_region(struct fdt_region_state
*info
, int offset
, int size
)
163 struct fdt_region
*reg
;
165 reg
= info
->region
? &info
->region
[info
->count
- 1] : NULL
;
166 if (info
->can_merge
&& info
->count
&&
167 info
->count
<= info
->max_regions
&&
168 reg
&& offset
<= reg
->offset
+ reg
->size
) {
169 reg
->size
= offset
+ size
- reg
->offset
;
170 } else if (info
->count
++ < info
->max_regions
) {
173 reg
->offset
= offset
;
183 static int region_list_contains_offset(struct fdt_region_state
*info
,
184 const void *fdt
, int target
)
186 struct fdt_region
*reg
;
189 target
+= fdt_off_dt_struct(fdt
);
190 for (reg
= info
->region
, num
= 0; num
< info
->count
; reg
++, num
++) {
191 if (target
>= reg
->offset
&& target
< reg
->offset
+ reg
->size
)
199 * fdt_add_alias_regions() - Add regions covering the aliases that we want
201 * The /aliases node is not automatically included by fdtgrep unless the
202 * command-line arguments cause to be included (or not excluded). However
203 * aliases are special in that we generally want to include those which
204 * reference a node that fdtgrep includes.
206 * In fact we want to include only aliases for those nodes still included in
207 * the fdt, and drop the other aliases since they point to nodes that will not
210 * This function scans the aliases and adds regions for those which we want
213 * @fdt: Device tree to scan
214 * @region: List of regions
215 * @count: Number of regions in the list so far (i.e. starting point for this
217 * @max_regions: Maximum number of regions in @region list
218 * @info: Place to put the region state
219 * @return number of regions after processing, or -FDT_ERR_NOSPACE if we did
220 * not have enough room in the regions table for the regions we wanted to add.
222 int fdt_add_alias_regions(const void *fdt
, struct fdt_region
*region
, int count
,
223 int max_regions
, struct fdt_region_state
*info
)
225 int base
= fdt_off_dt_struct(fdt
);
226 int node
, node_end
, offset
;
227 int did_alias_header
;
229 node
= fdt_subnode_offset(fdt
, 0, "aliases");
231 return -FDT_ERR_NOTFOUND
;
234 * Find the next node so that we know where the /aliases node ends. We
235 * need special handling if /aliases is the last node.
237 node_end
= fdt_next_subnode(fdt
, node
);
238 if (node_end
== -FDT_ERR_NOTFOUND
)
239 /* Move back to the FDT_END_NODE tag of '/' */
240 node_end
= fdt_size_dt_struct(fdt
) - sizeof(fdt32_t
) * 2;
241 else if (node_end
< 0) /* other error */
243 node_end
-= sizeof(fdt32_t
); /* Move to FDT_END_NODE tag of /aliases */
245 did_alias_header
= 0;
246 info
->region
= region
;
249 info
->max_regions
= max_regions
;
251 for (offset
= fdt_first_property_offset(fdt
, node
);
253 offset
= fdt_next_property_offset(fdt
, offset
)) {
254 const struct fdt_property
*prop
;
258 prop
= fdt_get_property_by_offset(fdt
, offset
, NULL
);
259 name
= fdt_string(fdt
, fdt32_to_cpu(prop
->nameoff
));
260 target
= fdt_path_offset(fdt
, name
);
261 if (!region_list_contains_offset(info
, fdt
, target
))
263 next
= fdt_next_property_offset(fdt
, offset
);
267 if (!did_alias_header
) {
268 fdt_add_region(info
, base
+ node
, 12);
269 did_alias_header
= 1;
271 fdt_add_region(info
, base
+ offset
, next
- offset
);
274 /* Add the FDT_END_NODE tag */
275 if (did_alias_header
)
276 fdt_add_region(info
, base
+ node_end
, sizeof(fdt32_t
));
278 return info
->count
< max_regions
? info
->count
: -FDT_ERR_NOSPACE
;
282 * fdt_include_supernodes() - Include supernodes required by this node
283 * @info: State information
284 * @depth: Current stack depth
286 * When we decided to include a node or property which is not at the top
287 * level, this function forces the inclusion of higher level nodes. For
288 * example, given this tree:
295 * If we decide to include testing then we need the root node to have a valid
296 * tree. This function adds those regions.
298 static int fdt_include_supernodes(struct fdt_region_state
*info
, int depth
)
300 int base
= fdt_off_dt_struct(info
->fdt
);
305 * Work down the stack looking for supernodes that we didn't include.
306 * The algortihm here is actually pretty simple, since we know that
307 * no previous subnode had to include these nodes, or if it did, we
308 * marked them as included (on the stack) already.
310 for (i
= 0; i
<= depth
; i
++) {
311 if (!info
->stack
[i
].included
) {
312 start
= info
->stack
[i
].offset
;
314 /* Add the FDT_BEGIN_NODE tag of this supernode */
315 fdt_next_tag(info
->fdt
, start
, &stop_at
);
316 if (fdt_add_region(info
, base
+ start
, stop_at
- start
))
319 /* Remember that this supernode is now included */
320 info
->stack
[i
].included
= 1;
324 /* Force (later) generation of the FDT_END_NODE tag */
325 if (!info
->stack
[i
].want
)
326 info
->stack
[i
].want
= WANT_NODES_ONLY
;
341 int fdt_first_region(const void *fdt
,
342 int (*h_include
)(void *priv
, const void *fdt
, int offset
,
343 int type
, const char *data
, int size
),
344 void *priv
, struct fdt_region
*region
,
345 char *path
, int path_len
, int flags
,
346 struct fdt_region_state
*info
)
348 struct fdt_region_ptrs
*p
= &info
->ptrs
;
350 /* Set up our state */
353 info
->max_regions
= 1;
355 p
->want
= WANT_NOTHING
;
360 p
->done
= FDT_DONE_NOTHING
;
362 return fdt_next_region(fdt
, h_include
, priv
, region
,
363 path
, path_len
, flags
, info
);
366 /***********************************************************************
368 * Theory of operation
370 * Note: in this description 'included' means that a node (or other part
371 * of the tree) should be included in the region list, i.e. it will have
372 * a region which covers its part of the tree.
374 * This function maintains some state from the last time it is called.
375 * It checks the next part of the tree that it is supposed to look at
376 * (p.nextoffset) to see if that should be included or not. When it
377 * finds something to include, it sets info->start to its offset. This
378 * marks the start of the region we want to include.
380 * Once info->start is set to the start (i.e. not -1), we continue
381 * scanning until we find something that we don't want included. This
382 * will be the end of a region. At this point we can close off the
383 * region and add it to the list. So we do so, and reset info->start
386 * One complication here is that we want to merge regions. So when we
387 * come to add another region later, we may in fact merge it with the
388 * previous one if one ends where the other starts.
390 * The function fdt_add_region() will return -1 if it fails to add the
391 * region, because we already have a region ready to be returned, and
392 * the new one cannot be merged in with it. In this case, we must return
393 * the region we found, and wait for another call to this function.
394 * When it comes, we will repeat the processing of the tag and again
395 * try to add a region. This time it will succeed.
397 * The current state of the pointers (stack, offset, etc.) is maintained
398 * in a ptrs member. At the start of every loop iteration we make a copy
399 * of it. The copy is then updated as the tag is processed. Only if we
400 * get to the end of the loop iteration (and successfully call
401 * fdt_add_region() if we need to) can we commit the changes we have
402 * made to these pointers. For example, if we see an FDT_END_NODE tag,
403 * we will decrement the depth value. But if we need to add a region
404 * for this tag (let's say because the previous tag is included and this
405 * FDT_END_NODE tag is not included) then we will only commit the result
406 * if we were able to add the region. That allows us to retry again next
409 * We keep track of a variable called 'want' which tells us what we want
410 * to include when there is no specific information provided by the
411 * h_include function for a particular property. This basically handles
412 * the inclusion of properties which are pulled in by virtue of the node
413 * they are in. So if you include a node, its properties are also
414 * included. In this case 'want' will be WANT_NODES_AND_PROPS. The
415 * FDT_REG_DIRECT_SUBNODES feature also makes use of 'want'. While we
416 * are inside the subnode, 'want' will be set to WANT_NODES_ONLY, so
417 * that only the subnode's FDT_BEGIN_NODE and FDT_END_NODE tags will be
418 * included, and properties will be skipped. If WANT_NOTHING is
419 * selected, then we will just rely on what the h_include() function
422 * Using 'want' we work out 'include', which tells us whether this
423 * current tag should be included or not. As you can imagine, if the
424 * value of 'include' changes, that means we are on a boundary between
425 * nodes to include and nodes to exclude. At this point we either close
426 * off a previous region and add it to the list, or mark the start of a
429 * Apart from the nodes, we have mem_rsvmap, the FDT_END tag and the
430 * string list. Each of these dealt with as a whole (i.e. we create a
431 * region for each if it is to be included). For mem_rsvmap we don't
432 * allow it to merge with the first struct region. For the stringlist,
433 * we don't allow it to merge with the last struct region (which
434 * contains at minimum the FDT_END tag).
436 *********************************************************************/
438 int fdt_next_region(const void *fdt
,
439 int (*h_include
)(void *priv
, const void *fdt
, int offset
,
440 int type
, const char *data
, int size
),
441 void *priv
, struct fdt_region
*region
,
442 char *path
, int path_len
, int flags
,
443 struct fdt_region_state
*info
)
445 int base
= fdt_off_dt_struct(fdt
);
449 info
->region
= region
;
451 if (info
->ptrs
.done
< FDT_DONE_MEM_RSVMAP
&&
452 (flags
& FDT_REG_ADD_MEM_RSVMAP
)) {
453 /* Add the memory reserve map into its own region */
454 if (fdt_add_region(info
, fdt_off_mem_rsvmap(fdt
),
455 fdt_off_dt_struct(fdt
) -
456 fdt_off_mem_rsvmap(fdt
)))
458 info
->can_merge
= 0; /* Don't allow merging with this */
459 info
->ptrs
.done
= FDT_DONE_MEM_RSVMAP
;
463 * Work through the tags one by one, deciding whether each needs to
464 * be included or not. We set the variable 'include' to indicate our
465 * decision. 'want' is used to track what we want to include - it
466 * allows us to pick up all the properties (and/or subnode tags) of
469 while (info
->ptrs
.done
< FDT_DONE_STRUCT
) {
470 const struct fdt_property
*prop
;
471 struct fdt_region_ptrs p
;
481 * Make a copy of our pointers. If we make it to the end of
482 * this block then we will commit them back to info->ptrs.
483 * Otherwise we can try again from the same starting state
484 * next time we are called.
489 * Find the tag, and the offset of the next one. If we need to
490 * stop including tags, then by default we stop *after*
491 * including the current tag
493 offset
= p
.nextoffset
;
494 tag
= fdt_next_tag(fdt
, offset
, &p
.nextoffset
);
495 stop_at
= p
.nextoffset
;
500 prop
= fdt_get_property_by_offset(fdt
, offset
, NULL
);
501 str
= fdt_string(fdt
, fdt32_to_cpu(prop
->nameoff
));
502 val
= h_include(priv
, fdt
, last_node
, FDT_IS_PROP
, str
,
505 include
= p
.want
>= WANT_NODES_AND_PROPS
;
509 * Make sure we include the } for this block.
510 * It might be more correct to have this done
511 * by the call to fdt_include_supernodes() in
512 * the case where it adds the node we are
513 * currently in, but this is equivalent.
515 if ((flags
& FDT_REG_SUPERNODES
) && val
&&
517 p
.want
= WANT_NODES_ONLY
;
520 /* Value grepping is not yet supported */
524 include
= p
.want
>= WANT_NODES_AND_PROPS
;
531 if (p
.depth
== FDT_MAX_DEPTH
)
532 return -FDT_ERR_BADSTRUCTURE
;
533 name
= fdt_get_name(fdt
, offset
, &len
);
534 if (p
.end
- path
+ 2 + len
>= path_len
)
535 return -FDT_ERR_NOSPACE
;
537 /* Build the full path of this node */
538 if (p
.end
!= path
+ 1)
542 info
->stack
[p
.depth
].want
= p
.want
;
543 info
->stack
[p
.depth
].offset
= offset
;
546 * If we are not intending to include this node unless
547 * it matches, make sure we stop *before* its tag.
549 if (p
.want
== WANT_NODES_ONLY
||
550 !(flags
& (FDT_REG_DIRECT_SUBNODES
|
551 FDT_REG_ALL_SUBNODES
))) {
553 p
.want
= WANT_NOTHING
;
555 val
= h_include(priv
, fdt
, offset
, FDT_IS_NODE
, path
,
558 /* Include this if requested */
560 p
.want
= (flags
& FDT_REG_ALL_SUBNODES
) ?
561 WANT_ALL_NODES_AND_PROPS
:
562 WANT_NODES_AND_PROPS
;
565 /* If not requested, decay our 'p.want' value */
567 if (p
.want
!= WANT_ALL_NODES_AND_PROPS
)
570 /* Not including this tag, so stop now */
576 * Decide whether to include this tag, and update our
577 * stack with the state for this node
580 info
->stack
[p
.depth
].included
= include
;
586 return -FDT_ERR_BADSTRUCTURE
;
589 * If we don't want this node, stop right away, unless
590 * we are including subnodes
592 if (!p
.want
&& !(flags
& FDT_REG_DIRECT_SUBNODES
))
594 p
.want
= info
->stack
[p
.depth
].want
;
596 while (p
.end
> path
&& *--p
.end
!= '/')
602 /* We always include the end tag */
604 p
.done
= FDT_DONE_STRUCT
;
608 /* If this tag is to be included, mark it as region start */
609 if (include
&& info
->start
== -1) {
610 /* Include any supernodes required by this one */
611 if (flags
& FDT_REG_SUPERNODES
) {
612 if (fdt_include_supernodes(info
, p
.depth
))
615 info
->start
= offset
;
619 * If this tag is not to be included, finish up the current
622 if (!include
&& info
->start
!= -1) {
623 if (fdt_add_region(info
, base
+ info
->start
,
624 stop_at
- info
->start
))
630 /* If we have made it this far, we can commit our pointers */
634 /* Add a region for the END tag and a separate one for string table */
635 if (info
->ptrs
.done
< FDT_DONE_END
) {
636 if (info
->ptrs
.nextoffset
!= fdt_size_dt_struct(fdt
))
637 return -FDT_ERR_BADSTRUCTURE
;
639 if (fdt_add_region(info
, base
+ info
->start
,
640 info
->ptrs
.nextoffset
- info
->start
))
644 if (info
->ptrs
.done
< FDT_DONE_STRINGS
) {
645 if (flags
& FDT_REG_ADD_STRING_TAB
) {
647 if (fdt_off_dt_strings(fdt
) <
648 base
+ info
->ptrs
.nextoffset
)
649 return -FDT_ERR_BADLAYOUT
;
650 if (fdt_add_region(info
, fdt_off_dt_strings(fdt
),
651 fdt_size_dt_strings(fdt
)))
657 return info
->count
> 0 ? 0 : -FDT_ERR_NOTFOUND
;