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 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 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 94 void emi_mpu_init(void) 95 { 96 /* TODO: more setting for EMI MPU. */ 97 } 98