| /****************************************************************************** |
| * |
| * Copyright (C) 2014 - 2016 Xilinx, Inc. All rights reserved. |
| * |
| * Permission is hereby granted, free of charge, to any person obtaining a copy |
| * of this software and associated documentation files (the "Software"), to deal |
| * in the Software without restriction, including without limitation the rights |
| * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
| * copies of the Software, and to permit persons to whom the Software is |
| * furnished to do so, subject to the following conditions: |
| * |
| * The above copyright notice and this permission notice shall be included in |
| * all copies or substantial portions of the Software. |
| * |
| * Use of the Software is limited solely to applications: |
| * (a) running on a Xilinx device, or |
| * (b) that interact with a Xilinx device through a bus or interconnect. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| * XILINX BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, |
| * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF |
| * OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
| * SOFTWARE. |
| * |
| * Except as contained in this notice, the name of the Xilinx shall not be used |
| * in advertising or otherwise to promote the sale, use or other dealings in |
| * this Software without prior written authorization from Xilinx. |
| * |
| ******************************************************************************/ |
| /*****************************************************************************/ |
| /** |
| * @file mpu.c |
| * |
| * This file contains initial configuration of the MPU. |
| * |
| * <pre> |
| * MODIFICATION HISTORY: |
| * |
| * Ver Who Date Changes |
| * ----- ---- -------- --------------------------------------------------- |
| * 5.00 pkp 02/20/14 First release |
| * 5.04 pkp 12/18/15 Updated MPU initialization as per the proper address map |
| * 6.00 pkp 06/27/16 moving the Init_MPU code to .boot section since it is a |
| * part of processor boot process |
| * </pre> |
| * |
| * @note |
| * |
| * None. |
| * |
| ******************************************************************************/ |
| /***************************** Include Files *********************************/ |
| |
| #include "xil_types.h" |
| #include "xreg_cortexr5.h" |
| #include "xil_mpu.h" |
| #include "xpseudo_asm.h" |
| #include "xparameters.h" |
| |
| /***************** Macros (Inline Functions) Definitions *********************/ |
| |
| /**************************** Type Definitions *******************************/ |
| |
| /************************** Constant Definitions *****************************/ |
| |
| /************************** Variable Definitions *****************************/ |
| |
| static const struct { |
| u64 size; |
| unsigned int encoding; |
| }region_size[] = { |
| { 0x20, REGION_32B }, |
| { 0x40, REGION_64B }, |
| { 0x80, REGION_128B }, |
| { 0x100, REGION_256B }, |
| { 0x200, REGION_512B }, |
| { 0x400, REGION_1K }, |
| { 0x800, REGION_2K }, |
| { 0x1000, REGION_4K }, |
| { 0x2000, REGION_8K }, |
| { 0x4000, REGION_16K }, |
| { 0x8000, REGION_32K }, |
| { 0x10000, REGION_64K }, |
| { 0x20000, REGION_128K }, |
| { 0x40000, REGION_256K }, |
| { 0x80000, REGION_512K }, |
| { 0x100000, REGION_1M }, |
| { 0x200000, REGION_2M }, |
| { 0x400000, REGION_4M }, |
| { 0x800000, REGION_8M }, |
| { 0x1000000, REGION_16M }, |
| { 0x2000000, REGION_32M }, |
| { 0x4000000, REGION_64M }, |
| { 0x8000000, REGION_128M }, |
| { 0x10000000, REGION_256M }, |
| { 0x20000000, REGION_512M }, |
| { 0x40000000, REGION_1G }, |
| { 0x80000000, REGION_2G }, |
| { 0x100000000, REGION_4G }, |
| }; |
| |
| /************************** Function Prototypes ******************************/ |
| void Init_MPU(void) __attribute__((__section__(".boot"))); |
| static void Xil_SetAttribute(u32 addr, u32 reg_size,s32 reg_num, u32 attrib) __attribute__((__section__(".boot"))); |
| static void Xil_DisableMPURegions(void) __attribute__((__section__(".boot"))); |
| |
| /***************************************************************************** |
| * |
| * Initialize MPU for a given address map and Enabled the background Region in |
| * MPU with default memory attributes for rest of address range for Cortex R5 |
| * processor. |
| * |
| * @param None. |
| * |
| * @return None. |
| * |
| * |
| ******************************************************************************/ |
| |
| void Init_MPU(void) |
| { |
| u32 Addr; |
| u32 RegSize; |
| u32 Attrib; |
| u32 RegNum = 0, i; |
| u64 size; |
| |
| Xil_DisableMPURegions(); |
| |
| Addr = 0x00000000U; |
| #ifdef XPAR_PSU_R5_DDR_0_S_AXI_BASEADDR |
| /* If the DDR is present, configure region as per DDR size */ |
| size = (XPAR_PSU_R5_DDR_0_S_AXI_HIGHADDR - XPAR_PSU_R5_DDR_0_S_AXI_BASEADDR) + 1; |
| if (size < 0x80000000) { |
| /* Lookup the size. */ |
| for (i = 0; i < sizeof region_size / sizeof region_size[0]; i++) { |
| if (size <= region_size[i].size) { |
| RegSize = region_size[i].encoding; |
| break; |
| } |
| } |
| } else { |
| /* if the DDR size is > 2GB, truncate it to 2GB */ |
| RegSize = REGION_2G; |
| } |
| #else |
| /* For DDRless system, configure region for TCM */ |
| RegSize = REGION_256K; |
| #endif |
| Attrib = NORM_NSHARED_WB_WA | PRIV_RW_USER_RW; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| RegNum++; |
| |
| /* |
| * 1G of strongly ordered memory from 0x80000000 to 0xBFFFFFFF for PL. |
| * 512 MB - LPD-PL interface |
| * 256 MB - FPD-PL (HPM0) interface |
| * 256 MB - FPD-PL (HPM1) interface |
| */ |
| Addr = 0x80000000; |
| RegSize = REGION_1G; |
| Attrib = STRONG_ORDERD_SHARED | PRIV_RW_USER_RW ; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| RegNum++; |
| |
| /* 512M of device memory from 0xC0000000 to 0xDFFFFFFF for QSPI */ |
| Addr = 0xC0000000U; |
| RegSize = REGION_512M; |
| Attrib = DEVICE_NONSHARED | PRIV_RW_USER_RW ; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| RegNum++; |
| |
| /* 256M of device memory from 0xE0000000 to 0xEFFFFFFF for PCIe Low */ |
| Addr = 0xE0000000U; |
| RegSize = REGION_256M; |
| Attrib = DEVICE_NONSHARED | PRIV_RW_USER_RW ; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| RegNum++; |
| |
| /* 16M of device memory from 0xF8000000 to 0xF8FFFFFF for STM_CORESIGHT */ |
| Addr = 0xF8000000U; |
| RegSize = REGION_16M; |
| Attrib = DEVICE_NONSHARED | PRIV_RW_USER_RW ; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| RegNum++; |
| |
| /* 1M of device memory from 0xF9000000 to 0xF90FFFFF for RPU_A53_GIC */ |
| Addr = 0xF9000000U; |
| RegSize = REGION_1M; |
| Attrib = DEVICE_NONSHARED | PRIV_RW_USER_RW ; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| RegNum++; |
| |
| /* 16M of device memory from 0xFD000000 to 0xFDFFFFFF for FPS slaves */ |
| Addr = 0xFD000000U; |
| RegSize = REGION_16M; |
| Attrib = DEVICE_NONSHARED | PRIV_RW_USER_RW ; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| RegNum++; |
| |
| /* 16M of device memory from 0xFE000000 to 0xFEFFFFFF for Upper LPS slaves */ |
| Addr = 0xFE000000U; |
| RegSize = REGION_16M; |
| Attrib = DEVICE_NONSHARED | PRIV_RW_USER_RW ; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| RegNum++; |
| |
| /* |
| * 16M of device memory from 0xFF000000 to 0xFFFFFFFF for Lower LPS slaves, |
| * CSU, PMU, TCM, OCM |
| */ |
| Addr = 0xFF000000U; |
| RegSize = REGION_16M; |
| Attrib = DEVICE_NONSHARED | PRIV_RW_USER_RW ; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| RegNum++; |
| |
| /* 256K of OCM RAM from 0xFFFC0000 to 0xFFFFFFFF marked as normal memory */ |
| Addr = 0xFFFC0000U; |
| RegSize = REGION_256K; |
| Attrib = NORM_NSHARED_WB_WA| PRIV_RW_USER_RW ; |
| Xil_SetAttribute(Addr,RegSize,RegNum, Attrib); |
| |
| /* A total of 10 MPU regions are allocated with another 6 being free for users */ |
| |
| } |
| |
| /***************************************************************************** |
| * |
| * Set the memory attributes for a section of memory with starting address addr |
| * of the region size defined by reg_size having attributes attrib of region number |
| * reg_num |
| * |
| * @param addr is the address for which attributes are to be set. |
| * @param attrib specifies the attributes for that memory region. |
| * @param reg_size specifies the size for that memory region. |
| * @param reg_num specifies the number for that memory region. |
| * @return None. |
| * |
| * |
| ******************************************************************************/ |
| static void Xil_SetAttribute(u32 addr, u32 reg_size,s32 reg_num, u32 attrib) |
| { |
| u32 Local_reg_size = reg_size; |
| |
| Local_reg_size = Local_reg_size<<1U; |
| Local_reg_size |= REGION_EN; |
| dsb(); |
| mtcp(XREG_CP15_MPU_MEMORY_REG_NUMBER,reg_num); |
| isb(); |
| mtcp(XREG_CP15_MPU_REG_BASEADDR,addr); /* Set base address of a region */ |
| mtcp(XREG_CP15_MPU_REG_ACCESS_CTRL,attrib); /* Set the control attribute */ |
| mtcp(XREG_CP15_MPU_REG_SIZE_EN,Local_reg_size); /* set the region size and enable it*/ |
| dsb(); |
| isb(); /* synchronize context on this processor */ |
| } |
| |
| |
| /***************************************************************************** |
| * |
| * Disable all the MPU regions if any of them is enabled |
| * |
| * @param None. |
| * |
| * @return None. |
| * |
| * |
| ******************************************************************************/ |
| static void Xil_DisableMPURegions(void) |
| { |
| u32 Temp; |
| u32 Index; |
| for (Index = 0; Index <= 15; Index++) { |
| mtcp(XREG_CP15_MPU_MEMORY_REG_NUMBER,Index); |
| Temp = mfcp(XREG_CP15_MPU_REG_SIZE_EN); |
| Temp &= (~REGION_EN); |
| dsb(); |
| mtcp(XREG_CP15_MPU_REG_SIZE_EN,Temp); |
| dsb(); |
| isb(); |
| } |
| |
| } |