linuxloader: Introduce device_quirks

Author: luka177

droidbootPlatformsLib.inf

@@ -41,6 +41,7 @@
 [Sources]
   uefi/common/droidboot_uefi_common.c
   uefi/common_linuxloader/common_linuxloader.c
+  uefi/common_linuxloader/device_quirks.c
   uefi/common_linuxloader/linux-boot/arm.c
   common/droidboot_platform_common.c
 

uefi/common_linuxloader/common_linuxloader.c

@@ -21,6 +21,7 @@
 #include <droidboot_dtb.h>
 #include <droidboot_kernel_helper.h>
 #include <droidboot_ufdt_overlay.h>
+#include <device_quirks.h>
 
 #include "linux-boot/arm.h"
 
@@ -171,6 +172,7 @@ void droidboot_internal_boot_linux_from_ram(void *kernel_raw, off_t kernel_raw_s
             }
         }
     }
+
     droidboot_log(DROIDBOOT_LOG_INFO, "dtb reallocation done, old addr: %p new: %p, new size: %llx\n", dtb_raw, dtb_address, dtb_raw_size);
 
     // Update size in dtb itself
@@ -212,6 +214,9 @@ void droidboot_internal_boot_linux_from_ram(void *kernel_raw, off_t kernel_raw_s
     }
     droidboot_dtb_update_cmdline(dtb_address, &cmdline);
 
+    // As a last step apply platform specific hacks, if any
+    droidboot_uefi_dtb_device_patch(dtb_address, model);
+
     // Boot new kernel
     boot_linux_arm(kernel_reallocated+LINUX_ARM64_OFFSET, kernel_actual_size, dtb_address, dtb_raw_size);
 }

uefi/common_linuxloader/device_quirks.c

@@ -0,0 +1,53 @@
+#include <string.h>
+
+#include <droidboot_logging.h>
+#include <droidboot_error.h>
+#include <droidboot_libufdt.h>
+#include <sys/types.h>
+#include <droidboot_libfdt.h>
+
+// We need device name from dtbo as it apparently not overlayed by ufdt
+droidboot_error droidboot_uefi_dtb_device_patch(void*fdt, char *device_name)
+{
+    droidboot_error err;
+    uint off;
+
+    // Check fdt header, just in case
+    err = fdt_check_header(fdt);
+    if(err!=0){
+        droidboot_log(DROIDBOOT_LOG_ERROR, "dtb header check failed: %d\n", err);
+        return err;
+    }
+
+    // On some devices BL disable firmware node, if left enable confuses android's init
+   /* if (strstr(device_name, "pipa") != NULL || strstr(device_name, "vayu") != NULL){
+        droidboot_log(DROIDBOOT_LOG_INFO, "device quirks: Patching dtb, disable fstab/vendor\n");
+        err=fdt_path_offset(fdt,"/firmware/android/fstab/vendor");
+        if(err<0){
+            droidboot_log(DROIDBOOT_LOG_ERROR, "get chosen node failed: %s\n", fdt_strerror(err));
+            return err;
+        }
+        off=err;
+        err=fdt_setprop_string(fdt, off, "status", "disabled");
+        if(err<0){
+            droidboot_log(DROIDBOOT_LOG_ERROR, "Setting status failed: %s\n", fdt_strerror(err));
+            return err;
+        }
+    }*/
+
+    if (strstr(device_name, "pipa") != NULL){
+        droidboot_log(DROIDBOOT_LOG_INFO, "device quirks: Patching dtb, adding ddr type\n");
+        err=fdt_path_offset(fdt,"/memory");
+        if(err<0){
+            droidboot_log(DROIDBOOT_LOG_ERROR, "get memory node failed: %s\n", fdt_strerror(err));
+            return err;
+        }
+        off=err;
+        err=fdt_setprop_u32(fdt,off,"ddr_device_type",0x88);
+        if(err<0){
+            droidboot_log(DROIDBOOT_LOG_ERROR, "Setting status failed: %s\n", fdt_strerror(err));
+            return err;
+        }
+    }
+    return DROIDBOOT_EOK;
+}

uefi/common_linuxloader/device_quirks.h

@@ -0,0 +1,4 @@
+#pragma once
+#include <droidboot_error.h>
+
+droidboot_error droidboot_uefi_dtb_device_patch(void*fdt, char *device_name);