1 /*
2 * Copyright (c) 2021, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <string.h>
8 #include <common/debug.h>
9 #include <lib/mmio.h>
10 #include <emi_mpu.h>
11
12 #if ENABLE_EMI_MPU_SW_LOCK
13 static unsigned char region_lock_state[EMI_MPU_REGION_NUM];
14 #endif
15
16 #define EMI_MPU_START_MASK (0x00FFFFFF)
17 #define EMI_MPU_END_MASK (0x00FFFFFF)
18 #define EMI_MPU_APC_SW_LOCK_MASK (0x00FFFFFF)
19 #define EMI_MPU_APC_HW_LOCK_MASK (0x80FFFFFF)
20
_emi_mpu_set_protection(unsigned int start,unsigned int end,unsigned int apc)21 static int _emi_mpu_set_protection(unsigned int start, unsigned int end,
22 unsigned int apc)
23 {
24 unsigned int dgroup;
25 unsigned int region;
26
27 region = (start >> 24) & 0xFF;
28 start &= EMI_MPU_START_MASK;
29 dgroup = (end >> 24) & 0xFF;
30 end &= EMI_MPU_END_MASK;
31
32 if ((region >= EMI_MPU_REGION_NUM) || (dgroup > EMI_MPU_DGROUP_NUM)) {
33 WARN("invalid region, domain\n");
34 return -1;
35 }
36
37 #if ENABLE_EMI_MPU_SW_LOCK
38 if (region_lock_state[region] == 1) {
39 WARN("invalid region\n");
40 return -1;
41 }
42
43 if ((dgroup == 0) && ((apc >> 31) & 0x1)) {
44 region_lock_state[region] = 1;
45 }
46
47 apc &= EMI_MPU_APC_SW_LOCK_MASK;
48 #else
49 apc &= EMI_MPU_APC_HW_LOCK_MASK;
50 #endif
51
52 if ((start >= DRAM_OFFSET) && (end >= start)) {
53 start -= DRAM_OFFSET;
54 end -= DRAM_OFFSET;
55 } else {
56 WARN("invalid range\n");
57 return -1;
58 }
59
60 mmio_write_32(EMI_MPU_SA(region), start);
61 mmio_write_32(EMI_MPU_EA(region), end);
62 mmio_write_32(EMI_MPU_APC(region, dgroup), apc);
63
64 #if defined(SUB_EMI_MPU_BASE)
65 mmio_write_32(SUB_EMI_MPU_SA(region), start);
66 mmio_write_32(SUB_EMI_MPU_EA(region), end);
67 mmio_write_32(SUB_EMI_MPU_APC(region, dgroup), apc);
68 #endif
69 return 1;
70 }
71
emi_mpu_set_protection(struct emi_region_info_t * region_info)72 int emi_mpu_set_protection(struct emi_region_info_t *region_info)
73 {
74 unsigned int start, end;
75 int i;
76
77 if (region_info->region >= EMI_MPU_REGION_NUM) {
78 WARN("invalid region\n");
79 return -1;
80 }
81
82 start = (unsigned int)(region_info->start >> EMI_MPU_ALIGN_BITS) |
83 (region_info->region << 24);
84
85 for (i = EMI_MPU_DGROUP_NUM - 1; i >= 0; i--) {
86 end = (unsigned int)(region_info->end >> EMI_MPU_ALIGN_BITS) |
87 (i << 24);
88 _emi_mpu_set_protection(start, end, region_info->apc[i]);
89 }
90
91 return 0;
92 }
93
dump_emi_mpu_regions(void)94 void dump_emi_mpu_regions(void)
95 {
96 unsigned long apc[EMI_MPU_DGROUP_NUM], sa, ea;
97
98 int region, i;
99
100 /* Only dump 8 regions(max: EMI_MPU_REGION_NUM --> 32) */
101 for (region = 0; region < 8; ++region) {
102 for (i = 0; i < EMI_MPU_DGROUP_NUM; ++i)
103 apc[i] = mmio_read_32(EMI_MPU_APC(region, i));
104 sa = mmio_read_32(EMI_MPU_SA(region));
105 ea = mmio_read_32(EMI_MPU_EA(region));
106
107 INFO("region %d:\n", region);
108 INFO("\tsa:0x%lx, ea:0x%lx, apc0: 0x%lx apc1: 0x%lx\n",
109 sa, ea, apc[0], apc[1]);
110 }
111 }
112
emi_mpu_init(void)113 void emi_mpu_init(void)
114 {
115 struct emi_region_info_t region_info;
116
117 /* SCP DRAM */
118 region_info.start = 0x50000000ULL;
119 region_info.end = 0x51400000ULL;
120 region_info.region = 2;
121 SET_ACCESS_PERMISSION(region_info.apc, 1,
122 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
123 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
124 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
125 NO_PROTECTION, FORBIDDEN, FORBIDDEN, NO_PROTECTION);
126 emi_mpu_set_protection(®ion_info);
127
128 /* DSP protect address */
129 region_info.start = 0x60000000ULL; /* dram base addr */
130 region_info.end = 0x610FFFFFULL;
131 region_info.region = 3;
132 SET_ACCESS_PERMISSION(region_info.apc, 1,
133 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
134 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
135 FORBIDDEN, FORBIDDEN, FORBIDDEN, NO_PROTECTION,
136 FORBIDDEN, FORBIDDEN, FORBIDDEN, NO_PROTECTION);
137 emi_mpu_set_protection(®ion_info);
138
139 /* Forbidden All */
140 region_info.start = 0x40000000ULL; /* dram base addr */
141 region_info.end = 0x1FFFF0000ULL;
142 region_info.region = 4;
143 SET_ACCESS_PERMISSION(region_info.apc, 1,
144 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
145 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
146 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
147 FORBIDDEN, FORBIDDEN, FORBIDDEN, NO_PROTECTION);
148 emi_mpu_set_protection(®ion_info);
149
150 dump_emi_mpu_regions();
151 }
152