1 /*
2  * Copyright (c) 2023, MediaTek Inc. All rights reserved.
3  *
4  * SPDX-License-Identifier: BSD-3-Clause
5  */
6 
7 /* TF-A system header */
8 #include <common/debug.h>
9 #include <lib/utils_def.h>
10 
11 /* Vendor header */
12 #include "apusys.h"
13 #include "apusys_dapc_v1.h"
14 #include <platform_def.h>
15 
set_apusys_dapc_v1(const struct apc_dom_16 * dapc,uint32_t size,dapc_cfg_func cfg)16 enum apusys_apc_err_status set_apusys_dapc_v1(const struct apc_dom_16 *dapc,
17 					      uint32_t size, dapc_cfg_func cfg)
18 {
19 	enum apusys_apc_err_status ret = APUSYS_APC_OK;
20 	uint32_t i;
21 
22 	if ((dapc == NULL) || (cfg == NULL)) {
23 		return APUSYS_APC_ERR_GENERIC;
24 	}
25 
26 	for (i = 0; i < size; i++) {
27 		ret += cfg(i, DOMAIN_0,	 dapc[i].d0_permission);
28 		ret += cfg(i, DOMAIN_1,	 dapc[i].d1_permission);
29 		ret += cfg(i, DOMAIN_2,	 dapc[i].d2_permission);
30 		ret += cfg(i, DOMAIN_3,	 dapc[i].d3_permission);
31 		ret += cfg(i, DOMAIN_4,	 dapc[i].d4_permission);
32 		ret += cfg(i, DOMAIN_5,	 dapc[i].d5_permission);
33 		ret += cfg(i, DOMAIN_6,	 dapc[i].d6_permission);
34 		ret += cfg(i, DOMAIN_7,	 dapc[i].d7_permission);
35 		ret += cfg(i, DOMAIN_8,	 dapc[i].d8_permission);
36 		ret += cfg(i, DOMAIN_9,	 dapc[i].d9_permission);
37 		ret += cfg(i, DOMAIN_10, dapc[i].d10_permission);
38 		ret += cfg(i, DOMAIN_11, dapc[i].d11_permission);
39 		ret += cfg(i, DOMAIN_12, dapc[i].d12_permission);
40 		ret += cfg(i, DOMAIN_13, dapc[i].d13_permission);
41 		ret += cfg(i, DOMAIN_14, dapc[i].d14_permission);
42 		ret += cfg(i, DOMAIN_15, dapc[i].d15_permission);
43 	}
44 
45 	if (ret != APUSYS_APC_OK) {
46 		ret = APUSYS_APC_ERR_GENERIC;
47 	}
48 
49 	return ret;
50 }
51 
dump_apusys_dapc_v1(const char * name,uintptr_t base,uint32_t reg_num,uint32_t dom_num)52 void dump_apusys_dapc_v1(const char *name, uintptr_t base, uint32_t reg_num, uint32_t dom_num)
53 {
54 	uint32_t d, i;
55 
56 	if ((name == NULL) || (base == 0)) {
57 		return;
58 	}
59 
60 	for (d = 0; d < dom_num; d++) {
61 		for (i = 0; i <= reg_num; i++) {
62 			INFO(MODULE_TAG "[%s] D%d_APC_%d: 0x%x\n", name, d, i,
63 			     mmio_read_32(base + d * DEVAPC_DOM_SIZE + i * DEVAPC_REG_SIZE));
64 		}
65 	}
66 
67 	INFO(MODULE_TAG "[%s] APC_CON: 0x%x\n", name, mmio_read_32(APUSYS_DAPC_CON(base)));
68 }
69