Merge https://gitlab.denx.de/u-boot/custodians/u-boot-sh

[oweals/u-boot.git] / include / initcall.h

diff --git a/include/initcall.h b/include/initcall.h
index 01f3f2833f10291429049ec346b407d405b97954..41b74dc52d2ff1ee751bba9333d6f517e4f829e3 100644 (file)
--- a/include/initcall.h
+++ b/include/initcall.h
@@ -8,6 +8,49 @@
 
 typedef int (*init_fnc_t)(void);
 
-int initcall_run_list(const init_fnc_t init_sequence[]);
+#include <log.h>
+#ifdef CONFIG_EFI_APP
+#include <efi.h>
+#endif
+
+/*
+ * To enable debugging. add #define DEBUG at the top of the including file.
+ *
+ * To find a symbol, use grep on u-boot.map
+ */
+static inline int initcall_run_list(const init_fnc_t init_sequence[])
+{
+       const init_fnc_t *init_fnc_ptr;
+
+       for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
+               unsigned long reloc_ofs = 0;
+               int ret;
+
+               /*
+                * Sandbox is relocated by the OS, so symbols always appear at
+                * the relocated address.
+                */
+               if (IS_ENABLED(CONFIG_SANDBOX) || (gd->flags & GD_FLG_RELOC))
+                       reloc_ofs = gd->reloc_off;
+#ifdef CONFIG_EFI_APP
+               reloc_ofs = (unsigned long)image_base;
+#endif
+               if (reloc_ofs)
+                       debug("initcall: %p (relocated to %p)\n",
+                                       (char *)*init_fnc_ptr - reloc_ofs,
+                                       (char *)*init_fnc_ptr);
+               else
+                       debug("initcall: %p\n", (char *)*init_fnc_ptr - reloc_ofs);
+
+               ret = (*init_fnc_ptr)();
+               if (ret) {
+                       printf("initcall sequence %p failed at call %p (err=%d)\n",
+                              init_sequence,
+                              (char *)*init_fnc_ptr - reloc_ofs, ret);
+                       return -1;
+               }
+       }
+       return 0;
+}
 
 #endif