1 /* SPDX-License-Identifier: GPL-2.0-only OR MIT */
2
3 #include <soc/devapc.h>
4 #include <soc/devapc_common.h>
5
getreg_domain(uintptr_t base,unsigned int offset,enum domain_id domain_id,unsigned int index)6 void *getreg_domain(uintptr_t base, unsigned int offset,
7 enum domain_id domain_id, unsigned int index)
8 {
9 return (void *)(base + offset + domain_id * DOMAIN_OFT + index * IDX_OFT);
10 }
11
getreg(uintptr_t base,unsigned int offset)12 void *getreg(uintptr_t base, unsigned int offset)
13 {
14 return getreg_domain(base, offset, 0, 0);
15 }
16
set_module_apc(uintptr_t base,uint32_t module,enum domain_id domain_id,enum devapc_perm_type perm)17 void set_module_apc(uintptr_t base, uint32_t module, enum domain_id domain_id,
18 enum devapc_perm_type perm)
19 {
20 uint32_t apc_register_index;
21 uint32_t apc_set_index;
22
23 apc_register_index = module / MOD_NO_IN_1_DEVAPC;
24 apc_set_index = module % MOD_NO_IN_1_DEVAPC;
25
26 clrsetbits32(getreg_domain(base, 0, domain_id, apc_register_index),
27 0x3 << (apc_set_index * 2),
28 perm << (apc_set_index * 2));
29 }
30
dapc_init(void)31 void dapc_init(void)
32 {
33 size_t i;
34 uintptr_t devapc_ao_base;
35
36 for (i = 0; i < devapc_init_cnt; i++) {
37 devapc_ao_base = devapc_init[i].base;
38
39 /* Init dapc */
40 write32(getreg(devapc_ao_base, AO_APC_CON), 0x0);
41 write32(getreg(devapc_ao_base, AO_APC_CON), 0x1);
42
43 /* Initialization */
44 if (devapc_init[i].init)
45 devapc_init[i].init(devapc_ao_base);
46
47 /* Dump setting */
48 if (CONFIG(DEVAPC_DEBUG) && devapc_init[i].dump)
49 devapc_init[i].dump(devapc_ao_base);
50 }
51 }
52