mxssb: Support multiple sections

So far, we only support one section, but once we have proper parser
we will be able to support multiple sections. Prepare for this by
implementing the section generation in the image tree correctly.
Signed-off-by: Marek Vasut <marex@denx.de>

mxssb.c

@@ -661,34 +661,60 @@ err:
 static int sb_parse_sections(struct sb_image_ctx *ictx)
 {
 	/* This function is a stub, we support only one section so far. */
-	struct sb_section_ctx *sctx;
+	struct sb_cmd_ctx *cctx, *c_head;
+	struct sb_section_ctx *sctx, *head = NULL, *prev = NULL;
 	struct sb_sections_header *shdr;
 	int ret;
+	int sects = 1;
 
-	sctx = calloc(1, sizeof(*sctx));
-	if (!sctx)
-		return -ENOMEM;
+	while (sects--) {
 
-	ret = sb_parse_cmds(sctx);
-	if (ret)
-		goto fail;
+		sctx = calloc(1, sizeof(*sctx));
+		if (!sctx)
+			goto fail;
 
-	shdr = &sctx->payload;
-	/* FIXME -- bootable by default. */
-	sctx->boot = 1;
+		if (!head)
+			head = sctx;
 
-	/* FIXME -- the section ID should be configurable */
-	shdr->section_number = ictx->section_count++;
-	/* FIXME -- use this instead of sctx->size */
-	shdr->section_size = sctx->size / SB_BLOCK_SIZE;
-	shdr->section_flags = sctx->boot ? SB_SECTION_FLAG_BOOTABLE : 0;
+		ret = sb_parse_cmds(sctx);
+		if (ret)
+			goto fail;
+
+		shdr = &sctx->payload;
+		/* FIXME -- bootable by default. */
+		sctx->boot = 1;
+
+		/* FIXME -- the section ID should be configurable */
+		shdr->section_number = ictx->section_count++;
+		shdr->section_size = sctx->size / SB_BLOCK_SIZE;
+		shdr->section_flags = sctx->boot ? SB_SECTION_FLAG_BOOTABLE : 0;
+
+		if (prev)
+			prev->sect = sctx;
+		prev = sctx;
+	}
 
-	ictx->sect = sctx;
+	ictx->sect = head;
 
 	return 0;
 
 fail:
-	free(sctx);
+	while (head) {
+		sctx = head;
+		c_head = head->cmd;
+
+		while (c_head) {
+			cctx = c_head;
+			c_head = c_head->cmd;
+			if (cctx->data)
+				free(cctx->data);
+			free(cctx);
+		}
+
+		head = head->sect;
+		free(sctx);
+	}
+
 	return ret;
 }