1 /*
2 * Copyright (c) 2021-2022, 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 == 0U) && ((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 0;
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) | (i << 24);
87
88 if (_emi_mpu_set_protection(start, end, region_info->apc[i]) < 0) {
89 WARN("failed to set emi mpu protection(%d, %d, %d)\n",
90 start, end, region_info->apc[i]);
91 }
92 }
93
94 return 0;
95 }
96
emi_mpu_init(void)97 void emi_mpu_init(void)
98 {
99 struct emi_region_info_t region_info;
100
101 /* SCP DRAM */
102 region_info.start = 0x50000000ULL;
103 region_info.end = 0x5109FFFFULL;
104 region_info.region = 2;
105 SET_ACCESS_PERMISSION(region_info.apc, 1,
106 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
107 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
108 FORBIDDEN, FORBIDDEN, FORBIDDEN, NO_PROTECTION,
109 FORBIDDEN, FORBIDDEN, FORBIDDEN, NO_PROTECTION);
110 emi_mpu_set_protection(®ion_info);
111
112 /* DSP protect address */
113 region_info.start = 0x60000000ULL; /* dram base addr */
114 region_info.end = 0x610FFFFFULL;
115 region_info.region = 3;
116 SET_ACCESS_PERMISSION(region_info.apc, 1,
117 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
118 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
119 FORBIDDEN, NO_PROTECTION, FORBIDDEN, FORBIDDEN,
120 FORBIDDEN, FORBIDDEN, FORBIDDEN, NO_PROTECTION);
121 emi_mpu_set_protection(®ion_info);
122
123 /* Forbidden All */
124 region_info.start = 0x40000000ULL; /* dram base addr */
125 region_info.end = 0x1FFFF0000ULL;
126 region_info.region = 4;
127 SET_ACCESS_PERMISSION(region_info.apc, 1,
128 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
129 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
130 FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
131 FORBIDDEN, FORBIDDEN, FORBIDDEN, NO_PROTECTION);
132 emi_mpu_set_protection(®ion_info);
133 }
134
