xref: /arm-trusted-firmware/plat/mediatek/lib/mtk_init/mtk_init.c (revision 91f16700b400a8c0651d24a598fc48ee2997a0d7)
1*91f16700Schasinglulu /*
2*91f16700Schasinglulu  * Copyright (c) 2022, MediaTek Inc. All rights reserved.
3*91f16700Schasinglulu  *
4*91f16700Schasinglulu  * SPDX-License-Identifier: BSD-3-Clause
5*91f16700Schasinglulu  */
6*91f16700Schasinglulu 
7*91f16700Schasinglulu #include <common/debug.h>
8*91f16700Schasinglulu #include <lib/utils_def.h>
9*91f16700Schasinglulu #include <lib/mtk_init/mtk_init.h>
10*91f16700Schasinglulu 
11*91f16700Schasinglulu INIT_CALL_TABLE(EXPAND_AS_EXTERN);
12*91f16700Schasinglulu extern struct initcall __MTK_PLAT_INITCALL_END__[];
13*91f16700Schasinglulu 
14*91f16700Schasinglulu struct initcall *initcall_list[] = {
15*91f16700Schasinglulu 	INIT_CALL_TABLE(EXPAND_AS_SYMBOL_ARR)
16*91f16700Schasinglulu 	__MTK_PLAT_INITCALL_END__
17*91f16700Schasinglulu };
18*91f16700Schasinglulu 
19*91f16700Schasinglulu void mtk_init_one_level(uint32_t level)
20*91f16700Schasinglulu {
21*91f16700Schasinglulu 	const struct initcall *entry;
22*91f16700Schasinglulu 	int error;
23*91f16700Schasinglulu 
24*91f16700Schasinglulu 	if (level >= MTK_INIT_LVL_MAX) {
25*91f16700Schasinglulu 		ERROR("invalid level:%u\n", level);
26*91f16700Schasinglulu 		panic();
27*91f16700Schasinglulu 	}
28*91f16700Schasinglulu 
29*91f16700Schasinglulu 	INFO("init calling level:%u\n", level);
30*91f16700Schasinglulu 	for (entry = initcall_list[level];
31*91f16700Schasinglulu 	     (entry != NULL) && (entry < initcall_list[level + 1]);
32*91f16700Schasinglulu 	     entry++) {
33*91f16700Schasinglulu 		INFO("calling %s\n", entry->name);
34*91f16700Schasinglulu 		error = entry->fn();
35*91f16700Schasinglulu 		if (error != 0) {
36*91f16700Schasinglulu 			ERROR("init %s fail, errno:%d\n", entry->name, error);
37*91f16700Schasinglulu 		}
38*91f16700Schasinglulu 	}
39*91f16700Schasinglulu }
40