sandbox: Improve debugging in initcall_run_list()
[oweals/u-boot.git] / include / initcall.h
1 /* SPDX-License-Identifier: GPL-2.0+ */
2 /*
3  * Copyright (c) 2011 The Chromium OS Authors.
4  */
5
6 #ifndef __INITCALL_H
7 #define __INITCALL_H
8
9 typedef int (*init_fnc_t)(void);
10
11 #include <common.h>
12 #include <initcall.h>
13 #include <efi.h>
14
15 DECLARE_GLOBAL_DATA_PTR;
16
17 static inline int initcall_run_list(const init_fnc_t init_sequence[])
18 {
19         const init_fnc_t *init_fnc_ptr;
20
21         for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
22                 unsigned long reloc_ofs = 0;
23                 int ret;
24
25                 /*
26                  * Sandbox is relocated by the OS, so symbols always appear at
27                  * the relocated address.
28                  */
29                 if (IS_ENABLED(CONFIG_SANDBOX) || (gd->flags & GD_FLG_RELOC))
30                         reloc_ofs = gd->reloc_off;
31 #ifdef CONFIG_EFI_APP
32                 reloc_ofs = (unsigned long)image_base;
33 #endif
34                 debug("initcall: %p", (char *)*init_fnc_ptr - reloc_ofs);
35                 if (reloc_ofs)
36                         debug(" (relocated to %p)\n", (char *)*init_fnc_ptr);
37                 else
38                         debug("\n");
39                 ret = (*init_fnc_ptr)();
40                 if (ret) {
41                         printf("initcall sequence %p failed at call %p (err=%d)\n",
42                                init_sequence,
43                                (char *)*init_fnc_ptr - reloc_ofs, ret);
44                         return -1;
45                 }
46         }
47         return 0;
48 }
49
50 #endif