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