kboot: pmp initialization

Copy all the things that PMP needs in order to boot.

Signed-off-by: Sasha Finkelstein <fnkl.kernel@gmail.com>

Author: WhatAmISupposedToPutHere

src/kboot.c

@@ -1984,6 +1984,53 @@ static int dt_set_display(void)
         return dt_vram_reserved_region("dcp", "disp0");
 }
 
+static int dt_set_pmp(void)
+{
+    const char *path = fdt_get_alias(dt, "pmp");
+    if (path == NULL) {
+        printf("FDT: pmp alias not found in devtree\n");
+        return 0;
+    }
+
+    int chosen_anode = adt_path_offset(adt, "/chosen");
+    if (chosen_anode < 0)
+        bail("ADT: /chosen not found \n");
+    int pmp_iop_anode = adt_path_offset(adt, "/arm-io/pmp/iop-pmp-nub");
+    if (pmp_iop_anode < 0)
+        bail("ADT: /arm-io/pmp/iop-pmp-nub not found \n");
+
+    u32 board_id, dram_vendor_id, dram_capacity;
+    if (ADT_GETPROP(adt, chosen_anode, "board-id", &board_id) < 0)
+        bail("ADT: failed to get board id\n");
+    if (ADT_GETPROP(adt, chosen_anode, "dram-vendor-id", &dram_vendor_id) < 0)
+        bail("ADT: failed to get dram vendor id\n");
+    if (ADT_GETPROP(adt, pmp_iop_anode, "dram-capacity", &dram_capacity) < 0)
+        bail("ADT: failed to get dram capacity\n");
+
+    int pmp_node = fdt_path_offset(dt, path);
+    if (pmp_node < 0)
+        bail("FDT: pmp not not found in devtree\n");
+    if (fdt_setprop_u32(dt, pmp_node, "apple,board-id", board_id))
+        bail("FDT: failed to set board id\n");
+    if (fdt_setprop_u32(dt, pmp_node, "apple,dram-vendor-id", dram_vendor_id))
+        bail("FDT: failed to set dram vendor id\n");
+    if (fdt_setprop_u32(dt, pmp_node, "apple,dram-capacity", dram_capacity))
+        bail("FDT: failed to set dram capacity\n");
+
+    int tunables_node = fdt_subnode_offset(dt, pmp_node, "tunables");
+    if (tunables_node < 0)
+        bail("FDT: pmp tunables not not found in devtree\n");
+
+    ADT_FOREACH_PROPERTY(adt, pmp_iop_anode, prop)
+    {
+        if (!strcmp(prop->name, "compatible") || !strcmp(prop->name, "AAPL,phandle"))
+            continue;
+        if (fdt_setprop(dt, tunables_node, prop->name, prop->value, prop->size))
+            bail("FDT: failed to transfer pmp tunable");
+    }
+    return 0;
+}
+
 static int dt_set_sep(void)
 {
     const char *path = fdt_get_alias(dt, "sep");
@@ -2685,6 +2732,8 @@ int kboot_prepare_dt(void *fdt)
         return -1;
     if (dt_set_sep())
         return -1;
+    if (dt_set_pmp())
+        return -1;
     if (dt_set_nvram())
         return -1;
     if (dt_set_ipd())