src/mainboard/sifive/hifive-unmatched/fixup_fdt.c

   1 /* SPDX-License-Identifier: GPL-2.0-only */
   2
   3 #include <stdint.h>
   4 #include <stdlib.h>
   5 #include <string.h>
   6 #include <console/console.h>
   7 #include <soc/otp.h>
   8 #include <soc/sdram.h>
   9 #include <cbfs.h>
  10 #include <commonlib/device_tree.h>
  11 #include <bootstate.h>
  12 #include <mcall.h>
  13
  14 static void do_fixup_mac(struct device_tree_node *node)
  15 {
  16         uint32_t serial = otp_read_serial();
  17         static unsigned char mac[6] = { 0x70, 0xb3, 0xd5, 0x92, 0xf0, 0x00 };
  18         if (serial != ~0) {
  19                 mac[5] |= (serial >>  0) & 0xff;
  20                 mac[4] |= (serial >>  8) & 0xff;
  21                 mac[3] |= (serial >> 16) & 0xff;
  22         }
  23         dt_add_bin_prop(node, "local-mac-address", mac, 6);
  24 }
  25
  26 static void fixup_mac(struct device_tree_node *parent)
  27 {
  28         struct device_tree_property *prop;
  29         const char *name = "local-mac-address";
  30
  31         list_for_each(prop, parent->properties, list_node) {
  32                 if (!strcmp(name, prop->prop.name))
  33                         do_fixup_mac(parent);
  34         }
  35
  36         struct device_tree_node *child;
  37         list_for_each(child, parent->children, list_node) {
  38                 fixup_mac(child);
  39         }
  40 }
  41
  42 static void do_fixup_memory(struct device_tree_node *node)
  43 {
  44         u64 addrs[1], sizes[1];
  45         addrs[0] = 0x80000000;
  46         sizes[0] = sdram_size();
  47         dt_add_reg_prop(node, addrs, sizes, 1, 2, 2);
  48 }
  49
  50 static void fixup_memory(struct device_tree_node *parent)
  51 {
  52         struct device_tree_property *prop;
  53         const char *name = "device_type";
  54         const char *value = "memory";
  55
  56         list_for_each(prop, parent->properties, list_node) {
  57                 if (!strcmp(name, prop->prop.name)) {
  58                         if (!strcmp(value, (char *)prop->prop.data))
  59                                 do_fixup_memory(parent);
  60                 }
  61         }
  62
  63         struct device_tree_node *child;
  64         list_for_each(child, parent->children, list_node) {
  65                 fixup_memory(child);
  66         }
  67 }
  68
  69 static void fixup_fdt(void *unused)
  70 {
  71         printk(BIOS_DEBUG, "fix up FDT\n");
  72
  73         void *fdt_rom;
  74         struct device_tree *tree;
  75
  76         /* load flat dt from cbfs */
  77         fdt_rom = cbfs_map("fallback/DTB", NULL);
  78
  79         if (fdt_rom == NULL) {
  80                 printk(BIOS_ERR, "Unable to load fallback/DTB from CBFS\n");
  81                 return;
  82         }
  83
  84         /* Expand DT into a tree */
  85         tree = fdt_unflatten(fdt_rom);
  86
  87         /* fixup tree */
  88         fixup_mac(tree->root);
  89         fixup_memory(tree->root);
  90
  91         /* convert the tree to a flat dt */
  92         void *dt = malloc(dt_flat_size(tree));
  93
  94         if (dt == NULL) {
  95                 printk(BIOS_ERR, "Unable to allocate memory for flat device tree\n");
  96                 return;
  97         }
  98
  99         dt_flatten(tree, dt);
 100
 101         /* update HLS */
 102         for (int i = 0; i < CONFIG_MAX_CPUS; i++)
 103                 OTHER_HLS(i)->fdt = dt;
 104 }
 105
 106 BOOT_STATE_INIT_ENTRY(BS_WRITE_TABLES, BS_ON_EXIT, fixup_fdt, NULL);