stm32mp2: Update fwu_mdata node accordingly to boot device

Update dynamically fwu_mdata node properties accordingly to boot device.
Depending of boot device, fwu_mdata node's properties must be updated
to allow to EFI framework to get access to metadata.

This fixes the following EFI error message "FWU metadata read failed".

By default, the fwu-mdata node in stm32mp1***-u-boot.dtsi indicates
that metadata are located on sdmmc1. This is used by default, in this
case boot device is sdcard :

	fwu-mdata {
		compatible = "u-boot,fwu-mdata-gpt";
		fwu-mdata-store = <&sdmmc1>;
	};

For emmc boot, the compatible and fwu-mdata-store properties must be
updated as following :
	fwu-mdata {
		compatible = "u-boot,fwu-mdata-gpt";
		fwu-mdata-store = <&sdmmc2>;
	};

For nor boot, the fwu-mdata-store and compatible properties must be
updated as following:

	fwu-mdata {
		compatible = "u-boot,fwu-mdata-mtd";
		fwu-mdata-store = <&flash0>;
	};

For nand boot, the fwu-mdata-store and compatible properties must be
updated as following:

	fwu-mdata {
		compatible = "u-boot,fwu-mdata-mtd";
		fwu-mdata-store = <&nand0>;
	};

Signed-off-by: Patrice Chotard <patrice.chotard@foss.st.com>
Change-Id: I8232e1037aac9908caeef5906e78a6ac00c221a8
Reviewed-on: https://gerrit.st.com/c/mpu/oe/st/u-boot/+/382102
ACI: CIBUILD <MDG-smet-aci-builds@list.st.com>

Author: Patrice Chotard

board/st/stm32mp2/stm32mp2.c

@@ -791,3 +791,86 @@ void *env_sf_get_env_addr(void)
 {
 	return NULL;
 }
+
+#if defined(CONFIG_OF_BOARD_FIXUP)
+
+int fdt_update_fwu_properties(void *blob, int nodeoff,
+			      const char *compat_str,
+			      const char *storage_path)
+{
+	int ret;
+	int storage_off;
+
+	ret = fdt_increase_size(blob, 100);
+	if (ret) {
+		printf("fdt_increase_size: err=%s\n", fdt_strerror(ret));
+		return ret;
+	}
+
+	ret = fdt_setprop_string(blob, nodeoff, "compatible", compat_str);
+	if (ret) {
+		log_err("Can't set compatible property\n");
+		return ret;
+	}
+
+	storage_off = fdt_path_offset(blob, storage_path);
+	if (storage_off < 0) {
+		log_err("Can't find %s path\n", storage_path);
+		return nodeoff;
+	}
+
+	ret = fdt_setprop_string(blob, nodeoff, "fwu-mdata-store", storage_path);
+
+	if (ret < 0)
+		log_err("Can't set fwu-mdata-store property\n");
+
+	return ret;
+}
+
+int fdt_update_fwu_mdata(void *blob)
+{
+	int nodeoff, ret = 0;
+	u32 bootmode;
+
+	nodeoff = fdt_path_offset(blob, "/fwu-mdata");
+	if (nodeoff < 0) {
+		log_info("no /fwu-mdata node ?\n");
+
+		return 0;
+	}
+
+	bootmode = get_bootmode() & TAMP_BOOT_DEVICE_MASK;
+
+	switch (bootmode) {
+	case BOOT_FLASH_SD:
+		/* sdmmc1 : nothing to do, already the default device tree configuration */
+		break;
+	case BOOT_FLASH_EMMC:
+		/* sdmmc2 */
+		ret = fdt_update_fwu_properties(blob, nodeoff, "u-boot,fwu-mdata-mtd",
+						"/soc@0/rifsc@42080000/mmc@48230000");
+		break;
+
+	case BOOT_FLASH_SPINAND:
+	case BOOT_FLASH_NOR:
+		/* flash0 */
+		ret = fdt_update_fwu_properties(blob, nodeoff, "u-boot,fwu-mdata-gpt",
+						"/soc@0/ommanager@40500000/spi@40430000/flash@0");
+		break;
+	}
+
+	return ret;
+}
+
+int board_fix_fdt(void *blob)
+{
+	int ret = 0;
+
+	if (CONFIG_IS_ENABLED(FWU_MDATA) &&
+	    (board_is_stm32mp257_eval() || board_is_stm32mp257_disco()))
+		ret = fdt_update_fwu_mdata(blob);
+
+	return ret;
+}
+#endif /* CONFIG_OF_BOARD_FIXUP */
+