From b169095c7dfd106a9c0c3d47e9f1c640ac3377d2 Mon Sep 17 00:00:00 2001 From: Christian Mauderer Date: Tue, 17 Nov 2020 09:38:50 +0100 Subject: cpu/armv7m: Add table based init for ARMV7M_MPU Modify the MPU functions of the stm32h7 BSP to be table based and available for all ARMV7M BSPs. Update #4180 --- bsps/arm/stm32h7/include/stm32h7/mpu-config.h | 44 ++++++++++ bsps/arm/stm32h7/start/bspstarthooks.c | 120 +------------------------- bsps/arm/stm32h7/start/mpu-config.c | 75 ++++++++++++++++ 3 files changed, 121 insertions(+), 118 deletions(-) create mode 100644 bsps/arm/stm32h7/include/stm32h7/mpu-config.h create mode 100644 bsps/arm/stm32h7/start/mpu-config.c (limited to 'bsps/arm') diff --git a/bsps/arm/stm32h7/include/stm32h7/mpu-config.h b/bsps/arm/stm32h7/include/stm32h7/mpu-config.h new file mode 100644 index 0000000000..27dddd4532 --- /dev/null +++ b/bsps/arm/stm32h7/include/stm32h7/mpu-config.h @@ -0,0 +1,44 @@ +/* SPDX-License-Identifier: BSD-2-Clause */ + +/* + * Copyright (C) 2020 embedded brains GmbH (http://www.embedded-brains.de) + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#ifndef LIBBSP_ARM_STM32H7_STM32H7_MPU_CONFIG_H +#define LIBBSP_ARM_STM32H7_STM32H7_MPU_CONFIG_H + +#include + +#ifdef __cplusplus +extern "C" { +#endif /* __cplusplus */ + +extern const ARMV7M_MPU_Region_config stm32h7_config_mpu_region[]; +extern const size_t stm32h7_config_mpu_region_count; + +#ifdef __cplusplus +} +#endif /* __cplusplus */ + +#endif /* LIBBSP_ARM_STM32H7_STM32H7_MPU_CONFIG_H */ diff --git a/bsps/arm/stm32h7/start/bspstarthooks.c b/bsps/arm/stm32h7/start/bspstarthooks.c index 565bd6876a..dcd4b0bef2 100644 --- a/bsps/arm/stm32h7/start/bspstarthooks.c +++ b/bsps/arm/stm32h7/start/bspstarthooks.c @@ -31,6 +31,7 @@ #include #include #include +#include #include #include @@ -83,123 +84,6 @@ static void init_peripheral_clocks(void) } } -static uint32_t get_region_size(uintptr_t size) -{ - if ((size & (size - 1)) == 0) { - return ARMV7M_MPU_RASR_SIZE(30 - __builtin_clz(size)); - } else { - return ARMV7M_MPU_RASR_SIZE(31 - __builtin_clz(size)); - } -} - -static void set_region( - volatile ARMV7M_MPU *mpu, - uint32_t region, - uint32_t rasr, - const void *begin, - const void *end -) -{ - uintptr_t size; - uint32_t rbar; - - RTEMS_OBFUSCATE_VARIABLE(begin); - RTEMS_OBFUSCATE_VARIABLE(end); - size = (uintptr_t) end - (uintptr_t) begin; - - if ( size > 0 ) { - rbar = (uintptr_t) begin | region | ARMV7M_MPU_RBAR_VALID; - rasr |= get_region_size(size); - } else { - rbar = region; - rasr = 0; - } - - mpu->rbar = rbar; - mpu->rasr = rasr; -} - -static void init_mpu(void) -{ - volatile ARMV7M_MPU *mpu; - volatile ARMV7M_SCB *scb; - uint32_t region_count; - uint32_t region; - - mpu = _ARMV7M_MPU; - scb = _ARMV7M_SCB; - - region_count = ARMV7M_MPU_TYPE_DREGION_GET(mpu->type); - - for (region = 0; region < region_count; ++region) { - mpu->rbar = ARMV7M_MPU_RBAR_VALID | region; - mpu->rasr = 0; - } - - set_region( - mpu, - 0, - ARMV7M_MPU_RASR_XN - | ARMV7M_MPU_RASR_AP(0x3) - | ARMV7M_MPU_RASR_TEX(0x1) | ARMV7M_MPU_RASR_C | ARMV7M_MPU_RASR_B - | ARMV7M_MPU_RASR_ENABLE, - stm32h7_memory_sram_axi_begin, - stm32h7_memory_sram_axi_end - ); - set_region( - mpu, - 1, - ARMV7M_MPU_RASR_XN - | ARMV7M_MPU_RASR_AP(0x3) - | ARMV7M_MPU_RASR_TEX(0x1) | ARMV7M_MPU_RASR_C | ARMV7M_MPU_RASR_B - | ARMV7M_MPU_RASR_ENABLE, - stm32h7_memory_sdram_1_begin, - stm32h7_memory_sdram_1_end - ); - set_region( - mpu, - 2, - ARMV7M_MPU_RASR_AP(0x5) - | ARMV7M_MPU_RASR_TEX(0x1) | ARMV7M_MPU_RASR_C | ARMV7M_MPU_RASR_B - | ARMV7M_MPU_RASR_ENABLE, - bsp_section_start_begin, - bsp_section_text_end - ); - set_region( - mpu, - 3, - ARMV7M_MPU_RASR_XN - | ARMV7M_MPU_RASR_AP(0x5) - | ARMV7M_MPU_RASR_TEX(0x1) | ARMV7M_MPU_RASR_C | ARMV7M_MPU_RASR_B - | ARMV7M_MPU_RASR_ENABLE, - bsp_section_rodata_begin, - bsp_section_rodata_end - ); - set_region( - mpu, - 4, - ARMV7M_MPU_RASR_XN - | ARMV7M_MPU_RASR_AP(0x3) - | ARMV7M_MPU_RASR_TEX(0x2) - | ARMV7M_MPU_RASR_ENABLE, - bsp_section_nocache_begin, - bsp_section_nocachenoload_end - ); - set_region( - mpu, - region - 1, - ARMV7M_MPU_RASR_XN | ARMV7M_MPU_RASR_ENABLE, - stm32h7_memory_null_begin, - stm32h7_memory_null_end - ); - - mpu->ctrl = ARMV7M_MPU_CTRL_ENABLE | ARMV7M_MPU_CTRL_PRIVDEFENA; - scb->shcsr |= ARMV7M_SCB_SHCSR_MEMFAULTENA; - - _ARM_Data_synchronization_barrier(); - _ARM_Instruction_synchronization_barrier(); -} - void bsp_start_hook_0(void) { if ((RCC->AHB3ENR & RCC_AHB3ENR_FMCEN) == 0) { @@ -226,7 +110,7 @@ void bsp_start_hook_0(void) SCB_EnableDCache(); } - init_mpu(); + _ARMV7M_MPU_Setup(stm32h7_config_mpu_region, stm32h7_config_mpu_region_count); } void bsp_start_hook_1(void) diff --git a/bsps/arm/stm32h7/start/mpu-config.c b/bsps/arm/stm32h7/start/mpu-config.c new file mode 100644 index 0000000000..8140e73c37 --- /dev/null +++ b/bsps/arm/stm32h7/start/mpu-config.c @@ -0,0 +1,75 @@ +/* SPDX-License-Identifier: BSD-2-Clause */ + +/* + * Copyright (C) 2020 embedded brains GmbH (http://www.embedded-brains.de) + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#include +#include +#include + +const ARMV7M_MPU_Region_config stm32h7_config_mpu_region [] = { + { + .begin = stm32h7_memory_sram_axi_begin, + .end = stm32h7_memory_sram_axi_end, + .rasr = ARMV7M_MPU_RASR_XN + | ARMV7M_MPU_RASR_AP(0x3) + | ARMV7M_MPU_RASR_TEX(0x1) | ARMV7M_MPU_RASR_C | ARMV7M_MPU_RASR_B + | ARMV7M_MPU_RASR_ENABLE, + }, { + .begin = stm32h7_memory_sdram_1_begin, + .end = stm32h7_memory_sdram_1_end, + .rasr = ARMV7M_MPU_RASR_XN + | ARMV7M_MPU_RASR_AP(0x3) + | ARMV7M_MPU_RASR_TEX(0x1) | ARMV7M_MPU_RASR_C | ARMV7M_MPU_RASR_B + | ARMV7M_MPU_RASR_ENABLE, + }, { + .begin = bsp_section_start_begin, + .end = bsp_section_text_end, + .rasr = ARMV7M_MPU_RASR_AP(0x5) + | ARMV7M_MPU_RASR_TEX(0x1) | ARMV7M_MPU_RASR_C | ARMV7M_MPU_RASR_B + | ARMV7M_MPU_RASR_ENABLE, + }, { + .begin = bsp_section_rodata_begin, + .end = bsp_section_rodata_end, + .rasr = ARMV7M_MPU_RASR_XN + | ARMV7M_MPU_RASR_AP(0x5) + | ARMV7M_MPU_RASR_TEX(0x1) | ARMV7M_MPU_RASR_C | ARMV7M_MPU_RASR_B + | ARMV7M_MPU_RASR_ENABLE, + }, { + .begin = bsp_section_nocache_begin, + .end = bsp_section_nocachenoload_end, + .rasr = ARMV7M_MPU_RASR_XN + | ARMV7M_MPU_RASR_AP(0x3) + | ARMV7M_MPU_RASR_TEX(0x2) + | ARMV7M_MPU_RASR_ENABLE, + }, { + .begin = stm32h7_memory_null_begin, + .end = stm32h7_memory_null_end, + .rasr = ARMV7M_MPU_RASR_XN | ARMV7M_MPU_RASR_ENABLE, + } + }; + +const size_t stm32h7_config_mpu_region_count = + RTEMS_ARRAY_SIZE(stm32h7_config_mpu_region); -- cgit v1.2.3