include/initcall.h

/* SPDX-License-Identifier: GPL-2.0+ */
/*
 * Copyright (c) 2011 The Chromium OS Authors.
 */

#ifndef __INITCALL_H
#define __INITCALL_H

typedef int (*init_fnc_t)(void);

#include <log.h>
#ifdef CONFIG_EFI_APP
#include <efi.h>
#endif
#include <asm/global_data.h>

#ifdef CONFIG_AMLOGIC_MODIFY
#ifdef CONFIG_AMLOGIC_TIME_PROFILE
void record_init_call_time(void *func, unsigned int time);
void dump_initcall_time(void);
unsigned int get_time(void);
#endif
#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;
#ifdef CONFIG_AMLOGIC_MODIFY
#ifdef CONFIG_AMLOGIC_TIME_PROFILE
	int time;
#endif
#endif

	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);

#ifdef CONFIG_AMLOGIC_MODIFY
	#ifdef CONFIG_AMLOGIC_TIME_PROFILE
		time = get_time();
	#endif
#endif
		ret = (*init_fnc_ptr)();
#ifdef CONFIG_AMLOGIC_MODIFY
	#ifdef CONFIG_AMLOGIC_TIME_PROFILE
		time = get_time() - time;
		record_init_call_time((char *)*init_fnc_ptr - reloc_ofs, time);
	#endif
#endif
		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