1  /* fmap_from_fmd.c, tool to distill flashmap descriptors into raw FMAP sections */
 2  /* SPDX-License-Identifier: GPL-2.0-only */
 3  
 4  #include "fmap_from_fmd.h"
 5  
 6  #include "common.h"
 7  
 8  #include <assert.h>
 9  #include <string.h>
10  
11  static bool fmap_append_fmd_node(struct fmap **flashmap,
12  				const struct flashmap_descriptor *section,
13  						unsigned absolute_watermark) {
14  	uint16_t flags = 0;
15  	if (strlen(section->name) >= FMAP_STRLEN) {
16  		ERROR("Section name ('%s') exceeds %d character FMAP format limit\n",
17  						section->name, FMAP_STRLEN - 1);
18  		return false;
19  	}
20  
21  	absolute_watermark += section->offset;
22  
23  	if (section->flags.f.preserve)
24  		flags |= FMAP_AREA_PRESERVE;
25  
26  	if (fmap_append_area(flashmap, absolute_watermark, section->size,
27  					(uint8_t *)section->name, flags) < 0) {
28  		ERROR("Failed to insert section '%s' into FMAP\n",
29  								section->name);
30  		return false;
31  	}
32  
33  	fmd_foreach_child(subsection, section) {
34  		if (!fmap_append_fmd_node(flashmap, subsection,
35  							absolute_watermark))
36  			return false;
37  	}
38  
39  	return true;
40  }
41  
42  struct fmap *fmap_from_fmd(const struct flashmap_descriptor *desc)
43  {
44  	assert(desc);
45  	assert(desc->size_known);
46  
47  	if (strlen(desc->name) >= FMAP_STRLEN) {
48  		ERROR("Image name ('%s') exceeds %d character FMAP header limit\n",
49  						desc->name, FMAP_STRLEN - 1);
50  		return NULL;
51  	}
52  
53  	struct fmap *fmap = fmap_create(desc->offset_known ? desc->offset : 0,
54  					desc->size, (uint8_t *)desc->name);
55  	if (!fmap) {
56  		ERROR("Failed to allocate FMAP header\n");
57  		return fmap;
58  	}
59  
60  	fmd_foreach_child(real_section, desc) {
61  		if (!fmap_append_fmd_node(&fmap, real_section, 0)) {
62  			fmap_destroy(fmap);
63  			return NULL;
64  		}
65  	}
66  
67  	return fmap;
68  }