arm: mvebu: turris_omnia: fixup MTD partitions in Linux' DTB

Fixup SPI NOR partition nodes in Linux' device tree prior booting Linux.

Linux' devicetree does not contain "u-boot-env" partition and we do not
want to add it there because the address is different between stock
U-Boot and current upstream U-Boot.

Instead we add code that recreates partition nodes from scratch
according to how U-Boot sees them (which is defined in U-Boot's device
tree).

Signed-off-by: Marek Behún <marek.behun@nic.cz>
Reviewed-by: Stefan Roese <sr@denx.de>

diff --git a/board/CZ.NIC/turris_omnia/turris_omnia.c b/board/CZ.NIC/turris_omnia/turris_omnia.c
index 8b2f94f959ab2d45f9d80a0dbc15038894dd11eb..a7e5f56eed7b7819a62b4c4dbe8559d43b758f66 100644 (file)
--- a/board/CZ.NIC/turris_omnia/turris_omnia.c
+++ b/board/CZ.NIC/turris_omnia/turris_omnia.c
@@ -13,6 +13,7 @@
 #include <init.h>
 #include <log.h>
 #include <miiphy.h>
+#include <mtd.h>
 #include <net.h>
 #include <netdev.h>
 #include <asm/global_data.h>
@@ -31,6 +32,8 @@
 
 DECLARE_GLOBAL_DATA_PTR;
 
+#define OMNIA_SPI_NOR_PATH             "/soc/spi@10600/spi-nor@0"
+
 #define OMNIA_I2C_BUS_NAME             "i2c@11000->i2cmux@70->i2c@0"
 
 #define OMNIA_I2C_MCU_CHIP_ADDR                0x2a
@@ -557,3 +560,90 @@ out:
        return 0;
 }
 
+#if defined(CONFIG_OF_BOARD_SETUP)
+/*
+ * I plan to generalize this function and move it to common/fdt_support.c.
+ * This will require some more work on multiple boards, though, so for now leave
+ * it here.
+ */
+static bool fixup_mtd_partitions(void *blob, int offset, struct mtd_info *mtd)
+{
+       struct mtd_info *slave;
+       int parts;
+
+       parts = fdt_subnode_offset(blob, offset, "partitions");
+       if (parts < 0)
+               return false;
+
+       if (fdt_del_node(blob, parts) < 0)
+               return false;
+
+       parts = fdt_add_subnode(blob, offset, "partitions");
+       if (parts < 0)
+               return false;
+
+       if (fdt_setprop_u32(blob, parts, "#address-cells", 1) < 0)
+               return false;
+
+       if (fdt_setprop_u32(blob, parts, "#size-cells", 1) < 0)
+               return false;
+
+       if (fdt_setprop_string(blob, parts, "compatible",
+                              "fixed-partitions") < 0)
+               return false;
+
+       mtd_probe_devices();
+
+       list_for_each_entry(slave, &mtd->partitions, node) {
+               char name[32];
+               int part;
+
+               snprintf(name, sizeof(name), "partition@%llx", slave->offset);
+               part = fdt_add_subnode(blob, parts, name);
+               if (part < 0)
+                       return false;
+
+               if (fdt_setprop_u32(blob, part, "reg", slave->offset) < 0)
+                       return false;
+
+               if (fdt_appendprop_u32(blob, part, "reg", slave->size) < 0)
+                       return false;
+
+               if (fdt_setprop_string(blob, part, "label", slave->name) < 0)
+                       return false;
+
+               if (!(slave->flags & MTD_WRITEABLE))
+                       if (fdt_setprop_empty(blob, part, "read-only") < 0)
+                               return false;
+
+               if (slave->flags & MTD_POWERUP_LOCK)
+                       if (fdt_setprop_empty(blob, part, "lock") < 0)
+                               return false;
+       }
+
+       return true;
+}
+
+int ft_board_setup(void *blob, struct bd_info *bd)
+{
+       struct mtd_info *mtd;
+       int node;
+
+       mtd = get_mtd_device_nm(OMNIA_SPI_NOR_PATH);
+       if (IS_ERR_OR_NULL(mtd))
+               goto fail;
+
+       node = fdt_path_offset(blob, OMNIA_SPI_NOR_PATH);
+       if (node < 0)
+               goto fail;
+
+       if (!fixup_mtd_partitions(blob, node, mtd))
+               goto fail;
+
+       return 0;
+
+fail:
+       printf("Failed fixing SPI NOR partitions!\n");
+       return 0;
+}
+#endif

diff --git a/configs/turris_omnia_defconfig b/configs/turris_omnia_defconfig
index f860cf5e7de026c6b277bfd0d78a9f91524e249d..5f7b1a67a208d5f8e84fce7ceabf54cb9b34ef01 100644 (file)
--- a/configs/turris_omnia_defconfig
+++ b/configs/turris_omnia_defconfig
@@ -23,6 +23,7 @@ CONFIG_SPL=y
 CONFIG_DEBUG_UART_BASE=0xd0012000
 CONFIG_DEBUG_UART_CLOCK=250000000
 CONFIG_DEBUG_UART=y
+CONFIG_OF_BOARD_SETUP=y
 CONFIG_AHCI=y
 CONFIG_DISTRO_DEFAULTS=y
 CONFIG_FIT=y