db410c: replace reset driver with psci

[u-boot] / board / qualcomm / dragonboard410c / dragonboard410c.c

diff --git a/board/qualcomm/dragonboard410c/dragonboard410c.c b/board/qualcomm/dragonboard410c/dragonboard410c.c
index 848e27848b743a3d7c31b43966b127e5064a2b4b..b9bf55ba31e53bb0ab7d990ec251b588533d8165 100644 (file)
--- a/board/qualcomm/dragonboard410c/dragonboard410c.c
+++ b/board/qualcomm/dragonboard410c/dragonboard410c.c
@@ -10,9 +10,16 @@
 #include <dm.h>
 #include <usb.h>
 #include <asm/gpio.h>
+#include <fdt_support.h>
 
 DECLARE_GLOBAL_DATA_PTR;
 
+/* pointer to the device tree ammended by the firmware */
+extern const void *fw_dtb;
+
+static char wlan_mac[ARP_HLEN];
+static char bt_mac[ARP_HLEN];
+
 int dram_init(void)
 {
        gd->ram_size = PHYS_SDRAM_1_SIZE;
@@ -27,7 +34,6 @@ int dram_init_banksize(void)
        return 0;
 }
 
-
 int board_prepare_usb(enum usb_init_type type)
 {
        static struct udevice *pmic_gpio;
@@ -96,11 +102,6 @@ int board_prepare_usb(enum usb_init_type type)
        return 0;
 }
 
-int board_init(void)
-{
-       return 0;
-}
-
 /* Check for vol- button - if pressed - stop autoboot */
 int misc_init_r(void)
 {
@@ -134,3 +135,44 @@ int misc_init_r(void)
 
        return 0;
 }
+
+int board_init(void)
+{
+       int offset, len;
+       const char *mac;
+
+       /* take a copy of the firmware information (the user could unknownly
+          overwrite that DDR via tftp or other means)  */
+
+       offset = fdt_node_offset_by_compatible(fw_dtb, -1, "qcom,wcnss-wlan");
+       if (offset >= 0) {
+               mac = fdt_getprop(fw_dtb, offset, "local-mac-address", &len);
+               if (mac)
+                       memcpy(wlan_mac, mac, ARP_HLEN);
+       }
+
+       offset = fdt_node_offset_by_compatible(fw_dtb, -1, "qcom,wcnss-bt");
+       if (offset >= 0) {
+               mac = fdt_getprop(fw_dtb, offset, "local-bd-address", &len);
+               if (mac)
+                       memcpy(bt_mac, mac, ARP_HLEN);
+       }
+
+       return 0;
+}
+
+int ft_board_setup(void *blob, bd_t *bd)
+{
+       do_fixup_by_compat(blob, "qcom,wcnss-wlan", "local-mac-address",
+                          wlan_mac, ARP_HLEN, 1);
+
+       do_fixup_by_compat(blob, "qcom,wcnss-bt", "local-bd-address",
+                          bt_mac, ARP_HLEN, 1);
+
+       return 0;
+}
+
+void reset_cpu(ulong addr)
+{
+       psci_system_reset();
+}