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
fmap_append_fmd_node(struct fmap ** flashmap,const struct flashmap_descriptor * section,unsigned absolute_watermark)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
fmap_from_fmd(const struct flashmap_descriptor * desc)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 }
69