1 /* 2 * Copyright (c) 2013 The Chromium OS Authors. 3 * 4 * SPDX-License-Identifier: GPL-2.0+ 5 */ 6 7 #include <common.h> 8 #include <initcall.h> 9 #include <efi.h> 10 11 DECLARE_GLOBAL_DATA_PTR; 12 13 #define TICKS_TO_US(ticks) ((ticks) / (gd->arch.timer_rate_hz / 1000000)) 14 #define US_TO_MS(ticks) ((ticks) / 1000) 15 #define US_TO_US(ticks) ((ticks) % 1000) 16 17 #ifdef DEBUG 18 static inline void call_get_ticks(ulong *ticks) { *ticks = get_ticks(); } 19 #else 20 static inline void call_get_ticks(ulong *ticks) { } 21 #endif 22 23 int initcall_run_list(const init_fnc_t init_sequence[]) 24 { 25 const init_fnc_t *init_fnc_ptr; 26 ulong start = 0, end = 0, sum = 0; 27 28 if (!gd->sys_start_tick) 29 gd->sys_start_tick = get_ticks(); 30 31 for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) { 32 unsigned long reloc_ofs = 0; 33 int ret; 34 35 if (gd->flags & GD_FLG_RELOC) 36 reloc_ofs = gd->reloc_off; 37 #ifdef CONFIG_EFI_APP 38 reloc_ofs = (unsigned long)image_base; 39 #endif 40 debug("initcall: %p", (char *)*init_fnc_ptr - reloc_ofs); 41 if (gd->flags & GD_FLG_RELOC) 42 debug(" (relocated to %p)\n", (char *)*init_fnc_ptr); 43 else 44 debug("\n"); 45 call_get_ticks(&start); 46 ret = (*init_fnc_ptr)(); 47 call_get_ticks(&end); 48 49 if (start != end) { 50 sum = TICKS_TO_US(end - gd->sys_start_tick); 51 debug("\t\t\t\t\t\t\t\t#%8ld us #%4ld.%3ld ms\n", 52 TICKS_TO_US(end - start), US_TO_MS(sum), US_TO_US(sum)); 53 } 54 if (ret) { 55 printf("initcall sequence %p failed at call %p (err=%d)\n", 56 init_sequence, 57 (char *)*init_fnc_ptr - reloc_ofs, ret); 58 return -1; 59 } 60 } 61 return 0; 62 } 63